public void SAVE_PID(int theValue) {
// save PID parameter on Arduino EEPROM
if (init_com == 0) return;
serial.write('S');
// println("Save PID");
}
public void draw() {
background(0);
// Strings composition
textFont(createFont("Arial bold", 24));
fill(c_red);
stroke(255);
text("OpenWheels GUI V1.0", 20, 30);
textSize(16);
// textAlign(CENTER);
fill(c_azure);
text("Acc_RAW: " + Acc_RAW, 150, 65);
AccSlider.setValue(Acc_RAW);
text("Gyro_RAW: " + Gyro_RAW, 150, 90);
GyroSlider.setValue(Gyro_RAW);
text("Acc_Angle: " + Acc_Angle + "\u00b0", 150, 115);
text("Gyro_Rate: " + Gyro_Rate + "\u00b0/sec", 150, 140);
text("Drive: " + Drive, 150, 165);
text("Steer: " + Steer, 150, 190);
text("BatLevel: " + nf(BatLevel, 1, 1) + "V", 150, 215);
text("Status: " + statusFlag, 150, 240);
graphGauge();
graphGrid();
// call the function that plot the angular of acc, with few screen settings
graphRoll(PApplet.parseFloat(Acc_Angle), VideoBuffer2, c_red); // xPos, YPos, YSpan
// call the function that plot the estimate angular, with few screen settings
graphRoll(Angle, VideoBuffer1, c_yellow); // xPos, YPos, YSpan
// call arduino for data every timePolling [msec]
int timePolling = 50; // 50msec=20Hz
time1 = millis();
if (init_com == 1) {
while (serial.available() > 0) processSerialData();
if ((time1 - time2) > timePolling) {
if (requestPID == true) {
serial.write('E');
requestPID = false;
} else if (writePID == true) {
int P = PApplet.parseInt(conf_KP.value());
int I = PApplet.parseInt(conf_KI.value());
int D = PApplet.parseInt(conf_KD.value());
char data[] = {0, 0, 0, 0, 0};
data[0] = 'W';
data[1] = PApplet.parseChar(P);
data[2] = PApplet.parseChar(I);
data[3] = PApplet.parseChar(D);
data[4] = ' ';
String str = new String(data);
serial.write(str);
println(str);
// println(" P=" + P + " I=" + I + " D=" + D);
writePID = false;
}
// else if (RUN==true ) {serial.write('A');}
else {
serial.write('A');
}
time2 = time1;
}
}
}
public void SET_ZERO(int theValue) {
// set zero acc e gyro
if (init_com == 0) return;
serial.write('Z');
println("Zet Zero");
}