public void CONFIGoff() {
myPort.write("j"); // exit config command
buttonWRITE.setColorBackground(gray_);
buttonREAD.setColorBackground(gray_);
buttonCONFon.setColorBackground(gray_);
buttonCONFoff.setColorBackground(green_);
writeEnable = false;
readEnable = false;
}
public void CONFIGon() {
myPort.write("i"); // enter config command
buttonWRITE.setColorBackground(green_);
buttonREAD.setColorBackground(green_);
buttonCONFon.setColorBackground(green_);
buttonCONFoff.setColorBackground(gray_);
writeEnable = true;
readEnable = true;
}
public void P2() {
buttonP0.setColorBackground(gray_);
buttonP1.setColorBackground(gray_);
buttonP2.setColorBackground(green_);
// Open the port you are using at the rate you want:
if (portopen == true) {
myPort.stop();
}
myPort = new Serial(this, Serial.list()[2], 9600);
portopen = true;
}
public void READ() {
if (readEnable == false) return;
myPort.write("g"); // sends get values command
while (i < 200000000) {
i++;
} // delay
i = 0;
// myPort.write("OK");
readStatus = "Can't Read";
if (myPort.read() == 'x') {
PitchP.setValue(myPort.read() / 100.00f);
RollP.setValue(myPort.read() / 100.00f);
YawP.setValue(myPort.read() / 100.00f);
PitchD.setValue(myPort.read() / 100.00f);
RollD.setValue(myPort.read() / 100.00f);
YawD.setValue(myPort.read() / 100.00f);
PitchPWR.setValue(myPort.read());
RollPWR.setValue(myPort.read());
YawPWR.setValue(myPort.read());
RCcontrol = PApplet.parseChar(myPort.read());
YawRCon = PApplet.parseChar(myPort.read());
RollCal.setValue((myPort.read() - 100.00f) / 10.00f);
if (RCcontrol == '0') {
buttonRCOff.setColorBackground(green_);
buttonRCOn.setColorBackground(gray_);
}
if (RCcontrol == '1') {
buttonRCOff.setColorBackground(gray_);
buttonRCOn.setColorBackground(green_);
}
if (YawRCon == '0') {
buttonYawRC.setColorBackground(gray_);
buttonYawAut.setColorBackground(green_);
}
if (YawRCon == '1') {
buttonYawRC.setColorBackground(green_);
buttonYawAut.setColorBackground(gray_);
}
readStatus = "Read OK";
}
}
public void setup() {
size(600, 280);
background(75);
textSize(28);
fill(0, 120, 170); // blue
text("EvvGC GUI", 20, 50);
text(Version, 170, 50);
// Define colors
b1 = color(80);
b2 = color(60);
c1 = color(80, 80, 80);
c2 = color(60, 61, 59);
controlP5 = new ControlP5(this); // initialize the GUI controls
// List all the available serial ports:
println(Serial.list());
commListMax = -1;
for (int i = 0; i < Serial.list().length; i++) {
commListMax = i;
}
/**
* ****************************PID
* cells************************************************************
*/
PitchP = (controlP5.Numberbox) hideLabel(controlP5.addNumberbox("PitchP", 0, xPP, yPP, 40, 16));
PitchP.setColorBackground(gray_);
PitchP.setMin(0);
PitchP.setDirection(Controller.HORIZONTAL);
PitchP.setDecimalPrecision(2);
PitchP.setMultiplier(0.01f);
PitchP.setMax(2.54f);
PitchD = (controlP5.Numberbox) hideLabel(controlP5.addNumberbox("PitchD", 0, xPD, yPD, 40, 16));
PitchD.setColorBackground(gray_);
PitchD.setMin(0);
PitchD.setDirection(Controller.HORIZONTAL);
PitchD.setDecimalPrecision(2);
PitchD.setMultiplier(0.01f);
PitchD.setMax(1);
RollP = (controlP5.Numberbox) hideLabel(controlP5.addNumberbox("RollP", 0, xRP, yRP, 40, 16));
RollP.setColorBackground(gray_);
RollP.setMin(0);
RollP.setDirection(Controller.HORIZONTAL);
RollP.setDecimalPrecision(2);
RollP.setMultiplier(0.01f);
RollP.setMax(2.54f);
RollD = (controlP5.Numberbox) hideLabel(controlP5.addNumberbox("RollD", 0, xRD, yRD, 40, 16));
RollD.setColorBackground(gray_);
RollD.setMin(0);
RollD.setDirection(Controller.HORIZONTAL);
RollD.setDecimalPrecision(2);
RollD.setMultiplier(0.01f);
RollD.setMax(1);
YawP = (controlP5.Numberbox) hideLabel(controlP5.addNumberbox("YawP", 0, xYP, yYP, 40, 16));
YawP.setColorBackground(gray_);
YawP.setMin(0);
YawP.setDirection(Controller.HORIZONTAL);
YawP.setDecimalPrecision(2);
YawP.setMultiplier(0.01f);
YawP.setMax(2.54f);
YawD = (controlP5.Numberbox) hideLabel(controlP5.addNumberbox("YawD", 0, xYD, yYD, 40, 16));
YawD.setColorBackground(gray_);
YawD.setMin(0);
YawD.setDirection(Controller.HORIZONTAL);
YawD.setDecimalPrecision(2);
YawD.setMultiplier(0.01f);
YawD.setMax(1);
/**
* ****************************Power
* cells************************************************************
*/
PitchPWR =
(controlP5.Numberbox)
hideLabel(controlP5.addNumberbox("PitchPWR", 0, xPPWR, yPPWR, 40, 16));
PitchPWR.setColorBackground(gray_);
PitchPWR.setMin(0);
PitchPWR.setDirection(Controller.HORIZONTAL);
PitchPWR.setDecimalPrecision(0);
PitchPWR.setMultiplier(1);
PitchPWR.setMax(100);
RollPWR =
(controlP5.Numberbox) hideLabel(controlP5.addNumberbox("RollPWR", 0, xRPWR, yRPWR, 40, 16));
RollPWR.setColorBackground(gray_);
RollPWR.setMin(0);
RollPWR.setDirection(Controller.HORIZONTAL);
RollPWR.setDecimalPrecision(0);
RollPWR.setMultiplier(1);
RollPWR.setMax(100);
YawPWR =
(controlP5.Numberbox) hideLabel(controlP5.addNumberbox("YawPWR", 0, xYPWR, yYPWR, 40, 16));
YawPWR.setColorBackground(gray_);
YawPWR.setMin(0);
YawPWR.setDirection(Controller.HORIZONTAL);
YawPWR.setDecimalPrecision(0);
YawPWR.setMultiplier(1);
YawPWR.setMax(100);
/**
* ****************************Calibration
* cells************************************************************
*/
RollCal =
(controlP5.Numberbox)
hideLabel(controlP5.addNumberbox("RollCal", 0, xRollCal, yRollCal, 40, 16));
RollCal.setColorBackground(gray_);
RollCal.setMin(-10);
RollCal.setDirection(Controller.HORIZONTAL);
RollCal.setDecimalPrecision(1);
RollCal.setMultiplier(0.2f);
RollCal.setMax(10);
buttonZeroRoll = controlP5.addButton("ZERO", 1, 535, 200, 40, 16);
buttonZeroRoll.setColorBackground(gray_);
/**
* **************************Buttons********************************************************************
*/
buttonWRITE = controlP5.addButton("WRITE", 1, 500, 248, 60, 20);
buttonWRITE.setColorBackground(gray_);
buttonREAD = controlP5.addButton("READ", 1, 40, 248, 60, 20);
buttonREAD.setColorBackground(gray_);
buttonCONFon = controlP5.addButton("CONFIGon", 1, 400, 10, 60, 60);
buttonCONFon.setColorBackground(gray_);
buttonCONFoff = controlP5.addButton("CONFIGoff", 1, 330, 10, 60, 60);
buttonCONFoff.setColorBackground(gray_);
buttonP0 = controlP5.addButton("P0", 1, 490, 5, 20, 20);
buttonP0.setColorBackground(gray_);
buttonP1 = controlP5.addButton("P1", 1, 490, 30, 20, 20);
buttonP1.setColorBackground(gray_);
buttonP2 = controlP5.addButton("P2", 1, 490, 55, 20, 20);
buttonP2.setColorBackground(gray_);
buttonRCOff = controlP5.addButton("RC_OFF", 1, 450, 122, 65, 20);
buttonRCOff.setColorBackground(gray_);
buttonRCOn = controlP5.addButton("RC_ON", 1, 450, 100, 65, 20);
buttonRCOn.setColorBackground(gray_);
buttonYawRC = controlP5.addButton("Yaw_RC_Pan", 1, 520, 100, 75, 20);
buttonYawRC.setColorBackground(gray_);
buttonYawAut = controlP5.addButton("Yaw_Auto_Pan", 1, 520, 122, 75, 20);
buttonYawAut.setColorBackground(gray_);
buttonCONFoff.setColorBackground(green_);
}
public void Yaw_Auto_Pan() {
buttonYawRC.setColorBackground(gray_);
buttonYawAut.setColorBackground(green_);
YawRCon = '0';
}
public void RC_ON() {
buttonRCOff.setColorBackground(gray_);
buttonRCOn.setColorBackground(green_);
RCcontrol = '1';
}