Rev 240 | Show entire file | Ignore whitespace | Details | Blame | Last modification | View Log | RSS feed
Rev 240 | Rev 251 | ||
---|---|---|---|
Line 115... | Line 115... | ||
115 | cos_nick = cos_f(MM3.NickGrad); |
115 | cos_nick = cos_f(MM3.NickGrad); |
116 | sin_roll = sin_f(MM3.RollGrad); |
116 | sin_roll = sin_f(MM3.RollGrad); |
117 | cos_roll = cos_f(MM3.RollGrad); |
117 | cos_roll = cos_f(MM3.RollGrad); |
Line 118... | Line 118... | ||
118 | 118 | ||
- | 119 | //Neigungskompensation |
|
- | 120 | //x_corr = (((sin_roll * MM3.y_axis) - (cos_roll * MM3.z_axis)) * sin_nick) + (cos_nick * MM3.x_axis); |
|
119 | //Neigungskompensation |
121 | x_corr = (cos_nick * MM3.x_axis) + (sin_roll * MM3.y_axis* sin_nick) - (cos_roll * MM3.z_axis * sin_nick); |
120 | y_corr = ((cos_roll * MM3.y_axis) + (sin_roll * MM3.z_axis)); |
- | |
Line 121... | Line 122... | ||
121 | x_corr = (((sin_roll * MM3.y_axis) - (cos_roll * MM3.z_axis)) * sin_nick) + (cos_nick * MM3.x_axis); |
122 | y_corr = ((cos_roll * MM3.y_axis) + (sin_roll * MM3.z_axis)); |
122 | 123 | ||
Line 123... | Line 124... | ||
123 | //Winkelberechnung |
124 | //Winkelberechnung |