| /branches/v0.60_MicroMag3_Nick666/compass.c |
|---|
| 113,10 → 113,10 |
| signed int heading; |
| //Berechung von sinus und cosinus |
| sin_nick = (float)sin_i(MM3.NickGrad)/1000; |
| cos_nick = (float)cos_i(MM3.NickGrad)/1000; |
| sin_roll = (float)sin_i(MM3.RollGrad)/1000; |
| cos_roll = (float)cos_i(MM3.RollGrad)/1000; |
| sin_nick = (float)sin_f(MM3.NickGrad); |
| cos_nick = (float)cos_f(MM3.NickGrad); |
| sin_roll = (float)sin_f(MM3.RollGrad); |
| cos_roll = (float)cos_f(MM3.RollGrad); |
| //Neigungskompensation |
| y_corr = ((cos_roll * MM3.y_axis) + (sin_roll * MM3.z_axis)); |