Rev 1213 | Rev 1320 | Go to most recent revision | Show entire file | Ignore whitespace | Details | Blame | Last modification | View Log | RSS feed
Rev 1213 | Rev 1232 | ||
---|---|---|---|
Line 267... | Line 267... | ||
267 | signal = signal/3; // scaling to fit PPM resolution |
267 | signal = signal/3; // scaling to fit PPM resolution |
Line 268... | Line 268... | ||
268 | 268 | ||
269 | if(index >= 0 && index <= 10) |
269 | if(index >= 0 && index <= 10) |
270 | { |
270 | { |
271 | // Stabiles Signal |
271 | // Stabiles Signal |
- | 272 | if(abs(signal - PPM_in[index]) < 6) |
|
- | 273 | { |
|
- | 274 | if(SenderOkay < 200) SenderOkay += 10; |
|
- | 275 | else |
|
- | 276 | { |
|
- | 277 | SenderOkay = 200; |
|
- | 278 | TIMSK1 &= ~_BV(ICIE1); // disable PPM-Input |
|
- | 279 | } |
|
272 | if(abs(signal - PPM_in[index]) < 6) { if(SenderOkay < 200) SenderOkay += 10; else SenderOkay = 200;} |
280 | } |
273 | tmp = (3 * (PPM_in[index]) + signal) / 4; |
281 | tmp = (3 * (PPM_in[index]) + signal) / 4; |
274 | if(tmp > signal+1) tmp--; else |
282 | if(tmp > signal+1) tmp--; else |
275 | if(tmp < signal-1) tmp++; |
283 | if(tmp < signal-1) tmp++; |
276 | if(SenderOkay >= 180) PPM_diff[index] = ((tmp - PPM_in[index]) / 3) * 3; |
284 | if(SenderOkay >= 180) PPM_diff[index] = ((tmp - PPM_in[index]) / 3) * 3; |
277 | else PPM_diff[index] = 0; |
285 | else PPM_diff[index] = 0; |
278 | PPM_in[index] = tmp; |
286 | PPM_in[index] = tmp; |
279 | } |
287 | } |
280 | } |
288 | } |