| 72,24 → 72,24 |
|---|
| |
| uint16_t Led_Timer = 0; |
| |
| struct Scaling_t |
| typedef struct |
| { |
| int16_t Range; |
| int16_t Offset; |
| } ; |
| } Scaling_t; |
| |
| struct Calibration_t |
| typedef struct |
| { |
| struct Scaling_t MagX; |
| struct Scaling_t MagY; |
| struct Scaling_t MagZ; |
| struct Scaling_t AccX; |
| struct Scaling_t AccY; |
| struct Scaling_t AccZ; |
| }; |
| Scaling_t MagX; |
| Scaling_t MagY; |
| Scaling_t MagZ; |
| Scaling_t AccX; |
| Scaling_t AccY; |
| Scaling_t AccZ; |
| } Calibration_t; |
| |
| struct Calibration_t eeCalibration EEMEM; // calibration data in EEProm |
| struct Calibration_t Calibration; // calibration data in RAM |
| Calibration_t eeCalibration EEMEM; // calibration data in EEProm |
| Calibration_t Calibration; // calibration data in RAM |
| |
| // magnet sensor variable |
| int16_t RawMagnet1a, RawMagnet1b; // raw magnet sensor data |
| 455,7 → 455,7 |
|---|
| if(NC_Connected) NC_Connected--; |
| if(FC_Connected) FC_Connected--; |
| // fall back to attitude estimation from acc sensor if NC or FC does'nt send attittude data |
| if(!NC_Connected && ! NC_Connected) |
| if(!FC_Connected && ! NC_Connected) |
| { |
| AttitudeSource = ATTITUDE_SOURCE_ACC; |
| Orientation = ORIENTATION_FC; |