Rihards Balass / 4DGL-mbed-32PTU
Committer:
CaptainR
Date:
Fri Sep 09 06:17:05 2016 +0000
Revision:
2:81eaaa491a02
Parent:
1:e2337e2653e1
Child:
3:dcfbceb81fef
Cleaned up all files, redefined constants to be more easier to use...; Added info about copyright :)

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 0:a5ef6bc3c2e8 22 //Serial pc(USBTX,USBRX);
CaptainR 0:a5ef6bc3c2e8 23 DigitalOut led1(LED1), led2(LED2);
CaptainR 0:a5ef6bc3c2e8 24 #define SHORT_WAIT 500
CaptainR 0:a5ef6bc3c2e8 25 #define LONG_WAIT 2000
CaptainR 0:a5ef6bc3c2e8 26
CaptainR 0:a5ef6bc3c2e8 27 //******************************************************************************************************
CaptainR 0:a5ef6bc3c2e8 28 TFT_4DGL :: TFT_4DGL(PinName tx, PinName rx, PinName rst) : pc(USBTX, USBRX), _cmd(tx, rx), _rst(rst) { // Constructor
CaptainR 0:a5ef6bc3c2e8 29
CaptainR 0:a5ef6bc3c2e8 30 responseBuild(10, '0');
CaptainR 0:a5ef6bc3c2e8 31
CaptainR 0:a5ef6bc3c2e8 32 #if DEBUGMODE
CaptainR 0:a5ef6bc3c2e8 33 pc.baud(115200);
CaptainR 0:a5ef6bc3c2e8 34
CaptainR 0:a5ef6bc3c2e8 35 pc.printf("\n\n\n");
CaptainR 0:a5ef6bc3c2e8 36 pc.printf("********************\n\r");
CaptainR 0:a5ef6bc3c2e8 37 pc.printf("TFT_4DGL CONSTRUCTOR\n\r");
CaptainR 0:a5ef6bc3c2e8 38 pc.printf("********************\n\r");
CaptainR 0:a5ef6bc3c2e8 39 #endif
CaptainR 0:a5ef6bc3c2e8 40
CaptainR 0:a5ef6bc3c2e8 41 _rst = 1; // put RESET pin to high to start TFT screen
CaptainR 0:a5ef6bc3c2e8 42 //wait_ms(10000);
CaptainR 0:a5ef6bc3c2e8 43 //reset();
CaptainR 0:a5ef6bc3c2e8 44 #if DEBUGMODE
CaptainR 0:a5ef6bc3c2e8 45 pc.printf("Wait 3 seconds for startup...\n\r");
CaptainR 0:a5ef6bc3c2e8 46 wait_ms(1000);
CaptainR 0:a5ef6bc3c2e8 47 pc.printf("2\n\r");
CaptainR 0:a5ef6bc3c2e8 48 wait_ms(1000);
CaptainR 0:a5ef6bc3c2e8 49 pc.printf("1\n\r");
CaptainR 0:a5ef6bc3c2e8 50 wait_ms(1000);
CaptainR 0:a5ef6bc3c2e8 51 #else
CaptainR 0:a5ef6bc3c2e8 52 wait_ms(3000);
CaptainR 0:a5ef6bc3c2e8 53 #endif
CaptainR 0:a5ef6bc3c2e8 54 //autobaud(); // send autobaud command
CaptainR 0:a5ef6bc3c2e8 55 #if DEBUGMODE
CaptainR 0:a5ef6bc3c2e8 56 pc.printf("set baudrate to 9600...\n\r");
CaptainR 0:a5ef6bc3c2e8 57 #endif
CaptainR 0:a5ef6bc3c2e8 58 baudrate(9600); // set the initial baudrate to 256kbps - fastest supported by uLCD-32PT
CaptainR 0:a5ef6bc3c2e8 59 #if DEBUGMODE
CaptainR 0:a5ef6bc3c2e8 60 pc.printf("clear screen...\n\r");
CaptainR 0:a5ef6bc3c2e8 61 #endif
CaptainR 0:a5ef6bc3c2e8 62 cls(); // clear screen
CaptainR 0:a5ef6bc3c2e8 63 screenOrientation(1);
CaptainR 0:a5ef6bc3c2e8 64 setFont(3);
CaptainR 0:a5ef6bc3c2e8 65
CaptainR 0:a5ef6bc3c2e8 66 #if DEBUGMODE
CaptainR 0:a5ef6bc3c2e8 67 pc.printf("Start Demo...\n\r");
CaptainR 0:a5ef6bc3c2e8 68 wait_ms(1000);
CaptainR 2:81eaaa491a02 69 mainDemo();
CaptainR 0:a5ef6bc3c2e8 70 //textDemo();
CaptainR 2:81eaaa491a02 71 //graphicsDemo();
CaptainR 0:a5ef6bc3c2e8 72 #endif
CaptainR 0:a5ef6bc3c2e8 73
CaptainR 0:a5ef6bc3c2e8 74 }
CaptainR 0:a5ef6bc3c2e8 75
CaptainR 0:a5ef6bc3c2e8 76 //******************************************************************************************************
CaptainR 0:a5ef6bc3c2e8 77 void TFT_4DGL :: responseBuild(int size, char c) {
CaptainR 0:a5ef6bc3c2e8 78
CaptainR 0:a5ef6bc3c2e8 79 response[size] = c;
CaptainR 0:a5ef6bc3c2e8 80 respLen = 0;
CaptainR 0:a5ef6bc3c2e8 81 }
CaptainR 0:a5ef6bc3c2e8 82
CaptainR 0:a5ef6bc3c2e8 83 //******************************************************************************************************
CaptainR 0:a5ef6bc3c2e8 84 void TFT_4DGL :: writeBYTE(char c) { // send a BYTE command to screen
CaptainR 0:a5ef6bc3c2e8 85
CaptainR 0:a5ef6bc3c2e8 86 _cmd.putc(c);
CaptainR 0:a5ef6bc3c2e8 87
CaptainR 0:a5ef6bc3c2e8 88 #if DEBUGMODE
CaptainR 0:a5ef6bc3c2e8 89 pc.printf(" Char sent : 0x%02X ",c);
CaptainR 0:a5ef6bc3c2e8 90 pc.putc(c);
CaptainR 0:a5ef6bc3c2e8 91 pc.printf(" \n\r");
CaptainR 0:a5ef6bc3c2e8 92 #endif
CaptainR 0:a5ef6bc3c2e8 93
CaptainR 0:a5ef6bc3c2e8 94 }
CaptainR 0:a5ef6bc3c2e8 95
CaptainR 0:a5ef6bc3c2e8 96 //******************************************************************************************************
CaptainR 0:a5ef6bc3c2e8 97 void TFT_4DGL :: freeBUFFER(void) { // Clear serial buffer before writing command
CaptainR 0:a5ef6bc3c2e8 98
CaptainR 0:a5ef6bc3c2e8 99 while (_cmd.readable()) _cmd.getc(); // clear buffer garbage
CaptainR 0:a5ef6bc3c2e8 100 }
CaptainR 0:a5ef6bc3c2e8 101
CaptainR 0:a5ef6bc3c2e8 102 //******************************************************************************************************
CaptainR 0:a5ef6bc3c2e8 103 void TFT_4DGL :: writeCOMMAND(char *command, int number) { // send several BYTES making a command and return an answer
CaptainR 0:a5ef6bc3c2e8 104
CaptainR 0:a5ef6bc3c2e8 105 #if DEBUGMODE
CaptainR 0:a5ef6bc3c2e8 106 pc.printf("\n\r");
CaptainR 0:a5ef6bc3c2e8 107 pc.printf("New COMMAND : 0x%02X%02X\n\r", command[0], command[1]);
CaptainR 0:a5ef6bc3c2e8 108 #endif
CaptainR 0:a5ef6bc3c2e8 109 int i;
CaptainR 0:a5ef6bc3c2e8 110 freeBUFFER();
CaptainR 0:a5ef6bc3c2e8 111
CaptainR 0:a5ef6bc3c2e8 112 for (i = 0; i < number; i++) writeBYTE(command[i]); // send command to serial port
CaptainR 0:a5ef6bc3c2e8 113
CaptainR 0:a5ef6bc3c2e8 114 getResponse();
CaptainR 0:a5ef6bc3c2e8 115 }
CaptainR 0:a5ef6bc3c2e8 116
CaptainR 0:a5ef6bc3c2e8 117 //**************************************************************************
CaptainR 0:a5ef6bc3c2e8 118 void TFT_4DGL :: reset() { // Reset Screen
CaptainR 0:a5ef6bc3c2e8 119
CaptainR 0:a5ef6bc3c2e8 120 _rst = 0; // put RESET pin to low
CaptainR 0:a5ef6bc3c2e8 121 wait_ms(TEMPO); // wait a few milliseconds for command reception
CaptainR 0:a5ef6bc3c2e8 122 _rst = 1; // put RESET back to high
CaptainR 0:a5ef6bc3c2e8 123 wait(3); // wait 3s for screen to restart
CaptainR 0:a5ef6bc3c2e8 124
CaptainR 0:a5ef6bc3c2e8 125 freeBUFFER(); // clean buffer from possible garbage
CaptainR 0:a5ef6bc3c2e8 126 }
CaptainR 0:a5ef6bc3c2e8 127
CaptainR 0:a5ef6bc3c2e8 128 //**************************************************************************
CaptainR 0:a5ef6bc3c2e8 129 void TFT_4DGL :: baudrate(long speed) { // set screen baud rate
CaptainR 0:a5ef6bc3c2e8 130
CaptainR 0:a5ef6bc3c2e8 131 char command[4]= "";
CaptainR 2:81eaaa491a02 132 command[0] = (BAUDRATE >> (8*1)) & 0xff;
CaptainR 2:81eaaa491a02 133 command[1] = (BAUDRATE >> (8*0)) & 0xff;
CaptainR 0:a5ef6bc3c2e8 134 switch (speed) {
CaptainR 0:a5ef6bc3c2e8 135 case 300 :
CaptainR 2:81eaaa491a02 136 command[2] = (BAUD_300 >> (8*1)) & 0xff;
CaptainR 2:81eaaa491a02 137 command[3] = (BAUD_300 >> (8*0)) & 0xff;
CaptainR 0:a5ef6bc3c2e8 138 break;
CaptainR 0:a5ef6bc3c2e8 139 case 600 :
CaptainR 2:81eaaa491a02 140 command[2] = (BAUD_600 >> (8*1)) & 0xff;
CaptainR 2:81eaaa491a02 141 command[3] = (BAUD_600 >> (8*0)) & 0xff;
CaptainR 0:a5ef6bc3c2e8 142 break;
CaptainR 0:a5ef6bc3c2e8 143 case 1200 :
CaptainR 2:81eaaa491a02 144 command[2] = (BAUD_1200 >> (8*1)) & 0xff;
CaptainR 2:81eaaa491a02 145 command[3] = (BAUD_1200 >> (8*0)) & 0xff;
CaptainR 0:a5ef6bc3c2e8 146 break;
CaptainR 0:a5ef6bc3c2e8 147 case 2400 :
CaptainR 2:81eaaa491a02 148 command[2] = (BAUD_2400 >> (8*1)) & 0xff;
CaptainR 2:81eaaa491a02 149 command[3] = (BAUD_2400 >> (8*0)) & 0xff;
CaptainR 0:a5ef6bc3c2e8 150 break;
CaptainR 0:a5ef6bc3c2e8 151 case 4800 :
CaptainR 2:81eaaa491a02 152 command[2] = (BAUD_4800 >> (8*1)) & 0xff;
CaptainR 2:81eaaa491a02 153 command[3] = (BAUD_4800 >> (8*0)) & 0xff;
CaptainR 0:a5ef6bc3c2e8 154 break;
CaptainR 0:a5ef6bc3c2e8 155 case 9600 :
CaptainR 2:81eaaa491a02 156 command[2] = (BAUD_9600 >> (8*1)) & 0xff;
CaptainR 2:81eaaa491a02 157 command[3] = (BAUD_9600 >> (8*0)) & 0xff;
CaptainR 0:a5ef6bc3c2e8 158 break;
CaptainR 0:a5ef6bc3c2e8 159 case 14400 :
CaptainR 2:81eaaa491a02 160 command[2] = (BAUD_14400 >> (8*1)) & 0xff;
CaptainR 2:81eaaa491a02 161 command[3] = (BAUD_14400 >> (8*0)) & 0xff;
CaptainR 0:a5ef6bc3c2e8 162 break;
CaptainR 0:a5ef6bc3c2e8 163 case 19200 :
CaptainR 2:81eaaa491a02 164 command[2] = (BAUD_19200 >> (8*1)) & 0xff;
CaptainR 2:81eaaa491a02 165 command[3] = (BAUD_19200 >> (8*0)) & 0xff;
CaptainR 2:81eaaa491a02 166 break;
CaptainR 2:81eaaa491a02 167 case 31250 :
CaptainR 2:81eaaa491a02 168 command[2] = (BAUD_31250 >> (8*1)) & 0xff;
CaptainR 2:81eaaa491a02 169 command[3] = (BAUD_31250 >> (8*0)) & 0xff;
CaptainR 0:a5ef6bc3c2e8 170 break;
CaptainR 0:a5ef6bc3c2e8 171 case 38400 :
CaptainR 2:81eaaa491a02 172 command[2] = (BAUD_38400 >> (8*1)) & 0xff;
CaptainR 2:81eaaa491a02 173 command[3] = (BAUD_38400 >> (8*0)) & 0xff;
CaptainR 0:a5ef6bc3c2e8 174 break;
CaptainR 0:a5ef6bc3c2e8 175 case 56000 :
CaptainR 2:81eaaa491a02 176 command[2] = (BAUD_56000 >> (8*1)) & 0xff;
CaptainR 2:81eaaa491a02 177 command[3] = (BAUD_56000 >> (8*0)) & 0xff;
CaptainR 0:a5ef6bc3c2e8 178 break;
CaptainR 0:a5ef6bc3c2e8 179 case 57600 :
CaptainR 2:81eaaa491a02 180 command[2] = (BAUD_57600 >> (8*1)) & 0xff;
CaptainR 2:81eaaa491a02 181 command[3] = (BAUD_57600 >> (8*0)) & 0xff;
CaptainR 0:a5ef6bc3c2e8 182 break;
CaptainR 0:a5ef6bc3c2e8 183 case 115200 :
CaptainR 2:81eaaa491a02 184 command[2] = (BAUD_115200 >> (8*1)) & 0xff;
CaptainR 2:81eaaa491a02 185 command[3] = (BAUD_115200 >> (8*0)) & 0xff;
CaptainR 0:a5ef6bc3c2e8 186 break;
CaptainR 0:a5ef6bc3c2e8 187 case 128000 :
CaptainR 2:81eaaa491a02 188 command[2] = (BAUD_128000 >> (8*1)) & 0xff;
CaptainR 2:81eaaa491a02 189 command[3] = (BAUD_128000 >> (8*0)) & 0xff;
CaptainR 0:a5ef6bc3c2e8 190 break;
CaptainR 0:a5ef6bc3c2e8 191 case 256000 :
CaptainR 2:81eaaa491a02 192 command[2] = (BAUD_256000 >> (8*1)) & 0xff;
CaptainR 2:81eaaa491a02 193 command[3] = (BAUD_256000 >> (8*0)) & 0xff;
CaptainR 0:a5ef6bc3c2e8 194 break;
CaptainR 0:a5ef6bc3c2e8 195 case 300000 :
CaptainR 2:81eaaa491a02 196 command[2] = (BAUD_300000 >> (8*1)) & 0xff;
CaptainR 2:81eaaa491a02 197 command[3] = (BAUD_300000 >> (8*0)) & 0xff;
CaptainR 0:a5ef6bc3c2e8 198 break;
CaptainR 0:a5ef6bc3c2e8 199 case 375000 :
CaptainR 2:81eaaa491a02 200 command[2] = (BAUD_375000 >> (8*1)) & 0xff;
CaptainR 2:81eaaa491a02 201 command[3] = (BAUD_375000 >> (8*0)) & 0xff;
CaptainR 0:a5ef6bc3c2e8 202 break;
CaptainR 0:a5ef6bc3c2e8 203 case 500000 :
CaptainR 2:81eaaa491a02 204 command[2] = (BAUD_500000 >> (8*1)) & 0xff;
CaptainR 2:81eaaa491a02 205 command[3] = (BAUD_500000 >> (8*0)) & 0xff;
CaptainR 0:a5ef6bc3c2e8 206 break;
CaptainR 0:a5ef6bc3c2e8 207 case 600000 :
CaptainR 2:81eaaa491a02 208 command[2] = (BAUD_600000 >> (8*1)) & 0xff;
CaptainR 2:81eaaa491a02 209 command[3] = (BAUD_600000 >> (8*0)) & 0xff;
CaptainR 0:a5ef6bc3c2e8 210 break;
CaptainR 0:a5ef6bc3c2e8 211 default :
CaptainR 2:81eaaa491a02 212 command[2] = (BAUD_9600 >> (8*1)) & 0xff;
CaptainR 2:81eaaa491a02 213 command[3] = (BAUD_9600 >> (8*0)) & 0xff;
CaptainR 0:a5ef6bc3c2e8 214 speed = 9600;
CaptainR 0:a5ef6bc3c2e8 215 break;
CaptainR 0:a5ef6bc3c2e8 216 }
CaptainR 0:a5ef6bc3c2e8 217
CaptainR 0:a5ef6bc3c2e8 218 #if DEBUGMODE
CaptainR 0:a5ef6bc3c2e8 219 pc.printf("\n\r");
CaptainR 0:a5ef6bc3c2e8 220 pc.printf("New COMMAND : 0x%02X%02X\n\r", command[0], command[1]);
CaptainR 0:a5ef6bc3c2e8 221 #endif
CaptainR 0:a5ef6bc3c2e8 222
CaptainR 0:a5ef6bc3c2e8 223 int i;
CaptainR 0:a5ef6bc3c2e8 224 freeBUFFER();
CaptainR 0:a5ef6bc3c2e8 225
CaptainR 0:a5ef6bc3c2e8 226 //Change baudrates - as instructed by 4DGL
CaptainR 0:a5ef6bc3c2e8 227 if (speed == 128000) speed = 133928;
CaptainR 0:a5ef6bc3c2e8 228 if (speed == 256000) speed = 282353;
CaptainR 0:a5ef6bc3c2e8 229 if (speed == 300000) speed = 312500;
CaptainR 0:a5ef6bc3c2e8 230 if (speed == 375000) speed = 401785;
CaptainR 0:a5ef6bc3c2e8 231 if (speed == 500000) speed = 562500;
CaptainR 0:a5ef6bc3c2e8 232 if (speed == 600000) speed = 703125;
CaptainR 0:a5ef6bc3c2e8 233
CaptainR 0:a5ef6bc3c2e8 234 for (i = 0; i <4; i++) writeBYTE(command[i]); // send command to serial port
CaptainR 0:a5ef6bc3c2e8 235 _cmd.baud(speed); // set mbed to same speed
CaptainR 0:a5ef6bc3c2e8 236
CaptainR 0:a5ef6bc3c2e8 237 getResponse();
CaptainR 0:a5ef6bc3c2e8 238 }
CaptainR 0:a5ef6bc3c2e8 239
CaptainR 0:a5ef6bc3c2e8 240 //**************************************************************************
CaptainR 0:a5ef6bc3c2e8 241 void TFT_4DGL :: getResponse() {
CaptainR 0:a5ef6bc3c2e8 242
CaptainR 0:a5ef6bc3c2e8 243 while (!_cmd.readable()) wait_ms(TEMPO); // wait for screen answer
CaptainR 0:a5ef6bc3c2e8 244
CaptainR 0:a5ef6bc3c2e8 245 while (_cmd.readable()) {
CaptainR 0:a5ef6bc3c2e8 246 resp = _cmd.getc(); // read response if any
CaptainR 0:a5ef6bc3c2e8 247 }
CaptainR 0:a5ef6bc3c2e8 248 switch (resp) {
CaptainR 0:a5ef6bc3c2e8 249 case ACK :
CaptainR 0:a5ef6bc3c2e8 250 resp = 1;
CaptainR 0:a5ef6bc3c2e8 251 break;
CaptainR 0:a5ef6bc3c2e8 252 case NACK :
CaptainR 0:a5ef6bc3c2e8 253 resp = -1;
CaptainR 0:a5ef6bc3c2e8 254 break;
CaptainR 0:a5ef6bc3c2e8 255 default :
CaptainR 0:a5ef6bc3c2e8 256 resp = 0;
CaptainR 0:a5ef6bc3c2e8 257 break;
CaptainR 0:a5ef6bc3c2e8 258 }
CaptainR 0:a5ef6bc3c2e8 259 pc.printf("\n\r Answer received : %d\n\r", resp);
CaptainR 0:a5ef6bc3c2e8 260 }
CaptainR 0:a5ef6bc3c2e8 261
CaptainR 0:a5ef6bc3c2e8 262 //**************************************************************************
CaptainR 0:a5ef6bc3c2e8 263 void TFT_4DGL :: screenOrientation(char c) { // select screen orientation
CaptainR 0:a5ef6bc3c2e8 264 char command[4] = "";
CaptainR 2:81eaaa491a02 265 command[0] = (ORIENTATION >> (8*1)) & 0xff;
CaptainR 2:81eaaa491a02 266 command[1] = (ORIENTATION >> (8*0)) & 0xff;
CaptainR 0:a5ef6bc3c2e8 267
CaptainR 0:a5ef6bc3c2e8 268 switch (c) {
CaptainR 0:a5ef6bc3c2e8 269 case 1 :
CaptainR 2:81eaaa491a02 270 command[2] = (LANDSCAPE >> (8*1)) & 0xff;
CaptainR 2:81eaaa491a02 271 command[3] = (LANDSCAPE >> (8*0)) & 0xff;
CaptainR 0:a5ef6bc3c2e8 272 currentOrientation = 1;
CaptainR 0:a5ef6bc3c2e8 273 break;
CaptainR 0:a5ef6bc3c2e8 274 case 2 :
CaptainR 2:81eaaa491a02 275 command[2] = (LANDSCAPE_R >> (8*1)) & 0xff;
CaptainR 2:81eaaa491a02 276 command[3] = (LANDSCAPE_R >> (8*0)) & 0xff;
CaptainR 0:a5ef6bc3c2e8 277 currentOrientation = 2;
CaptainR 0:a5ef6bc3c2e8 278 break;
CaptainR 0:a5ef6bc3c2e8 279 case 3 :
CaptainR 2:81eaaa491a02 280 command[2] = (PORTRAIT >> (8*1)) & 0xff;
CaptainR 2:81eaaa491a02 281 command[3] = (PORTRAIT >> (8*0)) & 0xff;
CaptainR 0:a5ef6bc3c2e8 282 currentOrientation = 3;
CaptainR 0:a5ef6bc3c2e8 283 break;
CaptainR 0:a5ef6bc3c2e8 284 case 4 :
CaptainR 2:81eaaa491a02 285 command[2] = (PORTRAIT_R >> (8*1)) & 0xff;
CaptainR 2:81eaaa491a02 286 command[3] = (PORTRAIT_R >> (8*0)) & 0xff;
CaptainR 0:a5ef6bc3c2e8 287 currentOrientation = 4;
CaptainR 0:a5ef6bc3c2e8 288 break;
CaptainR 0:a5ef6bc3c2e8 289 }
CaptainR 0:a5ef6bc3c2e8 290
CaptainR 0:a5ef6bc3c2e8 291 writeCOMMAND(command, 4);
CaptainR 0:a5ef6bc3c2e8 292 }