18,12 → 18,16 |
implements Runnable |
{ |
|
private final static String RECORD_STORE_NAME="bluetoothurl"; |
|
private BTSearcher bt_scanner; |
private MKCommunicator mk=null; |
public MKCommunicator mk=null; |
private MKStatistics mk_stat=null; |
private MKParamsEditor params_editor=null; |
|
|
private String err=""; |
private MKMiniMidlet root; |
private DUBwise root; |
|
private Image bg_img; |
private Image bt_img; |
37,6 → 41,8 |
public int[] accnick_line_pos_data; |
public int[] accroll_line_pos_data; |
|
public int lcd_char_width=0; |
public int lcd_char_height=0; |
|
public int frame_pos=0; |
|
44,13 → 50,90 |
|
public int line_middle_y; |
|
public MKMiniCanvas(MKMiniMidlet _root) |
boolean quit=false; |
boolean rescan=true; |
int bg_offset=0; |
|
public int state=-1; |
|
|
|
public final static int STATEID_SCANNING=0; |
public final static int STATEID_DEVICESELECT=1; |
public final static int STATEID_MAINMENU=2; |
public final static int STATEID_MOTORTEST=3; |
public final static int STATEID_SELECT_PARAMSET=4; |
public final static int STATEID_EDIT_PARAMS=5; |
public final static int STATEID_FLIGHTVIEW=6; |
|
|
int local_max=-1; |
|
int y_off=0; |
int spacer=0; |
int[] motor_test = {0,0,0,0}; |
|
|
String[] menu_items; |
int act_menu_select=0; |
|
String[] lcd_lines =null; |
|
public void paint_menu(Graphics g) |
{ |
for ( int i=0;i<menu_items.length;i++) |
lcd_lines[i]=(act_menu_select==i?"# ":" ") + menu_items[i]; |
paint_lcd(g,true); |
} |
|
public void menu_keypress(int keyCode) |
{ |
switch (getGameAction (keyCode)) |
{ |
case UP: |
if (act_menu_select!=0) act_menu_select--; |
break; |
|
case DOWN: |
if (act_menu_select<(menu_items.length-1)) act_menu_select++; |
break; |
|
} |
|
} |
|
|
|
public void paint_lcd(Graphics g,boolean bottomup) |
{ |
int y; |
|
for(int i=0;i<lcd_lines.length;i++) |
for (int pos=0;pos<20;pos++) |
{ |
if (bottomup) |
y=this.getHeight()-(lcd_lines.length-i)*lcd_char_height; |
else |
y=i*lcd_char_height; |
g.setClip((lcd_img.getWidth()/222)*pos,y,(lcd_img.getWidth()/222),lcd_img.getHeight()); |
g.drawImage(lcd_img,(lcd_img.getWidth()/222)*pos-((pos<lcd_lines[i].length()?lcd_lines[i].charAt(pos):' ')-' ')*(lcd_img.getWidth()/222),y,g.TOP | g.LEFT); |
|
} |
} |
|
public MKMiniCanvas(DUBwise _root) |
{ |
|
root=_root; |
|
bt_scanner = new BTSearcher(); |
params_editor = new MKParamsEditor(this); |
mk = new MKCommunicator(); |
mk_stat= new MKStatistics(mk); |
|
try |
{ |
// load all needed images |
lcd_img=Image.createImage("/lcd.png"); |
bt_img=Image.createImage("/bt.png"); |
bg_img=Image.createImage("/bg.jpg"); |
60,6 → 143,9 |
{ |
err+=e.toString(); |
} |
|
lcd_char_width=lcd_img.getWidth()/222; |
lcd_char_height=lcd_img.getHeight(); |
|
|
nick_line_pos_data=new int[bg_img.getWidth()]; |
76,21 → 162,26 |
} |
|
|
// mk = new MKCommunicator("btspp://000BCE016B5B:1"); |
//connect_mk("btspp://000BCE016B4F:1"); |
|
|
try |
{ |
RecordStore recStore = RecordStore.openRecordStore("bturl", true ); |
RecordStore recStore = RecordStore.openRecordStore(RECORD_STORE_NAME , true ); |
|
if (recStore.getNumRecords()==1) |
if (recStore.getNumRecords()==2) |
{ |
byte[] recData = new byte[recStore.getRecordSize(1)]; |
int len = recStore.getRecord(1, recData, 0); |
rescan=false; |
connect_mk(new String(recData, 0, len)); |
|
//byte[] recData = new byte[recStore.getRecordSize(1)]; |
//int len = recStore.getRecord(1, recData, 0); |
|
//byte[] recData2 = new byte[recStore.getRecordSize(2)]; |
//int len2 = recStore.getRecord(2, recData, 0); |
|
byte[] url_data=recStore.getRecord(1); |
byte[] name_data=recStore.getRecord(2); |
|
connect_mk(new String(url_data, 0, url_data.length),new String(name_data, 0, name_data.length)); |
|
} |
recStore.closeRecordStore(); |
} |
catch (Exception e) |
{ |
97,24 → 188,22 |
err+=e.toString(); |
} |
|
if (mk==null) bt_scanner = new BTSearcher(); |
|
chg_state((mk.force_disconnect)?STATEID_SCANNING:STATEID_MAINMENU); |
|
|
|
new Thread(this).start(); |
|
} |
|
boolean quit=false; |
boolean rescan=true; |
int bg_offset=0; |
|
|
|
|
/********************************************************** Thread ***********************************************************/ |
/****************************** Thread ******************/ |
// ticking runnable Section |
public void run() |
{ |
|
|
while(true) |
{ |
repaint(); |
126,8 → 215,6 |
|
frame_pos++; |
|
|
|
switch(state) |
{ |
case STATEID_MOTORTEST: |
146,6 → 233,15 |
|
mk.motor_test(motor_test); |
break; |
|
case STATEID_SCANNING: |
if (!bt_scanner.searching) |
chg_state(STATEID_DEVICESELECT); |
|
break; |
|
|
|
} |
|
try { |
169,12 → 265,11 |
|
try |
{ |
RecordStore recStore = RecordStore.openRecordStore("bturl", true ); |
|
if (recStore.getNumRecords()==1) |
recStore.deleteRecord(1); |
byte[] rec = mk.mk_url.getBytes(); |
recStore.addRecord(rec, 0, rec.length); |
RecordStore.deleteRecordStore(RECORD_STORE_NAME); |
RecordStore recStore = RecordStore.openRecordStore(RECORD_STORE_NAME, true ); |
recStore.addRecord(mk.mk_url.getBytes(), 0, mk.mk_url.getBytes().length); |
recStore.addRecord(mk.name.getBytes(), 0, mk.name.getBytes().length); |
recStore.closeRecordStore(); |
|
} |
catch (Exception e) |
186,13 → 281,12 |
} |
if (rescan) |
{ |
if (mk!=null) mk.close_connections(true); |
mk=null; |
bt_scanner.search_again(); |
|
rescan=false; |
} |
|
try { |
rescan=false; |
//rescan=false; |
bg_offset--; |
if (bg_offset==-bg_img.getWidth()) |
bg_offset=0; |
228,18 → 322,11 |
|
|
|
public int state=-1; |
|
public final static int STATEID_MOTORTEST=2; |
|
|
int local_max=-1; |
|
int[] motor_test = {0,0,0,0}; |
|
// drawing section |
public void paint(Graphics g) { |
|
y_off=0; |
try { |
|
if (mk!=null) |
255,7 → 342,7 |
local_max=Math.abs(mk.debug_data.accroll()); |
line_scaler= local_max/(this.getHeight()/2)+1; |
} |
int spacer=(g.getFont().getHeight()); |
spacer=(g.getFont().getHeight()); |
g.setColor(0xFFFFFF); |
g.fillRect(0,0,this.getWidth(),this.getHeight()); |
g.drawImage(bg_img,bg_offset,0, g.TOP | g.LEFT); |
264,8 → 351,8 |
g.drawImage(bg_img,bg_offset+bg_img.getWidth(),0, g.TOP | g.LEFT); |
|
|
g.setColor(0x000000); |
|
|
switch(state) |
{ |
case STATEID_MOTORTEST: |
279,67 → 366,73 |
} |
break; |
|
default: |
g.setColor(0x000000); |
|
if (mk==null) |
{ |
case STATEID_EDIT_PARAMS: |
params_editor.paint(g); |
break; |
|
case STATEID_SCANNING: |
paint_lcd(g,true); |
|
g.setClip(this.getWidth()/2-load_img.getWidth()/6,this.getHeight()/2-load_img.getHeight()/8, load_img.getWidth()/4,load_img.getHeight()/3);; |
g.drawImage(load_img,this.getWidth()/2-load_img.getWidth()/8 - ((((frame_pos/3)%12)%4)*(load_img.getWidth()/4)) ,this.getHeight()/2-load_img.getHeight()/6- ((((frame_pos/3)%12)/4)*(load_img.getHeight()/3)), g.TOP | g.LEFT); |
g.drawImage(bt_img,this.getWidth()/2 ,this.getHeight()/2 , g.HCENTER | g.VCENTER); |
break; |
|
if (bt_scanner.searching) |
{ |
case STATEID_MAINMENU: |
g.drawString("MK-Connection(" + (mk.connected?("open"+((System.currentTimeMillis()- mk.connection_start_time)/1000)+"s"):"close")+"):",0,y_off,Graphics.TOP | Graphics.LEFT); |
y_off+=spacer; |
g.drawString(" Name:" + mk.name,0,y_off,Graphics.TOP | Graphics.LEFT); |
y_off+=spacer; |
g.drawString(" URL:" + mk.mk_url,0,y_off,Graphics.TOP | Graphics.LEFT); |
y_off+=spacer; |
g.drawString(" Version:" + mk.version.str,0,y_off,Graphics.TOP | Graphics.LEFT); |
y_off+=spacer; |
g.drawString("Packet Traffic:",0,y_off,Graphics.TOP | Graphics.LEFT); |
y_off+=spacer; |
g.drawString( " debug:"+mk.debug_data_count+ " LCD:" + mk.lcd_data_count + " vers:" + mk.version_data_count,0,y_off,Graphics.TOP | Graphics.LEFT); |
y_off+=spacer; |
g.drawString( " other:"+mk.other_data_count+" params:"+mk.params_data_count,0,y_off,Graphics.TOP | Graphics.LEFT); |
|
|
g.drawString("scanning for BT-Devices",this.getWidth()/2,this.getHeight()/2+load_img.getHeight()/8,Graphics.TOP | Graphics.HCENTER); |
|
g.setClip(this.getWidth()/2-load_img.getWidth()/6,this.getHeight()/2-load_img.getHeight()/8, load_img.getWidth()/4,load_img.getHeight()/3);; |
g.drawImage(load_img,this.getWidth()/2-load_img.getWidth()/8 - ((((frame_pos/3)%12)%4)*(load_img.getWidth()/4)) ,this.getHeight()/2-load_img.getHeight()/6- ((((frame_pos/3)%12)/4)*(load_img.getHeight()/3)), g.TOP | g.LEFT); |
g.drawImage(bt_img,this.getWidth()/2 ,this.getHeight()/2 , g.HCENTER | g.VCENTER); |
} |
else |
{ |
g.drawString("Press key 0-"+(bt_scanner.remote_device_count-1) + " to continue" ,0,0,Graphics.TOP | Graphics.LEFT); |
for (int i=0;i<bt_scanner.remote_device_count;i++) |
g.drawString("#"+i+">" + bt_scanner.remote_device_name[i]+"("+bt_scanner.remote_device_mac[i]+")",0,spacer+spacer*i,Graphics.TOP | Graphics.LEFT); |
|
} |
|
|
// falltru wanted |
case STATEID_SELECT_PARAMSET: |
|
case STATEID_DEVICESELECT: |
paint_menu(g); |
break; |
|
case STATEID_FLIGHTVIEW: |
|
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; |
|
} |
else // MK is connected |
{ |
int y_off=0; |
|
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+")",0,y_off,Graphics.TOP | Graphics.LEFT); |
|
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("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); |
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); |
} |
|
|
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=this.getHeight()-4*lcd_img.getHeight(); |
|
for ( int foo=0;foo<4;foo++) |
y_off=this.getHeight()-4*lcd_img.getHeight(); |
|
for ( int foo=0;foo<4;foo++) |
{ |
for (int x=0;x<20;x++) |
{ |
for (int x=0;x<20;x++) |
{ |
g.setClip((lcd_img.getWidth()/222)*x,y_off,(lcd_img.getWidth()/222),lcd_img.getHeight()); |
g.setClip((lcd_img.getWidth()/222)*x,y_off,(lcd_img.getWidth()/222),lcd_img.getHeight()); |
g.drawImage(lcd_img,(lcd_img.getWidth()/222)*x-(mk.LCD.LCD_str[foo].charAt(x)-' ')*(lcd_img.getWidth()/222),y_off, g.TOP | g.LEFT); |
|
} |
351,7 → 444,7 |
|
|
|
} |
|
// draw lines |
|
for ( int x=0;x<this.getWidth();x++) |
378,13 → 471,14 |
|
} |
|
|
|
} catch (Exception e) {} |
} |
|
private void connect_mk(String url) |
private void connect_mk(String url,String name) |
{ |
mk = new MKCommunicator(url); |
mk_stat= new MKStatistics(mk); |
mk.connect_to(url,name); |
|
} |
|
404,9 → 498,49 |
public int act_motor_increase=0; |
public boolean motor_test_sel_all=false; |
|
public void chg_state(int _state) |
public String[] main_menu_items={"Telemetry" , "Motor Test" , "Flight Settings","(NA)Tool Settings","Change Device" , "Quit " }; |
public void chg_state(int next_state) |
{ |
state=_state; |
act_menu_select=0; |
// prepare next state |
switch(next_state) |
{ |
case STATEID_SCANNING: |
lcd_lines=new String[3]; |
lcd_lines[0]="Scanning for Devices"; |
lcd_lines[1]=" "; |
lcd_lines[2]="DUBwise v0.34 "; |
mk.close_connections(true); |
|
bt_scanner.search(); |
break; |
|
case STATEID_SELECT_PARAMSET: |
menu_items=new String[5]; |
menu_items[0]="ParamSet No 1"; |
menu_items[1]="ParamSet No 2"; |
menu_items[2]="ParamSet No 3"; |
menu_items[3]="ParamSet No 4"; |
menu_items[4]="ParamSet No 5"; |
lcd_lines=new String[5]; |
break; |
|
case STATEID_DEVICESELECT: |
menu_items=new String[bt_scanner.remote_device_count]; |
for (int i=0;i<bt_scanner.remote_device_count;i++) |
menu_items[i]=bt_scanner.remote_device_name[i]; |
lcd_lines=new String[bt_scanner.remote_device_count]; |
break; |
|
case STATEID_MAINMENU: |
menu_items=main_menu_items; |
lcd_lines=new String[menu_items.length]; |
break; |
|
} |
|
// switch state |
state=next_state; |
} |
|
|
425,6 → 559,17 |
public void keyPressed(int keyCode) |
{ |
|
if (keyCode==KEY_STAR) |
{ |
chg_state(STATEID_MAINMENU); |
return; |
} |
if (keyCode==KEY_POUND) |
{ |
fullscreen=!fullscreen; |
setFullScreenMode(fullscreen); |
return; |
} |
switch(state) |
{ |
case STATEID_MOTORTEST: |
444,7 → 589,7 |
|
case LEFT: |
act_motor--; |
if (act_motor<0) {act_motor=0; chg_state(-1); } |
if (act_motor<0) {act_motor=0; chg_state(STATEID_MAINMENU); } |
break; |
|
case RIGHT: |
454,46 → 599,84 |
} |
|
break; |
case STATEID_MAINMENU: |
if ( getGameAction (keyCode)==FIRE ) |
switch(act_menu_select) |
{ |
case 0: |
chg_state(STATEID_FLIGHTVIEW); |
break; |
|
default: |
if ((mk==null)&&(keyCode >= this.KEY_NUM0) && (keyCode < this.KEY_NUM0+bt_scanner.remote_device_count)) |
connect_mk("btspp://"+bt_scanner.remote_device_mac[keyCode-this.KEY_NUM0] + ":1"); |
case 1: |
chg_state(STATEID_MOTORTEST); |
break; |
|
case 2: |
chg_state(STATEID_SELECT_PARAMSET); |
break; |
case 3: |
break; |
|
case 4: |
chg_state(STATEID_SCANNING); |
break; |
|
case 5: |
quit=true; |
break; |
|
} |
else menu_keypress(keyCode); |
break; |
|
case STATEID_SELECT_PARAMSET: |
if ( getGameAction (keyCode)==FIRE ) |
{ |
chg_state(STATEID_EDIT_PARAMS); |
} |
else menu_keypress(keyCode); |
break; |
case STATEID_DEVICESELECT: |
if ((keyCode >= this.KEY_NUM0) && (keyCode < this.KEY_NUM0+bt_scanner.remote_device_count)) |
{ |
connect_mk("btspp://"+bt_scanner.remote_device_mac[keyCode-this.KEY_NUM0] + ":1",bt_scanner.remote_device_name[keyCode-this.KEY_NUM0]); |
chg_state(STATEID_MAINMENU); |
} |
else |
if ( getGameAction (keyCode)==FIRE ) |
{ |
connect_mk("btspp://"+bt_scanner.remote_device_mac[act_menu_select] + ":1",bt_scanner.remote_device_name[act_menu_select]); |
chg_state(STATEID_MAINMENU); |
} |
else menu_keypress(keyCode); |
break; |
|
case STATEID_EDIT_PARAMS: |
params_editor.keypress(keyCode,getGameAction (keyCode)) ; |
break; |
|
case STATEID_FLIGHTVIEW: |
|
switch (getGameAction (keyCode)) |
{ |
switch (keyCode) |
{ |
case UP: |
mk.LCD.LCD_PREVPAGE(); |
break; |
|
case KEY_STAR: |
mk.other_data_count=23; |
quit=true; |
break; |
case DOWN: |
mk.LCD.LCD_NEXTPAGE(); |
break; |
|
case KEY_POUND: |
//rescan=true; |
fullscreen=!fullscreen; |
setFullScreenMode(fullscreen); |
|
break; |
} |
switch (getGameAction (keyCode)) |
{ |
case UP: |
mk.LCD.LCD_PREVPAGE(); |
break; |
case LEFT: |
chg_state(STATEID_MAINMENU); |
break; |
|
case DOWN: |
mk.LCD.LCD_NEXTPAGE(); |
break; |
|
case RIGHT: |
state=STATEID_MOTORTEST; |
break; |
} |
} |
|
break; |
} |
|
|
return; |
|
} |
|
|