Subversion Repositories NaviCtrl

Rev

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];