Rev 918 | Rev 930 | Go to most recent revision | Show entire file | Ignore whitespace | Details | Blame | Last modification | View Log | RSS feed
| Rev 918 | Rev 921 | ||
|---|---|---|---|
| Line 56... | Line 56... | ||
| 56 | { |
56 | { |
| 57 | unsigned char i, ready = 0; |
57 | unsigned char i, ready = 0; |
| 58 | GyroDefektN = 0; GyroDefektR = 0; GyroDefektG = 0; |
58 | GyroDefektN = 0; GyroDefektR = 0; GyroDefektG = 0; |
| 59 | for(i=140; i != 0; i--) |
59 | for(i=140; i != 0; i--) |
| 60 | { |
60 | { |
| 61 | if(ready == 3 && i > 10) i = 5; |
61 | if(ready == 3 && i > 10) i = 9; |
| 62 | ready = 0; |
62 | ready = 0; |
| 63 | if(AdWertNick < 1020) AnalogOffsetNick--; else if(AdWertNick > 1030) AnalogOffsetNick++; else ready++; |
63 | if(AdWertNick < 1020) AnalogOffsetNick--; else if(AdWertNick > 1030) AnalogOffsetNick++; else ready++; |
| 64 | if(AdWertRoll < 1020) AnalogOffsetRoll--; else if(AdWertRoll > 1030) AnalogOffsetRoll++; else ready++; |
64 | if(AdWertRoll < 1020) AnalogOffsetRoll--; else if(AdWertRoll > 1030) AnalogOffsetRoll++; else ready++; |
| 65 | if(AdWertGier < 1020) AnalogOffsetGier--; else if(AdWertGier > 1030) AnalogOffsetGier++; else ready++; |
65 | if(AdWertGier < 1020) AnalogOffsetGier--; else if(AdWertGier > 1030) AnalogOffsetGier++; else ready++; |
| 66 | twi_state = 8; |
66 | twi_state = 8; |
| Line 72... | Line 72... | ||
| 72 | messanzahl_Druck = 0; |
72 | messanzahl_Druck = 0; |
| 73 | ANALOG_ON; |
73 | ANALOG_ON; |
| 74 | while(messanzahl_Druck == 0); |
74 | while(messanzahl_Druck == 0); |
| 75 | if(i<10) Delay_ms_Mess(10); |
75 | if(i<10) Delay_ms_Mess(10); |
| 76 | } |
76 | } |
| 77 | Delay_ms_Mess(50); |
77 | Delay_ms_Mess(70); |
| 78 | } |
78 | } |
| Line 79... | Line 79... | ||
| 79 | 79 | ||
| 80 | 80 | ||