Rev 1682 | Rev 1693 | Go to most recent revision | Show entire file | Ignore whitespace | Details | Blame | Last modification | View Log | RSS feed
| Rev 1682 | Rev 1685 | ||
|---|---|---|---|
| Line 643... | Line 643... | ||
| 643 | if(Intervall3D > 0 && CheckDelay(Timer3D) && UebertragungAbgeschlossen) |
643 | if(Intervall3D > 0 && CheckDelay(Timer3D) && UebertragungAbgeschlossen) |
| 644 | { |
644 | { |
| 645 | Data3D.Winkel[0] = (int) (IntegralNick / (EE_Parameter.GyroAccFaktor * 4)); // etwa in 0.1 Grad |
645 | Data3D.Winkel[0] = (int) (IntegralNick / (EE_Parameter.GyroAccFaktor * 4)); // etwa in 0.1 Grad |
| 646 | Data3D.Winkel[1] = (int) (IntegralRoll / (EE_Parameter.GyroAccFaktor * 4)); // etwa in 0.1 Grad |
646 | Data3D.Winkel[1] = (int) (IntegralRoll / (EE_Parameter.GyroAccFaktor * 4)); // etwa in 0.1 Grad |
| 647 | Data3D.Winkel[2] = (int) ((10 * ErsatzKompass) / GIER_GRAD_FAKTOR); |
647 | Data3D.Winkel[2] = (int) ((10 * ErsatzKompass) / GIER_GRAD_FAKTOR); |
| - | 648 | Data3D.Centroid[0] = SummeNick >> 9; |
|
| - | 649 | Data3D.Centroid[1] = SummeRoll >> 9; |
|
| - | 650 | Data3D.Centroid[2] = Mess_Integral_Gier >> 9; |
|
| 648 | SendOutData('C', FC_ADDRESS, 1, (unsigned char *) &Data3D,sizeof(Data3D)); |
651 | SendOutData('C', FC_ADDRESS, 1, (unsigned char *) &Data3D,sizeof(Data3D)); |
| 649 | Timer3D = SetDelay(Intervall3D); |
652 | Timer3D = SetDelay(Intervall3D); |
| 650 | } |
653 | } |
| 651 | if(DebugTextAnforderung != 255) // Texte für die Analogdaten |
654 | if(DebugTextAnforderung != 255) // Texte für die Analogdaten |
| 652 | { |
655 | { |