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 |