![](/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-02-11
- Revision:
- 3:5f3bb4ab449a
- Parent:
- 2:bbbacfd62773
- Child:
- 4:d3c19705042b
File content as of revision 3:5f3bb4ab449a:
#include "mbed.h" #include "Adafruit_ST7735.h" #include "RPG.h" #include "reScale.h" #include "Ee24xx08.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 #define currentToolAddress 51 #define numToolsAddress 52 #define numNozAddress 53 //DigitalOut myled(P1_13); I2C iic(P0_5, P0_4); Serial device(P0_14, P0_13, 19200); // RS 485 TX RX? 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 reScale servo1Scale(-45,0,750,1800); //19850 is 1.0v from voltage divider at 10k. 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 Timer t; int lastBackButton; int lastDownButton; int lastEncoderButton; 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(WHITE); tft.setTextWrap(false); tft.printf("AccuBlast v0"); 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("Nozzle"); tft.setCursor(4, 65); tft.setTextColor(WHITE); tft.setTextSize(1); tft.printf("Res."); tft.setCursor(4, 80); tft.setTextColor(WHITE); tft.setTextSize(1); tft.printf("Res."); tft.setCursor(4, 95); tft.setTextColor(WHITE); tft.setTextSize(1); tft.printf("Num Tls"); tft.setCursor(4, 110); tft.setTextColor(WHITE); tft.setTextSize(1); tft.printf("Num Noz"); // ************************************************************************************************************** int received = 9; int serialCounter = 0; int count = 0; int maxCount = 7; //max number of menu items int lastCount = 99; //************* 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 eeprom.read(currentToolNo, &tempLastAngle); int lastAngle = (int)tempLastAngle; lastAngle = lastAngle - 45; // Not storing signed int, so signed value is 45 less than what was stored to memory. //******************** Button debounce ********************************* backButton.mode(PullUp); // button pull up //tDownButton.mode(PullUp); // button pull up encoderButton.mode(PullUp); encoderFalseButton.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 servo1Pos = 0; RPG rpg1(P2_2,P1_20,P0_23); // RPG (PinName pA, PinName pB, PinName pPB)P0_23 is unconnected!! ; 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; 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; } if (encoderButton == 0){ if (t.read_ms() > (lastEncoderButton + 200)){ count = count + 1; //Reset count if PB pressed } if (count > maxCount){ count = 0; } lastEncoderButton = t.read_ms(); if (count > maxCount){ count = 0; } } //****************** ENCODER ACTIONS ************************************************ if (count == 0){ // knob controls servo value dirt = rpg1.dir(); //Get Dir n1Pos = n1Pos + dirt; //Ad Dirt to n1pos if (n1Pos > 0){ n1Pos = 0; } if (n1Pos < -45){ n1Pos = -45; } } if (count == 2){ //knob controls tool number dirt = rpg1.dir(); //Get Dir currentToolNo = currentToolNo + dirt; //Ad Dirt to n1pos if (currentToolNo > numTools){ currentToolNo = numTools; } if (currentToolNo < 1){ currentToolNo = 1; } } if (count == 6){ //knob controls tool number dirt = rpg1.dir(); //Get Dir numTools = numTools + dirt; //Ad Dirt to n1pos if (numTools > 50){ numTools = 50; } if (numTools < 1){ numTools = 1; } } if (count == 7){ //knob controls tool number dirt = rpg1.dir(); //Get Dir numNoz = numNoz + dirt; //Ad Dirt to n1pos if (numNoz> 2){ numNoz = 2; } if (numNoz < 1){ numNoz = 1; } } // ************* Rectangles for identifying active selection ***************************** if (count == 0){ // N1 adjust tft.drawRect(2,2,74,18,GREEN); } else{ tft.drawRect(2,2,74,18,WHITE); } if ((count == 1) && (numNoz == 2)){ // N2 adjust tft.drawRect(78,2,74,18,GREEN); } if ((count != 1) && (numNoz == 2)){ // N2 adjust tft.drawRect(78,2,74,18,WHITE); } if (count == 2){ tft.drawRect(20,26,28,18,GREEN); } else{ tft.drawRect(20,26,28,18,BLACK); } if (count == 3){ tft.drawRect(53,48,20,12,GREEN); } else{ tft.drawRect(53,48,20,12,BLACK); } if (count == 4){ tft.drawRect(53,63,20,12,GREEN); } else{ tft.drawRect(53,63,20,12,BLACK); } if (count == 5){ tft.drawRect(53,78,20,12,GREEN); } else{ tft.drawRect(53,78,20,12,BLACK); } if (count == 6){ tft.drawRect(53,93,20,12,GREEN); } else{ tft.drawRect(53,93,20,12,BLACK); } if (count == 7){ tft.drawRect(53,108,20,12,GREEN); } else{ tft.drawRect(53,108,20,12,BLACK); } //**************************************************************************************** servo1Pos = servo1Scale.from(n1Pos); 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 - 45; // Not storing signed int, so signed value is 45 less than what was stored to memory. //RotaryEncoder knob1(D2, D3, -45, 45, lastAngle); // RotaryEncoder(PinName pin1_name, PinName pin2_name, int min = 0, int max = 100, int val = 50); //knob1.val = lastAngle; n1Pos = lastAngle; eeprom.write(currentToolAddress, currentToolNo); //wait(0.1); 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 + 45); // store new angle in eeprom, add 45 because its an unsigned value. //wait(0.1); // adjusted from 1 dir=1; device.printf("N"); device.printf("%d", n1Pos + 145); //send over RS485 add 145 so no negative values and always 3 digits. 1xx for N1, 2xx for nozzle 2 //device.printf("N245"); // TEST!!! tft.setCursor(100, 50); tft.setTextSize(2); tft.printf("%d", n1Pos + 145); //wait(0.05); dir=0; lastN1Pos = n1Pos; } if (numTools != lastNumTools){ tft.setCursor(55, 95); tft.setTextColor(BLACK); tft.setTextSize(1); tft.printf("%d", lastNumTools); tft.setCursor(55,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(55, 110); tft.setTextColor(BLACK); tft.setTextSize(1); tft.printf("%d", lastNumNoz); tft.setCursor(55,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.drawRect(78,2,74,18,BLACK); } lastNumNoz = numNoz; } if (count != lastCount){ tft.setCursor(150, 100); tft.setTextColor(BLACK); tft.setTextSize(1); tft.printf("%d", lastCount); tft.setCursor(150,100); tft.setTextColor(RED); tft.setTextSize(1); tft.printf("%d", count); lastCount = count; } //**************************** RS485 link *************************************** //dir =0; // receiver enable /* if (device.readable()) { c = device.getc(); if(c=='B'){ received = 1; } } if (received == 1){ tft.setCursor(150, 80); tft.setTextColor(WHITE); tft.setTextSize(1); tft.printf("1"); } */ /* 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; } } 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); currentToolNo = serialToolNumber; // update tool number index=0; } if (index == 5){ // magazine monitoring c = device.getc(); if (c == 'U'){ currentToolNo = (currentToolNo +1); if (currentToolNo > numTools){ currentToolNo = 1; } index = 0; } else if (c == 'D'){ tft.setTextColor(WHITE); tft.setCursor(100, 100); tft.printf("1"); currentToolNo = (currentToolNo -1); if (currentToolNo < 1){ currentToolNo = numTools; } index = 0; } } } */ } }