Rev 407 | Show entire file | Ignore whitespace | Details | Blame | Last modification | View Log | RSS feed
Rev 407 | Rev 408 | ||
---|---|---|---|
Line 242... | Line 242... | ||
242 | x_corr -= z_axis * cos_roll * sin_nick; |
242 | x_corr -= z_axis * cos_roll * sin_nick; |
Line 243... | Line 243... | ||
243 | 243 | ||
244 | y_corr = y_axis * cos_roll; |
244 | y_corr = y_axis * cos_roll; |
Line 245... | Line 245... | ||
245 | y_corr += z_axis * sin_roll; |
245 | y_corr += z_axis * sin_roll; |
246 | - | ||
247 | // Winkelberechnung |
246 | |
248 | 247 | // Winkelberechnung |
|
249 | heading = atan2_i(x_corr, y_corr); |
248 | heading = atan2_i(x_corr, y_corr); |
Line 250... | Line 249... | ||
250 | if (heading < 0) heading = -heading; |
249 | if (heading < 0) heading = -heading; |