1.44 tft lcd display

Dependencies:   TFT_fonts mbed-os

Fork of newTFTLCD by madhu sudhana

Committer:
ttodorov
Date:
Sat Jan 26 04:36:46 2013 +0000
Revision:
22:4c169297f374
Parent:
20:4bdca8d8dadc
- added PWM backlight control

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 }