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++; |