Rev 204 | Rev 206 | Go to most recent revision | Show entire file | Ignore whitespace | Details | Blame | Last modification | View Log | RSS feed
Rev 204 | Rev 205 | ||
---|---|---|---|
Line 304... | Line 304... | ||
304 | 304 | ||
305 | case SPI_NCCMD_GPSINFO: |
305 | case SPI_NCCMD_GPSINFO: |
306 | ToFlightCtrl.Param.Byte[0] = GPSData.Flags; |
306 | ToFlightCtrl.Param.Byte[0] = GPSData.Flags; |
307 | ToFlightCtrl.Param.Byte[1] = GPSData.NumOfSats; |
307 | ToFlightCtrl.Param.Byte[1] = GPSData.NumOfSats; |
- | 308 | ToFlightCtrl.Param.Byte[2] = GPSData.SatFix; |
|
- | 309 | ToFlightCtrl.Param.Int[2] = NaviData.HomePositionDeviation.Distance; // dm |
|
308 | ToFlightCtrl.Param.Byte[2] = GPSData.SatFix; |
310 | ToFlightCtrl.Param.sInt[3] = NaviData.HomePositionDeviation.Bearing; // deg |
Line 309... | Line 311... | ||
309 | break; |
311 | break; |
310 | 312 | ||
311 | default: |
313 | default: |
Line 375... | Line 377... | ||
375 | { // put only new CompassCalState into queue to send via I2C |
377 | { // put only new CompassCalState into queue to send via I2C |
376 | CompassCalState = FromFlightCtrl.Param.Byte[0]; |
378 | CompassCalState = FromFlightCtrl.Param.Byte[0]; |
377 | fifo_put(&CompassCalcStateFiFo, CompassCalState); |
379 | fifo_put(&CompassCalcStateFiFo, CompassCalState); |
378 | } |
380 | } |
379 | Parameter.NaviPH_LoginTime = FromFlightCtrl.Param.Byte[1]; |
381 | Parameter.NaviPH_LoginTime = FromFlightCtrl.Param.Byte[1]; |
380 | NaviData.Variometer = (NaviData.Variometer + 2 * ((s16) FromFlightCtrl.Param.Int[1] - NaviData.Altimeter)) / 2; // provisorisch |
382 | NaviData.Variometer = (NaviData.Variometer + 2 * (FromFlightCtrl.Param.sInt[1] - NaviData.Altimeter)) / 2; // provisorisch |
381 | NaviData.Altimeter = (s16) FromFlightCtrl.Param.Int[1]; // is located at byte 2 and 3 |
383 | NaviData.Altimeter = FromFlightCtrl.Param.sInt[1]; // is located at byte 2 and 3 |
382 | NaviData.SetpointAltitude = (s16) FromFlightCtrl.Param.Int[2]; // is located at byte 4 and 5 |
384 | NaviData.SetpointAltitude = FromFlightCtrl.Param.sInt[2]; // is located at byte 4 and 5 |
383 | CHK_POTI_MM(Parameter.NaviGpsPLimit,FromFlightCtrl.Param.Byte[6],0,255); |
385 | CHK_POTI_MM(Parameter.NaviGpsPLimit,FromFlightCtrl.Param.Byte[6],0,255); |
384 | CHK_POTI_MM(Parameter.NaviGpsILimit,FromFlightCtrl.Param.Byte[7],0,255); |
386 | CHK_POTI_MM(Parameter.NaviGpsILimit,FromFlightCtrl.Param.Byte[7],0,255); |
385 | CHK_POTI_MM(Parameter.NaviGpsDLimit,FromFlightCtrl.Param.Byte[8],0,255); |
387 | CHK_POTI_MM(Parameter.NaviGpsDLimit,FromFlightCtrl.Param.Byte[8],0,255); |
386 | FC.RC_Quality = FromFlightCtrl.Param.Byte[9]; |
388 | FC.RC_Quality = FromFlightCtrl.Param.Byte[9]; |
387 | FC.RC_RSSI = FromFlightCtrl.Param.Byte[10]; |
389 | FC.RC_RSSI = FromFlightCtrl.Param.Byte[10]; |