WebSVN - FlightCtrl - Diff - Rev 325 and 390 - /branches/ligi


/***************************************************************
 *
 * minimal canvas to test Abstraction layer on various Phones
 *                                                          
 * Author:        Marcus -LiGi- Bueschleb                    
 * Project-Start: 9/2007                                    
 * Mailto:        ligi@smart4mobile.de                      
 * Licence:       Creative Commons / Non Commercial
 *                ( see README for exact terms of usage)
 * Big Up:        Holger&Ingo                                
 ***************************************************************/
 
import javax.microedition.lcdui.*;
import javax.microedition.rms.*;
 
 
public class MKMiniCanvas
    extends Canvas
    implements Runnable
{
 
    // name/handle for the recordStore to memorize some stuff
    private final static String RECORD_STORE_NAME="bluetoothurl";
   
    private BTSearcher bt_scanner;
    public MKCommunicator mk=null;
    private MKStatistics mk_stat=null;
    private MKParamsEditor params_editor=null;
 
 
    private String err="";
    private DUBwise root;
 
    private Image bg_img;
    private Image bt_img;
    private Image lcd_img;
    private Image load_img;
 
 
    public int[] nick_line_pos_data;
    public int[] roll_line_pos_data;
 
    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;
   
    int line_scaler=20;
 
    public int line_middle_y;
 
    boolean quit=false;
    boolean rescan=true;
    int bg_offset=0;
 
    // variable to hold the current state
 
    public int state=-1;
 
 
    // id  for each state - must just be uniq - order isnt important
    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_HANDLE_PARAMS    =6;
    public final static int STATEID_FLIGHTVIEW       =7;
 
 
    public boolean fullscreen=false;
    public int act_motor=0;
    public int act_motor_increase=0;
    public boolean motor_test_sel_all=false;
 
    public String[] main_menu_items={"Telemetry" , "Motor Test" , "Flight Settings","(NA)Tool Settings","Proxy","Change Device" , "Quit " };
    public final static int MAINMENU_TELEMETRY     =0;
    public final static int MAINMENU_MOTORTES      =1;
    public final static int MAINMENU_PARAMS        =2;
    public final static int MAINMENU_SETTINGS      =3;
    public final static int MAINMENU_PROXY         =4;
    public final static int MAINMENU_DEVICESELECT  =5;
    public final static int MAINMENU_QUIT          =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--;
                else
                    act_menu_select=menu_items.length-1;
                break;
               
            case DOWN:
                if (act_menu_select<(menu_items.length-1)) act_menu_select++;
                else act_menu_select=0;
                break;
       
            }
 
    }
 
 
 
    public 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");               
                load_img=Image.createImage("/load.png");
            }
        catch (Exception e)
            {
                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()];
        roll_line_pos_data=new int[bg_img.getWidth()];
        accnick_line_pos_data=new int[bg_img.getWidth()];
        accroll_line_pos_data=new int[bg_img.getWidth()];
           
        for (int c=0;c<bg_img.getWidth();c++)
            {
                nick_line_pos_data[c]=-1;
                roll_line_pos_data[c]=-1;
                accnick_line_pos_data[c]=-1;
                accroll_line_pos_data[c]=-1;
            }
           
       
        try
            {
                RecordStore recStore = RecordStore.openRecordStore(RECORD_STORE_NAME , true );
 
                if (recStore.getNumRecords()==2)
                    {
 
                        //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)
            {
                err+=e.toString();
            }
 
        chg_state((mk.force_disconnect)?STATEID_SCANNING:STATEID_MAINMENU);
 
 
       
        new Thread(this).start();
 
    }
 
 
   
    /****************************** Thread ******************/
    // ticking runnable Section
    public void run()
    {
 
 
        while(true)
            {
                repaint();
                serviceRepaints();
 
                long loopStartTime = System.currentTimeMillis();
                long sleeptime=0;
                // ticked thing
       
                frame_pos++;
 
                switch(state)
                    {
                    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;
                                }
                        else
                            {
                                motor_test[act_motor]+=act_motor_increase;
                                if (motor_test[act_motor]<0)motor_test[act_motor]=0;
                            }
 
                        mk.motor_test(motor_test);
                        break;
 
                    case STATEID_SCANNING:
                        intro_str_delay--;
                        if (intro_str_delay<0)
                            {
                                intro_str_delay=1;
                                if (intro_str_pos>intro_str.length())
                                    intro_str_pos=0;
                                lcd_lines[3]=intro_str.substring(intro_str_pos,  (((intro_str_pos+20)>intro_str.length())?intro_str.length():intro_str_pos+20));
                                intro_str_pos++;
                            }
               
                        if (!bt_scanner.searching)
                                chg_state(STATEID_DEVICESELECT);
 
                       
                        break;
 
 
                       
                    }
 
                try {
                    nick_line_pos_data[-bg_offset] = mk.debug_data.nick_int();
                    roll_line_pos_data[-bg_offset] = mk.debug_data.roll_int();
                    accnick_line_pos_data[-bg_offset] = mk.debug_data.accnick();
                    accroll_line_pos_data[-bg_offset] = mk.debug_data.accroll();
                }
                catch (Exception e)
                    {
                        err+=e.toString();
                    }
 
               
 
               
                if (quit)
                    {
 
 
                       
                        try
                            {
                                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)
                            {
                                err+=e.toString();
                            }
 
                        root.quit();
                    }
                if (rescan)
                    {
                       
                        rescan=false;
                    }
 
                try {
                    //rescan=false;
                    bg_offset--;
                    if (bg_offset==-bg_img.getWidth())
                        bg_offset=0;
                    com.nokia.mid.ui.DeviceControl.setLights(0,100);
                    //bt.tick();
                    // every state has sth to do in tick section
                }
                catch (Exception e)
                    {
                       
                    }
             
 
                //                System.gc();
           
 
       
                       
                sleeptime=1000/ 15 - (int) (System.currentTimeMillis()- loopStartTime);
               
               
                if (sleeptime<0)
                    sleeptime=100; // everyone has fi sleep
               
                try { Thread.sleep(sleeptime); }
                catch (Exception e)
                    {
                        err="Problem Sleeping ";
                    }
 
            }
    }
 
     
 
 
 
    // drawing section
    public void paint(Graphics g) {
        y_off=0;
        try {
       
            if (mk!=null)
                {
                    line_middle_y=this.getHeight()/2;
                    if (local_max<Math.abs(mk.debug_data.nick_int()))
                        local_max=Math.abs(mk.debug_data.nick_int());
                    if (local_max<Math.abs(mk.debug_data.roll_int()))
                        local_max=Math.abs(mk.debug_data.roll_int());
                    if (local_max<Math.abs(mk.debug_data.accnick()))
                        local_max=Math.abs(mk.debug_data.accnick());
                    if (local_max<Math.abs(mk.debug_data.accroll()))
                        local_max=Math.abs(mk.debug_data.accroll());
                    line_scaler= local_max/(this.getHeight()/2)+1;
                }
            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);
 
            if (bg_offset+bg_img.getWidth()<this.getWidth())
                g.drawImage(bg_img,bg_offset+bg_img.getWidth(),0, g.TOP | g.LEFT);
 
 
            g.setColor(0x000000);
 
            switch(state)
                {
                case STATEID_MOTORTEST:
                    for (int bar=0;bar<4;bar++)
                        {
                            g.setColor(((bar==act_motor)|motor_test_sel_all)?0x44CC44:0x4444DD);  
                            g.fillRect(this.getWidth()/(8*2)+bar*2*this.getWidth()/8,10,this.getWidth()/8,20+motor_test[bar]);
                            g.setColor(0x000000);
                            g.drawString(""+motor_test[bar] ,this.getWidth()/8+bar*2*this.getWidth()/8,10,Graphics.TOP | Graphics.HCENTER);
                            if(bar!=4)                      g.drawString(""+mk.debug_data.motor_val(bar) ,this.getWidth()/8+bar*2*this.getWidth()/8,30,Graphics.TOP | Graphics.HCENTER);
                        }
                    break;
 
                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;
               
                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);
 
 
 
 
                    // falltru wanted
                case STATEID_SELECT_PARAMSET:
                case STATEID_HANDLE_PARAMS:
               
                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;
 
                    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=this.getHeight()-4*lcd_img.getHeight();
                   
                    for ( int foo=0;foo<4;foo++)
                        {
                            for (int x=0;x<20;x++)
                                {
                                    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);
 
                                        }
                                    y_off+=lcd_img.getHeight();
                                }
 
                            g.setClip(0,0,this.getWidth(),this.getHeight());
 
               
 
 
               
                    // draw lines
 
                    for ( int x=0;x<this.getWidth();x++)
 
                        {
 
                            int p= (((-bg_offset+x-this.getWidth()-5)));
                            if (p<1)
                                p+=bg_img.getWidth();
                            p%=(bg_img.getWidth()-1);
 
                            g.setColor(0x156315);              
                            draw_graph_part(g,x,nick_line_pos_data[p]/line_scaler,nick_line_pos_data[p+1]/line_scaler);
                            g.setColor(0xCC1315);
                            draw_graph_part(g,x,roll_line_pos_data[p]/line_scaler,roll_line_pos_data[p+1]/line_scaler);
                            g.setColor(0xf8ef02);              
                            draw_graph_part(g,x,accnick_line_pos_data[p]/line_scaler,accnick_line_pos_data[p+1]/line_scaler);
                            g.setColor(0x19194d);
                            draw_graph_part(g,x,accroll_line_pos_data[p]/line_scaler,accroll_line_pos_data[p+1]/line_scaler);
               
 
           
                        }
 
                }
 
               
 
        } catch (Exception e) {}
    }
 
    private void connect_mk(String url,String name)
    {
        mk.connect_to(url,name);
 
    }
 
    public void draw_graph_part(Graphics g,int x,int y1,int y2)
    {
        g.fillRect(x,line_middle_y-y1,2,2 );
        if (y1>y2)
            g.fillRect(x,line_middle_y-y1,2,y1-y2);
        else
            g.fillRect(x,line_middle_y-y2,2,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;
 
    public void chg_state(int next_state)
    {
        act_menu_select=0;
        // prepare next state
        switch(next_state)
            {
            case STATEID_SCANNING:
                lcd_lines=new String[4];
                lcd_lines[0]="Scanning for Devices";
                lcd_lines[1]="                    ";
                lcd_lines[2]="DUBwise v0.40       ";
                lcd_lines[3]=intro_str.substring(0,20);
                mk.close_connections(true);
               
                bt_scanner.search();
                break;
 
            case STATEID_HANDLE_PARAMS:
                menu_items=new String[2];
                menu_items[0]="write to MK";
                menu_items[1]="Discard";
                lcd_lines=new String[2];
 
                break;
 
            case STATEID_SELECT_PARAMSET:
                menu_items=new String[5];
                for (int i=0;i<5;i++)
                    menu_items[i]=mk.params.names[i];
 
                lcd_lines=new String[5];
                break;
 
            case STATEID_DEVICESELECT:
                menu_items=new String[bt_scanner.remote_device_count+1];
                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";
                lcd_lines=new String[bt_scanner.remote_device_count+1];
                break;
 
            case STATEID_MAINMENU:
                menu_items=main_menu_items;
                lcd_lines=new String[menu_items.length];
                break;
 
            }
               
        // switch state
        state=next_state;
    }
 
 
    public void keyReleased(int keyCode)
    {
       
        switch(state)
            {
            case STATEID_MOTORTEST:
                act_motor_increase=0;
                break;
            }
 
    }
 
    public void keyPressed(int keyCode)
    {
       
        if (keyCode==KEY_STAR)
            {
                if (state==STATEID_EDIT_PARAMS)
                    chg_state(STATEID_HANDLE_PARAMS);
                else
                    chg_state(STATEID_MAINMENU);
                   
                return;
            }
        if (keyCode==KEY_POUND)
            {
                fullscreen=!fullscreen;
                setFullScreenMode(fullscreen);
                return;
            }
        switch(state)
            {
            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_HANDLE_PARAMS:
                if ( getGameAction (keyCode)==FIRE )
                    switch(act_menu_select)
                        {
                        case 0:
                            mk.write_params();
                        default:
                            chg_state(STATEID_MAINMENU);
                        }
                else
                    menu_keypress(keyCode);
                break;
            case STATEID_MAINMENU:
                if ( getGameAction (keyCode)==FIRE )
                    switch(act_menu_select)
                        {
 
                        case MAINMENU_TELEMETRY :
                            chg_state(STATEID_FLIGHTVIEW);
                            break;
 
                        case  MAINMENU_MOTORTES :
                            chg_state(STATEID_MOTORTEST);
                            break;
 
                        case MAINMENU_PARAMS :
                            chg_state(STATEID_SELECT_PARAMSET);
                            break;
                        case MAINMENU_SETTINGS:
                            break;
                        case MAINMENU_PROXY:
                            mk.do_proxy("socket://192.168.1.42:2323");
                            break;
 
                        case MAINMENU_DEVICESELECT:
                            chg_state(STATEID_SCANNING);
                            break;
 
                        case  MAINMENU_QUIT:
                            quit=true;
                            break;
                           
                        }
                else menu_keypress(keyCode);
                break;
 
            case STATEID_SELECT_PARAMSET:
                if ( getGameAction (keyCode)==FIRE )
                    {              
                        mk.params.act_paramset=act_menu_select;
                        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 )
                    {              
 
                        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_MAINMENU);
                            }
                        else
                            chg_state(STATEID_SCANNING);
                    }
                else menu_keypress(keyCode);
               
                break;
 
            case STATEID_EDIT_PARAMS:
                params_editor.keypress(keyCode,getGameAction (keyCode)) ;
                break;
 
            case STATEID_FLIGHTVIEW:
 
                switch (getGameAction (keyCode))
                    {
                    case UP:
                        mk.LCD.LCD_PREVPAGE();
                        break;
                       
                    case DOWN:
                        mk.LCD.LCD_NEXTPAGE();
                        break;
 
                    case LEFT:
                        chg_state(STATEID_MAINMENU);
                        break;
                       
                    }
                break;
            }
   
       
 
    }
 
 
 
 
 
 
 
 
}
 
 
 

Rev 325	Rev 390
1	/***************************************************************	1	/***************************************************************
2	*	2	*
3	* minimal canvas to test Abstraction layer on various Phones	3	* minimal canvas to test Abstraction layer on various Phones
4	*	4	*
5	* Author: Marcus -LiGi- Bueschleb	5	* Author: Marcus -LiGi- Bueschleb
6	* Project-Start: 9/2007	6	* Project-Start: 9/2007
7	* Mailto: ligi@smart4mobile.de	7	* Mailto: ligi@smart4mobile.de
8	* Licence: Creative Commons / Non Commercial	8	* Licence: Creative Commons / Non Commercial
-		9	* ( see README for exact terms of usage)
9	* Big Up: Holger&Ingo	10	* Big Up: Holger&Ingo
10	***************************************************************/	11	***************************************************************/
11		12
12	import javax.microedition.lcdui.*;	13	import javax.microedition.lcdui.*;
13	import javax.microedition.rms.*;	14	import javax.microedition.rms.*;
14		15
15		16
16	public class MKMiniCanvas	17	public class MKMiniCanvas
17	extends Canvas	18	extends Canvas
18	implements Runnable	19	implements Runnable
19	{	20	{
-		21
20		22	// name/handle for the recordStore to memorize some stuff
21	private final static String RECORD_STORE_NAME="bluetoothurl";	23	private final static String RECORD_STORE_NAME="bluetoothurl";
22		24
23	private BTSearcher bt_scanner;	25	private BTSearcher bt_scanner;
24	public MKCommunicator mk=null;	26	public MKCommunicator mk=null;
25	private MKStatistics mk_stat=null;	27	private MKStatistics mk_stat=null;
26	private MKParamsEditor params_editor=null;	28	private MKParamsEditor params_editor=null;
27		29
28		30
29	private String err="";	31	private String err="";
30	private DUBwise root;	32	private DUBwise root;
31		33
32	private Image bg_img;	34	private Image bg_img;
33	private Image bt_img;	35	private Image bt_img;
34	private Image lcd_img;	36	private Image lcd_img;
35	private Image load_img;	37	private Image load_img;
36		38
37		39
38	public int[] nick_line_pos_data;	40	public int[] nick_line_pos_data;
39	public int[] roll_line_pos_data;	41	public int[] roll_line_pos_data;
40		42
41	public int[] accnick_line_pos_data;	43	public int[] accnick_line_pos_data;
42	public int[] accroll_line_pos_data;	44	public int[] accroll_line_pos_data;
43		45
44	public int lcd_char_width=0;	46	public int lcd_char_width=0;
45	public int lcd_char_height=0;	47	public int lcd_char_height=0;
46		48
47	public int frame_pos=0;	49	public int frame_pos=0;
48		50
49	int line_scaler=20;	51	int line_scaler=20;
50		52
51	public int line_middle_y;	53	public int line_middle_y;
52		54
53	boolean quit=false;	55	boolean quit=false;
54	boolean rescan=true;	56	boolean rescan=true;
55	int bg_offset=0;	57	int bg_offset=0;
-		58
56		59	// variable to hold the current state
57	public int state=-1;	-
58		60	public int state=-1;
59		-
60		61
61	// id for each state - must just be uniq - order dont matter	62	// id for each state - must just be uniq - order isnt important
62	public final static int STATEID_SCANNING =0;	63	public final static int STATEID_SCANNING =0;
63	public final static int STATEID_DEVICESELECT =1;	64	public final static int STATEID_DEVICESELECT =1;
64	public final static int STATEID_MAINMENU =2;	65	public final static int STATEID_MAINMENU =2;
65	public final static int STATEID_MOTORTEST =3;	66	public final static int STATEID_MOTORTEST =3;
66	public final static int STATEID_SELECT_PARAMSET =4;	67	public final static int STATEID_SELECT_PARAMSET =4;
67	public final static int STATEID_EDIT_PARAMS =5;	68	public final static int STATEID_EDIT_PARAMS =5;
68	public final static int STATEID_HANDLE_PARAMS =6;	69	public final static int STATEID_HANDLE_PARAMS =6;
69	public final static int STATEID_FLIGHTVIEW =7;	70	public final static int STATEID_FLIGHTVIEW =7;
70		71
71		72
72	public boolean fullscreen=false;	73	public boolean fullscreen=false;
73	public int act_motor=0;	74	public int act_motor=0;
74	public int act_motor_increase=0;	75	public int act_motor_increase=0;
75	public boolean motor_test_sel_all=false;	76	public boolean motor_test_sel_all=false;
76		77
77	public String[] main_menu_items={"Telemetry" , "Motor Test" , "Flight Settings","(NA)Tool Settings","Proxy","Change Device" , "Quit " };	78	public String[] main_menu_items={"Telemetry" , "Motor Test" , "Flight Settings","(NA)Tool Settings","Proxy","Change Device" , "Quit " };
78	public final static int MAINMENU_TELEMETRY =0;	79	public final static int MAINMENU_TELEMETRY =0;
79	public final static int MAINMENU_MOTORTES =1;	80	public final static int MAINMENU_MOTORTES =1;
80	public final static int MAINMENU_PARAMS =2;	81	public final static int MAINMENU_PARAMS =2;
81	public final static int MAINMENU_SETTINGS =3;	82	public final static int MAINMENU_SETTINGS =3;
82	public final static int MAINMENU_PROXY =4;	83	public final static int MAINMENU_PROXY =4;
83	public final static int MAINMENU_DEVICESELECT =5;	84	public final static int MAINMENU_DEVICESELECT =5;
84	public final static int MAINMENU_QUIT =6;	85	public final static int MAINMENU_QUIT =6;
85		86
86	int local_max=-1;	87	int local_max=-1;
87		88
88	int y_off=0;	89	int y_off=0;
89	int spacer=0;	90	int spacer=0;
90	int[] motor_test = {0,0,0,0};	91	int[] motor_test = {0,0,0,0};
91		92
92		93
93	String[] menu_items;	94	String[] menu_items;
94	int act_menu_select=0;	95	int act_menu_select=0;
95		96
96	String[] lcd_lines =null;	97	String[] lcd_lines =null;
97		98
98	public void paint_menu(Graphics g)	99	public void paint_menu(Graphics g)
99	{	100	{
100	for ( int i=0;i<menu_items.length;i++)	101	for ( int i=0;i<menu_items.length;i++)
101	lcd_lines[i]=(act_menu_select==i?"# ":" ") + menu_items[i];	102	lcd_lines[i]=(act_menu_select==i?"# ":" ") + menu_items[i];
102	paint_lcd(g,true);	103	paint_lcd(g,true);
103	}	104	}
104		105
105	public void menu_keypress(int keyCode)	106	public void menu_keypress(int keyCode)
106	{	107	{
107	switch (getGameAction (keyCode))	108	switch (getGameAction (keyCode))
108	{	109	{
109	case UP:	110	case UP:
110	if (act_menu_select!=0) act_menu_select--;	111	if (act_menu_select!=0) act_menu_select--;
-		112	else
-		113	act_menu_select=menu_items.length-1;
111	break;	114	break;
112		115
113	case DOWN:	116	case DOWN:
114	if (act_menu_select<(menu_items.length-1)) act_menu_select++;	117	if (act_menu_select<(menu_items.length-1)) act_menu_select++;
-		118	else act_menu_select=0;
115	break;	119	break;
116		120
117	}	121	}
118		122
119	}	123	}
120		124
121		125
122		126
123	public void paint_lcd(Graphics g,boolean bottomup)	127	public void paint_lcd(Graphics g,boolean bottomup)
124	{	128	{
125	int y;	129	int y;
126		130
127	for(int i=0;i<lcd_lines.length;i++)	131	for(int i=0;i<lcd_lines.length;i++)
128	for (int pos=0;pos<20;pos++)	132	for (int pos=0;pos<20;pos++)
129	{	133	{
130	if (bottomup)	134	if (bottomup)
131	y=this.getHeight()-(lcd_lines.length-i)*lcd_char_height;	135	y=this.getHeight()-(lcd_lines.length-i)*lcd_char_height;
132	else	136	else
133	y=i*lcd_char_height;	137	y=i*lcd_char_height;
134	g.setClip((lcd_img.getWidth()/222)*pos,y,(lcd_img.getWidth()/222),lcd_img.getHeight());	138	g.setClip((lcd_img.getWidth()/222)*pos,y,(lcd_img.getWidth()/222),lcd_img.getHeight());
135	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);	139	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);
136		140
137	}	141	}
138	}	142	}
139		143
140	public MKMiniCanvas(DUBwise _root)	144	public MKMiniCanvas(DUBwise _root)
141	{	145	{
142		146
143	root=_root;	147	root=_root;
144		148
145	bt_scanner = new BTSearcher();	149	bt_scanner = new BTSearcher();
146	params_editor = new MKParamsEditor(this);	150	params_editor = new MKParamsEditor(this);
147	mk = new MKCommunicator();	151	mk = new MKCommunicator();
148	mk_stat= new MKStatistics(mk);	152	mk_stat= new MKStatistics(mk);
149		153
150	try	154	try
151	{	155	{
152	// load all needed images	156	// load all needed images
153	lcd_img=Image.createImage("/lcd.png");	157	lcd_img=Image.createImage("/lcd.png");
154	bt_img=Image.createImage("/bt.png");	158	bt_img=Image.createImage("/bt.png");
155	bg_img=Image.createImage("/bg.jpg");	159	bg_img=Image.createImage("/bg.jpg");
156	load_img=Image.createImage("/load.png");	160	load_img=Image.createImage("/load.png");
157	}	161	}
158	catch (Exception e)	162	catch (Exception e)
159	{	163	{
160	err+=e.toString();	164	err+=e.toString();
161	}	165	}
162		166
163	lcd_char_width=lcd_img.getWidth()/222;	167	lcd_char_width=lcd_img.getWidth()/222;
164	lcd_char_height=lcd_img.getHeight();	168	lcd_char_height=lcd_img.getHeight();
165		169
166		170
167	nick_line_pos_data=new int[bg_img.getWidth()];	171	nick_line_pos_data=new int[bg_img.getWidth()];
168	roll_line_pos_data=new int[bg_img.getWidth()];	172	roll_line_pos_data=new int[bg_img.getWidth()];
169	accnick_line_pos_data=new int[bg_img.getWidth()];	173	accnick_line_pos_data=new int[bg_img.getWidth()];
170	accroll_line_pos_data=new int[bg_img.getWidth()];	174	accroll_line_pos_data=new int[bg_img.getWidth()];
171		175
172	for (int c=0;c<bg_img.getWidth();c++)	176	for (int c=0;c<bg_img.getWidth();c++)
173	{	177	{
174	nick_line_pos_data[c]=-1;	178	nick_line_pos_data[c]=-1;
175	roll_line_pos_data[c]=-1;	179	roll_line_pos_data[c]=-1;
176	accnick_line_pos_data[c]=-1;	180	accnick_line_pos_data[c]=-1;
177	accroll_line_pos_data[c]=-1;	181	accroll_line_pos_data[c]=-1;
178	}	182	}
179		183
180		184
181	try	185	try
182	{	186	{
183	RecordStore recStore = RecordStore.openRecordStore(RECORD_STORE_NAME , true );	187	RecordStore recStore = RecordStore.openRecordStore(RECORD_STORE_NAME , true );
184		188
185	if (recStore.getNumRecords()==2)	189	if (recStore.getNumRecords()==2)
186	{	190	{
187		191
188	//byte[] recData = new byte[recStore.getRecordSize(1)];	192	//byte[] recData = new byte[recStore.getRecordSize(1)];
189	//int len = recStore.getRecord(1, recData, 0);	193	//int len = recStore.getRecord(1, recData, 0);
190		194
191	//byte[] recData2 = new byte[recStore.getRecordSize(2)];	195	//byte[] recData2 = new byte[recStore.getRecordSize(2)];
192	//int len2 = recStore.getRecord(2, recData, 0);	196	//int len2 = recStore.getRecord(2, recData, 0);
193		197
194	byte[] url_data=recStore.getRecord(1);	198	byte[] url_data=recStore.getRecord(1);
195	byte[] name_data=recStore.getRecord(2);	199	byte[] name_data=recStore.getRecord(2);
196		200
197	connect_mk(new String(url_data, 0, url_data.length),new String(name_data, 0, name_data.length));	201	connect_mk(new String(url_data, 0, url_data.length),new String(name_data, 0, name_data.length));
198		202
199	}	203	}
200	recStore.closeRecordStore();	204	recStore.closeRecordStore();
201	}	205	}
202	catch (Exception e)	206	catch (Exception e)
203	{	207	{
204	err+=e.toString();	208	err+=e.toString();
205	}	209	}
206		210
207	chg_state((mk.force_disconnect)?STATEID_SCANNING:STATEID_MAINMENU);	211	chg_state((mk.force_disconnect)?STATEID_SCANNING:STATEID_MAINMENU);
208		212
209		213
210		214
211	new Thread(this).start();	215	new Thread(this).start();
212		216
213	}	217	}
214		218
215		219
216		220
217	/**************************** Thread ****************/	221	/**************************** Thread ****************/
218	// ticking runnable Section	222	// ticking runnable Section
219	public void run()	223	public void run()
220	{	224	{
221		225
222		226
223	while(true)	227	while(true)
224	{	228	{
225	repaint();	229	repaint();
226	serviceRepaints();	230	serviceRepaints();
227		231
228	long loopStartTime = System.currentTimeMillis();	232	long loopStartTime = System.currentTimeMillis();
229	long sleeptime=0;	233	long sleeptime=0;
230	// ticked thing	234	// ticked thing
231		235
232	frame_pos++;	236	frame_pos++;
233		237
234	switch(state)	238	switch(state)
235	{	239	{
236	case STATEID_MOTORTEST:	240	case STATEID_MOTORTEST:
237		241
238	if (motor_test_sel_all)	242	if (motor_test_sel_all)
239	for (int m=0;m<4;m++)	243	for (int m=0;m<4;m++)
240	{	244	{
241	motor_test[m]+=act_motor_increase;	245	motor_test[m]+=act_motor_increase;
242	if (motor_test[m]<0)motor_test[m]=0;	246	if (motor_test[m]<0)motor_test[m]=0;
243	}	247	}
244	else	248	else
245	{	249	{
246	motor_test[act_motor]+=act_motor_increase;	250	motor_test[act_motor]+=act_motor_increase;
247	if (motor_test[act_motor]<0)motor_test[act_motor]=0;	251	if (motor_test[act_motor]<0)motor_test[act_motor]=0;
248	}	252	}
249		253
250	mk.motor_test(motor_test);	254	mk.motor_test(motor_test);
251	break;	255	break;
252		256
253	case STATEID_SCANNING:	257	case STATEID_SCANNING:
-		258	intro_str_delay--;
-		259	if (intro_str_delay<0)
-		260	{
-		261	intro_str_delay=1;
-		262	if (intro_str_pos>intro_str.length())
-		263	intro_str_pos=0;
-		264	lcd_lines[3]=intro_str.substring(intro_str_pos, (((intro_str_pos+20)>intro_str.length())?intro_str.length():intro_str_pos+20));
-		265	intro_str_pos++;
-		266	}
-		267
254	if (!bt_scanner.searching)	268	if (!bt_scanner.searching)
255	chg_state(STATEID_DEVICESELECT);	269	chg_state(STATEID_DEVICESELECT);
-		270
256		271
257	break;	272	break;
258		273
259		274
260		275
261	}	276	}
262		277
263	try {	278	try {
264	nick_line_pos_data[-bg_offset] = mk.debug_data.nick_int();	279	nick_line_pos_data[-bg_offset] = mk.debug_data.nick_int();
265	roll_line_pos_data[-bg_offset] = mk.debug_data.roll_int();	280	roll_line_pos_data[-bg_offset] = mk.debug_data.roll_int();
266	accnick_line_pos_data[-bg_offset] = mk.debug_data.accnick();	281	accnick_line_pos_data[-bg_offset] = mk.debug_data.accnick();
267	accroll_line_pos_data[-bg_offset] = mk.debug_data.accroll();	282	accroll_line_pos_data[-bg_offset] = mk.debug_data.accroll();
268	}	283	}
269	catch (Exception e)	284	catch (Exception e)
270	{	285	{
271	err+=e.toString();	286	err+=e.toString();
272	}	287	}
273		288
274		289
275		290
276		291
277	if (quit)	292	if (quit)
278	{	293	{
279		294
280		295
281		296
282	try	297	try
283	{	298	{
284	RecordStore.deleteRecordStore(RECORD_STORE_NAME);	299	RecordStore.deleteRecordStore(RECORD_STORE_NAME);
285	RecordStore recStore = RecordStore.openRecordStore(RECORD_STORE_NAME, true );	300	RecordStore recStore = RecordStore.openRecordStore(RECORD_STORE_NAME, true );
286	recStore.addRecord(mk.mk_url.getBytes(), 0, mk.mk_url.getBytes().length);	301	recStore.addRecord(mk.mk_url.getBytes(), 0, mk.mk_url.getBytes().length);
287	recStore.addRecord(mk.name.getBytes(), 0, mk.name.getBytes().length);	302	recStore.addRecord(mk.name.getBytes(), 0, mk.name.getBytes().length);
288	recStore.closeRecordStore();	303	recStore.closeRecordStore();
289		304
290	}	305	}
291	catch (Exception e)	306	catch (Exception e)
292	{	307	{
293	err+=e.toString();	308	err+=e.toString();
294	}	309	}
295		310
296	root.quit();	311	root.quit();
297	}	312	}
298	if (rescan)	313	if (rescan)
299	{	314	{
300		315
301	rescan=false;	316	rescan=false;
302	}	317	}
303		318
304	try {	319	try {
305	//rescan=false;	320	//rescan=false;
306	bg_offset--;	321	bg_offset--;
307	if (bg_offset==-bg_img.getWidth())	322	if (bg_offset==-bg_img.getWidth())
308	bg_offset=0;	323	bg_offset=0;
309	com.nokia.mid.ui.DeviceControl.setLights(0,100);	324	com.nokia.mid.ui.DeviceControl.setLights(0,100);
310	//bt.tick();	325	//bt.tick();
311	// every state has sth to do in tick section	326	// every state has sth to do in tick section
312	}	327	}
313	catch (Exception e)	328	catch (Exception e)
314	{	329	{
315		330
316	}	331	}
317		332
318		333
319	// System.gc();	334	// System.gc();
320		335
321		336
322		337
323		338
324	sleeptime=1000/ 15 - (int) (System.currentTimeMillis()- loopStartTime);	339	sleeptime=1000/ 15 - (int) (System.currentTimeMillis()- loopStartTime);
325		340
326		341
327	if (sleeptime<0)	342	if (sleeptime<0)
328	sleeptime=100; // everyone has fi sleep	343	sleeptime=100; // everyone has fi sleep
329		344
330	try { Thread.sleep(sleeptime); }	345	try { Thread.sleep(sleeptime); }
331	catch (Exception e)	346	catch (Exception e)
332	{	347	{
333	err="Problem Sleeping ";	348	err="Problem Sleeping ";
334	}	349	}
335		350
336	}	351	}
337	}	352	}
338		353
339		354
340		355
341		356
342		357
343	// drawing section	358	// drawing section
344	public void paint(Graphics g) {	359	public void paint(Graphics g) {
345	y_off=0;	360	y_off=0;
346	try {	361	try {
347		362
348	if (mk!=null)	363	if (mk!=null)
349	{	364	{
350	line_middle_y=this.getHeight()/2;	365	line_middle_y=this.getHeight()/2;
351	if (local_max<Math.abs(mk.debug_data.nick_int()))	366	if (local_max<Math.abs(mk.debug_data.nick_int()))
352	local_max=Math.abs(mk.debug_data.nick_int());	367	local_max=Math.abs(mk.debug_data.nick_int());
353	if (local_max<Math.abs(mk.debug_data.roll_int()))	368	if (local_max<Math.abs(mk.debug_data.roll_int()))
354	local_max=Math.abs(mk.debug_data.roll_int());	369	local_max=Math.abs(mk.debug_data.roll_int());
355	if (local_max<Math.abs(mk.debug_data.accnick()))	370	if (local_max<Math.abs(mk.debug_data.accnick()))
356	local_max=Math.abs(mk.debug_data.accnick());	371	local_max=Math.abs(mk.debug_data.accnick());
357	if (local_max<Math.abs(mk.debug_data.accroll()))	372	if (local_max<Math.abs(mk.debug_data.accroll()))
358	local_max=Math.abs(mk.debug_data.accroll());	373	local_max=Math.abs(mk.debug_data.accroll());
359	line_scaler= local_max/(this.getHeight()/2)+1;	374	line_scaler= local_max/(this.getHeight()/2)+1;
360	}	375	}
361	spacer=(g.getFont().getHeight());	376	spacer=(g.getFont().getHeight());
362	g.setColor(0xFFFFFF);	377	g.setColor(0xFFFFFF);
363	g.fillRect(0,0,this.getWidth(),this.getHeight());	378	g.fillRect(0,0,this.getWidth(),this.getHeight());
364	g.drawImage(bg_img,bg_offset,0, g.TOP \| g.LEFT);	379	g.drawImage(bg_img,bg_offset,0, g.TOP \| g.LEFT);
365		380
366	if (bg_offset+bg_img.getWidth()<this.getWidth())	381	if (bg_offset+bg_img.getWidth()<this.getWidth())
367	g.drawImage(bg_img,bg_offset+bg_img.getWidth(),0, g.TOP \| g.LEFT);	382	g.drawImage(bg_img,bg_offset+bg_img.getWidth(),0, g.TOP \| g.LEFT);
368		383
369		384
370	g.setColor(0x000000);	385	g.setColor(0x000000);
371		386
372	switch(state)	387	switch(state)
373	{	388	{
374	case STATEID_MOTORTEST:	389	case STATEID_MOTORTEST:
375	for (int bar=0;bar<4;bar++)	390	for (int bar=0;bar<4;bar++)
376	{	391	{
377	g.setColor(((bar==act_motor)\|motor_test_sel_all)?0x44CC44:0x4444DD);	392	g.setColor(((bar==act_motor)\|motor_test_sel_all)?0x44CC44:0x4444DD);
378	g.fillRect(this.getWidth()/(82)+bar2*this.getWidth()/8,10,this.getWidth()/8,20+motor_test[bar]);	393	g.fillRect(this.getWidth()/(82)+bar2*this.getWidth()/8,10,this.getWidth()/8,20+motor_test[bar]);
379	g.setColor(0x000000);	394	g.setColor(0x000000);
380	g.drawString(""+motor_test[bar] ,this.getWidth()/8+bar2this.getWidth()/8,10,Graphics.TOP \| Graphics.HCENTER);	395	g.drawString(""+motor_test[bar] ,this.getWidth()/8+bar2this.getWidth()/8,10,Graphics.TOP \| Graphics.HCENTER);
381	if(bar!=4) g.drawString(""+mk.debug_data.motor_val(bar) ,this.getWidth()/8+bar2this.getWidth()/8,30,Graphics.TOP \| Graphics.HCENTER);	396	if(bar!=4) g.drawString(""+mk.debug_data.motor_val(bar) ,this.getWidth()/8+bar2this.getWidth()/8,30,Graphics.TOP \| Graphics.HCENTER);
382	}	397	}
383	break;	398	break;
384		399
385	case STATEID_EDIT_PARAMS:	400	case STATEID_EDIT_PARAMS:
386	params_editor.paint(g);	401	params_editor.paint(g);
387	break;	402	break;
388		403
389	case STATEID_SCANNING:	404	case STATEID_SCANNING:
390	paint_lcd(g,true);	405	paint_lcd(g,true);
391		406
392	g.setClip(this.getWidth()/2-load_img.getWidth()/6,this.getHeight()/2-load_img.getHeight()/8, load_img.getWidth()/4,load_img.getHeight()/3);;	407	g.setClip(this.getWidth()/2-load_img.getWidth()/6,this.getHeight()/2-load_img.getHeight()/8, load_img.getWidth()/4,load_img.getHeight()/3);;
393	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);	408	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);
394	g.drawImage(bt_img,this.getWidth()/2 ,this.getHeight()/2 , g.HCENTER \| g.VCENTER);	409	g.drawImage(bt_img,this.getWidth()/2 ,this.getHeight()/2 , g.HCENTER \| g.VCENTER);
395	break;	410	break;
396		411
397	case STATEID_MAINMENU:	412	case STATEID_MAINMENU:
398	g.drawString("MK-Connection(" + (mk.connected?("open"+((System.currentTimeMillis()- mk.connection_start_time)/1000)+"s"):"close")+"):",0,y_off,Graphics.TOP \| Graphics.LEFT);	413	g.drawString("MK-Connection(" + (mk.connected?("open"+((System.currentTimeMillis()- mk.connection_start_time)/1000)+"s"):"close")+"):",0,y_off,Graphics.TOP \| Graphics.LEFT);
399	y_off+=spacer;	414	y_off+=spacer;
400	g.drawString(" Name:" + mk.name,0,y_off,Graphics.TOP \| Graphics.LEFT);	415	g.drawString(" Name:" + mk.name,0,y_off,Graphics.TOP \| Graphics.LEFT);
401	y_off+=spacer;	416	y_off+=spacer;
402	g.drawString(" URL:" + mk.mk_url,0,y_off,Graphics.TOP \| Graphics.LEFT);	417	g.drawString(" URL:" + mk.mk_url,0,y_off,Graphics.TOP \| Graphics.LEFT);
403	y_off+=spacer;	418	y_off+=spacer;
404	g.drawString(" Version:" + mk.version.str,0,y_off,Graphics.TOP \| Graphics.LEFT);	419	g.drawString(" Version:" + mk.version.str,0,y_off,Graphics.TOP \| Graphics.LEFT);
405	y_off+=spacer;	420	y_off+=spacer;
406	g.drawString("Packet Traffic:",0,y_off,Graphics.TOP \| Graphics.LEFT);	421	g.drawString("Packet Traffic:",0,y_off,Graphics.TOP \| Graphics.LEFT);
407	y_off+=spacer;	422	y_off+=spacer;
408	g.drawString( " debug:"+mk.debug_data_count+ " LCD:" + mk.lcd_data_count + " vers:" + mk.version_data_count,0,y_off,Graphics.TOP \| Graphics.LEFT);	423	g.drawString( " debug:"+mk.debug_data_count+ " LCD:" + mk.lcd_data_count + " vers:" + mk.version_data_count,0,y_off,Graphics.TOP \| Graphics.LEFT);
409	y_off+=spacer;	424	y_off+=spacer;
410	g.drawString( " other:"+mk.other_data_count+" params:"+mk.params_data_count,0,y_off,Graphics.TOP \| Graphics.LEFT);	425	g.drawString( " other:"+mk.other_data_count+" params:"+mk.params_data_count,0,y_off,Graphics.TOP \| Graphics.LEFT);
411		426
412		427
413		428
414		429
415	// falltru wanted	430	// falltru wanted
416	case STATEID_SELECT_PARAMSET:	431	case STATEID_SELECT_PARAMSET:
417	case STATEID_HANDLE_PARAMS:	432	case STATEID_HANDLE_PARAMS:
418		433
419	case STATEID_DEVICESELECT:	434	case STATEID_DEVICESELECT:
420	paint_menu(g);	435	paint_menu(g);
421	break;	436	break;
422		437
423	case STATEID_FLIGHTVIEW:	438	case STATEID_FLIGHTVIEW:
424		439
425	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);	440	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);
426		441
427	y_off+=spacer;	442	y_off+=spacer;
428		443
429	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);	444	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);
430	y_off+=spacer;	445	y_off+=spacer;
431		446
432		447
433	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);	448	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);
434	y_off+=spacer;	449	y_off+=spacer;
435		450
436	if (mk.connected)	451	if (mk.connected)
437	{	452	{
438	g.drawString("time conn:" +((System.currentTimeMillis()- mk.connection_start_time)/1000)+"s" ,0,y_off,Graphics.TOP \| Graphics.LEFT);	453	g.drawString("time conn:" +((System.currentTimeMillis()- mk.connection_start_time)/1000)+"s" ,0,y_off,Graphics.TOP \| Graphics.LEFT);
439	y_off+=spacer;	454	y_off+=spacer;
440	g.drawString("time motor>15:" +(mk_stat.motor_on_time/1000) +"s" ,0,y_off,Graphics.TOP \| Graphics.LEFT);	455	g.drawString("time motor>15:" +(mk_stat.motor_on_time/1000) +"s" ,0,y_off,Graphics.TOP \| Graphics.LEFT);
441	y_off+=spacer;	456	y_off+=spacer;
442	g.drawString("time motor=15:" +(mk_stat.motor_stand_time/1000) +"s" ,0,y_off,Graphics.TOP \| Graphics.LEFT);	457	g.drawString("time motor=15:" +(mk_stat.motor_stand_time/1000) +"s" ,0,y_off,Graphics.TOP \| Graphics.LEFT);
443	}	458	}
444		459
445		460
446	y_off=this.getHeight()-4*lcd_img.getHeight();	461	y_off=this.getHeight()-4*lcd_img.getHeight();
447		462
448	for ( int foo=0;foo<4;foo++)	463	for ( int foo=0;foo<4;foo++)
449	{	464	{
450	for (int x=0;x<20;x++)	465	for (int x=0;x<20;x++)
451	{	466	{
452	g.setClip((lcd_img.getWidth()/222)*x,y_off,(lcd_img.getWidth()/222),lcd_img.getHeight());	467	g.setClip((lcd_img.getWidth()/222)*x,y_off,(lcd_img.getWidth()/222),lcd_img.getHeight());
453	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);	468	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);
454		469
455	}	470	}
456	y_off+=lcd_img.getHeight();	471	y_off+=lcd_img.getHeight();
457	}	472	}
458		473
459	g.setClip(0,0,this.getWidth(),this.getHeight());	474	g.setClip(0,0,this.getWidth(),this.getHeight());
460		475
461		476
462		477
463		478
464		479
465	// draw lines	480	// draw lines
466		481
467	for ( int x=0;x<this.getWidth();x++)	482	for ( int x=0;x<this.getWidth();x++)
468		483
469	{	484	{
470		485
471	int p= (((-bg_offset+x-this.getWidth()-5)));	486	int p= (((-bg_offset+x-this.getWidth()-5)));
472	if (p<1)	487	if (p<1)
473	p+=bg_img.getWidth();	488	p+=bg_img.getWidth();
474	p%=(bg_img.getWidth()-1);	489	p%=(bg_img.getWidth()-1);
475		490
476	g.setColor(0x156315);	491	g.setColor(0x156315);
477	draw_graph_part(g,x,nick_line_pos_data[p]/line_scaler,nick_line_pos_data[p+1]/line_scaler);	492	draw_graph_part(g,x,nick_line_pos_data[p]/line_scaler,nick_line_pos_data[p+1]/line_scaler);
478	g.setColor(0xCC1315);	493	g.setColor(0xCC1315);
479	draw_graph_part(g,x,roll_line_pos_data[p]/line_scaler,roll_line_pos_data[p+1]/line_scaler);	494	draw_graph_part(g,x,roll_line_pos_data[p]/line_scaler,roll_line_pos_data[p+1]/line_scaler);
480	g.setColor(0xf8ef02);	495	g.setColor(0xf8ef02);
481	draw_graph_part(g,x,accnick_line_pos_data[p]/line_scaler,accnick_line_pos_data[p+1]/line_scaler);	496	draw_graph_part(g,x,accnick_line_pos_data[p]/line_scaler,accnick_line_pos_data[p+1]/line_scaler);
482	g.setColor(0x19194d);	497	g.setColor(0x19194d);
483	draw_graph_part(g,x,accroll_line_pos_data[p]/line_scaler,accroll_line_pos_data[p+1]/line_scaler);	498	draw_graph_part(g,x,accroll_line_pos_data[p]/line_scaler,accroll_line_pos_data[p+1]/line_scaler);

Subversion Repositories FlightCtrl

(root)/branches/ligi_j2me/src/MKMiniCanvas.java - Rev 325 → 390