Rihards Balass / 4DGL-mbed-32PTU

Important changes to repositories hosted on mbed.com

Mbed hosted mercurial repositories are deprecated and are due to be permanently deleted in July 2026.

To keep a copy of this software download the repository Zip archive or clone locally using Mercurial.

It is also possible to export all your personal repositories from the account settings page.

Picaso_4DGL-32PTU_main.cpp@14:561cb06a2739, 2016-09-15 (annotated)

Committer:
CaptainR
Date:
Thu Sep 15 09:48:59 2016 +0000
Revision:
14:561cb06a2739
Parent:
13:1a0800957412
Child:
15:86bdf382e6f7
write sector

Who changed what in which revision?

UserRevisionLine numberNew contents of line
CaptainR 0:a5ef6bc3c2e8 1 //
CaptainR 2:81eaaa491a02 2 // Picaso_4DGL-32PTU is a class to drive 4D Systems TFT touch screens with PICASO processor
CaptainR 2:81eaaa491a02 3 // Tested with NUCLEO L152RE development board
CaptainR 2:81eaaa491a02 4 // Copyright (C) <2016> Rihards Balass <rihards.balass@gmail.com>
CaptainR 0:a5ef6bc3c2e8 5 //
CaptainR 2:81eaaa491a02 6 // Picaso_4DGL-32PTU is free software: you can redistribute it and/or modify
CaptainR 2:81eaaa491a02 7 // it under the terms of the GNU General Public License as published by
CaptainR 2:81eaaa491a02 8 // the Free Software Foundation, either version 3 of the License, or
CaptainR 2:81eaaa491a02 9 // (at your option) any later version.
CaptainR 2:81eaaa491a02 10 //
CaptainR 2:81eaaa491a02 11 // Picaso_4DGL-32PTU is distributed in the hope that it will be useful,
CaptainR 2:81eaaa491a02 12 // but WITHOUT ANY WARRANTY; without even the implied warranty of
CaptainR 2:81eaaa491a02 13 // MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE. See the
CaptainR 2:81eaaa491a02 14 // GNU General Public License for more details.
CaptainR 2:81eaaa491a02 15 //
CaptainR 2:81eaaa491a02 16 // You can see GNU General Public License at <http://www.gnu.org/licenses/>.
CaptainR 0:a5ef6bc3c2e8 17 //
CaptainR 0:a5ef6bc3c2e8 18
CaptainR 0:a5ef6bc3c2e8 19 #include "mbed.h"
CaptainR 0:a5ef6bc3c2e8 20 #include "Picaso_4DGL-32PTU.h"
CaptainR 0:a5ef6bc3c2e8 21
CaptainR 4:50511ed54ab4 22 DigitalOut led1(LED1);
CaptainR 0:a5ef6bc3c2e8 23
CaptainR 0:a5ef6bc3c2e8 24 //******************************************************************************************************
CaptainR 3:dcfbceb81fef 25 PICASO_4DGL :: PICASO_4DGL(PinName tx, PinName rx, PinName rst) : pc(USBTX, USBRX), _cmd(tx, rx), _rst(rst) { // Constructor
CaptainR 4:50511ed54ab4 26
CaptainR 13:1a0800957412 27 //rxBuf[RXBUFLEN] = 0; // create buffer
CaptainR 13:1a0800957412 28 //buffer[BUFFER_SIZE] = 0;
CaptainR 5:890ddd974624 29 index = 0;
CaptainR 12:29f5ad896382 30 _cmd.attach(this, &PICASO_4DGL::rxCallback, Serial::RxIrq);
CaptainR 4:50511ed54ab4 31
CaptainR 11:3ebd2263f3e9 32 pc.baud(115200);
CaptainR 0:a5ef6bc3c2e8 33 #if DEBUGMODE
CaptainR 0:a5ef6bc3c2e8 34 pc.printf("\n\n\n");
CaptainR 0:a5ef6bc3c2e8 35 pc.printf("********************\n\r");
CaptainR 3:dcfbceb81fef 36 pc.printf("PICASO_4DGL CONSTRUCTOR\n\r");
CaptainR 0:a5ef6bc3c2e8 37 pc.printf("********************\n\r");
CaptainR 0:a5ef6bc3c2e8 38 #endif
CaptainR 0:a5ef6bc3c2e8 39 _rst = 1; // put RESET pin to high to start TFT screen
CaptainR 12:29f5ad896382 40
CaptainR 0:a5ef6bc3c2e8 41 #if DEBUGMODE
CaptainR 0:a5ef6bc3c2e8 42 pc.printf("Wait 3 seconds for startup...\n\r");
CaptainR 3:dcfbceb81fef 43 #endif
CaptainR 0:a5ef6bc3c2e8 44 wait_ms(3000);
CaptainR 3:dcfbceb81fef 45
CaptainR 0:a5ef6bc3c2e8 46 #if DEBUGMODE
CaptainR 0:a5ef6bc3c2e8 47 pc.printf("set baudrate to 9600...\n\r");
CaptainR 0:a5ef6bc3c2e8 48 #endif
CaptainR 4:50511ed54ab4 49 baudrate(9600);
CaptainR 3:dcfbceb81fef 50
CaptainR 0:a5ef6bc3c2e8 51 #if DEBUGMODE
CaptainR 0:a5ef6bc3c2e8 52 pc.printf("clear screen...\n\r");
CaptainR 0:a5ef6bc3c2e8 53 #endif
CaptainR 3:dcfbceb81fef 54 wait_ms(1000);
CaptainR 12:29f5ad896382 55 screenMode(landscape);
CaptainR 12:29f5ad896382 56 setFont(font3);
CaptainR 12:29f5ad896382 57 cls();
CaptainR 0:a5ef6bc3c2e8 58
CaptainR 12:29f5ad896382 59 #if DEMO
CaptainR 3:dcfbceb81fef 60 //mainDemo();
CaptainR 0:a5ef6bc3c2e8 61 //textDemo();
CaptainR 12:29f5ad896382 62 //graphicsDemo();
CaptainR 12:29f5ad896382 63 mediaDemo();
CaptainR 0:a5ef6bc3c2e8 64 #endif
CaptainR 0:a5ef6bc3c2e8 65 }
CaptainR 0:a5ef6bc3c2e8 66
CaptainR 0:a5ef6bc3c2e8 67 //******************************************************************************************************
CaptainR 5:890ddd974624 68 void PICASO_4DGL :: rxCallback() {
CaptainR 0:a5ef6bc3c2e8 69
CaptainR 13:1a0800957412 70 if(_cmd.readable()) rxBuf[index++] = _cmd.getc();
CaptainR 0:a5ef6bc3c2e8 71 }
CaptainR 0:a5ef6bc3c2e8 72
CaptainR 0:a5ef6bc3c2e8 73 //******************************************************************************************************
CaptainR 3:dcfbceb81fef 74 void PICASO_4DGL :: writeBYTE(char c) { // send a BYTE command to screen
CaptainR 0:a5ef6bc3c2e8 75
CaptainR 0:a5ef6bc3c2e8 76 _cmd.putc(c);
CaptainR 0:a5ef6bc3c2e8 77
CaptainR 0:a5ef6bc3c2e8 78 #if DEBUGMODE
CaptainR 0:a5ef6bc3c2e8 79 pc.printf(" Char sent : 0x%02X ",c);
CaptainR 0:a5ef6bc3c2e8 80 pc.putc(c);
CaptainR 0:a5ef6bc3c2e8 81 pc.printf(" \n\r");
CaptainR 0:a5ef6bc3c2e8 82 #endif
CaptainR 0:a5ef6bc3c2e8 83
CaptainR 0:a5ef6bc3c2e8 84 }
CaptainR 0:a5ef6bc3c2e8 85
CaptainR 0:a5ef6bc3c2e8 86 //******************************************************************************************************
CaptainR 3:dcfbceb81fef 87 void PICASO_4DGL :: freeBUFFER(void) { // Clear serial buffer before writing command
CaptainR 0:a5ef6bc3c2e8 88
CaptainR 0:a5ef6bc3c2e8 89 while (_cmd.readable()) _cmd.getc(); // clear buffer garbage
CaptainR 0:a5ef6bc3c2e8 90 }
CaptainR 0:a5ef6bc3c2e8 91
CaptainR 0:a5ef6bc3c2e8 92 //******************************************************************************************************
CaptainR 3:dcfbceb81fef 93 void PICASO_4DGL :: writeCOMMAND(char *command, int number) { // send several BYTES making a command and return an answer
CaptainR 0:a5ef6bc3c2e8 94
CaptainR 0:a5ef6bc3c2e8 95 #if DEBUGMODE
CaptainR 0:a5ef6bc3c2e8 96 pc.printf("\n\r");
CaptainR 0:a5ef6bc3c2e8 97 pc.printf("New COMMAND : 0x%02X%02X\n\r", command[0], command[1]);
CaptainR 0:a5ef6bc3c2e8 98 #endif
CaptainR 0:a5ef6bc3c2e8 99 int i;
CaptainR 0:a5ef6bc3c2e8 100 freeBUFFER();
CaptainR 13:1a0800957412 101 //index = 0;
CaptainR 13:1a0800957412 102
CaptainR 0:a5ef6bc3c2e8 103 for (i = 0; i < number; i++) writeBYTE(command[i]); // send command to serial port
CaptainR 0:a5ef6bc3c2e8 104 }
CaptainR 0:a5ef6bc3c2e8 105
CaptainR 0:a5ef6bc3c2e8 106 //**************************************************************************
CaptainR 3:dcfbceb81fef 107 void PICASO_4DGL :: reset() { // Reset Screen
CaptainR 0:a5ef6bc3c2e8 108
CaptainR 0:a5ef6bc3c2e8 109 _rst = 0; // put RESET pin to low
CaptainR 0:a5ef6bc3c2e8 110 wait_ms(TEMPO); // wait a few milliseconds for command reception
CaptainR 0:a5ef6bc3c2e8 111 _rst = 1; // put RESET back to high
CaptainR 0:a5ef6bc3c2e8 112 wait(3); // wait 3s for screen to restart
CaptainR 0:a5ef6bc3c2e8 113
CaptainR 0:a5ef6bc3c2e8 114 freeBUFFER(); // clean buffer from possible garbage
CaptainR 0:a5ef6bc3c2e8 115 }
CaptainR 0:a5ef6bc3c2e8 116
CaptainR 0:a5ef6bc3c2e8 117 //**************************************************************************
CaptainR 3:dcfbceb81fef 118 void PICASO_4DGL :: baudrate(long speed) { // set screen baud rate
CaptainR 0:a5ef6bc3c2e8 119
CaptainR 0:a5ef6bc3c2e8 120 char command[4]= "";
CaptainR 2:81eaaa491a02 121 command[0] = (BAUDRATE >> (8*1)) & 0xff;
CaptainR 2:81eaaa491a02 122 command[1] = (BAUDRATE >> (8*0)) & 0xff;
CaptainR 0:a5ef6bc3c2e8 123 switch (speed) {
CaptainR 0:a5ef6bc3c2e8 124 case 300 :
CaptainR 2:81eaaa491a02 125 command[2] = (BAUD_300 >> (8*1)) & 0xff;
CaptainR 2:81eaaa491a02 126 command[3] = (BAUD_300 >> (8*0)) & 0xff;
CaptainR 0:a5ef6bc3c2e8 127 break;
CaptainR 0:a5ef6bc3c2e8 128 case 600 :
CaptainR 2:81eaaa491a02 129 command[2] = (BAUD_600 >> (8*1)) & 0xff;
CaptainR 2:81eaaa491a02 130 command[3] = (BAUD_600 >> (8*0)) & 0xff;
CaptainR 0:a5ef6bc3c2e8 131 break;
CaptainR 0:a5ef6bc3c2e8 132 case 1200 :
CaptainR 2:81eaaa491a02 133 command[2] = (BAUD_1200 >> (8*1)) & 0xff;
CaptainR 2:81eaaa491a02 134 command[3] = (BAUD_1200 >> (8*0)) & 0xff;
CaptainR 0:a5ef6bc3c2e8 135 break;
CaptainR 0:a5ef6bc3c2e8 136 case 2400 :
CaptainR 2:81eaaa491a02 137 command[2] = (BAUD_2400 >> (8*1)) & 0xff;
CaptainR 2:81eaaa491a02 138 command[3] = (BAUD_2400 >> (8*0)) & 0xff;
CaptainR 0:a5ef6bc3c2e8 139 break;
CaptainR 0:a5ef6bc3c2e8 140 case 4800 :
CaptainR 2:81eaaa491a02 141 command[2] = (BAUD_4800 >> (8*1)) & 0xff;
CaptainR 2:81eaaa491a02 142 command[3] = (BAUD_4800 >> (8*0)) & 0xff;
CaptainR 0:a5ef6bc3c2e8 143 break;
CaptainR 0:a5ef6bc3c2e8 144 case 9600 :
CaptainR 2:81eaaa491a02 145 command[2] = (BAUD_9600 >> (8*1)) & 0xff;
CaptainR 2:81eaaa491a02 146 command[3] = (BAUD_9600 >> (8*0)) & 0xff;
CaptainR 0:a5ef6bc3c2e8 147 break;
CaptainR 0:a5ef6bc3c2e8 148 case 14400 :
CaptainR 2:81eaaa491a02 149 command[2] = (BAUD_14400 >> (8*1)) & 0xff;
CaptainR 2:81eaaa491a02 150 command[3] = (BAUD_14400 >> (8*0)) & 0xff;
CaptainR 0:a5ef6bc3c2e8 151 break;
CaptainR 0:a5ef6bc3c2e8 152 case 19200 :
CaptainR 2:81eaaa491a02 153 command[2] = (BAUD_19200 >> (8*1)) & 0xff;
CaptainR 2:81eaaa491a02 154 command[3] = (BAUD_19200 >> (8*0)) & 0xff;
CaptainR 2:81eaaa491a02 155 break;
CaptainR 2:81eaaa491a02 156 case 31250 :
CaptainR 2:81eaaa491a02 157 command[2] = (BAUD_31250 >> (8*1)) & 0xff;
CaptainR 2:81eaaa491a02 158 command[3] = (BAUD_31250 >> (8*0)) & 0xff;
CaptainR 0:a5ef6bc3c2e8 159 break;
CaptainR 0:a5ef6bc3c2e8 160 case 38400 :
CaptainR 2:81eaaa491a02 161 command[2] = (BAUD_38400 >> (8*1)) & 0xff;
CaptainR 2:81eaaa491a02 162 command[3] = (BAUD_38400 >> (8*0)) & 0xff;
CaptainR 0:a5ef6bc3c2e8 163 break;
CaptainR 0:a5ef6bc3c2e8 164 case 56000 :
CaptainR 2:81eaaa491a02 165 command[2] = (BAUD_56000 >> (8*1)) & 0xff;
CaptainR 2:81eaaa491a02 166 command[3] = (BAUD_56000 >> (8*0)) & 0xff;
CaptainR 0:a5ef6bc3c2e8 167 break;
CaptainR 0:a5ef6bc3c2e8 168 case 57600 :
CaptainR 2:81eaaa491a02 169 command[2] = (BAUD_57600 >> (8*1)) & 0xff;
CaptainR 2:81eaaa491a02 170 command[3] = (BAUD_57600 >> (8*0)) & 0xff;
CaptainR 0:a5ef6bc3c2e8 171 break;
CaptainR 0:a5ef6bc3c2e8 172 case 115200 :
CaptainR 2:81eaaa491a02 173 command[2] = (BAUD_115200 >> (8*1)) & 0xff;
CaptainR 2:81eaaa491a02 174 command[3] = (BAUD_115200 >> (8*0)) & 0xff;
CaptainR 0:a5ef6bc3c2e8 175 break;
CaptainR 0:a5ef6bc3c2e8 176 case 128000 :
CaptainR 2:81eaaa491a02 177 command[2] = (BAUD_128000 >> (8*1)) & 0xff;
CaptainR 2:81eaaa491a02 178 command[3] = (BAUD_128000 >> (8*0)) & 0xff;
CaptainR 0:a5ef6bc3c2e8 179 break;
CaptainR 0:a5ef6bc3c2e8 180 case 256000 :
CaptainR 2:81eaaa491a02 181 command[2] = (BAUD_256000 >> (8*1)) & 0xff;
CaptainR 2:81eaaa491a02 182 command[3] = (BAUD_256000 >> (8*0)) & 0xff;
CaptainR 0:a5ef6bc3c2e8 183 break;
CaptainR 0:a5ef6bc3c2e8 184 case 300000 :
CaptainR 2:81eaaa491a02 185 command[2] = (BAUD_300000 >> (8*1)) & 0xff;
CaptainR 2:81eaaa491a02 186 command[3] = (BAUD_300000 >> (8*0)) & 0xff;
CaptainR 0:a5ef6bc3c2e8 187 break;
CaptainR 0:a5ef6bc3c2e8 188 case 375000 :
CaptainR 2:81eaaa491a02 189 command[2] = (BAUD_375000 >> (8*1)) & 0xff;
CaptainR 2:81eaaa491a02 190 command[3] = (BAUD_375000 >> (8*0)) & 0xff;
CaptainR 0:a5ef6bc3c2e8 191 break;
CaptainR 0:a5ef6bc3c2e8 192 case 500000 :
CaptainR 2:81eaaa491a02 193 command[2] = (BAUD_500000 >> (8*1)) & 0xff;
CaptainR 2:81eaaa491a02 194 command[3] = (BAUD_500000 >> (8*0)) & 0xff;
CaptainR 0:a5ef6bc3c2e8 195 break;
CaptainR 0:a5ef6bc3c2e8 196 case 600000 :
CaptainR 2:81eaaa491a02 197 command[2] = (BAUD_600000 >> (8*1)) & 0xff;
CaptainR 2:81eaaa491a02 198 command[3] = (BAUD_600000 >> (8*0)) & 0xff;
CaptainR 0:a5ef6bc3c2e8 199 break;
CaptainR 0:a5ef6bc3c2e8 200 default :
CaptainR 2:81eaaa491a02 201 command[2] = (BAUD_9600 >> (8*1)) & 0xff;
CaptainR 2:81eaaa491a02 202 command[3] = (BAUD_9600 >> (8*0)) & 0xff;
CaptainR 0:a5ef6bc3c2e8 203 speed = 9600;
CaptainR 0:a5ef6bc3c2e8 204 break;
CaptainR 0:a5ef6bc3c2e8 205 }
CaptainR 0:a5ef6bc3c2e8 206
CaptainR 0:a5ef6bc3c2e8 207 #if DEBUGMODE
CaptainR 0:a5ef6bc3c2e8 208 pc.printf("\n\r");
CaptainR 13:1a0800957412 209 pc.printf("New BAUDRATE : 0x%02X%02X\n\r", command[0], command[1]);
CaptainR 0:a5ef6bc3c2e8 210 #endif
CaptainR 0:a5ef6bc3c2e8 211
CaptainR 0:a5ef6bc3c2e8 212 int i;
CaptainR 0:a5ef6bc3c2e8 213 freeBUFFER();
CaptainR 0:a5ef6bc3c2e8 214
CaptainR 0:a5ef6bc3c2e8 215 //Change baudrates - as instructed by 4DGL
CaptainR 12:29f5ad896382 216 if (speed == 128000) speed = 133929;
CaptainR 12:29f5ad896382 217 if (speed == 256000) speed = 281250;
CaptainR 0:a5ef6bc3c2e8 218 if (speed == 300000) speed = 312500;
CaptainR 12:29f5ad896382 219 if (speed == 375000) speed = 401786;
CaptainR 0:a5ef6bc3c2e8 220 if (speed == 500000) speed = 562500;
CaptainR 0:a5ef6bc3c2e8 221 if (speed == 600000) speed = 703125;
CaptainR 0:a5ef6bc3c2e8 222
CaptainR 0:a5ef6bc3c2e8 223 for (i = 0; i <4; i++) writeBYTE(command[i]); // send command to serial port
CaptainR 12:29f5ad896382 224 _cmd.baud(speed);
CaptainR 5:890ddd974624 225 getResponse(1);
CaptainR 0:a5ef6bc3c2e8 226 }
CaptainR 0:a5ef6bc3c2e8 227
CaptainR 0:a5ef6bc3c2e8 228 //**************************************************************************
CaptainR 12:29f5ad896382 229 bool PICASO_4DGL :: getResponse(int count) {
CaptainR 5:890ddd974624 230
CaptainR 12:29f5ad896382 231 #if DEBUGMODE
CaptainR 12:29f5ad896382 232 pc.printf("\n\r DEBUG: Wait for answer...");
CaptainR 12:29f5ad896382 233 #endif
CaptainR 12:29f5ad896382 234 //pc.printf("\n\r count = %i, index = %i", count, index);
CaptainR 12:29f5ad896382 235 while (index < count) wait_ms(100); // wait for screen answer
CaptainR 0:a5ef6bc3c2e8 236
CaptainR 12:29f5ad896382 237 #if DEBUGMODE
CaptainR 12:29f5ad896382 238 pc.printf("\n\r DEBUG: Answer = ");
CaptainR 5:890ddd974624 239 for (int i = 0; i < index; i++) {
CaptainR 5:890ddd974624 240 pc.printf("%02X ", rxBuf[i]);
CaptainR 0:a5ef6bc3c2e8 241 }
CaptainR 4:50511ed54ab4 242 pc.printf("\n\r");
CaptainR 12:29f5ad896382 243 #endif
CaptainR 12:29f5ad896382 244 if (rxBuf[0] == 0x06) {
CaptainR 12:29f5ad896382 245 index = 0; // set buffer index to 0
CaptainR 12:29f5ad896382 246 return true;
CaptainR 12:29f5ad896382 247 }
CaptainR 12:29f5ad896382 248 else {
CaptainR 12:29f5ad896382 249 index = 0;
CaptainR 12:29f5ad896382 250 return false;
CaptainR 12:29f5ad896382 251 }
CaptainR 0:a5ef6bc3c2e8 252 }
CaptainR 0:a5ef6bc3c2e8 253
CaptainR 0:a5ef6bc3c2e8 254 //**************************************************************************
CaptainR 12:29f5ad896382 255 bool PICASO_4DGL :: calculateOrbitResponse() {
CaptainR 6:a1a85f2bc04b 256
CaptainR 12:29f5ad896382 257 #if DEBUGMODE
CaptainR 12:29f5ad896382 258 pc.printf("\n\r DEBUG: Wait for answer...");
CaptainR 12:29f5ad896382 259 #endif
CaptainR 12:29f5ad896382 260 while (index < 5) wait_ms(100); // wait for screen answer
CaptainR 6:a1a85f2bc04b 261
CaptainR 12:29f5ad896382 262 #if DEBUGMODE
CaptainR 12:29f5ad896382 263 pc.printf("\n\r DEBUG: Answer = ");
CaptainR 6:a1a85f2bc04b 264 for (int i = 0; i < index; i++) {
CaptainR 6:a1a85f2bc04b 265 pc.printf("%02X ", rxBuf[i]);
CaptainR 6:a1a85f2bc04b 266 }
CaptainR 6:a1a85f2bc04b 267 pc.printf("\n\r");
CaptainR 12:29f5ad896382 268 #endif
CaptainR 6:a1a85f2bc04b 269 Xdest = rxBuf[1] << 8 | rxBuf[2];
CaptainR 6:a1a85f2bc04b 270 Ydest = rxBuf[3] << 8 | rxBuf[4];
CaptainR 12:29f5ad896382 271 #if DEBUGMODE
CaptainR 12:29f5ad896382 272 pc.printf("\n\r DEBUG: New coordiantes = %i x %i\n\r", Xdest, Ydest);
CaptainR 12:29f5ad896382 273 #endif
CaptainR 12:29f5ad896382 274 index = 0; // set buffer index to 0
CaptainR 12:29f5ad896382 275 return true;
CaptainR 6:a1a85f2bc04b 276 }
CaptainR 6:a1a85f2bc04b 277
CaptainR 11:3ebd2263f3e9 278
CaptainR 6:a1a85f2bc04b 279 //**************************************************************************
CaptainR 11:3ebd2263f3e9 280 short PICASO_4DGL :: getGraphicsResponse() {
CaptainR 11:3ebd2263f3e9 281
CaptainR 12:29f5ad896382 282 #if DEBUGMODE
CaptainR 12:29f5ad896382 283 pc.printf("\n\r DEBUG: Wait for answer...");
CaptainR 12:29f5ad896382 284 #endif
CaptainR 12:29f5ad896382 285 while (index < 3) wait_ms(100); // wait for screen answer
CaptainR 0:a5ef6bc3c2e8 286
CaptainR 12:29f5ad896382 287 #if DEBUGMODE
CaptainR 12:29f5ad896382 288 pc.printf("\n\r DEBUG: Answer = ");
CaptainR 12:29f5ad896382 289 for (int i = 0; i < index; i++) {
CaptainR 12:29f5ad896382 290 pc.printf("%02X ", rxBuf[i]);
CaptainR 12:29f5ad896382 291 }
CaptainR 12:29f5ad896382 292 pc.printf("\n\r");
CaptainR 12:29f5ad896382 293 #endif
CaptainR 12:29f5ad896382 294 short answer = rxBuf[1] << 8 | rxBuf[2]; // set response variable
CaptainR 12:29f5ad896382 295 index = 0; // set buffer index to 0
CaptainR 12:29f5ad896382 296 return answer;
CaptainR 12:29f5ad896382 297 }
CaptainR 12:29f5ad896382 298
CaptainR 12:29f5ad896382 299 //**************************************************************************
CaptainR 12:29f5ad896382 300 short PICASO_4DGL :: mediaInitResponse() {
CaptainR 12:29f5ad896382 301
CaptainR 12:29f5ad896382 302 #if DEBUGMODE
CaptainR 12:29f5ad896382 303 pc.printf("\n\r DEBUG: Wait for answer...");
CaptainR 12:29f5ad896382 304 #endif
CaptainR 12:29f5ad896382 305 while (index < 3) wait_ms(100); // wait for screen answer
CaptainR 12:29f5ad896382 306
CaptainR 12:29f5ad896382 307 #if DEBUGMODE
CaptainR 12:29f5ad896382 308 pc.printf("\n\r DEBUG: Answer = ");
CaptainR 11:3ebd2263f3e9 309 for (int i = 0; i < index; i++) {
CaptainR 11:3ebd2263f3e9 310 pc.printf("%02X ", rxBuf[i]);
CaptainR 0:a5ef6bc3c2e8 311 }
CaptainR 11:3ebd2263f3e9 312 pc.printf("\n\r");
CaptainR 12:29f5ad896382 313 #endif
CaptainR 12:29f5ad896382 314 short answer = rxBuf[1] << 8 | rxBuf[2];
CaptainR 11:3ebd2263f3e9 315 index = 0;
CaptainR 11:3ebd2263f3e9 316 return answer;
CaptainR 0:a5ef6bc3c2e8 317 }
CaptainR 12:29f5ad896382 318
CaptainR 12:29f5ad896382 319 //**************************************************************************
CaptainR 12:29f5ad896382 320 bool PICASO_4DGL :: readSectorResponse(int count) {
CaptainR 12:29f5ad896382 321
CaptainR 12:29f5ad896382 322 #if DEBUGMODE
CaptainR 12:29f5ad896382 323 pc.printf("\n\r DEBUG: Wait for answer");
CaptainR 12:29f5ad896382 324 #endif
CaptainR 14:561cb06a2739 325
CaptainR 14:561cb06a2739 326 while (index < count) wait_ms(100); // wait for screen answer
CaptainR 14:561cb06a2739 327
CaptainR 12:29f5ad896382 328 #if DEBUGMODE
CaptainR 13:1a0800957412 329 pc.printf("\n\r DEBUG: Answer = ");
CaptainR 13:1a0800957412 330 pc.printf("%02X %02X %02X\n\r", rxBuf[0], rxBuf[1], rxBuf[2]);
CaptainR 12:29f5ad896382 331 #endif
CaptainR 12:29f5ad896382 332
CaptainR 12:29f5ad896382 333 int j = 3;
CaptainR 12:29f5ad896382 334 for (int i = 0; i < BUFFER_SIZE; i++) {
CaptainR 12:29f5ad896382 335 buffer[i] = rxBuf[j];
CaptainR 12:29f5ad896382 336 j++;
CaptainR 12:29f5ad896382 337 }
CaptainR 13:1a0800957412 338 #if DEBUGMODE
CaptainR 13:1a0800957412 339 pc.printf("\n\r DEBUG: Buffer = ");
CaptainR 13:1a0800957412 340 for (int i = 0; i < BUFFER_SIZE; i++) {
CaptainR 13:1a0800957412 341 pc.printf("%02X ", buffer[i]);
CaptainR 13:1a0800957412 342 }
CaptainR 13:1a0800957412 343 pc.printf("\n\r");
CaptainR 13:1a0800957412 344 #endif
CaptainR 13:1a0800957412 345 if (rxBuf[2] == 1) {
CaptainR 12:29f5ad896382 346 index = 0; // set buffer index to 0
CaptainR 12:29f5ad896382 347 return true;
CaptainR 12:29f5ad896382 348 }
CaptainR 12:29f5ad896382 349 else {
CaptainR 12:29f5ad896382 350 index = 0;
CaptainR 12:29f5ad896382 351 return false;
CaptainR 12:29f5ad896382 352 }
CaptainR 12:29f5ad896382 353 }
CaptainR 14:561cb06a2739 354
CaptainR 14:561cb06a2739 355 //**************************************************************************
CaptainR 14:561cb06a2739 356 bool PICASO_4DGL :: writeSectorResponse(int count) {
CaptainR 14:561cb06a2739 357
CaptainR 14:561cb06a2739 358 #if DEBUGMODE
CaptainR 14:561cb06a2739 359 pc.printf("\n\r DEBUG: Wait for answer");
CaptainR 14:561cb06a2739 360 #endif
CaptainR 14:561cb06a2739 361 while (index < count) wait_ms(100); // wait for screen answer
CaptainR 14:561cb06a2739 362
CaptainR 14:561cb06a2739 363 #if DEBUGMODE
CaptainR 14:561cb06a2739 364 pc.printf("\n\r DEBUG: Answer = ");
CaptainR 14:561cb06a2739 365 pc.printf("%02X %02X %02X\n\r", rxBuf[0], rxBuf[1], rxBuf[2]);
CaptainR 14:561cb06a2739 366 #endif
CaptainR 14:561cb06a2739 367
CaptainR 14:561cb06a2739 368 if (rxBuf[2] == 1) {
CaptainR 14:561cb06a2739 369 index = 0; // set buffer index to 0
CaptainR 14:561cb06a2739 370 return true;
CaptainR 14:561cb06a2739 371 }
CaptainR 14:561cb06a2739 372 else {
CaptainR 14:561cb06a2739 373 index = 0;
CaptainR 14:561cb06a2739 374 return false;
CaptainR 14:561cb06a2739 375 }
CaptainR 14:561cb06a2739 376 }