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.
Fork of TFTLCD by
ssd1289.cpp@18:b934d95cc380, 2012-12-13 (annotated)
- Committer:
- ttodorov
- Date:
- Thu Dec 13 02:41:56 2012 +0000
- Revision:
- 18:b934d95cc380
- Parent:
- 17:866f2a851dd7
- Child:
- 20:4bdca8d8dadc
- fix LANDSCAPE and LANDSCAPE_REV modes for the SSD1289 driver
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 | 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 | 4:3ac4239f6c9c | 225 | void SSD1289_LCD::SetXY( uint16_t x1, uint16_t y1, uint16_t x2, uint16_t 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 | 12:d0978272a340 | 246 | void SSD1289_LCD::SetPixelColor( unsigned int color ) |
ttodorov | 10:69571adcfad5 | 247 | { |
ttodorov | 12:d0978272a340 | 248 | unsigned char r, g, b; |
ttodorov | 16:4ccc2fa2cfec | 249 | unsigned short clr; |
ttodorov | 12:d0978272a340 | 250 | r = ( color >> 16 ) & 0xFF; |
ttodorov | 12:d0978272a340 | 251 | g = ( color >> 8 ) & 0xFF; |
ttodorov | 12:d0978272a340 | 252 | b = color & 0xFF; |
ttodorov | 15:af3cd35886fb | 253 | if ( _colorDepth == RGB16 ) |
ttodorov | 15:af3cd35886fb | 254 | { |
ttodorov | 16:4ccc2fa2cfec | 255 | clr = ( ( ( ( r ) & 0xF8 ) | ( ( g ) >> 5 ) ) << 8 ) | ( ( ( ( g ) & 0x1C ) << 3 ) | ( ( b ) >> 3 ) ); |
ttodorov | 15:af3cd35886fb | 256 | WriteData( clr ); |
ttodorov | 15:af3cd35886fb | 257 | } |
ttodorov | 15:af3cd35886fb | 258 | else if ( _colorDepth == RGB18 ) |
ttodorov | 15:af3cd35886fb | 259 | { |
ttodorov | 16:4ccc2fa2cfec | 260 | clr = ( ( r & 0xFC ) << 8 ) | ( g & 0xFC ); |
ttodorov | 16:4ccc2fa2cfec | 261 | WriteData( clr ); |
ttodorov | 16:4ccc2fa2cfec | 262 | WriteData( b & 0xFC ); |
ttodorov | 15:af3cd35886fb | 263 | } |
ttodorov | 10:69571adcfad5 | 264 | } |