| 654,7 → 654,25 |
|---|
| // 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; |