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