![](/media/cache/img/default_profile.jpg.50x50_q85.jpg)
Display code
Dependencies: mbed reScale RotaryEncoder RPG Adafruit_ST7735 Adafruit_GFX PinDetect Ee24xx08 mRotaryEncoder
main.cpp
- Committer:
- BETZtechnik
- Date:
- 2019-10-06
- Revision:
- 13:83cb3b5c69de
- Parent:
- 12:1e974964272e
File content as of revision 13:83cb3b5c69de:
#include "mbed.h" #include "Adafruit_ST7735.h" #include "RPG.h" #include "reScale.h" #include "Ee24xx08.h" #include "mRotaryEncoder.h" // DISPLAY INIT: #define BLACK 0x0000 #define BLUE 0x001F #define RED 0xF800 #define GREEN 0x07E0 #define CYAN 0x07FF #define MAGENTA 0xF81F #define YELLOW 0xFFE0 #define WHITE 0xFFFF /* EEPROM Memory map: 1 - 50: N1 angles 51 - 100: Settings 101- 150: N2 angles 151- 200: Twitch settings 200- 250: unused */ #define currentToolAddress 51 #define numToolsAddress 52 #define numNozAddress 53 #define versionAddress 54 // 0= basic, 1=pro #define syncAddress 55 #define n1DirAddress 56 #define n2DirAddress 57 #define autoModeAddress 58 // #define aux2ModeAddress 59 //DigitalOut myled(P1_13); I2C iic(P0_5, P0_4); DigitalOut dir(P0_21); Ee24xx08 eeprom(&iic); Adafruit_ST7735 tft(P0_9, P0_8, P0_6, P0_2, P0_22, P0_7); // MOSI, MISO, SCLK, SSEL, TFT_DC, TFT_RST int maxServo = 2500; int minServo = 500; reScale servo1Scale(-90,90,minServo,maxServo); // PwmOut myServo(P1_13); //display board //PwmOut myServo(D4); //DigitalIn tUpButton(P2_11); //DigitalIn tDownButton(P2_12); DigitalIn encoderFalseButton(P0_23); // FALSE!!! push button of knob DigitalIn encoderButton(P0_20); // push button of knob DigitalIn backButton(P0_15); // back button DigitalIn aButton(P0_1); // ISP and A button Timer t; Timer tw; int lastBackButton; int lastDownButton; int lastEncoderButton; int encoderPressed =0; // flag for state int encoderPressedTime= 0; int encoderMove = 0; int dirt = 0; 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.4"); 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("AUTO:"); tft.setCursor(4, 95); tft.setTextColor(WHITE); tft.setTextSize(1); tft.printf("IN2mode:"); 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:"); // ************************************************************************************************************** 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 autoMode = 0; int lastAutoMode = 99; int aux2Mode = 0; int lastAux2Mode = 99; 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 twitchHold = 0; //marker for hold message recieved from Inputs board. 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 ******************* 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; char tempLastAuto = 0; // previous N2 knob direction setting eeprom.read(autoModeAddress, &tempLastAuto); autoMode = (int)tempLastAuto; char tempLastAux2 = 0; // previous N2 knob direction setting eeprom.read(aux2ModeAddress, &tempLastAux2); aux2Mode = (int)tempLastAux2; /*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(); encoderPressedTime= 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); /* 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? while(1) { /* 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; 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; } // ************************* encoder button if (encoderButton == 0 && encoderPressed == 0 && (t.read_ms() > (lastEncoderButton + 200))) { encoderPressed = 1; encoderPressedTime = t.read_ms(); } if (encoderButton == 0 && encoderPressed == 1 && (t.read_ms() < (encoderPressedTime + 20))) { count = count + 1; //Reset count if PB pressed lastEncoderButton = t.read_ms(); encoderPressed = 0; } if (encoderButton == 1 && encoderPressed == 1 && (t.read_ms() < (encoderPressedTime + 10))) { encoderPressed = 0; } if (count > maxCount) { count = 0; } if (count > maxCount) { 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 (autoMode != lastAutoMode) { // tft.setCursor(52, 80); tft.setTextColor(BLACK); tft.setTextSize(1); if (lastAutoMode == 0) { tft.printf("OFF"); } if (lastAutoMode == 1) { tft.printf("X7a"); } if (lastAutoMode == 2) { tft.printf("Pul"); } tft.setCursor(52, 80); if (autoMode == 0) { tft.setTextColor(WHITE); tft.printf("OFF"); } if (autoMode == 1) { tft.setTextColor(GREEN); tft.printf("X7a"); } if (autoMode == 2) { tft.setTextColor(GREEN); tft.printf("Pul"); } eeprom.write(autoModeAddress, autoMode); // store new twitch setting lastAutoMode = autoMode; dir=1; device.printf("A"); //A for auto mode device.printf("%d", autoMode); // send 0,1,2 etc. wait(0.05); dir=0; } if (aux2Mode != lastAux2Mode) { // tft.setCursor(52, 95); tft.setTextColor(BLACK); tft.setTextSize(1); if (lastAux2Mode == 0) { tft.printf("OFF"); } if (lastAux2Mode == 1) { tft.printf("TWP"); } tft.setCursor(52, 95); if (aux2Mode == 0) { tft.setTextColor(WHITE); tft.printf("OFF"); } if (aux2Mode == 1) { tft.setTextColor(GREEN); tft.printf("TWP"); } eeprom.write(aux2ModeAddress, aux2Mode); // store new twitch setting lastAux2Mode = aux2Mode; dir=1; device.printf("I"); //I for input device.printf("%d", aux2Mode); // send 0,1,2 etc. 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); 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 == 5) { Enc.Set(autoMode); } else if (count == 6) { Enc.Set(aux2Mode); } 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); } 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); } 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 == 12) { tft.drawRect(130,108,20,12,BLACK); } // Set new box 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); } else if (count == 3) { tft.drawRect(50,48,20,12,GREEN); } else if (count == 4) { tft.drawRect(50,63,20,12,GREEN); } else if (count == 5) { tft.drawRect(50,78,20,12,GREEN); } else if (count == 6) { tft.drawRect(50,93,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 == 10) { tft.drawRect(130,78,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); } lastCount = count; } //****************** 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; } 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 (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 (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 (n1Pos > 90) { n1Pos =90; } if (n1Pos < -90) { n1Pos = -90; } if (n2Pos > 90) { n2Pos =90; } if (n2Pos < -90) { n2Pos = -90; } } //*************************** 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 (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; } } } //**************************** 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 (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); } } //**************************** if (count == 5) { // Knob controls auto setting. 1=off, 2=sync, 3=rev autoMode = Enc.Get(); if (autoMode < 0) { autoMode= 0; Enc.Set(0); } if (autoMode > 2) { autoMode = 2; Enc.Set(2); } } //**************************** if (count == 6) { // Knob controls auto setting. 1=off, 2=sync, 3=rev aux2Mode = Enc.Get(); if (aux2Mode < 0) { aux2Mode= 0; Enc.Set(0); } if (aux2Mode > 1) { aux2Mode = 1; Enc.Set(1); } } //**************************** // 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); } } //**************************** 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 (c == 'X') { // magazine + or - sent over serial tft.setCursor(50, 30); tft.setTextColor(RED); tft.setTextSize(1.5); tft.printf("TWITCH HOLD"); index=0; } if (c == 'Y') { // magazine + or - sent over serial tft.setCursor(50, 30); tft.setTextColor(BLACK); tft.setTextSize(1.5); tft.printf("TWITCH HOLD"); index=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=='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); count = 0; // 2019-09-23 to make sure the new tool isn't overwritten. 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; } } } } }