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 | { |