WebSVN - FlightCtrl - Diff - Rev 485 and 495 - /branches/ligi


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

Subversion Repositories FlightCtrl

(root)/branches/ligi_j2me/src/MKMiniCanvas.java - Rev 485 → 495