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 | { |