Rev 2034 | Rev 2072 | Go to most recent revision | Show entire file | Ignore whitespace | Details | Blame | Last modification | View Log | RSS feed
Rev 2034 | Rev 2037 | ||
---|---|---|---|
Line 197... | Line 197... | ||
197 | ToNaviCtrl.Param.Int[0] = Capacity.ActualCurrent; // 0.1A |
197 | ToNaviCtrl.Param.Int[0] = Capacity.ActualCurrent; // 0.1A |
198 | ToNaviCtrl.Param.Int[1] = Capacity.UsedCapacity; // mAh |
198 | ToNaviCtrl.Param.Int[1] = Capacity.UsedCapacity; // mAh |
199 | ToNaviCtrl.Param.Byte[4] = (unsigned char) UBat; // 0.1V |
199 | ToNaviCtrl.Param.Byte[4] = (unsigned char) UBat; // 0.1V |
200 | ToNaviCtrl.Param.Byte[5] = (unsigned char) BattLowVoltageWarning; //0.1V |
200 | ToNaviCtrl.Param.Byte[5] = (unsigned char) BattLowVoltageWarning; //0.1V |
201 | ToNaviCtrl.Param.Byte[6] = VarioCharacter; |
201 | ToNaviCtrl.Param.Byte[6] = VarioCharacter; |
202 | ToNaviCtrl.Param.Byte[7] = Parameter_GlobalConfig; |
202 | ToNaviCtrl.Param.Byte[7] = motorindex; |
203 | ToNaviCtrl.Param.Byte[8] = Parameter_ExtraConfig; |
203 | ToNaviCtrl.Param.Byte[8] = Motor[motorindex].MaxPWM; |
204 | ToNaviCtrl.Param.Byte[9] = motorindex; |
204 | ToNaviCtrl.Param.Byte[9] = Motor[motorindex].State; |
205 | ToNaviCtrl.Param.Byte[10] = Motor[motorindex].Temperature; |
205 | ToNaviCtrl.Param.Byte[10] = Motor[motorindex].Temperature; |
206 | ToNaviCtrl.Param.Byte[11] = Motor[motorindex++].Current; |
206 | ToNaviCtrl.Param.Byte[11] = Motor[motorindex++].Current; |
207 | motorindex %= 12; |
207 | motorindex %= 12; |
208 | break; |
208 | break; |
209 | case SPI_FCCMD_PARAMETER1: |
209 | case SPI_FCCMD_PARAMETER1: |
Line 266... | Line 266... | ||
266 | ToNaviCtrl.Param.Byte[4] = PlatinenVersion; |
266 | ToNaviCtrl.Param.Byte[4] = PlatinenVersion; |
267 | ToNaviCtrl.Param.Byte[5] = VersionInfo.HardwareError[0]; |
267 | ToNaviCtrl.Param.Byte[5] = VersionInfo.HardwareError[0]; |
268 | ToNaviCtrl.Param.Byte[6] = VersionInfo.HardwareError[1]; |
268 | ToNaviCtrl.Param.Byte[6] = VersionInfo.HardwareError[1]; |
269 | VersionInfo.HardwareError[0] = 0; |
269 | VersionInfo.HardwareError[0] = 0; |
270 | VersionInfo.HardwareError[1] &= FC_ERROR1_MIXER; |
270 | VersionInfo.HardwareError[1] &= FC_ERROR1_MIXER; |
271 | ToNaviCtrl.Param.Byte[7] = VersionInfo.HardwareError[2]; |
271 | ToNaviCtrl.Param.Byte[7] = VersionInfo.HardwareError[2]; // unused |
272 | ToNaviCtrl.Param.Byte[8] = VersionInfo.HardwareError[3]; |
272 | ToNaviCtrl.Param.Byte[8] = Parameter_GlobalConfig; |
273 | ToNaviCtrl.Param.Byte[9] = VersionInfo.HardwareError[4]; |
273 | ToNaviCtrl.Param.Byte[9] = Parameter_ExtraConfig; |
274 | ToNaviCtrl.Param.Byte[10] = EE_Parameter.OrientationAngle; |
274 | ToNaviCtrl.Param.Byte[10] = EE_Parameter.OrientationAngle; |
275 | ToNaviCtrl.Param.Byte[11] = EE_Parameter.GlobalConfig3; |
275 | ToNaviCtrl.Param.Byte[11] = EE_Parameter.GlobalConfig3; |
276 | break; |
276 | break; |
277 | case SPI_FCCMD_SERVOS: |
277 | case SPI_FCCMD_SERVOS: |
278 | ToNaviCtrl.Param.Byte[0] = EE_Parameter.ServoNickRefresh; // Parameters for the Servo Control |
278 | ToNaviCtrl.Param.Byte[0] = EE_Parameter.ServoNickRefresh; // Parameters for the Servo Control |