Rev 1912 | Rev 1915 | Go to most recent revision | Show entire file | Ignore whitespace | Details | Blame | Last modification | View Log | RSS feed
| Rev 1912 | Rev 1913 | ||
|---|---|---|---|
| Line 182... | Line 182... | ||
| 182 | ToNaviCtrl.Param.Byte[6] = Parameter_UserParam7; |
182 | ToNaviCtrl.Param.Byte[6] = Parameter_UserParam7; |
| 183 | ToNaviCtrl.Param.Byte[7] = Parameter_UserParam8; |
183 | ToNaviCtrl.Param.Byte[7] = Parameter_UserParam8; |
| 184 | ToNaviCtrl.Param.Byte[8] = FC_StatusFlags; |
184 | ToNaviCtrl.Param.Byte[8] = FC_StatusFlags; |
| 185 | FC_StatusFlags &= ~(FC_STATUS_CALIBRATE | FC_STATUS_START); |
185 | FC_StatusFlags &= ~(FC_STATUS_CALIBRATE | FC_STATUS_START); |
| 186 | ToNaviCtrl.Param.Byte[9] = GetActiveParamSet(); |
186 | ToNaviCtrl.Param.Byte[9] = GetActiveParamSet(); |
| 187 | ToNaviCtrl.Param.Byte[10] = ControlHeading; |
187 | // ToNaviCtrl.Param.Byte[10] = ControlHeading; |
| 188 | ToNaviCtrl.Param.Byte[11] = FC_StatusFlags2; |
188 | ToNaviCtrl.Param.Byte[11] = FC_StatusFlags2; |
| 189 | break; |
189 | break; |
| Line 190... | Line 190... | ||
| 190 | 190 | ||
| 191 | case SPI_FCCMD_ACCU: |
191 | case SPI_FCCMD_ACCU: |
| 192 | ToNaviCtrl.Param.Int[0] = Capacity.ActualCurrent; // 0.1A |
192 | ToNaviCtrl.Param.Int[0] = Capacity.ActualCurrent; // 0.1A |
| 193 | ToNaviCtrl.Param.Int[1] = Capacity.UsedCapacity; // mAh |
193 | ToNaviCtrl.Param.Int[1] = Capacity.UsedCapacity; // mAh |
| 194 | ToNaviCtrl.Param.Byte[4] = (unsigned char) UBat; // 0.1V |
194 | ToNaviCtrl.Param.Byte[4] = (unsigned char) UBat; // 0.1V |
| 195 | ToNaviCtrl.Param.Byte[5] = (unsigned char) BattLowVoltageWarning; //0.1V |
195 | ToNaviCtrl.Param.Byte[5] = (unsigned char) BattLowVoltageWarning; //0.1V |
| - | 196 | ToNaviCtrl.Param.Byte[6] = VarioCharacter; |
|
| - | 197 | ToNaviCtrl.Param.Byte[7] = EE_Parameter.GlobalConfig; |
|
| 196 | ToNaviCtrl.Param.Byte[6] = VarioCharacter; |
198 | ToNaviCtrl.Param.Byte[8] = EE_Parameter.ExtraConfig; |
| Line 197... | Line 199... | ||
| 197 | break; |
199 | break; |
| 198 | 200 | ||
| 199 | case SPI_FCCMD_PARAMETER1: |
201 | case SPI_FCCMD_PARAMETER1: |
| Line 257... | Line 259... | ||
| 257 | ToNaviCtrl.Param.Byte[5] = VersionInfo.HardwareError[0]; |
259 | ToNaviCtrl.Param.Byte[5] = VersionInfo.HardwareError[0]; |
| 258 | ToNaviCtrl.Param.Byte[6] = VersionInfo.HardwareError[1]; |
260 | ToNaviCtrl.Param.Byte[6] = VersionInfo.HardwareError[1]; |
| 259 | ToNaviCtrl.Param.Byte[7] = VersionInfo.HardwareError[2]; |
261 | ToNaviCtrl.Param.Byte[7] = VersionInfo.HardwareError[2]; |
| 260 | ToNaviCtrl.Param.Byte[8] = VersionInfo.HardwareError[3]; |
262 | ToNaviCtrl.Param.Byte[8] = VersionInfo.HardwareError[3]; |
| 261 | ToNaviCtrl.Param.Byte[9] = VersionInfo.HardwareError[4]; |
263 | ToNaviCtrl.Param.Byte[9] = VersionInfo.HardwareError[4]; |
| - | 264 | ToNaviCtrl.Param.Byte[10] = EE_Parameter.OrientationAngle; |
|
| 262 | break; |
265 | break; |
| 263 | case SPI_FCCMD_SERVOS: |
266 | case SPI_FCCMD_SERVOS: |
| 264 | ToNaviCtrl.Param.Byte[0] = EE_Parameter.ServoNickRefresh; // Parameters for the Servo Control |
267 | ToNaviCtrl.Param.Byte[0] = EE_Parameter.ServoNickRefresh; // Parameters for the Servo Control |
| 265 | ToNaviCtrl.Param.Byte[1] = EE_Parameter.ServoCompInvert; |
268 | ToNaviCtrl.Param.Byte[1] = EE_Parameter.ServoCompInvert; |
| 266 | ToNaviCtrl.Param.Byte[2] = Parameter_ServoNickControl; |
269 | ToNaviCtrl.Param.Byte[2] = Parameter_ServoNickControl; |