Rev 330 | Rev 339 | Go to most recent revision | Show entire file | Ignore whitespace | Details | Blame | Last modification | View Log | RSS feed
| Rev 330 | Rev 338 | ||
|---|---|---|---|
| Line 73... | Line 73... | ||
| 73 | volatile u8 Compass_CalState; // is written by mk3mag or ncmag implementation |
73 | volatile u8 Compass_CalState; // is written by mk3mag or ncmag implementation |
| 74 | s16 Hx = 0, Hy = 0; |
74 | s16 Hx = 0, Hy = 0; |
| 75 | s32 EarthMagneticField = 100; |
75 | s32 EarthMagneticField = 100; |
| 76 | s32 EarthMagneticFieldFiltered = 100; |
76 | s32 EarthMagneticFieldFiltered = 100; |
| 77 | s32 EarthMagneticInclination = 0; |
77 | s32 EarthMagneticInclination = 0; |
| - | 78 | s32 EarthMagneticInclinationTheoretic = 0; |
|
| 78 | u8 ErrorDisturbedEarthMagnetField = 0; |
79 | u8 ErrorDisturbedEarthMagnetField = 0; |
| Line 79... | Line 80... | ||
| 79 | 80 | ||
| 80 | #define COMPASS_NONE 0 |
81 | #define COMPASS_NONE 0 |
| 81 | #define COMPASS_MK3MAG 1 |
82 | #define COMPASS_MK3MAG 1 |
| Line 160... | Line 161... | ||
| 160 | case COMPASS_NCMAG: |
161 | case COMPASS_NCMAG: |
| 161 | NCMAG_Update(); |
162 | NCMAG_Update(); |
| 162 | default: |
163 | default: |
| 163 | break; |
164 | break; |
| 164 | } |
165 | } |
| 165 | DebugOut.Analog[21] = MagVector.X; |
166 | DebugOut.Analog[24] = MagVector.X; |
| 166 | DebugOut.Analog[22] = MagVector.Y; |
167 | DebugOut.Analog[25] = MagVector.Y; |
| 167 | DebugOut.Analog[23] = MagVector.Z; |
168 | DebugOut.Analog[26] = MagVector.Z; |
| 168 | if(!((old.X == MagVector.X) || (old.Y == MagVector.Y) || (old.Z == MagVector.Z))) check_value_counter = 0; // Values are normally changing |
169 | if(!((old.X == MagVector.X) || (old.Y == MagVector.Y) || (old.Z == MagVector.Z))) check_value_counter = 0; // Values are normally changing |
| Line 169... | Line 170... | ||
| 169 | 170 | ||
| 170 | if(check_value_counter > 5000) |
171 | if(check_value_counter > 5000) |
| 171 | { |
172 | { |