Carlos Silva / 24_TFT_STMNUCLEO

Code to run the cheap 2.4" TFT made by mcufriend.com on the STM nucleo. No modifications required, this plugs into the arduino header.

Dependents:   ST7735_V2_STM32F407

Fork of TFTLCD_8bit by Thiha Electronics

ssd1289.cpp@20:4bdca8d8dadc, 2012-12-21 (annotated)

Committer:
ttodorov
Date:
Fri Dec 21 06:05:15 2012 +0000
Revision:
20:4bdca8d8dadc
Parent:
18:b934d95cc380
Child:
22:4c169297f374
- changed internals of SetPixelColor to allow more general and simple implementation of the bitmap drawing functions

Who changed what in which revision?

UserRevisionLine numberNew contents of line
ttodorov 0:881ff0b71102 1 /*
ttodorov 0:881ff0b71102 2 * Copyright (C)2010-2012 Henning Karlsen. All right reserved.
ttodorov 0:881ff0b71102 3 * Copyright (C)2012 Todor Todorov.
ttodorov 0:881ff0b71102 4 *
ttodorov 0:881ff0b71102 5 * This library is free software; you can redistribute it and/or
ttodorov 0:881ff0b71102 6 * modify it under the terms of the GNU Lesser General Public
ttodorov 0:881ff0b71102 7 * License as published by the Free Software Foundation; either
ttodorov 0:881ff0b71102 8 * version 2.1 of the License, or (at your option) any later version.
ttodorov 0:881ff0b71102 9 *
ttodorov 0:881ff0b71102 10 * This library is distributed in the hope that it will be useful,
ttodorov 0:881ff0b71102 11 * but WITHOUT ANY WARRANTY; without even the implied warranty of
ttodorov 0:881ff0b71102 12 * MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE. See the GNU
ttodorov 0:881ff0b71102 13 * Lesser General Public License for more details.
ttodorov 0:881ff0b71102 14 *
ttodorov 0:881ff0b71102 15 * You should have received a copy of the GNU Lesser General Public
ttodorov 0:881ff0b71102 16 * License along with this library; if not, write to:
ttodorov 0:881ff0b71102 17 *
ttodorov 0:881ff0b71102 18 * Free Software Foundation, Inc.
ttodorov 0:881ff0b71102 19 * 51 Franklin St, 5th Floor, Boston, MA 02110-1301, USA
ttodorov 0:881ff0b71102 20 *
ttodorov 0:881ff0b71102 21 *********************************************************************/
ttodorov 3:64a5b67d5b51 22 #include "ssd1289.h"
ttodorov 3:64a5b67d5b51 23 #include "helpers.h"
ttodorov 0:881ff0b71102 24
ttodorov 4:3ac4239f6c9c 25 SSD1289_LCD::SSD1289_LCD( PinName CS, PinName RESET, PinName RS, PinName WR, BusOut* DATA_PORT, PinName BL, PinName RD )
ttodorov 4:3ac4239f6c9c 26 : LCD( 240, 320, CS, RS, RESET ), _lcd_pin_wr( WR )
ttodorov 0:881ff0b71102 27 {
ttodorov 0:881ff0b71102 28 _lcd_port = DATA_PORT;
ttodorov 4:3ac4239f6c9c 29 if ( BL != NC ) _lcd_pin_bl = new DigitalOut( BL );
ttodorov 4:3ac4239f6c9c 30 else _lcd_pin_bl = 0;
ttodorov 4:3ac4239f6c9c 31 if ( RD != NC ) _lcd_pin_rd = new DigitalOut( RD );
ttodorov 4:3ac4239f6c9c 32 else _lcd_pin_rd = 0;
ttodorov 0:881ff0b71102 33 }
ttodorov 0:881ff0b71102 34
ttodorov 12:d0978272a340 35 void SSD1289_LCD::Initialize( orientation_t orientation, colordepth_t colors )
ttodorov 0:881ff0b71102 36 {
ttodorov 0:881ff0b71102 37 _orientation = orientation;
ttodorov 15:af3cd35886fb 38 _colorDepth = colors;
ttodorov 0:881ff0b71102 39
ttodorov 0:881ff0b71102 40 _lcd_pin_reset = HIGH;
ttodorov 0:881ff0b71102 41 wait_ms( 5 );
ttodorov 0:881ff0b71102 42 _lcd_pin_reset = LOW;
ttodorov 0:881ff0b71102 43 wait_ms( 15 );
ttodorov 0:881ff0b71102 44 _lcd_pin_reset = HIGH;
ttodorov 0:881ff0b71102 45 _lcd_pin_cs = HIGH;
ttodorov 4:3ac4239f6c9c 46 if ( _lcd_pin_bl != 0 )
ttodorov 4:3ac4239f6c9c 47 *_lcd_pin_bl = HIGH;
ttodorov 0:881ff0b71102 48 if ( _lcd_pin_rd != 0 )
ttodorov 0:881ff0b71102 49 *_lcd_pin_rd = HIGH;
ttodorov 0:881ff0b71102 50 _lcd_pin_wr = HIGH;
ttodorov 0:881ff0b71102 51 wait_ms( 15 );
ttodorov 0:881ff0b71102 52
ttodorov 4:3ac4239f6c9c 53 Activate();
ttodorov 15:af3cd35886fb 54 WriteCmdData( 0x00, 0x0001 ); // oscillator: 1 = on, 0 = off
ttodorov 15:af3cd35886fb 55 wait_ms( 1 );
ttodorov 15:af3cd35886fb 56 WriteCmdData( 0x03, 0xA8A4 ); // power control
ttodorov 15:af3cd35886fb 57 wait_ms( 1 );
ttodorov 15:af3cd35886fb 58 WriteCmdData( 0x0C, 0x0000 ); // power control 2
ttodorov 15:af3cd35886fb 59 wait_ms( 1 );
ttodorov 15:af3cd35886fb 60 WriteCmdData( 0x0D, 0x080C ); // power control 3
ttodorov 15:af3cd35886fb 61 wait_ms( 1 );
ttodorov 15:af3cd35886fb 62 WriteCmdData( 0x0E, 0x2B00 ); // power control 4
ttodorov 15:af3cd35886fb 63 wait_ms( 1 );
ttodorov 15:af3cd35886fb 64 WriteCmdData( 0x1E, 0x00B7 ); // power control 5
ttodorov 15:af3cd35886fb 65 wait_ms( 1 );
ttodorov 15:af3cd35886fb 66 WriteCmdData( 0x02, 0x0600 ); // driving waveform control
ttodorov 15:af3cd35886fb 67 wait_ms( 1 );
ttodorov 15:af3cd35886fb 68 WriteCmdData( 0x10, 0x0000 ); // sleep mode: 0 = exit, 1 = enter
ttodorov 15:af3cd35886fb 69 wait_ms( 1 );
ttodorov 15:af3cd35886fb 70 if ( _colorDepth == RGB16 )
ttodorov 15:af3cd35886fb 71 {
ttodorov 15:af3cd35886fb 72 switch ( _orientation )
ttodorov 15:af3cd35886fb 73 {
ttodorov 18:b934d95cc380 74 case LANDSCAPE: // works
ttodorov 18:b934d95cc380 75 WriteCmdData( 0x01, 0x293F ); // driver output control
ttodorov 16:4ccc2fa2cfec 76 wait_ms( 1 );
ttodorov 18:b934d95cc380 77 WriteCmdData( 0x11, 0x6078 ); // entry mode
ttodorov 15:af3cd35886fb 78 break;
ttodorov 16:4ccc2fa2cfec 79
ttodorov 17:866f2a851dd7 80 case PORTRAIT_REV: // works
ttodorov 16:4ccc2fa2cfec 81 WriteCmdData( 0x01, 0x693F ); // driver output control
ttodorov 16:4ccc2fa2cfec 82 wait_ms( 1 );
ttodorov 16:4ccc2fa2cfec 83 WriteCmdData( 0x11, 0x6070 ); // entry mode
ttodorov 15:af3cd35886fb 84 break;
ttodorov 16:4ccc2fa2cfec 85
ttodorov 18:b934d95cc380 86 case LANDSCAPE_REV: // works
ttodorov 18:b934d95cc380 87 WriteCmdData( 0x01, 0x6B3F ); // driver output control
ttodorov 18:b934d95cc380 88 wait_ms( 1 );
ttodorov 18:b934d95cc380 89 WriteCmdData( 0x11, 0x6078 ); // entry mode
ttodorov 15:af3cd35886fb 90 break;
ttodorov 16:4ccc2fa2cfec 91
ttodorov 17:866f2a851dd7 92 case PORTRAIT: // works
ttodorov 15:af3cd35886fb 93 default:
ttodorov 16:4ccc2fa2cfec 94 WriteCmdData( 0x01, 0x2B3F ); // driver output control
ttodorov 16:4ccc2fa2cfec 95 wait_ms( 1 );
ttodorov 16:4ccc2fa2cfec 96 WriteCmdData( 0x11, 0x6070 ); // entry mode
ttodorov 15:af3cd35886fb 97 break;
ttodorov 15:af3cd35886fb 98 }
ttodorov 15:af3cd35886fb 99 }
ttodorov 15:af3cd35886fb 100 else if ( _colorDepth == RGB18 )
ttodorov 15:af3cd35886fb 101 {
ttodorov 15:af3cd35886fb 102 switch ( _orientation )
ttodorov 15:af3cd35886fb 103 {
ttodorov 18:b934d95cc380 104 case LANDSCAPE: // works
ttodorov 18:b934d95cc380 105 WriteCmdData( 0x01, 0x293F ); // driver output control
ttodorov 16:4ccc2fa2cfec 106 wait_ms( 1 );
ttodorov 18:b934d95cc380 107 WriteCmdData( 0x11, 0x4078 ); // entry mode
ttodorov 15:af3cd35886fb 108 break;
ttodorov 16:4ccc2fa2cfec 109
ttodorov 17:866f2a851dd7 110 case PORTRAIT_REV: // works
ttodorov 16:4ccc2fa2cfec 111 WriteCmdData( 0x01, 0x693F ); // driver output control
ttodorov 16:4ccc2fa2cfec 112 wait_ms( 1 );
ttodorov 16:4ccc2fa2cfec 113 WriteCmdData( 0x11, 0x4070 ); // entry mode
ttodorov 15:af3cd35886fb 114 break;
ttodorov 16:4ccc2fa2cfec 115
ttodorov 18:b934d95cc380 116 case LANDSCAPE_REV: // works
ttodorov 18:b934d95cc380 117 WriteCmdData( 0x01, 0x6B3F ); // driver output control
ttodorov 18:b934d95cc380 118 wait_ms( 1 );
ttodorov 18:b934d95cc380 119 WriteCmdData( 0x11, 0x4078 ); // entry mode
ttodorov 15:af3cd35886fb 120 break;
ttodorov 16:4ccc2fa2cfec 121
ttodorov 17:866f2a851dd7 122 case PORTRAIT: // works
ttodorov 15:af3cd35886fb 123 default:
ttodorov 16:4ccc2fa2cfec 124 WriteCmdData( 0x01, 0x2B3F ); // driver output control
ttodorov 16:4ccc2fa2cfec 125 wait_ms( 1 );
ttodorov 16:4ccc2fa2cfec 126 WriteCmdData( 0x11, 0x4070 ); // entry mode
ttodorov 15:af3cd35886fb 127 break;
ttodorov 15:af3cd35886fb 128 }
ttodorov 15:af3cd35886fb 129 }
ttodorov 15:af3cd35886fb 130 wait_ms( 1 );
ttodorov 15:af3cd35886fb 131 WriteCmdData( 0x05, 0x0000 ); // compare register
ttodorov 15:af3cd35886fb 132 wait_ms( 1 );
ttodorov 15:af3cd35886fb 133 WriteCmdData( 0x06, 0x0000 ); // compare register
ttodorov 15:af3cd35886fb 134 wait_ms( 1 );
ttodorov 15:af3cd35886fb 135 WriteCmdData( 0x16, 0xEF1C ); // horizontal porch
ttodorov 15:af3cd35886fb 136 wait_ms( 1 );
ttodorov 15:af3cd35886fb 137 WriteCmdData( 0x17, 0x0003 ); // vertical porch
ttodorov 15:af3cd35886fb 138 wait_ms( 1 );
ttodorov 15:af3cd35886fb 139 WriteCmdData( 0x07, 0x0233 ); // display control
ttodorov 15:af3cd35886fb 140 wait_ms( 1 );
ttodorov 15:af3cd35886fb 141 WriteCmdData( 0x0B, 0x0000 ); // frame cycle control
ttodorov 15:af3cd35886fb 142 wait_ms( 1 );
ttodorov 15:af3cd35886fb 143 WriteCmdData( 0x0F, 0x0000 ); // gate scan position
ttodorov 15:af3cd35886fb 144 wait_ms( 1 );
ttodorov 15:af3cd35886fb 145 WriteCmdData( 0x41, 0x0000 ); // vertical scroll control
ttodorov 15:af3cd35886fb 146 wait_ms( 1 );
ttodorov 15:af3cd35886fb 147 WriteCmdData( 0x42, 0x0000 ); // vertical scroll control
ttodorov 15:af3cd35886fb 148 wait_ms( 1 );
ttodorov 15:af3cd35886fb 149 WriteCmdData( 0x48, 0x0000 ); // 1st screen driving position
ttodorov 15:af3cd35886fb 150 wait_ms( 1 );
ttodorov 15:af3cd35886fb 151 WriteCmdData( 0x49, 0x013F ); // 1st screen driving position
ttodorov 15:af3cd35886fb 152 wait_ms( 1 );
ttodorov 15:af3cd35886fb 153 WriteCmdData( 0x4A, 0x0000 ); // 2nd screen driving position
ttodorov 15:af3cd35886fb 154 wait_ms( 1 );
ttodorov 15:af3cd35886fb 155 WriteCmdData( 0x4B, 0x0000 ); // 2nd screen driving position
ttodorov 15:af3cd35886fb 156 wait_ms( 1 );
ttodorov 15:af3cd35886fb 157 WriteCmdData( 0x44, 0xEF00 ); // horizontal ram address position
ttodorov 15:af3cd35886fb 158 wait_ms( 1 );
ttodorov 15:af3cd35886fb 159 WriteCmdData( 0x45, 0x0000 ); // vertical ram address position
ttodorov 15:af3cd35886fb 160 wait_ms( 1 );
ttodorov 15:af3cd35886fb 161 WriteCmdData( 0x46, 0x013F ); // vertical ram address position
ttodorov 15:af3cd35886fb 162 wait_ms( 1 );
ttodorov 15:af3cd35886fb 163 WriteCmdData( 0x30, 0x0707 ); // gamma control
ttodorov 15:af3cd35886fb 164 wait_ms( 1 );
ttodorov 15:af3cd35886fb 165 WriteCmdData( 0x31, 0x0204 ); // gamma control
ttodorov 15:af3cd35886fb 166 wait_ms( 1 );
ttodorov 15:af3cd35886fb 167 WriteCmdData( 0x32, 0x0204 ); // gamma control
ttodorov 15:af3cd35886fb 168 wait_ms( 1 );
ttodorov 15:af3cd35886fb 169 WriteCmdData( 0x33, 0x0502 ); // gamma control
ttodorov 15:af3cd35886fb 170 wait_ms( 1 );
ttodorov 15:af3cd35886fb 171 WriteCmdData( 0x34, 0x0507 ); // gamma control
ttodorov 15:af3cd35886fb 172 wait_ms( 1 );
ttodorov 15:af3cd35886fb 173 WriteCmdData( 0x35, 0x0204 ); // gamma control
ttodorov 15:af3cd35886fb 174 wait_ms( 1 );
ttodorov 15:af3cd35886fb 175 WriteCmdData( 0x36, 0x0204 ); // gamma control
ttodorov 15:af3cd35886fb 176 wait_ms( 1 );
ttodorov 15:af3cd35886fb 177 WriteCmdData( 0x37, 0x0502 ); // gamma control
ttodorov 15:af3cd35886fb 178 wait_ms( 1 );
ttodorov 15:af3cd35886fb 179 WriteCmdData( 0x3A, 0x0302 ); // gamma control
ttodorov 15:af3cd35886fb 180 wait_ms( 1 );
ttodorov 15:af3cd35886fb 181 WriteCmdData( 0x3B, 0x0302 ); // gamma control
ttodorov 15:af3cd35886fb 182 wait_ms( 1 );
ttodorov 15:af3cd35886fb 183 WriteCmdData( 0x23, 0x0000 ); // GRAM write mask for red and green pins
ttodorov 15:af3cd35886fb 184 wait_ms( 1 );
ttodorov 15:af3cd35886fb 185 WriteCmdData( 0x24, 0x0000 ); // GRAM write mask for blue pins
ttodorov 15:af3cd35886fb 186 wait_ms( 1 );
ttodorov 15:af3cd35886fb 187 WriteCmdData( 0x25, 0x8000 ); // frame frequency control
ttodorov 15:af3cd35886fb 188 wait_ms( 1 );
ttodorov 15:af3cd35886fb 189 WriteCmdData( 0x4e, 0x0000 ); // ram address set
ttodorov 15:af3cd35886fb 190 wait_ms( 1 );
ttodorov 15:af3cd35886fb 191 WriteCmdData( 0x4f, 0x0000 ); // ram address set
ttodorov 15:af3cd35886fb 192 wait_ms( 1 );
ttodorov 15:af3cd35886fb 193 WriteCmd( 0x22 ); // write GRAM
ttodorov 4:3ac4239f6c9c 194 Deactivate();
ttodorov 0:881ff0b71102 195 }
ttodorov 0:881ff0b71102 196
ttodorov 4:3ac4239f6c9c 197 void SSD1289_LCD::Sleep( void )
ttodorov 0:881ff0b71102 198 {
ttodorov 18:b934d95cc380 199 WriteCmdData( 0x10, 0x0001 ); // sleep mode: 0 = exit, 1 = enter
ttodorov 4:3ac4239f6c9c 200 if ( _lcd_pin_bl != 0 )
ttodorov 4:3ac4239f6c9c 201 *_lcd_pin_bl = LOW;
ttodorov 0:881ff0b71102 202 }
ttodorov 0:881ff0b71102 203
ttodorov 4:3ac4239f6c9c 204 void SSD1289_LCD::WakeUp( void )
ttodorov 4:3ac4239f6c9c 205 {
ttodorov 18:b934d95cc380 206 WriteCmdData( 0x10, 0x0000 ); // sleep mode: 0 = exit, 1 = enter
ttodorov 4:3ac4239f6c9c 207 if ( _lcd_pin_bl != 0 )
ttodorov 4:3ac4239f6c9c 208 *_lcd_pin_bl = HIGH;
ttodorov 4:3ac4239f6c9c 209 }
ttodorov 4:3ac4239f6c9c 210
ttodorov 4:3ac4239f6c9c 211 void SSD1289_LCD::WriteCmd( unsigned short cmd )
ttodorov 4:3ac4239f6c9c 212 {
ttodorov 4:3ac4239f6c9c 213 _lcd_pin_rs = LOW;
ttodorov 4:3ac4239f6c9c 214 _lcd_port->write( cmd );
ttodorov 4:3ac4239f6c9c 215 pulseLow( _lcd_pin_wr );
ttodorov 4:3ac4239f6c9c 216 }
ttodorov 4:3ac4239f6c9c 217
ttodorov 4:3ac4239f6c9c 218 void SSD1289_LCD::WriteData( unsigned short data )
ttodorov 0:881ff0b71102 219 {
ttodorov 0:881ff0b71102 220 _lcd_pin_rs = HIGH;
ttodorov 0:881ff0b71102 221 _lcd_port->write( data );
ttodorov 0:881ff0b71102 222 pulseLow( _lcd_pin_wr );
ttodorov 0:881ff0b71102 223 }
ttodorov 0:881ff0b71102 224
ttodorov 20:4bdca8d8dadc 225 void SSD1289_LCD::SetXY( unsigned short x1, unsigned short y1, unsigned short x2, unsigned short y2 )
ttodorov 0:881ff0b71102 226 {
ttodorov 18:b934d95cc380 227 if ( _orientation == PORTRAIT || _orientation == PORTRAIT_REV )
ttodorov 18:b934d95cc380 228 {
ttodorov 18:b934d95cc380 229 WriteCmdData( 0x44, ( x2 << 8 ) + x1 );
ttodorov 18:b934d95cc380 230 WriteCmdData( 0x45, y1 );
ttodorov 18:b934d95cc380 231 WriteCmdData( 0x46, y2 );
ttodorov 18:b934d95cc380 232 WriteCmdData( 0x4e, x1 );
ttodorov 18:b934d95cc380 233 WriteCmdData( 0x4f, y1 );
ttodorov 18:b934d95cc380 234 }
ttodorov 18:b934d95cc380 235 else
ttodorov 18:b934d95cc380 236 {
ttodorov 18:b934d95cc380 237 WriteCmdData( 0x44, ( y2 << 8 ) + y1 );
ttodorov 18:b934d95cc380 238 WriteCmdData( 0x45, x1 );
ttodorov 18:b934d95cc380 239 WriteCmdData( 0x46, x2 );
ttodorov 18:b934d95cc380 240 WriteCmdData( 0x4e, y1 );
ttodorov 18:b934d95cc380 241 WriteCmdData( 0x4f, x1 );
ttodorov 18:b934d95cc380 242 }
ttodorov 2:81ed304b7e9b 243 WriteCmd( 0x22 );
ttodorov 0:881ff0b71102 244 }
ttodorov 10:69571adcfad5 245
ttodorov 20:4bdca8d8dadc 246 void SSD1289_LCD::SetPixelColor( unsigned int color, colordepth_t mode )
ttodorov 10:69571adcfad5 247 {
ttodorov 12:d0978272a340 248 unsigned char r, g, b;
ttodorov 16:4ccc2fa2cfec 249 unsigned short clr;
ttodorov 15:af3cd35886fb 250 if ( _colorDepth == RGB16 )
ttodorov 15:af3cd35886fb 251 {
ttodorov 20:4bdca8d8dadc 252 switch ( mode )
ttodorov 20:4bdca8d8dadc 253 {
ttodorov 20:4bdca8d8dadc 254 case RGB16:
ttodorov 20:4bdca8d8dadc 255 WriteData( color & 0xFFFF );
ttodorov 20:4bdca8d8dadc 256 break;
ttodorov 20:4bdca8d8dadc 257 case RGB18:
ttodorov 20:4bdca8d8dadc 258 r = ( color >> 10 ) & 0xF8;
ttodorov 20:4bdca8d8dadc 259 g = ( color >> 4 ) & 0xFC;
ttodorov 20:4bdca8d8dadc 260 b = ( color >> 1 ) & 0x1F;
ttodorov 20:4bdca8d8dadc 261 clr = ( ( r | ( g >> 5 ) ) << 8 ) | ( ( g << 3 ) | b );
ttodorov 20:4bdca8d8dadc 262 WriteData( clr );
ttodorov 20:4bdca8d8dadc 263 break;
ttodorov 20:4bdca8d8dadc 264 case RGB24:
ttodorov 20:4bdca8d8dadc 265 r = ( color >> 16 ) & 0xF8;
ttodorov 20:4bdca8d8dadc 266 g = ( color >> 8 ) & 0xFC;
ttodorov 20:4bdca8d8dadc 267 b = color & 0xF8;
ttodorov 20:4bdca8d8dadc 268 clr = ( ( r | ( g >> 5 ) ) << 8 ) | ( ( g << 3 ) | ( b >> 3 ) );
ttodorov 20:4bdca8d8dadc 269 WriteData( clr );
ttodorov 20:4bdca8d8dadc 270 break;
ttodorov 20:4bdca8d8dadc 271 }
ttodorov 15:af3cd35886fb 272 }
ttodorov 15:af3cd35886fb 273 else if ( _colorDepth == RGB18 )
ttodorov 15:af3cd35886fb 274 {
ttodorov 20:4bdca8d8dadc 275 switch ( mode )
ttodorov 20:4bdca8d8dadc 276 {
ttodorov 20:4bdca8d8dadc 277 case RGB16:
ttodorov 20:4bdca8d8dadc 278 r = ( ( color >> 8 ) & 0xF8 ) | ( ( color & 0x8000 ) >> 13 );
ttodorov 20:4bdca8d8dadc 279 g = ( color >> 3 ) & 0xFC;
ttodorov 20:4bdca8d8dadc 280 b = ( ( color << 3 ) & 0xFC ) | ( ( color >> 3 ) & 0x01 );
ttodorov 20:4bdca8d8dadc 281 WriteData( ( r << 8 ) | g );
ttodorov 20:4bdca8d8dadc 282 WriteData( b );
ttodorov 20:4bdca8d8dadc 283 break;
ttodorov 20:4bdca8d8dadc 284 case RGB18:
ttodorov 20:4bdca8d8dadc 285 b = ( color << 2 ) & 0xFC;
ttodorov 20:4bdca8d8dadc 286 g = ( color >> 4 ) & 0xFC;
ttodorov 20:4bdca8d8dadc 287 r = ( color >> 10 ) & 0xFC;
ttodorov 20:4bdca8d8dadc 288 WriteData( ( r << 8 ) | g );
ttodorov 20:4bdca8d8dadc 289 WriteData( b );
ttodorov 20:4bdca8d8dadc 290 break;
ttodorov 20:4bdca8d8dadc 291 case RGB24:
ttodorov 20:4bdca8d8dadc 292 r = ( color >> 16 ) & 0xFC;
ttodorov 20:4bdca8d8dadc 293 g = ( color >> 8 ) & 0xFC;
ttodorov 20:4bdca8d8dadc 294 b = color & 0xFC;
ttodorov 20:4bdca8d8dadc 295 WriteData( ( r << 8 ) | g );
ttodorov 20:4bdca8d8dadc 296 WriteData( b );
ttodorov 20:4bdca8d8dadc 297 break;
ttodorov 20:4bdca8d8dadc 298 }
ttodorov 15:af3cd35886fb 299 }
ttodorov 10:69571adcfad5 300 }