![](/media/cache/img/default_profile.jpg.50x50_q85.jpg)
Display code
Dependencies: mbed reScale RotaryEncoder RPG Adafruit_ST7735 Adafruit_GFX PinDetect Ee24xx08 mRotaryEncoder
Diff: main.cpp
- Revision:
- 11:ce51026d8702
- Parent:
- 10:dd8d89133b28
- Child:
- 12:1e974964272e
diff -r dd8d89133b28 -r ce51026d8702 main.cpp --- a/main.cpp Sat Apr 13 20:38:22 2019 +0000 +++ b/main.cpp Sun Sep 15 18:41:03 2019 +0000 @@ -1,4 +1,4 @@ - #include "mbed.h" +#include "mbed.h" #include "Adafruit_ST7735.h" #include "RPG.h" #include "reScale.h" @@ -14,17 +14,17 @@ #define GREEN 0x07E0 #define CYAN 0x07FF #define MAGENTA 0xF81F -#define YELLOW 0xFFE0 +#define YELLOW 0xFFE0 #define WHITE 0xFFFF /* EEPROM Memory map: -1 - 50: N1 angles +1 - 50: N1 angles 51 - 100: Settings 101- 150: N2 angles 151- 200: Twitch settings 200- 250: unused -*/ +*/ #define currentToolAddress 51 #define numToolsAddress 52 @@ -54,7 +54,7 @@ int minServo = 500; reScale servo1Scale(-90,90,minServo,maxServo); // - PwmOut myServo(P1_13); //display board +PwmOut myServo(P1_13); //display board //PwmOut myServo(D4); //DigitalIn tUpButton(P2_11); @@ -70,1122 +70,1252 @@ int lastDownButton; int lastEncoderButton; - +int encoderMove = 0; int dirt = 0; -int main() { +int main() +{ // ************************************** SCREEN INIT ************************************************* - tft.initR(INITR_GREENTAB); // initialize a ST7735S chip, black tab - - tft.setRotation(3); - tft.fillScreen(BLACK); - tft.setCursor(30,120); - tft.setTextColor(BLUE); - tft.setTextWrap(false); - tft.printf("AccuBlast v1.1"); - - tft.setCursor(4, 4); - tft.setTextColor(WHITE); - tft.setTextSize(2); - tft.printf("N1"); - - tft.setCursor(80, 4); - tft.setTextColor(WHITE); - tft.setTextSize(2); - tft.printf("N2"); - - tft.setCursor(4, 28); - tft.setTextColor(WHITE); - tft.setTextSize(2); - tft.printf("T"); - - tft.setCursor(4, 50); - tft.setTextColor(WHITE); - tft.setTextSize(1); - tft.printf("Twitch:"); - - tft.setCursor(4, 65); - tft.setTextColor(WHITE); - tft.setTextSize(1); - tft.printf("Sync:"); - - tft.setCursor(4, 80); - tft.setTextColor(WHITE); - tft.setTextSize(1); - tft.printf("AUX 1:"); - - tft.setCursor(4, 95); - tft.setTextColor(WHITE); - tft.setTextSize(1); - tft.printf("AUX 2:"); - - tft.setCursor(4, 110); - tft.setTextColor(WHITE); - tft.setTextSize(1); - tft.printf("AUX 3:"); - - tft.setCursor(75, 95); - tft.setTextColor(WHITE); - tft.setTextSize(1); - tft.printf("Num Tls"); - - tft.setCursor(75, 110); - tft.setTextColor(WHITE); - tft.setTextSize(1); - tft.printf("Num Noz"); - - tft.setCursor(75, 50); - tft.setTextColor(WHITE); - tft.setTextSize(1); - tft.printf("N1 dir:"); - - tft.setCursor(75, 65); - tft.setTextColor(WHITE); - tft.setTextSize(1); - tft.printf("N2 dir:"); + tft.initR(INITR_GREENTAB); // initialize a ST7735S chip, black tab + + tft.setRotation(3); + tft.fillScreen(BLACK); + tft.setCursor(30,120); + tft.setTextColor(BLUE); + tft.setTextWrap(false); + tft.printf("AccuBlast v1.3"); + + tft.setCursor(4, 4); + tft.setTextColor(WHITE); + tft.setTextSize(2); + tft.printf("N1"); + + tft.setCursor(80, 4); + tft.setTextColor(WHITE); + tft.setTextSize(2); + tft.printf("N2"); + + tft.setCursor(4, 28); + tft.setTextColor(WHITE); + tft.setTextSize(2); + tft.printf("T"); + + tft.setCursor(4, 50); + tft.setTextColor(WHITE); + tft.setTextSize(1); + tft.printf("Twitch:"); + + tft.setCursor(4, 65); + tft.setTextColor(WHITE); + tft.setTextSize(1); + tft.printf("Sync:"); + + tft.setCursor(4, 80); + tft.setTextColor(WHITE); + tft.setTextSize(1); + tft.printf("AUX 1:"); + + tft.setCursor(4, 95); + tft.setTextColor(WHITE); + tft.setTextSize(1); + tft.printf("AUX 2:"); + + tft.setCursor(4, 110); + tft.setTextColor(WHITE); + tft.setTextSize(1); + tft.printf("AUX 3:"); + + tft.setCursor(75, 95); + tft.setTextColor(WHITE); + tft.setTextSize(1); + tft.printf("Num Tls"); + + tft.setCursor(75, 110); + tft.setTextColor(WHITE); + tft.setTextSize(1); + tft.printf("Num Noz"); + + tft.setCursor(75, 50); + tft.setTextColor(WHITE); + tft.setTextSize(1); + tft.printf("N1 dir:"); + + tft.setCursor(75, 65); + tft.setTextColor(WHITE); + tft.setTextSize(1); + tft.printf("N2 dir:"); + + tft.setCursor(75, 80); + tft.setTextColor(WHITE); + tft.setTextSize(1); + tft.printf("version:"); - tft.setCursor(75, 80); - tft.setTextColor(WHITE); - tft.setTextSize(1); - tft.printf("version:"); - - // ************************************************************************************************************** - int version = 0; // 0= basic, 1=pro - int lastVersion = 99; - - int sync = 0; // sync setting for N1 and N1 - int lastSync = 99; - int syncSpread = 0; - - int n1Dir = 0; // direction of knob for N1 - int lastN1Dir = 99; - - int n2Dir = 0; // direction of knob for N2 - int lastN2Dir = 99; +// ************************************************************************************************************** + int version = 0; // 0= basic, 1=pro + int lastVersion = 99; + + int sync = 0; // sync setting for N1 and N1 + int lastSync = 99; + int syncSpread = 0; + int syncFlag =0; ///// for count/ sync = 2 issue. 2019-09-11 + + int n1Dir = 0; // direction of knob for N1 + int lastN1Dir = 99; + + int n2Dir = 0; // direction of knob for N2 + int lastN2Dir = 99; + + int index = 0; - int index = 0; - - int count = 0; - int maxCount = 12; //max number of menu items - int lastCount = 99; - - int twitch = 0; - int lastTwitch = 300; - int lastTwitchMove = 0; - int twitchStart = 0; // has twitching begun? - int twitchDirection = 0; // 0 is up, 1 is down. - int maxTwitch = 0; - int minTwitch = 0; + int count = 0; + int maxCount = 12; //max number of menu items + int lastCount = 99; -int tw1 = 5; // stages of servo write to control speed of sweep. 11.11 Ms = 1 degree -int tw2 = 10; -int tw3 = 15; + int twitch = 0; + int lastTwitch = 300; + int lastTwitchMove = 0; + int twitchStart = 0; // has twitching begun? + int twitchDirection = 0; // 0 is up, 1 is down. + int maxTwitch = 0; + int minTwitch = 0; + + int tw1 = 5; // stages of servo write to control speed of sweep. 11.11 Ms = 1 degree + int tw2 = 10; + int tw3 = 15; + + int twReadMs = 100; // interval of twitch changes us. + + //************* Pull previous setting from eeprom ******************* -int twReadMs = 100; // interval of twitch changes us. - - //************* Pull previous setting from eeprom ******************* - - char tempToolNo = 0; // last tool in spindle - eeprom.read(currentToolAddress, &tempToolNo); - int currentToolNo = (int)tempToolNo; - - char tempNumTools = 0; // number of tools in ATC - eeprom.read(numToolsAddress, &tempNumTools); - int numTools = (int)tempNumTools; - - char tempNumNoz = 0; // number of nozzles installed - eeprom.read(numNozAddress, &tempNumNoz); - int numNoz = (int)tempNumNoz; - - char tempLastAngle = 0; // last angle of last tool in spindle N1 - eeprom.read(currentToolNo, &tempLastAngle); - int lastAngle = (int)tempLastAngle; - lastAngle = lastAngle - 90; // Not storing signed int, so signed value is 45 less than what was stored to memory. - - char tempLastAngleN2 = 0; // last angle of last tool in spindle - eeprom.read(currentToolNo+100, &tempLastAngleN2); - int lastAngleN2 = (int)tempLastAngleN2; - lastAngleN2 = lastAngleN2 - 90; // Not storing signed int, so signed value is 45 less than what was stored to memory. - - char tempLastTwitch = 0; // last Twitch setting for the current tool in spindle - eeprom.read(currentToolNo + 150, &tempLastTwitch); - twitch = (int)tempLastTwitch; // should be 1, 2 or 3. - - char tempLastVersion = 0; // version of system. 0=basic, 1=pro - eeprom.read(versionAddress, &tempLastVersion); - version = (int)tempLastVersion; - - char tempLastSync = 0; // previous sync setting - eeprom.read(syncAddress, &tempLastSync); - sync = (int)tempLastSync; - - char tempLastN1Dir = 0; // previous N1 knob direction setting - eeprom.read(n1DirAddress, &tempLastN1Dir); - n1Dir = (int)tempLastN1Dir; - + char tempToolNo = 0; // last tool in spindle + eeprom.read(currentToolAddress, &tempToolNo); + int currentToolNo = (int)tempToolNo; + + char tempNumTools = 0; // number of tools in ATC + eeprom.read(numToolsAddress, &tempNumTools); + int numTools = (int)tempNumTools; + + char tempNumNoz = 0; // number of nozzles installed + eeprom.read(numNozAddress, &tempNumNoz); + int numNoz = (int)tempNumNoz; + + char tempLastAngle = 0; // last angle of last tool in spindle N1 + eeprom.read(currentToolNo, &tempLastAngle); + int lastAngle = (int)tempLastAngle; + lastAngle = lastAngle - 90; // Not storing signed int, so signed value is 45 less than what was stored to memory. + + char tempLastAngleN2 = 0; // last angle of last tool in spindle + eeprom.read(currentToolNo+100, &tempLastAngleN2); + int lastAngleN2 = (int)tempLastAngleN2; + lastAngleN2 = lastAngleN2 - 90; // Not storing signed int, so signed value is 45 less than what was stored to memory. + + char tempLastTwitch = 0; // last Twitch setting for the current tool in spindle + eeprom.read(currentToolNo + 150, &tempLastTwitch); + twitch = (int)tempLastTwitch; // should be 1, 2 or 3. + + char tempLastVersion = 0; // version of system. 0=basic, 1=pro + eeprom.read(versionAddress, &tempLastVersion); + version = (int)tempLastVersion; + + char tempLastSync = 0; // previous sync setting + eeprom.read(syncAddress, &tempLastSync); + sync = (int)tempLastSync; + + char tempLastN1Dir = 0; // previous N1 knob direction setting + eeprom.read(n1DirAddress, &tempLastN1Dir); + n1Dir = (int)tempLastN1Dir; + char tempLastN2Dir = 0; // previous N2 knob direction setting - eeprom.read(n2DirAddress, &tempLastN2Dir); - n2Dir = (int)tempLastN2Dir; - - - /*EEprom test over 2 digits: - int test1 = 150; - eeprom.write(199, test1); - wait(1); -char tempN2char = 0; -eeprom.read(199, &tempN2char); -int tempN2 = (int)tempN2char; - tft.setCursor(130,120); - tft.setTextColor(RED); - tft.setTextSize(1); - tft.printf("%d", tempN2); - */ - - - //******************** Button debounce ********************************* - + eeprom.read(n2DirAddress, &tempLastN2Dir); + n2Dir = (int)tempLastN2Dir; - backButton.mode(PullUp); // button pull up - //tDownButton.mode(PullUp); // button pull up - encoderButton.mode(PullUp); - encoderFalseButton.mode(PullUp); - aButton.mode(PullUp); - -t.start(); // starts timer -lastBackButton = t.read_ms(); -lastDownButton = t.read_ms(); -lastEncoderButton = t.read_ms(); - - //**************************************************************************** - - int lastToolNo = 99; - int lastNumTools = -1; // trigger to write eeprom value for number of tools - - int lastNumNoz = 0; //trigger display for number of nozzles after startup - - int n1Pos = lastAngle; //Set servo to last known postition prior to power off - int lastN1Pos = 150; - - int n2Pos = lastAngleN2; - int lastN2Pos = 150; - - int servo1Pos = 0; - - // RPG rpg1(P2_2,P1_20,P0_23); // RPG (PinName pA, PinName pB, PinName pPB)P0_23 is unconnected!! ; - //mRotaryEncoder Enc(P2_2,P1_20,P0_23, PullUp, 500); - mRotaryEncoder Enc(P1_20,P2_2,P0_23, PullUp, 1000); - - myServo.period_ms(20); + /*EEprom test over 2 digits: + int test1 = 150; + eeprom.write(199, test1); + wait(1); + char tempN2char = 0; + eeprom.read(199, &tempN2char); + int tempN2 = (int)tempN2char; + tft.setCursor(130,120); + tft.setTextColor(RED); + tft.setTextSize(1); + tft.printf("%d", tempN2); + */ + + + //******************** Button debounce ********************************* + + + + backButton.mode(PullUp); // button pull up +//tDownButton.mode(PullUp); // button pull up + encoderButton.mode(PullUp); + encoderFalseButton.mode(PullUp); + aButton.mode(PullUp); + + t.start(); // starts timer + lastBackButton = t.read_ms(); + lastDownButton = t.read_ms(); + lastEncoderButton = t.read_ms(); + +//**************************************************************************** + + int lastToolNo = 99; + int lastNumTools = -1; // trigger to write eeprom value for number of tools + + int lastNumNoz = 0; //trigger display for number of nozzles after startup + + int n1Pos = lastAngle; //Set servo to last known postition prior to power off + int lastN1Pos = 150; -/* - char t1Ang = 200; - char t1Read = 0; - - eeprom.write(1, t1Ang); - wait(1); - eeprom.read(1, &t1Read); - + int n2Pos = lastAngleN2; + int lastN2Pos = 150; + + int servo1Pos = 0; + + +// RPG rpg1(P2_2,P1_20,P0_23); // RPG (PinName pA, PinName pB, PinName pPB)P0_23 is unconnected!! ; +//mRotaryEncoder Enc(P2_2,P1_20,P0_23, PullUp, 500); + mRotaryEncoder Enc(P1_20,P2_2,P0_23, PullUp, 1000); + + myServo.period_ms(20); + + /* + char t1Ang = 200; + char t1Read = 0; + + eeprom.write(1, t1Ang); + wait(1); + eeprom.read(1, &t1Read); + - tft.setCursor(30,110); - tft.setTextColor(WHITE); - tft.setTextWrap(true); - // tft.printf("%s\r\n",t1Read); - tft.printf("%d", currentTool); - */ - - uint8_t c = 0; // for 485 link - - - int serialToolNumber = 0; - int stage = 0; // for serial parsing - int Tens = 0; - int Ones = 0; - - dir = 0; - - wait(2); - Serial device(P0_14, P0_13, 19200); // RS 485 TX RX? - + tft.setCursor(30,110); + tft.setTextColor(WHITE); + tft.setTextWrap(true); + // tft.printf("%s\r\n",t1Read); + tft.printf("%d", currentTool); + */ + + uint8_t c = 0; // for 485 link + + + int serialToolNumber = 0; + int stage = 0; // for serial parsing + int Tens = 0; + int Ones = 0; + + dir = 0; + + wait(2); + Serial device(P0_14, P0_13, 19200); // RS 485 TX RX? + while(1) { - - - - /* - while (device.readable()) - { - c = device.getc(); + + + + /* + while (device.readable()) + { + c = device.getc(); + + + if (c == '+'){ + currentToolNo = currentToolNo +1; + if (currentToolNo > numTools){ + currentToolNo = 1; + } + } + + else if (c == '-'){ + currentToolNo = currentToolNo - 1; + if (currentToolNo > 1){ + currentToolNo = numTools; + } + } + } + */ + + /* + while (device.readable()) + { + + + c = device.getc(); + + if (c == 'M'){ + // stage = 1; - - if (c == '+'){ - currentToolNo = currentToolNo +1; - if (currentToolNo > numTools){ - currentToolNo = 1; - } - } - - else if (c == '-'){ - currentToolNo = currentToolNo - 1; - if (currentToolNo > 1){ - currentToolNo = numTools; - } - } - } - */ - - /* - while (device.readable()) - { - - - c = device.getc(); - - if (c == 'M'){ - // stage = 1; - - c = device.getc(); - if (c == '+'){ - - // tft.setTextColor(WHITE); - // tft.setCursor(100, 100); - // tft.printf("%d", c); - currentToolNo = currentToolNo +1; - if (currentToolNo > numTools){ - currentToolNo = 1; - } - } - - else if (c == '-'){ - currentToolNo = currentToolNo - 1; - if (currentToolNo < 1){ - currentToolNo = numTools; - } - } - - } - } - - */ - - - -//myled = 1; - -if (t.read() > 1200){ // timer can only hold 30 min, so reset after 20 -t.reset(); -lastBackButton = t.read_ms(); -lastDownButton = t.read_ms(); -lastEncoderButton = t.read_ms(); -} + c = device.getc(); + if (c == '+'){ + + // tft.setTextColor(WHITE); + // tft.setCursor(100, 100); + // tft.printf("%d", c); + currentToolNo = currentToolNo +1; + if (currentToolNo > numTools){ + currentToolNo = 1; + } + } + + else if (c == '-'){ + currentToolNo = currentToolNo - 1; + if (currentToolNo < 1){ + currentToolNo = numTools; + } + } + + } + } + + */ + + + +//myled = 1; + + if (t.read() > 1200) { // timer can only hold 30 min, so reset after 20 + t.reset(); + lastBackButton = t.read_ms(); + lastDownButton = t.read_ms(); + lastEncoderButton = t.read_ms(); + } -if (backButton == 0){ //Back button was pressed so back to default selection - count = 0; - } - -if (encoderButton == 0){ -if (t.read_ms() > (lastEncoderButton + 50)){ // from 200 -count = count + 1; //Reset count if PB pressed -} - if (count > maxCount){ - count = 0; - } -lastEncoderButton = t.read_ms(); - - if (count > maxCount){ - count = 0; - } - } + if (backButton == 0) { //Back button was pressed so back to default selection + count = 0; + } + + if (encoderButton == 0) { + if (t.read_ms() > (lastEncoderButton + 50)) { // from 200 + count = count + 1; //Reset count if PB pressed + } + if (count > maxCount) { + count = 0; + } + lastEncoderButton = t.read_ms(); + + if (count > maxCount) { + count = 0; + } + } + + +//**************************************************************************************** + + if (version == 0) { //Basic runs the servo direct from the display unit + if (twitch == 0) { + tw.stop(); + twitchStart = 0; + twitchDirection = 0; + servo1Pos = servo1Scale.from(n1Pos); + } + + if (twitch > 0) { + if (twitchStart == 0) { + tw.start(); // start timer for nozzle sweep + servo1Pos = servo1Scale.from(n1Pos); + lastTwitchMove = tw.read_ms(); // store time of last nozzle movement + minTwitch = servo1Pos; // store original servo postion for bottom of sweep + maxTwitch = servo1Pos + 1000; // 11.11mS per degree of sweep, 55 = 5 degrees of sweep. This should be a viariable set on the display. + twitchStart = 1; + } + if ((twitchStart == 1) && (tw.read_ms() > (lastTwitchMove + twReadMs))) { + if (twitchDirection == 0) { //going up + servo1Pos = servo1Pos + 100; // add variable amount of uS to the servo signal + + tft.setCursor(130,120); + tft.setTextColor(RED); + tft.setTextSize(1); + tft.printf("%d", servo1Pos); + + + if (servo1Pos > maxServo) { + servo1Pos = maxServo; + twitchDirection = 1; //reverse direction + } + if (servo1Pos > maxTwitch) { + servo1Pos = maxTwitch; + twitchDirection = 1; //reverse direction + } + lastTwitchMove = tw.read_ms(); + } + + if (twitchDirection == 1) { // going down + servo1Pos = servo1Pos - 100; // add variable amount of Ms to the servo signal + if (servo1Pos < minServo) { + servo1Pos = minServo; + twitchDirection = 0; //reverse direction + } + if (servo1Pos < minTwitch) { + servo1Pos = minTwitch; + twitchDirection = 0; //reverse direction + } + lastTwitchMove = tw.read_ms(); + } + } + } + + myServo.pulsewidth_us(servo1Pos); + } + + +//********************** update display values ********************************************** + + + if (currentToolNo != lastToolNo) { + /* + tft.fillRect(103, 2, 55,25, BLACK); + tft.setCursor(105, 4); + */ + tft.setCursor(22, 28); + tft.setTextColor(BLACK); + tft.setTextSize(2); + tft.printf("%d", lastToolNo); + tft.setTextColor(WHITE); + //tft.setTextSize(2); + // tft.printf("T"); + tft.setCursor(22,28); + tft.printf("%d", currentToolNo); + + tempLastAngle = 0; + eeprom.read(currentToolNo, &tempLastAngle); + lastAngle = (int)tempLastAngle; + lastAngle = lastAngle - 90; // Not storing signed int, so signed value is 90 less than what was stored to memory. + n1Pos = lastAngle; + + tempLastAngleN2 = 0; + eeprom.read(currentToolNo+100, &tempLastAngleN2); + int lastAngleN2 = (int)tempLastAngleN2; + lastAngleN2 = lastAngleN2 - 90; // Not storing signed int, so signed value is 45 less than what was stored to memory. + n2Pos = lastAngleN2; + + if (count == 0) { // if knob is on N1 adjust and ATC changes tools, update enc value) + Enc.Set(n1Pos); // test for ATC following issue! + } + + eeprom.write(currentToolAddress, currentToolNo); + wait(0.1); + tempLastTwitch = 0; + eeprom.read(currentToolNo + 150, &tempLastTwitch); // pull up previous twitch setting. + twitch = (int)tempLastTwitch; + lastToolNo = currentToolNo; + } + + + if (n1Pos != lastN1Pos) { + tft.setCursor(40, 4); + tft.setTextColor(BLACK); + tft.setTextSize(2); + tft.printf("%d", lastN1Pos); + tft.setCursor(40,4); + tft.setTextColor(GREEN); + tft.setTextSize(2); + tft.printf("%d", n1Pos); + eeprom.write(currentToolNo, n1Pos + 90); // store new angle in eeprom, add 90 because its an unsigned value. + //wait(0.1); // adjusted from 1 + dir=1; + device.printf("N"); + device.printf("%d", n1Pos + 190); //send over RS485 add 190 so no negative values and always 3 digits. + //device.printf("N245"); // TEST!!! + // tft.setCursor(100, 50); + // tft.setTextSize(2); + // tft.printf("%d", n1Pos + 145); + wait(0.05); + dir=0; + + //Enc.Set(n1Pos); // test!! + + lastN1Pos = n1Pos; + syncFlag =1; // set the flag after lastN1Pos has run once to allow REV sync setting in count ==0 2019-09-11 + } + + if (n2Pos != lastN2Pos && numNoz == 2) { + tft.setCursor(115, 4); + tft.setTextColor(BLACK); + tft.setTextSize(2); + tft.printf("%d", lastN2Pos); + tft.setCursor(115, 4); + tft.setTextColor(GREEN); + tft.setTextSize(2); + tft.printf("%d", n2Pos); + eeprom.write(currentToolNo +100, n2Pos + 90); // store new angle in eeprom, add 90 because its an unsigned value. + //wait(0.1); // adjusted from 1 + dir=1; + device.printf("N"); + device.printf("%d", n2Pos + 390); //send over RS485 add 390 so no negative values and always 3 digits. + //device.printf("N245"); // TEST!!! + // tft.setCursor(100, 50); + // tft.setTextSize(2); + // tft.printf("%d", n1Pos + 145); + wait(0.05); + dir=0; + lastN2Pos = n2Pos; + } + + + if (numTools != lastNumTools) { + tft.setCursor(133, 95); + tft.setTextColor(BLACK); + tft.setTextSize(1); + tft.printf("%d", lastNumTools); + tft.setCursor(133,95); + tft.setTextColor(WHITE); + tft.setTextSize(1); + tft.printf("%d", numTools); + eeprom.write(numToolsAddress, numTools); // store new angle in eeprom, add 45 because its an unsigned value. + //wait(0.1); // adjusted from 1 + lastNumTools = numTools; + } + + if (numNoz != lastNumNoz) { + tft.setCursor(133, 110); + tft.setTextColor(BLACK); + tft.setTextSize(1); + tft.printf("%d", lastNumNoz); + tft.setCursor(133,110); + tft.setTextColor(WHITE); + tft.setTextSize(1); + tft.printf("%d", numNoz); + eeprom.write(numNozAddress, numNoz); // store new angle in eeprom, add 45 because its an unsigned value. + //wait(0.1); // adjusted from 1 + + if (numNoz == 2) { + tft.setCursor(80, 4); + tft.setTextColor(WHITE); + tft.setTextSize(2); + tft.printf("N2"); + tft.drawRect(78,2,74,18,WHITE); + } + if (numNoz == 1) { + tft.setCursor(80, 4); + tft.setTextColor(BLACK); + tft.setTextSize(2); + tft.printf("N2"); + tft.setCursor(115, 4); + tft.printf("%d", n2Pos); + tft.drawRect(78,2,74,18,BLACK); + } + lastNumNoz = numNoz; + } + + + if (twitch != lastTwitch) { + tft.setCursor(52, 50); + tft.setTextColor(BLACK); + tft.setTextSize(1); + tft.printf("%d", lastTwitch); + tft.setCursor(52, 50); + tft.setTextColor(GREEN); + tft.setTextSize(1); + tft.printf("%d", twitch); + dir=1; + device.printf("W"); + device.printf("%d", twitch); + wait(0.05); + dir=0; + eeprom.write(currentToolNo +150, twitch); // store new twitch setting + lastN1Pos = 999; // trigger sending servo values to module + lastN2Pos = 999; + lastTwitch = twitch; + } + + if (sync != lastSync) { // + tft.setCursor(52, 65); + tft.setTextColor(BLACK); + tft.setTextSize(1); + if (lastSync == 0) { + tft.printf("OFF"); + } + if (lastSync == 1) { + tft.printf("ON"); + } + + tft.setCursor(52, 65); + tft.setTextSize(1); + if (sync == 0) { + tft.setTextColor(WHITE); + tft.printf("OFF"); + } + if (sync == 1) { + tft.setTextColor(GREEN); + tft.printf("ON"); + } + + + eeprom.write(syncAddress, sync); // store new twitch setting + syncSpread = (n2Pos - n1Pos); + + lastSync = sync; + + } + + if (n1Dir != lastN1Dir) { // + tft.setCursor(132, 50); + tft.setTextColor(BLACK); + tft.setTextSize(1); + if (lastN1Dir == 0) { + tft.printf("NOR"); + } + if (lastN1Dir == 1) { + tft.printf("REV"); + } + tft.setCursor(132, 50); + if (n1Dir == 0) { + tft.setTextColor(WHITE); + tft.printf("NOR"); + } + if (n1Dir == 1) { + tft.setTextColor(GREEN); + tft.printf("REV"); + } + eeprom.write(n1DirAddress, n1Dir); // store new twitch setting + lastN1Dir = n1Dir; + + dir=1; + device.printf("D1"); + device.printf("%d", n1Dir); + wait(0.05); + dir=0; + + } + + if (n2Dir != lastN2Dir) { // + tft.setCursor(132, 65); + tft.setTextColor(BLACK); + tft.setTextSize(1); + if (lastN2Dir == 0) { + tft.printf("NOR"); + } + if (lastN2Dir == 1) { + tft.printf("REV"); + } + tft.setCursor(132, 65); + if (n2Dir == 0) { + tft.setTextColor(WHITE); + tft.printf("NOR"); + } + if (n2Dir == 1) { + tft.setTextColor(GREEN); + tft.printf("REV"); + } + eeprom.write(n2DirAddress, n2Dir); // store new twitch setting + lastN2Dir = n2Dir; + + dir=1; + device.printf("D2"); + device.printf("%d", n2Dir); + wait(0.05); + dir=0; + + } + + if (version != lastVersion) { // + tft.setCursor(132, 80); + tft.setTextColor(BLACK); + tft.setTextSize(1); + if (lastVersion == 0) { + tft.printf("BAS"); + } + if (lastVersion == 1) { + tft.printf("PRO"); + } + tft.setCursor(132, 80); + if (version == 0) { + tft.setTextColor(WHITE); + tft.setTextSize(1); + tft.printf("BAS"); + } + if (version == 1) { + tft.setTextColor(RED); + tft.printf("PRO"); + } + eeprom.write(versionAddress, version); // store new twitch setting + lastVersion = version; + } // ************* Rectangles for identifying active selection ***************************** -if (count != lastCount){ - - if (count ==0){ - Enc.Set(n1Pos); - } - - else if (count == 1){ - Enc.Set(n2Pos); - } - - else if (count == 2){ - Enc.Set(currentToolNo); - } - - else if (count == 3){ - Enc.Set(twitch); - } - - else if (count == 4){ - Enc.Set(sync); - } - - else if (count == 8){ - Enc.Set(n1Dir); - } - - else if (count == 9){ - Enc.Set(n2Dir); - } - - else if (count == 10){ - Enc.Set(version); - } - - else if (count == 11){ - Enc.Set(numTools); - } + if (count != lastCount) { + + if (count ==0) { + Enc.Set(n1Pos); + lastN1Pos = n1Pos; ////*******************************2019-09-11 WAS FIX FOR SYNC REV RST = 90 + } + + else if (count == 1) { + Enc.Set(n2Pos); + } + + else if (count == 2) { + Enc.Set(currentToolNo); + } + + else if (count == 3) { + Enc.Set(twitch); + } + + else if (count == 4) { + Enc.Set(sync); + } + + else if (count == 8) { + Enc.Set(n1Dir); + } + + else if (count == 9) { + Enc.Set(n2Dir); + } + + else if (count == 10) { + Enc.Set(version); + } - else if (count == 12){ - Enc.Set(numNoz); - } + else if (count == 11) { + Enc.Set(numTools); + } + + else if (count == 12) { + Enc.Set(numNoz); + } + + + +// clear old boxes (white or black) + if (lastCount == 0) { + tft.drawRect(2,2,74,18,WHITE); + } + + else if ((lastCount == 1) && (numNoz == 2)) { + tft.drawRect(78,2,74,18,WHITE); + } + + else if (lastCount == 2) { + tft.drawRect(20,26,28,18,BLACK); + } + + else if (lastCount == 3) { + tft.drawRect(50,48,20,12,BLACK); + } + + else if (lastCount == 4) { + tft.drawRect(50,63,20,12,BLACK); + } + + else if (lastCount == 5) { + tft.drawRect(50,78,20,12,BLACK); + } + + else if (lastCount == 6) { + tft.drawRect(50,93,20,12,BLACK); + } - - - // clear old boxes (white or black) - if (lastCount == 0){ -tft.drawRect(2,2,74,18,WHITE); -} - -else if ((lastCount == 1) && (numNoz == 2)){ -tft.drawRect(78,2,74,18,WHITE); -} - -else if (lastCount == 2){ -tft.drawRect(20,26,28,18,BLACK); -} - -else if (lastCount == 3){ -tft.drawRect(50,48,20,12,BLACK); -} - -else if (lastCount == 4){ -tft.drawRect(50,63,20,12,BLACK); -} - -else if (lastCount == 5){ -tft.drawRect(50,78,20,12,BLACK); -} - -else if (lastCount == 6){ -tft.drawRect(50,93,20,12,BLACK); -} - -else if (lastCount == 7){ -tft.drawRect(50,108,20,12,BLACK); -} - -else if (lastCount == 8){ -tft.drawRect(130,48,20,12,BLACK); -} - -else if (lastCount == 9){ -tft.drawRect(130,63,20,12,BLACK); -} - -else if (lastCount == 10){ -tft.drawRect(130,78,20,12,BLACK); -} + else if (lastCount == 7) { + tft.drawRect(50,108,20,12,BLACK); + } + + else if (lastCount == 8) { + tft.drawRect(130,48,20,12,BLACK); + } + + else if (lastCount == 9) { + tft.drawRect(130,63,20,12,BLACK); + } + + else if (lastCount == 10) { + tft.drawRect(130,78,20,12,BLACK); + } -else if (lastCount == 11){ -tft.drawRect(130,93,20,12,BLACK); -} + else if (lastCount == 11) { + tft.drawRect(130,93,20,12,BLACK); + } + + else if (lastCount == 12) { + tft.drawRect(130,108,20,12,BLACK); + } + +// Set new box -else if (lastCount == 12){ -tft.drawRect(130,108,20,12,BLACK); -} + if (count == 0) { // N1 adjust + tft.drawRect(2,2,74,18,GREEN); + } + + else if ((count == 1) && (numNoz == 2)) { // N2 adjust + tft.drawRect(78,2,74,18,GREEN); + } + + else if (count == 2) { + tft.drawRect(20,26,28,18,GREEN); + } - // Set new box - -if (count == 0){ // N1 adjust -tft.drawRect(2,2,74,18,GREEN); -} + else if (count == 3) { + tft.drawRect(50,48,20,12,GREEN); + } -else if ((count == 1) && (numNoz == 2)){ // N2 adjust -tft.drawRect(78,2,74,18,GREEN); -} + else if (count == 4) { + tft.drawRect(50,63,20,12,GREEN); + } -else if (count == 2){ -tft.drawRect(20,26,28,18,GREEN); -} - -else if (count == 3){ -tft.drawRect(50,48,20,12,GREEN); -} + else if (count == 5) { + tft.drawRect(50,78,20,12,GREEN); + } -else if (count == 4){ -tft.drawRect(50,63,20,12,GREEN); -} + else if (count == 6) { + tft.drawRect(50,93,20,12,GREEN); + } -else if (count == 5){ -tft.drawRect(50,78,20,12,GREEN); -} + else if (count == 7) { + tft.drawRect(50,108,20,12,GREEN); + } -else if (count == 6){ -tft.drawRect(50,93,20,12,GREEN); -} + else if (count == 8) { + tft.drawRect(130,48,20,12,GREEN); + } -else if (count == 7){ -tft.drawRect(50,108,20,12,GREEN); -} - -else if (count == 8){ -tft.drawRect(130,48,20,12,GREEN); -} + else if (count == 9) { + tft.drawRect(130,63,20,12,GREEN); + } -else if (count == 9){ -tft.drawRect(130,63,20,12,GREEN); -} - -else if (count == 10){ -tft.drawRect(130,78,20,12,GREEN); -} + else if (count == 10) { + tft.drawRect(130,78,20,12,GREEN); + } -else if (count == 11){ -tft.drawRect(130,93,20,12,GREEN); -} + else if (count == 11) { + tft.drawRect(130,93,20,12,GREEN); + } -else if (count == 12){ -tft.drawRect(130,108,20,12,GREEN); -} + else if (count == 12) { + tft.drawRect(130,108,20,12,GREEN); + } -lastCount = count; -} + lastCount = count; + } - - //****************** ENCODER ACTIONS ************************************************ - if (count == 0){ // knob controls servo value -n1Pos = Enc.Get(); -if (sync == 1){ - n2Pos = (n1Pos + syncSpread); - if (n2Pos > 90){ - n2Pos = 90; - //Enc.Set(90); - } - if (n2Pos < -90){ - n2Pos = -90; - // Enc.Set(-90); - } - } - if (sync == 2){ - n2Pos = n2Pos + (lastN1Pos - n1Pos); - if (n2Pos > 90){ - n2Pos = 90; - //Enc.Set(90); - } - if (n2Pos < -90){ - n2Pos = -90; - // Enc.Set(-90); - } - } -if (n1Pos > 90){ - n1Pos = 90; - Enc.Set(90); - } - if (n1Pos < -90){ - n1Pos = -90; - Enc.Set(-90); - } - } - //*************************** - if (count == 1){ // knob controls servo value -n2Pos = Enc.Get(); -if (n2Pos > 90){ - n2Pos = 90; - Enc.Set(90); - } - if (n2Pos < -90){ - n2Pos = -90; - Enc.Set(-90); - } - } -//**************************** -if (count == 2){ //knob controls tool number + +//****************** ENCODER ACTIONS ************************************************ + if (count == 0) { // knob controls servo value + + if (n1Pos != Enc.Get()) { + //n1Pos = Enc.Get(); 2019-09-12 + if (sync == 0 && n1Dir ==0) { // n1 fwd + n1Pos = Enc.Get(); + } + + if (sync == 0 && n1Dir ==1) { // n1 rev + n1Pos = n1Pos + (n1Pos - Enc.Get()); + Enc.Set(n1Pos); + } + + + if (n1Pos > 90) { + n1Pos = 90; + Enc.Set(90); + } + + if (n1Pos < -90) { + n1Pos = -90; + Enc.Set(-90); + } + +//*** + + if (sync == 1 && n1Dir == 0 && n2Dir == 0) { // PASS 2019-09-12 + encoderMove = (Enc.Get() - n1Pos); // save direction change, positive or negative + if (encoderMove > 0 && n1Pos < 90 && n2Pos <90) { // Move is positive // stop both nozzles once ONE reaches limit. + n1Pos = Enc.Get(); + n2Pos = n2Pos + encoderMove; + encoderMove =0; + //Enc.Set(n1Pos); + } + + if (encoderMove < 0 && n1Pos > -90 && n2Pos >-90) { // Move is positive // stop both nozzles once ONE reaches limit. + n1Pos = Enc.Get(); + n2Pos = n2Pos + encoderMove; + encoderMove =0; + // Enc.Set(n1Pos); + } + Enc.Set(n1Pos); // reset encoder so it doesnt store counts past +90/ -90 + + } + + if (sync == 1 && n1Dir == 1 && n2Dir == 0) { + encoderMove = ( n1Pos - Enc.Get()); // save direction change, positive or negative + if (encoderMove > 0 && n1Pos > -90 && n2Pos <90) { // Move is positive // stop both nozzles once ONE reaches limit. + n1Pos = (n1Pos + encoderMove); + Enc.Set(n1Pos); + n2Pos = (n2Pos - encoderMove); + encoderMove=0; + } -currentToolNo = Enc.Get(); -if (currentToolNo > numTools){ - currentToolNo = numTools; - } - if (currentToolNo < 1){ - currentToolNo = 1; - Enc.Set(1); - } - } - //**************************** -if (count == 3){ // Knob controls twitch setting - twitch = Enc.Get(); - if (twitch < 0){ - twitch = 0; - Enc.Set(0); - } - if (twitch > 3){ - twitch = 3; - Enc.Set(3); - } - } - //**************************** - if (count == 4){ // Knob controls sync setting. 1=off, 2=sync, 3=rev - sync = Enc.Get(); - if (sync < 0){ - sync= 0; - Enc.Set(0); - } - if (sync > 2){ - sync = 2; - Enc.Set(2); - } - } - //**************************** - // 5,6,7 AUX? - if (count == 8){ // knob controls the direction of rotation for N1 - n1Dir = Enc.Get(); - - if (n1Dir > 1){ - n1Dir = 1; - Enc.Set(1); - } - - if (n1Dir < 0){ - n1Dir =0; - Enc.Set(0); - } - } -//**************************** - if (count == 9){ // knob controls the direction of rotation for N2 - n2Dir = Enc.Get(); - - if (n2Dir > 1){ - n2Dir = 1; - Enc.Set(1); - } - - if (n2Dir < 0){ - n2Dir =0; - Enc.Set(0); - } - } -//**************************** - if (count == 10){ // knob controls the version -version = Enc.Get(); - - if (version > 1){ - version = 1; - Enc.Set(1); - } - - if (version < 0){ - version =0; - Enc.Set(0); - } - } - //**************************** - if (count == 11){ //knob controls tool number -numTools = Enc.Get(); -if (numTools > 50){ - numTools = 50; - Enc.Set(50); - } - if (numTools < 1){ - numTools = 1; - Enc.Set(1); - } - } -//**************************** - if (count == 12){ //knob controls tool number -numNoz = Enc.Get(); -if (numNoz> 2){ - numNoz = 2; - Enc.Set(2); - } - if (numNoz < 1){ - numNoz = 1; - Enc.Set(1); - } - } -//**************************************************************************************** + if (encoderMove < 0 && n1Pos < 90 && n2Pos > -90) { // Move is positive // stop both nozzles once ONE reaches limit. + n1Pos = (n1Pos + encoderMove); + Enc.Set(n1Pos); + n2Pos = (n2Pos - encoderMove); + encoderMove=0; + } + Enc.Set(n1Pos); // reset encoder so it doesnt store counts past +90/ -90 + + } + + + if (sync == 1 && n1Dir == 0 && n2Dir == 1) { + encoderMove = (Enc.Get() - n1Pos); // save direction change, positive or negative + if (encoderMove < 0 && n1Pos > -90 && n2Pos <90) { // Move is positive // stop both nozzles once ONE reaches limit. + n1Pos = (n1Pos + encoderMove); + Enc.Set(n1Pos); + n2Pos = (n2Pos - encoderMove); + encoderMove=0; + } + + if (encoderMove > 0 && n1Pos < 90 && n2Pos > -90) { // Move is positive // stop both nozzles once ONE reaches limit. + n1Pos = (n1Pos + encoderMove); + Enc.Set(n1Pos); + n2Pos = (n2Pos - encoderMove); + encoderMove=0; + } + Enc.Set(n1Pos); // reset encoder so it doesnt store counts past +90/ -90 + } + + -if (version == 0){ //Basic runs the servo direct from the display unit -if (twitch == 0){ -tw.stop(); -twitchStart = 0; -twitchDirection = 0; -servo1Pos = servo1Scale.from(n1Pos); -} + if (sync == 1 && n1Dir == 1 && n2Dir == 1) { + encoderMove = (Enc.Get() - n1Pos); // save direction change, positive or negative + if (encoderMove > 0 && n1Pos > -90 && n2Pos >-90) { // Move is positive // stop both nozzles once ONE reaches limit. + n1Pos = (n1Pos - encoderMove); + Enc.Set(n1Pos); + n2Pos = (n2Pos - encoderMove); + encoderMove=0; + } -if (twitch > 0){ - if (twitchStart == 0){ - tw.start(); // start timer for nozzle sweep - servo1Pos = servo1Scale.from(n1Pos); - lastTwitchMove = tw.read_ms(); // store time of last nozzle movement - minTwitch = servo1Pos; // store original servo postion for bottom of sweep - maxTwitch = servo1Pos + 1000; // 11.11mS per degree of sweep, 55 = 5 degrees of sweep. This should be a viariable set on the display. - twitchStart = 1; - } - if ((twitchStart == 1) && (tw.read_ms() > (lastTwitchMove + twReadMs))){ - if (twitchDirection == 0){ //going up - servo1Pos = servo1Pos + 100; // add variable amount of uS to the servo signal - - tft.setCursor(130,120); - tft.setTextColor(RED); - tft.setTextSize(1); - tft.printf("%d", servo1Pos); - - - if (servo1Pos > maxServo){ - servo1Pos = maxServo; - twitchDirection = 1; //reverse direction + if (encoderMove < 0 && n1Pos < 90 && n2Pos < 90) { // Move is positive // stop both nozzles once ONE reaches limit. + n1Pos = (n1Pos - encoderMove); + Enc.Set(n1Pos); + n2Pos = (n2Pos - encoderMove); + encoderMove=0; + } + Enc.Set(n1Pos); // reset encoder so it doesnt store counts past +90/ -90 + } + } - if (servo1Pos > maxTwitch){ - servo1Pos = maxTwitch; - twitchDirection = 1; //reverse direction - } - lastTwitchMove = tw.read_ms(); + if (n1Pos > 90) { + n1Pos =90; + } + if (n1Pos < -90) { + n1Pos = -90; } - - if (twitchDirection == 1){ // going down - servo1Pos = servo1Pos - 100; // add variable amount of Ms to the servo signal - if (servo1Pos < minServo){ - servo1Pos = minServo; - twitchDirection = 0; //reverse direction + if (n2Pos > 90) { + n2Pos =90; } - if (servo1Pos < minTwitch){ - servo1Pos = minTwitch; - twitchDirection = 0; //reverse direction - } - lastTwitchMove = tw.read_ms(); - } - } - } - -myServo.pulsewidth_us(servo1Pos); -} + if (n2Pos < -90) { + n2Pos = -90; + } + } -//********************** update display values ********************************************** +//*************************** + if (count == 1) { // knob controls servo value + + if (n2Pos != Enc.Get()) { + encoderMove = (Enc.Get() - n2Pos); // save direction change, positive or negative + + if (n2Dir == 0 && encoderMove >0 && n2Pos < 90){ // normal direction + n2Pos = n2Pos + encoderMove; + encoderMove=0; + } + if (n2Dir == 0 && encoderMove <0 && n2Pos > -90){ // normal direction + n2Pos = n2Pos + encoderMove; + encoderMove=0; + } - - if (currentToolNo != lastToolNo){ - /* - tft.fillRect(103, 2, 55,25, BLACK); - tft.setCursor(105, 4); - */ - tft.setCursor(22, 28); - tft.setTextColor(BLACK); - tft.setTextSize(2); - tft.printf("%d", lastToolNo); - tft.setTextColor(WHITE); - //tft.setTextSize(2); - // tft.printf("T"); - tft.setCursor(22,28); - tft.printf("%d", currentToolNo); - tempLastAngle = 0; - eeprom.read(currentToolNo, &tempLastAngle); - lastAngle = (int)tempLastAngle; - lastAngle = lastAngle - 90; // Not storing signed int, so signed value is 90 less than what was stored to memory. - n1Pos = lastAngle; - - if (count == 0){ // if knob is on N1 adjust and ATC changes tools, update enc value) - Enc.Set(n1Pos); // test for ATC following issue! + if (n2Dir == 1 && encoderMove <0 && n2Pos < 90){ // reverse direction + n2Pos = n2Pos - encoderMove; + encoderMove=0; + } + if (n2Dir == 1 && encoderMove >0 && n2Pos > -90){ // reverse direction + n2Pos = n2Pos - encoderMove; + encoderMove=0; + } + Enc.Set(n2Pos); // reset encoder so it doesnt store counts past +90/ -90 + if (n2Pos > 90){ + n2Pos = 90; + } + if (n2Pos < -90){ + n2Pos = -90; + } } - eeprom.write(currentToolAddress, currentToolNo); - wait(0.1); - tempLastTwitch = 0; - eeprom.read(currentToolNo + 150, &tempLastTwitch); // pull up previous twitch setting. - twitch = (int)tempLastTwitch; - lastToolNo = currentToolNo; + } +//**************************** + if (count == 2) { //knob controls tool number + + currentToolNo = Enc.Get(); + if (currentToolNo > numTools) { + currentToolNo = numTools; + } + if (currentToolNo < 1) { + currentToolNo = 1; + Enc.Set(1); + } + } +//**************************** + if (count == 3) { // Knob controls twitch setting + twitch = Enc.Get(); + if (twitch < 0) { + twitch = 0; + Enc.Set(0); + } + if (twitch > 3) { + twitch = 3; + Enc.Set(3); + } } - - - if (n1Pos != lastN1Pos){ - tft.setCursor(40, 4); - tft.setTextColor(BLACK); - tft.setTextSize(2); - tft.printf("%d", lastN1Pos); - tft.setCursor(40,4); - tft.setTextColor(GREEN); - tft.setTextSize(2); - tft.printf("%d", n1Pos); - eeprom.write(currentToolNo, n1Pos + 90); // store new angle in eeprom, add 90 because its an unsigned value. - //wait(0.1); // adjusted from 1 - dir=1; - device.printf("N"); - device.printf("%d", n1Pos + 190); //send over RS485 add 190 so no negative values and always 3 digits. - //device.printf("N245"); // TEST!!! - // tft.setCursor(100, 50); - // tft.setTextSize(2); - // tft.printf("%d", n1Pos + 145); - wait(0.05); - dir=0; - - //Enc.Set(n1Pos); // test!! - - lastN1Pos = n1Pos; - } - -if (n2Pos != lastN2Pos && numNoz == 2){ - tft.setCursor(115, 4); - tft.setTextColor(BLACK); - tft.setTextSize(2); - tft.printf("%d", lastN2Pos); - tft.setCursor(115, 4); - tft.setTextColor(GREEN); - tft.setTextSize(2); - tft.printf("%d", n2Pos); - eeprom.write(currentToolNo +100, n2Pos + 90); // store new angle in eeprom, add 90 because its an unsigned value. - //wait(0.1); // adjusted from 1 - dir=1; - device.printf("N"); - device.printf("%d", n2Pos + 390); //send over RS485 add 390 so no negative values and always 3 digits. - //device.printf("N245"); // TEST!!! - // tft.setCursor(100, 50); - // tft.setTextSize(2); - // tft.printf("%d", n1Pos + 145); - wait(0.05); - dir=0; - lastN2Pos = n2Pos; - } - - - if (numTools != lastNumTools){ - tft.setCursor(133, 95); - tft.setTextColor(BLACK); - tft.setTextSize(1); - tft.printf("%d", lastNumTools); - tft.setCursor(133,95); - tft.setTextColor(WHITE); - tft.setTextSize(1); - tft.printf("%d", numTools); - eeprom.write(numToolsAddress, numTools); // store new angle in eeprom, add 45 because its an unsigned value. - //wait(0.1); // adjusted from 1 - lastNumTools = numTools; - } +//**************************** + if (count == 4) { // Knob controls sync setting. 1=off, 2=sync, 3=rev + sync = Enc.Get(); + if (sync < 0) { + sync= 0; + Enc.Set(0); + } + if (sync > 1) { + sync = 1; + Enc.Set(1); + } + } + //**************************** + // 5,6,7 AUX? + if (count == 8) { // knob controls the direction of rotation for N1 + n1Dir = Enc.Get(); - if (numNoz != lastNumNoz){ - tft.setCursor(133, 110); - tft.setTextColor(BLACK); - tft.setTextSize(1); - tft.printf("%d", lastNumNoz); - tft.setCursor(133,110); - tft.setTextColor(WHITE); - tft.setTextSize(1); - tft.printf("%d", numNoz); - eeprom.write(numNozAddress, numNoz); // store new angle in eeprom, add 45 because its an unsigned value. - //wait(0.1); // adjusted from 1 - - if (numNoz == 2){ - tft.setCursor(80, 4); - tft.setTextColor(WHITE); - tft.setTextSize(2); - tft.printf("N2"); - tft.drawRect(78,2,74,18,WHITE); - } - if (numNoz == 1){ - tft.setCursor(80, 4); - tft.setTextColor(BLACK); - tft.setTextSize(2); - tft.printf("N2"); - tft.setCursor(115, 4); - tft.printf("%d", n2Pos); - tft.drawRect(78,2,74,18,BLACK); + if (n1Dir > 1) { + n1Dir = 1; + Enc.Set(1); + } + + if (n1Dir < 0) { + n1Dir =0; + Enc.Set(0); + } } - lastNumNoz = numNoz; - } - - - if (twitch != lastTwitch){ - tft.setCursor(52, 50); - tft.setTextColor(BLACK); - tft.setTextSize(1); - tft.printf("%d", lastTwitch); - tft.setCursor(52, 50); - tft.setTextColor(GREEN); - tft.setTextSize(1); - tft.printf("%d", twitch); - dir=1; - device.printf("W"); - device.printf("%d", twitch); - wait(0.05); - dir=0; - eeprom.write(currentToolNo +150, twitch); // store new twitch setting - lastN1Pos = 999; // trigger sending servo values to module - lastN2Pos = 999; - lastTwitch = twitch; -} +//**************************** + if (count == 9) { // knob controls the direction of rotation for N2 + n2Dir = Enc.Get(); + + if (n2Dir > 1) { + n2Dir = 1; + Enc.Set(1); + } - if (sync != lastSync){ // - tft.setCursor(52, 65); - tft.setTextColor(BLACK); - tft.setTextSize(1); - if (lastSync == 0){ - tft.printf("OFF"); - } - if (lastSync == 1){ - tft.printf("ON"); + if (n2Dir < 0) { + n2Dir =0; + Enc.Set(0); + } } - if (lastSync == 2){ - tft.printf("REV"); - } - tft.setCursor(52, 65); - tft.setTextSize(1); - if (sync == 0){ - tft.setTextColor(WHITE); - tft.printf("OFF"); - } - if (sync == 1){ - tft.setTextColor(GREEN); - tft.printf("ON"); - } - if (sync == 2){ - tft.setTextColor(RED); - tft.printf("REV"); - } - eeprom.write(syncAddress, sync); // store new twitch setting - syncSpread = (n2Pos - n1Pos); - - lastSync = sync; - -} +//**************************** + if (count == 10) { // knob controls the version + version = Enc.Get(); + + if (version > 1) { + version = 1; + Enc.Set(1); + } - if (n1Dir != lastN1Dir){ // - tft.setCursor(132, 50); - tft.setTextColor(BLACK); - tft.setTextSize(1); - if (lastN1Dir == 0){ - tft.printf("NOR"); - } - if (lastN1Dir == 1){ - tft.printf("REV"); - } - tft.setCursor(132, 50); - if (n1Dir == 0){ - tft.setTextColor(WHITE); - tft.printf("NOR"); - } - if (n1Dir == 1){ - tft.setTextColor(GREEN); - tft.printf("REV"); - } - eeprom.write(n1DirAddress, n1Dir); // store new twitch setting - lastN1Dir = n1Dir; -} - - if (n2Dir != lastN2Dir){ // - tft.setCursor(132, 65); - tft.setTextColor(BLACK); - tft.setTextSize(1); - if (lastN2Dir == 0){ - tft.printf("NOR"); + if (version < 0) { + version =0; + Enc.Set(0); + } } - if (lastN2Dir == 1){ - tft.printf("REV"); - } - tft.setCursor(132, 65); - if (n2Dir == 0){ - tft.setTextColor(WHITE); - tft.printf("NOR"); +//**************************** + if (count == 11) { //knob controls tool number + numTools = Enc.Get(); + if (numTools > 50) { + numTools = 50; + Enc.Set(50); + } + if (numTools < 1) { + numTools = 1; + Enc.Set(1); + } } - if (n2Dir == 1){ - tft.setTextColor(GREEN); - tft.printf("REV"); +//**************************** + if (count == 12) { //knob controls tool number + numNoz = Enc.Get(); + if (numNoz> 2) { + numNoz = 2; + Enc.Set(2); + } + if (numNoz < 1) { + numNoz = 1; + Enc.Set(1); + } } - eeprom.write(n2DirAddress, n2Dir); // store new twitch setting - lastN2Dir = n2Dir; -} - if (version != lastVersion){ // - tft.setCursor(132, 80); - tft.setTextColor(BLACK); - tft.setTextSize(1); - if (lastVersion == 0){ - tft.printf("BAS"); - } - if (lastVersion == 1){ - tft.printf("PRO"); - } - tft.setCursor(132, 80); - if (version == 0){ - tft.setTextColor(WHITE); - tft.setTextSize(1); - tft.printf("BAS"); - } - if (version == 1){ - tft.setTextColor(RED); - tft.printf("PRO"); - } - eeprom.write(versionAddress, version); // store new twitch setting - lastVersion = version; -} //**************************** RS485 link *************************************** -while (device.readable()) - { - c = device.getc(); - - if (c == 'T'){ // Actual tool number sent over serial - - index = 1; - - } - - - if (c == 'M'){ // magazine + or - sent over serial - index = 5; - } - - if (index == 1){ - c = device.getc(); - if (c == '1'){ // hundreds place to know we are sending 3 digits - index = 2; - } - } - + while (device.readable()) { + c = device.getc(); + + if (c == 'T') { // Actual tool number sent over serial + + index = 1; + + } + + + if (c == 'M') { // magazine + or - sent over serial + index = 5; + } - - if (index == 2){ // tool number 10's column - - c = device.getc(); - - if (c=='0'){ - Tens = 0; + if (index == 1) { + c = device.getc(); + if (c == '1') { // hundreds place to know we are sending 3 digits + index = 2; + } + } + + + + if (index == 2) { // tool number 10's column + + c = device.getc(); + + if (c=='0') { + Tens = 0; + index = 4; + + } + + else if (c=='1') { + Tens = 1; index = 4; - - } - - else if (c=='1'){ - Tens = 1; - index = 4; - - } - - else if (c=='2'){ - Tens = 2; - index = 4; - - } - - else if (c=='3'){ - Tens = 3; - index = 4; - - } - - else if (c=='4'){ - Tens = 4; - index = 4; - } - - else if (c=='5'){ //max number of tools is 50 - Tens = 5; - index = 4; - } - - } - - if (index == 4){ // tool number ones column - - c = device.getc(); - - if (c=='0'){ - Ones = 0; - - } - - else if (c=='1'){ - Ones = 1; - - - } - - else if (c=='2'){ - Ones = 2; - - } - - else if (c=='3'){ - Ones = 3; - - } - - else if (c=='4'){ - Ones = 4; - } - - else if (c=='5'){ - Ones = 5; - } - - else if (c=='6'){ - Ones = 6; - } - - else if (c=='7'){ - Ones = 7; - } - - else if (c=='8'){ - Ones = 8; - } - - else if (c=='9'){ - Ones = 9; - } - - else if (c=='0'){ - Ones = 0; - } - - - - serialToolNumber = ((Tens * 10) + Ones); - - currentToolNo = serialToolNumber; // update tool number - - index=0; - + + } + + else if (c=='2') { + Tens = 2; + index = 4; + + } + + else if (c=='3') { + Tens = 3; + index = 4; + + } + + else if (c=='4') { + Tens = 4; + index = 4; } - - if (index == 5){ // magazine monitoring - + + else if (c=='5') { //max number of tools is 50 + Tens = 5; + index = 4; + } + + } + + if (index == 4) { // tool number ones column - - c = device.getc(); + c = device.getc(); + + if (c=='0') { + Ones = 0; - if (c == '+'){ + } + + else if (c=='1') { + Ones = 1; - currentToolNo = (currentToolNo +1); - if (currentToolNo > numTools){ - currentToolNo = 1; - } - index = 0; - } - else if (c == '-'){ - /* - tft.setTextColor(WHITE); - tft.setCursor(100, 100); - tft.printf("1"); - */ - currentToolNo = (currentToolNo -1); - if (currentToolNo < 1){ - currentToolNo = numTools; - } - index = 0; + } + + else if (c=='2') { + Ones = 2; + + } + + else if (c=='3') { + Ones = 3; + + } + + else if (c=='4') { + Ones = 4; + } + + else if (c=='5') { + Ones = 5; + } + + else if (c=='6') { + Ones = 6; + } + + else if (c=='7') { + Ones = 7; + } + + else if (c=='8') { + Ones = 8; + } + + else if (c=='9') { + Ones = 9; + } + + else if (c=='0') { + Ones = 0; } - -} + + + + serialToolNumber = ((Tens * 10) + Ones); + + currentToolNo = serialToolNumber; // update tool number + + index=0; + + } + + if (index == 5) { // magazine monitoring + + + + c = device.getc(); + + if (c == '+') { + + + currentToolNo = (currentToolNo +1); + if (currentToolNo > numTools) { + currentToolNo = 1; + } + index = 0; + } else if (c == '-') { + /* + tft.setTextColor(WHITE); + tft.setCursor(100, 100); + tft.printf("1"); + */ + currentToolNo = (currentToolNo -1); + if (currentToolNo < 1) { + currentToolNo = numTools; + } + index = 0; + } + + } + } + + } } -} -} -