/***************************************************************
*
* User Interface ( Canvas ) of DUBwise
*
* Author: Marcus -LiGi- Bueschleb
* Mailto: LiGi @at@ LiGi DOTT de
*
***************************************************************/
import javax.microedition.lcdui.*;
import javax.microedition.media.*;
import javax.microedition.media.control.*;
//#if fileapi=="on"
import javax.microedition.io.*;
import javax.microedition.midlet.*;
import javax.microedition.io.file.*;
import java.io.*;
import java.util.*;
//#endif
public class DUBwiseCanvas
extends Canvas
implements Runnable,org.
ligi.
ufo.
DUBwiseDefinitions
{
//#if fileapi=="on"
public final static int MAX_FILELIST_LENGTH=
100;
public final static int MAX_PATH_DEPTH=
10;
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;
//#endif
boolean ipinput4proxy
;
byte ipinput_pos=
0;
int[] act_edit_ip
;
int canvas_width=
100;
int canvas_height=
100;
// public String ip_digit_zeroes(int digit)
//{ return "" + digit/100 + "" + (digit/10)%10 + "" + (digit)%10; }
int heading_offset=
0;
int act_wp
;
//#if bluetooth=="on"
private BTSearcher bt_scanner
;
//#endif
public org.
ligi.
ufo.
MKCommunicator mk=
null;
// private MKStatistics mk_stat=null;
private MKParamsEditor params_editor=
null;
public DUBwiseDebug debug=
null;
public DUBwiseHelper helper=
null;
//#if voice_mode!="no_voice"
private MKStatusVoice status_voice
;
//#endif
private DUBwise root
;
public DUBwiseSettings settings
;
// public UFOProber mk.ufo_prober;
private Image bg_img
;
private Image lcd_img
;
private Image symbols_img
;
private Image err_img
;
int max_lines
;
public byte act_motor=
0;
public byte act_motor_increase=
0;
public boolean motor_test_sel_all=
false;
/* Graph Vars */
public final static int GRAPH_COUNT=
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 lcd_char_width=
0;
public int lcd_char_height=
0;
public int frame_pos=
0;
// public byte mk.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;
int bg_offset=
0;
// variable to hold the current state
public byte 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
;
byte[] menu_actions
;
int act_menu_select=
0;
String[] lcd_lines =
null;
public void setup_menu
(String[] items ,
byte[] actions
)
{
menu_items=items
;
menu_actions=actions
;
lcd_lines=
new String[menu_items.
length];
}
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("Menu with 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);
max_lines=
(canvas_height-lcd_top
)/lcd_char_height
;
int spacer_left_right=
(canvas_width-
(20*(lcd_img.
getWidth()/
222)))/
2;
// for(int i=0;i<lcd_lines.length;i++)
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=canvas_height-
(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
{
bg_img=
null;
lcd_img=
null;
// load all needed images
switch (settings.
act_skin)
{
case SKINID_DARK:
lcd_img=
Image.
createImage("/lcd_green.png");
if (settings.
do_scrollbg) bg_img=
Image.
createImage("/starfield.jpg"); break;
case SKINID_LIGHT:
lcd_img=
Image.
createImage("/lcd_blue.png");
if (settings.
do_scrollbg) 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();
if (bg_img
!=
null)
graph_data=
new int[GRAPH_COUNT
][bg_img.
getWidth()];
else
graph_data=
new int[GRAPH_COUNT
][this.
getWidth()*2];
for (int c=
0;c
<graph_data
[0].
length;c++
)
for (int d=
0;d
<GRAPH_COUNT
;d++
)
graph_data
[d
][c
]=-
1;
/*
nick_line_pos_data=new int[graph_data[0].length];
roll_line_pos_data=new int[graph_data[0].length];
accnick_line_pos_data=new int[graph_data[0].length];
accroll_line_pos_data=new int[graph_data[0].length];
for (int c=0;c<graph_data[0].length;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;
}
*/
try {
err_img=
null;
if (settings.
do_scrollbg) err_img=
Image.
createImage("/preflight.jpg");
}
catch (Exception e
) { }
}
catch (Exception e
)
{
debug.
err(e.
toString());
}
}
public DUBwiseCanvas
(DUBwise _root
)
{
// mk = new MKCommunicator(root);
//#if fileapi=="on"
// file
file_list=
new String[MAX_FILELIST_LENGTH
];
act_path_arr=
new String[MAX_PATH_DEPTH
];
// end file
//#endif
root=_root
;
mk =
new org.
ligi.
ufo.
MKCommunicator();
helper =
new DUBwiseHelper
();
settings =
new DUBwiseSettings
();
debug =
new DUBwiseDebug
(this);
//#if bluetooth=="on"
bt_scanner =
new BTSearcher
();
//#endif
params_editor =
new MKParamsEditor
(this);
// mk.ufo_prober = new UFOProber();
// mk = new MKCommunicator(root);
// mk_stat = new MKStatistics(mk);
//#if voice_mode!="no_voice"
status_voice=
new MKStatusVoice
(mk,
this);
//#endif
load_images
();
if (settings.
connection_url!=
"")
connect_mk
(settings.
connection_url,settings.
connection_name);
chg_state
(STATEID_MAINMENU
);
new Thread(this).
start();
}
/****************************** Thread ******************/
// ticking runnable Section
public void run
()
{
while(true)
{
try {
repaint
();
serviceRepaints
();
System.
gc();
long loopStartTime =
System.
currentTimeMillis();
long sleeptime=
0;
// ticked thing
frame_pos++
;
if (mk.
ufo_prober.
change_notify)
{
mk.
ufo_prober.
change_notify=
false;
if (mk.
ufo_prober.
is_incompatible())
{
mk.
error_str=
"incompatible Device";
chg_state
(STATEID_NC_ERRORS
);
}
else
if (state==STATEID_MAINMENU
)
chg_state
(STATEID_MAINMENU
); // reload mainmenu ( changed content )
}
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
)
{
debug.
log("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_NC_ERRORS:
lcd_lines
[0]=
""+mk.
error_str;
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?"#":
"_") +
"| ";
if (mk.
params.
found_incompatible)
{
mk.
error_str=
"incompatible params";
chg_state
(STATEID_NC_ERRORS
);
}
}
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:
if (ipinput4proxy
)
act_edit_ip=settings.
act_proxy_ip;
else
act_edit_ip=settings.
act_conn_ip;
lcd_lines
[1]=helper.
ip_str(act_edit_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:
break;
//#if bluetooth=="on"
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++;
}
*/
lcd_lines
[2]=
"found " + bt_scanner.
remote_device_count;
if (!bt_scanner.
searching)
chg_state
(STATEID_DEVICESELECT
);
break;
//#endif
}
if (quit
)
{
settings.
save();
root.
quit();
}
try {
//rescan=false;
bg_offset--
;
if (bg_offset==-graph_data
[0].
length)
bg_offset=
0;
//#if devicecontrol=="on"
if (settings.
keep_lighton) com.
nokia.
mid.
ui.
DeviceControl.
setLights(0,
100);
//#endif
}
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
)
{
debug.
log("Problem Sleeping ");
}
}
catch (Exception e
)
{
debug.
log("E!:"+e.
getMessage());
}
}
}
boolean firstrun=
true;
public int skin_bg_color
()
{
switch (settings.
act_skin)
{
case SKINID_DARK:
return 0x000000
;
default:
case SKINID_LIGHT:
return 0xFFFFFF
;
}
}
public int skin_fg_color
()
{
switch (settings.
act_skin)
{
case SKINID_DARK:
return 0xFFFFFF
;
default:
case SKINID_LIGHT:
return 0x000000
;
}
}
// drawing section
public void paint
(Graphics g
) {
canvas_width=
this.
getWidth();
canvas_height=
this.
getHeight();
if (debug.
showing)
{
debug.
paint(g
);
return;
}
if (firstrun
)
{
if (settings.
fullscreen) setFullScreenMode
(settings.
fullscreen);
firstrun=
false;
}
y_off=
0;
try {
if (mk
!=
null)
{
line_middle_y=canvas_height/
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/
(canvas_height/
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 ((!settings.
do_scrollbg) ||
(state==STATEID_EDIT_PARAMS
))
{
g.
setColor(0xdedfff
);
g.
fillRect(0,
0,canvas_width,symbols_img.
getHeight());
g.
setColor(skin_bg_color
());
g.
fillRect(0,symbols_img.
getHeight(),canvas_width,canvas_height-symbols_img.
getHeight());
}
else
{
g.
setColor(0xFFFFFF
);
g.
fillRect(0,
0,canvas_width,canvas_height
);
g.
drawImage(bg_img,bg_offset,
0, g.
TOP | g.
LEFT);
if (bg_offset+bg_img.
getWidth()<canvas_width
)
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 (settings.
do_scrollbg)
for ( int bar=
0;bar
<canvas_width/
(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);
}
int symbol_left=
0;
g.
setClip(symbol_left,
0,
(symbols_img.
getWidth()/
10),symbols_img.
getHeight());;
if ((mk.
ufo_prober.
is_navi()||mk.
ufo_prober.
is_mk()))
{
if (((mk.
stats.
bytes_in>>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;
symbol_left+=symbol_spacer+
(symbols_img.
getWidth()/
10);
g.
setClip(symbol_left,
0,
(symbols_img.
getWidth()/
10),symbols_img.
getHeight());;
g.
drawImage(symbols_img,symbol_left+
(-
4)*(symbols_img.
getWidth()/
10),
0, g.
TOP | g.
LEFT);
g.
setClip(0,
0,canvas_width,canvas_height
);
g.
setColor(0x03035a
);
symbol_left+=
2+
(symbols_img.
getWidth()/
10);
g.
drawString("" +
(mk.
UBatt()/
10) +
"," +
(mk.
UBatt()%10
)+
"V" , symbol_left,y_off,
Graphics.
TOP |
Graphics.
LEFT);
symbol_left+= g.
getFont().
stringWidth("88,8V");//;
g.
setClip(symbol_left,
0,
(symbols_img.
getWidth()/
10),symbols_img.
getHeight());
g.
drawImage(symbols_img,
(-
6)*(symbols_img.
getWidth()/
10) + symbol_left,
0, g.
TOP | g.
LEFT);
g.
setClip(0,
0,canvas_width,canvas_height
);
symbol_left+=
2+
(symbols_img.
getWidth()/
10);
g.
drawString(""+mk.
SenderOkay() ,symbol_left,y_off,
Graphics.
TOP |
Graphics.
LEFT);
symbol_left+= g.
getFont().
stringWidth("8")+symbol_spacer
; //,0,(symbols_img.getWidth()/10)+2;
if (mk.
ufo_prober.
is_navi())
{
g.
setClip(symbol_left,
0,
(symbols_img.
getWidth()/
10),symbols_img.
getHeight());
g.
drawImage(symbols_img,
(-
5)*(symbols_img.
getWidth()/
10) + symbol_left,
0, g.
TOP | g.
LEFT);
g.
setClip(0,
0,canvas_width,canvas_height
);
symbol_left+=
2+
(symbols_img.
getWidth()/
10);
g.
drawString(""+mk.
gps_position.
SatsInUse ,symbol_left,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,canvas_width,canvas_height
);
y_off+=symbols_img.
getHeight();
g.
setColor(skin_fg_color
());
switch(state
)
{
case STATEID_DATABUFF:
g.
setFont(f2
);
y_off=canvas_height-spacer1
;
for (int pos_y=
0;pos_y
<(((canvas_height-spacer1
)/spacer1
));pos_y++
)
{
g.
drawString(mk.
get_buff(pos_y
) ,
0,y_off,
Graphics.
TOP |
Graphics.
LEFT);
y_off-=spacer1
;
}
break;
case STATEID_NC_ERRORS:
if (settings.
do_scrollbg)
{
int err_img_left=
(canvas_width-err_img.
getWidth()/
2)/
2;
int err_img_top=
(canvas_height-err_img.
getHeight())/
2;
g.
setClip(err_img_left,err_img_top,err_img.
getWidth()/
2,err_img.
getHeight());
g.
drawImage(err_img,err_img_left-err_img.
getWidth()/
2,err_img_top, g.
TOP | g.
LEFT);
}
paint_lcd
(g,
true);
break;
case STATEID_GPSVIEW:
g.
setFont(f2
);
g.
setStrokeStyle(Graphics.
SOLID);
g.
setColor(0x0000ff
);
// g.fillArc(0, 0, canvas_width, canvas_width, 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, canvas_width, canvas_width, start_angle,45);
*/
// g.drawArc(1, 1, canvas_width-2, canvas_width-2, start_angle,45);
// g.drawArc(2, 2, canvas_width-4, canvas_width-4, start_angle ,45);
g.
setColor(skin_fg_color
());
g.
drawString("Used Sats: " + mk.
gps_position.
SatsInUse +
" | Packages: " + mk.
stats.
navi_data_count ,
0,y_off,
Graphics.
TOP |
Graphics.
LEFT);
y_off+=spacer1
;
g.
drawString("Lat: " + mk.
gps_position.
Latitude_str() ,
0,y_off,
Graphics.
TOP |
Graphics.
LEFT);
y_off+=spacer1
;
g.
drawString("Long: " + mk.
gps_position.
Longitude_str() ,
0,y_off,
Graphics.
TOP |
Graphics.
LEFT);
y_off+=spacer1
;
g.
drawString("Altitude: " + mk.
gps_position.
Altitude ,
0,y_off,
Graphics.
TOP |
Graphics.
LEFT);
y_off+=spacer1
;
g.
drawString("Target-Lat: " + mk.
gps_position.
TargetLatitude_str() ,
0,y_off,
Graphics.
TOP |
Graphics.
LEFT);
y_off+=spacer1
;
g.
drawString("Target-Long: " + mk.
gps_position.
TargetLongitude_str() ,
0,y_off,
Graphics.
TOP |
Graphics.
LEFT);
y_off+=spacer1
;
g.
drawString("Target-Alt: " + mk.
gps_position.
TargetAltitude ,
0,y_off,
Graphics.
TOP |
Graphics.
LEFT);
y_off+=spacer1
;
g.
drawString("Home-Lat: " + mk.
gps_position.
HomeLatitude_str() ,
0,y_off,
Graphics.
TOP |
Graphics.
LEFT);
y_off+=spacer1
;
g.
drawString("Home-Long: " + mk.
gps_position.
HomeLongitude_str() ,
0,y_off,
Graphics.
TOP |
Graphics.
LEFT);
y_off+=spacer1
;
g.
drawString("Home-Alt: " + mk.
gps_position.
HomeAltitude ,
0,y_off,
Graphics.
TOP |
Graphics.
LEFT);
y_off+=spacer1
;
g.
drawString("Distance : " + mk.
gps_position.
Distance2Target ,
0,y_off,
Graphics.
TOP |
Graphics.
LEFT);
y_off+=spacer1
;
g.
drawString("Angle: " + mk.
gps_position.
Angle2Target ,
0,y_off,
Graphics.
TOP |
Graphics.
LEFT);
y_off+=spacer1
;
g.
drawString("WayPoints: " + mk.
gps_position.
WayPointNumber +
"/" + mk.
gps_position.
WayPointIndex ,
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_FLASHING:
int msg_pos=
0;
while (mk.
flash_msgs[msg_pos
]!=
null)
{
g.
drawString(mk.
flash_msgs[msg_pos
] ,
0,y_off,
Graphics.
TOP |
Graphics.
LEFT);
y_off+=spacer
;
msg_pos++
;
}
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.
params.
stick_names[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] ,canvas_width/
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(canvas_width/
(8*2)+bar
*2*canvas_width/
8,y_off+
10,canvas_width/
8,y_off+
20+motor_test
[bar
]);
g.
setColor(0x000000
);
g.
drawString(""+motor_test
[bar
] ,canvas_width/
8+bar
*2*canvas_width/
8,y_off+
10,
Graphics.
TOP |
Graphics.
HCENTER);
g.
drawString(""+mk.
debug_data.
motor_val(bar
) ,canvas_width/
8+bar
*2*canvas_width/
8,y_off+
25,
Graphics.
TOP |
Graphics.
HCENTER);
}
break;
case STATEID_EDIT_PARAMS:
params_editor.
paint(g
);
break;
case STATEID_SELECT_COMPORT:
g.
drawString("ports: " +
System.
getProperty("microedition.commports"),
0,y_off,
Graphics.
TOP |
Graphics.
LEFT);
y_off+=spacer
;
paint_menu
(g
);
break;
//#if fileapi=="on"
case STATEID_FILEOPEN:
y_off+=spacer
;
g.
drawString("act_path" + act_path
() ,
0,y_off,
Graphics.
TOP |
Graphics.
LEFT);
paint_menu
(g
);
break;
//#endif
case STATEID_ABOUT:
case STATEID_IPINPUT:
paint_lcd
(g,
true);
break;
case STATEID_READ_PARAMS:
paint_lcd
(g,
true);
break;
//#if bluetooth=="on"
case STATEID_SCANNING:
paint_lcd
(g,
true);
break;
//#endif
case STATEID_RAWDEBUG:
g.
setFont(f2
);
rawdebug_off_y=
0;
if ((rawdebug_cursor_y+
3)*spacer1
>canvas_height
)
rawdebug_off_y=
((rawdebug_cursor_y+
3)*spacer1-canvas_height
)/spacer1
;
for (int i=
0;i
<(canvas_height/spacer1
)-
1;i++
)
{
if (i+rawdebug_off_y==rawdebug_cursor_y
)
{
g.
setColor(0x0000CC
);
g.
fillRect(0,y_off,canvas_width,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(" URL:" + mk.
mk_url,
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(" "+mk.
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(" Slave-Addr:" + mk.
slave_addr,
0,y_off,
Graphics.
TOP |
Graphics.
LEFT);
paint_menu
(g
);
break;
case STATEID_TRAFFIC:
g.
setFont(f1
);
g.
drawString("Packet Traffic (over "+mk.
conn_time_in_s()+
"s):",
0,y_off,
Graphics.
TOP |
Graphics.
LEFT);
y_off+=spacer
;
g.
setFont(f2
);
g.
drawString( ">>in:"+mk.
stats.
bytes_in+
" bytes => " + mk.
stats.
bytes_in/mk.
conn_time_in_s() +
" bytes/s",
0,y_off,
Graphics.
TOP |
Graphics.
LEFT);
y_off+=spacer1
;
g.
drawString( " debug:"+mk.
stats.
debug_data_count+
" LCD:" + mk.
stats.
lcd_data_count +
" vers:" + mk.
stats.
version_data_count,
0,y_off,
Graphics.
TOP |
Graphics.
LEFT);
y_off+=spacer1
;
g.
drawString( " other:"+mk.
stats.
other_data_count+
" params:"+mk.
stats.
params_data_count +
" GPS:"+mk.
stats.
navi_data_count ,
0,y_off,
Graphics.
TOP |
Graphics.
LEFT);
y_off+=spacer1
;
g.
drawString( " debug_names:" + mk.
stats.
debug_names_count +
" angles:" + mk.
stats.
angle_data_count ,
0,y_off,
Graphics.
TOP |
Graphics.
LEFT);
y_off+=spacer1+
3;
g.
drawString( "<<out:"+mk.
stats.
bytes_out +
" bytes =>" + mk.
stats.
bytes_out/mk.
conn_time_in_s() +
"bytes/s",
0,y_off,
Graphics.
TOP |
Graphics.
LEFT);
y_off+=spacer1
;
g.
drawString( " LCD:" + mk.
stats.
lcd_data_request_count +
" vers:" + mk.
stats.
version_data_request_count,
0,y_off,
Graphics.
TOP |
Graphics.
LEFT);
y_off+=spacer1
;
g.
drawString( " params:"+mk.
stats.
params_data_request_count ,
0,y_off,
Graphics.
TOP |
Graphics.
LEFT);
y_off+=spacer1
;
paint_menu
(g
);
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
;
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.
setClip(0,
0,canvas_width,canvas_height
);
g.
setStrokeStyle(Graphics.
DOTTED);
g.
setColor(0xe1dddd
);
for (int d=
0;d
<GRAPH_COUNT
;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
;
}
/*
g.drawString("scale:"+scale + "line scaler" + line_scaler,0,y_off,Graphics.TOP | Graphics.LEFT);
int jump=0;
g.drawLine(0,line_middle_y,canvas_width,line_middle_y);
while (jump<canvas_height/2)
{
g.drawLine(0,line_middle_y - jump/line_scaler,canvas_width,line_middle_y - jump/line_scaler);
g.drawLine(0,line_middle_y + jump/line_scaler,canvas_width,line_middle_y + jump/line_scaler);
jump+=scale;
}
*/
for (int gr=
0;gr
<GRAPH_COUNT
;gr++
)
{
g.
setColor(graph_colors
[gr
]);
try {
graph_data
[gr
][-bg_offset
]=mk.
debug_data.
analog[graph_sources
[gr
]];
}
catch (Exception e
)
{
debug.
log("E!:" + e.
getMessage());
}
for ( int x=
0;x
<canvas_width
;x++
)
{
int p=
(((-bg_offset+x-canvas_width-
5)));
if (p
<1)
p+=graph_data
[0].
length;
p
%=
(graph_data
[0].
length-
1);
draw_graph_part
(g,x,graph_data
[gr
][p
]/line_scaler,graph_data
[gr
][p+
1]/line_scaler
);
}
}
break;
case STATEID_FLIGHTVIEW:
/*
g.setClip(canvas_width/2-load_img.getWidth()/6+1,canvas_height/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,canvas_width/2-load_img.getWidth()/8 - ((((frame_pos/3)%12)%4)*(load_img.getWidth()/4)) ,canvas_height/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(),canvas_width/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=
(canvas_width-
(20*(lcd_img.
getWidth()/
222)))/
2;
y_off=canvas_height-
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,canvas_width,canvas_height
);
}
} 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
)
{
// mk.ufo_prober.bluetooth_probe(url);
settings.
connection_url=url
;
settings.
connection_name=name
;
mk.
connect_to(url,name
);
}
public void draw_graph_part
(Graphics g,
int x,
int y1,
int y2
)
{
if ( canvas_width
>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
);
}
}
/*********************************************** 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;
boolean init_bootloader=
false;
public void chg_state
(byte next_state
)
{
if (next_state
!=state
)act_menu_select=
0;
// prepare next state
switch(next_state
)
{
case STATEID_FLIGHTVIEW:
mk.
user_intent=USER_INTENT_LCD
;
break;
case STATEID_FLASHING:
mk.
bootloader_intension_flash=
true;
init_bootloader=
true;
break;
//#if fileapi=="on"
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;
//#endif
case STATEID_STICKVIEW:
mk.
user_intent=USER_INTENT_RCDATA
;
break;
case STATEID_SELECT_COMPORT:
menu_items=
new String[6];
lcd_lines=
new String[6];
menu_items
[0]=
"com0";
menu_items
[1]=
"com1";
menu_items
[2]=
"com2";
menu_items
[3]=
"com3";
menu_items
[4]=
"com4";
menu_items
[5]=
"back";
break;
case STATEID_NC_ERRORS:
lcd_lines=
new String[1];
lcd_lines
[0]=
""+mk.
error_str;
break;
case STATEID_ABOUT:
lcd_lines=credits
;
act_menu_select=max_lines-
1;
break;
case STATEID_CONN_DETAILS:
setup_menu
(conn_details_menu_items,conn_details_menu_actions
);
break;
case STATEID_TRAFFIC:
setup_menu
(onlyback_menu_items,back_to_conndetails_actions
);
/*
menu_items=new String[1];
lcd_lines=new String[1];
menu_items[0]="back";
*/
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:
mk.
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;
//#if bluetooth=="on"
case STATEID_SCANNING:
lcd_lines=
new String[3];
lcd_lines
[0]=
"Searching for";
lcd_lines
[1]=
"Bluetooth Devices";
lcd_lines
[2]=
"found";
mk.
close_connections(true);
bt_scanner.
search();
break;
//#endif
case STATEID_HANDLE_PARAMS:
menu_items=handle_params_menu_items
;
menu_actions=handle_params_menu_actions
;
lcd_lines=
new String[menu_items.
length];
break;
case STATEID_SELECT_PARAMSET:
menu_items=
new String[5];
for (int i=
0;i
<5;i++
)
menu_items
[i
]=mk.
params.
names[i
] +
((i==mk.
params.
active_paramset)?"*":
"");
lcd_lines=
new String[5];
break;
//#if bluetooth=="on"
case STATEID_DEVICESELECT:
menu_items=
new String[bt_scanner.
remote_device_count+
2];
lcd_lines=
new String[bt_scanner.
remote_device_count+
2];
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";
menu_items
[bt_scanner.
remote_device_count+
1]=
"cancel";
break;
//#endif
case STATEID_MAINMENU:
if (mk.
ufo_prober.
is_navi())
setup_menu
(main_menu_items_navi,main_menu_actions_navi
);
else if (mk.
ufo_prober.
is_mk())
setup_menu
(main_menu_items_mk,main_menu_actions_mk
);
else if (mk.
ufo_prober.
is_mk3mag())
setup_menu
(main_menu_items_mk3mag,main_menu_actions_mk3mag
);
else if (mk.
ufo_prober.
is_incompatible())
setup_menu
(main_menu_items_incompatible,main_menu_actions_incompatible
);
else // no connection
setup_menu
(main_menu_items_no_connection,main_menu_actions_no_connection
);
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]+=
(settings.
act_skin==SKINID_DARK
)?"Dark":
"Light";
menu_items
[1]+=
(!settings.
do_sound)?"Off":
"On";
menu_items
[2]+=
(!settings.
do_vibra)?"Off":
"On";
menu_items
[3]+=
(!settings.
do_scrollbg)?"Off":
"On";
menu_items
[4]+=
(!settings.
fullscreen)?"Off":
"On";
//#if devicecontrol=="on"
menu_items
[5]+=
(!settings.
keep_lighton)?"Off":
"On";
//#endif
menu_actions=settings_menu_actions
;
lcd_lines=
new String[menu_items.
length];
break;
case STATEID_RAWDEBUG:
mk.
user_intent=USER_INTENT_RAWDEBUG
;
break;
case STATEID_GRAPH:
mk.
user_intent=USER_INTENT_GRAPH
;
break;
}
mk.
watchdog.
resend_timeout=
0;
// switch state
state=next_state
;
} // void chg_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_y
<lcd_img.
getHeight())
keyPressed
(KEY_STAR
);
else
switch(state
)
{
case STATEID_CONN_DETAILS:
case STATEID_SETTINGSMENU:
case STATEID_FILEOPEN:
case STATEID_TRAFFIC:
case STATEID_SELECT_COMPORT:
case STATEID_MAINMENU:
case STATEID_SELECT_PARAMSET:
case STATEID_DEVICESELECT:
if (pointer_y
>canvas_height-lcd_img.
getHeight()*menu_items.
length)
{
act_menu_select=
(pointer_y-
(canvas_height-lcd_img.
getHeight()*menu_items.
length))/lcd_img.
getHeight();
keyPressed
(getKeyCode
(FIRE
));
}
break;
}
}
public void keyPressed
(int keyCode
)
{
debug.
log("KeyCode:"+keyCode
);
// key-actions common in all states
debug.
process_key(keyCode
);
/*
if ((keyCode==KEY_NUM9))
{ chg_state(STATEID_FLASHING); }
*/
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
))
{
settings.
fullscreen=
!settings.
fullscreen;
setFullScreenMode
(settings.
fullscreen);
return;
}
// key actions per state
switch(state
)
{
case STATEID_NC_ERRORS:
chg_state
(STATEID_MAINMENU
);
break;
case STATEID_IPINPUT:
if ((keyCode
>=KEY_NUM0
)&&(keyCode
<=KEY_NUM9
))
{
act_edit_ip
[ipinput_pos/
4]=helper.
mod_decimal(act_edit_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_edit_ip
[ipinput_pos/
4]=helper.
mod_decimal(act_edit_ip
[ipinput_pos/
4],
(ipinput_pos
<15?2:
3)-
(ipinput_pos
%4
),
1,-
1,
9);
break;
case DOWN:
act_edit_ip
[ipinput_pos/
4]=helper.
mod_decimal(act_edit_ip
[ipinput_pos/
4],
(ipinput_pos
<15?2:
3)-
(ipinput_pos
%4
),-
1,-
1,
9);
case FIRE:
if (ipinput4proxy
)
{
settings.
act_proxy_ip=act_edit_ip
;
mk.
do_proxy("socket://"+helper.
ip_str(settings.
act_proxy_ip,
false));
chg_state
(STATEID_PROXY
);
}
else
{
settings.
act_conn_ip=act_edit_ip
;
connect_mk
("socket://"+helper.
ip_str(settings.
act_conn_ip,
false),
"TCP/IP Connection");
chg_state
(STATEID_CONN_DETAILS
);
}
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_ABOUT:
switch (getGameAction
(keyCode
))
{
case UP:
if (act_menu_select
>=max_lines
)
act_menu_select--
;
break;
case DOWN:
if (act_menu_select
<lcd_lines.
length-
1)
act_menu_select++
;
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_SELECT_COMPORT:
if ( getGameAction
(keyCode
)==FIRE
)
{
if (act_menu_select
<menu_items.
length)
connect_mk
("comm:com"+act_menu_select+
";baudrate=57600",
"com"+act_menu_select
);
chg_state
(STATEID_CONN_DETAILS
);
}
else
menu_keypress
(keyCode
);
break;
/*
case STATEID_HANDLsE_PARAMS:
menu_keypress(keyCode);
break;
*/
/*
case STATEID_TRAFFIC:
if ( getGameAction (keyCode)==FIRE )
chg_state(STATEID_CONN_DETAILS);
else
menu_keypress(keyCode);
break;
*/
//#if fileapi=="on"
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;
//#endif
// handle menue
case STATEID_TRAFFIC:
case STATEID_CONN_DETAILS:
case STATEID_HANDLE_PARAMS:
case STATEID_SETTINGSMENU:
case STATEID_MAINMENU:
if ( getGameAction
(keyCode
)==FIRE
)
{
switch(menu_actions
[act_menu_select
])
{
case ACTIONID_BACK_TO_CONNDETAILS:
chg_state
(STATEID_CONN_DETAILS
);
break;
case ACTIONID_RESET_PARAMS:
state=STATEID_FLASHING
;
mk.
bootloader_intension_flash=
false;
init_bootloader=
true;
break;
case ACTIONID_FLASH:
chg_state
(STATEID_FLASHING
);
//chg_state(STATEID_FLASHING);
break;
case ACTIONID_DATABUFF:
chg_state
(STATEID_DATABUFF
);
break;
case ACTIONID_NC_ERRORS:
chg_state
(STATEID_NC_ERRORS
);
break;
case ACTIONID_ABOUT:
chg_state
(STATEID_ABOUT
);
break;
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_SWITCH_MK3MAG:
mk.
switch_to_mk3mag();
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_CHANGESKIN:
settings.
act_skin++
;
settings.
act_skin=
(byte)(settings.
act_skin%2
);
load_images
();
chg_state
(STATEID_SETTINGSMENU
);
break;
case ACTIONID_SOUNDTOGGLE:
settings.
do_sound=
!settings.
do_sound;
chg_state
(STATEID_SETTINGSMENU
);
break;
case ACTIONID_VIBRATOGGLE:
settings.
do_vibra=
!settings.
do_vibra;
chg_state
(STATEID_SETTINGSMENU
);
break;
case ACTIONID_GRAPHTOGGLE:
settings.
do_scrollbg=
!settings.
do_scrollbg;
load_images
();
chg_state
(STATEID_SETTINGSMENU
);
break;
case ACTIONID_FULLSCREENTOGGLE:
settings.
fullscreen=
!settings.
fullscreen;
setFullScreenMode
(settings.
fullscreen);
chg_state
(STATEID_SETTINGSMENU
);
break;
//#if devicecontrol=="on"
case ACTIONID_LIGHTTOGGLE:
settings.
keep_lighton =
!settings.
keep_lighton;
chg_state
(STATEID_SETTINGSMENU
);
break;
//#endif
case ACTIONID_WRITE_PARAMS:
mk.
write_params();
chg_state
(STATEID_MAINMENU
);
break;
case ACTIONID_UNDO_PARAMS:
mk.
params.
use_backup();
chg_state
(STATEID_MAINMENU
);
break;
case ACTIONID_MAINMENU:
chg_state
(STATEID_MAINMENU
);
break;
case ACTIONID_DEBUG:
debug.
showing=
true;
break;
case ACTIONID_TRAFFIC:
chg_state
(STATEID_TRAFFIC
);
break;
case ACTIONID_CONNECT_TCP:
ipinput4proxy=
false;
chg_state
(STATEID_IPINPUT
);
break;
case ACTIONID_SCAN_BT:
chg_state
(STATEID_SCANNING
);
break;
case ACTIONID_SELECT_COM:
chg_state
(STATEID_SELECT_COMPORT
);
break;
case ACTIONID_PROXY_INPUT:
ipinput4proxy=
true;
chg_state
(STATEID_IPINPUT
);
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;
//#if bluetooth=="on"
case STATEID_DEVICESELECT:
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_CONN_DETAILS
);
}
else
{
if (bt_scanner.
remote_device_count == act_menu_select
)
chg_state
(STATEID_SCANNING
);
else
chg_state
(STATEID_CONN_DETAILS
);
}
}
else menu_keypress
(keyCode
);
break;
//#endif
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;
}
}
}