Rev 2390 | Rev 2408 | 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; |