224,9 → 224,11 |
act_gps_format=(byte)((act_gps_format+1)%GPS_FORMAT_COUNT); |
}*/ |
|
public String act_gps_format_str(int val) |
|
|
public String gps_format_str(int val,int format) |
{ |
switch(act_gps_format) |
switch(format) |
{ |
case GPS_FORMAT_DECIMAL: |
return "" + val/10000000 + "." +val%10000000 ; |
236,7 → 238,12 |
return "invalid format" + act_gps_format; |
} |
} |
public String act_gps_format_str(int val) |
{ |
return gps_format_str(val,act_gps_format); |
|
} |
|
|
|
public String act_speed_format_str(int val) |
352,52 → 359,55 |
|
public void set_by_mk_data(int[] in_arr,MKVersion version) |
{ |
Longitude=parse_arr_4(0,in_arr); |
Latitude=parse_arr_4(4,in_arr); |
Altitude=parse_arr_4(8,in_arr); |
int off=0; |
if (version.proto_minor>0) // fixme |
off++; |
Longitude=parse_arr_4(off+0,in_arr); |
Latitude=parse_arr_4(off+4,in_arr); |
Altitude=parse_arr_4(off+8,in_arr); |
//status=in_arr[12]; |
|
TargetLongitude=parse_arr_4(13,in_arr); |
TargetLatitude=parse_arr_4(17,in_arr); |
TargetAltitude=parse_arr_4(21,in_arr); |
TargetLongitude=parse_arr_4(off+13,in_arr); |
TargetLatitude=parse_arr_4(off+17,in_arr); |
TargetAltitude=parse_arr_4(off+21,in_arr); |
//Targetstatus=in_arr[25]; |
|
Distance2Target=parse_arr_2(26,in_arr); |
Angle2Target=parse_arr_2(28,in_arr); |
Distance2Target=parse_arr_2(off+26,in_arr); |
Angle2Target=parse_arr_2(off+28,in_arr); |
|
HomeLongitude=parse_arr_4(30,in_arr); |
HomeLatitude=parse_arr_4(34,in_arr); |
HomeAltitude=parse_arr_4(38,in_arr); |
HomeLongitude=parse_arr_4(off+30,in_arr); |
HomeLatitude=parse_arr_4(off+34,in_arr); |
HomeAltitude=parse_arr_4(off+38,in_arr); |
//Targetstatus=in_arr[42]; |
|
Distance2Home=parse_arr_2(43,in_arr); |
Angle2Home=parse_arr_2(45,in_arr); |
Distance2Home=parse_arr_2(off+43,in_arr); |
Angle2Home=parse_arr_2(off+45,in_arr); |
|
WayPointIndex=(byte)in_arr[47]; |
WayPointNumber=(byte)in_arr[48]; |
WayPointIndex=(byte)in_arr[off+47]; |
WayPointNumber=(byte)in_arr[off+48]; |
|
SatsInUse=(byte)in_arr[49]; |
SatsInUse=(byte)in_arr[off+49]; |
|
|
Altimeter=parse_arr_2(50,in_arr); // hight according to air pressure |
Variometer=parse_arr_2(52,in_arr);; // climb(+) and sink(-) rate |
FlyingTime=parse_arr_2(54,in_arr);; |
Altimeter=parse_arr_2(off+50,in_arr); // hight according to air pressure |
Variometer=parse_arr_2(off+52,in_arr);; // climb(+) and sink(-) rate |
FlyingTime=parse_arr_2(off+54,in_arr);; |
|
UBatt= in_arr[56]; |
UBatt= in_arr[off+56]; |
|
|
GroundSpeed= parse_arr_2(57,in_arr); |
Heading= parse_arr_2(59,in_arr); |
CompasHeading= parse_arr_2(61,in_arr); |
GroundSpeed= parse_arr_2(off+57,in_arr); |
Heading= parse_arr_2(off+59,in_arr); |
CompasHeading= parse_arr_2(off+61,in_arr); |
|
AngleNick = in_arr[63]; |
AngleRoll = in_arr[64]; |
SenderOkay = in_arr[65]; |
AngleNick = in_arr[off+63]; |
AngleRoll = in_arr[off+64]; |
SenderOkay = in_arr[off+65]; |
|
MKFlags=in_arr[66]; |
NCFlags=in_arr[67]; |
MKFlags=in_arr[off+66]; |
NCFlags=in_arr[off+67]; |
|
ErrorCode=in_arr[68]; |
ErrorCode=in_arr[off+68]; |
|
|
} |