Stedd
/
BalanceBot
1
0
Fork 0
Code Issues 6 Pull Requests Packages Projects 1 Releases Wiki Activity

Cleanup

This commit is contained in:
Stedd 2023-10-22 14:10:44 +02:00
parent 865eddb725
commit 8df11065df
1 changed files with 0 additions and 21 deletions
Show Stats Download Patch File Download Diff File Expand all files Collapse all files

21
plot.ino
View File

@ -8,13 +8,10 @@ void SerialPlot() {
// Serial.print(" "); // Serial.print(" ");
// IMU // IMU
// Serial.print("RollRate:"); // Serial.print("RollRate:");
// Serial.println(pitch_rate); // Serial.println(pitch_rate);
// Serial.print("Accelerometer_Pitch:"); // Serial.print("Accelerometer_Pitch:");
// Serial.println(acc_pitch); // Serial.println(acc_pitch);
// Serial.print("Pitch:"); // Serial.print("Pitch:");
// Serial.println(pitch); // Serial.println(pitch);
// Serial.print ( "," ); // Serial.print ( "," );
@ -39,29 +36,21 @@ void SerialPlot() {
// Encoders // Encoders
// Serial.print("m1Raw:"); // Serial.print("m1Raw:");
// Serial.println(m1Raw); // Serial.println(m1Raw);
// Serial.print("m2Raw:"); // Serial.print("m2Raw:");
// Serial.println(m2Raw); // Serial.println(m2Raw);
// // Motors // // Motors
// Serial.print("SpeedControllerOut:"); // Serial.print("SpeedControllerOut:");
// Serial.println(SC_cont_out); // Serial.println(SC_cont_out);
// Serial.print("BalanceOLControllerOut:"); // Serial.print("BalanceOLControllerOut:");
// Serial.println(OL_cont_out); // Serial.println(OL_cont_out);
// Serial.print("BalanceILControllerOut:"); // Serial.print("BalanceILControllerOut:");
// Serial.println(IL_cont_out); // Serial.println(IL_cont_out);
// Serial.print("TurnControllerOut:"); // Serial.print("TurnControllerOut:");
// Serial.println(TC_cont_out); // Serial.println(TC_cont_out);
// Serial.print("M1_CMD:"); // Serial.print("M1_CMD:");
// Serial.println(M1_Speed_CMD); // Serial.println(M1_Speed_CMD);
// Serial.print("M2_CMD:"); // Serial.print("M2_CMD:");
// Serial.println(M2_Speed_CMD); // Serial.println(M2_Speed_CMD);
// Serial.print("M1_Ang_Vel:"); // Serial.print("M1_Ang_Vel:");
// Serial.print(motor_ang_vel[0][0]); // Serial.print(motor_ang_vel[0][0]);
// Serial.print(" "); // Serial.print(" ");
@ -89,13 +78,3 @@ void SerialPlot() {
// Serial.println(Ps3.data.analog.stick.ry); // Serial.println(Ps3.data.analog.stick.ry);
// } // }
} }
// int PackFloat(int _i, float value) {
// data[_i] = (value & 0x000000FF) ;
// data[_i + 2] = (value & 0x0000FF00)>>8;
// data[_i + 3] = (value & 0x00FF0000)>>16;
// data[_i + 4] = (value & 0xFF000000)>>24;
// return _i + 4;
// }