Rev 261 | Go to most recent revision | Show entire file | Ignore whitespace | Details | Blame | Last modification | View Log | RSS feed
Rev 261 | Rev 272 | ||
---|---|---|---|
Line 122... | Line 122... | ||
122 | // Neigungskompensation |
122 | // Neigungskompensation |
123 | x_corr = (cos_nick * MM3.x_axis) + (((sin_roll * MM3.y_axis) - (cos_roll * MM3.z_axis)) * sin_nick); |
123 | x_corr = (cos_nick * MM3.x_axis) + (((sin_roll * MM3.y_axis) - (cos_roll * MM3.z_axis)) * sin_nick); |
124 | y_corr = ((cos_roll * MM3.y_axis) + (sin_roll * MM3.z_axis)); |
124 | y_corr = ((cos_roll * MM3.y_axis) + (sin_roll * MM3.z_axis)); |
Line 125... | Line 125... | ||
125 | 125 | ||
126 | // Winkelberechnung |
126 | // Winkelberechnung |
Line 127... | Line 127... | ||
127 | heading = arctan_i(x_corr, y_corr); |
127 | heading = atan2_i(x_corr, y_corr); |
128 | 128 |