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]; |