654,25 → 654,7 |
// DebugOut.Analog[2] = MesswertGier; |
// DebugOut.Analog[0] = IntegralNick / EE_Parameter.GyroAccFaktor; |
// DebugOut.Analog[1] = IntegralRoll / EE_Parameter.GyroAccFaktor; |
/* |
static signed int x_min,x_max,y_min,y_max,z_min,z_max; |
|
if (MM3.x_axis > x_max) x_max = MM3.x_axis; |
else if (MM3.x_axis < x_min) x_min = MM3.x_axis; |
|
if (MM3.y_axis > y_max) y_max = MM3.y_axis; |
else if (MM3.y_axis < y_min) y_min = MM3.y_axis; |
|
if (MM3.z_axis > z_max) z_max = MM3.z_axis; |
else if (MM3.z_axis < z_min) z_min = MM3.z_axis; |
|
DebugOut.Analog[0] = x_max; |
DebugOut.Analog[1] = x_min; |
DebugOut.Analog[2] = y_max; |
DebugOut.Analog[3] = y_min; |
DebugOut.Analog[4] = z_max; |
DebugOut.Analog[5] = z_min; |
*/ |
DebugOut.Analog[0] = MM3.NickGrad; |
DebugOut.Analog[1] = MM3.RollGrad; |
DebugOut.Analog[2] = Mittelwert_AccNick; |