/branches/v0.60_MicroMag3_Nick666/compass.c |
---|
84,6 → 84,7 |
case MM3_X_BYTE2: // 2. Byte der entsprechenden Achse ist da. |
MM3.x_axis |= SPDR; |
MM3.x_axis -= OFF_X; // Sofort Offset aus der Kalibrierung berücksichtigen |
MM3.NickGrad = IntegralNick/(EE_Parameter.UserParam1*8); // Zeitnahe Speicherung der aktuellen Neigung in ° |
MM3.AXIS = MM3_Y; |
MM3.STATE = MM3_RESET; |
break; |
91,6 → 92,7 |
case MM3_Y_BYTE2: |
MM3.y_axis |= SPDR; |
MM3.y_axis -= OFF_Y; |
MM3.RollGrad = IntegralRoll/(EE_Parameter.UserParam2*8); // Zeitnahe Speicherung der aktuellen Neigung in ° |
MM3.AXIS = MM3_Z; |
MM3.STATE = MM3_RESET; |
break; |
99,10 → 101,7 |
MM3.z_axis |= SPDR; |
MM3.z_axis -= OFF_Z; |
MM3.AXIS = MM3_X; |
MM3.STATE = MM3_RESET; |
// Zeitnahe Speicherung der aktuellen Nick-/Rollneigung in ° |
MM3.NickGrad = IntegralNick/(EE_Parameter.UserParam1*8); |
MM3.RollGrad = IntegralRoll/(EE_Parameter.UserParam2*8); |
MM3.STATE = MM3_RESET; |
break; |
} |
} |
/branches/v0.60_MicroMag3_Nick666/fc.c |
---|
652,8 → 652,8 |
// DebugOut.Analog[0] = MesswertNick; |
// DebugOut.Analog[1] = MesswertRoll; |
// DebugOut.Analog[2] = MesswertGier; |
DebugOut.Analog[0] = IntegralNick / (EE_Parameter.UserParam1*8); |
DebugOut.Analog[1] = IntegralRoll / (EE_Parameter.UserParam2*8); |
DebugOut.Analog[0] = MM3.NickGrad; |
DebugOut.Analog[1] = MM3.RollGrad; |
DebugOut.Analog[2] = Mittelwert_AccNick; |
DebugOut.Analog[3] = Mittelwert_AccRoll; |
DebugOut.Analog[4] = MesswertGier; |