Subversion Repositories Projects

/***************************************************************

 *

 * 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="DUBSETT";

    private BTSearcher bt_scanner;

    public MKCommunicator mk=null;

    private MKStatistics mk_stat=null;

    private MKParamsEditor params_editor=null;

//#if voice_mode!="no_voice"

    private MKStatusVoice status_voice;

//#endif

    private String err="";

    private DUBwise root;

    byte[] settings_arr;

    public boolean do_vibra=true;

    public boolean do_sound=true;

    public boolean do_graph=true;

    public boolean keep_lighton=false;

    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 final static int STATEID_SETTINGSMENU     =10;

    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","Tool Settings","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_SETTINGSMENU  =1+MAINMENU_PARAMS;

    public final static int MAINMENU_PROXY         =1+MAINMENU_SETTINGSMENU;

    public final static int MAINMENU_DEVICESELECT  =1+MAINMENU_PROXY;

    public final static int MAINMENU_QUIT          =1+MAINMENU_DEVICESELECT;

    public String[] settings_menu_items={"Skin ","Sound ","Vibra " ,"Graph ","FullScreen " ,"Keep BGLight " ,"Back" };

    public final static int SETTINGSMENU_CHANGESKIN   =0;

    public final static int SETTINGSMENU_SOUNDTOGGLE  =1;

    public final static int SETTINGSMENU_VIBRATOGGLE  =2;

    public final static int SETTINGSMENU_GRAPHTOGGLE  =3;

    public final static int SETTINGSMENU_FULLSCREENTOGGLE  =4;

    public final static int SETTINGSMENU_LIGHTTOGGLE  =5;

    public final static int SETTINGSMENU_BACK      =6;

    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);

//#if voice_mode!="no_voice"

        status_voice=new MKStatusVoice(mk,this);

//#endif

        try

            {

                RecordStore recStore = RecordStore.openRecordStore(RECORD_STORE_NAME , true );

                if (recStore.getNumRecords()==3)

                    {

                        //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);

                        settings_arr=recStore.getRecord(3);

                        act_skin=settings_arr[0];

                        do_sound=(settings_arr[1]==1);

                        do_vibra=(settings_arr[2]==1);

                        do_graph=(settings_arr[3]==1);

                        fullscreen=(settings_arr[4]==1);

                        keep_lighton=(settings_arr[5]==1);

                        connect_mk(new String(url_data, 0, url_data.length),new String(name_data, 0, name_data.length));

                    }

                recStore.closeRecordStore();

            }

        catch (Exception e)

            {

                settings_arr=new byte[10];

                err+=e.toString();

            }

        load_images();

        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);

                                settings_arr=new byte[10];

                                settings_arr[0]=(byte)act_skin;

                                settings_arr[1]=(byte)(do_sound?1:0);

                                settings_arr[2]=(byte)(do_vibra?1:0);

                                settings_arr[3]=(byte)(do_graph?1:0);

                                settings_arr[4]=(byte)(fullscreen?1:0);

                                settings_arr[5]=(byte)(keep_lighton?1:0);

                                recStore.addRecord(settings_arr, 0, settings_arr.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;

                    if (keep_lighton) 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();

                    }

            }

    }

    boolean firstrun=true;

    // drawing section

    public void paint(Graphics g) {

        if (firstrun)

            {

                if (fullscreen) setFullScreenMode(fullscreen);

                firstrun=false;

            }

        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(mk.debug_data.names[i] + mk.debug_data.analog[i] ,0,y_off,Graphics.TOP | Graphics.LEFT);

                            g.drawString(mk.debug_data.names[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);

                case STATEID_SETTINGSMENU:

                    // 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

                    if (do_graph) 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)

    {

        if (next_state!=state)act_menu_select=0;