Rev 338 | Rev 340 | Go to most recent revision | Show entire file | Ignore whitespace | Details | Blame | Last modification | View Log | RSS feed
Rev 338 | Rev 339 | ||
---|---|---|---|
Line 155... | Line 155... | ||
155 | // initiate new compass communication |
155 | // initiate new compass communication |
156 | switch(Compass_Device) |
156 | switch(Compass_Device) |
157 | { |
157 | { |
158 | case COMPASS_MK3MAG: |
158 | case COMPASS_MK3MAG: |
159 | MK3MAG_Update(); |
159 | MK3MAG_Update(); |
- | 160 | DebugOut.Analog[24] = MagVector.X; |
|
- | 161 | DebugOut.Analog[25] = MagVector.Y; |
|
- | 162 | DebugOut.Analog[26] = MagVector.Z; |
|
160 | break; |
163 | break; |
161 | case COMPASS_NCMAG: |
164 | case COMPASS_NCMAG: |
162 | NCMAG_Update(); |
165 | NCMAG_Update(); |
- | 166 | DebugOut.Analog[24] = MagRawVector.X; |
|
- | 167 | DebugOut.Analog[25] = MagRawVector.Y; |
|
- | 168 | DebugOut.Analog[26] = MagRawVector.Z; |
|
163 | default: |
169 | default: |
164 | break; |
170 | break; |
165 | } |
171 | } |
166 | DebugOut.Analog[24] = MagVector.X; |
- | |
167 | DebugOut.Analog[25] = MagVector.Y; |
- | |
168 | DebugOut.Analog[26] = MagVector.Z; |
- | |
169 | if(!((old.X == MagVector.X) || (old.Y == MagVector.Y) || (old.Z == MagVector.Z))) check_value_counter = 0; // Values are normally changing |
172 | if(!((old.X == MagVector.X) || (old.Y == MagVector.Y) || (old.Z == MagVector.Z))) check_value_counter = 0; // Values are normally changing |
Line 170... | Line 173... | ||
170 | 173 | ||
171 | if(check_value_counter > 5000) |
174 | if(check_value_counter > 5000) |
172 | { |
175 | { |