Rev 2518 | Rev 2540 | Go to most recent revision | Show entire file | Ignore whitespace | Details | Blame | Last modification | View Log | RSS feed
Rev 2518 | Rev 2527 | ||
---|---|---|---|
Line 179... | Line 179... | ||
179 | ToNaviCtrl.Param.Int[5] = UBat; // 10 & 11 |
179 | ToNaviCtrl.Param.Int[5] = UBat; // 10 & 11 |
180 | if(!(PORTC & (1<<PORTC2))) FC_StatusFlags2 &= ~FC_STATUS2_OUT1_ACTIVE; // Out1 (J16) |
180 | if(!(PORTC & (1<<PORTC2))) FC_StatusFlags2 &= ~FC_STATUS2_OUT1_ACTIVE; // Out1 (J16) |
181 | break; |
181 | break; |
182 | case SPI_FCCMD_BL_ACCU: |
182 | case SPI_FCCMD_BL_ACCU: |
183 | ToNaviCtrl.Param.Int[0] = Capacity.ActualCurrent; // 0.1A |
183 | ToNaviCtrl.Param.Int[0] = Capacity.ActualCurrent; // 0.1A |
184 | ToNaviCtrl.Param.Byte[2] = motorindex; |
184 | ToNaviCtrl.Param.Byte[2] = motorindex | Out1ChangedFlag; // 0x80 this Flag marks a changed Out1 |
185 | ToNaviCtrl.Param.Byte[3] = Capacity.MinOfMaxPWM; |
185 | ToNaviCtrl.Param.Byte[3] = Capacity.MinOfMaxPWM; |
186 | ToNaviCtrl.Param.Byte[4] = GetChannelValue(EE_Parameter.NaviGpsModeChannel); // GPS-Mode control |
186 | ToNaviCtrl.Param.Byte[4] = GetChannelValue(EE_Parameter.NaviGpsModeChannel); // GPS-Mode control |
187 | ToNaviCtrl.Param.Byte[5] = VarioCharacter; |
187 | ToNaviCtrl.Param.Byte[5] = VarioCharacter; |
188 | ToNaviCtrl.Param.Byte[6] = Motor[motorindex].NotReadyCnt; |
188 | ToNaviCtrl.Param.Byte[6] = Motor[motorindex].NotReadyCnt; |
189 | ToNaviCtrl.Param.Byte[7] = Motor[motorindex].Version; |
189 | ToNaviCtrl.Param.Byte[7] = Motor[motorindex].Version; |
190 | ToNaviCtrl.Param.Byte[8] = Motor[motorindex].MaxPWM; |
190 | ToNaviCtrl.Param.Byte[8] = Motor[motorindex].MaxPWM; |
191 | ToNaviCtrl.Param.Byte[9] = Motor[motorindex].State; |
191 | ToNaviCtrl.Param.Byte[9] = Motor[motorindex].State; |
192 | ToNaviCtrl.Param.Byte[10] = Motor[motorindex].Temperature; |
192 | ToNaviCtrl.Param.Byte[10] = Motor[motorindex].Temperature; |
193 | ToNaviCtrl.Param.Byte[11] = Motor[motorindex].Current; |
193 | ToNaviCtrl.Param.Byte[11] = Motor[motorindex].Current; |
194 | - | ||
195 | if(Mixer.Motor[++motorindex][0] <= 0) // next motor is not used ? |
194 | if(Mixer.Motor[++motorindex][0] <= 0) // next motor is not used ? |
196 | while(Mixer.Motor[motorindex][0] <= 0 && motorindex) motorindex = (motorindex + 1) % 13; |
195 | while(Mixer.Motor[motorindex][0] <= 0 && motorindex) motorindex = (motorindex + 1) % 13; |
- | 196 | Out1ChangedFlag = 0; |
|
197 | break; |
197 | break; |
198 | case SPI_FCCMD_SLOW: |
198 | case SPI_FCCMD_SLOW: |
199 | switch(slow_command) |
199 | switch(slow_command) |
200 | { |
200 | { |
201 | case 0: |
201 | case 0: |