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