1.44 tft lcd display
Dependencies: TFT_fonts mbed-os
Fork of newTFTLCD by
ssd1289.cpp@17:866f2a851dd7, 2012-12-12 (annotated)
- Committer:
- ttodorov
- Date:
- Wed Dec 12 18:08:41 2012 +0000
- Revision:
- 17:866f2a851dd7
- Parent:
- 16:4ccc2fa2cfec
- Child:
- 18:b934d95cc380
- still testing landscape modes for 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 | 17:866f2a851dd7 | 74 | case LANDSCAPE: // uder test |
ttodorov | 16:4ccc2fa2cfec | 75 | WriteCmdData( 0x01, 0x2B3F ); // driver output control // 0x293F 0x2B3F 0x2D3F 0x2F3F 0x693F 0x6B3F 0x6D3F 0x6F3F |
ttodorov | 16:4ccc2fa2cfec | 76 | wait_ms( 1 ); |
ttodorov | 17:866f2a851dd7 | 77 | WriteCmdData( 0x11, 0x6068 ); // entry mode // 0x6040 0x6048 0x6050 0x6058 0x6060 0x6068 |
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 | 17:866f2a851dd7 | 86 | case LANDSCAPE_REV: // uder test |
ttodorov | 17:866f2a851dd7 | 87 | WriteCmdData( 0x11, 0x6068 ); // entry mode |
ttodorov | 15:af3cd35886fb | 88 | break; |
ttodorov | 16:4ccc2fa2cfec | 89 | |
ttodorov | 17:866f2a851dd7 | 90 | case PORTRAIT: // works |
ttodorov | 15:af3cd35886fb | 91 | default: |
ttodorov | 16:4ccc2fa2cfec | 92 | WriteCmdData( 0x01, 0x2B3F ); // driver output control |
ttodorov | 16:4ccc2fa2cfec | 93 | wait_ms( 1 ); |
ttodorov | 16:4ccc2fa2cfec | 94 | WriteCmdData( 0x11, 0x6070 ); // entry mode |
ttodorov | 15:af3cd35886fb | 95 | break; |
ttodorov | 15:af3cd35886fb | 96 | } |
ttodorov | 15:af3cd35886fb | 97 | } |
ttodorov | 15:af3cd35886fb | 98 | else if ( _colorDepth == RGB18 ) |
ttodorov | 15:af3cd35886fb | 99 | { |
ttodorov | 15:af3cd35886fb | 100 | switch ( _orientation ) |
ttodorov | 15:af3cd35886fb | 101 | { |
ttodorov | 17:866f2a851dd7 | 102 | case LANDSCAPE: // uder test |
ttodorov | 16:4ccc2fa2cfec | 103 | WriteCmdData( 0x01, 0x293F ); // driver output control // 0x293F 0x2B3F 0x2D3F 0x2F3F 0x693F 0x6B3F 0x6D3F 0x6F3F |
ttodorov | 16:4ccc2fa2cfec | 104 | wait_ms( 1 ); |
ttodorov | 17:866f2a851dd7 | 105 | WriteCmdData( 0x11, 0x4068 ); // entry mode // 0x4040 0x4048 0x4050 0x4058 0x4060 0x4068 |
ttodorov | 15:af3cd35886fb | 106 | break; |
ttodorov | 16:4ccc2fa2cfec | 107 | |
ttodorov | 17:866f2a851dd7 | 108 | case PORTRAIT_REV: // works |
ttodorov | 16:4ccc2fa2cfec | 109 | WriteCmdData( 0x01, 0x693F ); // driver output control |
ttodorov | 16:4ccc2fa2cfec | 110 | wait_ms( 1 ); |
ttodorov | 16:4ccc2fa2cfec | 111 | WriteCmdData( 0x11, 0x4070 ); // entry mode |
ttodorov | 15:af3cd35886fb | 112 | break; |
ttodorov | 16:4ccc2fa2cfec | 113 | |
ttodorov | 17:866f2a851dd7 | 114 | case LANDSCAPE_REV: // uder test |
ttodorov | 16:4ccc2fa2cfec | 115 | WriteCmdData( 0x11, 0x4068 ); // entry mode |
ttodorov | 15:af3cd35886fb | 116 | break; |
ttodorov | 16:4ccc2fa2cfec | 117 | |
ttodorov | 17:866f2a851dd7 | 118 | case PORTRAIT: // works |
ttodorov | 15:af3cd35886fb | 119 | default: |
ttodorov | 16:4ccc2fa2cfec | 120 | WriteCmdData( 0x01, 0x2B3F ); // driver output control |
ttodorov | 16:4ccc2fa2cfec | 121 | wait_ms( 1 ); |
ttodorov | 16:4ccc2fa2cfec | 122 | WriteCmdData( 0x11, 0x4070 ); // entry mode |
ttodorov | 15:af3cd35886fb | 123 | break; |
ttodorov | 15:af3cd35886fb | 124 | } |
ttodorov | 15:af3cd35886fb | 125 | } |
ttodorov | 15:af3cd35886fb | 126 | wait_ms( 1 ); |
ttodorov | 15:af3cd35886fb | 127 | WriteCmdData( 0x05, 0x0000 ); // compare register |
ttodorov | 15:af3cd35886fb | 128 | wait_ms( 1 ); |
ttodorov | 15:af3cd35886fb | 129 | WriteCmdData( 0x06, 0x0000 ); // compare register |
ttodorov | 15:af3cd35886fb | 130 | wait_ms( 1 ); |
ttodorov | 15:af3cd35886fb | 131 | WriteCmdData( 0x16, 0xEF1C ); // horizontal porch |
ttodorov | 15:af3cd35886fb | 132 | wait_ms( 1 ); |
ttodorov | 15:af3cd35886fb | 133 | WriteCmdData( 0x17, 0x0003 ); // vertical porch |
ttodorov | 15:af3cd35886fb | 134 | wait_ms( 1 ); |
ttodorov | 15:af3cd35886fb | 135 | WriteCmdData( 0x07, 0x0233 ); // display control |
ttodorov | 15:af3cd35886fb | 136 | wait_ms( 1 ); |
ttodorov | 15:af3cd35886fb | 137 | WriteCmdData( 0x0B, 0x0000 ); // frame cycle control |
ttodorov | 15:af3cd35886fb | 138 | wait_ms( 1 ); |
ttodorov | 15:af3cd35886fb | 139 | WriteCmdData( 0x0F, 0x0000 ); // gate scan position |
ttodorov | 15:af3cd35886fb | 140 | wait_ms( 1 ); |
ttodorov | 15:af3cd35886fb | 141 | WriteCmdData( 0x41, 0x0000 ); // vertical scroll control |
ttodorov | 15:af3cd35886fb | 142 | wait_ms( 1 ); |
ttodorov | 15:af3cd35886fb | 143 | WriteCmdData( 0x42, 0x0000 ); // vertical scroll control |
ttodorov | 15:af3cd35886fb | 144 | wait_ms( 1 ); |
ttodorov | 15:af3cd35886fb | 145 | WriteCmdData( 0x48, 0x0000 ); // 1st screen driving position |
ttodorov | 15:af3cd35886fb | 146 | wait_ms( 1 ); |
ttodorov | 15:af3cd35886fb | 147 | WriteCmdData( 0x49, 0x013F ); // 1st screen driving position |
ttodorov | 15:af3cd35886fb | 148 | wait_ms( 1 ); |
ttodorov | 15:af3cd35886fb | 149 | WriteCmdData( 0x4A, 0x0000 ); // 2nd screen driving position |
ttodorov | 15:af3cd35886fb | 150 | wait_ms( 1 ); |
ttodorov | 15:af3cd35886fb | 151 | WriteCmdData( 0x4B, 0x0000 ); // 2nd screen driving position |
ttodorov | 15:af3cd35886fb | 152 | wait_ms( 1 ); |
ttodorov | 15:af3cd35886fb | 153 | WriteCmdData( 0x44, 0xEF00 ); // horizontal ram address position |
ttodorov | 15:af3cd35886fb | 154 | wait_ms( 1 ); |
ttodorov | 15:af3cd35886fb | 155 | WriteCmdData( 0x45, 0x0000 ); // vertical ram address position |
ttodorov | 15:af3cd35886fb | 156 | wait_ms( 1 ); |
ttodorov | 15:af3cd35886fb | 157 | WriteCmdData( 0x46, 0x013F ); // vertical ram address position |
ttodorov | 15:af3cd35886fb | 158 | wait_ms( 1 ); |
ttodorov | 15:af3cd35886fb | 159 | WriteCmdData( 0x30, 0x0707 ); // gamma control |
ttodorov | 15:af3cd35886fb | 160 | wait_ms( 1 ); |
ttodorov | 15:af3cd35886fb | 161 | WriteCmdData( 0x31, 0x0204 ); // gamma control |
ttodorov | 15:af3cd35886fb | 162 | wait_ms( 1 ); |
ttodorov | 15:af3cd35886fb | 163 | WriteCmdData( 0x32, 0x0204 ); // gamma control |
ttodorov | 15:af3cd35886fb | 164 | wait_ms( 1 ); |
ttodorov | 15:af3cd35886fb | 165 | WriteCmdData( 0x33, 0x0502 ); // gamma control |
ttodorov | 15:af3cd35886fb | 166 | wait_ms( 1 ); |
ttodorov | 15:af3cd35886fb | 167 | WriteCmdData( 0x34, 0x0507 ); // gamma control |
ttodorov | 15:af3cd35886fb | 168 | wait_ms( 1 ); |
ttodorov | 15:af3cd35886fb | 169 | WriteCmdData( 0x35, 0x0204 ); // gamma control |
ttodorov | 15:af3cd35886fb | 170 | wait_ms( 1 ); |
ttodorov | 15:af3cd35886fb | 171 | WriteCmdData( 0x36, 0x0204 ); // gamma control |
ttodorov | 15:af3cd35886fb | 172 | wait_ms( 1 ); |
ttodorov | 15:af3cd35886fb | 173 | WriteCmdData( 0x37, 0x0502 ); // gamma control |
ttodorov | 15:af3cd35886fb | 174 | wait_ms( 1 ); |
ttodorov | 15:af3cd35886fb | 175 | WriteCmdData( 0x3A, 0x0302 ); // gamma control |
ttodorov | 15:af3cd35886fb | 176 | wait_ms( 1 ); |
ttodorov | 15:af3cd35886fb | 177 | WriteCmdData( 0x3B, 0x0302 ); // gamma control |
ttodorov | 15:af3cd35886fb | 178 | wait_ms( 1 ); |
ttodorov | 15:af3cd35886fb | 179 | WriteCmdData( 0x23, 0x0000 ); // GRAM write mask for red and green pins |
ttodorov | 15:af3cd35886fb | 180 | wait_ms( 1 ); |
ttodorov | 15:af3cd35886fb | 181 | WriteCmdData( 0x24, 0x0000 ); // GRAM write mask for blue pins |
ttodorov | 15:af3cd35886fb | 182 | wait_ms( 1 ); |
ttodorov | 15:af3cd35886fb | 183 | WriteCmdData( 0x25, 0x8000 ); // frame frequency control |
ttodorov | 15:af3cd35886fb | 184 | wait_ms( 1 ); |
ttodorov | 15:af3cd35886fb | 185 | WriteCmdData( 0x4e, 0x0000 ); // ram address set |
ttodorov | 15:af3cd35886fb | 186 | wait_ms( 1 ); |
ttodorov | 15:af3cd35886fb | 187 | WriteCmdData( 0x4f, 0x0000 ); // ram address set |
ttodorov | 15:af3cd35886fb | 188 | wait_ms( 1 ); |
ttodorov | 15:af3cd35886fb | 189 | WriteCmd( 0x22 ); // write GRAM |
ttodorov | 4:3ac4239f6c9c | 190 | Deactivate(); |
ttodorov | 0:881ff0b71102 | 191 | } |
ttodorov | 0:881ff0b71102 | 192 | |
ttodorov | 4:3ac4239f6c9c | 193 | void SSD1289_LCD::Sleep( void ) |
ttodorov | 0:881ff0b71102 | 194 | { |
ttodorov | 4:3ac4239f6c9c | 195 | // TODO: figure out if the SSD1289 controller has sleep and wakeup commands |
ttodorov | 4:3ac4239f6c9c | 196 | if ( _lcd_pin_bl != 0 ) |
ttodorov | 4:3ac4239f6c9c | 197 | *_lcd_pin_bl = LOW; |
ttodorov | 0:881ff0b71102 | 198 | } |
ttodorov | 0:881ff0b71102 | 199 | |
ttodorov | 4:3ac4239f6c9c | 200 | void SSD1289_LCD::WakeUp( void ) |
ttodorov | 4:3ac4239f6c9c | 201 | { |
ttodorov | 4:3ac4239f6c9c | 202 | // TODO: figure out if the SSD1289 controller has sleep and wakeup commands |
ttodorov | 4:3ac4239f6c9c | 203 | if ( _lcd_pin_bl != 0 ) |
ttodorov | 4:3ac4239f6c9c | 204 | *_lcd_pin_bl = HIGH; |
ttodorov | 4:3ac4239f6c9c | 205 | } |
ttodorov | 4:3ac4239f6c9c | 206 | |
ttodorov | 4:3ac4239f6c9c | 207 | void SSD1289_LCD::WriteCmd( unsigned short cmd ) |
ttodorov | 4:3ac4239f6c9c | 208 | { |
ttodorov | 4:3ac4239f6c9c | 209 | _lcd_pin_rs = LOW; |
ttodorov | 4:3ac4239f6c9c | 210 | _lcd_port->write( cmd ); |
ttodorov | 4:3ac4239f6c9c | 211 | pulseLow( _lcd_pin_wr ); |
ttodorov | 4:3ac4239f6c9c | 212 | } |
ttodorov | 4:3ac4239f6c9c | 213 | |
ttodorov | 4:3ac4239f6c9c | 214 | void SSD1289_LCD::WriteData( unsigned short data ) |
ttodorov | 0:881ff0b71102 | 215 | { |
ttodorov | 0:881ff0b71102 | 216 | _lcd_pin_rs = HIGH; |
ttodorov | 0:881ff0b71102 | 217 | _lcd_port->write( data ); |
ttodorov | 0:881ff0b71102 | 218 | pulseLow( _lcd_pin_wr ); |
ttodorov | 0:881ff0b71102 | 219 | } |
ttodorov | 0:881ff0b71102 | 220 | |
ttodorov | 4:3ac4239f6c9c | 221 | void SSD1289_LCD::SetXY( uint16_t x1, uint16_t y1, uint16_t x2, uint16_t y2 ) |
ttodorov | 0:881ff0b71102 | 222 | { |
ttodorov | 2:81ed304b7e9b | 223 | WriteCmdData( 0x44, ( x2 << 8 ) + x1 ); |
ttodorov | 2:81ed304b7e9b | 224 | WriteCmdData( 0x45, y1 ); |
ttodorov | 2:81ed304b7e9b | 225 | WriteCmdData( 0x46, y2 ); |
ttodorov | 2:81ed304b7e9b | 226 | WriteCmdData( 0x4e, x1 ); |
ttodorov | 2:81ed304b7e9b | 227 | WriteCmdData( 0x4f, y1 ); |
ttodorov | 2:81ed304b7e9b | 228 | WriteCmd( 0x22 ); |
ttodorov | 0:881ff0b71102 | 229 | } |
ttodorov | 10:69571adcfad5 | 230 | |
ttodorov | 12:d0978272a340 | 231 | void SSD1289_LCD::SetPixelColor( unsigned int color ) |
ttodorov | 10:69571adcfad5 | 232 | { |
ttodorov | 12:d0978272a340 | 233 | unsigned char r, g, b; |
ttodorov | 16:4ccc2fa2cfec | 234 | unsigned short clr; |
ttodorov | 12:d0978272a340 | 235 | r = ( color >> 16 ) & 0xFF; |
ttodorov | 12:d0978272a340 | 236 | g = ( color >> 8 ) & 0xFF; |
ttodorov | 12:d0978272a340 | 237 | b = color & 0xFF; |
ttodorov | 15:af3cd35886fb | 238 | if ( _colorDepth == RGB16 ) |
ttodorov | 15:af3cd35886fb | 239 | { |
ttodorov | 16:4ccc2fa2cfec | 240 | clr = ( ( ( ( r ) & 0xF8 ) | ( ( g ) >> 5 ) ) << 8 ) | ( ( ( ( g ) & 0x1C ) << 3 ) | ( ( b ) >> 3 ) ); |
ttodorov | 15:af3cd35886fb | 241 | WriteData( clr ); |
ttodorov | 15:af3cd35886fb | 242 | } |
ttodorov | 15:af3cd35886fb | 243 | else if ( _colorDepth == RGB18 ) |
ttodorov | 15:af3cd35886fb | 244 | { |
ttodorov | 16:4ccc2fa2cfec | 245 | clr = ( ( r & 0xFC ) << 8 ) | ( g & 0xFC ); |
ttodorov | 16:4ccc2fa2cfec | 246 | WriteData( clr ); |
ttodorov | 16:4ccc2fa2cfec | 247 | WriteData( b & 0xFC ); |
ttodorov | 15:af3cd35886fb | 248 | } |
ttodorov | 10:69571adcfad5 | 249 | } |