Steffen Arntz / TFTLCD

This is a port of Henning Kralsen's UTFT library for Arduino/chipKIT to mbed, refactored to make full use of C inheritance and access control, in order to reduce work when implementing new drivers and at the same time make the code more readable and easier to maintain. As of now supported are SSD1289 (16-bit interface), HX8340-B (serial interface) and ST7735 (serial interface). Drivers for other controllers will be added as time and resources to acquire the displays to test the code permit.

Dependents:   UTFT_SSD1289

Fork of TFTLCD by Todor Todorov

ssd1289.cpp@28:89a1399409ff, 2016-02-16 (annotated)

Committer:
DooMMasteR
Date:
Tue Feb 16 19:09:15 2016 +0000
Revision:
28:89a1399409ff
Parent:
22:4c169297f374 
make size of the ST7735 variable, while not breaking old functionality;

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 22:4c169297f374 25 SSD1289_LCD::SSD1289_LCD( PinName CS, PinName RESET, PinName RS, PinName WR, BusOut* DATA_PORT, PinName BL, PinName RD, backlight_t blType, float defaultBackLightLevel )
ttodorov 22:4c169297f374 26 : LCD( 240, 320, CS, RS, RESET, BL, blType, defaultBackLightLevel ), _lcd_pin_wr( WR )
ttodorov 0:881ff0b71102 27 {
ttodorov 0:881ff0b71102 28 _lcd_port = DATA_PORT;
ttodorov 4:3ac4239f6c9c 29 if ( RD != NC ) _lcd_pin_rd = new DigitalOut( RD );
ttodorov 4:3ac4239f6c9c 30 else _lcd_pin_rd = 0;
ttodorov 0:881ff0b71102 31 }
ttodorov 0:881ff0b71102 32
ttodorov 12:d0978272a340 33 void SSD1289_LCD::Initialize( orientation_t orientation, colordepth_t colors )
ttodorov 0:881ff0b71102 34 {
ttodorov 0:881ff0b71102 35 _orientation = orientation;
ttodorov 15:af3cd35886fb 36 _colorDepth = colors;
ttodorov 0:881ff0b71102 37
ttodorov 0:881ff0b71102 38 _lcd_pin_reset = HIGH;
ttodorov 0:881ff0b71102 39 wait_ms( 5 );
ttodorov 0:881ff0b71102 40 _lcd_pin_reset = LOW;
ttodorov 0:881ff0b71102 41 wait_ms( 15 );
ttodorov 0:881ff0b71102 42 _lcd_pin_reset = HIGH;
ttodorov 0:881ff0b71102 43 _lcd_pin_cs = HIGH;
ttodorov 4:3ac4239f6c9c 44 if ( _lcd_pin_bl != 0 )
ttodorov 4:3ac4239f6c9c 45 *_lcd_pin_bl = HIGH;
ttodorov 22:4c169297f374 46 else if ( _bl_pwm != 0 )
ttodorov 22:4c169297f374 47 *_bl_pwm = _bl_pwm_default;
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 22:4c169297f374 200 LCD::Sleep();
ttodorov 0:881ff0b71102 201 }
ttodorov 0:881ff0b71102 202
ttodorov 4:3ac4239f6c9c 203 void SSD1289_LCD::WakeUp( void )
ttodorov 4:3ac4239f6c9c 204 {
ttodorov 18:b934d95cc380 205 WriteCmdData( 0x10, 0x0000 ); // sleep mode: 0 = exit, 1 = enter
ttodorov 22:4c169297f374 206 LCD::WakeUp();
ttodorov 4:3ac4239f6c9c 207 }
ttodorov 4:3ac4239f6c9c 208
ttodorov 4:3ac4239f6c9c 209 void SSD1289_LCD::WriteCmd( unsigned short cmd )
ttodorov 4:3ac4239f6c9c 210 {
ttodorov 4:3ac4239f6c9c 211 _lcd_pin_rs = LOW;
ttodorov 4:3ac4239f6c9c 212 _lcd_port->write( cmd );
ttodorov 4:3ac4239f6c9c 213 pulseLow( _lcd_pin_wr );
ttodorov 4:3ac4239f6c9c 214 }
ttodorov 4:3ac4239f6c9c 215
ttodorov 4:3ac4239f6c9c 216 void SSD1289_LCD::WriteData( unsigned short data )
ttodorov 0:881ff0b71102 217 {
ttodorov 0:881ff0b71102 218 _lcd_pin_rs = HIGH;
ttodorov 0:881ff0b71102 219 _lcd_port->write( data );
ttodorov 0:881ff0b71102 220 pulseLow( _lcd_pin_wr );
ttodorov 0:881ff0b71102 221 }
ttodorov 0:881ff0b71102 222
ttodorov 20:4bdca8d8dadc 223 void SSD1289_LCD::SetXY( unsigned short x1, unsigned short y1, unsigned short x2, unsigned short y2 )
ttodorov 0:881ff0b71102 224 {
ttodorov 18:b934d95cc380 225 if ( _orientation == PORTRAIT || _orientation == PORTRAIT_REV )
ttodorov 18:b934d95cc380 226 {
ttodorov 18:b934d95cc380 227 WriteCmdData( 0x44, ( x2 << 8 ) + x1 );
ttodorov 18:b934d95cc380 228 WriteCmdData( 0x45, y1 );
ttodorov 18:b934d95cc380 229 WriteCmdData( 0x46, y2 );
ttodorov 18:b934d95cc380 230 WriteCmdData( 0x4e, x1 );
ttodorov 18:b934d95cc380 231 WriteCmdData( 0x4f, y1 );
ttodorov 18:b934d95cc380 232 }
ttodorov 18:b934d95cc380 233 else
ttodorov 18:b934d95cc380 234 {
ttodorov 18:b934d95cc380 235 WriteCmdData( 0x44, ( y2 << 8 ) + y1 );
ttodorov 18:b934d95cc380 236 WriteCmdData( 0x45, x1 );
ttodorov 18:b934d95cc380 237 WriteCmdData( 0x46, x2 );
ttodorov 18:b934d95cc380 238 WriteCmdData( 0x4e, y1 );
ttodorov 18:b934d95cc380 239 WriteCmdData( 0x4f, x1 );
ttodorov 18:b934d95cc380 240 }
ttodorov 2:81ed304b7e9b 241 WriteCmd( 0x22 );
ttodorov 0:881ff0b71102 242 }
ttodorov 10:69571adcfad5 243
ttodorov 20:4bdca8d8dadc 244 void SSD1289_LCD::SetPixelColor( unsigned int color, colordepth_t mode )
ttodorov 10:69571adcfad5 245 {
ttodorov 12:d0978272a340 246 unsigned char r, g, b;
ttodorov 16:4ccc2fa2cfec 247 unsigned short clr;
ttodorov 15:af3cd35886fb 248 if ( _colorDepth == RGB16 )
ttodorov 15:af3cd35886fb 249 {
ttodorov 20:4bdca8d8dadc 250 switch ( mode )
ttodorov 20:4bdca8d8dadc 251 {
ttodorov 20:4bdca8d8dadc 252 case RGB16:
ttodorov 20:4bdca8d8dadc 253 WriteData( color & 0xFFFF );
ttodorov 20:4bdca8d8dadc 254 break;
ttodorov 20:4bdca8d8dadc 255 case RGB18:
ttodorov 20:4bdca8d8dadc 256 r = ( color >> 10 ) & 0xF8;
ttodorov 20:4bdca8d8dadc 257 g = ( color >> 4 ) & 0xFC;
ttodorov 20:4bdca8d8dadc 258 b = ( color >> 1 ) & 0x1F;
ttodorov 20:4bdca8d8dadc 259 clr = ( ( r | ( g >> 5 ) ) << 8 ) | ( ( g << 3 ) | b );
ttodorov 20:4bdca8d8dadc 260 WriteData( clr );
ttodorov 20:4bdca8d8dadc 261 break;
ttodorov 20:4bdca8d8dadc 262 case RGB24:
ttodorov 20:4bdca8d8dadc 263 r = ( color >> 16 ) & 0xF8;
ttodorov 20:4bdca8d8dadc 264 g = ( color >> 8 ) & 0xFC;
ttodorov 20:4bdca8d8dadc 265 b = color & 0xF8;
ttodorov 20:4bdca8d8dadc 266 clr = ( ( r | ( g >> 5 ) ) << 8 ) | ( ( g << 3 ) | ( b >> 3 ) );
ttodorov 20:4bdca8d8dadc 267 WriteData( clr );
ttodorov 20:4bdca8d8dadc 268 break;
ttodorov 20:4bdca8d8dadc 269 }
ttodorov 15:af3cd35886fb 270 }
ttodorov 15:af3cd35886fb 271 else if ( _colorDepth == RGB18 )
ttodorov 15:af3cd35886fb 272 {
ttodorov 20:4bdca8d8dadc 273 switch ( mode )
ttodorov 20:4bdca8d8dadc 274 {
ttodorov 20:4bdca8d8dadc 275 case RGB16:
ttodorov 20:4bdca8d8dadc 276 r = ( ( color >> 8 ) & 0xF8 ) | ( ( color & 0x8000 ) >> 13 );
ttodorov 20:4bdca8d8dadc 277 g = ( color >> 3 ) & 0xFC;
ttodorov 20:4bdca8d8dadc 278 b = ( ( color << 3 ) & 0xFC ) | ( ( color >> 3 ) & 0x01 );
ttodorov 20:4bdca8d8dadc 279 WriteData( ( r << 8 ) | g );
ttodorov 20:4bdca8d8dadc 280 WriteData( b );
ttodorov 20:4bdca8d8dadc 281 break;
ttodorov 20:4bdca8d8dadc 282 case RGB18:
ttodorov 20:4bdca8d8dadc 283 b = ( color << 2 ) & 0xFC;
ttodorov 20:4bdca8d8dadc 284 g = ( color >> 4 ) & 0xFC;
ttodorov 20:4bdca8d8dadc 285 r = ( color >> 10 ) & 0xFC;
ttodorov 20:4bdca8d8dadc 286 WriteData( ( r << 8 ) | g );
ttodorov 20:4bdca8d8dadc 287 WriteData( b );
ttodorov 20:4bdca8d8dadc 288 break;
ttodorov 20:4bdca8d8dadc 289 case RGB24:
ttodorov 20:4bdca8d8dadc 290 r = ( color >> 16 ) & 0xFC;
ttodorov 20:4bdca8d8dadc 291 g = ( color >> 8 ) & 0xFC;
ttodorov 20:4bdca8d8dadc 292 b = color & 0xFC;
ttodorov 20:4bdca8d8dadc 293 WriteData( ( r << 8 ) | g );
ttodorov 20:4bdca8d8dadc 294 WriteData( b );
ttodorov 20:4bdca8d8dadc 295 break;
ttodorov 20:4bdca8d8dadc 296 }
ttodorov 15:af3cd35886fb 297 }
ttodorov 10:69571adcfad5 298 }