98,7 → 98,7 |
s32 Kalman_MaxFusion = 64; |
s32 ToFcGpsZ = 0; |
|
u8 SPI_CommandSequence[] = { SPI_NCCMD_VERSION, SPI_NCCMD_KALMAN, SPI_NCCMD_KALMAN, SPI_NCCMD_KALMAN}; |
u8 SPI_CommandSequence[] = { SPI_NCCMD_VERSION, SPI_NCCMD_KALMAN, SPI_NCCMD_GPSINFO ,SPI_NCCMD_KALMAN, SPI_NCCMD_KALMAN}; |
u8 SPI_CommandCounter = 0; |
|
SPI_Version_t FC_Version; |
297,10 → 297,16 |
case SPI_NCCMD_VERSION: |
ToFlightCtrl.Param.Byte[0] = VERSION_MAJOR; |
ToFlightCtrl.Param.Byte[1] = VERSION_MINOR; |
ToFlightCtrl.Param.Byte[2] = VERSION_MINOR; |
ToFlightCtrl.Param.Byte[2] = VERSION_PATCH; |
ToFlightCtrl.Param.Byte[3] = FC_SPI_COMPATIBLE; |
ToFlightCtrl.Param.Byte[4] = 0; |
break; |
|
case SPI_NCCMD_GPSINFO: |
ToFlightCtrl.Param.Byte[0] = GPSData.Flags; |
ToFlightCtrl.Param.Byte[1] = GPSData.NumOfSats; |
ToFlightCtrl.Param.Byte[2] = GPSData.SatFix; |
break; |
|
default: |
break; |
404,7 → 410,7 |
break; |
|
default: |
break; |
break; |
} |
|
// every time we got new data from the FC via SPI call the navigation routine |