Kamil Ondrousek / Mbed 2 deprecated Chaotic

Dependencies:   mbed

Committer:
JLS
Date:
Sat Jan 08 17:55:24 2011 +0000
Revision:
0:c6e56e9f3cdb

        

Who changed what in which revision?

UserRevisionLine numberNew contents of line
JLS 0:c6e56e9f3cdb 1 //
JLS 0:c6e56e9f3cdb 2 // TFT_4DGL is a class to drive 4D Systems TFT touch screens
JLS 0:c6e56e9f3cdb 3 //
JLS 0:c6e56e9f3cdb 4 // Copyright (C) <2010> Stephane ROCHON <stephane.rochon at free.fr>
JLS 0:c6e56e9f3cdb 5 //
JLS 0:c6e56e9f3cdb 6 // TFT_4DGL is free software: you can redistribute it and/or modify
JLS 0:c6e56e9f3cdb 7 // it under the terms of the GNU General Public License as published by
JLS 0:c6e56e9f3cdb 8 // the Free Software Foundation, either version 3 of the License, or
JLS 0:c6e56e9f3cdb 9 // (at your option) any later version.
JLS 0:c6e56e9f3cdb 10 //
JLS 0:c6e56e9f3cdb 11 // TFT_4DGL is distributed in the hope that it will be useful,
JLS 0:c6e56e9f3cdb 12 // but WITHOUT ANY WARRANTY; without even the implied warranty of
JLS 0:c6e56e9f3cdb 13 // MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE. See the
JLS 0:c6e56e9f3cdb 14 // GNU General Public License for more details.
JLS 0:c6e56e9f3cdb 15 //
JLS 0:c6e56e9f3cdb 16 // You should have received a copy of the GNU General Public License
JLS 0:c6e56e9f3cdb 17 // along with TFT_4DGL. If not, see <http://www.gnu.org/licenses/>.
JLS 0:c6e56e9f3cdb 18
JLS 0:c6e56e9f3cdb 19 #include "mbed.h"
JLS 0:c6e56e9f3cdb 20 #include "TFT_4DGL.h"
JLS 0:c6e56e9f3cdb 21
JLS 0:c6e56e9f3cdb 22 Serial pc(USBTX,USBRX);
JLS 0:c6e56e9f3cdb 23 //DigitalOut led1(LED1), led2(LED2);
JLS 0:c6e56e9f3cdb 24
JLS 0:c6e56e9f3cdb 25 //******************************************************************************************************
JLS 0:c6e56e9f3cdb 26 TFT_4DGL :: TFT_4DGL(PinName tx, PinName rx, PinName rst) : _cmd(tx, rx), _rst(rst) { // Constructor
JLS 0:c6e56e9f3cdb 27
JLS 0:c6e56e9f3cdb 28 #if DEBUGMODE
JLS 0:c6e56e9f3cdb 29 pc.baud(115200);
JLS 0:c6e56e9f3cdb 30
JLS 0:c6e56e9f3cdb 31 pc.printf("\n\n\n");
JLS 0:c6e56e9f3cdb 32 pc.printf("********************\n\r");
JLS 0:c6e56e9f3cdb 33 pc.printf("TFT_4DGL CONSTRUCTOR\n\r");
JLS 0:c6e56e9f3cdb 34 pc.printf("********************\n\r");
JLS 0:c6e56e9f3cdb 35 #endif
JLS 0:c6e56e9f3cdb 36
JLS 0:c6e56e9f3cdb 37 _rst = 1; // put RESET pin to high to start TFT screen
JLS 0:c6e56e9f3cdb 38
JLS 0:c6e56e9f3cdb 39 reset();
JLS 0:c6e56e9f3cdb 40 autobaud(); // send autobaud command
JLS 0:c6e56e9f3cdb 41 baudrate(256000); // set the initial baudrate to 256kbps - fastest supported by uLCD-32PT
JLS 0:c6e56e9f3cdb 42 cls(); // clear screen
JLS 0:c6e56e9f3cdb 43
JLS 0:c6e56e9f3cdb 44 current_col = 0; // initial cursor col
JLS 0:c6e56e9f3cdb 45 current_row = 0; // initial cursor row
JLS 0:c6e56e9f3cdb 46 current_color = WHITE; // initial text color
JLS 0:c6e56e9f3cdb 47 current_orientation = IS_PORTRAIT; // initial screen orientation
JLS 0:c6e56e9f3cdb 48
JLS 0:c6e56e9f3cdb 49 set_font(FONT_5X7); // initial font
JLS 0:c6e56e9f3cdb 50 text_mode(TRANSPARENT); // initial text mode
JLS 0:c6e56e9f3cdb 51 display_control(0x06,0x00); // initial Image control new format
JLS 0:c6e56e9f3cdb 52 }
JLS 0:c6e56e9f3cdb 53
JLS 0:c6e56e9f3cdb 54 //******************************************************************************************************
JLS 0:c6e56e9f3cdb 55 void TFT_4DGL :: writeBYTE(char c) { // send a BYTE command to screen
JLS 0:c6e56e9f3cdb 56
JLS 0:c6e56e9f3cdb 57 _cmd.putc(c);
JLS 0:c6e56e9f3cdb 58
JLS 0:c6e56e9f3cdb 59 #if DEBUGMODE
JLS 0:c6e56e9f3cdb 60 pc.printf(" Char sent : 0x%02X ",c);
JLS 0:c6e56e9f3cdb 61 pc.putc(c);
JLS 0:c6e56e9f3cdb 62 pc.printf(" \n\r");
JLS 0:c6e56e9f3cdb 63 #endif
JLS 0:c6e56e9f3cdb 64
JLS 0:c6e56e9f3cdb 65 }
JLS 0:c6e56e9f3cdb 66
JLS 0:c6e56e9f3cdb 67 //******************************************************************************************************
JLS 0:c6e56e9f3cdb 68 void TFT_4DGL :: freeBUFFER(void) { // Clear serial buffer before writing command
JLS 0:c6e56e9f3cdb 69
JLS 0:c6e56e9f3cdb 70 while (_cmd.readable()) _cmd.getc(); // clear buffer garbage
JLS 0:c6e56e9f3cdb 71 }
JLS 0:c6e56e9f3cdb 72
JLS 0:c6e56e9f3cdb 73 //******************************************************************************************************
JLS 0:c6e56e9f3cdb 74 int TFT_4DGL :: writeCOMMAND(char *command, int number) { // send several BYTES making a command and return an answer
JLS 0:c6e56e9f3cdb 75
JLS 0:c6e56e9f3cdb 76 #if DEBUGMODE
JLS 0:c6e56e9f3cdb 77 pc.printf("\n\r");
JLS 0:c6e56e9f3cdb 78 pc.printf("New COMMAND : 0x%02X\n\r", command[0]);
JLS 0:c6e56e9f3cdb 79 #endif
JLS 0:c6e56e9f3cdb 80 int i, resp = 0;
JLS 0:c6e56e9f3cdb 81 freeBUFFER();
JLS 0:c6e56e9f3cdb 82
JLS 0:c6e56e9f3cdb 83 for (i = 0; i < number; i++) writeBYTE(command[i]); // send command to serial port
JLS 0:c6e56e9f3cdb 84
JLS 0:c6e56e9f3cdb 85 while (!_cmd.readable()) wait_ms(TEMPO); // wait for screen answer
JLS 0:c6e56e9f3cdb 86 if (_cmd.readable()) resp = _cmd.getc(); // read response if any
JLS 0:c6e56e9f3cdb 87 switch (resp) {
JLS 0:c6e56e9f3cdb 88 case ACK : // if OK return 1
JLS 0:c6e56e9f3cdb 89 resp = 1;
JLS 0:c6e56e9f3cdb 90 break;
JLS 0:c6e56e9f3cdb 91 case NAK : // if NOK return -1
JLS 0:c6e56e9f3cdb 92 resp = -1;
JLS 0:c6e56e9f3cdb 93 break;
JLS 0:c6e56e9f3cdb 94 default :
JLS 0:c6e56e9f3cdb 95 resp = 0; // else return 0
JLS 0:c6e56e9f3cdb 96 break;
JLS 0:c6e56e9f3cdb 97 }
JLS 0:c6e56e9f3cdb 98 #if DEBUGMODE
JLS 0:c6e56e9f3cdb 99 pc.printf(" Answer received : %d\n\r",resp);
JLS 0:c6e56e9f3cdb 100 #endif
JLS 0:c6e56e9f3cdb 101
JLS 0:c6e56e9f3cdb 102 return resp;
JLS 0:c6e56e9f3cdb 103 }
JLS 0:c6e56e9f3cdb 104
JLS 0:c6e56e9f3cdb 105 //**************************************************************************
JLS 0:c6e56e9f3cdb 106 void TFT_4DGL :: reset() { // Reset Screen
JLS 0:c6e56e9f3cdb 107
JLS 0:c6e56e9f3cdb 108 _rst = 0; // put RESET pin to low
JLS 0:c6e56e9f3cdb 109 wait_ms(TEMPO); // wait a few milliseconds for command reception
JLS 0:c6e56e9f3cdb 110 _rst = 1; // put RESET back to high
JLS 0:c6e56e9f3cdb 111 wait(3); // wait 3s for screen to restart
JLS 0:c6e56e9f3cdb 112
JLS 0:c6e56e9f3cdb 113 freeBUFFER(); // clean buffer from possible garbage
JLS 0:c6e56e9f3cdb 114 }
JLS 0:c6e56e9f3cdb 115
JLS 0:c6e56e9f3cdb 116 //**************************************************************************
JLS 0:c6e56e9f3cdb 117 void TFT_4DGL :: autobaud() { // send AutoBaud command (9600)
JLS 0:c6e56e9f3cdb 118 char command[1] = "";
JLS 0:c6e56e9f3cdb 119 command[0] = AUTOBAUD;
JLS 0:c6e56e9f3cdb 120 writeCOMMAND(command, 1);
JLS 0:c6e56e9f3cdb 121 }
JLS 0:c6e56e9f3cdb 122
JLS 0:c6e56e9f3cdb 123 //**************************************************************************
JLS 0:c6e56e9f3cdb 124 void TFT_4DGL :: cls() { // clear screen
JLS 0:c6e56e9f3cdb 125 char command[1] = "";
JLS 0:c6e56e9f3cdb 126 command[0] = CLS;
JLS 0:c6e56e9f3cdb 127 writeCOMMAND(command, 1);
JLS 0:c6e56e9f3cdb 128 }
JLS 0:c6e56e9f3cdb 129
JLS 0:c6e56e9f3cdb 130 //**************************************************************************
JLS 0:c6e56e9f3cdb 131 void TFT_4DGL :: version() { // get API version
JLS 0:c6e56e9f3cdb 132 char command[2] = "";
JLS 0:c6e56e9f3cdb 133 command[0] = VERSION;
JLS 0:c6e56e9f3cdb 134 command[1] = OFF;
JLS 0:c6e56e9f3cdb 135 readVERSION(command, 2);
JLS 0:c6e56e9f3cdb 136 }
JLS 0:c6e56e9f3cdb 137
JLS 0:c6e56e9f3cdb 138 //**************************************************************************
JLS 0:c6e56e9f3cdb 139 void TFT_4DGL :: baudrate(long speed) { // set screen baud rate
JLS 0:c6e56e9f3cdb 140 char command[2]= "";
JLS 0:c6e56e9f3cdb 141 command[0] = BAUDRATE;
JLS 0:c6e56e9f3cdb 142 switch (speed) {
JLS 0:c6e56e9f3cdb 143 case 110 :
JLS 0:c6e56e9f3cdb 144 command[1] = BAUD_110;
JLS 0:c6e56e9f3cdb 145 break;
JLS 0:c6e56e9f3cdb 146 case 300 :
JLS 0:c6e56e9f3cdb 147 command[1] = BAUD_300;
JLS 0:c6e56e9f3cdb 148 break;
JLS 0:c6e56e9f3cdb 149 case 600 :
JLS 0:c6e56e9f3cdb 150 command[1] = BAUD_600;
JLS 0:c6e56e9f3cdb 151 break;
JLS 0:c6e56e9f3cdb 152 case 1200 :
JLS 0:c6e56e9f3cdb 153 command[1] = BAUD_1200;
JLS 0:c6e56e9f3cdb 154 break;
JLS 0:c6e56e9f3cdb 155 case 2400 :
JLS 0:c6e56e9f3cdb 156 command[1] = BAUD_2400;
JLS 0:c6e56e9f3cdb 157 break;
JLS 0:c6e56e9f3cdb 158 case 4800 :
JLS 0:c6e56e9f3cdb 159 command[1] = BAUD_4800;
JLS 0:c6e56e9f3cdb 160 break;
JLS 0:c6e56e9f3cdb 161 case 9600 :
JLS 0:c6e56e9f3cdb 162 command[1] = BAUD_9600;
JLS 0:c6e56e9f3cdb 163 break;
JLS 0:c6e56e9f3cdb 164 case 14400 :
JLS 0:c6e56e9f3cdb 165 command[1] = BAUD_14400;
JLS 0:c6e56e9f3cdb 166 break;
JLS 0:c6e56e9f3cdb 167 case 19200 :
JLS 0:c6e56e9f3cdb 168 command[1] = BAUD_19200;
JLS 0:c6e56e9f3cdb 169 break;
JLS 0:c6e56e9f3cdb 170 case 31250 :
JLS 0:c6e56e9f3cdb 171 command[1] = BAUD_31250;
JLS 0:c6e56e9f3cdb 172 break;
JLS 0:c6e56e9f3cdb 173 case 38400 :
JLS 0:c6e56e9f3cdb 174 command[1] = BAUD_38400;
JLS 0:c6e56e9f3cdb 175 break;
JLS 0:c6e56e9f3cdb 176 case 56000 :
JLS 0:c6e56e9f3cdb 177 command[1] = BAUD_56000;
JLS 0:c6e56e9f3cdb 178 break;
JLS 0:c6e56e9f3cdb 179 case 57600 :
JLS 0:c6e56e9f3cdb 180 command[1] = BAUD_57600;
JLS 0:c6e56e9f3cdb 181 break;
JLS 0:c6e56e9f3cdb 182 case 115200 :
JLS 0:c6e56e9f3cdb 183 command[1] = BAUD_115200;
JLS 0:c6e56e9f3cdb 184 break;
JLS 0:c6e56e9f3cdb 185 case 128000 :
JLS 0:c6e56e9f3cdb 186 command[1] = BAUD_128000;
JLS 0:c6e56e9f3cdb 187 break;
JLS 0:c6e56e9f3cdb 188 case 256000 :
JLS 0:c6e56e9f3cdb 189 command[1] = BAUD_256000;
JLS 0:c6e56e9f3cdb 190 break;
JLS 0:c6e56e9f3cdb 191 default :
JLS 0:c6e56e9f3cdb 192 command[1] = BAUD_9600;
JLS 0:c6e56e9f3cdb 193 speed = 9600;
JLS 0:c6e56e9f3cdb 194 break;
JLS 0:c6e56e9f3cdb 195 }
JLS 0:c6e56e9f3cdb 196
JLS 0:c6e56e9f3cdb 197 #if DEBUGMODE
JLS 0:c6e56e9f3cdb 198 pc.printf("\n\r");
JLS 0:c6e56e9f3cdb 199 pc.printf("New COMMAND : 0x%02X\n\r", command[0]);
JLS 0:c6e56e9f3cdb 200 #endif
JLS 0:c6e56e9f3cdb 201
JLS 0:c6e56e9f3cdb 202 int i, resp = 0;
JLS 0:c6e56e9f3cdb 203 freeBUFFER();
JLS 0:c6e56e9f3cdb 204
JLS 0:c6e56e9f3cdb 205 if(speed==256000)
JLS 0:c6e56e9f3cdb 206 speed=281000; //If baud rate is 256K comm at 281k - as instructed by 4DGL
JLS 0:c6e56e9f3cdb 207
JLS 0:c6e56e9f3cdb 208 for (i = 0; i <2; i++) writeBYTE(command[i]); // send command to serial port
JLS 0:c6e56e9f3cdb 209 _cmd.baud(speed); // set mbed to same speed
JLS 0:c6e56e9f3cdb 210
JLS 0:c6e56e9f3cdb 211 while (!_cmd.readable()) wait_ms(TEMPO); // wait for screen answer
JLS 0:c6e56e9f3cdb 212
JLS 0:c6e56e9f3cdb 213 if (_cmd.readable()) resp = _cmd.getc(); // read response if any
JLS 0:c6e56e9f3cdb 214 switch (resp) {
JLS 0:c6e56e9f3cdb 215 case ACK : // if OK return 1
JLS 0:c6e56e9f3cdb 216 resp = 1;
JLS 0:c6e56e9f3cdb 217 break;
JLS 0:c6e56e9f3cdb 218 case NAK : // if NOK return -1
JLS 0:c6e56e9f3cdb 219 resp = -1;
JLS 0:c6e56e9f3cdb 220 break;
JLS 0:c6e56e9f3cdb 221 default :
JLS 0:c6e56e9f3cdb 222 resp = 0; // else return 0
JLS 0:c6e56e9f3cdb 223 break;
JLS 0:c6e56e9f3cdb 224 }
JLS 0:c6e56e9f3cdb 225 #if DEBUGMODE
JLS 0:c6e56e9f3cdb 226 pc.printf(" Baudrate reply received : %d\n\r",resp);
JLS 0:c6e56e9f3cdb 227 #endif
JLS 0:c6e56e9f3cdb 228 }
JLS 0:c6e56e9f3cdb 229
JLS 0:c6e56e9f3cdb 230 //******************************************************************************************************
JLS 0:c6e56e9f3cdb 231 int TFT_4DGL :: readVERSION(char *command, int number) { // read screen info and populate data
JLS 0:c6e56e9f3cdb 232
JLS 0:c6e56e9f3cdb 233 int i, temp = 0, resp = 0;
JLS 0:c6e56e9f3cdb 234 char response[5] = "";
JLS 0:c6e56e9f3cdb 235
JLS 0:c6e56e9f3cdb 236 freeBUFFER();
JLS 0:c6e56e9f3cdb 237
JLS 0:c6e56e9f3cdb 238 for (i = 0; i < number; i++) writeBYTE(command[i]); // send all chars to serial port
JLS 0:c6e56e9f3cdb 239
JLS 0:c6e56e9f3cdb 240 while (!_cmd.readable()) wait_ms(TEMPO); // wait for screen answer
JLS 0:c6e56e9f3cdb 241
JLS 0:c6e56e9f3cdb 242 while (_cmd.readable()) {
JLS 0:c6e56e9f3cdb 243 temp = _cmd.getc();
JLS 0:c6e56e9f3cdb 244 response[resp++] = (char)temp;
JLS 0:c6e56e9f3cdb 245 }
JLS 0:c6e56e9f3cdb 246 switch (resp) {
JLS 0:c6e56e9f3cdb 247 case 5 : // if OK populate data and return 1
JLS 0:c6e56e9f3cdb 248 type = response[0];
JLS 0:c6e56e9f3cdb 249 revision = response[1];
JLS 0:c6e56e9f3cdb 250 firmware = response[2];
JLS 0:c6e56e9f3cdb 251 reserved1 = response[3];
JLS 0:c6e56e9f3cdb 252 reserved2 = response[4];
JLS 0:c6e56e9f3cdb 253 resp = 1;
JLS 0:c6e56e9f3cdb 254 break;
JLS 0:c6e56e9f3cdb 255 default :
JLS 0:c6e56e9f3cdb 256 resp = 0; // else return 0
JLS 0:c6e56e9f3cdb 257 break;
JLS 0:c6e56e9f3cdb 258 }
JLS 0:c6e56e9f3cdb 259 return resp;
JLS 0:c6e56e9f3cdb 260 }
JLS 0:c6e56e9f3cdb 261
JLS 0:c6e56e9f3cdb 262 //****************************************************************************************************
JLS 0:c6e56e9f3cdb 263 void TFT_4DGL :: background_color(int color) { // set screen background color
JLS 0:c6e56e9f3cdb 264 char command[3]= ""; // input color is in 24bits like 0xRRGGBB
JLS 0:c6e56e9f3cdb 265
JLS 0:c6e56e9f3cdb 266 command[0] = BCKGDCOLOR;
JLS 0:c6e56e9f3cdb 267
JLS 0:c6e56e9f3cdb 268 int red5 = (color >> (16 + 3)) & 0x1F; // get red on 5 bits
JLS 0:c6e56e9f3cdb 269 int green6 = (color >> (8 + 2)) & 0x3F; // get green on 6 bits
JLS 0:c6e56e9f3cdb 270 int blue5 = (color >> (0 + 3)) & 0x1F; // get blue on 5 bits
JLS 0:c6e56e9f3cdb 271
JLS 0:c6e56e9f3cdb 272 command[1] = ((red5 << 3) + (green6 >> 3)) & 0xFF; // first part of 16 bits color
JLS 0:c6e56e9f3cdb 273 command[2] = ((green6 << 5) + (blue5 >> 0)) & 0xFF; // second part of 16 bits color
JLS 0:c6e56e9f3cdb 274
JLS 0:c6e56e9f3cdb 275 writeCOMMAND(command, 3);
JLS 0:c6e56e9f3cdb 276 }
JLS 0:c6e56e9f3cdb 277
JLS 0:c6e56e9f3cdb 278 //****************************************************************************************************
JLS 0:c6e56e9f3cdb 279 void TFT_4DGL :: display_control(char mode, char value) { // set screen mode to value
JLS 0:c6e56e9f3cdb 280 char command[3]= "";
JLS 0:c6e56e9f3cdb 281
JLS 0:c6e56e9f3cdb 282 command[0] = DISPCONTROL;
JLS 0:c6e56e9f3cdb 283 command[1] = mode;
JLS 0:c6e56e9f3cdb 284 command[2] = value;
JLS 0:c6e56e9f3cdb 285
JLS 0:c6e56e9f3cdb 286 if (mode == ORIENTATION) {
JLS 0:c6e56e9f3cdb 287 switch (value) {
JLS 0:c6e56e9f3cdb 288 case LANDSCAPE :
JLS 0:c6e56e9f3cdb 289 current_orientation = IS_LANDSCAPE;
JLS 0:c6e56e9f3cdb 290 break;
JLS 0:c6e56e9f3cdb 291 case LANDSCAPE_R :
JLS 0:c6e56e9f3cdb 292 current_orientation = IS_LANDSCAPE;
JLS 0:c6e56e9f3cdb 293 break;
JLS 0:c6e56e9f3cdb 294 case PORTRAIT :
JLS 0:c6e56e9f3cdb 295 current_orientation = IS_PORTRAIT;
JLS 0:c6e56e9f3cdb 296 break;
JLS 0:c6e56e9f3cdb 297 case PORTRAIT_R :
JLS 0:c6e56e9f3cdb 298 current_orientation = IS_PORTRAIT;
JLS 0:c6e56e9f3cdb 299 break;
JLS 0:c6e56e9f3cdb 300 }
JLS 0:c6e56e9f3cdb 301 set_font(current_font);
JLS 0:c6e56e9f3cdb 302 }
JLS 0:c6e56e9f3cdb 303 writeCOMMAND(command, 3);
JLS 0:c6e56e9f3cdb 304
JLS 0:c6e56e9f3cdb 305 }
JLS 0:c6e56e9f3cdb 306
JLS 0:c6e56e9f3cdb 307 //****************************************************************************************************
JLS 0:c6e56e9f3cdb 308 void TFT_4DGL :: set_volume(char value) { // set sound volume to value
JLS 0:c6e56e9f3cdb 309 char command[2]= "";
JLS 0:c6e56e9f3cdb 310
JLS 0:c6e56e9f3cdb 311 command[0] = SETVOLUME;
JLS 0:c6e56e9f3cdb 312 command[1] = value;
JLS 0:c6e56e9f3cdb 313
JLS 0:c6e56e9f3cdb 314 writeCOMMAND(command, 2);
JLS 0:c6e56e9f3cdb 315 }
JLS 0:c6e56e9f3cdb 316
JLS 0:c6e56e9f3cdb 317
JLS 0:c6e56e9f3cdb 318 //******************************************************************************************************
JLS 0:c6e56e9f3cdb 319 void TFT_4DGL :: getTOUCH(char *command, int number, int *x, int *y) { // read screen info and populate data
JLS 0:c6e56e9f3cdb 320
JLS 0:c6e56e9f3cdb 321 #if DEBUGMODE
JLS 0:c6e56e9f3cdb 322 pc.printf("\n\r");
JLS 0:c6e56e9f3cdb 323 pc.printf("New COMMAND : 0x%02X\n\r", command[0]);
JLS 0:c6e56e9f3cdb 324 #endif
JLS 0:c6e56e9f3cdb 325 int i, temp = 0, resp = 0;
JLS 0:c6e56e9f3cdb 326 char response[5] = "";
JLS 0:c6e56e9f3cdb 327
JLS 0:c6e56e9f3cdb 328 freeBUFFER();
JLS 0:c6e56e9f3cdb 329
JLS 0:c6e56e9f3cdb 330 for (i = 0; i < number; i++) writeBYTE(command[i]); // send all chars to serial port
JLS 0:c6e56e9f3cdb 331
JLS 0:c6e56e9f3cdb 332 while (!_cmd.readable()) wait_ms(TEMPO); // wait for screen answer
JLS 0:c6e56e9f3cdb 333
JLS 0:c6e56e9f3cdb 334 while (_cmd.readable()) {
JLS 0:c6e56e9f3cdb 335 temp = _cmd.getc();
JLS 0:c6e56e9f3cdb 336 response[resp++] = (char)temp;
JLS 0:c6e56e9f3cdb 337 }
JLS 0:c6e56e9f3cdb 338
JLS 0:c6e56e9f3cdb 339 #if DEBUGMODE
JLS 0:c6e56e9f3cdb 340 pc.printf(" Answer received %d : 0x%02X 0x%02X 0x%02X 0x%02X\n\r", resp, response[0], response[1], response[2], response[3]);
JLS 0:c6e56e9f3cdb 341 #endif
JLS 0:c6e56e9f3cdb 342
JLS 0:c6e56e9f3cdb 343 switch (resp) {
JLS 0:c6e56e9f3cdb 344 case 4 : // if OK populate data
JLS 0:c6e56e9f3cdb 345 *x = ((response[0]<<8)+ response[1]) * (response[0] != 0xFF);
JLS 0:c6e56e9f3cdb 346 *y = ((response[2]<<8)+ response[3]) * (response[2] != 0xFF);
JLS 0:c6e56e9f3cdb 347 break;
JLS 0:c6e56e9f3cdb 348 default :
JLS 0:c6e56e9f3cdb 349 *x = -1;
JLS 0:c6e56e9f3cdb 350 *y = -1;
JLS 0:c6e56e9f3cdb 351 break;
JLS 0:c6e56e9f3cdb 352 }
JLS 0:c6e56e9f3cdb 353
JLS 0:c6e56e9f3cdb 354 #if DEBUGMODE
JLS 0:c6e56e9f3cdb 355 pc.printf(" X,Y : %03d,%03d\n\r", *x, *y);
JLS 0:c6e56e9f3cdb 356 #endif
JLS 0:c6e56e9f3cdb 357 }
JLS 0:c6e56e9f3cdb 358
JLS 0:c6e56e9f3cdb 359 //******************************************************************************************************
JLS 0:c6e56e9f3cdb 360 int TFT_4DGL :: getSTATUS(char *command, int number) { // read screen info and populate data
JLS 0:c6e56e9f3cdb 361
JLS 0:c6e56e9f3cdb 362 #if DEBUGMODE
JLS 0:c6e56e9f3cdb 363 pc.printf("\n\r");
JLS 0:c6e56e9f3cdb 364 pc.printf("New COMMAND : 0x%02X\n\r", command[0]);
JLS 0:c6e56e9f3cdb 365 #endif
JLS 0:c6e56e9f3cdb 366
JLS 0:c6e56e9f3cdb 367 int i, temp = 0, resp = 0;
JLS 0:c6e56e9f3cdb 368 char response[5] = "";
JLS 0:c6e56e9f3cdb 369
JLS 0:c6e56e9f3cdb 370 freeBUFFER();
JLS 0:c6e56e9f3cdb 371
JLS 0:c6e56e9f3cdb 372 for (i = 0; i < number; i++) writeBYTE(command[i]); // send all chars to serial port
JLS 0:c6e56e9f3cdb 373
JLS 0:c6e56e9f3cdb 374 while (!_cmd.readable()) wait_ms(TEMPO); // wait for screen answer
JLS 0:c6e56e9f3cdb 375
JLS 0:c6e56e9f3cdb 376 while (_cmd.readable()) {
JLS 0:c6e56e9f3cdb 377 temp = _cmd.getc();
JLS 0:c6e56e9f3cdb 378 response[resp++] = (char)temp;
JLS 0:c6e56e9f3cdb 379 }
JLS 0:c6e56e9f3cdb 380 switch (resp) {
JLS 0:c6e56e9f3cdb 381 case 4 :
JLS 0:c6e56e9f3cdb 382 resp = (int)response[1]; // if OK populate data
JLS 0:c6e56e9f3cdb 383 break;
JLS 0:c6e56e9f3cdb 384 default :
JLS 0:c6e56e9f3cdb 385 resp = -1; // else return 0
JLS 0:c6e56e9f3cdb 386 break;
JLS 0:c6e56e9f3cdb 387 }
JLS 0:c6e56e9f3cdb 388
JLS 0:c6e56e9f3cdb 389 #if DEBUGMODE
JLS 0:c6e56e9f3cdb 390 pc.printf(" Answer received : %d\n\r", resp);
JLS 0:c6e56e9f3cdb 391 #endif
JLS 0:c6e56e9f3cdb 392
JLS 0:c6e56e9f3cdb 393 return resp;
JLS 0:c6e56e9f3cdb 394 }