Rev 205 | Go to most recent revision | Show entire file | Ignore whitespace | Details | Blame | Last modification | View Log | RSS feed
Rev 205 | Rev 206 | ||
---|---|---|---|
Line 330... | Line 330... | ||
330 | if(ClearFCFlags) |
330 | if(ClearFCFlags) |
331 | { |
331 | { |
332 | FC.Flags = 0; |
332 | FC.Flags = 0; |
333 | ClearFCFlags = 0; |
333 | ClearFCFlags = 0; |
334 | } |
334 | } |
335 | FC.Flags |= FromFlightCtrl.Param.Byte[8]; |
335 | FC.Flags |= FromFlightCtrl.Param.Byte[8]; |
336 | FC.UBat = FromFlightCtrl.Param.Byte[9]; |
- | |
337 | Parameter.LowVoltageWarning = FromFlightCtrl.Param.Byte[10]; |
- | |
338 | Parameter.ActiveSetting = FromFlightCtrl.Param.Byte[11]; |
336 | Parameter.ActiveSetting = FromFlightCtrl.Param.Byte[9]; |
339 | DebugOut.Analog[5] = FC.Flags; |
337 | DebugOut.Analog[5] = FC.Flags; |
- | 338 | NaviData.FCFlags = FC.Flags; |
|
- | 339 | break; |
|
- | 340 | ||
- | 341 | case SPI_FCCMD_ACCU: |
|
- | 342 | FC.BAT_Current = FromFlightCtrl.Param.Int[0]; |
|
- | 343 | FC.BAT_UsedCapacity = FromFlightCtrl.Param.Int[1]; |
|
- | 344 | FC.BAT_Voltage = FromFlightCtrl.Param.Byte[4]; |
|
- | 345 | Parameter.LowVoltageWarning = FromFlightCtrl.Param.Byte[5]; |
|
- | 346 | NaviData.UBat = FC.BAT_Voltage; |
|
- | 347 | NaviData.Current = FC.BAT_Current; |
|
- | 348 | NaviData.UsedCapacity = FC.BAT_UsedCapacity; |
|
340 | break; |
349 | break; |
Line 341... | Line 350... | ||
341 | 350 | ||
342 | #define CHK_POTI(b,a) { if(a < 248) b = a; else b = FC.Poti[255 - a]; } |
351 | #define CHK_POTI(b,a) { if(a < 248) b = a; else b = FC.Poti[255 - a]; } |
Line 385... | Line 394... | ||
385 | CHK_POTI_MM(Parameter.NaviGpsPLimit,FromFlightCtrl.Param.Byte[6],0,255); |
394 | CHK_POTI_MM(Parameter.NaviGpsPLimit,FromFlightCtrl.Param.Byte[6],0,255); |
386 | CHK_POTI_MM(Parameter.NaviGpsILimit,FromFlightCtrl.Param.Byte[7],0,255); |
395 | CHK_POTI_MM(Parameter.NaviGpsILimit,FromFlightCtrl.Param.Byte[7],0,255); |
387 | CHK_POTI_MM(Parameter.NaviGpsDLimit,FromFlightCtrl.Param.Byte[8],0,255); |
396 | CHK_POTI_MM(Parameter.NaviGpsDLimit,FromFlightCtrl.Param.Byte[8],0,255); |
388 | FC.RC_Quality = FromFlightCtrl.Param.Byte[9]; |
397 | FC.RC_Quality = FromFlightCtrl.Param.Byte[9]; |
389 | FC.RC_RSSI = FromFlightCtrl.Param.Byte[10]; |
398 | FC.RC_RSSI = FromFlightCtrl.Param.Byte[10]; |
- | 399 | NaviData.RC_Quality = FC.RC_Quality; |
|
- | 400 | NaviData.RC_RSSI = FC.RC_RSSI; |
|
390 | NaviData.Gas = (FC.UBat * (u32) FromFlightCtrl.Param.Byte[11]) / (u32) Parameter.LowVoltageWarning; |
401 | NaviData.Gas = (FC.BAT_Voltage * (u32) FromFlightCtrl.Param.Byte[11]) / (u32) Parameter.LowVoltageWarning; |
391 | break; |
402 | break; |
Line 392... | Line 403... | ||
392 | 403 | ||
393 | case SPI_FCCMD_SERVOS: |
404 | case SPI_FCCMD_SERVOS: |
394 | ServoParams.Refresh = FromFlightCtrl.Param.Byte[0]; |
405 | ServoParams.Refresh = FromFlightCtrl.Param.Byte[0]; |