Subversion Repositories Projects

Rev

Rev 258 | Rev 262 | Go to most recent revision | Blame | Compare with Previous | Last modification | View Log | RSS feed

/***************************************************************
 *
 * User Interface ( Canvas ) of DUBwise
 *                                                          
 * Author:        Marcus -LiGi- Bueschleb
 * Mailto:        LiGi @at@ LiGi DOTT de                    
 *
 ***************************************************************/


import javax.microedition.lcdui.*;

import javax.microedition.media.*;
import javax.microedition.media.control.*;


import javax.microedition.rms.*;
import java.io.*;

public class DUBwiseCanvas
    extends Canvas
    implements Runnable,org.ligi.ufo.DUBwiseDefinitions , DUBwiseUIDefinitions,org.ligi.ufo.DUBwiseLangDefs
{

    public final static int[] param_menu_items={STRINGID_EDIT_SETTINGS,STRINGID_COPY_TO_MOBILE,STRINGID_LOAD_FROM_MOBILE,STRINGID_REINITIALIZE_ALL,STRINGID_BACK};
    public  final static byte[] param_menu_actions={ACTIONID_SELECT_PARAMS,ACTIONID_PARAM_COPY_MOBILE,ACTIONID_PARAM_LOAD_MOBILE,ACTIONID_RESET_PARAMS,ACTIONID_MAINMENU};

    public  final static int[] handle_params_menu_items={STRINGID_EDIT_CONTENT,STRINGID_RENAME,STRINGID_SAVE_AS,STRINGID_SAVE,STRINGID_REREAD,STRINGID_BACK};
    public  final static byte[] handle_params_menu_actions={ACTIONID_EDIT_PARAMS,ACTIONID_RENAME_PARAMS,ACTIONID_WRITE_PARAM_AS,ACTIONID_WRITE_PARAMS,ACTIONID_UNDO_PARAMS,ACTIONID_SELECT_PARAMS };

    public final static int[] onlyback_menu_items={STRINGID_BACK };
    public final static byte[]    back_to_conndetails_actions={ACTIONID_BACK_TO_CONNDETAILS};


//#if fileapi=="on"
    DUBwiseFileAccess file_access;
//#endif

    String act_input_str=" ";
    // for dual use of states
    boolean select_paramset4edit;

           
    boolean read_paramset_intension_save;
    boolean ipinput4proxy;


    byte ipinput_pos=0;
    int[] act_edit_ip;

    int canvas_width=100;
    int canvas_height=100;


    int heading_offset=0;
    int act_wp;

//#if bluetooth=="on"
    private BTSearcher bt_scanner;
//#endif

    public org.ligi.ufo.MKCommunicator mk=null;
    //    private MKStatistics mk_stat=null;
    private MKParamsEditor params_editor=null;
    private MKParamsEditor settings_editor=null;
    public DUBwiseDebug debug=null;
    public FirmwareLoader fw_loader=null;
   



//#if voice_mode!="no_voice"
    public MKStatusVoice status_voice;
//#endif


    private DUBwise root;
    public DUBwiseSettings settings;
    //    public UFOProber mk.ufo_prober;

    private Image bg_img;
    private Image lcd_img;
    private Image symbols_img;
   
    private int symbols_img_tile_height;
    private int symbols_img_tile_width;


    private Image err_img;


    int max_lines;


    public byte act_motor=0;
    public byte act_motor_increase=0;
    public boolean motor_test_sel_all=false;


    /* Graph Vars */
    public final static int GRAPH_COUNT=4;
    public final static int[] graph_colors={0x156315,0xCC1315,0xf8ef02,0x19194d};
    public int[] graph_sources={0,1,2,3};
    public String[] graph_names={"nick int","roll int","nick acc","roll acc"};
    public int[][] graph_data;
    public int graph_offset=0;
   
    //    public int lcd_char_width=0;
    public int lcd_char_height=0;

    public int frame_pos=0;

    //    public byte mk.user_intent=USER_INTENT_NONE;
   
    int line_scaler=20;

    int rawdebug_cursor_y=0;    
    int rawdebug_off_y=0;

    public int line_middle_y;
    public int graph_height;


    boolean quit=false;

    int     bg_offset=0;

    // variable to hold the current state
    public byte state=STATEID_INITIAL;
    public byte nextstate=STATEID_INITIAL;
 
    int local_max=-1;

    int y_off=0;
    int spacer=0;
    int spacer1=0;

    int[] motor_test = {0,0,0,0};
   

    String[] menu_items;
    byte[]    menu_actions;
    int act_menu_select=0;
    int[] act_menu_select_bak;
    String[] lcd_lines =null;


    // to check if 2 keys are pressed
    byte keycontrol_exit=0;


    byte     setup_pos;
    byte[]   tmp_actions;
    String[] tmp_items;
    //    boolean expert_mode=false;


    byte act_lang=0;

    public String[] localized_strings;

    public String l(int str_id)
    {
            return localized_strings[str_id];

    }
    public void tmp_menu_init(int max_items)
    {
        setup_pos=0;
        tmp_actions=new byte[max_items];
        tmp_items=new String[max_items];
    }

    public void tmp_menu_add(String label,byte action)
    {
        tmp_actions[setup_pos] = action;
        tmp_items[setup_pos] = label;
        setup_pos++;
    }

    public void tmp_menu_use()
    {
        byte[]   tmp_actions_fin=new byte[setup_pos];
        String[] tmp_items_fin=new String[setup_pos];

        if (setup_pos<act_menu_select)
            act_menu_select=0;
       
        for ( int tmp_p=0;tmp_p<setup_pos;tmp_p++)
            {
                tmp_actions_fin[tmp_p]=tmp_actions[tmp_p];
                tmp_items_fin[tmp_p]  =tmp_items[tmp_p];
            }

        setup_menu(tmp_items_fin,tmp_actions_fin);
    }
   
    public void setup_conn_menu()
    {
        tmp_menu_init(7);
        tmp_menu_add(l(STRINGID_PACKET_TRAFFIC),ACTIONID_TRAFFIC);
        tmp_menu_add(l(STRINGID_VIEW_DATA),ACTIONID_DATABUFF);
//#if bluetooth=="on"
        tmp_menu_add(l(STRINGID_CONNECT_BT),ACTIONID_SCAN_BT);
//#endif
        tmp_menu_add(l(STRINGID_CONNECT_TCP),ACTIONID_CONNECT_TCP);

        if ((System.getProperty("microedition.commports")!=null)&&(!System.getProperty("microedition.commports").equals("")))
            tmp_menu_add(l(STRINGID_CONNECT_COM),ACTIONID_SELECT_COM);
        tmp_menu_add(l(STRINGID_SET_PROXY),ACTIONID_PROXY_INPUT);
        tmp_menu_add(l(STRINGID_BACK),ACTIONID_MAINMENU);
        tmp_menu_use();

    }


    public void setup_main_menu()
    {
        tmp_menu_init(20);
       
        tmp_menu_add(l(STRINGID_SETTINGS),ACTIONID_SETTINGS);
        tmp_menu_add(l(STRINGID_CONN),ACTIONID_CONN_DETAILS);

        tmp_menu_add(l(STRINGID_SELECT_FIRMWARE),ACTIONID_SELECT_FIRMWARE);
        tmp_menu_add("UPDATE_DUBWISE",ACTIONID_UPDATE_DUBWISE);
        tmp_menu_add("Phone GPS",ACTIONID_SHOWPHONEGPS);


        if (settings.expert_mode)
            tmp_menu_add(l(STRINGID_DEBUG),ACTIONID_DEBUG);
           
        if (mk.ufo_prober.is_mk())
            {
               
                tmp_menu_add(l(STRINGID_MOTORTEST),ACTIONID_MOTORTEST);
                tmp_menu_add(l(STRINGID_KEYCONTROL),ACTIONID_KEYCONTROL);
                tmp_menu_add(l(STRINGID_RCDATA),ACTIONID_RCDATA);
                tmp_menu_add(l(STRINGID_FLIGHTSETTINGS),ACTIONID_PARAM_MENU);
                tmp_menu_add(l(STRINGID_HORIZON),ACTIONID_HORIZON);
            }



        if ( mk.ufo_prober.is_navi()||mk.ufo_prober.is_mk()  )
            tmp_menu_add(l(STRINGID_LCD),ACTIONID_LCD);

        if ( mk.ufo_prober.is_mk()  )
            tmp_menu_add(l(STRINGID_GRAPH),ACTIONID_GRAPH);

        if (( mk.ufo_prober.is_navi()||mk.ufo_prober.is_mk()||mk.ufo_prober.is_mk3mag() ))
            tmp_menu_add(l(STRINGID_DEBUG_VALUES),ACTIONID_RAWDEBUG);


        if ( mk.ufo_prober.is_navi())
            {
                tmp_menu_add(l(STRINGID_VIEW_GPS),ACTIONID_GPSDATA);
                tmp_menu_add(l(STRINGID_VIEW_ERRORS),ACTIONID_NC_ERRORS);
                tmp_menu_add(l(STRINGID_SWITCH_FC),ACTIONID_SWITCH_FC);
                tmp_menu_add(l(STRINGID_SWITCH_MK3MAG),ACTIONID_SWITCH_MK3MAG);

            }

        if (mk.ufo_prober.is_mk()||mk.ufo_prober.is_mk3mag() )
            tmp_menu_add(l(STRINGID_SWITCH_NAVI),ACTIONID_SWITCH_NC);


        //if ((settings.expert_mode)&& ( mk.ufo_prober.is_navi()||mk.ufo_prober.is_mk()||mk.ufo_prober.is_mk3mag()||mk.ufo_prober.is_incompatible()   ))
         
        if (settings.expert_mode)
            tmp_menu_add(l(STRINGID_FLASH_FIRMWARE),ACTIONID_FLASH);
           
        if (settings.expert_mode&& mk.ufo_prober.is_mk()   )
            tmp_menu_add(l(STRINGID_REMOTE_CAM),ACTIONID_CAM);

        if (!settings.expert_mode)
            tmp_menu_add(l(STRINGID_ABOUT),ACTIONID_ABOUT);

        tmp_menu_add(l(STRINGID_QUIT),ACTIONID_QUIT);

        tmp_menu_use();
    }


    public void setup_menu(String[] items , byte[] actions)
    {
        menu_items=items;
        menu_actions=actions;
        lcd_lines=new String[menu_items.length];
    }

    public void setup_menu(int[] items , byte[] actions)
    {
        menu_items=new String[items.length];
        for(int i=0;i<items.length;i++)
            menu_items[i]=l(items[i]);

        menu_actions=actions;
        lcd_lines=new String[menu_items.length];
    }

    public void paint_menu(Graphics g)
    {
        if (menu_items==null) return;
        for ( int i=0;i<menu_items.length;i++)
            {
                if ((frame_pos%3)!=0)
                    {
                        lcd_lines[i]=(act_menu_select==i?">":" ") + menu_items[i];     
                        for ( int ii=0;ii<(18-menu_items[i].length());ii++)
                            lcd_lines[i]+=" ";
                        if (act_menu_select==i)
                            lcd_lines[i]+="<";
                    }
                else
                    lcd_lines[i]=" " + menu_items[i];  
                       

            }
        paint_lcd(g);
    }

    public void menu_keypress(int keyCode)
    {
        debug.log("Menu with KeyCode:"+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;

            case FIRE:
                switch(state)
                    {

                    case STATEID_SELECT_COMPORT:       
                        if (act_menu_select<menu_items.length)
                            connect_mk("comm:"+menu_items[act_menu_select]+";baudrate=57600","com"+act_menu_select);
                       
                        chg_state(STATEID_CONN_DETAILS);                           
                        break;

//#if fileapi=="on"
                    case STATEID_FILEOPEN:
                       
                        file_access.fire();
                   
                        break;

//#endif

                    case STATEID_SELECT_PARAMSET:

                        if (act_menu_select==5) // back
                            {
                                if (select_paramset4edit)
                                        chg_state(STATEID_PARAM_MENU);
                                else
                                    chg_state(STATEID_HANDLE_PARAMS); // from save as
                               
                            }
                        else
                            {
                                if (select_paramset4edit)
                                    //                  if ( mk.params.field[act_menu_select]!=null)
                                    {
                                        mk.params.act_paramset=act_menu_select;
                                        chg_state(STATEID_HANDLE_PARAMS);
                                        //success_msg="Params saved";
                                    }
                                else
                                    {
                                        mk.write_params(act_menu_select);
                                        nextstate=STATEID_HANDLE_PARAMS;
                                        success_msg="saved in slot " + (act_menu_select+1) ;
                                        chg_state(STATEID_SUCCESS_MSG);  // TODO - ground too optimistic way ;-)
                                    }

                            }


                        break;

//#if bluetooth=="on"
                    case STATEID_DEVICESELECT:
                       

                        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_CONN_DETAILS);
                            }
                        else
                            {
                                if (bt_scanner.remote_device_count == act_menu_select)
                                    chg_state(STATEID_SCANNING);
                                else
                                    chg_state(STATEID_CONN_DETAILS);
                            }
                                   
                        break;
//#endif


                    default:
                        if (menu_actions!=null)
                            process_action(menu_actions[act_menu_select]);
                    }
            }

    }

    public boolean cam_condition()
    {
        return (mk.stick_data.stick[settings.remote_cam_stick]>100);
    }

    //    int lcd_top=25;
    int lcd_off;
    public void paint_lcd(Graphics g)
    {
        int y;
        //      int lcd_top= (state==STATEID_EDIT_PARAMS?0:25);
        //int lcd_top= 25;
        max_lines=(canvas_height-25/*lcd_top*/)/lcd_char_height;
        int spacer_left_right=(canvas_width-(20*(lcd_img.getWidth()/222)))/2;
        //      for(int i=0;i<lcd_lines.length;i++)

        int display_lines=(lcd_lines.length>max_lines?max_lines:lcd_lines.length);


        lcd_off= (((state==STATEID_EDIT_PARAMS)&&(!params_editor.select_mode))?params_editor.act_y:act_menu_select)-display_lines+1;
        if ( lcd_off<0)  lcd_off=0;

        for(int i=0;i<display_lines;i++)
            for (int pos=0;pos<20;pos++)
            {
                /*if (!bottomup)
                    y=i*lcd_char_height;
                    else*/

                y=canvas_height-(display_lines-i)*lcd_char_height;

                g.setClip((lcd_img.getWidth()/222)*pos+spacer_left_right,y,(lcd_img.getWidth()/222),lcd_img.getHeight());
                g.drawImage(lcd_img,spacer_left_right+(lcd_img.getWidth()/222)*pos-((pos<lcd_lines[i+lcd_off].length()?lcd_lines[i+lcd_off].charAt(pos):' ')-' ')*(lcd_img.getWidth()/222),y,g.TOP | g.LEFT);
            }
    }

    public void load_skin_images()
    {
        try
            {
                bg_img=null;
                lcd_img=null;

                // load all needed images
                switch (settings.act_skin)
                    {
                    case SKINID_DARK:
                        lcd_img=Image.createImage("/lcd_green.png");
                        if (settings.do_scrollbg) bg_img=Image.createImage("/starfield.jpg");
                        break;
                       
                       
                    case SKINID_LIGHT:
                        lcd_img=Image.createImage("/lcd_blue.png");
                        if (settings.do_scrollbg) bg_img=Image.createImage("/clouds.jpg");
                        break;
                    }
                //              lcd_char_width=lcd_img.getWidth()/222;
                lcd_char_height=lcd_img.getHeight();
            }

        catch (Exception e)
            {
                debug.err(e.toString());
            }

    }
    public void load_global_images()
    {
        try
            {
                symbols_img=Image.createImage("/symbols.png");
                symbols_img_tile_height=symbols_img.getHeight()/2;
                symbols_img_tile_width=symbols_img.getWidth()/10;

                /*              if (bg_img!=null)
                    graph_data=new int[GRAPH_COUNT][bg_img.getWidth()];
                else
                */


            }
       
        catch (Exception e)
            {
                debug.err(e.toString());
            }
       
    }


    public void load_strings()
    {
        System.out.println("loading strings");
        localized_strings=new String[STRING_COUNT];
       
        try {
            InputStream in=this.getClass().getResourceAsStream("/l");      
           
            for (int i=0;i<STRING_COUNT;i++)
                {
                    System.out.println("s"+i);
                    String tmp_s="";
                    String tmp_b="";
                    char ch=0;

                    int act_l=0;
                    while ( (ch=(char)in.read())!='\n')
                        {
                            if (ch==';')
                                {
                                    act_l++;
                                    tmp_s="";
                                }
                            else
                                {
                                    if (act_l==0)
                                        tmp_b+=ch;
                                   
                                    if (act_l==act_lang)
                                        tmp_s+=ch;
                                }
 
                        }

                    if (tmp_s.equals(""))
                        localized_strings[i]=tmp_b;        
                    else
                        localized_strings[i]=tmp_s;        
                    System.out.println("s"+localized_strings[i]);
                }
        }
        catch (Exception e) {               System.out.println("str_load err"+e);}
    }


    // construct
    public DUBwiseCanvas(DUBwise _root)
    {
        load_strings();
       




        act_menu_select_bak=new int[STATEID_COUNT];
        for (int i=0;i<STATEID_COUNT;i++)
            act_menu_select_bak[i]=0;
//#if fileapi=="on"
        file_access=new DUBwiseFileAccess(this);
//#endif

        root=_root;

        mk      = new org.ligi.ufo.MKCommunicator();


//#if voice_mode!="no_voice"
        status_voice=new MKStatusVoice(mk,this);
//#endif

        settings = new DUBwiseSettings(this);
        settings.load();
        load_global_images();
        debug   = new DUBwiseDebug(this);

//#if bluetooth=="on"
        bt_scanner = new BTSearcher();
//#endif

       

       
       
        mk.gps_position.act_speed_format=settings.speed_format;
        mk.gps_position.act_gps_format= settings.gps_format;

       
        chg_state(STATEID_MAINMENU);

        new Thread(this).start();

        if (settings.connection_url!="")
            connect_mk(settings.connection_url,settings.connection_name);
    }

   
    /****************************** Thread ******************/
    // ticking runnable Section
    public void run()
    {
        while(true)
            {
                try {


                repaint();
                serviceRepaints();

                System.gc();
                long loopStartTime = System.currentTimeMillis();
                long sleeptime=0;
                // ticked thing
       
                frame_pos++;

                // handle Device Change
                if (mk.ufo_prober.change_notify)
                    {
                        mk.ufo_prober.change_notify=false;
                        if (mk.ufo_prober.is_incompatible())
                            {
                                mk.error_str=l(STRINGID_INCOMPATIBLEDEVICE);
                                chg_state(STATEID_ERROR_MSG);
                            }
                        else
                            if (state==STATEID_MAINMENU)
                                chg_state(STATEID_MAINMENU); // reload mainmenu ( changed content )
                    }

               
                switch(state)
                    {
                       

                    case STATEID_SHOWPHONEGPS:
                       
                        try
                            {
                                Class.forName("javax.microedition.location.LocationProvider");

                                javax.microedition.location.Criteria cr= new javax.microedition.location.Criteria();
                                cr.setHorizontalAccuracy(500);
                               
                                // Get an instance of the provider
                                javax.microedition.location.LocationProvider lp= javax.microedition.location.LocationProvider.getInstance(cr);
                               
                                // Request the location, setting a one-minute timeout
                                javax.microedition.location.Location l = lp.getLocation(60);
                                javax.microedition.location.Coordinates c = l.getQualifiedCoordinates();
                               


                                /* low crit

Criteria crit2 = new Criteria();
crit2.setHorizontalAccuracy(Criteria.NO_REQUIREMENT);
crit2.setVerticalAccuracy(Criteria.NO_REQUIREMENT);
crit2.setPreferredResponseTime(Criteria.NO_REQUIREMENT);
crit2.setPreferredPowerConsumption(Criteria.POWER_USAGE_HIGH);
crit2.setCostAllowed(false);
crit2.setSpeedAndCourseRequired(false);
crit2.setAltitudeRequired(false);
lp= LocationProvider.getInstance(crit2);

                                */

                                if(c != null ) {
                                    // Use coordinate information
                                    phone_lat= c.getLatitude();
                                    phone_long = c.getLongitude();
                                }
                            }
                        catch (Exception e)
                            {
                                mk.error_str="Phone GPS Problem";
                                chg_state(STATEID_ERROR_MSG);
                               
                            }
               
                        break;
               
                    case STATEID_SELECT_FIRMWARE:
                        if ((menu_items.length==0)&&(fw_loader.got_list))
                            setup_menu(fw_loader.names,null);
                            break;
                       
                    case STATEID_RESET_PARAMS:

                       
                        if (mk.bootloader_finish_ok)
                            {
                                mk.params.reset();
                                mk.watchdog.act_paramset=0;
                                nextstate=STATEID_PARAM_MENU;
                                success_msg=l(STRINGID_PARAMRESETOK);
                                chg_state(STATEID_SUCCESS_MSG);
                            }
                        break;
                    case STATEID_GRAPH:
                        graph_offset--;
                        if (graph_offset==-graph_data[0].length)
                            graph_offset=0;
                        break;

                    case STATEID_CAMMODE:
                       
                        try
                            {
                                if(cam_condition())
                                    {
                                        cam_img=null;
                                        debug.log("get snap\n");
                                        cam_raw = mVideoControl.getSnapshot(null);
                                       
                                       
                                        try { Thread.sleep(4000); }
                                        catch (Exception e)
                                            {
                                                debug.log("Problem Sleeping ");
                                               
                                            }
                                        cam_img = Image.createImage(cam_raw, 0, cam_raw.length);
                                    }
                                else
                                    {
                                        if (cam_img==null)
                                            ;;
                                    }
                            }
                        catch ( Exception e)
                            {
                                debug.log(e.toString());
                            }
                        break;
                    case STATEID_KEYCONTROL:
                        //mk.send_keys(keycontrol_bitfield);   
                        break;
                       

                    case STATEID_ERROR_MSG:
                        lcd_lines[0]=""+mk.error_str;
                        break;
                       

                    case STATEID_PARAM_MASSWRITE:

                        if (param_masswrite_write_pos==5)
                            {
                                nextstate=STATEID_PARAM_MENU;
                                success_msg=l(STRINGID_PARAMWRITEOK);
                                chg_state(STATEID_SUCCESS_MSG);
                            }
                        else
                            {
                                if (param_masswrite_write_pos!=0)
                                    try { Thread.sleep(2000); }
                                    catch (Exception e)
                                        {debug.log("Problem Sleeping ");   }
                               
                                lcd_lines[0]=l(STRINGID_WRITINGPARAMS);
                                lcd_lines[1]=DUBwiseHelper.pound_progress(param_masswrite_write_pos,5);

                       
                                mk.params.set_by_mk_data(params2masswrite[param_masswrite_write_pos]);
                                mk.params.act_paramset=param_masswrite_write_pos;
                                mk.write_params(mk.params.act_paramset);
                               
                                param_masswrite_write_pos++;
                            }
                        break;
                    case STATEID_READ_PARAMS:
                        if (mk.watchdog.act_paramset==5)
                            {
                                if (read_paramset_intension_save)
                                    {
               
                                        try
                                            {
                                                RecordStore.deleteRecordStore( PARAM_SAVE_STORE_NAME);
                                            }
                                        catch (Exception e)
                                            { }
                                       
                                        try {
                                            RecordStore recStore = RecordStore.openRecordStore( PARAM_SAVE_STORE_NAME, true );
                                           
                                            ByteArrayOutputStream bout = new ByteArrayOutputStream();
                                            DataOutputStream      dout = new   DataOutputStream( bout );
                                           
                                            // params_version
                                            dout.writeInt(mk.params.params_version);
                                           
                                            // params_length
                                            dout.writeInt(mk.params.field_bak[0].length);
                                           
                                            for (int p=0;p<5;p++)
                                                for (int i=0;i<mk.params.field_bak[0].length;i++)
                                                    dout.writeInt(mk.params.field_bak[p][i]);

                                            recStore.addRecord(bout.toByteArray(),0,bout.size());
                                            recStore.closeRecordStore();
                                           
                                           
                                        }
                                        catch (Exception e)
                                            {       }
                                        //                                      chg_state(STATEID_COPY_PARAMS);

                                        nextstate=STATEID_PARAM_MENU;
                                        success_msg="Parameter Copy OK";
                                        chg_state(STATEID_SUCCESS_MSG);
                                       
                                    }
                                else
                                    {
                                        select_paramset4edit=true;
                                        chg_state(STATEID_SELECT_PARAMSET);

                                    }

                            }
                        else
                            {
                                lcd_lines[0]="Reading Settings    ";
                                lcd_lines[1]=DUBwiseHelper.pound_progress(mk.watchdog.act_paramset,5);
                               
                               
                                if (mk.params.found_incompatible)
                                    {
                                        mk.error_str="incompatible params";
                                        chg_state(STATEID_ERROR_MSG);
                                    }
                               
                            }
                        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_STRINGINPUT:
                       
                        lcd_lines[0]=act_input_str;
                        for(int tmp_i=act_input_str.length();tmp_i<20;tmp_i++)
                            lcd_lines[0]+=(char)(0);

                        lcd_lines[1]="";
                        for(int foo=0;foo<20;foo++)
                            {
                                if (foo==ipinput_pos)
                                    lcd_lines[1]+="^";
                                else
                                    lcd_lines[1]+=" ";
                            }
                        break;


                    case STATEID_IPINPUT:
                        if (ipinput4proxy)
                            act_edit_ip=settings.act_proxy_ip;
                        else
                            act_edit_ip=settings.act_conn_ip;                      
                           
                        lcd_lines[1]=DUBwiseHelper.ip_str(act_edit_ip,true);
                       

                        lcd_lines[2]="";
                        for(int foo=0;foo<20;foo++)
                            {
                                if (foo==ipinput_pos)
                                    lcd_lines[2]+="^";
                                else
                                    lcd_lines[2]+=" ";
                            }
                        break;

                    case STATEID_MAINMENU:

                        break;

//#if bluetooth=="on"
                    case STATEID_SCANNING:

                        lcd_lines[1]="Bluetooth Devices " + idle_seq[(((frame_pos/5)%idle_seq.length))];
                        lcd_lines[2]="found " + bt_scanner.remote_device_count;
                       
                        if (!bt_scanner.searching)
                                chg_state(STATEID_DEVICESELECT);
                       
                        break;
//#endif

                       
                    }

                if (quit)
                    {
                        settings.speed_format=mk.gps_position.act_speed_format;
                        settings.gps_format=mk.gps_position.act_gps_format;
                        settings.save();
                        root.quit();
                    }


                    //rescan=false;

                if (bg_img!=null)
                    {
                        bg_offset--;
                        if (bg_offset==-bg_img.getWidth())
                            bg_offset=0;
                    }



               
//#if devicecontrol=="on"

                try {
                    Class.forName("com.nokia.mid.ui.DeviceControl");
                    if (settings.keep_lighton) com.nokia.mid.ui.DeviceControl.setLights(0,100);

                }
                catch (Exception e)   {    }
//#endif        
                       
                sleeptime=1000/ 15 - (int) (System.currentTimeMillis()- loopStartTime);

                if (sleeptime<0)
                    sleeptime=100; // everyone has fi sleep
               
                try { Thread.sleep(sleeptime); }
                catch (Exception e)
                    {
                        debug.log("Problem Sleeping ");
                    }

                }
                catch (Exception e)
                    {
                        debug.log("E!:"+e.getMessage());

                    }
            }
    }

     

    boolean firstrun=true;

    public int skin_bg_color()
    {
       
        switch (settings.act_skin)
            {
            case SKINID_DARK:
                return BG_COLOR_SKIN_DARK;

            default:           
            case SKINID_LIGHT:
                return BG_COLOR_SKIN_LIGHT;
            }
    }


    public int skin_fg_color()
    {
       
        switch (settings.act_skin)
            {
            case SKINID_DARK:
                return FG_COLOR_SKIN_DARK;
               
            default:
            case SKINID_LIGHT:
                return FG_COLOR_SKIN_LIGHT;
            }
    }


    public int check_local_max(int val)
    {
        if ( val>local_max)
            local_max=val;
        else if (-val>local_max)
            local_max=-val;
        return val;
    }




    public void symbol_paint(Graphics g,int x,int tile,int row)
    {
        g.setClip(x,0,(symbols_img_tile_width),symbols_img_tile_height);;
        g.drawImage(symbols_img,x+(-tile)*(symbols_img_tile_width),row*(-symbols_img_tile_height), g.TOP | g.LEFT);                        
    }




    // drawing sections
    public void paint(Graphics g) {
       
        canvas_width=this.getWidth();
        canvas_height=this.getHeight();


        if (debug.showing)
            {
                debug.paint(g);
                return;
            }

       
        if (firstrun)
            {
                if (settings.fullscreen) setFullScreenMode(settings.fullscreen);
                firstrun=false;
            }
        y_off=0;
       
        try {



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


            //draw background
            if (settings.do_scrollbg)
                {
                    g.setColor(0xFFFFFF);
                    g.fillRect(0,0,canvas_width,canvas_height);
                    g.drawImage(bg_img,bg_offset,0, g.TOP | g.LEFT);
                   
                    if (bg_offset+bg_img.getWidth()<canvas_width)
                        g.drawImage(bg_img,bg_offset+bg_img.getWidth(),0, g.TOP | g.LEFT);             

                }
            else
                {
                    g.setColor(0xdedfff);
                    g.fillRect(0,0,canvas_width,symbols_img_tile_height);

                    g.setColor(skin_bg_color());
                    g.fillRect(0,symbols_img_tile_height,canvas_width,canvas_height-symbols_img_tile_height);
                }


            //int bar=0;
            //      for ( int bar=0;bar<3;bar++)
            if (settings.do_scrollbg)
                for ( int bar=0;bar<canvas_width/(symbols_img.getWidth()/10)+1;bar++)
                    {
                        g.setClip(bar*(symbols_img_tile_width),0,(symbols_img_tile_width),symbols_img_tile_height);;
                        g.drawImage(symbols_img,bar*(symbols_img_tile_width),0, g.TOP | g.LEFT);
                    }

            int symbol_left=0;
            int symbol_spacer=5;

            g.setClip(symbol_left,0,symbols_img_tile_width,symbols_img_tile_height);;
            if (mk.connected)
                symbol_paint(g,symbol_left,(((mk.stats.bytes_in>>3)&1)==1)?2:3,0);

            else
                {
                    if (mk.mk_url.startsWith("btspp://"))
                        symbol_paint(g,symbol_left,1,0);
               

                }
            //          g.drawImage(symbols_img,(-1)*(symbols_img.getWidth()/10),0, g.TOP | g.LEFT);                   



            symbol_left+=6*(symbols_img_tile_width)/4;


            if ((mk.ufo_prober.is_navi()||mk.ufo_prober.is_mk()))
                {

                    symbol_paint(g,symbol_left,4,0);
                    symbol_left+=5 *(symbols_img_tile_width)/4;

                    if ((mk.UBatt()/100)!=0)
                        {
                            symbol_paint(g,symbol_left,(mk.UBatt()/100),1);
                            symbol_left+=(symbols_img_tile_width);
                        }

                    symbol_paint(g,symbol_left,(mk.UBatt()/10)%10,1);
                    symbol_left+=(2*symbols_img_tile_width/3);
                    symbol_paint(g,symbol_left,9,0);
                    symbol_left+=(2*symbols_img_tile_width/3);
                    symbol_paint(g,symbol_left,(mk.UBatt())%10,1);
                    symbol_left+=6*(symbols_img_tile_width)/4;


                    //              g.drawString("" + (mk.UBatt()/10) + "," +(mk.UBatt()%10)+"V" , symbol_left,y_off,Graphics.TOP | Graphics.LEFT);


                    //symbol_left+=         g.getFont().stringWidth("88,8V");//;
                    /*
                    symbol_paint(g,symbol_left,6,0);
                    symbol_left+=5*(symbols_img_tile_width)/4;
                    */

                    if (mk.SenderOkay()>0)
                        {
                            symbol_paint(g,symbol_left,6,0);
                            symbol_left+=5*(symbols_img_tile_width)/4;
                           
                            /*symbol_paint(g,symbol_left,(mk.SenderOkay())/100,1);
                            symbol_left+=(symbols_img_tile_width);

                            symbol_paint(g,symbol_left,(mk.SenderOkay()/10)%10,1);
                            symbol_left+=(symbols_img_tile_width);*/

                        }
                    //              symbol_paint(g,symbol_left,(mk.SenderOkay())%10,1);
                    //symbol_left+=6*(symbols_img_tile_width)/4;

                    //              g.drawString(""+mk.SenderOkay() ,symbol_left,y_off,Graphics.TOP | Graphics.LEFT);
               

                    //symbol_left+=         g.getFont().stringWidth("8")+symbol_spacer; //,0,(symbols_img.getWidth()/10)+2;




                    if (mk.ufo_prober.is_navi())
                        {
                            symbol_paint(g,symbol_left,5,0);
                            symbol_left+=5*(symbols_img_tile_width)/4;

                            symbol_paint(g,symbol_left,(mk.gps_position.SatsInUse)%10,1);
                            symbol_left+=6*(symbols_img_tile_width)/4;


                            g.setClip(symbol_left,0,(symbols_img.getWidth()/10),symbols_img.getHeight());
                            g.drawImage(symbols_img,(-5)*(symbols_img.getWidth()/10) +   symbol_left,0, g.TOP | g.LEFT);                           
                    g.setClip(0,0,canvas_width,canvas_height);
                            symbol_left+=2+(symbols_img.getWidth()/10);
                            g.drawString(""+mk.gps_position.SatsInUse ,symbol_left,y_off,Graphics.TOP | Graphics.LEFT);

                        }

                }


            // unclip
            g.setClip(0,0,canvas_width,canvas_height);

            y_off+=symbols_img_tile_height;
            graph_height=(canvas_height-y_off)/2;
            line_middle_y=graph_height+y_off;
            g.setColor(skin_fg_color());
         
            switch(state)
                {
                case STATEID_HORIZON:

                    g.setStrokeStyle(Graphics.SOLID);  
                    g.setColor(0x6e4e1d);  

                    int horizon_height=(canvas_height-y_off)/2;
                    int horizon_middle=y_off+horizon_height;

                   
                    int horizon_roll_pixels= (mk.angle_roll*horizon_height)/600;
                    int horizon_roll_pixels_=horizon_roll_pixels;


                    int nick_bar_width=canvas_width/4;
                    int nick_bar_height= nick_bar_width/2;

                   
                    int nick_size=canvas_width/4;
                    int nick_pixels_y=(mk.angle_nick*horizon_height)/900;
               
                    int nick_pixels_x;
                    if ((mk.angle_roll*mk.angle_nick)>1)
                        nick_pixels_x=-((int)Math.sqrt(mk.angle_roll*mk.angle_nick)*(canvas_width/2))/(900);
                    else
                        nick_pixels_x=((int)Math.sqrt(-mk.angle_roll*mk.angle_nick)*(canvas_width/2))/(900);
                       
                    while (horizon_roll_pixels!=0)
                        {
                         
                            if (horizon_roll_pixels_>0)
                                {
                                    g.drawLine(0,horizon_middle+horizon_roll_pixels_,canvas_width,horizon_middle-horizon_roll_pixels);
                                    g.drawLine(0,horizon_middle+horizon_roll_pixels_,canvas_width,horizon_middle+horizon_roll_pixels);
                                }
                            else
                                {
                                    g.drawLine(0,horizon_middle+horizon_roll_pixels,canvas_width,horizon_middle-horizon_roll_pixels_);
                                    g.drawLine(0,horizon_middle-horizon_roll_pixels,canvas_width,horizon_middle-horizon_roll_pixels_);
                                }
                            //                      g.drawLine(0,horizon_middle-horizon_roll_pixels_,canvas_width,horizon_middle-horizon_roll_pixels);
                            horizon_roll_pixels+=(horizon_roll_pixels<0)?1:-1; // go to 0

                            /*g.drawLine(0,horizon_middle-horizon_roll_pixels,canvas_width,horizon_middle+horizon_roll_pixels);
                            if (horizon_roll_pixels<0)
                                g.drawLine(0,horizon_middle-horizon_roll_pixels_,canvas_width,horizon_middle-horizon_roll_pixels);
                            else
                                g.drawLine(0,horizon_middle+horizon_roll_pixels,canvas_width,horizon_middle+horizon_roll_pixels_);
                               
                            horizon_roll_pixels+=(horizon_roll_pixels<0)?1:-1; // go to 0
                            */

                        }

                    if (horizon_roll_pixels_>0)
                        {
                            g.drawLine(0,horizon_middle+horizon_roll_pixels_,canvas_width,horizon_middle-horizon_roll_pixels);
                            g.drawLine(0,horizon_middle+horizon_roll_pixels_,canvas_width,horizon_middle+horizon_roll_pixels);
                            g.fillRect(0,horizon_middle+horizon_roll_pixels_,canvas_width,canvas_height-(horizon_middle+horizon_roll_pixels_));
                        }
                    else
                        {
                            g.drawLine(0,horizon_middle+horizon_roll_pixels,canvas_width,horizon_middle-horizon_roll_pixels_);
                            g.drawLine(0,horizon_middle-horizon_roll_pixels,canvas_width,horizon_middle-horizon_roll_pixels_);
                            g.fillRect(0,horizon_middle-horizon_roll_pixels_,canvas_width,canvas_height-(horizon_middle-horizon_roll_pixels_));
                        }


                    g.setColor(0x254d9e);  
                    g.fillArc((canvas_width-nick_size)/2- nick_pixels_x, horizon_middle-nick_size/2+ nick_pixels_y, nick_size, nick_size, 0,360);

                    //              for (i=0;i<horizon_roll_pixels
                    //               g.fillArc(0, 0, canvas_width, canvas_width, 0,45);
                   
/*
  int start_angle=(360+mk.gps_position.angle2wp(act_wp) - ((360+mk.debug_data.analog[26]-heading_offset)%360))%360;
                    //              start_angle=0;
                    start_angle=(360-start_angle +90 -(45/2))%360;

                    g.fillArc(0, 0, canvas_width, canvas_width, start_angle,45);
*/

                    //              g.drawArc(1, 1, canvas_width-2, canvas_width-2, start_angle,45);
                    // g.drawArc(2, 2, canvas_width-4, canvas_width-4, start_angle  ,45);


                    g.setColor(skin_fg_color());



                    if (settings.expert_mode)
                        {
                            g.drawString("nick => " + mk.angle_nick,0,y_off,Graphics.TOP | Graphics.LEFT);
                            y_off+=spacer;

                            g.drawString("roll => " + mk.angle_roll,0,y_off,Graphics.TOP | Graphics.LEFT);
                            y_off+=spacer;
                        }
                    break;

                case STATEID_DATABUFF:
                    g.setFont(f2);

                    int lines2paint=(((canvas_height-y_off)/spacer1));
                    y_off=canvas_height-spacer1;

                    for (int pos_y=0;pos_y<lines2paint;pos_y++)
                        {
                           
                            g.drawString(mk.get_buff(pos_y) ,0,y_off,Graphics.TOP | Graphics.LEFT);
                            y_off-=spacer1;
                        }
                    break;

                case STATEID_SUCCESS_MSG:
                case STATEID_ERROR_MSG:
                    if (err_img!=null)
                        {
                            int err_img_left=(canvas_width-err_img.getWidth()/2)/2;
                            int err_img_top=(canvas_height-err_img.getHeight())/2;
                            if (err_img_top<0)err_img_top=0;
                            g.setClip(err_img_left,err_img_top,err_img.getWidth()/2,err_img.getHeight());
                            g.drawImage(err_img,err_img_left-((state==STATEID_SUCCESS_MSG)?0:(err_img.getWidth()/2)),err_img_top, g.TOP | g.LEFT);
                        }
                            paint_lcd(g);

                     break;

                case STATEID_GPSVIEW:

                    g.setFont(f2);

                    g.setStrokeStyle(Graphics.SOLID);  
                    g.setColor(0x0000ff);  


                    //              g.fillArc(0, 0, canvas_width, canvas_width, 0,45);

/*
  int start_angle=(360+mk.gps_position.angle2wp(act_wp) - ((360+mk.debug_data.analog[26]-heading_offset)%360))%360;
                    //              start_angle=0;
                    start_angle=(360-start_angle +90 -(45/2))%360;

                    g.fillArc(0, 0, canvas_width, canvas_width, start_angle,45);
*/

                    //              g.drawArc(1, 1, canvas_width-2, canvas_width-2, start_angle,45);
                    // g.drawArc(2, 2, canvas_width-4, canvas_width-4, start_angle  ,45);


                    g.setColor(skin_fg_color());

                    g.drawString("Used Sats: " + mk.gps_position.SatsInUse + " | Packages: " + mk.stats.navi_data_count ,0,y_off,Graphics.TOP | Graphics.LEFT);  
                    y_off+=spacer1;

                    g.drawString("Lat: " + mk.gps_position.Latitude_str() ,0,y_off,Graphics.TOP | Graphics.LEFT);
                    y_off+=spacer1;

                    g.drawString("Long: " + mk.gps_position.Longitude_str() ,0,y_off,Graphics.TOP | Graphics.LEFT);
                    y_off+=spacer1;

                    g.drawString("Altitude: " + mk.gps_position.Altitude ,0,y_off,Graphics.TOP | Graphics.LEFT);
                    y_off+=spacer1;

                    g.drawString("GrSpeed: " + mk.gps_position.GroundSpeed_str() ,0,y_off,Graphics.TOP | Graphics.LEFT);
                    y_off+=spacer1;

                    g.drawString("Heading: " + mk.gps_position.Heading ,0,y_off,Graphics.TOP | Graphics.LEFT);
                    y_off+=spacer1;

                    g.drawString("CompasHeading: " + mk.gps_position.CompasHeading ,0,y_off,Graphics.TOP | Graphics.LEFT);
                    y_off+=spacer1;
                   

                    g.drawString("Target-Lat: " + mk.gps_position.TargetLatitude_str() ,0,y_off,Graphics.TOP | Graphics.LEFT);
                    y_off+=spacer1;
                    g.drawString("Target-Long: " + mk.gps_position.TargetLongitude_str() ,0,y_off,Graphics.TOP | Graphics.LEFT);
                    y_off+=spacer1;

                    g.drawString("Target-Alt: " + mk.gps_position.TargetAltitude ,0,y_off,Graphics.TOP | Graphics.LEFT);
                    y_off+=spacer1;


                    g.drawString("Home-Lat: " + mk.gps_position.HomeLatitude_str() ,0,y_off,Graphics.TOP | Graphics.LEFT);
                    y_off+=spacer1;

                    g.drawString("Home-Long: " + mk.gps_position.HomeLongitude_str() ,0,y_off,Graphics.TOP | Graphics.LEFT);
                    y_off+=spacer1;

                    g.drawString("Home-Alt: " + mk.gps_position.HomeAltitude ,0,y_off,Graphics.TOP | Graphics.LEFT);

                    y_off+=spacer1;
                    g.drawString("Distance : " + mk.gps_position.Distance2Target ,0,y_off,Graphics.TOP | Graphics.LEFT);
                    y_off+=spacer1;
                    g.drawString("Angle: " + mk.gps_position.Angle2Target ,0,y_off,Graphics.TOP | Graphics.LEFT);
                    y_off+=spacer1;

                    g.drawString("WayPoints: " + mk.gps_position.WayPointNumber + "/" +  mk.gps_position.WayPointIndex ,0,y_off,Graphics.TOP | Graphics.LEFT);
                    y_off+=spacer;



                    /*
                      g.drawString("" +  mk.gps_position.NameWP[act_wp] ,0,y_off,Graphics.TOP | Graphics.LEFT);
                    y_off+=spacer;

                    g.drawString("Lat: " +  mk.gps_position.WP_Latitude_str(act_wp) ,0,y_off,Graphics.TOP | Graphics.LEFT);
                    y_off+=spacer;

                    g.drawString("Long: " +  mk.gps_position.WP_Longitude_str(act_wp) ,0,y_off,Graphics.TOP | Graphics.LEFT);
                    y_off+=spacer;


                    g.drawString("Distance: " +  mk.gps_position.distance2wp(act_wp) ,0,y_off,Graphics.TOP | Graphics.LEFT);
                    y_off+=spacer;

                    g.drawString("Angle: " +  mk.gps_position.angle2wp(act_wp) ,0,y_off,Graphics.TOP | Graphics.LEFT);
                    y_off+=spacer;

                    g.drawString("Compas Heading: " +  (360+mk.debug_data.analog[26]-heading_offset)%360) + "("  +mk.debug_data.analog[26] +")" ,0,y_off,Graphics.TOP | Graphics.LEFT);
                    y_off+=spacer;
                    */

                   

                    break;

                case STATEID_RESET_PARAMS:
                case STATEID_FLASHING:
                    g.setFont(f2);
                    int msg_pos=0;
                    while (mk.flash_msgs[msg_pos]!=null)
                        {
                            g.drawString(mk.flash_msgs[msg_pos] ,0,y_off,Graphics.TOP | Graphics.LEFT);
                            y_off+=spacer1;
                            msg_pos++;
                        }
                    break;

                case STATEID_CAMMODE:

                    if (cam_img!=null)
                        g.drawImage(cam_img,0,0,g.TOP | g.LEFT);
                    g.drawString("condition: " + cam_condition() ,0,y_off,Graphics.TOP | Graphics.LEFT);
                    y_off+=spacer;
                    g.drawString("width " + cam_img.getWidth(),0,y_off,Graphics.TOP | Graphics.LEFT);
                    y_off+=spacer;
                    g.drawString("height " + cam_img.getHeight(),0,y_off,Graphics.TOP | Graphics.LEFT);
                    y_off+=spacer;
                    break;

                case STATEID_STICKVIEW:

                    for(int tmp_y=0;tmp_y<10;tmp_y++)
                        {
                            g.drawString(""+tmp_y+"(" + l(mk.params.stick_stringids[tmp_y]) + ")=>"+mk.stick_data.stick[tmp_y],0,y_off,Graphics.TOP | Graphics.LEFT);
                            y_off+=spacer;
                        }
                    break;

                case STATEID_KEYCONTROL:

                    y_off+=spacer;
                    g.drawString("UP or DOWN =>nick " + mk.extern_control[EXTERN_CONTROL_NICK],0,y_off,Graphics.TOP | Graphics.LEFT);
                    y_off+=spacer;
                    g.drawString("LEFT or RIGHT =>roll " + mk.extern_control[EXTERN_CONTROL_ROLL],0,y_off,Graphics.TOP | Graphics.LEFT);
                    y_off+=spacer;
                    g.drawString("1 or 4 =>altitude  " + mk.extern_control[EXTERN_CONTROL_HIGHT],0,y_off,Graphics.TOP | Graphics.LEFT);

                    y_off+=spacer;
                    g.drawString("2 or 3 =>gier " + mk.extern_control[EXTERN_CONTROL_GIER],0,y_off,Graphics.TOP | Graphics.LEFT);

                    y_off+=spacer;
                    g.drawString("6 or 9 =>gas " + mk.extern_control[EXTERN_CONTROL_GAS],0,y_off,Graphics.TOP | Graphics.LEFT);

                    y_off+=spacer;
                    g.drawString("* and # =>exit",0,y_off,Graphics.TOP | Graphics.LEFT);
                    y_off+=spacer;
                    /*              g.drawString("* and Fire =>Start Engines",0,y_off,Graphics.TOP | Graphics.LEFT);
                    y_off+=spacer;
                    g.drawString("* and 0 =>Stop Engines",0,y_off,Graphics.TOP | Graphics.LEFT);
                    y_off+=spacer;
                    */

                    g.drawString("sent:" + mk.stats.external_control_request_count   +"confirm:" + mk.stats.external_control_confirm_frame_count,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] ,canvas_width/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(canvas_width/(8*2)+bar*2*canvas_width/8,y_off+10,canvas_width/8,y_off+20+motor_test[bar]);
                            g.setColor(0x000000);
                            g.drawString(""+motor_test[bar] ,canvas_width/8+bar*2*canvas_width/8,y_off+10,Graphics.TOP | Graphics.HCENTER);
                            g.drawString(""+mk.debug_data.motor_val(bar) ,canvas_width/8+bar*2*canvas_width/8,y_off+25,Graphics.TOP | Graphics.HCENTER);
                        }
                    g.setColor(skin_fg_color());
                    g.drawString(""+mk.debug_data.analog[2]+"<->"+mk.debug_data.analog[3] ,0,canvas_height-30,Graphics.TOP | Graphics.LEFT);
                    break;

                case STATEID_EDIT_PARAMS:
                    params_editor.paint(g);
                    break;



//#if fileapi=="on"
                case STATEID_FILEOPEN:
                    y_off+=spacer;
                    g.drawString("act_path" + file_access.act_path() ,0,y_off,Graphics.TOP | Graphics.LEFT);
                    paint_menu(g);
                    break;
//#endif


                case STATEID_SHOWPHONEGPS:
                    y_off+=spacer;
                    g.drawString("lat" + phone_lat ,0,y_off,Graphics.TOP | Graphics.LEFT);
                    y_off+=spacer;
                    g.drawString("long" + phone_long ,0,y_off,Graphics.TOP | Graphics.LEFT);

                    break;


                case STATEID_SELECT_FIRMWARE:
                case STATEID_SELECT_COMPORT:
                case STATEID_PARAM_MENU:
                    paint_menu(g);
                    break;
                case STATEID_STRINGINPUT:
                case STATEID_ABOUT:
                case STATEID_IPINPUT:
                case STATEID_PARAM_MASSWRITE:
                case STATEID_READ_PARAMS:
//#if bluetooth=="on"
                case STATEID_SCANNING:
//#endif
                    paint_lcd(g);
                    break;



                case STATEID_RAWDEBUG: 
                    g.setFont(f2);
                    rawdebug_off_y=0;
                    if ((rawdebug_cursor_y+3)*spacer1>canvas_height)
                        rawdebug_off_y=((rawdebug_cursor_y+3)*spacer1-canvas_height)/spacer1;
                    for (int i=0;i<(canvas_height/spacer1)-1;i++)
                        {
                            if (i+rawdebug_off_y==rawdebug_cursor_y)
                                {
                                g.setColor(0x0000CC);
                                g.fillRect(0,y_off,canvas_width,spacer1);

                                g.setColor(skin_fg_color());


                                }
                            if (i+rawdebug_off_y<32) //todo better style
                                g.drawString(mk.debug_data.names[i+rawdebug_off_y] + mk.debug_data.analog[i+rawdebug_off_y] ,0,y_off,Graphics.TOP | Graphics.LEFT);
                           
                            y_off+=spacer1;
                           
                        }



                    break;

               
                case STATEID_CONN_DETAILS:     
                    g.setFont(f1);
                    g.drawString(l(STRINGID_CONN)+":",0,y_off,Graphics.TOP | Graphics.LEFT);
                    y_off+=spacer;
                    g.setFont(f2);

                    g.drawString(" URL:" + mk.mk_url,0,y_off,Graphics.TOP | Graphics.LEFT);
                    y_off+=spacer1;

                    g.drawString(" Name:" + mk.name,0,y_off,Graphics.TOP | Graphics.LEFT);
                    y_off+=spacer1;

                    g.drawString(" "+mk.ufo_prober.extended_name()+ " (" + (mk.connected?("open"+((System.currentTimeMillis()- mk.connection_start_time)/1000)+"s"):"closed")+"):",0,y_off,Graphics.TOP | Graphics.LEFT);
                    y_off+=spacer1;
                    g.drawString(" Software Version:" + mk.version.version_str ,0,y_off,Graphics.TOP | Graphics.LEFT);
                    y_off+=spacer1;

                    g.drawString(" Protocol Version:" + mk.version.proto_str ,0,y_off,Graphics.TOP | Graphics.LEFT);
                    y_off+=spacer1;
                    g.drawString(" Slave-Addr:" + mk.slave_addr,0,y_off,Graphics.TOP | Graphics.LEFT);

                    paint_menu(g);

                    break;

                case STATEID_TRAFFIC:
                                   
                    g.setFont(f1);
                    g.drawString("Packet Traffic (over "+mk.conn_time_in_s()+"s):",0,y_off,Graphics.TOP | Graphics.LEFT);
                    y_off+=spacer;
                    g.setFont(f2);
                    g.drawString( ">>in:"+mk.stats.bytes_in+ " bytes => " + mk.stats.bytes_in/mk.conn_time_in_s() + " bytes/s",0,y_off,Graphics.TOP | Graphics.LEFT);
                    y_off+=spacer1;




                    g.drawString( " debug:"+mk.stats.debug_data_count+ " LCD:" + mk.stats.lcd_data_count + " vers:" + mk.stats.version_data_count,0,y_off,Graphics.TOP | Graphics.LEFT);
                    y_off+=spacer1;
                    g.drawString( " rc:"+mk.stats.stick_data_count+" params:"+mk.stats.params_data_count + " GPS:"+mk.stats.navi_data_count ,0,y_off,Graphics.TOP | Graphics.LEFT);
                    y_off+=spacer1;
                    g.drawString( " debug_names:" + mk.stats.debug_names_count + " angles:" + mk.stats.angle_data_count ,0,y_off,Graphics.TOP | Graphics.LEFT);

                    y_off+=spacer1;
                    g.drawString( " other:"+mk.stats.other_data_count,0,y_off,Graphics.TOP | Graphics.LEFT);

                    y_off+=spacer1+3;
                    g.drawString( "<<out:"+mk.stats.bytes_out + " bytes =>" + mk.stats.bytes_out/mk.conn_time_in_s() + "bytes/s", 0,y_off,Graphics.TOP | Graphics.LEFT);
                    y_off+=spacer1;
                    g.drawString( " LCD:" + mk.stats.lcd_data_request_count + " vers:" + mk.stats.version_data_request_count,0,y_off,Graphics.TOP | Graphics.LEFT);
                    y_off+=spacer1;
                    g.drawString( " params:"+mk.stats.params_data_request_count +" rc:" + mk.stats.stick_data_request_count ,0,y_off,Graphics.TOP | Graphics.LEFT);
                    y_off+=spacer1;

                    g.drawString( " resend:"+mk.stats.resend_count ,0,y_off,Graphics.TOP | Graphics.LEFT);
                    y_off+=spacer1;

                    paint_menu(g);
                    break;

                case STATEID_PROXY:    
                    g.setFont(f1);
                    g.drawString("Host:",0,y_off,Graphics.TOP | Graphics.LEFT);
                    y_off+=spacer;
                    g.setFont(f2);
                    g.drawString(" " + mk.proxy.url + "("+((mk.proxy.connected)?"open":"closed") +")",0,y_off,Graphics.TOP | Graphics.LEFT);
                    y_off+=spacer1;

                   

                    break;

                case STATEID_SETTINGSMENU:

                    settings_editor.paint(g);
                    break;
                // falltru wanted
                case STATEID_MAINMENU: 
                case STATEID_SELECT_PARAMSET:
                case STATEID_HANDLE_PARAMS:
                case STATEID_DEVICESELECT:

                    paint_menu(g);
                    break;
                   

                case STATEID_GRAPH:
   
                    g.setClip(0,0,canvas_width,canvas_height);

                    g.setStrokeStyle(Graphics.DOTTED);  
                    g.setColor(0xe1dddd);
                    g.setFont(f2);
                    // LEGEND
                    if (settings.graph_legend)
                        for (int d=0;d<GRAPH_COUNT;d++)
                            {/*
                               g.setColor(graph_colors[d]);            
                               g.fillRect(0,y_off +spacer1/2-2 ,20,4);
                               g.setColor(skin_fg_color());
                               g.drawString(graph_names[d] + mk.debug_data.analog[graph_sources[d]],23,y_off,Graphics.TOP | Graphics.LEFT);
                               y_off+=spacer1;
                               
                             */

                                g.setColor(graph_colors[d]);           
                                g.fillRect(canvas_width-20,canvas_height-spacer*(d+1)+(spacer)/2-2 ,20,4);
                                g.setColor(skin_fg_color());
                                g.drawString(graph_names[d] /*+ mk.debug_data.analog[graph_sources[d]]*/,canvas_width-23,canvas_height-spacer*(d+1),Graphics.TOP | Graphics.RIGHT);
                                //                          y_off+=spacer1;
                               
                            }

                    if (settings.graph_scale)
                        {
                           
                            int scale=10;
                            //                      if ((10/line_scaler)<5)scale =1;
                            if (((10/line_scaler)*2)<(canvas_height/2) )scale =10;
                            if (((50/line_scaler)*2)<(canvas_height/2) )scale =50;
                            if (((100/line_scaler)*2)<(canvas_height/2) )scale =100;
                            if (((250/line_scaler)*2)<(canvas_height/2) )scale =250;
                            if (((500/line_scaler)*2)<(canvas_height/2) )scale =500;
                            if (((1000/line_scaler)*2)<(canvas_height/2) )scale =1000;
                            if (((10000/line_scaler)*2)<(canvas_height/2) )scale =10000;




                            //                      g.drawString("scale:"+scale + "line scaler" + line_scaler,0,y_off,Graphics.TOP | Graphics.LEFT);


                            int jump=0;

                            g.drawLine(0,line_middle_y,canvas_width,line_middle_y);
                           
                            while ((jump/line_scaler)<graph_height)
                                {
                                   
                                    g.drawString(""+jump,0,line_middle_y - jump/line_scaler,Graphics.TOP | Graphics.LEFT);
                                    if (jump!=0)g.drawString("-"+jump,0,line_middle_y + jump/line_scaler,Graphics.TOP | Graphics.LEFT);
                                    g.drawLine(0,line_middle_y - jump/line_scaler,canvas_width,line_middle_y - jump/line_scaler);
                                    g.drawLine(0,line_middle_y + jump/line_scaler,canvas_width,line_middle_y + jump/line_scaler);
                                    jump+=scale;
                                }
                        }



                    for (int gr=0;gr<GRAPH_COUNT;gr++)
                        {


                            // !!TODO checkme
                            g.setColor(graph_colors[gr]);              

                            graph_data[gr][-graph_offset]=check_local_max(mk.debug_data.analog[graph_sources[gr]]);

                           
                   
                            line_scaler= local_max/graph_height+1;


                            for ( int x=0;x<canvas_width;x++)
                                {
                                    int p= (((-graph_offset+x-canvas_width-5)));
                                    if (p<1)
                                        p+=graph_data[0].length;
                                    p%=(graph_data[0].length-1);
                                   
                                    draw_graph_part(g,x,graph_data[gr][p]/line_scaler,graph_data[gr][p+1]/line_scaler);
                               
                                }
                        }



                    break;

                case STATEID_LCD:
                    /*
                    g.setClip(canvas_width/2-load_img.getWidth()/6+1,canvas_height/2-load_img.getHeight()/8+1, load_img.getWidth()/4,load_img.getHeight()/3);;
                    if (( mk.LCD.init_state!=-1)||(mk.LCD.act_mk_page!=mk.LCD.act_user_page)) g.drawImage(load_img,canvas_width/2-load_img.getWidth()/8 - ((((frame_pos/3)%12)%4)*(load_img.getWidth()/4)) ,canvas_height/2-load_img.getHeight()/6- ((((frame_pos/3)%12)/4)*(load_img.getHeight()/3)), g.TOP | g.LEFT);            

                    */

                    /*
                    // !!TODO!! check exactly which version those Datas where introduced
                    if (mk.version.compare(0,60)==mk.version.VERSION_PREVIOUS)
                        {
                            g.drawString("Voltage: " + (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(),canvas_width/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+=spacer;
                            g.drawString("lcd:" + mk.LCD.act_mk_page + "/" + mk.LCD.pages + " ( wanted: " + mk.LCD.act_user_page + "state:" + mk.LCD.init_state +")" ,0,y_off,Graphics.TOP | Graphics.LEFT);

                            y_off+=spacer;
                            g.drawString("lcd-key:" + mk.LCD.act_key ,0,y_off,Graphics.TOP | Graphics.LEFT);

                        }
*/

                   
                    int spacer_left_right=(canvas_width-(20*(lcd_img.getWidth()/222)))/2;

                    y_off=canvas_height-4*lcd_img.getHeight();
                   
                    for ( int foo=0;foo<4;foo++)
                        {
                            for (int x=0;x<20;x++)
                                {
                                    g.setClip(spacer_left_right+(lcd_img.getWidth()/222)*x,y_off,(lcd_img.getWidth()/222),lcd_img.getHeight());
                                            g.drawImage(lcd_img,spacer_left_right+(lcd_img.getWidth()/222)*x-(mk.LCD.get_act_page()[foo].charAt(x)-' ')*(lcd_img.getWidth()/222),y_off, g.TOP | g.LEFT);

                                        }
                                    y_off+=lcd_img.getHeight();
                                }

                    g.setClip(0,0,canvas_width,canvas_height);

                }

               

        } catch (Exception e) {}

    }
    Player mPlayer;
    VideoControl        mVideoControl;
    Image cam_img;
    Image last_cam_img;
    int cam_img_seq=0;
    byte[] cam_raw;

    private void connect_mk(String url,String name)
    {
        //      mk.ufo_prober.bluetooth_probe(url);
        settings.connection_url=url;
        settings.connection_name=name;
        mk.connect_to(url,name);
    }

    public void draw_graph_part(Graphics g,int x,int y1,int y2)
    {
        if ( canvas_width>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;
    //    boolean init_bootloader=false;
    String success_msg="";

    public void chg_state(byte next_state)
    {
        settings_editor = null;
        params_editor = null;
        err_img=null;
        graph_data=null;

        act_menu_select_bak[state]=act_menu_select;
        act_menu_select=act_menu_select_bak[next_state];


        /*
        // tasks on state exit
        switch(next_state)
            {
            case STATEID_SETTINGSMENU:

                break;
            }
        */

        // prepare next state
        switch(next_state)

            {
                //          case STATEID_COPY_PARAMS:
               
                //break;

            case STATEID_SELECT_FIRMWARE:
               


                fw_loader=new FirmwareLoader();
                setup_menu(new String[0],new byte[0]);

                break;


            case STATEID_SUCCESS_MSG:
            case STATEID_ERROR_MSG:
                lcd_lines=new String[1];
               
                lcd_lines[0]=""+((next_state==STATEID_SUCCESS_MSG)?success_msg:mk.error_str);
                try
                    {
                        err_img=Image.createImage("/preflight.jpg");       
                    }
                catch (Exception e)        
                    {    
                        debug.log("problem loading error image");
                    }
               
                break;
            case STATEID_EDIT_PARAMS:
                params_editor = new MKParamsEditor(this,mk.params,STATEID_HANDLE_PARAMS);
                break;
            case STATEID_STRINGINPUT:
                lcd_lines=new String[2];
                lcd_lines[0]=act_input_str;
                lcd_lines[1]="^";
               
                break;
            case STATEID_LCD:
                mk.user_intent=USER_INTENT_LCD;
                break;
            case STATEID_RESET_PARAMS:

                mk.bootloader_intension_flash=false;
                mk.bl_retrys=0;
                mk.init_bootloader=true;
                break;

            case STATEID_FLASHING:
                mk.bootloader_intension_flash=true;
                mk.bl_retrys=0;
                mk.init_bootloader=true;
                break;

 //#if fileapi=="on"
            case STATEID_FILEOPEN:
                file_access.trigger();
                break;
//#endif

            case STATEID_STICKVIEW:
                mk.user_intent=USER_INTENT_RCDATA;
                break;
            case STATEID_SELECT_COMPORT:       
                menu_items=DUBwiseHelper.split_str(System.getProperty("microedition.commports")+",back",",");
                setup_menu(menu_items,null);
                break;


            case STATEID_ABOUT:
                lcd_lines=credits;
                lcd_lines[1]=" ufo-lib: " + mk.lib_version_str();
                act_menu_select=max_lines-1;
                break;
            case STATEID_CONN_DETAILS: 
                setup_conn_menu();//conn_details_menu_items,conn_details_menu_actions);
                break;


            case STATEID_PARAM_MENU:
                setup_menu(param_menu_items,param_menu_actions);
                break;
            case STATEID_TRAFFIC:      
                setup_menu(onlyback_menu_items,back_to_conndetails_actions);
                break;
            case STATEID_CAMMODE:
                mk.user_intent=USER_INTENT_RCDATA;
                if (mVideoControl==null)
                    try
                        {
                            debug.log("creating player\n");
                            mPlayer = Manager.createPlayer("capture://video?encoding=png&width=2048&height=1536");
                           
                            debug.log("realizing player\n");
                            mPlayer.realize();
                           
                            debug.log("get_videocontrol\n");
                           
                            mVideoControl = (VideoControl)mPlayer.getControl("VideoControl");
                           
                            debug.log("switching Canvas\n");
                            mVideoControl.initDisplayMode(VideoControl.USE_DIRECT_VIDEO, this);
                       
                            debug.log("get snap\n");
                            byte[] raw = mVideoControl.getSnapshot(null);    
                         
                        }
                    catch ( Exception e)
                        {
                            debug.log(e.toString());
                        }


                break;
            case STATEID_KEYCONTROL:
                mk.user_intent= USER_INTENT_EXTERNAL_CONTROL;
                keycontrol_exit=0;
                break;


            case STATEID_PARAM_MASSWRITE:
                mk.user_intent=USER_INTENT_PARAMS;
                lcd_lines=new String[2];
                lcd_lines[0]="";
                lcd_lines[1]="";
                break;

            case STATEID_READ_PARAMS:
                mk.user_intent=USER_INTENT_PARAMS;
                lcd_lines=new String[2];
                lcd_lines[0]="Reading Settings    ";
                lcd_lines[1]=DUBwiseHelper.pound_progress(mk.watchdog.act_paramset,5);

                break;

            case STATEID_IPINPUT:
               
                lcd_lines=new String[3];
                lcd_lines[0]="Address (IP:Port):  ";
                break;

//#if bluetooth=="on"
            case STATEID_SCANNING:
                lcd_lines=new String[3];
                lcd_lines[0]="Searching for";
                lcd_lines[1]="Bluetooth Devices";
                lcd_lines[2]="found";

                mk.close_connections(true);
                bt_scanner.search();
                break;
//#endif

            case STATEID_HANDLE_PARAMS:
                setup_menu(handle_params_menu_items,handle_params_menu_actions);
                break;

            case STATEID_SELECT_PARAMSET:
                menu_items=new String[6];
                for (int i=0;i<5;i++)
                    menu_items[i]=""+(i+1)+": " + mk.params.getParamName(i) + ((i==mk.params.active_paramset)?"*":"");

                menu_items[5]=l(STRINGID_BACK);
                lcd_lines=new String[6];
                break;

//#if bluetooth=="on"
            case STATEID_DEVICESELECT:
               
                menu_items=new String[bt_scanner.remote_device_count+2];
                lcd_lines=new String[bt_scanner.remote_device_count+2];

                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";
                menu_items[bt_scanner.remote_device_count+1]="cancel";

                break;
//#endif

            case STATEID_MAINMENU:
                setup_main_menu();

                break;

            case STATEID_SETTINGSMENU:
                settings_editor = new MKParamsEditor(this,settings,STATEID_MAINMENU);
                /*
                menu_items=new String[settings_menu_items.length];
                for(int cnt=0;cnt<settings_menu_items.length;cnt++)
                    menu_items[cnt]=settings_menu_items[cnt];

                menu_items[0]+=(settings.act_skin==SKINID_DARK)?"Dark":"Light";
                menu_items[1]+=(!settings.do_sound)?"Off":"On";
                menu_items[2]+=(!settings.do_vibra)?"Off":"On";
                menu_items[3]+=(!settings.do_scrollbg)?"Off":"On";
                menu_items[4]+=(!settings.fullscreen)?"Off":"On";
                menu_items[5]+=(mk.gps_position.act_gps_format==0)?" Decimal":" MinSec";
                menu_items[6]+=(mk.gps_position.act_speed_format==0)?" KM/H":((mk.gps_position.act_speed_format==1)?" MP/H":"CM/S");

//#if devicecontrol=="on"
                menu_items[7]+=(!settings.keep_lighton)?"Off":"On";
//#endif
                menu_items[8]+=(!settings.expert_mode)?" Off":" On";
                menu_actions=settings_menu_actions;
                lcd_lines=new String[menu_items.length];*/

                break;

            case STATEID_RAWDEBUG:
                mk.user_intent=USER_INTENT_RAWDEBUG;
                break;


            case STATEID_GRAPH:
                graph_data=new int[GRAPH_COUNT][this.getWidth()*2];
               
                for (int c=0;c<graph_data[0].length;c++)
                    for (int d=0;d<GRAPH_COUNT;d++)
                        graph_data[d][c]=-1;
       
       
                mk.user_intent=USER_INTENT_GRAPH;
                local_max=1;
                break;

            }
        mk.watchdog.resend_timeout=0;

        // switch state
        state=next_state;
    } // void chg_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
                    mod_external_control_by_keycode(keyCode,(byte)0);

                    /*
                mk.send_keys(keycontrol_bitfield);
                    */

                break;
            }

    }


    public void mod_external_control_by_keycode(int keyCode,byte mul)
    {

        if (keyCode==this.KEY_NUM2)
                mk.extern_control[EXTERN_CONTROL_GIER]=(byte)(-mul*settings.default_extern_control[EXTERN_CONTROL_GIER]);
        else if (keyCode==this.KEY_NUM3)
                mk.extern_control[EXTERN_CONTROL_GIER]=(byte)(mul*settings.default_extern_control[EXTERN_CONTROL_GIER]);

        else if (keyCode==this.KEY_NUM1)
            mk.extern_control[EXTERN_CONTROL_HIGHT]+=mul*settings.default_extern_control[EXTERN_CONTROL_HIGHT];
        else if (keyCode==this.KEY_NUM4)
            mk.extern_control[EXTERN_CONTROL_HIGHT]-=mul*settings.default_extern_control[EXTERN_CONTROL_HIGHT];


        else if (keyCode==this.KEY_NUM6)
            { if ( mk.extern_control[EXTERN_CONTROL_GAS]<255) mk.extern_control[EXTERN_CONTROL_GAS]+=mul*settings.default_extern_control[EXTERN_CONTROL_GAS]; }
        else if (keyCode==this.KEY_NUM9)
            { if ( mk.extern_control[EXTERN_CONTROL_GAS]>0) mk.extern_control[EXTERN_CONTROL_GAS]-=mul*settings.default_extern_control[EXTERN_CONTROL_GAS]; }

        else switch (getGameAction (keyCode))
                    {
                    case UP:
                        mk.extern_control[EXTERN_CONTROL_NICK]=(byte)(mul*settings.default_extern_control[EXTERN_CONTROL_NICK]);
                        break;
                       
                    case DOWN:
                        mk.extern_control[EXTERN_CONTROL_NICK]=(byte)(-mul*settings.default_extern_control[EXTERN_CONTROL_NICK]);

                        break;
                       
                       
                    case LEFT:
                        mk.extern_control[EXTERN_CONTROL_ROLL]=(byte)(mul*settings.default_extern_control[EXTERN_CONTROL_ROLL]);
                        break;
                       
                    case RIGHT:
                        mk.extern_control[EXTERN_CONTROL_ROLL]=(byte)(-mul*settings.default_extern_control[EXTERN_CONTROL_ROLL]);
                        break;
                       
                    case FIRE:

                        break;
                       
                       
                    }

    }


   
    public final static String PARAM_SAVE_STORE_NAME="MKParamsV1";

   
    int[][] params2masswrite;
    int     param_masswrite_write_pos;
   

    double phone_lat=0.0;
    double phone_long=0.0;

    public void process_action(byte actionid)
    {
        switch(actionid)
            {
            case ACTIONID_UPDATE_DUBWISE:
                try
                    {
                        root.platformRequest("http://mikrocontroller.cco-ev.de/mikrosvn/Projects/DUBwise/trunk/j2me/bin/240x320/cldc11/en_speedy/bluetooth_on/fileapi_on/devicecontrol_on/DUBwise-240x320-cldc11-en_speedy-all_firmwares-bluetooth_on-fileapi_on-devicecontrol_on.jad");
                    }
                catch(Exception e) { }
                break;


            case ACTIONID_SHOWPHONEGPS:
                chg_state(STATEID_SHOWPHONEGPS);
                break;

            case ACTIONID_PARAM_LOAD_MOBILE:
                try
                    {
                        RecordStore recStore = RecordStore.openRecordStore(PARAM_SAVE_STORE_NAME , true );
                       
                        if (recStore.getNumRecords()==1)
                            {
                                ByteArrayInputStream bin = new ByteArrayInputStream(recStore.getRecord(1));
                                DataInputStream      din = new   DataInputStream( bin );


                                // params_version
                                if ( mk.params.params_version!=din.readInt())
                                    {
                                        mk.error_str=l(STRINGID_PARAMSINCOMPATIBLE);
                                        chg_state(STATEID_ERROR_MSG);
                                        break;
                                    }

                                int p_length=din.readInt();
                                params2masswrite=new int[5][p_length];

                                for ( int p=0;p<5;p++)
                                    for ( int p_pos=0;p_pos<p_length;p_pos++)
                                        params2masswrite[p][p_pos]=din.readInt();

                                param_masswrite_write_pos=0;
                                chg_state(STATEID_PARAM_MASSWRITE);
                            }
                        else throw(new Exception("rms err"));
                        recStore.closeRecordStore();
                    }
                catch (Exception e)
                    {
                        mk.error_str=l(STRINGID_NOPARAMSONMOBILE);
                        chg_state(STATEID_ERROR_MSG);
                    }


                break;
               
            case ACTIONID_SELECT_FIRMWARE:
                chg_state(STATEID_SELECT_FIRMWARE);
                break;
            case ACTIONID_PARAM_COPY_MOBILE:
                read_paramset_intension_save=true;
                chg_state(STATEID_READ_PARAMS);
                break;

            case ACTIONID_PARAM_MENU:
                chg_state(STATEID_PARAM_MENU);
                break;
                               
            case ACTIONID_PARAM_WRITE_OK:
                success_msg=l(STRINGID_PARAMWRITEOK);
                chg_state(STATEID_SUCCESS_MSG);
                break;
            case ACTIONID_HORIZON:
                chg_state(STATEID_HORIZON);
                break;

            case ACTIONID_RENAME_PARAMS:
                act_input_str=mk.params.getParamName(mk.params.act_paramset);
                ipinput_pos=0;
                chg_state(STATEID_STRINGINPUT);
                break;


            case ACTIONID_BACK_TO_CONNDETAILS:
                chg_state(STATEID_CONN_DETAILS);
                break;

            case ACTIONID_RESET_PARAMS:
                chg_state(STATEID_RESET_PARAMS);
                //                              state=STATEID_FLASHING;

                break;

            case ACTIONID_FLASH:
                chg_state(STATEID_FLASHING);
                break;
                                       
            case ACTIONID_DATABUFF:
                chg_state(STATEID_DATABUFF);
                break;
                                   
            case ACTIONID_NC_ERRORS:
                chg_state(STATEID_ERROR_MSG);
                break;

            case ACTIONID_ABOUT:
                chg_state(STATEID_ABOUT);
                break;

            case ACTIONID_CONN_DETAILS:
                chg_state(STATEID_CONN_DETAILS);
                break;
                               
            case ACTIONID_QUIT:
                quit=true;
                break;

            case ACTIONID_SWITCH_NC:
                mk.switch_to_navi();
                break;

            case ACTIONID_SWITCH_FC:
                mk.switch_to_fc();
                break;

            case ACTIONID_SWITCH_MK3MAG:
                mk.switch_to_mk3mag();
                break;
                                 
            case ACTIONID_GRAPH:
                chg_state(STATEID_GRAPH);
                break;
                                 
            case ACTIONID_KEYCONTROL:
                chg_state(STATEID_KEYCONTROL);
                break;
                               
            case ACTIONID_LCD :
                chg_state(STATEID_LCD);
                break;

                               
            case ACTIONID_PROXY:

                chg_state(STATEID_IPINPUT);
                break;
                               
            case ACTIONID_DEVICESELECT:
                chg_state(STATEID_SCANNING);
                break;
                               
            case ACTIONID_RAWDEBUG:
                chg_state(STATEID_RAWDEBUG);
                break;
                               
            case ACTIONID_SETTINGS:
                chg_state(STATEID_SETTINGSMENU);
                break;

            case ACTIONID_RCDATA:
                chg_state(STATEID_STICKVIEW);
                break;

            case ACTIONID_CAM:
                chg_state(STATEID_CAMMODE);
                break;

            case ACTIONID_GPSDATA:
                chg_state(STATEID_GPSVIEW);
                break;


            case  ACTIONID_MOTORTEST :
                chg_state(STATEID_MOTORTEST);
                break;
                               

            case ACTIONID_EDIT_PARAMS:
                chg_state(STATEID_EDIT_PARAMS);
                break;
            case ACTIONID_SELECT_PARAMS:
                select_paramset4edit=true;
                read_paramset_intension_save=false;
                if (settings.reload_settings)
                    {  

                        mk.watchdog.act_paramset=0;
                        mk.params.reset();

                        chg_state(STATEID_READ_PARAMS);
                    }
                else
                    {
                        if (mk.watchdog.act_paramset!=5)
                            chg_state(STATEID_READ_PARAMS);
                        else
                            chg_state(STATEID_SELECT_PARAMSET);
                    }
                break;


            case ACTIONID_WRITE_PARAM_AS:
                select_paramset4edit=false;
                chg_state(STATEID_SELECT_PARAMSET);
                break;

            case ACTIONID_WRITE_PARAMS:
                mk.write_params(mk.params.act_paramset);
                success_msg=l(STRINGID_SAVEDSETTINGS); // too optimistic
                nextstate=STATEID_HANDLE_PARAMS;
                chg_state(STATEID_SUCCESS_MSG);
                break;

            case ACTIONID_UNDO_PARAMS:
                mk.params.use_backup();
                success_msg=l(STRINGID_SETTINGSUNDOOK); // too optimistic
                nextstate=STATEID_HANDLE_PARAMS;
                chg_state(STATEID_SUCCESS_MSG);

                break;

            case ACTIONID_MAINMENU:
                chg_state(STATEID_MAINMENU);
                break;

            case ACTIONID_DEBUG:
                debug.showing=true;
                break;

            case ACTIONID_TRAFFIC:
                chg_state(STATEID_TRAFFIC);
                break;

            case ACTIONID_CONNECT_TCP:
                ipinput4proxy=false;
                chg_state(STATEID_IPINPUT);
                break;

            case ACTIONID_SCAN_BT:
                chg_state(STATEID_SCANNING);
                break;

            case ACTIONID_SELECT_COM:
                chg_state(STATEID_SELECT_COMPORT);
                break;

            case ACTIONID_PROXY_INPUT:
                ipinput4proxy=true;
                chg_state(STATEID_IPINPUT);
                break;                     

            }
               
    }


    public void pointerPressed (int pointer_x, int pointer_y)
    {

        if (pointer_y<lcd_img.getHeight())
            keyPressed(KEY_STAR);
        else
            if (pointer_y>canvas_height-lcd_img.getHeight()*lcd_lines.length)
                switch(state)
                {
                case STATEID_SETTINGSMENU:

                    settings_editor.pointer_press(pointer_x,(pointer_y-(canvas_height-lcd_img.getHeight()*lcd_lines.length))/lcd_img.getHeight()) ;
                    break;

                case STATEID_EDIT_PARAMS:              
                    params_editor.pointer_press(pointer_x,(pointer_y-(canvas_height-lcd_img.getHeight()*lcd_lines.length))/lcd_img.getHeight()) ;

                    break;

                case STATEID_LCD:
                    if (pointer_x<(canvas_width/2))
                        keyPressed(getKeyCode(LEFT));
                    else
                        keyPressed(getKeyCode(RIGHT));
                    break;
                case STATEID_PARAM_MENU:
                case STATEID_CONN_DETAILS:
                case STATEID_HANDLE_PARAMS:
                case STATEID_FILEOPEN:
                case STATEID_TRAFFIC:
                case STATEID_SELECT_COMPORT:   
                case STATEID_MAINMENU:
                case STATEID_SELECT_PARAMSET:
                case STATEID_DEVICESELECT:
       

                    //      if (pointer_y>canvas_height-lcd_img.getHeight()*menu_items.length)
                    //  {                      
                    if (lcd_lines.length>max_lines)
                        act_menu_select=(pointer_y-(canvas_height-lcd_img.getHeight()*max_lines))/lcd_img.getHeight() +lcd_off ;
                        else
                        act_menu_select=(pointer_y-(canvas_height-lcd_img.getHeight()*lcd_lines.length))/lcd_img.getHeight() ;
                    keyPressed(getKeyCode(FIRE));
                            //}    
                    break;
                }
   
    }


    int last_keycode=-1;
    int repeat_keycode=0;
   
    public void keyPressed(int keyCode)
    {
        if (last_keycode==keyCode)
            repeat_keycode++;
        else
            {
                repeat_keycode=0;
                last_keycode=keyCode;
            }
       
        debug.log("KeyCode:"+keyCode);
        // key-actions common in all states
        debug.process_key(keyCode);
       
       
        if (((keyCode==KEY_STAR) || (keyCode==settings.key_back) )&&(state!=STATEID_KEYCONTROL))//&&(state!= STATEID_STRINGINPUT))
            {
                chg_state(STATEID_MAINMENU);
                return;
            }


        if (((keyCode==KEY_POUND)||(keyCode==settings.key_fullscreen))&&(state!=STATEID_KEYCONTROL))
            {
                settings.toggle_fullscreen();

                return;
            }

        // key actions per state
        switch(state)
            {

            case STATEID_SUCCESS_MSG:
                chg_state(nextstate);
                break;
            case STATEID_ERROR_MSG:
                chg_state(STATEID_MAINMENU);
                break;
            case STATEID_STRINGINPUT:
                if ((keyCode>=KEY_NUM2)&&(keyCode<=KEY_NUM9))
                    {
                        act_input_str=act_input_str.substring(0,ipinput_pos) +


                            (char)( 97 + (keyCode-KEY_NUM2)*3 + ((keyCode>KEY_NUM7)?1:0) +(repeat_keycode%(((keyCode==KEY_NUM7)||(keyCode==KEY_NUM9))?4:3)))

                            + act_input_str.substring(ipinput_pos+1,act_input_str.length());
                    }
                else if ((keyCode==KEY_NUM0))
                    {
                        act_input_str=act_input_str.substring(0,ipinput_pos) +
                            act_input_str.substring(ipinput_pos+1,act_input_str.length());
                    }
                else
                    {
                    switch (getGameAction (keyCode))
                        {

                        case LEFT:
                            if(ipinput_pos>0) ipinput_pos--;
                            break;
                           
                        case RIGHT:
                            if(ipinput_pos<19)  ipinput_pos++;
                            break;

                        case UP:
                            act_input_str=act_input_str.substring(0,ipinput_pos) +
                                (char)((byte) act_input_str.charAt(ipinput_pos)-1) + act_input_str.substring(ipinput_pos+1,act_input_str.length());

                            break;
                        case DOWN:
                            act_input_str=act_input_str.substring(0,ipinput_pos) +
                                (char)((byte) act_input_str.charAt(ipinput_pos)+1) + act_input_str.substring(ipinput_pos+1,act_input_str.length());

                            break;


                        case FIRE:
                            mk.params.set_name(act_input_str);
                            chg_state(STATEID_HANDLE_PARAMS);
                            break;
                        }
       
                    }
                if (act_input_str.length()<=ipinput_pos) act_input_str+=" ";
                break;
            case STATEID_IPINPUT:
                if ((keyCode>=KEY_NUM0)&&(keyCode<=KEY_NUM9))
                    {
                        act_edit_ip[ipinput_pos/4]=DUBwiseHelper.mod_decimal(act_edit_ip[ipinput_pos/4],(ipinput_pos<15?2:3)-(ipinput_pos%4),0,(keyCode-KEY_NUM0),9);

                        if(ipinput_pos<19)      ipinput_pos++;
                        if ((ipinput_pos<18)&&(((ipinput_pos+1)%4)==0))ipinput_pos++;
                    }
                else
                    switch (getGameAction (keyCode))
                            {
                            case LEFT:
                                if(ipinput_pos>0) ipinput_pos--;
                                if (((ipinput_pos+1)%4)==0)ipinput_pos--;
                                break;
                       
                            case RIGHT:
                                if(ipinput_pos<19)      ipinput_pos++;
                                if(ipinput_pos<18)if (((ipinput_pos+1)%4)==0)ipinput_pos++;
                                break;

                            case UP:
                                act_edit_ip[ipinput_pos/4]=DUBwiseHelper.mod_decimal(act_edit_ip[ipinput_pos/4],(ipinput_pos<15?2:3)-(ipinput_pos%4),1,-1,9);

                                break;

                            case DOWN:
                                act_edit_ip[ipinput_pos/4]=DUBwiseHelper.mod_decimal(act_edit_ip[ipinput_pos/4],(ipinput_pos<15?2:3)-(ipinput_pos%4),-1,-1,9);


                            case FIRE:
                                if (ipinput4proxy)
                                    {
                                        settings.act_proxy_ip=act_edit_ip;
                                        mk.do_proxy("socket://"+DUBwiseHelper.ip_str(settings.act_proxy_ip,false));
                                        chg_state(STATEID_PROXY);
                                    }
                                else
                                    {
                                        settings.act_conn_ip=act_edit_ip;
                                        connect_mk("socket://"+DUBwiseHelper.ip_str(settings.act_conn_ip,false),"TCP/IP Connection");
                                        chg_state(STATEID_CONN_DETAILS);
                                    }

                                break;

                            }
                break;

            case STATEID_GPSVIEW:
                if (keyCode == this.KEY_NUM0)
                    mk.set_gps_target(mk.gps_position.Latitude,mk.gps_position.Longitude);
                if (keyCode == this.KEY_NUM1)
                    mk.gps_position.push_wp();
                if (keyCode == this.KEY_NUM2)
                    chg_state(STATEID_FILEOPEN);
                if (keyCode == this.KEY_NUM3)
                    mk.set_gps_target(mk.gps_position.LatWP[act_wp],mk.gps_position.LongWP[act_wp]);


                if (keyCode == this.KEY_NUM5)
                    heading_offset= mk.debug_data.analog[26];

                switch (getGameAction (keyCode))
                            {
                            case UP:
                                if (act_wp!=0) act_wp--;
                                break;
                       
                            case DOWN:
                                if (act_wp<mk.gps_position.last_wp) act_wp++;

                                break;


                            }
       

                break;

            case STATEID_ABOUT:
               
                switch (getGameAction (keyCode))
                            {
                            case UP:
                                if (act_menu_select>=max_lines)
                                    act_menu_select--;
                                break;
                       
                            case DOWN:
                                if (act_menu_select<lcd_lines.length-1)
                                    act_menu_select++;

                                break;


                            }
       

                break;
               

            case STATEID_RAWDEBUG:
               
                switch (getGameAction (keyCode))
                            {
                            case UP:
                                if (rawdebug_cursor_y==0)
                                    rawdebug_cursor_y=31;
                                else
                                    rawdebug_cursor_y--;
                                break;
                       
                            case DOWN:
                                if (rawdebug_cursor_y==31)
                                    rawdebug_cursor_y=0;
                                else
                                    rawdebug_cursor_y++;
                                break;


                            }
                break;
            case STATEID_KEYCONTROL:
                if (keyCode==KEY_POUND)
                    keycontrol_exit |= 1;
                else
                if (keyCode==KEY_STAR)
                    keycontrol_exit |= 2;
                else
                    mod_external_control_by_keycode(keyCode,(byte)1);



                if (keycontrol_exit==3)
                    chg_state(STATEID_MAINMENU);

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

                            }
                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_HANDLsE_PARAMS:
               
                menu_keypress(keyCode);
                break;
                */

                /*
            case STATEID_TRAFFIC:
                if ( getGameAction (keyCode)==FIRE )
                    chg_state(STATEID_CONN_DETAILS);
                else
                    menu_keypress(keyCode);
                break;
                */


            case STATEID_MAINMENU:
            case STATEID_SELECT_PARAMSET:
            case STATEID_SELECT_COMPORT:       

            case STATEID_PARAM_MENU:
            case STATEID_TRAFFIC:
            case STATEID_CONN_DETAILS:
            case STATEID_HANDLE_PARAMS:

//#if bluetooth=="on"
            case STATEID_DEVICESELECT:
//#endif

//#if fileapi=="on"
            case STATEID_FILEOPEN:
//#endif

                menu_keypress(keyCode);
                break;



            case STATEID_SETTINGSMENU:
                settings_editor.keypress(keyCode,getGameAction (keyCode)) ;
                break;

                // handle menue
                //          case STATEID_SELECT_SPEED_FORMAT:  
                //          case STATEID_SELECT_GPS_FORMAT:


            case STATEID_EDIT_PARAMS:
                params_editor.keypress(keyCode,getGameAction (keyCode)) ;
                break;

            case STATEID_LCD:

                if ((keyCode >= this.KEY_NUM0) && (keyCode <= this.KEY_NUM9))              
                        mk.LCD.set_page(keyCode-this.KEY_NUM0);
                else
                switch (getGameAction (keyCode))
                    {
                    case LEFT:
                    case UP:
                        mk.LCD.LCD_PREVPAGE();
                        break;
                       
                    case RIGHT:
                    case DOWN:
                        mk.LCD.LCD_NEXTPAGE();
                        break;


                       
                    }
                break;
            }
   
       

    }

 






}