Rev 240 | Go to most recent revision | 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 |