/***************************************************************
*
* 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.*;
import javax.microedition.rms.*;
import java.io.*;
public class DUBwiseCanvas
extends Canvas
implements Runnable,org.
ligi.
ufo.
DUBwiseDefinitions , DUBwiseUIDefinitions,org.
ligi.
ufo.
DUBwiseLangDefs
{
public final static int[] param_menu_items=
{STRINGID_EDIT_SETTINGS,STRINGID_COPY_TO_MOBILE,STRINGID_LOAD_FROM_MOBILE,STRINGID_REINITIALIZE_ALL,STRINGID_BACK
};
public final static byte[] param_menu_actions=
{ACTIONID_SELECT_PARAMS,ACTIONID_PARAM_COPY_MOBILE,ACTIONID_PARAM_LOAD_MOBILE,ACTIONID_RESET_PARAMS,ACTIONID_MAINMENU
};
public final static int[] handle_params_menu_items=
{STRINGID_EDIT_CONTENT,STRINGID_RENAME,STRINGID_SAVE_AS,STRINGID_SAVE,STRINGID_REREAD,STRINGID_BACK
};
public final static byte[] handle_params_menu_actions=
{ACTIONID_EDIT_PARAMS,ACTIONID_RENAME_PARAMS,ACTIONID_WRITE_PARAM_AS,ACTIONID_WRITE_PARAMS,ACTIONID_UNDO_PARAMS,ACTIONID_SELECT_PARAMS
};
public final static int[] onlyback_menu_items=
{STRINGID_BACK
};
public final static byte[] back_to_conndetails_actions=
{ACTIONID_BACK_TO_CONNDETAILS
};
//#if fileapi=="on"
DUBwiseFileAccess file_access
;
//#endif
String act_input_str=
" ";
// for dual use of states
boolean select_paramset4edit
;
boolean read_paramset_intension_save
;
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;
public FirmwareLoader fw_loader=
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 int symbols_img_tile_height
;
private int symbols_img_tile_width
;
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;
// to check if 2 keys are pressed
byte keycontrol_exit=
0;
byte setup_pos
;
byte[] tmp_actions
;
String[] tmp_items
;
// boolean expert_mode=false;
byte act_lang=
0;
public String[] localized_strings
;
public String l
(int str_id
)
{
return localized_strings
[str_id
];
}
public void tmp_menu_init
(int max_items
)
{
setup_pos=
0;
tmp_actions=
new byte[max_items
];
tmp_items=
new String[max_items
];
}
public void tmp_menu_add
(String label,
byte action
)
{
tmp_actions
[setup_pos
] = action
;
tmp_items
[setup_pos
] = label
;
setup_pos++
;
}
public void tmp_menu_use
()
{
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_conn_menu
()
{
tmp_menu_init
(7);
tmp_menu_add
(l
(STRINGID_PACKET_TRAFFIC
),ACTIONID_TRAFFIC
);
tmp_menu_add
(l
(STRINGID_VIEW_DATA
),ACTIONID_DATABUFF
);
//#if bluetooth=="on"
tmp_menu_add
(l
(STRINGID_CONNECT_BT
),ACTIONID_SCAN_BT
);
//#endif
tmp_menu_add
(l
(STRINGID_CONNECT_TCP
),ACTIONID_CONNECT_TCP
);
if ((System.
getProperty("microedition.commports")!=
null)&&(!System.
getProperty("microedition.commports").
equals("")))
tmp_menu_add
(l
(STRINGID_CONNECT_COM
),ACTIONID_SELECT_COM
);
tmp_menu_add
(l
(STRINGID_SET_PROXY
),ACTIONID_PROXY_INPUT
);
tmp_menu_add
(l
(STRINGID_BACK
),ACTIONID_MAINMENU
);
tmp_menu_use
();
}
public void setup_main_menu
()
{
tmp_menu_init
(20);
tmp_menu_add
(l
(STRINGID_SETTINGS
),ACTIONID_SETTINGS
);
tmp_menu_add
(l
(STRINGID_CONN
),ACTIONID_CONN_DETAILS
);
tmp_menu_add
(l
(STRINGID_SELECT_FIRMWARE
),ACTIONID_SELECT_FIRMWARE
);
tmp_menu_add
("UPDATE_DUBWISE",ACTIONID_UPDATE_DUBWISE
);
tmp_menu_add
("Phone GPS",ACTIONID_SHOWPHONEGPS
);
if (settings.
expert_mode)
tmp_menu_add
(l
(STRINGID_DEBUG
),ACTIONID_DEBUG
);
if (mk.
ufo_prober.
is_mk())
{
tmp_menu_add
(l
(STRINGID_MOTORTEST
),ACTIONID_MOTORTEST
);
tmp_menu_add
(l
(STRINGID_KEYCONTROL
),ACTIONID_KEYCONTROL
);
tmp_menu_add
(l
(STRINGID_RCDATA
),ACTIONID_RCDATA
);
tmp_menu_add
(l
(STRINGID_FLIGHTSETTINGS
),ACTIONID_PARAM_MENU
);
tmp_menu_add
(l
(STRINGID_HORIZON
),ACTIONID_HORIZON
);
}
if ( mk.
ufo_prober.
is_navi()||mk.
ufo_prober.
is_mk() )
tmp_menu_add
(l
(STRINGID_LCD
),ACTIONID_LCD
);
if ( mk.
ufo_prober.
is_mk() )
tmp_menu_add
(l
(STRINGID_GRAPH
),ACTIONID_GRAPH
);
if (( mk.
ufo_prober.
is_navi()||mk.
ufo_prober.
is_mk()||mk.
ufo_prober.
is_mk3mag() ))
tmp_menu_add
(l
(STRINGID_DEBUG_VALUES
),ACTIONID_RAWDEBUG
);
if ( mk.
ufo_prober.
is_navi())
{
tmp_menu_add
(l
(STRINGID_VIEW_GPS
),ACTIONID_GPSDATA
);
tmp_menu_add
(l
(STRINGID_VIEW_ERRORS
),ACTIONID_NC_ERRORS
);
tmp_menu_add
(l
(STRINGID_SWITCH_FC
),ACTIONID_SWITCH_FC
);
tmp_menu_add
(l
(STRINGID_SWITCH_MK3MAG
),ACTIONID_SWITCH_MK3MAG
);
}
if (mk.
ufo_prober.
is_mk()||mk.
ufo_prober.
is_mk3mag() )
tmp_menu_add
(l
(STRINGID_SWITCH_NAVI
),ACTIONID_SWITCH_NC
);
//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_menu_add
(l
(STRINGID_FLASH_FIRMWARE
),ACTIONID_FLASH
);
if (settings.
expert_mode&& mk.
ufo_prober.
is_mk() )
tmp_menu_add
(l
(STRINGID_REMOTE_CAM
),ACTIONID_CAM
);
if (!settings.
expert_mode)
tmp_menu_add
(l
(STRINGID_ABOUT
),ACTIONID_ABOUT
);
tmp_menu_add
(l
(STRINGID_QUIT
),ACTIONID_QUIT
);
tmp_menu_use
();
}
public void setup_menu
(String[] items ,
byte[] actions
)
{
menu_items=items
;
menu_actions=actions
;
lcd_lines=
new String[menu_items.
length];
}
public void setup_menu
(int[] items ,
byte[] actions
)
{
menu_items=
new String[items.
length];
for(int i=
0;i
<items.
length;i++
)
menu_items
[i
]=l
(items
[i
]);
menu_actions=actions
;
lcd_lines=
new String[menu_items.
length];
}
public void paint_menu
(Graphics g
)
{
if (menu_items==
null) return;
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;
case FIRE:
switch(state
)
{
case STATEID_SELECT_COMPORT:
if (act_menu_select
<menu_items.
length)
connect_mk
("comm:"+menu_items
[act_menu_select
]+
";baudrate=57600",
"com"+act_menu_select
);
chg_state
(STATEID_CONN_DETAILS
);
break;
//#if fileapi=="on"
case STATEID_FILEOPEN:
file_access.
fire();
break;
//#endif
case STATEID_SELECT_PARAMSET:
if (act_menu_select==
5) // back
{
if (select_paramset4edit
)
chg_state
(STATEID_PARAM_MENU
);
else
chg_state
(STATEID_HANDLE_PARAMS
); // from save as
}
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 ;-)
}
}
break;
//#if bluetooth=="on"
case STATEID_DEVICESELECT:
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
);
}
break;
//#endif
default:
if (menu_actions
!=
null)
process_action
(menu_actions
[act_menu_select
]);
}
}
}
public boolean cam_condition
()
{
return (mk.
stick_data.
stick[settings.
remote_cam_stick]>100);
}
// int lcd_top=25;
int lcd_off
;
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);
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");
symbols_img_tile_height=symbols_img.
getHeight()/
2;
symbols_img_tile_width=symbols_img.
getWidth()/
10;
/* if (bg_img!=null)
graph_data=new int[GRAPH_COUNT][bg_img.getWidth()];
else
*/
}
catch (Exception e
)
{
debug.
err(e.
toString());
}
}
public void load_strings
()
{
System.
out.
println("loading strings");
localized_strings=
new String[STRING_COUNT
];
try {
InputStream in=
this.
getClass().
getResourceAsStream("/l");
for (int i=
0;i
<STRING_COUNT
;i++
)
{
System.
out.
println("s"+i
);
String tmp_s=
"";
String tmp_b=
"";
char ch=
0;
int act_l=
0;
while ( (ch=
(char)in.
read())!=
'\n')
{
if (ch==
';')
{
act_l++
;
tmp_s=
"";
}
else
{
if (act_l==
0)
tmp_b+=ch
;
if (act_l==act_lang
)
tmp_s+=ch
;
}
}
if (tmp_s.
equals(""))
localized_strings
[i
]=tmp_b
;
else
localized_strings
[i
]=tmp_s
;
System.
out.
println("s"+localized_strings
[i
]);
}
}
catch (Exception e
) { System.
out.
println("str_load err"+e
);}
}
// construct
public DUBwiseCanvas
(DUBwise _root
)
{
load_strings
();
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++
;
// handle Device Change
if (mk.
ufo_prober.
change_notify)
{
mk.
ufo_prober.
change_notify=
false;
if (mk.
ufo_prober.
is_incompatible())
{
mk.
error_str=l
(STRINGID_INCOMPATIBLEDEVICE
);
chg_state
(STATEID_ERROR_MSG
);
}
else
if (state==STATEID_MAINMENU
)
chg_state
(STATEID_MAINMENU
); // reload mainmenu ( changed content )
}
switch(state
)
{
case STATEID_SHOWPHONEGPS:
try
{
Class.
forName("javax.microedition.location.LocationProvider");
javax.
microedition.
location.
Criteria cr=
new javax.
microedition.
location.
Criteria();
cr.
setHorizontalAccuracy(500);
// Get an instance of the provider
javax.
microedition.
location.
LocationProvider lp= javax.
microedition.
location.
LocationProvider.
getInstance(cr
);
// Request the location, setting a one-minute timeout
javax.
microedition.
location.
Location l = lp.
getLocation(60);
javax.
microedition.
location.
Coordinates c = l.
getQualifiedCoordinates();
/* low crit
Criteria crit2 = new Criteria();
crit2.setHorizontalAccuracy(Criteria.NO_REQUIREMENT);
crit2.setVerticalAccuracy(Criteria.NO_REQUIREMENT);
crit2.setPreferredResponseTime(Criteria.NO_REQUIREMENT);
crit2.setPreferredPowerConsumption(Criteria.POWER_USAGE_HIGH);
crit2.setCostAllowed(false);
crit2.setSpeedAndCourseRequired(false);
crit2.setAltitudeRequired(false);
lp= LocationProvider.getInstance(crit2);
*/
if(c
!=
null ) {
// Use coordinate information
phone_lat= c.
getLatitude();
phone_long = c.
getLongitude();
}
}
catch (Exception e
)
{
mk.
error_str=
"Phone GPS Problem";
chg_state
(STATEID_ERROR_MSG
);
}
break;
case STATEID_SELECT_FIRMWARE:
if ((menu_items.
length==
0)&&(fw_loader.
got_list))
setup_menu
(fw_loader.
names,
null);
break;
case STATEID_RESET_PARAMS:
if (mk.
bootloader_finish_ok)
{
mk.
params.
reset();
mk.
watchdog.
act_paramset=
0;
nextstate=STATEID_PARAM_MENU
;
success_msg=l
(STRINGID_PARAMRESETOK
);
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_PARAM_MASSWRITE:
if (param_masswrite_write_pos==
5)
{
nextstate=STATEID_PARAM_MENU
;
success_msg=l
(STRINGID_PARAMWRITEOK
);
chg_state
(STATEID_SUCCESS_MSG
);
}
else
{
if (param_masswrite_write_pos
!=
0)
try { Thread.
sleep(2000); }
catch (Exception e
)
{debug.
log("Problem Sleeping "); }
lcd_lines
[0]=l
(STRINGID_WRITINGPARAMS
);
lcd_lines
[1]=DUBwiseHelper.
pound_progress(param_masswrite_write_pos,
5);
mk.
params.
set_by_mk_data(params2masswrite
[param_masswrite_write_pos
]);
mk.
params.
act_paramset=param_masswrite_write_pos
;
mk.
write_params(mk.
params.
act_paramset);
param_masswrite_write_pos++
;
}
break;
case STATEID_READ_PARAMS:
if (mk.
watchdog.
act_paramset==
5)
{
if (read_paramset_intension_save
)
{
try
{
RecordStore.
deleteRecordStore( PARAM_SAVE_STORE_NAME
);
}
catch (Exception e
)
{ }
try {
RecordStore recStore = RecordStore.
openRecordStore( PARAM_SAVE_STORE_NAME,
true );
ByteArrayOutputStream bout =
new ByteArrayOutputStream();
DataOutputStream dout =
new DataOutputStream( bout
);
// params_version
dout.
writeInt(mk.
params.
params_version);
// params_length
dout.
writeInt(mk.
params.
field_bak[0].
length);
for (int p=
0;p
<5;p++
)
for (int i=
0;i
<mk.
params.
field_bak[0].
length;i++
)
dout.
writeInt(mk.
params.
field_bak[p
][i
]);
recStore.
addRecord(bout.
toByteArray(),
0,bout.
size());
recStore.
closeRecordStore();
}
catch (Exception e
)
{ }
// chg_state(STATEID_COPY_PARAMS);
nextstate=STATEID_PARAM_MENU
;
success_msg=
"Parameter Copy OK";
chg_state
(STATEID_SUCCESS_MSG
);
}
else
{
select_paramset4edit=
true;
chg_state
(STATEID_SELECT_PARAMSET
);
}
}
else
{
lcd_lines
[0]=
"Reading Settings ";
lcd_lines
[1]=DUBwiseHelper.
pound_progress(mk.
watchdog.
act_paramset,
5);
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 {
Class.
forName("com.nokia.mid.ui.DeviceControl");
if (settings.
keep_lighton) com.
nokia.
mid.
ui.
DeviceControl.
setLights(0,
100);
}
catch (Exception e
) { }
//#endif
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 BG_COLOR_SKIN_DARK
;
default:
case SKINID_LIGHT:
return BG_COLOR_SKIN_LIGHT
;
}
}
public int skin_fg_color
()
{
switch (settings.
act_skin)
{
case SKINID_DARK:
return FG_COLOR_SKIN_DARK
;
default:
case SKINID_LIGHT:
return FG_COLOR_SKIN_LIGHT
;
}
}
public int check_local_max
(int val
)
{
if ( val
>local_max
)
local_max=val
;
else if (-val
>local_max
)
local_max=-val
;
return val
;
}
public void symbol_paint
(Graphics g,
int x,
int tile,
int row
)
{
g.
setClip(x,
0,
(symbols_img_tile_width
),symbols_img_tile_height
);;
g.
drawImage(symbols_img,x+
(-tile
)*(symbols_img_tile_width
),row
*(-symbols_img_tile_height
), g.
TOP | g.
LEFT);
}
// drawing sections
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(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);
}
else
{
g.
setColor(0xdedfff
);
g.
fillRect(0,
0,canvas_width,symbols_img_tile_height
);
g.
setColor(skin_bg_color
());
g.
fillRect(0,symbols_img_tile_height,canvas_width,canvas_height-symbols_img_tile_height
);
}
//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_tile_width
),
0,
(symbols_img_tile_width
),symbols_img_tile_height
);;
g.
drawImage(symbols_img,bar
*(symbols_img_tile_width
),
0, g.
TOP | g.
LEFT);
}
int symbol_left=
0;
int symbol_spacer=
5;
g.
setClip(symbol_left,
0,symbols_img_tile_width,symbols_img_tile_height
);;
if (mk.
connected)
symbol_paint
(g,symbol_left,
(((mk.
stats.
bytes_in>>3)&1)==
1)?2:
3,
0);
else
{
if (mk.
mk_url.
startsWith("btspp://"))
symbol_paint
(g,symbol_left,
1,
0);
}
// g.drawImage(symbols_img,(-1)*(symbols_img.getWidth()/10),0, g.TOP | g.LEFT);
symbol_left+=
6*(symbols_img_tile_width
)/
4;
if ((mk.
ufo_prober.
is_navi()||mk.
ufo_prober.
is_mk()))
{
symbol_paint
(g,symbol_left,
4,
0);
symbol_left+=
5 *(symbols_img_tile_width
)/
4;
if ((mk.
UBatt()/
100)!=
0)
{
symbol_paint
(g,symbol_left,
(mk.
UBatt()/
100),
1);
symbol_left+=
(symbols_img_tile_width
);
}
symbol_paint
(g,symbol_left,
(mk.
UBatt()/
10)%10,
1);
symbol_left+=
(2*symbols_img_tile_width/
3);
symbol_paint
(g,symbol_left,
9,
0);
symbol_left+=
(2*symbols_img_tile_width/
3);
symbol_paint
(g,symbol_left,
(mk.
UBatt())%10,
1);
symbol_left+=
6*(symbols_img_tile_width
)/
4;
// g.drawString("" + (mk.UBatt()/10) + "," +(mk.UBatt()%10)+"V" , symbol_left,y_off,Graphics.TOP | Graphics.LEFT);
//symbol_left+= g.getFont().stringWidth("88,8V");//;
/*
symbol_paint(g,symbol_left,6,0);
symbol_left+=5*(symbols_img_tile_width)/4;
*/
if (mk.
SenderOkay()>0)
{
symbol_paint
(g,symbol_left,
6,
0);
symbol_left+=
5*(symbols_img_tile_width
)/
4;
/*symbol_paint(g,symbol_left,(mk.SenderOkay())/100,1);
symbol_left+=(symbols_img_tile_width);
symbol_paint(g,symbol_left,(mk.SenderOkay()/10)%10,1);
symbol_left+=(symbols_img_tile_width);*/
}
// symbol_paint(g,symbol_left,(mk.SenderOkay())%10,1);
//symbol_left+=6*(symbols_img_tile_width)/4;
// 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())
{
symbol_paint
(g,symbol_left,
5,
0);
symbol_left+=
5*(symbols_img_tile_width
)/
4;
symbol_paint
(g,symbol_left,
(mk.
gps_position.
SatsInUse)%10,
1);
symbol_left+=
6*(symbols_img_tile_width
)/
4;
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);
}
}
// unclip
g.
setClip(0,
0,canvas_width,canvas_height
);
y_off+=symbols_img_tile_height
;
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
);
int lines2paint=
(((canvas_height-y_off
)/spacer1
));
y_off=canvas_height-spacer1
;
for (int pos_y=
0;pos_y
<lines2paint
;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+
"(" + l
(mk.
params.
stick_stringids[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);
}
g.
setColor(skin_fg_color
());
g.
drawString(""+mk.
debug_data.
analog[2]+
"<->"+mk.
debug_data.
analog[3] ,
0,canvas_height-
30,
Graphics.
TOP |
Graphics.
LEFT);
break;
case STATEID_EDIT_PARAMS:
params_editor.
paint(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_SHOWPHONEGPS:
y_off+=spacer
;
g.
drawString("lat" + phone_lat ,
0,y_off,
Graphics.
TOP |
Graphics.
LEFT);
y_off+=spacer
;
g.
drawString("long" + phone_long ,
0,y_off,
Graphics.
TOP |
Graphics.
LEFT);
break;
case STATEID_SELECT_FIRMWARE:
case STATEID_SELECT_COMPORT:
case STATEID_PARAM_MENU:
paint_menu
(g
);
break;
case STATEID_STRINGINPUT:
case STATEID_ABOUT:
case STATEID_IPINPUT:
case STATEID_PARAM_MASSWRITE:
case STATEID_READ_PARAMS:
//#if bluetooth=="on"
case STATEID_SCANNING:
//#endif
paint_lcd
(g
);
break;
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(l
(STRINGID_CONN
)+
":",
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(" Software Version:" + mk.
version.
version_str ,
0,y_off,
Graphics.
TOP |
Graphics.
LEFT);
y_off+=spacer1
;
g.
drawString(" Protocol Version:" + mk.
version.
proto_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);
y_off+=spacer1
;
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_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_LCD:
/*
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_COPY_PARAMS:
//break;
case STATEID_SELECT_FIRMWARE:
fw_loader=
new FirmwareLoader
();
setup_menu
(new String[0],
new byte[0]);
break;
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_LCD:
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=DUBwiseHelper.
split_str(System.
getProperty("microedition.commports")+
",back",
",");
setup_menu
(menu_items,
null);
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_conn_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_PARAM_MASSWRITE:
mk.
user_intent=USER_INTENT_PARAMS
;
lcd_lines=
new String[2];
lcd_lines
[0]=
"";
lcd_lines
[1]=
"";
break;
case STATEID_READ_PARAMS:
mk.
user_intent=USER_INTENT_PARAMS
;
lcd_lines=
new String[2];
lcd_lines
[0]=
"Reading Settings ";
lcd_lines
[1]=DUBwiseHelper.
pound_progress(mk.
watchdog.
act_paramset,
5);
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:
setup_menu
(handle_params_menu_items,handle_params_menu_actions
);
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]=l
(STRINGID_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;
}
}
public final static String PARAM_SAVE_STORE_NAME=
"MKParamsV1";
int[][] params2masswrite
;
int param_masswrite_write_pos
;
double phone_lat=
0.0;
double phone_long=
0.0;
public void process_action
(byte actionid
)
{
switch(actionid
)
{
case ACTIONID_UPDATE_DUBWISE:
try
{
root.
platformRequest("http://mikrocontroller.cco-ev.de/mikrosvn/Projects/DUBwise/trunk/j2me/bin/240x320/cldc11/en_speedy/bluetooth_on/fileapi_on/devicecontrol_on/DUBwise-240x320-cldc11-en_speedy-all_firmwares-bluetooth_on-fileapi_on-devicecontrol_on.jad");
}
catch(Exception e
) { }
break;
case ACTIONID_SHOWPHONEGPS:
chg_state
(STATEID_SHOWPHONEGPS
);
break;
case ACTIONID_PARAM_LOAD_MOBILE:
try
{
RecordStore recStore = RecordStore.
openRecordStore(PARAM_SAVE_STORE_NAME ,
true );
if (recStore.
getNumRecords()==
1)
{
ByteArrayInputStream bin =
new ByteArrayInputStream(recStore.
getRecord(1));
DataInputStream din =
new DataInputStream( bin
);
// params_version
if ( mk.
params.
params_version!=din.
readInt())
{
mk.
error_str=l
(STRINGID_PARAMSINCOMPATIBLE
);
chg_state
(STATEID_ERROR_MSG
);
break;
}
int p_length=din.
readInt();
params2masswrite=
new int[5][p_length
];
for ( int p=
0;p
<5;p++
)
for ( int p_pos=
0;p_pos
<p_length
;p_pos++
)
params2masswrite
[p
][p_pos
]=din.
readInt();
param_masswrite_write_pos=
0;
chg_state
(STATEID_PARAM_MASSWRITE
);
}
else throw(new Exception("rms err"));
recStore.
closeRecordStore();
}
catch (Exception e
)
{
mk.
error_str=l
(STRINGID_NOPARAMSONMOBILE
);
chg_state
(STATEID_ERROR_MSG
);
}
break;
case ACTIONID_SELECT_FIRMWARE:
chg_state
(STATEID_SELECT_FIRMWARE
);
break;
case ACTIONID_PARAM_COPY_MOBILE:
read_paramset_intension_save=
true;
chg_state
(STATEID_READ_PARAMS
);
break;
case ACTIONID_PARAM_MENU:
chg_state
(STATEID_PARAM_MENU
);
break;
case ACTIONID_PARAM_WRITE_OK:
success_msg=l
(STRINGID_PARAMWRITEOK
);
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_LCD
);
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;
read_paramset_intension_save=
false;
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=l
(STRINGID_SAVEDSETTINGS
); // too optimistic
nextstate=STATEID_HANDLE_PARAMS
;
chg_state
(STATEID_SUCCESS_MSG
);
break;
case ACTIONID_UNDO_PARAMS:
mk.
params.
use_backup();
success_msg=l
(STRINGID_SETTINGSUNDOOK
); // 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;
}
}
public void pointerPressed
(int pointer_x,
int pointer_y
)
{
if (pointer_y
<lcd_img.
getHeight())
keyPressed
(KEY_STAR
);
else
if (pointer_y
>canvas_height-lcd_img.
getHeight()*lcd_lines.
length)
switch(state
)
{
case STATEID_SETTINGSMENU:
settings_editor.
pointer_press(pointer_x,
(pointer_y-
(canvas_height-lcd_img.
getHeight()*lcd_lines.
length))/lcd_img.
getHeight()) ;
break;
case STATEID_EDIT_PARAMS:
params_editor.
pointer_press(pointer_x,
(pointer_y-
(canvas_height-lcd_img.
getHeight()*lcd_lines.
length))/lcd_img.
getHeight()) ;
break;
case STATEID_LCD:
if (pointer_x
<(canvas_width/
2))
keyPressed
(getKeyCode
(LEFT
));
else
keyPressed
(getKeyCode
(RIGHT
));
break;
case STATEID_PARAM_MENU:
case STATEID_CONN_DETAILS:
case STATEID_HANDLE_PARAMS:
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)
// {
if (lcd_lines.
length>max_lines
)
act_menu_select=
(pointer_y-
(canvas_height-lcd_img.
getHeight()*max_lines
))/lcd_img.
getHeight() +lcd_off
;
else
act_menu_select=
(pointer_y-
(canvas_height-lcd_img.
getHeight()*lcd_lines.
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_HANDLsE_PARAMS:
menu_keypress(keyCode);
break;
*/
/*
case STATEID_TRAFFIC:
if ( getGameAction (keyCode)==FIRE )
chg_state(STATEID_CONN_DETAILS);
else
menu_keypress(keyCode);
break;
*/
case STATEID_MAINMENU:
case STATEID_SELECT_PARAMSET:
case STATEID_SELECT_COMPORT:
case STATEID_PARAM_MENU:
case STATEID_TRAFFIC:
case STATEID_CONN_DETAILS:
case STATEID_HANDLE_PARAMS:
//#if bluetooth=="on"
case STATEID_DEVICESELECT:
//#endif
//#if fileapi=="on"
case STATEID_FILEOPEN:
//#endif
menu_keypress
(keyCode
);
break;
case STATEID_SETTINGSMENU:
settings_editor.
keypress(keyCode,getGameAction
(keyCode
)) ;
break;
// handle menue
// case STATEID_SELECT_SPEED_FORMAT:
// case STATEID_SELECT_GPS_FORMAT:
case STATEID_EDIT_PARAMS:
params_editor.
keypress(keyCode,getGameAction
(keyCode
)) ;
break;
case STATEID_LCD:
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;
}
}
}