Rev 1773 | Rev 1791 | Go to most recent revision | Show entire file | Ignore whitespace | Details | Blame | Last modification | View Log | RSS feed
| Rev 1773 | Rev 1787 | ||
|---|---|---|---|
| Line 193... | Line 193... | ||
| 193 | DebugOut.Analog[29] = Capacity.MinOfMaxPWM; |
193 | DebugOut.Analog[29] = Capacity.MinOfMaxPWM; |
| 194 | DebugOut.Analog[30] = GPS_Nick; |
194 | DebugOut.Analog[30] = GPS_Nick; |
| 195 | DebugOut.Analog[31] = GPS_Roll; |
195 | DebugOut.Analog[31] = GPS_Roll; |
| 196 | if(VersionInfo.HardwareError[0] || VersionInfo.HardwareError[1]) DebugOut.Status[1] |= 1; else DebugOut.Status[1] &= 0xfe; |
196 | if(VersionInfo.HardwareError[0] || VersionInfo.HardwareError[1]) DebugOut.Status[1] |= 1; else DebugOut.Status[1] &= 0xfe; |
| Line 197... | Line 197... | ||
| 197 | 197 | ||
| 198 | if(Capacity.MinOfMaxPWM < 250/* && modell_fliegt > 500*/) { beeptime = 1000; DebugOut.Analog[25]++; } |
- | |
| 199 | 198 | //if(Capacity.MinOfMaxPWM < 250/* && modell_fliegt > 500*/) { beeptime = 1000; DebugOut.Analog[25]++; } |
|
| Line 200... | Line 199... | ||
| 200 | } |
199 | } |
| Line 504... | Line 503... | ||
| 504 | if(RohMesswertNick > 256) MesswertNick += 1 * (RohMesswertNick - 256); |
503 | if(RohMesswertNick > 256) MesswertNick += 1 * (RohMesswertNick - 256); |
| 505 | else if(RohMesswertNick < -256) MesswertNick += 1 * (RohMesswertNick + 256); |
504 | else if(RohMesswertNick < -256) MesswertNick += 1 * (RohMesswertNick + 256); |
| 506 | if(RohMesswertRoll > 256) MesswertRoll += 1 * (RohMesswertRoll - 256); |
505 | if(RohMesswertRoll > 256) MesswertRoll += 1 * (RohMesswertRoll - 256); |
| 507 | else if(RohMesswertRoll < -256) MesswertRoll += 1 * (RohMesswertRoll + 256); |
506 | else if(RohMesswertRoll < -256) MesswertRoll += 1 * (RohMesswertRoll + 256); |
| 508 | } |
507 | } |
| 509 | for(i=0;i<8;i++) |
- | |
| 510 | { |
- | |
| 511 | int tmp; |
- | |
| 512 | tmp = PPM_in[EE_Parameter.Kanalbelegung[K_POTI1 + i]] + 110; |
- | |
| 513 | if(tmp > 255) tmp = 255; else if(tmp < 0) tmp = 0; |
- | |
| 514 | if(tmp != Poti[i]) |
- | |
| 515 | { |
- | |
| 516 | Poti[i] += (tmp - Poti[i]) / 8; |
- | |
| 517 | if(Poti[i] > tmp) Poti[i]--; |
- | |
| 518 | else Poti[i]++; |
- | |
| 519 | } |
- | |
| 520 | } |
- | |
| 521 | } |
508 | } |
| Line 522... | Line 509... | ||
| 522 | 509 | ||
| 523 | //############################################################################ |
510 | //############################################################################ |
| 524 | // Senden der Motorwerte per I2C-Bus |
511 | // Senden der Motorwerte per I2C-Bus |
| Line 559... | Line 546... | ||
| 559 | //############################################################################ |
546 | //############################################################################ |
| 560 | // Trägt ggf. das Poti als Parameter ein |
547 | // Trägt ggf. das Poti als Parameter ein |
| 561 | void ParameterZuordnung(void) |
548 | void ParameterZuordnung(void) |
| 562 | //############################################################################ |
549 | //############################################################################ |
| 563 | { |
550 | { |
| 564 | unsigned char tmp; |
551 | unsigned char tmp,i; |
| 565 | #define CHK_POTI(b,a) {if(a < 248) b = a; else b = Poti[255 - a];} |
552 | #define CHK_POTI(b,a) {if(a < 248) b = a; else b = Poti[255 - a];} |
| 566 | #define CHK_POTI_MM(b,a,min,max) {CHK_POTI(b,a); LIMIT_MIN_MAX(b, min, max);} |
553 | #define CHK_POTI_MM(b,a,min,max) {CHK_POTI(b,a); LIMIT_MIN_MAX(b, min, max);} |
| - | 554 | for(i=0;i<8;i++) |
|
| - | 555 | { |
|
| - | 556 | int tmp2; |
|
| - | 557 | tmp2 = PPM_in[EE_Parameter.Kanalbelegung[K_POTI1 + i]] + 110; |
|
| - | 558 | if(tmp2 > 255) tmp2 = 255; else if(tmp2 < 0) tmp2 = 0; |
|
| - | 559 | if(tmp2 != Poti[i]) |
|
| - | 560 | { |
|
| - | 561 | Poti[i] += (tmp2 - Poti[i]) / 4; |
|
| - | 562 | if(Poti[i] > tmp2) Poti[i]--; |
|
| - | 563 | else Poti[i]++; |
|
| - | 564 | } |
|
| 567 | 565 | } |
|
| 568 | CHK_POTI_MM(Parameter_Luftdruck_D,EE_Parameter.Luftdruck_D,0,100); |
566 | CHK_POTI_MM(Parameter_Luftdruck_D,EE_Parameter.Luftdruck_D,0,100); |
| 569 | CHK_POTI_MM(Parameter_Hoehe_P,EE_Parameter.Hoehe_P,0,100); |
567 | CHK_POTI_MM(Parameter_Hoehe_P,EE_Parameter.Hoehe_P,0,100); |
| 570 | CHK_POTI_MM(Parameter_Gyro_P,EE_Parameter.Gyro_P,10,255); |
568 | CHK_POTI_MM(Parameter_Gyro_P,EE_Parameter.Gyro_P,10,255); |
| 571 | CHK_POTI_MM(Parameter_J16Timing,EE_Parameter.J16Timing,1,255); |
569 | CHK_POTI_MM(Parameter_J16Timing,EE_Parameter.J16Timing,1,255); |
| 572 | CHK_POTI_MM(Parameter_J17Timing,EE_Parameter.J17Timing,1,255); |
570 | CHK_POTI_MM(Parameter_J17Timing,EE_Parameter.J17Timing,1,255); |