| /branches/MicroMag3_Nick666/trunc/compass.c |
|---|
| 131,9 → 131,9 |
| { |
| uint8_t tmp_sreg = SREG; |
| cli(); |
| x_axis = MM3.x_axis; |
| y_axis = MM3.y_axis; |
| z_axis = MM3.z_axis; |
| x_axis = MM3.x_axis; |
| y_axis = MM3.y_axis; |
| z_axis = MM3.z_axis; |
| SREG = tmp_sreg; |
| if (x_axis > x_max) x_max = x_axis; |
| 190,12 → 190,12 |
| // 16bit-Werte lesen |
| uint8_t tmp_sreg = SREG; |
| cli(); |
| mm3_x_axis = MM3.x_axis; |
| mm3_y_axis = MM3.y_axis; |
| mm3_z_axis = MM3.z_axis; |
| mm3_x_axis = MM3.x_axis; |
| mm3_y_axis = MM3.y_axis; |
| mm3_z_axis = MM3.z_axis; |
| SREG = tmp_sreg; |
| int temp = Aktuell_az-550; |
| int temp = Aktuell_az - acc_neutral.compass; |
| // Lage-Berechnung mittels Acc-Messwerte |
| tilt = atan2_i(temp,AdWertAccNick*64); |
| sin_nick = sin_i(tilt); |