Rev 489 | Rev 493 | Go to most recent revision | Show entire file | Ignore whitespace | Details | Blame | Last modification | View Log | RSS feed
Rev 489 | Rev 492 | ||
---|---|---|---|
Line 193... | Line 193... | ||
193 | DebugOut.Analog[25] = MagVector.Y; |
193 | DebugOut.Analog[25] = MagVector.Y; |
194 | DebugOut.Analog[26] = MagVector.Z; |
194 | DebugOut.Analog[26] = MagVector.Z; |
Line 195... | Line 195... | ||
195 | 195 | ||
Line 196... | Line 196... | ||
196 | if(!((old.X == MagVector.X) || (old.Y == MagVector.Y) || (old.Z == MagVector.Z))) check_value_counter = 0; // Values are normaly changing |
196 | if(!((old.X == MagVector.X) || (old.Y == MagVector.Y) || (old.Z == MagVector.Z))) check_value_counter = 0; // Values are normaly changing |
197 | 197 | ||
198 | if(check_value_counter == 2000) |
198 | if(check_value_counter == 2000) // 2 seconds no change of the compass values |
199 | { |
199 | { |
200 | UART1_PutString("\n\r Init Mag.-Sensor"); |
200 | UART1_PutString("\n\r Init Mag.-Sensor"); |
- | 201 | Compass_Init(); |
|
201 | Compass_Init(); // 2 seconds no change of the compass value |
202 | } |
202 | } |
203 | |
203 | else if(check_value_counter > 5000) |
204 | if(check_value_counter > 5000) // 5 seconds no change of the compass values |
204 | { |
205 | { |
205 | Compass_Heading = -1; // values didn't change for 5 seconds -> probably a compass-fault |
206 | Compass_Heading = -1; // -> probably a compass-fault |
Line 206... | Line 207... | ||
206 | } |
207 | } |
207 | else check_value_counter++; |
208 | else check_value_counter++; |