1.44 tft lcd display
Dependencies: TFT_fonts mbed-os
Fork of newTFTLCD by
ssd1289.cpp@22:4c169297f374, 2013-01-26 (annotated)
- 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?
User | Revision | Line number | New 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 | } |