0,0 → 1,2527 |
/*************************************************************** |
* |
* 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.*; |
|
|
|
public class DUBwiseCanvas |
extends Canvas |
implements Runnable,org.ligi.ufo.DUBwiseDefinitions , DUBwiseUIDefinitions |
{ |
|
//#if fileapi=="on" |
DUBwiseFileAccess file_access; |
//#endif |
|
String act_input_str=" "; |
|
|
// for dual use of states |
boolean select_paramset4edit; |
boolean ipinput4proxy; |
|
|
byte ipinput_pos=0; |
int[] act_edit_ip; |
|
int canvas_width=100; |
int canvas_height=100; |
|
|
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; |
private MKParamsEditor settings_editor=null; |
public DUBwiseDebug debug=null; |
|
|
//#if voice_mode!="no_voice" |
public 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 graph_offset=0; |
|
// 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; |
public int graph_height; |
|
|
boolean quit=false; |
|
int bg_offset=0; |
|
// variable to hold the current state |
public byte state=STATEID_INITIAL; |
public byte nextstate=STATEID_INITIAL; |
|
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; |
int[] act_menu_select_bak; |
String[] lcd_lines =null; |
|
|
|
// boolean expert_mode=false; |
|
public void setup_main_menu() |
{ |
byte setup_pos=0; |
byte[] tmp_actions=new byte[20]; |
String[] tmp_items=new String[20]; |
|
|
|
tmp_actions[setup_pos]=ACTIONID_SETTINGS; |
tmp_items[setup_pos++] ="Tool Settings"; |
|
|
tmp_actions[setup_pos]=ACTIONID_CONN_DETAILS; |
tmp_items[setup_pos++] ="Connection"; |
|
if (settings.expert_mode) |
{ |
tmp_actions[setup_pos]=ACTIONID_DEBUG; |
tmp_items[setup_pos++] ="Debug"; |
|
} |
|
if (mk.ufo_prober.is_mk() ) |
{ |
tmp_actions[setup_pos]=ACTIONID_MOTORTEST; |
tmp_items[setup_pos++] ="Motor Test"; |
|
tmp_actions[setup_pos]=ACTIONID_KEYCONTROL; |
tmp_items[setup_pos++] ="Key-Control"; |
|
tmp_actions[setup_pos]=ACTIONID_RCDATA; |
tmp_items[setup_pos++] ="view RC-data"; |
|
tmp_actions[setup_pos]=ACTIONID_PARAM_MENU; |
tmp_items[setup_pos++] ="Flight Settings"; |
|
tmp_actions[setup_pos] =ACTIONID_HORIZON; |
tmp_items[setup_pos++] ="Artificial Horizon"; |
} |
|
|
|
if (( mk.ufo_prober.is_navi()||mk.ufo_prober.is_mk() )) |
{ |
tmp_actions[setup_pos]=ACTIONID_LCD; |
tmp_items[setup_pos++] ="LCD"; |
} |
|
if (( mk.ufo_prober.is_mk() )) |
{ |
tmp_actions[setup_pos]=ACTIONID_GRAPH; |
tmp_items[setup_pos++] ="Graph"; |
} |
|
|
|
|
if (( mk.ufo_prober.is_navi()||mk.ufo_prober.is_mk()||mk.ufo_prober.is_mk3mag() )) |
{ |
tmp_actions[setup_pos]=ACTIONID_RAWDEBUG; |
tmp_items[setup_pos++] ="Debug Values"; |
} |
|
|
if ( mk.ufo_prober.is_navi()) |
{ |
tmp_actions[setup_pos]=ACTIONID_GPSDATA; |
tmp_items[setup_pos++] ="view GPS-Data"; |
|
tmp_actions[setup_pos]=ACTIONID_NC_ERRORS; |
tmp_items[setup_pos++] ="view Errors"; |
|
|
tmp_actions[setup_pos]=ACTIONID_SWITCH_FC; |
tmp_items[setup_pos++] ="switch to FC"; |
|
tmp_actions[setup_pos]=ACTIONID_SWITCH_MK3MAG; |
tmp_items[setup_pos++] ="switch to MK3MAG"; |
|
} |
|
if ((mk.ufo_prober.is_mk()||mk.ufo_prober.is_mk3mag() )) |
{ |
tmp_actions[setup_pos]=ACTIONID_SWITCH_NC; |
tmp_items[setup_pos++] ="switch to Navi"; |
} |
|
|
//if ((settings.expert_mode)&& ( mk.ufo_prober.is_navi()||mk.ufo_prober.is_mk()||mk.ufo_prober.is_mk3mag()||mk.ufo_prober.is_incompatible() )) |
|
if (settings.expert_mode) |
{ |
tmp_actions[setup_pos]=ACTIONID_FLASH; |
tmp_items[setup_pos++] ="Flash Firmware"; |
} |
|
if ((settings.expert_mode)&& ( mk.ufo_prober.is_mk() )) |
{ |
tmp_actions[setup_pos]=ACTIONID_CAM; |
tmp_items[setup_pos++] ="Remote Cam"; |
} |
|
|
if (!settings.expert_mode) |
{ |
tmp_actions[setup_pos]=ACTIONID_ABOUT; |
tmp_items[setup_pos++] ="About"; |
} |
|
tmp_actions[setup_pos]=ACTIONID_QUIT; |
tmp_items[setup_pos++] ="Quit"; |
|
|
byte[] tmp_actions_fin=new byte[setup_pos]; |
String[] tmp_items_fin=new String[setup_pos]; |
|
if (setup_pos<act_menu_select) |
act_menu_select=0; |
|
for ( int tmp_p=0;tmp_p<setup_pos;tmp_p++) |
{ |
tmp_actions_fin[tmp_p]=tmp_actions[tmp_p]; |
tmp_items_fin[tmp_p] =tmp_items[tmp_p]; |
} |
|
setup_menu(tmp_items_fin,tmp_actions_fin); |
} |
|
|
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); |
} |
|
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[settings.remote_cam_stick]>100); |
} |
|
// int lcd_top=25; |
|
public void paint_lcd(Graphics g) |
{ |
int y; |
// int lcd_top= (state==STATEID_EDIT_PARAMS?0:25); |
//int lcd_top= 25; |
max_lines=(canvas_height-25/*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.select_mode))?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=i*lcd_char_height; |
else*/ |
y=canvas_height-(display_lines-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_skin_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; |
} |
// lcd_char_width=lcd_img.getWidth()/222; |
lcd_char_height=lcd_img.getHeight(); |
} |
|
catch (Exception e) |
{ |
debug.err(e.toString()); |
} |
|
} |
public void load_global_images() |
{ |
try |
{ |
symbols_img=Image.createImage("/symbols.png"); |
|
|
/* if (bg_img!=null) |
graph_data=new int[GRAPH_COUNT][bg_img.getWidth()]; |
else |
*/ |
|
} |
|
catch (Exception e) |
{ |
debug.err(e.toString()); |
} |
|
} |
|
// construct |
public DUBwiseCanvas(DUBwise _root) |
{ |
|
act_menu_select_bak=new int[STATEID_COUNT]; |
for (int i=0;i<STATEID_COUNT;i++) |
act_menu_select_bak[i]=0; |
//#if fileapi=="on" |
file_access=new DUBwiseFileAccess(this); |
//#endif |
|
root=_root; |
|
mk = new org.ligi.ufo.MKCommunicator(); |
|
|
//#if voice_mode!="no_voice" |
status_voice=new MKStatusVoice(mk,this); |
//#endif |
|
settings = new DUBwiseSettings(this); |
settings.load(); |
load_global_images(); |
debug = new DUBwiseDebug(this); |
|
//#if bluetooth=="on" |
bt_scanner = new BTSearcher(); |
//#endif |
|
|
|
|
|
mk.gps_position.act_speed_format=settings.speed_format; |
mk.gps_position.act_gps_format= settings.gps_format; |
|
|
chg_state(STATEID_MAINMENU); |
|
new Thread(this).start(); |
|
if (settings.connection_url!="") |
connect_mk(settings.connection_url,settings.connection_name); |
} |
|
|
/****************************** 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_ERROR_MSG); |
} |
else |
if (state==STATEID_MAINMENU) |
chg_state(STATEID_MAINMENU); // reload mainmenu ( changed content ) |
} |
|
|
switch(state) |
{ |
|
case STATEID_RESET_PARAMS: |
|
if (mk.bootloader_finish_ok) |
{ |
mk.params.reset(); |
mk.watchdog.act_paramset=0; |
nextstate=STATEID_PARAM_MENU; |
success_msg="Param Reset Success!"; |
chg_state(STATEID_SUCCESS_MSG); |
} |
break; |
case STATEID_GRAPH: |
graph_offset--; |
if (graph_offset==-graph_data[0].length) |
graph_offset=0; |
break; |
|
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 "); |
|
} |
cam_img = Image.createImage(cam_raw, 0, cam_raw.length); |
} |
else |
{ |
if (cam_img==null) |
;; |
} |
} |
catch ( Exception e) |
{ |
debug.log(e.toString()); |
} |
break; |
case STATEID_KEYCONTROL: |
//mk.send_keys(keycontrol_bitfield); |
break; |
|
|
case STATEID_ERROR_MSG: |
lcd_lines[0]=""+mk.error_str; |
break; |
|
case STATEID_READ_PARAMS: |
if (mk.watchdog.act_paramset==5) |
{ |
chg_state(STATEID_SELECT_PARAMSET); |
select_paramset4edit=true; |
} |
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_ERROR_MSG); |
} |
|
} |
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_STRINGINPUT: |
|
lcd_lines[0]=act_input_str; |
for(int tmp_i=act_input_str.length();tmp_i<20;tmp_i++) |
lcd_lines[0]+=(char)(0); |
|
lcd_lines[1]=""; |
for(int foo=0;foo<20;foo++) |
{ |
if (foo==ipinput_pos) |
lcd_lines[1]+="^"; |
else |
lcd_lines[1]+=" "; |
} |
break; |
|
|
case STATEID_IPINPUT: |
if (ipinput4proxy) |
act_edit_ip=settings.act_proxy_ip; |
else |
act_edit_ip=settings.act_conn_ip; |
|
lcd_lines[1]=DUBwiseHelper.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: |
|
lcd_lines[1]="Bluetooth Devices " + idle_seq[(((frame_pos/5)%idle_seq.length))]; |
lcd_lines[2]="found " + bt_scanner.remote_device_count; |
|
if (!bt_scanner.searching) |
chg_state(STATEID_DEVICESELECT); |
|
break; |
//#endif |
|
|
} |
|
if (quit) |
{ |
settings.speed_format=mk.gps_position.act_speed_format; |
settings.gps_format=mk.gps_position.act_gps_format; |
settings.save(); |
root.quit(); |
} |
|
|
//rescan=false; |
|
if (bg_img!=null) |
{ |
bg_offset--; |
if (bg_offset==-bg_img.getWidth()) |
bg_offset=0; |
} |
|
|
|
|
//#if devicecontrol=="on" |
|
try { |
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; |
} |
} |
|
|
public int check_local_max(int val) |
{ |
if ( val>local_max) |
local_max=val; |
else if (-val>local_max) |
local_max=-val; |
return val; |
} |
// 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 { |
|
|
|
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) |
{ |
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; |
int symbol_spacer=5; |
|
g.setClip(symbol_left,0,(symbols_img.getWidth()/10),symbols_img.getHeight());; |
if (mk.connected) |
{ |
|
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); |
|
|
|
symbol_left+=symbol_spacer+(symbols_img.getWidth()/10); |
|
|
} |
else |
g.drawImage(symbols_img,(-1)*(symbols_img.getWidth()/10),0, g.TOP | g.LEFT); |
|
|
|
|
|
|
if ((mk.ufo_prober.is_navi()||mk.ufo_prober.is_mk())) |
{ |
|
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); |
|
} |
|
} |
|
|
// if (mk.connected) |
|
|
// unclip |
g.setClip(0,0,canvas_width,canvas_height); |
|
y_off+=symbols_img.getHeight(); |
graph_height=(canvas_height-y_off)/2; |
line_middle_y=graph_height+y_off; |
g.setColor(skin_fg_color()); |
|
switch(state) |
{ |
case STATEID_HORIZON: |
|
g.setStrokeStyle(Graphics.SOLID); |
g.setColor(0x6e4e1d); |
|
int horizon_height=(canvas_height-y_off)/2; |
int horizon_middle=y_off+horizon_height; |
|
|
int horizon_roll_pixels= (mk.angle_roll*horizon_height)/600; |
int horizon_roll_pixels_=horizon_roll_pixels; |
|
|
int nick_bar_width=canvas_width/4; |
int nick_bar_height= nick_bar_width/2; |
|
|
int nick_size=canvas_width/4; |
int nick_pixels_y=(mk.angle_nick*horizon_height)/900; |
|
int nick_pixels_x; |
if ((mk.angle_roll*mk.angle_nick)>1) |
nick_pixels_x=-((int)Math.sqrt(mk.angle_roll*mk.angle_nick)*(canvas_width/2))/(900); |
else |
nick_pixels_x=((int)Math.sqrt(-mk.angle_roll*mk.angle_nick)*(canvas_width/2))/(900); |
|
while (horizon_roll_pixels!=0) |
{ |
|
if (horizon_roll_pixels_>0) |
{ |
g.drawLine(0,horizon_middle+horizon_roll_pixels_,canvas_width,horizon_middle-horizon_roll_pixels); |
g.drawLine(0,horizon_middle+horizon_roll_pixels_,canvas_width,horizon_middle+horizon_roll_pixels); |
} |
else |
{ |
g.drawLine(0,horizon_middle+horizon_roll_pixels,canvas_width,horizon_middle-horizon_roll_pixels_); |
g.drawLine(0,horizon_middle-horizon_roll_pixels,canvas_width,horizon_middle-horizon_roll_pixels_); |
} |
// g.drawLine(0,horizon_middle-horizon_roll_pixels_,canvas_width,horizon_middle-horizon_roll_pixels); |
horizon_roll_pixels+=(horizon_roll_pixels<0)?1:-1; // go to 0 |
|
/*g.drawLine(0,horizon_middle-horizon_roll_pixels,canvas_width,horizon_middle+horizon_roll_pixels); |
if (horizon_roll_pixels<0) |
g.drawLine(0,horizon_middle-horizon_roll_pixels_,canvas_width,horizon_middle-horizon_roll_pixels); |
else |
g.drawLine(0,horizon_middle+horizon_roll_pixels,canvas_width,horizon_middle+horizon_roll_pixels_); |
|
horizon_roll_pixels+=(horizon_roll_pixels<0)?1:-1; // go to 0 |
*/ |
} |
|
if (horizon_roll_pixels_>0) |
{ |
g.drawLine(0,horizon_middle+horizon_roll_pixels_,canvas_width,horizon_middle-horizon_roll_pixels); |
g.drawLine(0,horizon_middle+horizon_roll_pixels_,canvas_width,horizon_middle+horizon_roll_pixels); |
g.fillRect(0,horizon_middle+horizon_roll_pixels_,canvas_width,canvas_height-(horizon_middle+horizon_roll_pixels_)); |
} |
else |
{ |
g.drawLine(0,horizon_middle+horizon_roll_pixels,canvas_width,horizon_middle-horizon_roll_pixels_); |
g.drawLine(0,horizon_middle-horizon_roll_pixels,canvas_width,horizon_middle-horizon_roll_pixels_); |
g.fillRect(0,horizon_middle-horizon_roll_pixels_,canvas_width,canvas_height-(horizon_middle-horizon_roll_pixels_)); |
} |
|
|
g.setColor(0x254d9e); |
g.fillArc((canvas_width-nick_size)/2- nick_pixels_x, horizon_middle-nick_size/2+ nick_pixels_y, nick_size, nick_size, 0,360); |
|
// for (i=0;i<horizon_roll_pixels |
// 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()); |
|
|
|
if (settings.expert_mode) |
{ |
g.drawString("nick => " + mk.angle_nick,0,y_off,Graphics.TOP | Graphics.LEFT); |
y_off+=spacer; |
|
g.drawString("roll => " + mk.angle_roll,0,y_off,Graphics.TOP | Graphics.LEFT); |
y_off+=spacer; |
} |
break; |
|
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_SUCCESS_MSG: |
case STATEID_ERROR_MSG: |
if (err_img!=null) |
{ |
int err_img_left=(canvas_width-err_img.getWidth()/2)/2; |
int err_img_top=(canvas_height-err_img.getHeight())/2; |
if (err_img_top<0)err_img_top=0; |
g.setClip(err_img_left,err_img_top,err_img.getWidth()/2,err_img.getHeight()); |
g.drawImage(err_img,err_img_left-((state==STATEID_SUCCESS_MSG)?0:(err_img.getWidth()/2)),err_img_top, g.TOP | g.LEFT); |
} |
paint_lcd(g); |
|
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("GrSpeed: " + mk.gps_position.GroundSpeed_str() ,0,y_off,Graphics.TOP | Graphics.LEFT); |
y_off+=spacer1; |
|
g.drawString("Heading: " + mk.gps_position.Heading ,0,y_off,Graphics.TOP | Graphics.LEFT); |
y_off+=spacer1; |
|
g.drawString("CompasHeading: " + mk.gps_position.CompasHeading ,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_RESET_PARAMS: |
case STATEID_FLASHING: |
g.setFont(f2); |
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+=spacer1; |
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 or DOWN =>nick " + mk.extern_control[EXTERN_CONTROL_NICK],0,y_off,Graphics.TOP | Graphics.LEFT); |
y_off+=spacer; |
g.drawString("LEFT or RIGHT =>roll " + mk.extern_control[EXTERN_CONTROL_ROLL],0,y_off,Graphics.TOP | Graphics.LEFT); |
y_off+=spacer; |
g.drawString("1 or 4 =>altitude " + mk.extern_control[EXTERN_CONTROL_HIGHT],0,y_off,Graphics.TOP | Graphics.LEFT); |
|
y_off+=spacer; |
g.drawString("2 or 3 =>gier " + mk.extern_control[EXTERN_CONTROL_GIER],0,y_off,Graphics.TOP | Graphics.LEFT); |
|
y_off+=spacer; |
g.drawString("6 or 9 =>gas " + mk.extern_control[EXTERN_CONTROL_GAS],0,y_off,Graphics.TOP | Graphics.LEFT); |
|
y_off+=spacer; |
g.drawString("* and # =>exit",0,y_off,Graphics.TOP | Graphics.LEFT); |
y_off+=spacer; |
/* g.drawString("* and Fire =>Start Engines",0,y_off,Graphics.TOP | Graphics.LEFT); |
y_off+=spacer; |
g.drawString("* and 0 =>Stop Engines",0,y_off,Graphics.TOP | Graphics.LEFT); |
y_off+=spacer; |
*/ |
g.drawString("sent:" + mk.stats.external_control_request_count +"confirm:" + mk.stats.external_control_confirm_frame_count,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" + file_access.act_path() ,0,y_off,Graphics.TOP | Graphics.LEFT); |
paint_menu(g); |
break; |
//#endif |
|
|
case STATEID_PARAM_MENU: |
paint_menu(g); |
break; |
case STATEID_STRINGINPUT: |
case STATEID_ABOUT: |
case STATEID_IPINPUT: |
|
paint_lcd(g); |
break; |
|
case STATEID_READ_PARAMS: |
paint_lcd(g); |
break; |
|
|
//#if bluetooth=="on" |
case STATEID_SCANNING: |
paint_lcd(g); |
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( " rc:"+mk.stats.stick_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); |
|
|
g.drawString( " other:"+mk.stats.other_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 +" rc:" + mk.stats.stick_data_request_count ,0,y_off,Graphics.TOP | Graphics.LEFT); |
y_off+=spacer1; |
|
g.drawString( " resend:"+mk.stats.resend_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_SETTINGSMENU: |
|
settings_editor.paint(g); |
break; |
// falltru wanted |
// case STATEID_SELECT_SPEED_FORMAT: |
// case STATEID_SELECT_GPS_FORMAT: |
case STATEID_MAINMENU: |
|
|
|
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); |
g.setFont(f2); |
// LEGEND |
if (settings.graph_legend) 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] + mk.debug_data.analog[graph_sources[d]],23,y_off,Graphics.TOP | Graphics.LEFT); |
y_off+=spacer1; |
|
*/ |
g.setColor(graph_colors[d]); |
g.fillRect(canvas_width-20,canvas_height-spacer*(d+1)+(spacer)/2-2 ,20,4); |
g.setColor(skin_fg_color()); |
g.drawString(graph_names[d] /*+ mk.debug_data.analog[graph_sources[d]]*/,canvas_width-23,canvas_height-spacer*(d+1),Graphics.TOP | Graphics.RIGHT); |
// y_off+=spacer1; |
|
} |
|
if (settings.graph_scale) |
{ |
|
int scale=10; |
// if ((10/line_scaler)<5)scale =1; |
if (((10/line_scaler)*2)<(canvas_height/2) )scale =10; |
if (((50/line_scaler)*2)<(canvas_height/2) )scale =50; |
if (((100/line_scaler)*2)<(canvas_height/2) )scale =100; |
if (((250/line_scaler)*2)<(canvas_height/2) )scale =250; |
if (((500/line_scaler)*2)<(canvas_height/2) )scale =500; |
if (((1000/line_scaler)*2)<(canvas_height/2) )scale =1000; |
if (((10000/line_scaler)*2)<(canvas_height/2) )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,canvas_width,line_middle_y); |
|
while ((jump/line_scaler)<graph_height) |
{ |
|
g.drawString(""+jump,0,line_middle_y - jump/line_scaler,Graphics.TOP | Graphics.LEFT); |
if (jump!=0)g.drawString("-"+jump,0,line_middle_y + jump/line_scaler,Graphics.TOP | Graphics.LEFT); |
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++) |
{ |
|
|
// !!TODO checkme |
g.setColor(graph_colors[gr]); |
|
graph_data[gr][-graph_offset]=check_local_max(mk.debug_data.analog[graph_sources[gr]]); |
|
|
|
line_scaler= local_max/graph_height+1; |
|
|
for ( int x=0;x<canvas_width;x++) |
{ |
int p= (((-graph_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; |
Image last_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; |
String success_msg=""; |
|
public void chg_state(byte next_state) |
{ |
settings_editor = null; |
params_editor = null; |
err_img=null; |
graph_data=null; |
|
act_menu_select_bak[state]=act_menu_select; |
act_menu_select=act_menu_select_bak[next_state]; |
|
|
/* |
// tasks on state exit |
switch(next_state) |
{ |
case STATEID_SETTINGSMENU: |
|
break; |
} |
*/ |
// prepare next state |
switch(next_state) |
{ |
case STATEID_SUCCESS_MSG: |
case STATEID_ERROR_MSG: |
lcd_lines=new String[1]; |
|
lcd_lines[0]=""+((next_state==STATEID_SUCCESS_MSG)?success_msg:mk.error_str); |
try |
{ |
err_img=Image.createImage("/preflight.jpg"); |
} |
catch (Exception e) |
{ |
debug.log("problem loading error image"); |
} |
|
break; |
case STATEID_EDIT_PARAMS: |
params_editor = new MKParamsEditor(this,mk.params,STATEID_HANDLE_PARAMS); |
break; |
case STATEID_STRINGINPUT: |
lcd_lines=new String[2]; |
lcd_lines[0]=act_input_str; |
lcd_lines[1]="^"; |
|
break; |
case STATEID_FLIGHTVIEW: |
mk.user_intent=USER_INTENT_LCD; |
break; |
case STATEID_RESET_PARAMS: |
|
mk.bootloader_intension_flash=false; |
mk.bl_retrys=0; |
mk.init_bootloader=true; |
break; |
|
case STATEID_FLASHING: |
mk.bootloader_intension_flash=true; |
mk.bl_retrys=0; |
mk.init_bootloader=true; |
break; |
|
//#if fileapi=="on" |
case STATEID_FILEOPEN: |
file_access.trigger(); |
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_ABOUT: |
lcd_lines=credits; |
lcd_lines[1]=" ufo-lib: " + mk.lib_version_str(); |
act_menu_select=max_lines-1; |
break; |
case STATEID_CONN_DETAILS: |
setup_menu(conn_details_menu_items,conn_details_menu_actions); |
break; |
|
|
case STATEID_PARAM_MENU: |
setup_menu(param_menu_items,param_menu_actions); |
break; |
case STATEID_TRAFFIC: |
setup_menu(onlyback_menu_items,back_to_conndetails_actions); |
break; |
case STATEID_CAMMODE: |
mk.user_intent=USER_INTENT_RCDATA; |
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: |
mk.user_intent= USER_INTENT_EXTERNAL_CONTROL; |
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[6]; |
for (int i=0;i<5;i++) |
menu_items[i]=""+(i+1)+": " + mk.params.getParamName(i) + ((i==mk.params.active_paramset)?"*":""); |
|
menu_items[5]="back"; |
lcd_lines=new String[6]; |
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: |
setup_main_menu(); |
|
break; |
|
case STATEID_SETTINGSMENU: |
settings_editor = new MKParamsEditor(this,settings,STATEID_MAINMENU); |
/* |
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"; |
menu_items[5]+=(mk.gps_position.act_gps_format==0)?" Decimal":" MinSec"; |
menu_items[6]+=(mk.gps_position.act_speed_format==0)?" KM/H":((mk.gps_position.act_speed_format==1)?" MP/H":"CM/S"); |
|
//#if devicecontrol=="on" |
menu_items[7]+=(!settings.keep_lighton)?"Off":"On"; |
//#endif |
menu_items[8]+=(!settings.expert_mode)?" Off":" On"; |
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: |
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; |
|
|
mk.user_intent=USER_INTENT_GRAPH; |
local_max=1; |
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 |
mod_external_control_by_keycode(keyCode,(byte)0); |
|
/* |
mk.send_keys(keycontrol_bitfield); |
*/ |
break; |
} |
|
} |
|
|
public void mod_external_control_by_keycode(int keyCode,byte mul) |
{ |
|
if (keyCode==this.KEY_NUM2) |
mk.extern_control[EXTERN_CONTROL_GIER]=(byte)(-mul*settings.default_extern_control[EXTERN_CONTROL_GIER]); |
else if (keyCode==this.KEY_NUM3) |
mk.extern_control[EXTERN_CONTROL_GIER]=(byte)(mul*settings.default_extern_control[EXTERN_CONTROL_GIER]); |
|
else if (keyCode==this.KEY_NUM1) |
mk.extern_control[EXTERN_CONTROL_HIGHT]+=mul*settings.default_extern_control[EXTERN_CONTROL_HIGHT]; |
else if (keyCode==this.KEY_NUM4) |
mk.extern_control[EXTERN_CONTROL_HIGHT]-=mul*settings.default_extern_control[EXTERN_CONTROL_HIGHT]; |
|
|
else if (keyCode==this.KEY_NUM6) |
{ if ( mk.extern_control[EXTERN_CONTROL_GAS]<255) mk.extern_control[EXTERN_CONTROL_GAS]+=mul*settings.default_extern_control[EXTERN_CONTROL_GAS]; } |
else if (keyCode==this.KEY_NUM9) |
{ if ( mk.extern_control[EXTERN_CONTROL_GAS]>0) mk.extern_control[EXTERN_CONTROL_GAS]-=mul*settings.default_extern_control[EXTERN_CONTROL_GAS]; } |
|
else switch (getGameAction (keyCode)) |
{ |
case UP: |
mk.extern_control[EXTERN_CONTROL_NICK]=(byte)(mul*settings.default_extern_control[EXTERN_CONTROL_NICK]); |
break; |
|
case DOWN: |
mk.extern_control[EXTERN_CONTROL_NICK]=(byte)(-mul*settings.default_extern_control[EXTERN_CONTROL_NICK]); |
|
break; |
|
|
case LEFT: |
mk.extern_control[EXTERN_CONTROL_ROLL]=(byte)(mul*settings.default_extern_control[EXTERN_CONTROL_ROLL]); |
break; |
|
case RIGHT: |
mk.extern_control[EXTERN_CONTROL_ROLL]=(byte)(-mul*settings.default_extern_control[EXTERN_CONTROL_ROLL]); |
break; |
|
case FIRE: |
|
break; |
|
|
} |
|
} |
|
// to check if 2 keys are pressed |
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; |
} |
} |
|
|
int last_keycode=-1; |
int repeat_keycode=0; |
|
public void keyPressed(int keyCode) |
{ |
if (last_keycode==keyCode) |
repeat_keycode++; |
else |
{ |
repeat_keycode=0; |
last_keycode=keyCode; |
} |
|
debug.log("KeyCode:"+keyCode); |
// key-actions common in all states |
debug.process_key(keyCode); |
|
|
if (((keyCode==KEY_STAR) || (keyCode==settings.key_back) )&&(state!=STATEID_KEYCONTROL))//&&(state!= STATEID_STRINGINPUT)) |
{ |
chg_state(STATEID_MAINMENU); |
return; |
} |
|
|
if (((keyCode==KEY_POUND)||(keyCode==settings.key_fullscreen))&&(state!=STATEID_KEYCONTROL)) |
{ |
settings.toggle_fullscreen(); |
|
return; |
} |
|
// key actions per state |
switch(state) |
{ |
|
case STATEID_SUCCESS_MSG: |
chg_state(nextstate); |
break; |
case STATEID_ERROR_MSG: |
chg_state(STATEID_MAINMENU); |
break; |
case STATEID_STRINGINPUT: |
if ((keyCode>=KEY_NUM2)&&(keyCode<=KEY_NUM9)) |
{ |
act_input_str=act_input_str.substring(0,ipinput_pos) + |
|
|
(char)( 97 + (keyCode-KEY_NUM2)*3 + ((keyCode>KEY_NUM7)?1:0) +(repeat_keycode%(((keyCode==KEY_NUM7)||(keyCode==KEY_NUM9))?4:3))) |
|
+ act_input_str.substring(ipinput_pos+1,act_input_str.length()); |
} |
else if ((keyCode==KEY_NUM0)) |
{ |
act_input_str=act_input_str.substring(0,ipinput_pos) + |
act_input_str.substring(ipinput_pos+1,act_input_str.length()); |
} |
else |
{ |
switch (getGameAction (keyCode)) |
{ |
|
case LEFT: |
if(ipinput_pos>0) ipinput_pos--; |
break; |
|
case RIGHT: |
if(ipinput_pos<19) ipinput_pos++; |
break; |
|
case UP: |
act_input_str=act_input_str.substring(0,ipinput_pos) + |
(char)((byte) act_input_str.charAt(ipinput_pos)-1) + act_input_str.substring(ipinput_pos+1,act_input_str.length()); |
|
break; |
case DOWN: |
act_input_str=act_input_str.substring(0,ipinput_pos) + |
(char)((byte) act_input_str.charAt(ipinput_pos)+1) + act_input_str.substring(ipinput_pos+1,act_input_str.length()); |
|
break; |
|
|
case FIRE: |
mk.params.set_name(act_input_str); |
chg_state(STATEID_HANDLE_PARAMS); |
break; |
} |
|
} |
if (act_input_str.length()<=ipinput_pos) act_input_str+=" "; |
break; |
case STATEID_IPINPUT: |
if ((keyCode>=KEY_NUM0)&&(keyCode<=KEY_NUM9)) |
{ |
act_edit_ip[ipinput_pos/4]=DUBwiseHelper.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]=DUBwiseHelper.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]=DUBwiseHelper.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://"+DUBwiseHelper.ip_str(settings.act_proxy_ip,false)); |
chg_state(STATEID_PROXY); |
} |
else |
{ |
settings.act_conn_ip=act_edit_ip; |
connect_mk("socket://"+DUBwiseHelper.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_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 |
mod_external_control_by_keycode(keyCode,(byte)1); |
|
|
|
if (keycontrol_exit==3) |
chg_state(STATEID_MAINMENU); |
|
/* |
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; |
|
} |
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 ) |
{ |
file_access.fire(); |
} |
else |
menu_keypress(keyCode); |
break; |
|
//#endif |
|
case STATEID_SETTINGSMENU: |
settings_editor.keypress(keyCode,getGameAction (keyCode)) ; |
break; |
|
// handle menue |
// case STATEID_SELECT_SPEED_FORMAT: |
// case STATEID_SELECT_GPS_FORMAT: |
case STATEID_PARAM_MENU: |
case STATEID_TRAFFIC: |
case STATEID_CONN_DETAILS: |
case STATEID_HANDLE_PARAMS: |
|
case STATEID_MAINMENU: |
|
if ( getGameAction (keyCode)==FIRE ) |
{ |
switch(menu_actions[act_menu_select]) |
{ |
case ACTIONID_PARAM_MENU: |
chg_state(STATEID_PARAM_MENU); |
break; |
|
case ACTIONID_PARAM_WRITE_OK: |
success_msg="Parameter Write OK"; |
chg_state(STATEID_SUCCESS_MSG); |
break; |
case ACTIONID_HORIZON: |
chg_state(STATEID_HORIZON); |
break; |
|
case ACTIONID_RENAME_PARAMS: |
act_input_str=mk.params.getParamName(mk.params.act_paramset); |
ipinput_pos=0; |
chg_state(STATEID_STRINGINPUT); |
break; |
|
|
case ACTIONID_BACK_TO_CONNDETAILS: |
chg_state(STATEID_CONN_DETAILS); |
break; |
|
case ACTIONID_RESET_PARAMS: |
chg_state(STATEID_RESET_PARAMS); |
// state=STATEID_FLASHING; |
|
break; |
|
case ACTIONID_FLASH: |
chg_state(STATEID_FLASHING); |
break; |
|
case ACTIONID_DATABUFF: |
chg_state(STATEID_DATABUFF); |
break; |
|
case ACTIONID_NC_ERRORS: |
chg_state(STATEID_ERROR_MSG); |
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: |
chg_state(STATEID_EDIT_PARAMS); |
break; |
case ACTIONID_SELECT_PARAMS: |
select_paramset4edit=true; |
if (settings.reload_settings) |
{ |
|
|
mk.watchdog.act_paramset=0; |
mk.params.reset(); |
chg_state(STATEID_READ_PARAMS); |
} |
else |
{ |
if (mk.watchdog.act_paramset!=5) |
chg_state(STATEID_READ_PARAMS); |
else |
chg_state(STATEID_SELECT_PARAMSET); |
} |
break; |
|
|
case ACTIONID_WRITE_PARAM_AS: |
select_paramset4edit=false; |
chg_state(STATEID_SELECT_PARAMSET); |
break; |
|
case ACTIONID_WRITE_PARAMS: |
mk.write_params(mk.params.act_paramset); |
success_msg="Saved Settings"; // too optimistic |
nextstate=STATEID_HANDLE_PARAMS; |
chg_state(STATEID_SUCCESS_MSG); |
break; |
|
case ACTIONID_UNDO_PARAMS: |
mk.params.use_backup(); |
success_msg="Settings Undo OK"; // too optimistic |
nextstate=STATEID_HANDLE_PARAMS; |
chg_state(STATEID_SUCCESS_MSG); |
|
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 (act_menu_select==5) // back |
{ |
if (select_paramset4edit) |
chg_state(STATEID_PARAM_MENU); |
else |
chg_state(STATEID_HANDLE_PARAMS); |
|
} |
else |
{ |
if (select_paramset4edit) |
// if ( mk.params.field[act_menu_select]!=null) |
{ |
mk.params.act_paramset=act_menu_select; |
chg_state(STATEID_HANDLE_PARAMS); |
//success_msg="Params saved"; |
} |
else |
{ |
mk.write_params(act_menu_select); |
nextstate=STATEID_HANDLE_PARAMS; |
success_msg="saved in slot " + (act_menu_select+1) ; |
chg_state(STATEID_SUCCESS_MSG); // TODO - ground too optimistic way ;-) |
} |
|
} |
} |
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; |
} |
|
|
|
} |
|
|
|
|
|
|
|
|
} |
|
|