/***************************************************************
*
* User Interface ( Canvas ) of DUBwise
*
* Author: Marcus -LiGi- Bueschleb
*
* see README for further Infos
*
***************************************************************/
import javax.microedition.lcdui.*;
import javax.microedition.rms.*;
import javax.microedition.media.*;
import javax.microedition.media.control.*;
// for fileapi
import javax.microedition.io.*;
import javax.microedition.midlet.*;
import javax.microedition.io.file.*;
import java.io.*;
import java.util.*;
// end for fileapi
public class DUBwiseCanvas
extends Canvas
implements Runnable,DUBwiseDefinitions
{
// for fileapi
public final static int MAX_FILELIST_LENGTH=
100;
public final static int MAX_PATH_DEPTH=
10;
// String act_path="";
// String last_path="";
byte act_path_depth=
0;
String[] act_path_arr
;
public String act_path
()
{
String res=
"";
for (int i=
0;i
<act_path_depth
;i++
)
res+=act_path_arr
[i
];
return res
;
}
String[] file_list
;
int file_list_length=
0;
int[] act_proxy_ip=
{192,
168,
1,
42,
4242}; // { ip , ip , ip , ip , port }
int[] act_connection_ip=
{192,
168,
1,
42,
4242}; // { ip , ip , ip , ip , port }
int ipinput_pos=
0;
// end for fileapi
public String ip_digit_zeroes
(int digit
)
{ return "" + digit/
100 +
"" +
(digit/
10)%10 +
"" +
(digit
)%10
; }
public String ip_str
(int[] ip,
boolean with_zeroes
)
{
if(with_zeroes
)
return ip_digit_zeroes
(ip
[0]) +
"." +ip_digit_zeroes
(ip
[1]) +
"."+ip_digit_zeroes
(ip
[2]) +
"."+ip_digit_zeroes
(ip
[3]) +
":"+ip_digit_zeroes
(ip
[4]) ;
else
return ip
[0]+
"."+ip
[1]+
"."+ip
[2]+
"."+ip
[3]+
":"+ip
[4];
}
int heading_offset=
0;
int act_wp
;
// name/handle for the recordStore to memorize some stuff
private final static String RECORD_STORE_NAME=
"DUBSETT";
private BTSearcher bt_scanner
;
public MKCommunicator mk=
null;
private MKStatistics mk_stat=
null;
private MKParamsEditor params_editor=
null;
public DUBwiseDebug debug=
null;
//#if voice_mode!="no_voice"
private MKStatusVoice status_voice
;
//#endif
private String err=
"";
private DUBwise root
;
public UFOProber ufo_prober
;
byte[] settings_arr
;
public boolean do_vibra=
true;
public boolean do_sound=
true;
public boolean do_scrollbg=
true;
public boolean keep_lighton=
false;
private Image bg_img
;
private Image bt_img
;
private Image lcd_img
;
private Image load_img
;
private Image symbols_img
;
public boolean fullscreen=
false;
public int act_motor=
0;
public int act_motor_increase=
0;
public boolean motor_test_sel_all=
false;
final static int SKINID_DARK=
0;
final static int SKINID_LIGHT =
1;
//holds id of actual skin
byte act_skin=SKINID_DARK
;
public final static int MAX_GRAPHS=
4;
public final static int[] graph_colors=
{0x156315,0xCC1315,0xf8ef02,0x19194d
};
public int[] graph_sources=
{0,
1,
2,
3};
public String[] graph_names=
{"nick int",
"roll int",
"nick acc",
"roll acc"};
public int[][] graph_data
;
public int[] nick_line_pos_data
;
public int[] roll_line_pos_data
;
public int[] accnick_line_pos_data
;
public int[] accroll_line_pos_data
;
public int lcd_char_width=
0;
public int lcd_char_height=
0;
public int frame_pos=
0;
public int user_intent=USER_INTENT_NONE
;
int line_scaler=
20;
int rawdebug_cursor_y=
0;
int rawdebug_off_y=
0;
public int line_middle_y
;
boolean quit=
false;
boolean rescan=
true;
int bg_offset=
0;
// variable to hold the current state
public int state=-
1;
int local_max=-
1;
int y_off=
0;
int spacer=
0;
int spacer1=
0;
int[] motor_test =
{0,
0,
0,
0};
String[] menu_items
;
int[] menu_actions
;
int act_menu_select=
0;
String[] lcd_lines =
null;
public void paint_menu
(Graphics g
)
{
for ( int i=
0;i
<menu_items.
length;i++
)
{
if ((frame_pos
%3
)!=
0)
{
lcd_lines
[i
]=
(act_menu_select==i
?">":
" ") + menu_items
[i
];
for ( int ii=
0;ii
<(18-menu_items
[i
].
length());ii++
)
lcd_lines
[i
]+=
" ";
if (act_menu_select==i
)
lcd_lines
[i
]+=
"<";
}
else
lcd_lines
[i
]=
" " + menu_items
[i
];
}
paint_lcd
(g,
true);
}
public void menu_keypress
(int keyCode
)
{
debug.
log("KeyCode:"+keyCode
);
switch (getGameAction
(keyCode
))
{
case UP:
if (act_menu_select
!=
0) act_menu_select--
;
else
act_menu_select=menu_items.
length-
1;
break;
case DOWN:
if (act_menu_select
<(menu_items.
length-
1)) act_menu_select++
;
else act_menu_select=
0;
break;
}
}
public boolean cam_condition
()
{
return (mk.
stick_data.
stick[5]>100);
}
// int lcd_top=25;
public void paint_lcd
(Graphics g,
boolean bottomup
)
{
int y
;
int lcd_top=
(state==STATEID_EDIT_PARAMS
?0:
25);
int spacer_left_right=
(this.
getWidth()-
(20*(lcd_img.
getWidth()/
222)))/
2;
// for(int i=0;i<lcd_lines.length;i++)
int max_lines=
(this.
getHeight()-lcd_top
)/lcd_char_height
;
int display_lines=
(lcd_lines.
length>max_lines
?max_lines:lcd_lines.
length);
int lcd_off=
(state==STATEID_EDIT_PARAMS
?params_editor.
act_y:act_menu_select
)-display_lines+
1;
if ( lcd_off
<0) lcd_off=
0;
for(int i=
0;i
<display_lines
;i++
)
for (int pos=
0;pos
<20;pos++
)
{
if (bottomup
)
y=
this.
getHeight()-
(display_lines-i
)*lcd_char_height
;
else
y=i
*lcd_char_height
;
g.
setClip((lcd_img.
getWidth()/
222)*pos+spacer_left_right,y,
(lcd_img.
getWidth()/
222),lcd_img.
getHeight());
g.
drawImage(lcd_img,spacer_left_right+
(lcd_img.
getWidth()/
222)*pos-
((pos
<lcd_lines
[i+lcd_off
].
length()?lcd_lines
[i+lcd_off
].
charAt(pos
):
' ')-
' ')*(lcd_img.
getWidth()/
222),y,g.
TOP | g.
LEFT);
}
}
public void load_images
()
{
try
{
// load all needed images
switch (act_skin
)
{
case SKINID_DARK:
lcd_img=
Image.
createImage("/lcd_green.png");
bg_img=
Image.
createImage("/starfield.jpg"); break;
case SKINID_LIGHT:
lcd_img=
Image.
createImage("/lcd_blue.png");
bg_img=
Image.
createImage("/clouds.jpg");
break;
}
bt_img=
Image.
createImage("/bt.png");
symbols_img=
Image.
createImage("/symbols.png");
load_img=
Image.
createImage("/load.png");
lcd_char_width=lcd_img.
getWidth()/
222;
lcd_char_height=lcd_img.
getHeight();
graph_data=
new int[MAX_GRAPHS
][bg_img.
getWidth()];
for (int c=
0;c
<bg_img.
getWidth();c++
)
for (int d=
0;d
<MAX_GRAPHS
;d++
)
graph_data
[d
][c
]=-
1;
nick_line_pos_data=
new int[bg_img.
getWidth()];
roll_line_pos_data=
new int[bg_img.
getWidth()];
accnick_line_pos_data=
new int[bg_img.
getWidth()];
accroll_line_pos_data=
new int[bg_img.
getWidth()];
for (int c=
0;c
<bg_img.
getWidth();c++
)
{
nick_line_pos_data
[c
]=-
1;
roll_line_pos_data
[c
]=-
1;
accnick_line_pos_data
[c
]=-
1;
accroll_line_pos_data
[c
]=-
1;
}
}
catch (Exception e
)
{
debug.
err(e.
toString());
}
}
public DUBwiseCanvas
(DUBwise _root
)
{
// file
file_list=
new String[MAX_FILELIST_LENGTH
];
act_path_arr=
new String[MAX_PATH_DEPTH
];
// end file
root=_root
;
debug =
new DUBwiseDebug
(this);
bt_scanner =
new BTSearcher
();
params_editor =
new MKParamsEditor
(this);
ufo_prober =
new UFOProber
();
mk =
new MKCommunicator
(root,debug
);
mk_stat =
new MKStatistics
(mk
);
//#if voice_mode!="no_voice"
status_voice=
new MKStatusVoice
(mk,
this);
//#endif
try
{
RecordStore recStore = RecordStore.
openRecordStore(RECORD_STORE_NAME ,
true );
if (recStore.
getNumRecords()==
3)
{
//byte[] recData = new byte[recStore.getRecordSize(1)];
//int len = recStore.getRecord(1, recData, 0);
//byte[] recData2 = new byte[recStore.getRecordSize(2)];
//int len2 = recStore.getRecord(2, recData, 0);
byte[] url_data=recStore.
getRecord(1);
byte[] name_data=recStore.
getRecord(2);
settings_arr=recStore.
getRecord(3);
act_skin=settings_arr
[0];
do_sound=
(settings_arr
[1]==
1);
do_vibra=
(settings_arr
[2]==
1);
do_scrollbg=
(settings_arr
[3]==
1);
fullscreen=
(settings_arr
[4]==
1);
keep_lighton=
(settings_arr
[5]==
1);
connect_mk
(new String(url_data,
0, url_data.
length),
new String(name_data,
0, name_data.
length));
}
recStore.
closeRecordStore();
}
catch (Exception e
)
{
settings_arr=
new byte[10];
err+=e.
toString();
}
load_images
();
// chg_state((mk.force_disconnect)?STATEID_SCANNING:STATEID_MAINMENU);
chg_state
(STATEID_MAINMENU
);
new Thread(this).
start();
}
/****************************** Thread ******************/
// ticking runnable Section
public void run
()
{
while(true)
{
try {
repaint
();
serviceRepaints
();
long loopStartTime =
System.
currentTimeMillis();
long sleeptime=
0;
// ticked thing
frame_pos++
;
switch(state
)
{
case STATEID_CAMMODE:
try
{
if(cam_condition
())
{
cam_img=
null;
debug.
log("get snap\n");
cam_raw = mVideoControl.
getSnapshot(null);
try { Thread.
sleep(4000); }
catch (Exception e
)
{
err=
"Problem Sleeping ";
}
}
else
{
if (cam_img==
null)
cam_img =
Image.
createImage(cam_raw,
0, cam_raw.
length);
}
}
catch ( Exception e
)
{
debug.
log(e.
toString());
}
break;
case STATEID_KEYCONTROL:
mk.
send_keys(keycontrol_bitfield
);
break;
case STATEID_READ_PARAMS:
if (mk.
watchdog.
act_paramset==
5)
chg_state
(STATEID_SELECT_PARAMSET
);
else
{
lcd_lines
[0]=
"Reading Settings ";
lcd_lines
[1]=mk.
watchdog.
act_paramset+
"/5 |"+
(mk.
watchdog.
act_paramset>0?"#":
"_") +
(mk.
watchdog.
act_paramset>1?"#":
"_") +
(mk.
watchdog.
act_paramset>2?"#":
"_")+
(mk.
watchdog.
act_paramset>3?"#":
"_")+
(mk.
watchdog.
act_paramset>4?"#":
"_") +
"| ";
}
break;
case STATEID_MOTORTEST:
if (motor_test_sel_all
)
for (int m=
0;m
<4;m++
)
{
motor_test
[m
]+=act_motor_increase
;
if (motor_test
[m
]<0)motor_test
[m
]=
0;
if (motor_test
[m
]>255)motor_test
[m
]=
255;
}
else
{
motor_test
[act_motor
]+=act_motor_increase
;
if (motor_test
[act_motor
]<0) motor_test
[act_motor
]=
0;
if (motor_test
[act_motor
]>255) motor_test
[act_motor
]=
255;
}
mk.
motor_test(motor_test
);
break;
case STATEID_IPINPUT:
lcd_lines
[1]=ip_str
(act_proxy_ip,
true);
lcd_lines
[2]=
"";
for(int foo=
0;foo
<20;foo++
)
{
if (foo==ipinput_pos
)
lcd_lines
[2]+=
"^";
else
lcd_lines
[2]+=
" ";
}
break;
case STATEID_MAINMENU:
if (ufo_prober.
change_notify)
{
ufo_prober.
change_notify=
false;
chg_state
(STATEID_MAINMENU
);
}
break;
case STATEID_SCANNING:
intro_str_delay--
;
if (intro_str_delay
<0)
{
intro_str_delay=
1;
if (intro_str_pos
>intro_str.
length())
intro_str_pos=
0;
lcd_lines
[3]=intro_str.
substring(intro_str_pos,
(((intro_str_pos+
20)>intro_str.
length())?intro_str.
length():intro_str_pos+
20));
intro_str_pos++
;
}
if (!bt_scanner.
searching)
chg_state
(STATEID_DEVICESELECT
);
break;
}
try {
nick_line_pos_data
[-bg_offset
] = mk.
debug_data.
nick_int();
roll_line_pos_data
[-bg_offset
] = mk.
debug_data.
roll_int();
accnick_line_pos_data
[-bg_offset
] = mk.
debug_data.
accnick();
accroll_line_pos_data
[-bg_offset
] = mk.
debug_data.
accroll();
}
catch (Exception e
)
{
err+=e.
toString();
}
if (quit
)
{
try
{
RecordStore.
deleteRecordStore(RECORD_STORE_NAME
);
RecordStore recStore = RecordStore.
openRecordStore(RECORD_STORE_NAME,
true );
recStore.
addRecord(mk.
mk_url.
getBytes(),
0, mk.
mk_url.
getBytes().
length);
recStore.
addRecord(mk.
name.
getBytes(),
0, mk.
name.
getBytes().
length);
settings_arr=
new byte[10];
settings_arr
[0]=
(byte)act_skin
;
settings_arr
[1]=
(byte)(do_sound
?1:
0);
settings_arr
[2]=
(byte)(do_vibra
?1:
0);
settings_arr
[3]=
(byte)(do_scrollbg
?1:
0);
settings_arr
[4]=
(byte)(fullscreen
?1:
0);
settings_arr
[5]=
(byte)(keep_lighton
?1:
0);
recStore.
addRecord(settings_arr,
0, settings_arr.
length);
recStore.
closeRecordStore();
}
catch (Exception e
)
{
err+=e.
toString();
}
root.
quit();
}
if (rescan
)
{
rescan=
false;
}
try {
//rescan=false;
bg_offset--
;
if (bg_offset==-bg_img.
getWidth())
bg_offset=
0;
if (keep_lighton
) com.
nokia.
mid.
ui.
DeviceControl.
setLights(0,
100);
}
catch (Exception e
) { }
sleeptime=
1000/
15 -
(int) (System.
currentTimeMillis()- loopStartTime
);
if (sleeptime
<0)
sleeptime=
100; // everyone has fi sleep
try { Thread.
sleep(sleeptime
); }
catch (Exception e
)
{
err=
"Problem Sleeping ";
}
}
catch (Exception e
)
{
err+=e.
toString();
}
}
}
boolean firstrun=
true;
public int skin_bg_color
()
{
switch (act_skin
)
{
case SKINID_DARK:
return 0x000000
;
default:
case SKINID_LIGHT:
return 0xFFFFFF
;
}
}
public int skin_fg_color
()
{
switch (act_skin
)
{
case SKINID_DARK:
return 0xFFFFFF
;
default:
case SKINID_LIGHT:
return 0x000000
;
}
}
// drawing section
public void paint
(Graphics g
) {
//
if (debug.
showing)
{
debug.
paint(g
);
return;
}
if (firstrun
)
{
if (fullscreen
) setFullScreenMode
(fullscreen
);
firstrun=
false;
}
y_off=
0;
try {
if (mk
!=
null)
{
line_middle_y=
this.
getHeight()/
2;
if (local_max
<Math.
abs(mk.
debug_data.
nick_int()))
local_max=
Math.
abs(mk.
debug_data.
nick_int());
if (local_max
<Math.
abs(mk.
debug_data.
roll_int()))
local_max=
Math.
abs(mk.
debug_data.
roll_int());
if (local_max
<Math.
abs(mk.
debug_data.
accnick()))
local_max=
Math.
abs(mk.
debug_data.
accnick());
if (local_max
<Math.
abs(mk.
debug_data.
accroll()))
local_max=
Math.
abs(mk.
debug_data.
accroll());
line_scaler= local_max/
(this.
getHeight()/
2)+
1;
}
Font f1 =
Font.
getFont(Font.
FACE_SYSTEM,
Font.
STYLE_PLAIN,
Font.
SIZE_MEDIUM);
Font f2 =
Font.
getFont(Font.
FACE_SYSTEM,
Font.
STYLE_PLAIN,
Font.
SIZE_SMALL);
spacer=
(f1.
getHeight());
spacer1=
(f2.
getHeight());
//default Font
g.
setFont(f1
);
//draw background
if ((!do_scrollbg
) ||
(state==STATEID_EDIT_PARAMS
))
{
g.
setColor(0xdedfff
);
g.
fillRect(0,
0,
this.
getWidth(),symbols_img.
getHeight());
g.
setColor(skin_bg_color
());
g.
fillRect(0,symbols_img.
getHeight(),
this.
getWidth(),
this.
getHeight()-symbols_img.
getHeight());
}
else
{
g.
setColor(0xFFFFFF
);
g.
fillRect(0,
0,
this.
getWidth(),
this.
getHeight());
g.
drawImage(bg_img,bg_offset,
0, g.
TOP | g.
LEFT);
if (bg_offset+bg_img.
getWidth()<this.
getWidth())
g.
drawImage(bg_img,bg_offset+bg_img.
getWidth(),
0, g.
TOP | g.
LEFT);
}
//int bar=0;
// for ( int bar=0;bar<3;bar++)
if (do_scrollbg
)
for ( int bar=
0;bar
<this.
getWidth()/
(symbols_img.
getWidth()/
10)+
1;bar++
)
{
g.
setClip(bar
*(symbols_img.
getWidth()/
10),
0,
(symbols_img.
getWidth()/
10),symbols_img.
getHeight());;
g.
drawImage(symbols_img,bar
*(symbols_img.
getWidth()/
10),
0, g.
TOP | g.
LEFT);
}
g.
setClip(0,
0,
(symbols_img.
getWidth()/
10),symbols_img.
getHeight());;
if (mk.
connected)
{
if (((mk.
bytes_in_count>>3)&1)==
1)
g.
drawImage(symbols_img,
(-
2)*(symbols_img.
getWidth()/
10),
0, g.
TOP | g.
LEFT);
else
g.
drawImage(symbols_img,
(-
3)*(symbols_img.
getWidth()/
10),
0, g.
TOP | g.
LEFT);
int symbol_spacer=
5;
g.
setClip(symbol_spacer+
(symbols_img.
getWidth()/
10),
0,
(symbols_img.
getWidth()/
10),symbols_img.
getHeight());;
g.
drawImage(symbols_img,symbol_spacer+
(-
3)*(symbols_img.
getWidth()/
10),
0, g.
TOP | g.
LEFT);
g.
setClip(0,
0,
this.
getWidth(),
this.
getHeight());
g.
setColor(0x03035a
);
g.
drawString("" +
(mk.
debug_data.
UBatt()/
10) +
"," +
(mk.
debug_data.
UBatt()%10
)+
"V" , symbol_spacer+
2+
2*(symbols_img.
getWidth()/
10),y_off,
Graphics.
TOP |
Graphics.
LEFT);
// g.drawString("Sender: " + mk.debug_data.SenderOkay(),this.getWidth()/2,y_off,Graphics.TOP | Graphics.LEFT);
g.
setClip(2*symbol_spacer+
2*(symbols_img.
getWidth()/
10) + g.
getFont().
stringWidth("88,8V"),
0,
(symbols_img.
getWidth()/
10),symbols_img.
getHeight());;
g.
drawImage(symbols_img,
2*symbol_spacer+
(-
4)*(symbols_img.
getWidth()/
10) + g.
getFont().
stringWidth("88,8V"),
0, g.
TOP | g.
LEFT);
g.
setClip(0,
0,
this.
getWidth(),
this.
getHeight());
g.
drawString(""+mk.
debug_data.
SenderOkay() ,
2+
2*symbol_spacer+
3*(symbols_img.
getWidth()/
10) + g.
getFont().
stringWidth("88,8V"),y_off,
Graphics.
TOP |
Graphics.
LEFT);
}
else
g.
drawImage(symbols_img,
(-
1)*(symbols_img.
getWidth()/
10),
0, g.
TOP | g.
LEFT);
// if (mk.connected)
// unclip
g.
setClip(0,
0,
this.
getWidth(),
this.
getHeight());
y_off+=symbols_img.
getHeight();
g.
setColor(skin_fg_color
());
switch(state
)
{
case STATEID_GPSVIEW:
g.
setStrokeStyle(Graphics.
SOLID);
g.
setColor(0x0000ff
);
// g.fillArc(0, 0, this.getWidth(), this.getWidth(), 0,45);
int start_angle=
(360+mk.
gps_position.
angle2wp(act_wp
) -
((360+mk.
debug_data.
analog[26]-heading_offset
)%360
))%360
;
// start_angle=0;
start_angle=
(360-start_angle +
90 -
(45/
2))%360
;
g.
fillArc(0,
0,
this.
getWidth(),
this.
getWidth(), start_angle,
45);
// g.drawArc(1, 1, this.getWidth()-2, this.getWidth()-2, start_angle,45);
// g.drawArc(2, 2, this.getWidth()-4, this.getWidth()-4, start_angle ,45);
g.
setColor(skin_fg_color
());
g.
drawString("GPS-Packages: " + mk.
navi_data_count ,
0,y_off,
Graphics.
TOP |
Graphics.
LEFT); g.
drawString("GPS-Packages: " + mk.
navi_data_count ,
0,y_off,
Graphics.
TOP |
Graphics.
LEFT); g.
drawString("GPS-Packages: " + mk.
navi_data_count ,
0,y_off,
Graphics.
TOP |
Graphics.
LEFT);
y_off+=spacer
;
g.
drawString("Used Sats: " + mk.
gps_position.
Used_Sat ,
0,y_off,
Graphics.
TOP |
Graphics.
LEFT);
y_off+=spacer
;
g.
drawString("Latitude: " + mk.
gps_position.
Latitude_str() ,
0,y_off,
Graphics.
TOP |
Graphics.
LEFT);
y_off+=spacer
;
g.
drawString("Longitude: " + mk.
gps_position.
Longitude_str() ,
0,y_off,
Graphics.
TOP |
Graphics.
LEFT);
y_off+=spacer
;
g.
drawString("Target-Lat: " + mk.
gps_position.
TargetLatitude ,
0,y_off,
Graphics.
TOP |
Graphics.
LEFT);
y_off+=spacer
;
g.
drawString("Target-Long: " + mk.
gps_position.
TargetLongitude ,
0,y_off,
Graphics.
TOP |
Graphics.
LEFT);
y_off+=spacer
;
g.
drawString("Distance : " + mk.
gps_position.
Distance2Target ,
0,y_off,
Graphics.
TOP |
Graphics.
LEFT);
y_off+=spacer
;
g.
drawString("Angle: " + mk.
gps_position.
Angle2Target ,
0,y_off,
Graphics.
TOP |
Graphics.
LEFT);
y_off+=spacer
;
g.
drawString("WayPoints: " + act_wp +
"/" + mk.
gps_position.
last_wp ,
0,y_off,
Graphics.
TOP |
Graphics.
LEFT);
y_off+=spacer
;
g.
drawString("" + mk.
gps_position.
NameWP[act_wp
] ,
0,y_off,
Graphics.
TOP |
Graphics.
LEFT);
y_off+=spacer
;
g.
drawString("Lat: " + mk.
gps_position.
WP_Latitude_str(act_wp
) ,
0,y_off,
Graphics.
TOP |
Graphics.
LEFT);
y_off+=spacer
;
g.
drawString("Long: " + mk.
gps_position.
WP_Longitude_str(act_wp
) ,
0,y_off,
Graphics.
TOP |
Graphics.
LEFT);
y_off+=spacer
;
g.
drawString("Distance: " + mk.
gps_position.
distance2wp(act_wp
) ,
0,y_off,
Graphics.
TOP |
Graphics.
LEFT);
y_off+=spacer
;
g.
drawString("Angle: " + mk.
gps_position.
angle2wp(act_wp
) ,
0,y_off,
Graphics.
TOP |
Graphics.
LEFT);
y_off+=spacer
;
g.
drawString("Compas Heading: " +
((360+mk.
debug_data.
analog[26]-heading_offset
)%360
) +
"(" +mk.
debug_data.
analog[26] +
")" ,
0,y_off,
Graphics.
TOP |
Graphics.
LEFT);
y_off+=spacer
;
break;
case STATEID_CAMMODE:
if (cam_img
!=
null)
g.
drawImage(cam_img,
0,
0,g.
TOP | g.
LEFT);
g.
drawString("condition: " + cam_condition
() ,
0,y_off,
Graphics.
TOP |
Graphics.
LEFT);
y_off+=spacer
;
g.
drawString("width " + cam_img.
getWidth(),
0,y_off,
Graphics.
TOP |
Graphics.
LEFT);
y_off+=spacer
;
g.
drawString("height " + cam_img.
getHeight(),
0,y_off,
Graphics.
TOP |
Graphics.
LEFT);
y_off+=spacer
;
break;
case STATEID_STICKVIEW:
for(int tmp_y=
0;tmp_y
<10;tmp_y++
)
{
g.
drawString(""+tmp_y+
"=>"+mk.
stick_data.
stick[tmp_y
],
0,y_off,
Graphics.
TOP |
Graphics.
LEFT);
y_off+=spacer
;
}
break;
case STATEID_KEYCONTROL:
y_off+=spacer
;
g.
drawString("UP&DOWN => nick",
0,y_off,
Graphics.
TOP |
Graphics.
LEFT);
y_off+=spacer
;
g.
drawString("LEFT&RIGHT => roll",
0,y_off,
Graphics.
TOP |
Graphics.
LEFT);
y_off+=spacer
;
g.
drawString("1&4 => altitude",
0,y_off,
Graphics.
TOP |
Graphics.
LEFT);
y_off+=spacer
;
g.
drawString("2&3 => gier",
0,y_off,
Graphics.
TOP |
Graphics.
LEFT);
y_off+=spacer
;
g.
drawString("Press # and * at once",
0,y_off,
Graphics.
TOP |
Graphics.
LEFT);
y_off+=spacer
;
g.
drawString("to quit KeyControl",
0,y_off,
Graphics.
TOP |
Graphics.
LEFT);
y_off+=spacer
;
g.
drawString("bf1:"+ keycontrol_bitfield
[0] ,
0,y_off,
Graphics.
TOP |
Graphics.
LEFT);
g.
drawString("bf2:"+ keycontrol_bitfield
[1] ,
this.
getWidth()/
2,y_off,
Graphics.
TOP |
Graphics.
LEFT);
break;
case STATEID_MOTORTEST:
for (int bar=
0;bar
<4;bar++
)
{
g.
setColor(((bar==act_motor
)|motor_test_sel_all
)?0x44CC44:0x4444DD
);
g.
fillRect(this.
getWidth()/
(8*2)+bar
*2*this.
getWidth()/
8,y_off+
10,
this.
getWidth()/
8,y_off+
20+motor_test
[bar
]);
g.
setColor(0x000000
);
g.
drawString(""+motor_test
[bar
] ,
this.
getWidth()/
8+bar
*2*this.
getWidth()/
8,y_off+
10,
Graphics.
TOP |
Graphics.
HCENTER);
g.
drawString(""+mk.
debug_data.
motor_val(bar
) ,
this.
getWidth()/
8+bar
*2*this.
getWidth()/
8,y_off+
25,
Graphics.
TOP |
Graphics.
HCENTER);
}
break;
case STATEID_EDIT_PARAMS:
params_editor.
paint(g
);
break;
case STATEID_FILEOPEN:
y_off+=spacer
;
g.
drawString("act_path" + act_path
() ,
0,y_off,
Graphics.
TOP |
Graphics.
LEFT);
paint_menu
(g
);
break;
case STATEID_IPINPUT:
paint_lcd
(g,
true);
break;
case STATEID_READ_PARAMS:
paint_lcd
(g,
true);
g.
setClip(this.
getWidth()/
2-load_img.
getWidth()/
6+
1,
this.
getHeight()/
2-load_img.
getHeight()/
8+
1, load_img.
getWidth()/
4,load_img.
getHeight()/
3);;
g.
drawImage(load_img,
this.
getWidth()/
2-load_img.
getWidth()/
8 -
((((frame_pos/
3)%12
)%4
)*(load_img.
getWidth()/
4)) ,
this.
getHeight()/
2-load_img.
getHeight()/
6-
((((frame_pos/
3)%12
)/
4)*(load_img.
getHeight()/
3)), g.
TOP | g.
LEFT);
// g.drawImage(bt_img,this.getWidth()/2 ,this.getHeight()/2 , g.HCENTER | g.VCENTER);
break;
case STATEID_SCANNING:
paint_lcd
(g,
true);
g.
setClip(this.
getWidth()/
2-load_img.
getWidth()/
6+
1,
this.
getHeight()/
2-load_img.
getHeight()/
8+
1, load_img.
getWidth()/
4,load_img.
getHeight()/
3);;
g.
drawImage(load_img,
this.
getWidth()/
2-load_img.
getWidth()/
8 -
((((frame_pos/
3)%12
)%4
)*(load_img.
getWidth()/
4)) ,
this.
getHeight()/
2-load_img.
getHeight()/
6-
((((frame_pos/
3)%12
)/
4)*(load_img.
getHeight()/
3)), g.
TOP | g.
LEFT);
g.
drawImage(bt_img,
this.
getWidth()/
2 ,
this.
getHeight()/
2 , g.
HCENTER | g.
VCENTER);
break;
case STATEID_RAWDEBUG:
g.
setFont(f2
);
rawdebug_off_y=
0;
if ((rawdebug_cursor_y+
2)*spacer1
>this.
getHeight())
rawdebug_off_y=
((rawdebug_cursor_y+
2)*spacer1-
this.
getHeight())/spacer1
;
for (int i=
0;i
<(this.
getHeight()/spacer1
);i++
)
{
if (i+rawdebug_off_y==rawdebug_cursor_y
)
{
g.
setColor(0x0000CC
);
g.
fillRect(0,y_off,
this.
getWidth(),spacer1
);
g.
setColor(skin_fg_color
());
}
if (i+rawdebug_off_y
<32) //todo better style
g.
drawString(mk.
debug_data.
names[i+rawdebug_off_y
] + mk.
debug_data.
analog[i+rawdebug_off_y
] ,
0,y_off,
Graphics.
TOP |
Graphics.
LEFT);
y_off+=spacer1
;
}
break;
case STATEID_CONN_DETAILS:
g.
setFont(f1
);
g.
drawString("Connection::",
0,y_off,
Graphics.
TOP |
Graphics.
LEFT);
y_off+=spacer
;
g.
setFont(f2
);
g.
drawString(ufo_prober.
extended_name()+
" (" +
(mk.
connected?("open"+
((System.
currentTimeMillis()- mk.
connection_start_time)/
1000)+
"s"):
"closed")+
"):",
0,y_off,
Graphics.
TOP |
Graphics.
LEFT);
y_off+=spacer1
;
g.
drawString(" Version:" + mk.
version.
str ,
0,y_off,
Graphics.
TOP |
Graphics.
LEFT);
y_off+=spacer1
;
g.
drawString(" Name:" + mk.
name,
0,y_off,
Graphics.
TOP |
Graphics.
LEFT);
y_off+=spacer1
;
g.
drawString(" URL:" + mk.
mk_url,
0,y_off,
Graphics.
TOP |
Graphics.
LEFT);
y_off+=spacer1
;
g.
setFont(f1
);
g.
drawString("Packet Traffic:",
0,y_off,
Graphics.
TOP |
Graphics.
LEFT);
y_off+=spacer
;
g.
setFont(f2
);
g.
drawString( " in:"+mk.
bytes_in_count +
" bytes => " + mk.
bytes_in_count/
((System.
currentTimeMillis()- mk.
connection_start_time)/
1000) +
" bytes/s",
0,y_off,
Graphics.
TOP |
Graphics.
LEFT);
y_off+=spacer1
;
g.
drawString( " out:"+mk.
bytes_out_count +
" bytes =>" + mk.
bytes_out_count/
((System.
currentTimeMillis()- mk.
connection_start_time)/
1000) +
"bytes/s",
0,y_off,
Graphics.
TOP |
Graphics.
LEFT);
y_off+=spacer1
;
g.
drawString( " debug:"+mk.
debug_data_count+
" LCD:" + mk.
lcd_data_count +
" vers:" + mk.
version_data_count,
0,y_off,
Graphics.
TOP |
Graphics.
LEFT);
y_off+=spacer1
;
g.
drawString( " other:"+mk.
other_data_count+
" params:"+mk.
params_data_count +
" GPS:"+mk.
navi_data_count ,
0,y_off,
Graphics.
TOP |
Graphics.
LEFT);
y_off+=spacer1
;
g.
drawString( " debug_names:" + mk.
debug_names_count +
" angles:" + mk.
angle_data_count ,
0,y_off,
Graphics.
TOP |
Graphics.
LEFT);
break;
case STATEID_PROXY:
g.
setFont(f1
);
g.
drawString("Host:",
0,y_off,
Graphics.
TOP |
Graphics.
LEFT);
y_off+=spacer
;
g.
setFont(f2
);
g.
drawString(" " + mk.
proxy.
url +
"("+
((mk.
proxy.
connected)?"open":
"closed") +
")",
0,y_off,
Graphics.
TOP |
Graphics.
LEFT);
y_off+=spacer1
;
g.
setFont(f1
);
g.
drawString("Packet Traffic:",
0,y_off,
Graphics.
TOP |
Graphics.
LEFT);
y_off+=spacer
;
g.
setFont(f2
);
g.
drawString( " in:"+mk.
bytes_in_count +
" bytes => " + mk.
bytes_in_count/
((System.
currentTimeMillis()- mk.
connection_start_time)/
1000) +
" bytes/s",
0,y_off,
Graphics.
TOP |
Graphics.
LEFT);
y_off+=spacer1
;
g.
drawString( " out:"+mk.
bytes_out_count +
" bytes =>" + mk.
bytes_out_count/
((System.
currentTimeMillis()- mk.
connection_start_time)/
1000) +
"bytes/s",
0,y_off,
Graphics.
TOP |
Graphics.
LEFT);
y_off+=spacer1
;
g.
drawString( " debug:"+mk.
debug_data_count+
" LCD:" + mk.
lcd_data_count +
" vers:" + mk.
version_data_count,
0,y_off,
Graphics.
TOP |
Graphics.
LEFT);
y_off+=spacer1
;
g.
drawString( " other:"+mk.
other_data_count+
" params:"+mk.
params_data_count +
" GPS:"+mk.
navi_data_count ,
0,y_off,
Graphics.
TOP |
Graphics.
LEFT);
y_off+=spacer1
;
g.
drawString( " debug_names:" + mk.
debug_names_count +
" angles:" + mk.
angle_data_count ,
0,y_off,
Graphics.
TOP |
Graphics.
LEFT);
break;
case STATEID_MAINMENU:
case STATEID_SETTINGSMENU:
// falltru wanted
case STATEID_SELECT_PARAMSET:
case STATEID_HANDLE_PARAMS:
case STATEID_DEVICESELECT:
paint_menu
(g
);
break;
case STATEID_GRAPH:
g.
setStrokeStyle(Graphics.
DOTTED);
g.
setColor(0xe1dddd
);
int scale=
0;
if (1/line_scaler
< this.
getHeight()/
10) scale=
1;
if (10/line_scaler
< this.
getHeight()/
10) scale=
10;
if (100/line_scaler
< this.
getHeight()/
10) scale=
100;
if (1000/line_scaler
< this.
getHeight()/
10) scale=
1000;
if (10000/line_scaler
< this.
getHeight()/
10) scale=
10000;
/*
g.drawString("scale:"+scale + "line scaler" + line_scaler,0,y_off,Graphics.TOP | Graphics.LEFT);
int jump=0;
g.drawLine(0,line_middle_y,this.getWidth(),line_middle_y);
while (jump<this.getHeight()/2)
{
g.drawLine(0,line_middle_y - jump/line_scaler,this.getWidth(),line_middle_y - jump/line_scaler);
g.drawLine(0,line_middle_y + jump/line_scaler,this.getWidth(),line_middle_y + jump/line_scaler);
jump+=scale;
}
*/
for ( int x=
0;x
<this.
getWidth();x++
)
{
int p=
(((-bg_offset+x-
this.
getWidth()-
5)));
if (p
<1)
p+=bg_img.
getWidth();
p
%=
(bg_img.
getWidth()-
1);
try {
nick_line_pos_data
[-bg_offset
] = mk.
debug_data.
nick_int();
roll_line_pos_data
[-bg_offset
] = mk.
debug_data.
roll_int();
accnick_line_pos_data
[-bg_offset
] = mk.
debug_data.
accnick();
accroll_line_pos_data
[-bg_offset
] = mk.
debug_data.
accroll();
}
catch (Exception e
)
{
err+=e.
toString();
}
g.
setColor(0x156315
);
draw_graph_part
(g,x,nick_line_pos_data
[p
]/line_scaler,nick_line_pos_data
[p+
1]/line_scaler
);
g.
setColor(0xCC1315
);
draw_graph_part
(g,x,roll_line_pos_data
[p
]/line_scaler,roll_line_pos_data
[p+
1]/line_scaler
);
g.
setColor(0xf8ef02
);
draw_graph_part
(g,x,accnick_line_pos_data
[p
]/line_scaler,accnick_line_pos_data
[p+
1]/line_scaler
);
g.
setColor(0x19194d
);
draw_graph_part
(g,x,accroll_line_pos_data
[p
]/line_scaler,accroll_line_pos_data
[p+
1]/line_scaler
);
}
for (int d=
0;d
<MAX_GRAPHS
;d++
)
{
g.
setColor(graph_colors
[d
]);
g.
fillRect(0,y_off +spacer1/
2-
2 ,
20,
4);
g.
setColor(skin_fg_color
());
g.
drawString(graph_names
[d
],
23,y_off,
Graphics.
TOP |
Graphics.
LEFT);
y_off+=spacer1
;
}
break;
case STATEID_FLIGHTVIEW:
g.
setClip(this.
getWidth()/
2-load_img.
getWidth()/
6+
1,
this.
getHeight()/
2-load_img.
getHeight()/
8+
1, load_img.
getWidth()/
4,load_img.
getHeight()/
3);;
if (( mk.
LCD.
init_state!=-
1)||
(mk.
LCD.
act_mk_page!=mk.
LCD.
act_user_page)) g.
drawImage(load_img,
this.
getWidth()/
2-load_img.
getWidth()/
8 -
((((frame_pos/
3)%12
)%4
)*(load_img.
getWidth()/
4)) ,
this.
getHeight()/
2-load_img.
getHeight()/
6-
((((frame_pos/
3)%12
)/
4)*(load_img.
getHeight()/
3)), g.
TOP | g.
LEFT);
/*
// !!TODO!! check exactly which version those Datas where introduced
if (mk.version.compare(0,60)==mk.version.VERSION_PREVIOUS)
{
g.drawString("Voltage: " + (mk.debug_data.UBatt()/10) + "," +(mk.debug_data.UBatt()%10)+"V" ,0,y_off,Graphics.TOP | Graphics.LEFT);
g.drawString("Sender: " + mk.debug_data.SenderOkay(),this.getWidth()/2,y_off,Graphics.TOP | Graphics.LEFT);
y_off+=spacer;
}
g.drawString(mk.version.str+"(d"+mk.debug_data_count+ "l" + mk.lcd_data_count+ "v" + mk.version_data_count+"o"+mk.other_data_count+"p"+mk.params_data_count+")",0,y_off,Graphics.TOP | Graphics.LEFT);
y_off+=spacer;
g.drawString("n:"+mk.debug_data.nick_int() + " r:"+mk.debug_data.roll_int() + " an:"+mk.debug_data.accnick() + " ar:"+mk.debug_data.accroll() ,0,y_off,Graphics.TOP | Graphics.LEFT);
y_off+=spacer;
g.drawString("m1:"+mk.debug_data.motor_val(0) + " m2:"+mk.debug_data.motor_val(1)+" m3:"+mk.debug_data.motor_val(2) + " m4:"+mk.debug_data.motor_val(3) ,0,y_off,Graphics.TOP | Graphics.LEFT);
y_off+=spacer;
if (mk.connected)
{
g.drawString("time conn:" +((System.currentTimeMillis()- mk.connection_start_time)/1000)+"s" ,0,y_off,Graphics.TOP | Graphics.LEFT);
y_off+=spacer;
g.drawString("time motor>15:" +(mk_stat.motor_on_time/1000) +"s" ,0,y_off,Graphics.TOP | Graphics.LEFT);
y_off+=spacer;
g.drawString("time motor=15:" +(mk_stat.motor_stand_time/1000) +"s" ,0,y_off,Graphics.TOP | Graphics.LEFT);
y_off+=spacer;
g.drawString("lcd:" + mk.LCD.act_mk_page + "/" + mk.LCD.pages + " ( wanted: " + mk.LCD.act_user_page + "state:" + mk.LCD.init_state +")" ,0,y_off,Graphics.TOP | Graphics.LEFT);
y_off+=spacer;
g.drawString("lcd-key:" + mk.LCD.act_key ,0,y_off,Graphics.TOP | Graphics.LEFT);
}
*/
int spacer_left_right=
(this.
getWidth()-
(20*(lcd_img.
getWidth()/
222)))/
2;
y_off=
this.
getHeight()-
4*lcd_img.
getHeight();
for ( int foo=
0;foo
<4;foo++
)
{
for (int x=
0;x
<20;x++
)
{
g.
setClip(spacer_left_right+
(lcd_img.
getWidth()/
222)*x,y_off,
(lcd_img.
getWidth()/
222),lcd_img.
getHeight());
g.
drawImage(lcd_img,spacer_left_right+
(lcd_img.
getWidth()/
222)*x-
(mk.
LCD.
get_act_page()[foo
].
charAt(x
)-
' ')*(lcd_img.
getWidth()/
222),y_off, g.
TOP | g.
LEFT);
}
y_off+=lcd_img.
getHeight();
}
g.
setClip(0,
0,
this.
getWidth(),
this.
getHeight());
}
} catch (Exception e
) {}
}
Player mPlayer
;
VideoControl mVideoControl
;
Image cam_img
;
int cam_img_seq=
0;
byte[] cam_raw
;
private void connect_mk
(String url,
String name
)
{
// ufo_prober.bluetooth_probe(url);
mk.
connect_to(url,name
);
}
public void draw_graph_part
(Graphics g,
int x,
int y1,
int y2
)
{
if ( this.
getWidth()>200)
{
g.
fillRect(x,line_middle_y-y1,
1,
1 );
if (y1
>y2
)
g.
fillRect(x,line_middle_y-y1,
1,y1-y2
);
else
g.
fillRect(x,line_middle_y-y2,
1,y2-y1
);
}
else
{
g.
fillRect(x,line_middle_y-y1,
1,
1 );
if (y1
>y2
)
g.
fillRect(x,line_middle_y-y1,
1,y1-y2
);
else
g.
fillRect(x,line_middle_y-y2,
1,y2-y1
);
}
}
public int pow
(int val,
int pow
)
{
int res=
1;
for (int p=
0;p
<pow
;p++
)
res
*=val
;
return res
;
}
public int mod_decimal
(int val,
int mod_power,
int modder,
int setter,
int clipper
)
{
int res=
0;
for (int power=
0;power
<4;power++
)
{
int act_digit=
(val/pow
(10,power
))%10
;
int new_digit=act_digit
;
if (power==mod_power
)
{
if (setter
!=-
1)
new_digit=setter
;
new_digit+=modder
;
if(new_digit
<0)
new_digit=
0;
if(new_digit
>clipper
)
new_digit=clipper
;
}
// new_digit=1;
res+=new_digit
*pow
(10,power
);
}
return res
;
}
/*********************************************** input Section **********************************************/
public final String intro_str=
" Digital Ufo Broadcasting with intelligent service equipment by Marcus -LiGi- Bueschleb ; Big Up Holger&Ingo for the MikroKopter Project (http://www.mikrokopter.de) ";
int intro_str_pos=
0;
int intro_str_delay=
3;
public void chg_state
(int next_state
)
{
if (next_state
!=state
)act_menu_select=
0;
// prepare next state
switch(next_state
)
{
case STATEID_FILEOPEN:
if (act_path_depth==
0)
{
Enumeration drives = FileSystemRegistry.
listRoots();
int tmp_i=
0;
while(drives.
hasMoreElements())
{
file_list
[tmp_i
]=
(String) drives.
nextElement();
tmp_i++
;
if (MAX_FILELIST_LENGTH
<tmp_i
)
break;
}
menu_items=
new String[tmp_i
];
lcd_lines=
new String[tmp_i
];
file_list_length=tmp_i
;
for(tmp_i=
0;tmp_i
<file_list_length
;tmp_i++
)
menu_items
[tmp_i
]=file_list
[tmp_i
];
}
else
{
try {
FileConnection fc =
(FileConnection
) Connector.
open("file:///"+act_path
());
Enumeration filelist = fc.
list("*",
true);
int tmp_i=
0;
while(filelist.
hasMoreElements()) {
file_list
[tmp_i
] =
(String) filelist.
nextElement();
tmp_i++
;
/* fc = (FileConnection)
Connector.open("file:///CFCard/" + fileName);
if(fc.isDirectory()) {
System.out.println("\tDirectory Name: " + fileName);
} else {
System.out.println
("\tFile Name: " + fileName +
"\tSize: "+fc.fileSize());
}*/
}
menu_items=
new String[tmp_i+
1];
lcd_lines=
new String[tmp_i+
1];
file_list_length=tmp_i+
1;
menu_items
[0]=
"..";
for(tmp_i=
1;tmp_i
<file_list_length
;tmp_i++
)
menu_items
[tmp_i
]=file_list
[tmp_i-
1];
fc.
close();
} catch (IOException ioe
) {
System.
out.
println(ioe.
getMessage());
}
}
break;
case STATEID_CAMMODE:
if (mVideoControl==
null)
try
{
debug.
log("creating player\n");
mPlayer = Manager.
createPlayer("capture://video?encoding=png&width=2048&height=1536");
debug.
log("realizing player\n");
mPlayer.
realize();
debug.
log("get_videocontrol\n");
mVideoControl =
(VideoControl
)mPlayer.
getControl("VideoControl");
debug.
log("switching Canvas\n");
mVideoControl.
initDisplayMode(VideoControl.
USE_DIRECT_VIDEO,
this);
debug.
log("get snap\n");
byte[] raw = mVideoControl.
getSnapshot(null);
}
catch ( Exception e
)
{
debug.
log(e.
toString());
}
break;
case STATEID_KEYCONTROL:
keycontrol_exit=
0;
break;
case STATEID_READ_PARAMS:
user_intent=USER_INTENT_PARAMS
;
lcd_lines=
new String[2];
lcd_lines
[0]=
"Reading Settings ";
lcd_lines
[1]=mk.
watchdog.
act_paramset+
"/5 |"+
(mk.
watchdog.
act_paramset>0?"#":
"_") +
(mk.
watchdog.
act_paramset>1?"#":
"_") +
(mk.
watchdog.
act_paramset>2?"#":
"_")+
(mk.
watchdog.
act_paramset>3?"#":
"_")+
(mk.
watchdog.
act_paramset>4?"#":
"_") +
"| ";
break;
case STATEID_IPINPUT:
lcd_lines=
new String[3];
lcd_lines
[0]=
"Address (IP:Port): ";
break;
case STATEID_SCANNING:
lcd_lines=
new String[4];
lcd_lines
[0]=
"Scanning for Devices";
lcd_lines
[1]=
" ";
//#expand lcd_lines[2]="DUBwise v%VERSION% ";
lcd_lines
[3]=intro_str.
substring(0,
20);
mk.
close_connections(true);
bt_scanner.
search();
break;
case STATEID_HANDLE_PARAMS:
menu_items=
new String[3];
menu_items
[0]=
"write to MK";
menu_items
[1]=
"don't write to MK";
menu_items
[2]=
"discard/read again";
lcd_lines=
new String[3];
break;
case STATEID_SELECT_PARAMSET:
menu_items=
new String[5];
for (int i=
0;i
<5;i++
)
menu_items
[i
]=mk.
params.
names[i
];
lcd_lines=
new String[5];
break;
case STATEID_DEVICESELECT:
menu_items=
new String[bt_scanner.
remote_device_count+
1];
for (int i=
0;i
<bt_scanner.
remote_device_count;i++
)
menu_items
[i
]=bt_scanner.
remote_device_name[i
];
menu_items
[bt_scanner.
remote_device_count]=
"scan again";
lcd_lines=
new String[bt_scanner.
remote_device_count+
1];
break;
case STATEID_MAINMENU:
if (ufo_prober.
is_navi())
{
menu_items=main_menu_items_navi
;
menu_actions=main_menu_actions_navi
;
}
else if (ufo_prober.
is_mk())
{
menu_items=main_menu_items_mk
;
menu_actions=main_menu_actions_mk
;
}
else // no connection
{
menu_items=main_menu_items_no_connection
;
menu_actions=main_menu_actions_no_connection
;
}
lcd_lines=
new String[menu_items.
length];
break;
case STATEID_SETTINGSMENU:
menu_items=
new String[settings_menu_items.
length];
for(int cnt=
0;cnt
<settings_menu_items.
length;cnt++
)
menu_items
[cnt
]=settings_menu_items
[cnt
];
menu_items
[0]+=
(act_skin==SKINID_DARK
)?"Dark":
"Light";
menu_items
[1]+=
(!do_sound
)?"Off":
"On";
menu_items
[2]+=
(!do_vibra
)?"Off":
"On";
menu_items
[3]+=
(!do_scrollbg
)?"Off":
"On";
menu_items
[4]+=
(!fullscreen
)?"Off":
"On";
menu_items
[5]+=
(!keep_lighton
)?"Off":
"On";
lcd_lines=
new String[menu_items.
length];
break;
case STATEID_RAWDEBUG:
user_intent=USER_INTENT_RAWDEBUG
;
break;
case STATEID_GRAPH:
user_intent=USER_INTENT_GRAPH
;
break;
}
// switch state
state=next_state
;
}
public void keyReleased
(int keyCode
)
{
switch(state
)
{
case STATEID_MOTORTEST:
act_motor_increase=
0;
break;
case STATEID_KEYCONTROL:
if (keyCode==KEY_POUND
)
keycontrol_exit
&=
255^
1;
else
if (keyCode==KEY_STAR
)
keycontrol_exit
&=
255^
2;
else
if ((keyCode
>=
this.
KEY_NUM0) && (keyCode
< this.
KEY_NUM8))
keycontrol_bitfield
[0]&=
255^
( 1<<(keyCode-
this.
KEY_NUM0));
else
if ((keyCode
>=
this.
KEY_NUM8) && (keyCode
<=
this.
KEY_NUM9))
keycontrol_bitfield
[1]&=
255^
( 1<<(keyCode-
this.
KEY_NUM8));
else
switch (getGameAction
(keyCode
))
{
case UP:
keycontrol_bitfield
[1]&=
255^
4;
break;
case DOWN:
keycontrol_bitfield
[1]&=
255^
8;
break;
case LEFT:
keycontrol_bitfield
[1]&=
255^
16;
break;
case RIGHT:
keycontrol_bitfield
[1]&=
255^
32;
break;
case FIRE:
keycontrol_bitfield
[1]&=
255^
64;
break;
}
mk.
send_keys(keycontrol_bitfield
);
break;
}
}
byte keycontrol_exit=
0;
public final static int[] keycontrol_bitfield=
{0,
0};
public void pointerPressed
(int pointer_x,
int pointer_y
)
{
if (pointer_x
<this.
getWidth()/
2)
{
if (state==STATEID_EDIT_PARAMS
)
{
chg_state
(STATEID_HANDLE_PARAMS
);
return;
}
else
if (state
!=STATEID_KEYCONTROL
)
{
chg_state
(STATEID_MAINMENU
);
return;
}
}
else
{
fullscreen=
!fullscreen
;
setFullScreenMode
(fullscreen
);
}
}
public void keyPressed
(int keyCode
)
{
debug.
process_key(keyCode
);
if ((keyCode==KEY_STAR
) ||
(keyCode==
113))
{
if (state==STATEID_EDIT_PARAMS
)
{
chg_state
(STATEID_HANDLE_PARAMS
);
return;
}
else
if (state
!=STATEID_KEYCONTROL
)
{
chg_state
(STATEID_MAINMENU
);
return;
}
}
if ((keyCode==KEY_POUND
)&&(state
!=STATEID_KEYCONTROL
))
{
fullscreen=
!fullscreen
;
setFullScreenMode
(fullscreen
);
return;
}
switch(state
)
{
case STATEID_IPINPUT:
if ((keyCode
>=KEY_NUM0
)&&(keyCode
<=KEY_NUM9
))
{
act_proxy_ip
[ipinput_pos/
4]=mod_decimal
(act_proxy_ip
[ipinput_pos/
4],
(ipinput_pos
<15?2:
3)-
(ipinput_pos
%4
),
0,
(keyCode-KEY_NUM0
),
9);
if(ipinput_pos
<19) ipinput_pos++
;
if ((ipinput_pos
<18)&&(((ipinput_pos+
1)%4
)==
0))ipinput_pos++
;
}
else
switch (getGameAction
(keyCode
))
{
case LEFT:
if(ipinput_pos
>0) ipinput_pos--
;
if (((ipinput_pos+
1)%4
)==
0)ipinput_pos--
;
break;
case RIGHT:
if(ipinput_pos
<19) ipinput_pos++
;
if(ipinput_pos
<18)if (((ipinput_pos+
1)%4
)==
0)ipinput_pos++
;
break;
case UP:
act_proxy_ip
[ipinput_pos/
4]=mod_decimal
(act_proxy_ip
[ipinput_pos/
4],
(ipinput_pos
<15?2:
3)-
(ipinput_pos
%4
),
1,-
1,
9);
break;
case DOWN:
act_proxy_ip
[ipinput_pos/
4]=mod_decimal
(act_proxy_ip
[ipinput_pos/
4],
(ipinput_pos
<15?2:
3)-
(ipinput_pos
%4
),-
1,-
1,
9);
case FIRE:
mk.
do_proxy("socket://"+ip_str
(act_proxy_ip,
false));
chg_state
(STATEID_PROXY
);
break;
}
break;
case STATEID_GPSVIEW:
if (keyCode ==
this.
KEY_NUM0)
mk.
set_gps_target(mk.
gps_position.
Latitude,mk.
gps_position.
Longitude);
if (keyCode ==
this.
KEY_NUM1)
mk.
gps_position.
push_wp();
if (keyCode ==
this.
KEY_NUM2)
chg_state
(STATEID_FILEOPEN
);
if (keyCode ==
this.
KEY_NUM3)
mk.
set_gps_target(mk.
gps_position.
LatWP[act_wp
],mk.
gps_position.
LongWP[act_wp
]);
if (keyCode ==
this.
KEY_NUM4)
mk.
gps_position.
next_gps_format();
if (keyCode ==
this.
KEY_NUM5)
heading_offset= mk.
debug_data.
analog[26];
switch (getGameAction
(keyCode
))
{
case UP:
if (act_wp
!=
0) act_wp--
;
break;
case DOWN:
if (act_wp
<mk.
gps_position.
last_wp) act_wp++
;
break;
}
break;
case STATEID_RAWDEBUG:
switch (getGameAction
(keyCode
))
{
case UP:
if (rawdebug_cursor_y==
0)
rawdebug_cursor_y=
31;
else
rawdebug_cursor_y--
;
break;
case DOWN:
if (rawdebug_cursor_y==
31)
rawdebug_cursor_y=
0;
else
rawdebug_cursor_y++
;
break;
}
break;
case STATEID_KEYCONTROL:
if (keyCode==KEY_POUND
)
keycontrol_exit |=
1;
else
if (keyCode==KEY_STAR
)
keycontrol_exit |=
2;
else
if ((keyCode
>=
this.
KEY_NUM0) && (keyCode
< this.
KEY_NUM8))
keycontrol_bitfield
[0]|=
1<<(keyCode-
this.
KEY_NUM0);
else
if ((keyCode
>=
this.
KEY_NUM8) && (keyCode
<=
this.
KEY_NUM9))
keycontrol_bitfield
[1]|=
1<<(keyCode-
this.
KEY_NUM8);
else
switch (getGameAction
(keyCode
))
{
case UP:
keycontrol_bitfield
[1]|=
4;
break;
case DOWN:
keycontrol_bitfield
[1]|=
8;
break;
case LEFT:
keycontrol_bitfield
[1]|=
16;
break;
case RIGHT:
keycontrol_bitfield
[1]|=
32;
break;
case FIRE:
keycontrol_bitfield
[1]|=
64;
break;
}
if (keycontrol_exit==
3)
chg_state
(STATEID_MAINMENU
);
else
mk.
send_keys(keycontrol_bitfield
);
break;
case STATEID_MOTORTEST:
switch (getGameAction
(keyCode
))
{
case UP:
act_motor_increase=-
1;
break;
case DOWN:
act_motor_increase=
1;
break;
case FIRE:
motor_test_sel_all=
!motor_test_sel_all
;
break;
case LEFT:
act_motor--
;
if (act_motor
<0) {act_motor=
0; chg_state
(STATEID_MAINMENU
); }
break;
case RIGHT:
act_motor++
;
act_motor
%=
4;
break;
}
break;
case STATEID_HANDLE_PARAMS:
if ( getGameAction
(keyCode
)==FIRE
)
{
switch(act_menu_select
)
{
case 0:
mk.
write_params();
break;
case 2:
mk.
params.
use_backup();
break;
}
chg_state
(STATEID_MAINMENU
);
}
else
menu_keypress
(keyCode
);
break;
case STATEID_FILEOPEN:
if ( getGameAction
(keyCode
)==FIRE
)
{
if ((act_menu_select==
0)&&(act_path_depth
!=
0))
{
act_path_depth--
;
//act_path=act_path.substring(0,act_path.substring(0,act_path.length()-2).indexOf('/') );
//act_path=last_path;
}
else
{
//last_path=act_path;
if (act_path_depth==
0)
act_path_arr
[act_path_depth++
]=file_list
[act_menu_select
];
else
act_path_arr
[act_path_depth++
]=file_list
[act_menu_select-
1];
}
act_menu_select=
0;
chg_state
(STATEID_FILEOPEN
);
}
else
menu_keypress
(keyCode
);
break;
case STATEID_SETTINGSMENU:
if ( getGameAction
(keyCode
)==FIRE
)
switch(act_menu_select
)
{
case SETTINGSMENU_CHANGESKIN:
act_skin++
;
act_skin=
(byte)(act_skin
%2
);
load_images
();
chg_state
(STATEID_SETTINGSMENU
);
break;
case SETTINGSMENU_SOUNDTOGGLE:
do_sound=
!do_sound
;
chg_state
(STATEID_SETTINGSMENU
);
break;
case SETTINGSMENU_VIBRATOGGLE:
do_vibra=
!do_vibra
;
chg_state
(STATEID_SETTINGSMENU
);
break;
case SETTINGSMENU_GRAPHTOGGLE:
do_scrollbg=
!do_scrollbg
;
chg_state
(STATEID_SETTINGSMENU
);
break;
case SETTINGSMENU_FULLSCREENTOGGLE:
fullscreen=
!fullscreen
;
setFullScreenMode
(fullscreen
);
chg_state
(STATEID_SETTINGSMENU
);
break;
case SETTINGSMENU_LIGHTTOGGLE:
keep_lighton =
!keep_lighton
;
chg_state
(STATEID_SETTINGSMENU
);
break;
case SETTINGSMENU_BACK:
chg_state
(STATEID_MAINMENU
);
break;
}
else menu_keypress
(keyCode
);
break;
case STATEID_MAINMENU:
if (keyCode ==
this.
KEY_NUM2)
chg_state
(STATEID_FILEOPEN
);
if ( getGameAction
(keyCode
)==FIRE
)
{
switch(menu_actions
[act_menu_select
])
{
case ACTIONID_CONN_DETAILS:
chg_state
(STATEID_CONN_DETAILS
);
break;
case ACTIONID_QUIT:
quit=
true;
break;
case ACTIONID_SWITCH_NC:
mk.
switch_to_navi();
break;
case ACTIONID_SWITCH_FC:
mk.
switch_to_fc();
break;
case ACTIONID_GRAPH:
chg_state
(STATEID_GRAPH
);
break;
case ACTIONID_KEYCONTROL:
chg_state
(STATEID_KEYCONTROL
);
break;
case ACTIONID_LCD :
chg_state
(STATEID_FLIGHTVIEW
);
break;
case ACTIONID_PROXY:
chg_state
(STATEID_IPINPUT
);
break;
case ACTIONID_DEVICESELECT:
chg_state
(STATEID_SCANNING
);
break;
case ACTIONID_RAWDEBUG:
chg_state
(STATEID_RAWDEBUG
);
break;
case ACTIONID_SETTINGS:
chg_state
(STATEID_SETTINGSMENU
);
break;
case ACTIONID_RCDATA:
chg_state
(STATEID_STICKVIEW
);
break;
case ACTIONID_CAM:
chg_state
(STATEID_CAMMODE
);
break;
case ACTIONID_GPSDATA:
chg_state
(STATEID_GPSVIEW
);
break;
case ACTIONID_MOTORTEST :
chg_state
(STATEID_MOTORTEST
);
break;
case ACTIONID_EDIT_PARAMS:
if (mk.
watchdog.
act_paramset<5)
chg_state
(STATEID_READ_PARAMS
);
else
chg_state
(STATEID_SELECT_PARAMSET
);
break;
case ACTIONID_DEBUG:
debug.
showing=
true;
break;
}
/*
if (ufo_prober.is_mk())
switch(act_menu_select)
{
}
else if (ufo_prober.is_navi())
switch(act_menu_select)
{
case MAINMENU_NAVI_SWITCH_FC:
mk.switch_to_fc();
break;
case MAINMENU_NAVI_SETTINGS:
chg_state(STATEID_SETTINGSMENU);
break;
case MAINMENU_NAVI_TELEMETRY :
chg_state(STATEID_FLIGHTVIEW);
break;
case MAINMENU_NAVI_RAWDEBUG:
chg_state(STATEID_RAWDEBUG);
break;
case MAINMENU_NAVI_GPSVIEW:
chg_state(STATEID_GPSVIEW);
break;
case MAINMENU_NAVI_DEVICESELECT:
chg_state(STATEID_SCANNING);
break;
case MAINMENU_NAVI_QUIT:
// set quit Flag
quit=true;
break;
}
else
switch(act_menu_select)
{
case MAINMENU_NO_CONN_SETTINGS:
chg_state(STATEID_SETTINGSMENU);
break;
case MAINMENU_NO_CONN_DEVICESELECT:
chg_state(STATEID_SCANNING);
break;
case MAINMENU_NO_CONN_DEBUG:
debug.showing=true;
break;
case MAINMENU_NO_CONN_QUIT:
// set quit Flag
quit=true;
break;
} */
}
else menu_keypress
(keyCode
);
break;
case STATEID_SELECT_PARAMSET:
if ( getGameAction
(keyCode
)==FIRE
)
{
if ( mk.
params.
field[act_menu_select
]!=
null)
{
mk.
params.
act_paramset=act_menu_select
;
chg_state
(STATEID_EDIT_PARAMS
);
}
}
else menu_keypress
(keyCode
);
break;
case STATEID_DEVICESELECT:
/*
if ((keyCode >= this.KEY_NUM0) && (keyCode < this.KEY_NUM0+bt_scanner.remote_device_count))
{
connect_mk("btspp://"+bt_scanner.remote_device_mac[keyCode-this.KEY_NUM0] + ":1",bt_scanner.remote_device_name[keyCode-this.KEY_NUM0]);
chg_state(STATEID_MAINMENU);
}
else
*/
if ( getGameAction
(keyCode
)==FIRE
)
{
if (bt_scanner.
remote_device_count > act_menu_select
)
{
connect_mk
("btspp://"+bt_scanner.
remote_device_mac[act_menu_select
] +
":1",bt_scanner.
remote_device_name[act_menu_select
]);
chg_state
(STATEID_MAINMENU
);
// keyCode=-1;
}
else
chg_state
(STATEID_SCANNING
);
}
else menu_keypress
(keyCode
);
break;
case STATEID_EDIT_PARAMS:
params_editor.
keypress(keyCode,getGameAction
(keyCode
)) ;
break;
case STATEID_FLIGHTVIEW:
if ((keyCode
>=
this.
KEY_NUM0) && (keyCode
<=
this.
KEY_NUM9))
mk.
LCD.
set_page(keyCode-
this.
KEY_NUM0);
else
switch (getGameAction
(keyCode
))
{
case LEFT:
case UP:
mk.
LCD.
LCD_PREVPAGE();
break;
case RIGHT:
case DOWN:
mk.
LCD.
LCD_NEXTPAGE();
break;
}
break;
}
}
}