Rev 2344 | Rev 2348 | Go to most recent revision | Show entire file | Ignore whitespace | Details | Blame | Last modification | View Log | RSS feed
Rev 2344 | Rev 2346 | ||
---|---|---|---|
Line 184... | Line 184... | ||
184 | ToNaviCtrl.Param.Byte[6] = VarioCharacter; |
184 | ToNaviCtrl.Param.Byte[6] = VarioCharacter; |
185 | ToNaviCtrl.Param.Byte[7] = motorindex; |
185 | ToNaviCtrl.Param.Byte[7] = motorindex; |
186 | ToNaviCtrl.Param.Byte[8] = Motor[motorindex].MaxPWM; |
186 | ToNaviCtrl.Param.Byte[8] = Motor[motorindex].MaxPWM; |
187 | ToNaviCtrl.Param.Byte[9] = Motor[motorindex].State; |
187 | ToNaviCtrl.Param.Byte[9] = Motor[motorindex].State; |
188 | ToNaviCtrl.Param.Byte[10] = Motor[motorindex].Temperature; |
188 | ToNaviCtrl.Param.Byte[10] = Motor[motorindex].Temperature; |
189 | ToNaviCtrl.Param.Byte[11] = Motor[motorindex++].Current; |
189 | ToNaviCtrl.Param.Byte[11] = Motor[motorindex].Current; |
190 | motorindex %= 12; |
190 | if(Mixer.Motor[++motorindex][0] == 0) // next motor is not used ? |
- | 191 | while(Mixer.Motor[motorindex][0] == 0 && motorindex) motorindex = (motorindex + 1) % 12; |
|
191 | break; |
192 | break; |
192 | case SPI_FCCMD_PARAMETER1: |
193 | case SPI_FCCMD_PARAMETER1: |
193 | ToNaviCtrl.Param.Byte[0] = (unsigned char) BattLowVoltageWarning; //0.1V |
194 | ToNaviCtrl.Param.Byte[0] = (unsigned char) BattLowVoltageWarning; //0.1V |
194 | ToNaviCtrl.Param.Byte[1] = EE_Parameter.NaviGpsGain; // Parameters for the Naviboard |
195 | ToNaviCtrl.Param.Byte[1] = EE_Parameter.NaviGpsGain; // Parameters for the Naviboard |
195 | ToNaviCtrl.Param.Byte[2] = EE_Parameter.NaviGpsP; |
196 | ToNaviCtrl.Param.Byte[2] = EE_Parameter.NaviGpsP; |