195,27 → 195,11 |
switch (FromNaviCtrl.Command) |
{ |
case SPI_KALMAN: |
FromNaviCtrl_Value.Kalman_K = FromNaviCtrl.Param.Byte[0]; |
FromNaviCtrl_Value.Kalman_MaxFusion = FromNaviCtrl.Param.Byte[1]; |
FromNaviCtrl_Value.Kalman_MaxDrift = FromNaviCtrl.Param.Byte[2]; |
FCParam.Kalman_K = FromNaviCtrl.Param.Byte[0]; |
FCParam.Kalman_MaxFusion = FromNaviCtrl.Param.Byte[1]; |
FCParam.Kalman_MaxDrift = FromNaviCtrl.Param.Byte[2]; |
break; |
|
|
case SPI_CMD_OSD_DATA: |
FromNaviCtrl_Value.OsdBar = FromNaviCtrl.Param.Byte[0]; |
FromNaviCtrl_Value.Distance = FromNaviCtrl.Param.Int[1]; |
break; |
|
case SPI_CMD_GPS_POS: |
//FromFlightCtrl.Param.Long[0] = GPS_Data.Longitude; |
//FromFlightCtrl.Param.Long[1] = GPS_Data.Latitude; |
break; |
|
case SPI_CMD_GPS_TARGET: |
//FromFlightCtrl.Param.Long[0] = GPS_Data.TargetLongitude; |
//FromFlightCtrl.Param.Long[1] = GPS_Data.TargetLatitude; |
break; |
|
default: |
break; |
} |