WebSVN - Projects - Diff - Rev 135 and 149 - /DUBwise/src/J2ME/src/MKCommunicator.java

     // temp - to be removed
     String p_msg="--";
-    public String msg="BT_INIT";
     public String msg="BT_INIT";
     // for statistics
     public int debug_data_count=0;
     public int debug_names_count=0;
     public int lcd_data_count=0;
     public int params_data_count=0;
     public int navi_data_count=0;
+    public int bytes_in_count=0;
+    public int bytes_out_count=0;
     String name;
         stick_data=new MKStickData();
         params=new MKParamsParser();
         LCD= new MKLCD(this);
         watchdog=new MKWatchDog(this);
         gps_position=new MKGPSPosition();
+        proxy =new MKProxy();
         new Thread( this ).start(); // fire up main Thread
+    }
-        public void do_proxy(String proxy_url)
+    public void do_proxy(String proxy_url)
+    {
-        proxy=new MKProxy(proxy_url);
+        proxy.connect(proxy_url);
+    }
             // connection = (StreamConnection) Connector.open(mk_url, Connector.READ_WRITE);
             reader=connection.openInputStream();
             writer=connection.openOutputStream();
             //
-            String magic="\rmk-mode\r";
+            //String magic="\rmk-mode\r";
-            writer.write(magic.getBytes());
+            //writer.write(magic.getBytes());
-            writer.flush();
+            //writer.flush();
             //
         int[] target=new int[8];
         target[0]= (0xFF)&(longitude<<24);
         target[1]= (0xFF)&(longitude<<16);
         target[2]= (0xFF)&(longitude<<8);
         target[3]= (0xFF)&(longitude);
-        send_command(0,'s',target);
+        //      send_command(0,'s',target);
+    }
         send_command(0,'a',params);
+    }
+    public void trigger_debug()
+    {
+        if (sending||recieving) return; // its not that important - can be dropped
+        int[] params=new int[0];
+        send_command(0,'c',params);
+    }
+    public void switch_to_fc()
+    {
+        while(sending||recieving)
+            {
+                try { Thread.sleep(50); }
+                catch (Exception e)  {   }
+            }
+        int[] params=new int[1];
+        params[0]=0;
+        send_command(0,'u',params);
+        try { Thread.sleep(50); }
+        catch (Exception e)  {   }
+        version=new MKVersion();
+        LCD= new MKLCD(this);
+    }
+    public void switch_to_navi()
+    {
+        while(sending||recieving)
+            {try { Thread.sleep(50); }
+            catch (Exception e)  {   }
+            }
+        sending=true;
+        try
+            {
+        writer.write( 27);
+        writer.write( 27);
+        writer.write( 0x55);
+        writer.write( 0xaa);
+        writer.write( 0);
+        writer.write('\r');
+        bytes_out_count+=6;
+        writer.flush();
+            }
+        catch (Exception e)  {   }
+        sending=false;
+        try { Thread.sleep(50); }
+        catch (Exception e)  {   }
+        version=new MKVersion();
         LCD= new MKLCD(this);
+    }
     public void trigger_LCD(int key)
+    {
+    }
+    public void write_params()
     public void write_params()
         params.update_backup();
         while(sending||recieving)
             {try { Thread.sleep(50); }
     boolean recieving=false;
     // send command to FC ( add crc and pack into pseudo Base64
     public void send_command(int modul,char cmd,int[] params)
+    {
         //      if (modul==0) return;
+        sending=true;
+        //      char[] send_buff=new char[5 + (params.length/3 + (params.length%3==0?0:1) )*4]; // 5=1*start_char+1*addr+1*cmd+2*crc
-        sending=true;
-        char[] send_buff=new char[5 + (params.length/3 + (params.length%3==0?0:1) )*4]; // 5=1*start_char+1*addr+1*cmd+2*crc
+        char[] send_buff=new char[3 + (params.length/3 + (params.length%3==0?0:1) )*4]; // 5=1*start_char+1*addr+1*cmd+2*crc
         send_buff[0]='#';
         send_buff[1]=(char)modul;
         send_buff[2]=cmd;
                 int tmp_crc=0;
                 for ( int tmp_i=0; tmp_i<send_buff.length;tmp_i++)
+                    {
                         tmp_crc+=(int)send_buff[tmp_i];
                         writer.write(send_buff[tmp_i]);
+                        bytes_out_count++;
+                    }
                 tmp_crc%=4096;
                 writer.write( (char)(tmp_crc/64 + '='));
                 writer.write( (char)(tmp_crc%64 + '='));
                 writer.write('\r');
+                bytes_out_count+=3;
                 writer.flush();
+            }
         catch (Exception e)
             { // problem sending data to FC
+            }
                 break;
             case 'V': // Version Info
                 version_data_count++;
+                version.set_by_mk_data(Decode64(data,3,6));
+                if (version.minor>60) // FIXME - NO good detection
-                version.set_by_mk_data(Decode64(data,3,6));
+                    root.canvas.ufo_prober.set_to_mk();
                 break;
             case '0':
                 break;
             case 'w':
                 angle_data_count++;
-                root.canvas.ufo_prober.set_to_mk();
+                //              root.canvas.ufo_prober.set_to_mk();
-                debug.log("got angle data:");
+                debug.log("got angle data");
                         if (!force_disconnect) connect();
+                    }
                 else
                     try{
                         /*
                         while(sending)
                             {try { Thread.sleep(50); }
                             catch (Exception e)  {   }
                             }
                         */
                         recieving=true;
                         debug.log("Connected - reading data");
                         pos=0;
                         input=0;
+                        // recieve data-set
-                        // recieve data-set
+                        while ((input != 13)) //&&(input!=-1))
-                        while ((input != 13)) //&&(input!=-1))
+                            {
-                            {
+                                debug.log("pre read");
+                                input = reader.read() ;
+                                debug.log("Byte rcv" + input);
                                 input = reader.read() ;
-                                if (proxy!=null)
+                                proxy.write(input);
-                                    proxy.writer.write(input);
+                                if (input==-1) throw new Exception("disconnect");
-                                if (input==-1) throw new Exception("test");
+                                if (input!=-1)
                                 if (input!=-1)
+                                        bytes_in_count++;
+                                        data_set[pos]=input;
                                         pos++;
                                         data_set[pos]=input;
                                         pos++;

Subversion Repositories Projects

(root)/DUBwise/src/J2ME/src/MKCommunicator.java - Rev 135 → 149