| 33,6 → 33,7 |
|---|
| |
| PORTD &= ~(1<<PD3); // J5 auf Low |
| |
| // Init Statemachine |
| MM3.AXIS = MM3_X; |
| MM3.STATE = MM3_RESET; |
| |
| 60,7 → 61,7 |
|---|
| else if (MM3.AXIS == MM3_Y) SPDR = 0x32; // Micromag Period Select ist auf 256 (0x30) |
| else if (MM3.AXIS == MM3_Z) SPDR = 0x33; // 1: x-Achse, 2: Y-Achse, 3: Z-Achse |
| |
| MM3.DRDY = SetDelay(5); // Laut Datenblatt max. Zeit bis Messung fertig (bei PS 256 eigentlich 4 ms) |
| MM3.DRDY = SetDelay(8); // Laut Datenblatt max. Zeit bis Messung fertig (bei PS 256 eigentlich 4 ms) |
| MM3.STATE = MM3_WAIT_DRDY; |
| return; |
| |
| 195,7 → 196,7 |
|---|
| float sin_nick, cos_nick, sin_roll, cos_roll; |
| float x_corr, y_corr; |
| signed int x_axis,y_axis,z_axis, heading; |
| unsigned int div_faktor; |
| uint16_t div_faktor; |
| |
| div_faktor = (uint16_t)EE_Parameter.UserParam1 * 8; |
| |