Rucklidge chaotic attractor

Committer:
JLS
Date:
Mon Jan 03 13:57:46 2011 +0000
Revision:
0:73bfbf91b6e5

        

Who changed what in which revision?

UserRevisionLine numberNew contents of line
JLS 0:73bfbf91b6e5 1 //
JLS 0:73bfbf91b6e5 2 // TFT_4DGL is a class to drive 4D Systems TFT touch screens
JLS 0:73bfbf91b6e5 3 //
JLS 0:73bfbf91b6e5 4 // Copyright (C) <2010> Stephane ROCHON <stephane.rochon at free.fr>
JLS 0:73bfbf91b6e5 5 //
JLS 0:73bfbf91b6e5 6 // TFT_4DGL is free software: you can redistribute it and/or modify
JLS 0:73bfbf91b6e5 7 // it under the terms of the GNU General Public License as published by
JLS 0:73bfbf91b6e5 8 // the Free Software Foundation, either version 3 of the License, or
JLS 0:73bfbf91b6e5 9 // (at your option) any later version.
JLS 0:73bfbf91b6e5 10 //
JLS 0:73bfbf91b6e5 11 // TFT_4DGL is distributed in the hope that it will be useful,
JLS 0:73bfbf91b6e5 12 // but WITHOUT ANY WARRANTY; without even the implied warranty of
JLS 0:73bfbf91b6e5 13 // MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE. See the
JLS 0:73bfbf91b6e5 14 // GNU General Public License for more details.
JLS 0:73bfbf91b6e5 15 //
JLS 0:73bfbf91b6e5 16 // You should have received a copy of the GNU General Public License
JLS 0:73bfbf91b6e5 17 // along with TFT_4DGL. If not, see <http://www.gnu.org/licenses/>.
JLS 0:73bfbf91b6e5 18
JLS 0:73bfbf91b6e5 19 #include "mbed.h"
JLS 0:73bfbf91b6e5 20 #include "TFT_4DGL.h"
JLS 0:73bfbf91b6e5 21
JLS 0:73bfbf91b6e5 22
JLS 0:73bfbf91b6e5 23 //****************************************************************************************************
JLS 0:73bfbf91b6e5 24 void TFT_4DGL :: circle(int x, int y , int radius, int color) { // draw a circle in (x,y)
JLS 0:73bfbf91b6e5 25 char command[9]= "";
JLS 0:73bfbf91b6e5 26
JLS 0:73bfbf91b6e5 27 command[0] = CIRCLE;
JLS 0:73bfbf91b6e5 28
JLS 0:73bfbf91b6e5 29 command[1] = (x >> 8) & 0xFF;
JLS 0:73bfbf91b6e5 30 command[2] = x & 0xFF;
JLS 0:73bfbf91b6e5 31
JLS 0:73bfbf91b6e5 32 command[3] = (y >> 8) & 0xFF;
JLS 0:73bfbf91b6e5 33 command[4] = y & 0xFF;
JLS 0:73bfbf91b6e5 34
JLS 0:73bfbf91b6e5 35 command[5] = (radius >> 8) & 0xFF;
JLS 0:73bfbf91b6e5 36 command[6] = radius & 0xFF;
JLS 0:73bfbf91b6e5 37
JLS 0:73bfbf91b6e5 38 int red5 = (color >> (16 + 3)) & 0x1F; // get red on 5 bits
JLS 0:73bfbf91b6e5 39 int green6 = (color >> (8 + 2)) & 0x3F; // get green on 6 bits
JLS 0:73bfbf91b6e5 40 int blue5 = (color >> (0 + 3)) & 0x1F; // get blue on 5 bits
JLS 0:73bfbf91b6e5 41
JLS 0:73bfbf91b6e5 42 command[7] = ((red5 << 3) + (green6 >> 3)) & 0xFF; // first part of 16 bits color
JLS 0:73bfbf91b6e5 43 command[8] = ((green6 << 5) + (blue5 >> 0)) & 0xFF; // second part of 16 bits color
JLS 0:73bfbf91b6e5 44
JLS 0:73bfbf91b6e5 45 writeCOMMAND(command, 9);
JLS 0:73bfbf91b6e5 46 }
JLS 0:73bfbf91b6e5 47
JLS 0:73bfbf91b6e5 48 //****************************************************************************************************
JLS 0:73bfbf91b6e5 49 void TFT_4DGL :: triangle(int x1, int y1 , int x2, int y2, int x3, int y3, int color) { // draw a traingle
JLS 0:73bfbf91b6e5 50 char command[15]= "";
JLS 0:73bfbf91b6e5 51
JLS 0:73bfbf91b6e5 52 command[0] = TRIANGLE;
JLS 0:73bfbf91b6e5 53
JLS 0:73bfbf91b6e5 54 command[1] = (x1 >> 8) & 0xFF;
JLS 0:73bfbf91b6e5 55 command[2] = x1 & 0xFF;
JLS 0:73bfbf91b6e5 56
JLS 0:73bfbf91b6e5 57 command[3] = (y1 >> 8) & 0xFF;
JLS 0:73bfbf91b6e5 58 command[4] = y1 & 0xFF;
JLS 0:73bfbf91b6e5 59
JLS 0:73bfbf91b6e5 60 command[5] = (x2 >> 8) & 0xFF;
JLS 0:73bfbf91b6e5 61 command[6] = x2 & 0xFF;
JLS 0:73bfbf91b6e5 62
JLS 0:73bfbf91b6e5 63 command[7] = (y2 >> 8) & 0xFF;
JLS 0:73bfbf91b6e5 64 command[8] = y2 & 0xFF;
JLS 0:73bfbf91b6e5 65
JLS 0:73bfbf91b6e5 66 command[9] = (x3 >> 8) & 0xFF;
JLS 0:73bfbf91b6e5 67 command[10] = x3 & 0xFF;
JLS 0:73bfbf91b6e5 68
JLS 0:73bfbf91b6e5 69 command[11] = (y3 >> 8) & 0xFF;
JLS 0:73bfbf91b6e5 70 command[12] = y3 & 0xFF;
JLS 0:73bfbf91b6e5 71
JLS 0:73bfbf91b6e5 72 int red5 = (color >> (16 + 3)) & 0x1F; // get red on 5 bits
JLS 0:73bfbf91b6e5 73 int green6 = (color >> (8 + 2)) & 0x3F; // get green on 6 bits
JLS 0:73bfbf91b6e5 74 int blue5 = (color >> (0 + 3)) & 0x1F; // get blue on 5 bits
JLS 0:73bfbf91b6e5 75
JLS 0:73bfbf91b6e5 76 command[13] = ((red5 << 3) + (green6 >> 3)) & 0xFF; // first part of 16 bits color
JLS 0:73bfbf91b6e5 77 command[14] = ((green6 << 5) + (blue5 >> 0)) & 0xFF; // second part of 16 bits color
JLS 0:73bfbf91b6e5 78
JLS 0:73bfbf91b6e5 79 writeCOMMAND(command, 15);
JLS 0:73bfbf91b6e5 80 }
JLS 0:73bfbf91b6e5 81
JLS 0:73bfbf91b6e5 82 //****************************************************************************************************
JLS 0:73bfbf91b6e5 83 void TFT_4DGL :: line(int x1, int y1 , int x2, int y2, int color) { // draw a line
JLS 0:73bfbf91b6e5 84 char command[11]= "";
JLS 0:73bfbf91b6e5 85
JLS 0:73bfbf91b6e5 86 command[0] = LINE;
JLS 0:73bfbf91b6e5 87
JLS 0:73bfbf91b6e5 88 command[1] = (x1 >> 8) & 0xFF;
JLS 0:73bfbf91b6e5 89 command[2] = x1 & 0xFF;
JLS 0:73bfbf91b6e5 90
JLS 0:73bfbf91b6e5 91 command[3] = (y1 >> 8) & 0xFF;
JLS 0:73bfbf91b6e5 92 command[4] = y1 & 0xFF;
JLS 0:73bfbf91b6e5 93
JLS 0:73bfbf91b6e5 94 command[5] = (x2 >> 8) & 0xFF;
JLS 0:73bfbf91b6e5 95 command[6] = x2 & 0xFF;
JLS 0:73bfbf91b6e5 96
JLS 0:73bfbf91b6e5 97 command[7] = (y2 >> 8) & 0xFF;
JLS 0:73bfbf91b6e5 98 command[8] = y2 & 0xFF;
JLS 0:73bfbf91b6e5 99
JLS 0:73bfbf91b6e5 100 int red5 = (color >> (16 + 3)) & 0x1F; // get red on 5 bits
JLS 0:73bfbf91b6e5 101 int green6 = (color >> (8 + 2)) & 0x3F; // get green on 6 bits
JLS 0:73bfbf91b6e5 102 int blue5 = (color >> (0 + 3)) & 0x1F; // get blue on 5 bits
JLS 0:73bfbf91b6e5 103
JLS 0:73bfbf91b6e5 104 command[9] = ((red5 << 3) + (green6 >> 3)) & 0xFF; // first part of 16 bits color
JLS 0:73bfbf91b6e5 105 command[10] = ((green6 << 5) + (blue5 >> 0)) & 0xFF; // second part of 16 bits color
JLS 0:73bfbf91b6e5 106
JLS 0:73bfbf91b6e5 107 writeCOMMAND(command, 11);
JLS 0:73bfbf91b6e5 108 }
JLS 0:73bfbf91b6e5 109
JLS 0:73bfbf91b6e5 110 //****************************************************************************************************
JLS 0:73bfbf91b6e5 111 void TFT_4DGL :: rectangle(int x1, int y1 , int x2, int y2, int color) { // draw a rectangle
JLS 0:73bfbf91b6e5 112 char command[11]= "";
JLS 0:73bfbf91b6e5 113
JLS 0:73bfbf91b6e5 114 command[0] = RECTANGLE;
JLS 0:73bfbf91b6e5 115
JLS 0:73bfbf91b6e5 116 command[1] = (x1 >> 8) & 0xFF;
JLS 0:73bfbf91b6e5 117 command[2] = x1 & 0xFF;
JLS 0:73bfbf91b6e5 118
JLS 0:73bfbf91b6e5 119 command[3] = (y1 >> 8) & 0xFF;
JLS 0:73bfbf91b6e5 120 command[4] = y1 & 0xFF;
JLS 0:73bfbf91b6e5 121
JLS 0:73bfbf91b6e5 122 command[5] = (x2 >> 8) & 0xFF;
JLS 0:73bfbf91b6e5 123 command[6] = x2 & 0xFF;
JLS 0:73bfbf91b6e5 124
JLS 0:73bfbf91b6e5 125 command[7] = (y2 >> 8) & 0xFF;
JLS 0:73bfbf91b6e5 126 command[8] = y2 & 0xFF;
JLS 0:73bfbf91b6e5 127
JLS 0:73bfbf91b6e5 128 int red5 = (color >> (16 + 3)) & 0x1F; // get red on 5 bits
JLS 0:73bfbf91b6e5 129 int green6 = (color >> (8 + 2)) & 0x3F; // get green on 6 bits
JLS 0:73bfbf91b6e5 130 int blue5 = (color >> (0 + 3)) & 0x1F; // get blue on 5 bits
JLS 0:73bfbf91b6e5 131
JLS 0:73bfbf91b6e5 132 command[9] = ((red5 << 3) + (green6 >> 3)) & 0xFF; // first part of 16 bits color
JLS 0:73bfbf91b6e5 133 command[10] = ((green6 << 5) + (blue5 >> 0)) & 0xFF; // second part of 16 bits color
JLS 0:73bfbf91b6e5 134
JLS 0:73bfbf91b6e5 135 writeCOMMAND(command, 11);
JLS 0:73bfbf91b6e5 136 }
JLS 0:73bfbf91b6e5 137
JLS 0:73bfbf91b6e5 138 //****************************************************************************************************
JLS 0:73bfbf91b6e5 139 void TFT_4DGL :: ellipse(int x, int y , int radius_x, int radius_y, int color) { // draw an ellipse
JLS 0:73bfbf91b6e5 140 char command[11]= "";
JLS 0:73bfbf91b6e5 141
JLS 0:73bfbf91b6e5 142 command[0] = ELLIPSE;
JLS 0:73bfbf91b6e5 143
JLS 0:73bfbf91b6e5 144 command[1] = (x >> 8) & 0xFF;
JLS 0:73bfbf91b6e5 145 command[2] = x & 0xFF;
JLS 0:73bfbf91b6e5 146
JLS 0:73bfbf91b6e5 147 command[3] = (y >> 8) & 0xFF;
JLS 0:73bfbf91b6e5 148 command[4] = y & 0xFF;
JLS 0:73bfbf91b6e5 149
JLS 0:73bfbf91b6e5 150 command[5] = (radius_x >> 8) & 0xFF;
JLS 0:73bfbf91b6e5 151 command[6] = radius_x & 0xFF;
JLS 0:73bfbf91b6e5 152
JLS 0:73bfbf91b6e5 153 command[7] = (radius_y >> 8) & 0xFF;
JLS 0:73bfbf91b6e5 154 command[8] = radius_y & 0xFF;
JLS 0:73bfbf91b6e5 155
JLS 0:73bfbf91b6e5 156 int red5 = (color >> (16 + 3)) & 0x1F; // get red on 5 bits
JLS 0:73bfbf91b6e5 157 int green6 = (color >> (8 + 2)) & 0x3F; // get green on 6 bits
JLS 0:73bfbf91b6e5 158 int blue5 = (color >> (0 + 3)) & 0x1F; // get blue on 5 bits
JLS 0:73bfbf91b6e5 159
JLS 0:73bfbf91b6e5 160 command[9] = ((red5 << 3) + (green6 >> 3)) & 0xFF; // first part of 16 bits color
JLS 0:73bfbf91b6e5 161 command[10] = ((green6 << 5) + (blue5 >> 0)) & 0xFF; // second part of 16 bits color
JLS 0:73bfbf91b6e5 162
JLS 0:73bfbf91b6e5 163 writeCOMMAND(command, 11);
JLS 0:73bfbf91b6e5 164 }
JLS 0:73bfbf91b6e5 165
JLS 0:73bfbf91b6e5 166 //****************************************************************************************************
JLS 0:73bfbf91b6e5 167 void TFT_4DGL :: pixel(int x, int y, int color) { // draw a pixel
JLS 0:73bfbf91b6e5 168 char command[7]= "";
JLS 0:73bfbf91b6e5 169
JLS 0:73bfbf91b6e5 170 command[0] = PIXEL;
JLS 0:73bfbf91b6e5 171
JLS 0:73bfbf91b6e5 172 command[1] = (x >> 8) & 0xFF;
JLS 0:73bfbf91b6e5 173 command[2] = x & 0xFF;
JLS 0:73bfbf91b6e5 174
JLS 0:73bfbf91b6e5 175 command[3] = (y >> 8) & 0xFF;
JLS 0:73bfbf91b6e5 176 command[4] = y & 0xFF;
JLS 0:73bfbf91b6e5 177
JLS 0:73bfbf91b6e5 178 int red5 = (color >> (16 + 3)) & 0x1F; // get red on 5 bits
JLS 0:73bfbf91b6e5 179 int green6 = (color >> (8 + 2)) & 0x3F; // get green on 6 bits
JLS 0:73bfbf91b6e5 180 int blue5 = (color >> (0 + 3)) & 0x1F; // get blue on 5 bits
JLS 0:73bfbf91b6e5 181
JLS 0:73bfbf91b6e5 182 command[5] = ((red5 << 3) + (green6 >> 3)) & 0xFF; // first part of 16 bits color
JLS 0:73bfbf91b6e5 183 command[6] = ((green6 << 5) + (blue5 >> 0)) & 0xFF; // second part of 16 bits color
JLS 0:73bfbf91b6e5 184
JLS 0:73bfbf91b6e5 185 writeCOMMAND(command, 7);
JLS 0:73bfbf91b6e5 186 }
JLS 0:73bfbf91b6e5 187
JLS 0:73bfbf91b6e5 188 //******************************************************************************************************
JLS 0:73bfbf91b6e5 189 int TFT_4DGL :: read_pixel(int x, int y) { // read screen info and populate data
JLS 0:73bfbf91b6e5 190
JLS 0:73bfbf91b6e5 191 char command[5]= "";
JLS 0:73bfbf91b6e5 192
JLS 0:73bfbf91b6e5 193 command[0] = READPIXEL;
JLS 0:73bfbf91b6e5 194
JLS 0:73bfbf91b6e5 195 command[1] = (x >> 8) & 0xFF;
JLS 0:73bfbf91b6e5 196 command[2] = x & 0xFF;
JLS 0:73bfbf91b6e5 197
JLS 0:73bfbf91b6e5 198 command[3] = (y >> 8) & 0xFF;
JLS 0:73bfbf91b6e5 199 command[4] = y & 0xFF;
JLS 0:73bfbf91b6e5 200
JLS 0:73bfbf91b6e5 201 int i, temp = 0, color = 0, resp = 0;
JLS 0:73bfbf91b6e5 202 char response[2] = "";
JLS 0:73bfbf91b6e5 203
JLS 0:73bfbf91b6e5 204 freeBUFFER();
JLS 0:73bfbf91b6e5 205
JLS 0:73bfbf91b6e5 206 for (i = 0; i < 5; i++) { // send all chars to serial port
JLS 0:73bfbf91b6e5 207 writeBYTE(command[i]);
JLS 0:73bfbf91b6e5 208 }
JLS 0:73bfbf91b6e5 209
JLS 0:73bfbf91b6e5 210 while (!_cmd.readable()) wait_ms(TEMPO); // wait for screen answer
JLS 0:73bfbf91b6e5 211
JLS 0:73bfbf91b6e5 212 while (_cmd.readable()) {
JLS 0:73bfbf91b6e5 213 temp = _cmd.getc();
JLS 0:73bfbf91b6e5 214 response[resp++] = (char)temp;
JLS 0:73bfbf91b6e5 215 }
JLS 0:73bfbf91b6e5 216
JLS 0:73bfbf91b6e5 217 color = ((response[0] << 8) + response[1]);
JLS 0:73bfbf91b6e5 218
JLS 0:73bfbf91b6e5 219 return color; // WARNING : this is 16bits color, not 24bits... need to be fixed
JLS 0:73bfbf91b6e5 220 }
JLS 0:73bfbf91b6e5 221
JLS 0:73bfbf91b6e5 222 //******************************************************************************************************
JLS 0:73bfbf91b6e5 223 void TFT_4DGL :: screen_copy(int xs, int ys , int xd, int yd , int width, int height) {
JLS 0:73bfbf91b6e5 224
JLS 0:73bfbf91b6e5 225 char command[13]= "";
JLS 0:73bfbf91b6e5 226
JLS 0:73bfbf91b6e5 227 command[0] = SCREENCOPY;
JLS 0:73bfbf91b6e5 228
JLS 0:73bfbf91b6e5 229 command[1] = (xs >> 8) & 0xFF;
JLS 0:73bfbf91b6e5 230 command[2] = xs & 0xFF;
JLS 0:73bfbf91b6e5 231
JLS 0:73bfbf91b6e5 232 command[3] = (ys >> 8) & 0xFF;
JLS 0:73bfbf91b6e5 233 command[4] = ys & 0xFF;
JLS 0:73bfbf91b6e5 234
JLS 0:73bfbf91b6e5 235 command[5] = (xd >> 8) & 0xFF;
JLS 0:73bfbf91b6e5 236 command[6] = xd & 0xFF;
JLS 0:73bfbf91b6e5 237
JLS 0:73bfbf91b6e5 238 command[7] = (yd >> 8) & 0xFF;
JLS 0:73bfbf91b6e5 239 command[8] = yd & 0xFF;
JLS 0:73bfbf91b6e5 240
JLS 0:73bfbf91b6e5 241 command[9] = (width >> 8) & 0xFF;
JLS 0:73bfbf91b6e5 242 command[10] = width & 0xFF;
JLS 0:73bfbf91b6e5 243
JLS 0:73bfbf91b6e5 244 command[11] = (height >> 8) & 0xFF;
JLS 0:73bfbf91b6e5 245 command[12] = height & 0xFF;
JLS 0:73bfbf91b6e5 246
JLS 0:73bfbf91b6e5 247 writeCOMMAND(command, 13);
JLS 0:73bfbf91b6e5 248 }
JLS 0:73bfbf91b6e5 249
JLS 0:73bfbf91b6e5 250 //****************************************************************************************************
JLS 0:73bfbf91b6e5 251 void TFT_4DGL :: pen_size(char mode) { // set pen to SOLID or WIREFRAME
JLS 0:73bfbf91b6e5 252 char command[2]= "";
JLS 0:73bfbf91b6e5 253
JLS 0:73bfbf91b6e5 254 command[0] = PENSIZE;
JLS 0:73bfbf91b6e5 255 command[1] = mode;
JLS 0:73bfbf91b6e5 256
JLS 0:73bfbf91b6e5 257 writeCOMMAND(command, 2);
JLS 0:73bfbf91b6e5 258 }
JLS 0:73bfbf91b6e5 259
JLS 0:73bfbf91b6e5 260 //****************************************************************************************************
JLS 0:73bfbf91b6e5 261 // This plays a .wav file from the FAT partition of an uSD Card
JLS 0:73bfbf91b6e5 262 // Not really recommended as the speaker on the uLCD-32PT is really bad!
JLS 0:73bfbf91b6e5 263 //****************************************************************************************************
JLS 0:73bfbf91b6e5 264 void TFT_4DGL :: SD_Card_Wav(char *Filename) {
JLS 0:73bfbf91b6e5 265 char command[21]= "";
JLS 0:73bfbf91b6e5 266 int Lgt=0;
JLS 0:73bfbf91b6e5 267
JLS 0:73bfbf91b6e5 268 command[0] = 0x40; //ext_cmd
JLS 0:73bfbf91b6e5 269 command[1] = 0x6C; //Play Audio
JLS 0:73bfbf91b6e5 270 command[2] = 0x01; //Option 0x00=Return at end, 0x01=Return now, 0x02=Stop, 0x03=Pause, 0x04=Resume, 0x05=Loop.
JLS 0:73bfbf91b6e5 271 for(int i=0;Filename[i]!=0x00;i++){
JLS 0:73bfbf91b6e5 272 command[i+3] = Filename[i];
JLS 0:73bfbf91b6e5 273 Lgt = i;
JLS 0:73bfbf91b6e5 274 }
JLS 0:73bfbf91b6e5 275 command[Lgt+4] = 0x2E; //.
JLS 0:73bfbf91b6e5 276 command[Lgt+5] = 0x77; //w
JLS 0:73bfbf91b6e5 277 command[Lgt+6] = 0x61; //a
JLS 0:73bfbf91b6e5 278 command[Lgt+7] = 0x76; //v
JLS 0:73bfbf91b6e5 279 command[Lgt+8] = 0x00; //terminator
JLS 0:73bfbf91b6e5 280
JLS 0:73bfbf91b6e5 281 writeCOMMAND(command, Lgt+9);
JLS 0:73bfbf91b6e5 282 }
JLS 0:73bfbf91b6e5 283
JLS 0:73bfbf91b6e5 284 //****************************************************************************************************
JLS 0:73bfbf91b6e5 285 // This sets the volume for the speaker on the uLCD-32PT
JLS 0:73bfbf91b6e5 286 //****************************************************************************************************
JLS 0:73bfbf91b6e5 287 void TFT_4DGL :: Set_Volume(char vol) {
JLS 0:73bfbf91b6e5 288
JLS 0:73bfbf91b6e5 289 char command[2]= "";
JLS 0:73bfbf91b6e5 290
JLS 0:73bfbf91b6e5 291 command[0] = 0x76; //cmd
JLS 0:73bfbf91b6e5 292 command[1] = vol; //set volume
JLS 0:73bfbf91b6e5 293
JLS 0:73bfbf91b6e5 294 writeCOMMAND(command, 2);
JLS 0:73bfbf91b6e5 295 }
JLS 0:73bfbf91b6e5 296
JLS 0:73bfbf91b6e5 297 //****************************************************************************************************
JLS 0:73bfbf91b6e5 298 // This displays an image on the screen that is stored on the FAT partition of an uSD Card
JLS 0:73bfbf91b6e5 299 // Sent Filename, X-pos, Y-pos, Sector Address - Display from the RAW partition is quicker
JLS 0:73bfbf91b6e5 300 //****************************************************************************************************
JLS 0:73bfbf91b6e5 301 void TFT_4DGL :: uSD_FAT_Image(char *Filename, int x, int y, long s) {
JLS 0:73bfbf91b6e5 302 char X_MSB, X_LSB, Y_MSB, Y_LSB, S0, S1, S2, S3;
JLS 0:73bfbf91b6e5 303 char command[25]= "";
JLS 0:73bfbf91b6e5 304 int Lgt=0;
JLS 0:73bfbf91b6e5 305
JLS 0:73bfbf91b6e5 306 X_LSB = x&0x00FF;
JLS 0:73bfbf91b6e5 307 X_MSB = (x >> 8);
JLS 0:73bfbf91b6e5 308 Y_LSB = y&0x00FF;
JLS 0:73bfbf91b6e5 309 Y_MSB = (y >> 8);
JLS 0:73bfbf91b6e5 310
JLS 0:73bfbf91b6e5 311 S0 = (s >> 20)&0x000000FF;
JLS 0:73bfbf91b6e5 312 S1 = (s >> 16)&0x0000FF;
JLS 0:73bfbf91b6e5 313 S2 = (s >> 8)&0x0000FF;
JLS 0:73bfbf91b6e5 314 S3 = s&0x0000FF;;
JLS 0:73bfbf91b6e5 315
JLS 0:73bfbf91b6e5 316 command[0] = '@'; //ext_cmd
JLS 0:73bfbf91b6e5 317 command[1] = 'm'; //FAT Image
JLS 0:73bfbf91b6e5 318 for(int i=0;Filename[i]!=0x00;i++){
JLS 0:73bfbf91b6e5 319 command[i+2] = Filename[i];
JLS 0:73bfbf91b6e5 320 Lgt = i;
JLS 0:73bfbf91b6e5 321 }
JLS 0:73bfbf91b6e5 322 command[Lgt+3] = '.'; //.
JLS 0:73bfbf91b6e5 323 command[Lgt+4] = 'G'; //G
JLS 0:73bfbf91b6e5 324 command[Lgt+5] = 'C'; //C
JLS 0:73bfbf91b6e5 325 command[Lgt+6] = 'I'; //I
JLS 0:73bfbf91b6e5 326 command[Lgt+7] = 0x00; //Terminator
JLS 0:73bfbf91b6e5 327 command[Lgt+8] = X_MSB; //X-Position MSB
JLS 0:73bfbf91b6e5 328 command[Lgt+9] = X_LSB; //X-Position LSB
JLS 0:73bfbf91b6e5 329 command[Lgt+10] = Y_MSB; //Y-Position MSB
JLS 0:73bfbf91b6e5 330 command[Lgt+11] = Y_LSB; //Y-Position LSB
JLS 0:73bfbf91b6e5 331 command[Lgt+12] = S0; //Sector Address 4 bytes
JLS 0:73bfbf91b6e5 332 command[Lgt+13] = S1;
JLS 0:73bfbf91b6e5 333 command[Lgt+14] = S2;
JLS 0:73bfbf91b6e5 334 command[Lgt+15] = S3;
JLS 0:73bfbf91b6e5 335
JLS 0:73bfbf91b6e5 336 writeCOMMAND(command, Lgt+16);
JLS 0:73bfbf91b6e5 337 }
JLS 0:73bfbf91b6e5 338
JLS 0:73bfbf91b6e5 339 //****************************************************************************************************
JLS 0:73bfbf91b6e5 340 // This displays an image on the screen in the NEW FORMAT
JLS 0:73bfbf91b6e5 341 // Sent X-pos, Y-pos, Sector Address - This is the recommended way to display images
JLS 0:73bfbf91b6e5 342 //****************************************************************************************************
JLS 0:73bfbf91b6e5 343 void TFT_4DGL :: uSD_Image(int x, int y, long s) {
JLS 0:73bfbf91b6e5 344 char S1, S2, S3;
JLS 0:73bfbf91b6e5 345 char X_MSB, X_LSB, Y_MSB, Y_LSB;
JLS 0:73bfbf91b6e5 346 char command[9]= "";
JLS 0:73bfbf91b6e5 347
JLS 0:73bfbf91b6e5 348 X_LSB = x&0x00FF; //Work out the x position
JLS 0:73bfbf91b6e5 349 X_MSB = (x >> 8);
JLS 0:73bfbf91b6e5 350 Y_LSB = y&0x00FF; //Work out the y position
JLS 0:73bfbf91b6e5 351 Y_MSB = (y >> 8);
JLS 0:73bfbf91b6e5 352
JLS 0:73bfbf91b6e5 353 S1 = (s >> 16)&0x0000FF; //Work out the sector address
JLS 0:73bfbf91b6e5 354 S2 = (s >> 8)&0x0000FF;
JLS 0:73bfbf91b6e5 355 S3 = s&0x0000FF;
JLS 0:73bfbf91b6e5 356
JLS 0:73bfbf91b6e5 357 command[0] = 0x40; //ext_cmd
JLS 0:73bfbf91b6e5 358 command[1] = 0x49; //Display image
JLS 0:73bfbf91b6e5 359 command[2] = X_MSB; //X position - 2 bytes
JLS 0:73bfbf91b6e5 360 command[3] = X_LSB;
JLS 0:73bfbf91b6e5 361 command[4] = Y_MSB; //Y position - 2 bytes
JLS 0:73bfbf91b6e5 362 command[5] = Y_LSB;
JLS 0:73bfbf91b6e5 363 command[6] = S1; //Sector address - 3 bytes
JLS 0:73bfbf91b6e5 364 command[7] = S2;
JLS 0:73bfbf91b6e5 365 command[8] = S3;
JLS 0:73bfbf91b6e5 366
JLS 0:73bfbf91b6e5 367 writeCOMMAND(command, 9);
JLS 0:73bfbf91b6e5 368 }
JLS 0:73bfbf91b6e5 369
JLS 0:73bfbf91b6e5 370 //****************************************************************************************************
JLS 0:73bfbf91b6e5 371 // This displays an video on the screen in the NEW FORMAT
JLS 0:73bfbf91b6e5 372 // Sent X-pos, Y-pos, Sector Address - This is the recommended way to display video
JLS 0:73bfbf91b6e5 373 //****************************************************************************************************
JLS 0:73bfbf91b6e5 374 void TFT_4DGL :: uSD_Video(int x, int y, long s) {
JLS 0:73bfbf91b6e5 375 char S1, S2, S3;
JLS 0:73bfbf91b6e5 376 char X_MSB, X_LSB, Y_MSB, Y_LSB;
JLS 0:73bfbf91b6e5 377 char command[10]= "";
JLS 0:73bfbf91b6e5 378
JLS 0:73bfbf91b6e5 379 X_LSB = x&0x00FF;
JLS 0:73bfbf91b6e5 380 X_MSB = (x >> 8);
JLS 0:73bfbf91b6e5 381 Y_LSB = y&0x00FF;
JLS 0:73bfbf91b6e5 382 Y_MSB = (y >> 8);
JLS 0:73bfbf91b6e5 383
JLS 0:73bfbf91b6e5 384 S1 = (s >> 16)&0x0000FF;
JLS 0:73bfbf91b6e5 385 S2 = (s >> 8)&0x0000FF;
JLS 0:73bfbf91b6e5 386 S3 = s&0x0000FF;
JLS 0:73bfbf91b6e5 387
JLS 0:73bfbf91b6e5 388 command[0] = 0x40; //ext_cmd
JLS 0:73bfbf91b6e5 389 command[1] = 0x56; //Display video
JLS 0:73bfbf91b6e5 390 command[2] = X_MSB; //X position - 2 bytes
JLS 0:73bfbf91b6e5 391 command[3] = X_LSB;
JLS 0:73bfbf91b6e5 392 command[4] = Y_MSB; //Y position - 2 bytes
JLS 0:73bfbf91b6e5 393 command[5] = Y_LSB;
JLS 0:73bfbf91b6e5 394 command[6] = 0x00; //delay between frames
JLS 0:73bfbf91b6e5 395 command[7] = S1; //Sector address - 3 bytes
JLS 0:73bfbf91b6e5 396 command[8] = S2;
JLS 0:73bfbf91b6e5 397 command[9] = S3;
JLS 0:73bfbf91b6e5 398
JLS 0:73bfbf91b6e5 399 writeCOMMAND(command, 10);
JLS 0:73bfbf91b6e5 400 }