WebSVN - Projects - Rev 227 - /DUBwise/trunk/j2me/src/DUBwiseCanvas.java

/***************************************************************
*
* 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"
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 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;

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() ))
{
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";
}

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();
settings = new DUBwiseSettings(this);
settings.load();
load_global_images();
debug = new DUBwiseDebug(this);

//#if bluetooth=="on"
bt_scanner = new BTSearcher();
//#endif

//#if voice_mode!="no_voice"
status_voice=new MKStatusVoice(mk,this);
//#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)
{
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();

line_middle_y=canvas_height/2;

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();
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);

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++)
{

// !!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/(canvas_height/2)+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];
// 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_STRINGINPUT))
{
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)||(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 (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;
}

}

}

Subversion Repositories Projects

(root)/DUBwise/trunk/j2me/src/DUBwiseCanvas.java - Rev 227