| 35,9 → 35,13 |
|---|
| public byte bl_retrys=0; |
| public boolean init_bootloader=false; |
| |
| public boolean disconnect_notify=false; |
| |
| public byte lib_version_major=0; |
| public byte lib_version_minor=6; |
| public byte lib_version_minor=7; |
| |
| public byte last_navi_error=0; |
| |
| public String lib_version_str() |
| { |
| return "V"+lib_version_major+"."+lib_version_minor; |
| 462,8 → 466,8 |
|---|
| public void switch_todo() |
| { |
| sleep(150); |
| version=new MKVersion(); |
| LCD= new MKLCD(this); |
| version.reset(); |
| // LCD= new MKLCD(this); |
| debug_data=new MKDebugData(); |
| |
| } |
| 760,7 → 764,10 |
|---|
| debug_data.set_by_mk_data(Decode64(data,3,len-3),version); |
| |
| if (ufo_prober.is_mk()) |
| stats.process_mkflags(debug_data.motor_val(0)); // TODO remove dirty hack |
| { |
| stats.process_mkflags(debug_data.motor_val(0)); // TODO remove dirty hack |
| stats.process_alt(Alt()); |
| } |
| if (debug_buff_targets!=null) |
| { |
| for (int sp=0;sp<debug_buff_targets.length;sp++) |
| 769,8 → 776,6 |
|---|
| debug_buff_lastset=debug_buff_off; |
| |
| debug_buff_off=(debug_buff_off+1)%debug_buff_len; |
| |
| |
| |
| } |
| log("processed debug data"); |
| 844,6 → 849,8 |
|---|
| |
| stats.process_mkflags(gps_position.MKFlags); |
| stats.process_compas(gps_position.CompasHeading); |
| stats.process_speed(gps_position.GroundSpeed); |
| stats.process_alt(Alt()); |
| log("long:" + gps_position.Longitude); |
| log("lat:" + gps_position.Latitude); |
| |
| 867,6 → 874,7 |
|---|
| |
| public void close_connections(boolean force) |
| { |
| |
| // if ((!force)&&root.canvas.do_vibra) root.vibrate(500); |
| force_disconnect=force; |
| try{ reader.close(); } |
| 882,7 → 890,8 |
|---|
| ufo_prober.set_to_none(); |
| stats.reset(); |
| connected=false; |
| version=new MKVersion(); |
| version.reset(); |
| disconnect_notify=true; |
| } |
| |
| // Thread to recieve data from Connection |
| 1197,10 → 1206,6 |
|---|
| while(true) |
| { |
| |
| data_buff[data_buff_pos]="ct-l" +data_buff_pos + "" + connected ; |
| data_buff_pos++; |
| data_buff_pos%=DATA_BUFF_LEN; |
| |
| if (!connected) |
| { |
| if (!force_disconnect) connect(); |
| 1215,30 → 1220,19 |
|---|
| catch (Exception e) { } |
| } |
| */ |
| |
| recieving=true; |
| int read_count ; |
| |
| |
| |
| if (reader.available()<DATA_IN_BUFF_SIZE) |
| read_count =reader.read(data_in_buff,0,reader.available()); |
| else |
| read_count =reader.read(data_in_buff,0,DATA_IN_BUFF_SIZE); |
| |
| |
| if ( read_count!=0) |
| { |
| data_buff[data_buff_pos]="avail:" + reader.available(); |
| data_buff_pos++; |
| data_buff_pos%=DATA_BUFF_LEN; |
| } |
| // log("Connected - reading data " + read_count); |
| // pos=0; |
| input=0; |
| //data_buff[data_buff_pos]=""; |
| // recieve data-set |
| if (read_count==0) sleep(20); |
| |
| // int read_count =reader.read(data_in_buff,0,reader.available()); |
| stats.bytes_in+=read_count; |
| 1299,7 → 1293,10 |
|---|
| |
| } |
| else |
| sleep(5); |
| { |
| recieving=false; |
| sleep(20); |
| } |
| /* |
| while ((input != 13)) //&&(input!=-1)) |
| { |