Subversion Repositories FlightCtrl

Compare Revisions

Ignore whitespace Rev 302 → Rev 303

/branches/ligi_j2me/src/MKMiniCanvas.java
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;
 
}