Pete Skeggs / NokiaLCDex

This includes all known improvements from other people's spins on the Nokia library, including Alistair Popple's fix to the very poor contrast on newer LCD 6100 displays.

Fork of NokiaLCD by Iftekhar Choudhury

NokiaLCD.cpp@4:0a17a8a82c4c, 2014-01-26 (annotated)

Committer:
plskeggs
Date:
Sun Jan 26 23:10:31 2014 +0000
Revision:
4:0a17a8a82c4c
Parent:
3:ea0c085881f3 
Works with a Sparkfun LCD 6100.  Includes all changes from other people's spins of the original Nokia library, including the latest from Alistar Popple that fixes the very poor contrast issue.

Who changed what in which revision?

UserRevisionLine numberNew contents of line
simon 0:ff874f85ed33 1 /* mbed Nokia LCD Library
simon 0:ff874f85ed33 2 * Copyright (c) 2007-2010, sford
simon 0:ff874f85ed33 3 */
simon 0:ff874f85ed33 4
simon 0:ff874f85ed33 5 #include "NokiaLCD.h"
simon 0:ff874f85ed33 6
simon 0:ff874f85ed33 7 #include "mbed.h"
simon 0:ff874f85ed33 8
simon 0:ff874f85ed33 9 #define NOKIALCD_ROWS 16
simon 0:ff874f85ed33 10 #define NOKIALCD_COLS 16
simon 0:ff874f85ed33 11 #define NOKIALCD_WIDTH 130
ichoudhury6 3:ea0c085881f3 12 #define NOKIALCD_HEIGHT 132
plskeggs 4:0a17a8a82c4c 13 #define NOKIALCD_FREQUENCY 1000000
simon 0:ff874f85ed33 14
plskeggs 4:0a17a8a82c4c 15 NokiaLCD::NokiaLCD(PinName mosi, PinName sclk, PinName cs, PinName rst, LCDType type, int contrast)
simon 0:ff874f85ed33 16 : _spi(mosi, NC, sclk)
simon 0:ff874f85ed33 17 , _rst(rst)
simon 0:ff874f85ed33 18 , _cs(cs) {
simon 0:ff874f85ed33 19
simon 0:ff874f85ed33 20 _type = type;
simon 0:ff874f85ed33 21
simon 0:ff874f85ed33 22 _row = 0;
simon 0:ff874f85ed33 23 _column = 0;
simon 0:ff874f85ed33 24 _foreground = 0x00FFFFFF;
simon 0:ff874f85ed33 25 _background = 0x00000000;
plskeggs 4:0a17a8a82c4c 26 _rows = NOKIALCD_ROWS;
plskeggs 4:0a17a8a82c4c 27 _columns = NOKIALCD_COLS;
simon 0:ff874f85ed33 28
plskeggs 4:0a17a8a82c4c 29 //reset(contrast);
simon 0:ff874f85ed33 30 }
simon 0:ff874f85ed33 31
plskeggs 4:0a17a8a82c4c 32 void NokiaLCD::reset(int contrast) {
simon 0:ff874f85ed33 33
simon 0:ff874f85ed33 34 // setup the SPI interface and bring display out of reset
simon 0:ff874f85ed33 35 _cs = 1;
simon 0:ff874f85ed33 36 _rst = 0;
simon 0:ff874f85ed33 37 _spi.format(9);
simon 0:ff874f85ed33 38 _spi.frequency(NOKIALCD_FREQUENCY);
simon 0:ff874f85ed33 39 wait_ms(1);
simon 0:ff874f85ed33 40 _rst = 1;
simon 0:ff874f85ed33 41 wait_ms(1);
simon 0:ff874f85ed33 42
simon 0:ff874f85ed33 43 _cs = 0;
simon 0:ff874f85ed33 44
simon 0:ff874f85ed33 45 switch (_type) {
simon 0:ff874f85ed33 46 case LCD6100:
simon 0:ff874f85ed33 47 command(0xCA); // display control
plskeggs 4:0a17a8a82c4c 48 data(0xC);
simon 0:ff874f85ed33 49 data(32);
simon 0:ff874f85ed33 50 data(0);
simon 0:ff874f85ed33 51 command(0xBB);
simon 0:ff874f85ed33 52 data(1);
simon 0:ff874f85ed33 53 command(0xD1); // oscillator on
simon 0:ff874f85ed33 54 command(0x94); // sleep out
simon 0:ff874f85ed33 55 command(0x20); // power control
simon 0:ff874f85ed33 56 data(0x0F);
simon 0:ff874f85ed33 57 command(0xA7); // invert display
plskeggs 4:0a17a8a82c4c 58 command(0xBC); // data control
simon 0:ff874f85ed33 59 data(0);
simon 0:ff874f85ed33 60 data(1);
simon 0:ff874f85ed33 61 data(4);
plskeggs 4:0a17a8a82c4c 62 command(0x81); // Voltage control
plskeggs 4:0a17a8a82c4c 63 data(contrast);// contrast setting: 0..63
plskeggs 4:0a17a8a82c4c 64 data(3); // 3 resistance ratio
plskeggs 4:0a17a8a82c4c 65 wait_ms(10); // allow power supply to stabilize
simon 0:ff874f85ed33 66 command(0xAF); // turn on the display
simon 0:ff874f85ed33 67 break;
simon 0:ff874f85ed33 68
simon 0:ff874f85ed33 69 case LCD6610:
simon 0:ff874f85ed33 70 command(0xCA); // display control
simon 0:ff874f85ed33 71 data(0);
ichoudhury6 3:ea0c085881f3 72 data(32);
simon 0:ff874f85ed33 73 data(0);
simon 0:ff874f85ed33 74 command(0xBB);
simon 0:ff874f85ed33 75 data(1);
simon 0:ff874f85ed33 76 command(0xD1); // oscillator on
simon 0:ff874f85ed33 77 command(0x94); // sleep out
simon 0:ff874f85ed33 78 command(0x20); // power control
simon 0:ff874f85ed33 79 data(0x0F);
simon 0:ff874f85ed33 80 command(0xA7); // invert display
simon 0:ff874f85ed33 81 command(0x81); // Voltage control
plskeggs 4:0a17a8a82c4c 82 data(contrast);// contrast setting: 0..63
simon 0:ff874f85ed33 83 data(3); // resistance ratio
simon 0:ff874f85ed33 84 wait_ms(1);
simon 0:ff874f85ed33 85 command(0xBC);
simon 0:ff874f85ed33 86 data(0);
simon 0:ff874f85ed33 87 data(0);
simon 0:ff874f85ed33 88 data(2);
simon 0:ff874f85ed33 89 command(0xAF); // turn on the display
simon 0:ff874f85ed33 90 break;
simon 0:ff874f85ed33 91
simon 0:ff874f85ed33 92 case PCF8833:
simon 0:ff874f85ed33 93 command(0x11); // sleep out
simon 0:ff874f85ed33 94 command(0x3A); // column mode
simon 0:ff874f85ed33 95 data(0x05);
simon 0:ff874f85ed33 96 command(0x36); // madctl
simon 0:ff874f85ed33 97 data(0x60); // vertical RAM, flip x
simon 0:ff874f85ed33 98 command(0x25); // setcon
plskeggs 4:0a17a8a82c4c 99 data(contrast);// contrast 0x30
simon 0:ff874f85ed33 100 wait_ms(2);
simon 0:ff874f85ed33 101 command(0x29);//DISPON
simon 0:ff874f85ed33 102 command(0x03);//BSTRON
simon 0:ff874f85ed33 103 break;
simon 0:ff874f85ed33 104 }
simon 0:ff874f85ed33 105
simon 0:ff874f85ed33 106 _cs = 1;
simon 0:ff874f85ed33 107
simon 0:ff874f85ed33 108 cls();
simon 0:ff874f85ed33 109 }
simon 0:ff874f85ed33 110
simon 0:ff874f85ed33 111 void NokiaLCD::command(int value) {
simon 0:ff874f85ed33 112 _spi.write(value & 0xFF);
simon 0:ff874f85ed33 113 }
simon 0:ff874f85ed33 114
simon 0:ff874f85ed33 115 void NokiaLCD::data(int value) {
simon 0:ff874f85ed33 116 _spi.write(value | 0x100);
simon 0:ff874f85ed33 117 }
simon 0:ff874f85ed33 118
simon 0:ff874f85ed33 119 void NokiaLCD::_window(int x, int y, int width, int height) {
ichoudhury6 3:ea0c085881f3 120 int x1 = x + 0;
simon 0:ff874f85ed33 121 int y1 = y + 0;
simon 0:ff874f85ed33 122 int x2 = x1 + width - 1;
simon 0:ff874f85ed33 123 int y2 = y1 + height - 1;
simon 0:ff874f85ed33 124
simon 0:ff874f85ed33 125 switch (_type) {
simon 0:ff874f85ed33 126 case LCD6100:
simon 0:ff874f85ed33 127 case LCD6610:
simon 0:ff874f85ed33 128 command(0x15); // column
simon 0:ff874f85ed33 129 data(x1);
simon 0:ff874f85ed33 130 data(x2);
simon 0:ff874f85ed33 131 command(0x75); // row
simon 0:ff874f85ed33 132 data(y1);
simon 0:ff874f85ed33 133 data(y2);
simon 0:ff874f85ed33 134 command(0x5C); // start write to ram
simon 0:ff874f85ed33 135 break;
simon 0:ff874f85ed33 136 case PCF8833:
simon 0:ff874f85ed33 137 command(0x2A); // column
simon 0:ff874f85ed33 138 data(x1);
simon 0:ff874f85ed33 139 data(x2);
simon 0:ff874f85ed33 140 command(0x2B); // row
simon 0:ff874f85ed33 141 data(y1);
simon 0:ff874f85ed33 142 data(y2);
simon 0:ff874f85ed33 143 command(0x2C); // start write to ram
simon 0:ff874f85ed33 144 break;
simon 0:ff874f85ed33 145 }
simon 0:ff874f85ed33 146 }
simon 0:ff874f85ed33 147
simon 0:ff874f85ed33 148 void NokiaLCD::_putp(int colour) {
simon 0:ff874f85ed33 149 int gr = ((colour >> 20) & 0x0F)
simon 0:ff874f85ed33 150 | ((colour >> 8 ) & 0xF0);
simon 0:ff874f85ed33 151 int nb = ((colour >> 4 ) & 0x0F);
simon 0:ff874f85ed33 152 data(nb);
simon 0:ff874f85ed33 153 data(gr);
simon 0:ff874f85ed33 154 }
simon 0:ff874f85ed33 155
simon 0:ff874f85ed33 156 const unsigned char FONT8x8[97][8] = {
simon 0:ff874f85ed33 157 0x08,0x08,0x08,0x00,0x00,0x00,0x00,0x00, // columns, rows, num_bytes_per_char
simon 0:ff874f85ed33 158 0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00, // space 0x20
simon 0:ff874f85ed33 159 0x30,0x78,0x78,0x30,0x30,0x00,0x30,0x00, // !
simon 0:ff874f85ed33 160 0x6C,0x6C,0x6C,0x00,0x00,0x00,0x00,0x00, // "
simon 0:ff874f85ed33 161 0x6C,0x6C,0xFE,0x6C,0xFE,0x6C,0x6C,0x00, // #
simon 0:ff874f85ed33 162 0x18,0x3E,0x60,0x3C,0x06,0x7C,0x18,0x00, // $
simon 0:ff874f85ed33 163 0x00,0x63,0x66,0x0C,0x18,0x33,0x63,0x00, // %
simon 0:ff874f85ed33 164 0x1C,0x36,0x1C,0x3B,0x6E,0x66,0x3B,0x00, // &
simon 0:ff874f85ed33 165 0x30,0x30,0x60,0x00,0x00,0x00,0x00,0x00, // '
simon 0:ff874f85ed33 166 0x0C,0x18,0x30,0x30,0x30,0x18,0x0C,0x00, // (
simon 0:ff874f85ed33 167 0x30,0x18,0x0C,0x0C,0x0C,0x18,0x30,0x00, // )
simon 0:ff874f85ed33 168 0x00,0x66,0x3C,0xFF,0x3C,0x66,0x00,0x00, // *
simon 0:ff874f85ed33 169 0x00,0x30,0x30,0xFC,0x30,0x30,0x00,0x00, // +
simon 0:ff874f85ed33 170 0x00,0x00,0x00,0x00,0x00,0x18,0x18,0x30, // ,
simon 0:ff874f85ed33 171 0x00,0x00,0x00,0x7E,0x00,0x00,0x00,0x00, // -
simon 0:ff874f85ed33 172 0x00,0x00,0x00,0x00,0x00,0x18,0x18,0x00, // .
simon 0:ff874f85ed33 173 0x03,0x06,0x0C,0x18,0x30,0x60,0x40,0x00, // / (forward slash)
simon 0:ff874f85ed33 174 0x3E,0x63,0x63,0x6B,0x63,0x63,0x3E,0x00, // 0 0x30
simon 0:ff874f85ed33 175 0x18,0x38,0x58,0x18,0x18,0x18,0x7E,0x00, // 1
simon 0:ff874f85ed33 176 0x3C,0x66,0x06,0x1C,0x30,0x66,0x7E,0x00, // 2
simon 0:ff874f85ed33 177 0x3C,0x66,0x06,0x1C,0x06,0x66,0x3C,0x00, // 3
simon 0:ff874f85ed33 178 0x0E,0x1E,0x36,0x66,0x7F,0x06,0x0F,0x00, // 4
simon 0:ff874f85ed33 179 0x7E,0x60,0x7C,0x06,0x06,0x66,0x3C,0x00, // 5
simon 0:ff874f85ed33 180 0x1C,0x30,0x60,0x7C,0x66,0x66,0x3C,0x00, // 6
simon 0:ff874f85ed33 181 0x7E,0x66,0x06,0x0C,0x18,0x18,0x18,0x00, // 7
simon 0:ff874f85ed33 182 0x3C,0x66,0x66,0x3C,0x66,0x66,0x3C,0x00, // 8
simon 0:ff874f85ed33 183 0x3C,0x66,0x66,0x3E,0x06,0x0C,0x38,0x00, // 9
simon 0:ff874f85ed33 184 0x00,0x18,0x18,0x00,0x00,0x18,0x18,0x00, // :
simon 0:ff874f85ed33 185 0x00,0x18,0x18,0x00,0x00,0x18,0x18,0x30, // ;
simon 0:ff874f85ed33 186 0x0C,0x18,0x30,0x60,0x30,0x18,0x0C,0x00, // <
simon 0:ff874f85ed33 187 0x00,0x00,0x7E,0x00,0x00,0x7E,0x00,0x00, // =
simon 0:ff874f85ed33 188 0x30,0x18,0x0C,0x06,0x0C,0x18,0x30,0x00, // >
simon 0:ff874f85ed33 189 0x3C,0x66,0x06,0x0C,0x18,0x00,0x18,0x00, // ?
simon 0:ff874f85ed33 190 0x3E,0x63,0x6F,0x69,0x6F,0x60,0x3E,0x00, // @ 0x40
simon 0:ff874f85ed33 191 0x18,0x3C,0x66,0x66,0x7E,0x66,0x66,0x00, // A
simon 0:ff874f85ed33 192 0x7E,0x33,0x33,0x3E,0x33,0x33,0x7E,0x00, // B
simon 0:ff874f85ed33 193 0x1E,0x33,0x60,0x60,0x60,0x33,0x1E,0x00, // C
simon 0:ff874f85ed33 194 0x7C,0x36,0x33,0x33,0x33,0x36,0x7C,0x00, // D
simon 0:ff874f85ed33 195 0x7F,0x31,0x34,0x3C,0x34,0x31,0x7F,0x00, // E
simon 0:ff874f85ed33 196 0x7F,0x31,0x34,0x3C,0x34,0x30,0x78,0x00, // F
simon 0:ff874f85ed33 197 0x1E,0x33,0x60,0x60,0x67,0x33,0x1F,0x00, // G
simon 0:ff874f85ed33 198 0x66,0x66,0x66,0x7E,0x66,0x66,0x66,0x00, // H
simon 0:ff874f85ed33 199 0x3C,0x18,0x18,0x18,0x18,0x18,0x3C,0x00, // I
simon 0:ff874f85ed33 200 0x0F,0x06,0x06,0x06,0x66,0x66,0x3C,0x00, // J
simon 0:ff874f85ed33 201 0x73,0x33,0x36,0x3C,0x36,0x33,0x73,0x00, // K
simon 0:ff874f85ed33 202 0x78,0x30,0x30,0x30,0x31,0x33,0x7F,0x00, // L
simon 0:ff874f85ed33 203 0x63,0x77,0x7F,0x7F,0x6B,0x63,0x63,0x00, // M
simon 0:ff874f85ed33 204 0x63,0x73,0x7B,0x6F,0x67,0x63,0x63,0x00, // N
simon 0:ff874f85ed33 205 0x3E,0x63,0x63,0x63,0x63,0x63,0x3E,0x00, // O
simon 0:ff874f85ed33 206 0x7E,0x33,0x33,0x3E,0x30,0x30,0x78,0x00, // P 0x50
simon 0:ff874f85ed33 207 0x3C,0x66,0x66,0x66,0x6E,0x3C,0x0E,0x00, // Q
simon 0:ff874f85ed33 208 0x7E,0x33,0x33,0x3E,0x36,0x33,0x73,0x00, // R
simon 0:ff874f85ed33 209 0x3C,0x66,0x30,0x18,0x0C,0x66,0x3C,0x00, // S
simon 0:ff874f85ed33 210 0x7E,0x5A,0x18,0x18,0x18,0x18,0x3C,0x00, // T
simon 0:ff874f85ed33 211 0x66,0x66,0x66,0x66,0x66,0x66,0x7E,0x00, // U
simon 0:ff874f85ed33 212 0x66,0x66,0x66,0x66,0x66,0x3C,0x18,0x00, // V
simon 0:ff874f85ed33 213 0x63,0x63,0x63,0x6B,0x7F,0x77,0x63,0x00, // W
simon 0:ff874f85ed33 214 0x63,0x63,0x36,0x1C,0x1C,0x36,0x63,0x00, // X
simon 0:ff874f85ed33 215 0x66,0x66,0x66,0x3C,0x18,0x18,0x3C,0x00, // Y
simon 0:ff874f85ed33 216 0x7F,0x63,0x46,0x0C,0x19,0x33,0x7F,0x00, // Z
simon 0:ff874f85ed33 217 0x3C,0x30,0x30,0x30,0x30,0x30,0x3C,0x00, // [
simon 0:ff874f85ed33 218 0x60,0x30,0x18,0x0C,0x06,0x03,0x01,0x00, // \ (back slash)
simon 0:ff874f85ed33 219 0x3C,0x0C,0x0C,0x0C,0x0C,0x0C,0x3C,0x00, // ]
simon 0:ff874f85ed33 220 0x08,0x1C,0x36,0x63,0x00,0x00,0x00,0x00, // ^
simon 0:ff874f85ed33 221 0x00,0x00,0x00,0x00,0x00,0x00,0x00,0xFF, // _
simon 0:ff874f85ed33 222 0x18,0x18,0x0C,0x00,0x00,0x00,0x00,0x00, // ` 0x60
simon 0:ff874f85ed33 223 0x00,0x00,0x3C,0x06,0x3E,0x66,0x3B,0x00, // a
simon 0:ff874f85ed33 224 0x70,0x30,0x3E,0x33,0x33,0x33,0x6E,0x00, // b
simon 0:ff874f85ed33 225 0x00,0x00,0x3C,0x66,0x60,0x66,0x3C,0x00, // c
simon 0:ff874f85ed33 226 0x0E,0x06,0x3E,0x66,0x66,0x66,0x3B,0x00, // d
simon 0:ff874f85ed33 227 0x00,0x00,0x3C,0x66,0x7E,0x60,0x3C,0x00, // e
simon 0:ff874f85ed33 228 0x1C,0x36,0x30,0x78,0x30,0x30,0x78,0x00, // f
simon 0:ff874f85ed33 229 0x00,0x00,0x3B,0x66,0x66,0x3E,0x06,0x7C, // g
simon 0:ff874f85ed33 230 0x70,0x30,0x36,0x3B,0x33,0x33,0x73,0x00, // h
simon 0:ff874f85ed33 231 0x18,0x00,0x38,0x18,0x18,0x18,0x3C,0x00, // i
simon 0:ff874f85ed33 232 0x06,0x00,0x06,0x06,0x06,0x66,0x66,0x3C, // j
simon 0:ff874f85ed33 233 0x70,0x30,0x33,0x36,0x3C,0x36,0x73,0x00, // k
simon 0:ff874f85ed33 234 0x38,0x18,0x18,0x18,0x18,0x18,0x3C,0x00, // l
simon 0:ff874f85ed33 235 0x00,0x00,0x66,0x7F,0x7F,0x6B,0x63,0x00, // m
simon 0:ff874f85ed33 236 0x00,0x00,0x7C,0x66,0x66,0x66,0x66,0x00, // n
simon 0:ff874f85ed33 237 0x00,0x00,0x3C,0x66,0x66,0x66,0x3C,0x00, // o
simon 0:ff874f85ed33 238 0x00,0x00,0x6E,0x33,0x33,0x3E,0x30,0x78, // p
simon 0:ff874f85ed33 239 0x00,0x00,0x3B,0x66,0x66,0x3E,0x06,0x0F, // q
simon 0:ff874f85ed33 240 0x00,0x00,0x6E,0x3B,0x33,0x30,0x78,0x00, // r
simon 0:ff874f85ed33 241 0x00,0x00,0x3E,0x60,0x3C,0x06,0x7C,0x00, // s
simon 0:ff874f85ed33 242 0x08,0x18,0x3E,0x18,0x18,0x1A,0x0C,0x00, // t
simon 0:ff874f85ed33 243 0x00,0x00,0x66,0x66,0x66,0x66,0x3B,0x00, // u
simon 0:ff874f85ed33 244 0x00,0x00,0x66,0x66,0x66,0x3C,0x18,0x00, // v
simon 0:ff874f85ed33 245 0x00,0x00,0x63,0x6B,0x7F,0x7F,0x36,0x00, // w
simon 0:ff874f85ed33 246 0x00,0x00,0x63,0x36,0x1C,0x36,0x63,0x00, // x
simon 0:ff874f85ed33 247 0x00,0x00,0x66,0x66,0x66,0x3E,0x06,0x7C, // y
simon 0:ff874f85ed33 248 0x00,0x00,0x7E,0x4C,0x18,0x32,0x7E,0x00, // z
simon 0:ff874f85ed33 249 0x0E,0x18,0x18,0x70,0x18,0x18,0x0E,0x00, // {
simon 0:ff874f85ed33 250 0x0C,0x0C,0x0C,0x00,0x0C,0x0C,0x0C,0x00, // |
simon 0:ff874f85ed33 251 0x70,0x18,0x18,0x0E,0x18,0x18,0x70,0x00, // }
simon 0:ff874f85ed33 252 0x3B,0x6E,0x00,0x00,0x00,0x00,0x00,0x00, // ~
simon 0:ff874f85ed33 253 0x1C,0x36,0x36,0x1C,0x00,0x00,0x00,0x00
simon 0:ff874f85ed33 254 }; // DEL
simon 0:ff874f85ed33 255
simon 0:ff874f85ed33 256 void NokiaLCD::locate(int column, int row) {
simon 0:ff874f85ed33 257 _column = column;
simon 0:ff874f85ed33 258 _row = row;
simon 0:ff874f85ed33 259 }
simon 0:ff874f85ed33 260
simon 0:ff874f85ed33 261 void NokiaLCD::newline() {
simon 0:ff874f85ed33 262 _column = 0;
simon 0:ff874f85ed33 263 _row++;
simon 0:ff874f85ed33 264 if (_row >= _rows) {
simon 0:ff874f85ed33 265 _row = 0;
simon 0:ff874f85ed33 266 }
simon 0:ff874f85ed33 267 }
simon 0:ff874f85ed33 268
simon 0:ff874f85ed33 269 int NokiaLCD::_putc(int value) {
simon 0:ff874f85ed33 270 int x = _column * 8; // FIXME: Char sizes
simon 0:ff874f85ed33 271 int y = _row * 8;
simon 0:ff874f85ed33 272 bitblit(x + 1, y + 1, 8, 8, (char*)&(FONT8x8[value - 0x1F][0]));
simon 0:ff874f85ed33 273
simon 0:ff874f85ed33 274 _column++;
simon 0:ff874f85ed33 275
simon 0:ff874f85ed33 276 if (_column >= NOKIALCD_COLS) {
simon 0:ff874f85ed33 277 _row++;
simon 0:ff874f85ed33 278 _column = 0;
simon 0:ff874f85ed33 279 }
simon 0:ff874f85ed33 280
simon 0:ff874f85ed33 281 if (_row >= NOKIALCD_ROWS) {
simon 0:ff874f85ed33 282 _row = 0;
simon 0:ff874f85ed33 283 }
simon 0:ff874f85ed33 284
simon 0:ff874f85ed33 285 return value;
simon 0:ff874f85ed33 286 }
simon 0:ff874f85ed33 287
simon 0:ff874f85ed33 288 void NokiaLCD::cls() {
simon 0:ff874f85ed33 289 fill(0, 0, NOKIALCD_WIDTH, NOKIALCD_HEIGHT, _background);
simon 0:ff874f85ed33 290 _row = 0;
simon 0:ff874f85ed33 291 _column = 0;
simon 0:ff874f85ed33 292 }
simon 0:ff874f85ed33 293
simon 0:ff874f85ed33 294
simon 0:ff874f85ed33 295 void NokiaLCD::window(int x, int y, int width, int height) {
simon 0:ff874f85ed33 296 _cs = 0;
simon 0:ff874f85ed33 297 _window(x, y, width, height);
simon 0:ff874f85ed33 298 _cs = 1;
simon 0:ff874f85ed33 299 }
simon 0:ff874f85ed33 300
simon 0:ff874f85ed33 301 void NokiaLCD::putp(int colour) {
simon 0:ff874f85ed33 302 _cs = 0;
simon 0:ff874f85ed33 303 _putp(colour);
simon 0:ff874f85ed33 304 _cs = 1;
simon 0:ff874f85ed33 305 }
simon 0:ff874f85ed33 306
simon 0:ff874f85ed33 307 void NokiaLCD::pixel(int x, int y, int colour) {
simon 0:ff874f85ed33 308 _cs = 0;
simon 0:ff874f85ed33 309 _window(x, y, 1, 1);
simon 0:ff874f85ed33 310 _putp(colour);
simon 0:ff874f85ed33 311 _cs = 1;
simon 0:ff874f85ed33 312 }
simon 0:ff874f85ed33 313
simon 0:ff874f85ed33 314 void NokiaLCD::fill(int x, int y, int width, int height, int colour) {
simon 0:ff874f85ed33 315 _cs = 0;
simon 0:ff874f85ed33 316 _window(x, y, width, height);
simon 1:8f005b0dcfa7 317 switch (_type) {
simon 1:8f005b0dcfa7 318 case LCD6100:
simon 1:8f005b0dcfa7 319 case PCF8833:
simon 1:8f005b0dcfa7 320 for (int i=0; i<width*height; i++) {
simon 1:8f005b0dcfa7 321 _putp(colour);
simon 1:8f005b0dcfa7 322 }
simon 1:8f005b0dcfa7 323 break;
simon 1:8f005b0dcfa7 324 case LCD6610:
simon 1:8f005b0dcfa7 325 for (int i=0; i<width*height/2; i++) {
simon 1:8f005b0dcfa7 326 int r4 = (colour >> (16 + 4)) & 0xF;
ichoudhury6 3:ea0c085881f3 327 int g4 = (colour >> (8 + 4)) & 0xF;
simon 1:8f005b0dcfa7 328 int b4 = (colour >> (0 + 4)) & 0xF;
ichoudhury6 3:ea0c085881f3 329 int d1 = (r4 << 4) | g4;
simon 1:8f005b0dcfa7 330 int d2 = (b4 << 4) | r4;
simon 1:8f005b0dcfa7 331 int d3 = (g4 << 4) | b4;
simon 1:8f005b0dcfa7 332 data(d1);
ichoudhury6 3:ea0c085881f3 333 data(d2);
ichoudhury6 3:ea0c085881f3 334 data(d3);
simon 1:8f005b0dcfa7 335 }
simon 1:8f005b0dcfa7 336 break;
simon 0:ff874f85ed33 337 }
simon 0:ff874f85ed33 338 _window(0, 0, NOKIALCD_WIDTH, NOKIALCD_HEIGHT);
simon 0:ff874f85ed33 339 _cs = 1;
simon 0:ff874f85ed33 340 }
simon 0:ff874f85ed33 341
plskeggs 4:0a17a8a82c4c 342 void NokiaLCD::circle(int x0, int y0, int r, int colour) {
plskeggs 4:0a17a8a82c4c 343 int draw_x0, draw_y0;
plskeggs 4:0a17a8a82c4c 344 int draw_x1, draw_y1;
plskeggs 4:0a17a8a82c4c 345 int draw_x2, draw_y2;
plskeggs 4:0a17a8a82c4c 346 int draw_x3, draw_y3;
plskeggs 4:0a17a8a82c4c 347 int draw_x4, draw_y4;
plskeggs 4:0a17a8a82c4c 348 int draw_x5, draw_y5;
plskeggs 4:0a17a8a82c4c 349 int draw_x6, draw_y6;
plskeggs 4:0a17a8a82c4c 350 int draw_x7, draw_y7;
plskeggs 4:0a17a8a82c4c 351 int xx, yy;
plskeggs 4:0a17a8a82c4c 352 int di;
plskeggs 4:0a17a8a82c4c 353
plskeggs 4:0a17a8a82c4c 354 _cs = 0;
plskeggs 4:0a17a8a82c4c 355 _window(x0, y0, 1, 1);
plskeggs 4:0a17a8a82c4c 356
plskeggs 4:0a17a8a82c4c 357 if(r == 0) /* no radius */
plskeggs 4:0a17a8a82c4c 358 {
plskeggs 4:0a17a8a82c4c 359 return;
plskeggs 4:0a17a8a82c4c 360 }
plskeggs 4:0a17a8a82c4c 361
plskeggs 4:0a17a8a82c4c 362 draw_x0 = draw_x1 = x0;
plskeggs 4:0a17a8a82c4c 363 draw_y0 = draw_y1 = y0 + r;
plskeggs 4:0a17a8a82c4c 364 if(draw_y0 < NOKIALCD_HEIGHT)
plskeggs 4:0a17a8a82c4c 365 {
plskeggs 4:0a17a8a82c4c 366 _window(draw_x0, draw_y0, 1, 1);
plskeggs 4:0a17a8a82c4c 367 _putp(colour); /* 90 degree */
plskeggs 4:0a17a8a82c4c 368 }
plskeggs 4:0a17a8a82c4c 369
plskeggs 4:0a17a8a82c4c 370 draw_x2 = draw_x3 = x0;
plskeggs 4:0a17a8a82c4c 371 draw_y2 = draw_y3 = y0 - r;
plskeggs 4:0a17a8a82c4c 372 if(draw_y2 >= 0)
plskeggs 4:0a17a8a82c4c 373 {
plskeggs 4:0a17a8a82c4c 374 _window(draw_x2, draw_y2, 1, 1);
plskeggs 4:0a17a8a82c4c 375 _putp(colour); /* 270 degree */
plskeggs 4:0a17a8a82c4c 376 }
plskeggs 4:0a17a8a82c4c 377
plskeggs 4:0a17a8a82c4c 378 draw_x4 = draw_x6 = x0 + r;
plskeggs 4:0a17a8a82c4c 379 draw_y4 = draw_y6 = y0;
plskeggs 4:0a17a8a82c4c 380 if(draw_x4 < NOKIALCD_WIDTH)
plskeggs 4:0a17a8a82c4c 381 {
plskeggs 4:0a17a8a82c4c 382 _window(draw_x4, draw_y4, 1, 1);
plskeggs 4:0a17a8a82c4c 383 _putp(colour); /* 0 degree */
plskeggs 4:0a17a8a82c4c 384 }
plskeggs 4:0a17a8a82c4c 385
plskeggs 4:0a17a8a82c4c 386 draw_x5 = draw_x7 = x0 - r;
plskeggs 4:0a17a8a82c4c 387 draw_y5 = draw_y7 = y0;
plskeggs 4:0a17a8a82c4c 388 if(draw_x5>=0)
plskeggs 4:0a17a8a82c4c 389 {
plskeggs 4:0a17a8a82c4c 390 _window(draw_x5, draw_y5, 1, 1);
plskeggs 4:0a17a8a82c4c 391 _putp(colour); /* 90 degree */ /* 180 degree */
plskeggs 4:0a17a8a82c4c 392 }
plskeggs 4:0a17a8a82c4c 393
plskeggs 4:0a17a8a82c4c 394 if(r == 1)
plskeggs 4:0a17a8a82c4c 395 {
plskeggs 4:0a17a8a82c4c 396 return;
plskeggs 4:0a17a8a82c4c 397 }
plskeggs 4:0a17a8a82c4c 398
plskeggs 4:0a17a8a82c4c 399 di = 3 - 2*r;
plskeggs 4:0a17a8a82c4c 400 xx = 0;
plskeggs 4:0a17a8a82c4c 401 yy = r;
plskeggs 4:0a17a8a82c4c 402 while(xx < yy)
plskeggs 4:0a17a8a82c4c 403 {
plskeggs 4:0a17a8a82c4c 404
plskeggs 4:0a17a8a82c4c 405 if(di < 0)
plskeggs 4:0a17a8a82c4c 406 {
plskeggs 4:0a17a8a82c4c 407 di += 4*xx + 6;
plskeggs 4:0a17a8a82c4c 408 }
plskeggs 4:0a17a8a82c4c 409 else
plskeggs 4:0a17a8a82c4c 410 {
plskeggs 4:0a17a8a82c4c 411 di += 4*(xx - yy) + 10;
plskeggs 4:0a17a8a82c4c 412 yy--;
plskeggs 4:0a17a8a82c4c 413 draw_y0--;
plskeggs 4:0a17a8a82c4c 414 draw_y1--;
plskeggs 4:0a17a8a82c4c 415 draw_y2++;
plskeggs 4:0a17a8a82c4c 416 draw_y3++;
plskeggs 4:0a17a8a82c4c 417 draw_x4--;
plskeggs 4:0a17a8a82c4c 418 draw_x5++;
plskeggs 4:0a17a8a82c4c 419 draw_x6--;
plskeggs 4:0a17a8a82c4c 420 draw_x7++;
plskeggs 4:0a17a8a82c4c 421 }
plskeggs 4:0a17a8a82c4c 422 xx++;
plskeggs 4:0a17a8a82c4c 423 draw_x0++;
plskeggs 4:0a17a8a82c4c 424 draw_x1--;
plskeggs 4:0a17a8a82c4c 425 draw_x2++;
plskeggs 4:0a17a8a82c4c 426 draw_x3--;
plskeggs 4:0a17a8a82c4c 427 draw_y4++;
plskeggs 4:0a17a8a82c4c 428 draw_y5++;
plskeggs 4:0a17a8a82c4c 429 draw_y6--;
plskeggs 4:0a17a8a82c4c 430 draw_y7--;
plskeggs 4:0a17a8a82c4c 431
plskeggs 4:0a17a8a82c4c 432 if( (draw_x0 <= NOKIALCD_WIDTH) && (draw_y0>=0) )
plskeggs 4:0a17a8a82c4c 433 {
plskeggs 4:0a17a8a82c4c 434 _window(draw_x0, draw_y0, 1, 1);
plskeggs 4:0a17a8a82c4c 435 _putp(colour);
plskeggs 4:0a17a8a82c4c 436 }
plskeggs 4:0a17a8a82c4c 437
plskeggs 4:0a17a8a82c4c 438 if( (draw_x1 >= 0) && (draw_y1 >= 0) )
plskeggs 4:0a17a8a82c4c 439 {
plskeggs 4:0a17a8a82c4c 440 _window(draw_x1, draw_y1, 1, 1);
plskeggs 4:0a17a8a82c4c 441 _putp(colour);
plskeggs 4:0a17a8a82c4c 442 }
plskeggs 4:0a17a8a82c4c 443
plskeggs 4:0a17a8a82c4c 444 if( (draw_x2 <= NOKIALCD_WIDTH) && (draw_y2 <= NOKIALCD_HEIGHT) )
plskeggs 4:0a17a8a82c4c 445 {
plskeggs 4:0a17a8a82c4c 446 _window(draw_x2, draw_y2, 1, 1);
plskeggs 4:0a17a8a82c4c 447 _putp(colour);
plskeggs 4:0a17a8a82c4c 448 }
plskeggs 4:0a17a8a82c4c 449
plskeggs 4:0a17a8a82c4c 450 if( (draw_x3 >=0 ) && (draw_y3 <= NOKIALCD_HEIGHT) )
plskeggs 4:0a17a8a82c4c 451 {
plskeggs 4:0a17a8a82c4c 452 _window(draw_x3, draw_y3, 1, 1);
plskeggs 4:0a17a8a82c4c 453 _putp(colour);
plskeggs 4:0a17a8a82c4c 454 }
plskeggs 4:0a17a8a82c4c 455
plskeggs 4:0a17a8a82c4c 456 if( (draw_x4 <= /*OLED_DISPLAY_HEIGHT*/NOKIALCD_WIDTH) && (draw_y4 >= 0) )
plskeggs 4:0a17a8a82c4c 457 {
plskeggs 4:0a17a8a82c4c 458 _window(draw_x4, draw_y4, 1, 1);
plskeggs 4:0a17a8a82c4c 459 _putp(colour);
plskeggs 4:0a17a8a82c4c 460 }
plskeggs 4:0a17a8a82c4c 461
plskeggs 4:0a17a8a82c4c 462 if( (draw_x5 >= 0) && (draw_y5 >= 0) )
plskeggs 4:0a17a8a82c4c 463 {
plskeggs 4:0a17a8a82c4c 464 _window(draw_x5, draw_y5, 1, 1);
plskeggs 4:0a17a8a82c4c 465 _putp(colour);
plskeggs 4:0a17a8a82c4c 466 }
plskeggs 4:0a17a8a82c4c 467 if( (draw_x6 <= NOKIALCD_WIDTH) && (draw_y6 <= NOKIALCD_HEIGHT) )
plskeggs 4:0a17a8a82c4c 468 {
plskeggs 4:0a17a8a82c4c 469 _window(draw_x6, draw_y6, 1, 1);
plskeggs 4:0a17a8a82c4c 470 _putp(colour);
plskeggs 4:0a17a8a82c4c 471 }
plskeggs 4:0a17a8a82c4c 472 if( (draw_x7 >= 0) && (draw_y7 <= NOKIALCD_HEIGHT) )
plskeggs 4:0a17a8a82c4c 473 {
plskeggs 4:0a17a8a82c4c 474 _window(draw_x7, draw_y7, 1, 1);
plskeggs 4:0a17a8a82c4c 475 _putp(colour);
plskeggs 4:0a17a8a82c4c 476 }
plskeggs 4:0a17a8a82c4c 477 }
plskeggs 4:0a17a8a82c4c 478 _cs = 1;
plskeggs 4:0a17a8a82c4c 479 return;
plskeggs 4:0a17a8a82c4c 480 }
plskeggs 4:0a17a8a82c4c 481
plskeggs 4:0a17a8a82c4c 482 void NokiaLCD::line(int x0, int y0, int x1, int y1, int colour) {
plskeggs 4:0a17a8a82c4c 483 int dx = 0, dy = 0;
plskeggs 4:0a17a8a82c4c 484 int dx_sym = 0, dy_sym = 0;
plskeggs 4:0a17a8a82c4c 485 int dx_x2 = 0, dy_x2 = 0;
plskeggs 4:0a17a8a82c4c 486 int di = 0;
plskeggs 4:0a17a8a82c4c 487
plskeggs 4:0a17a8a82c4c 488 _cs = 0; // Chipselect the LCD.
plskeggs 4:0a17a8a82c4c 489
plskeggs 4:0a17a8a82c4c 490 dx = x1-x0;
plskeggs 4:0a17a8a82c4c 491 dy = y1-y0;
plskeggs 4:0a17a8a82c4c 492
plskeggs 4:0a17a8a82c4c 493
plskeggs 4:0a17a8a82c4c 494 if(dx == 0) /* vertical line */
plskeggs 4:0a17a8a82c4c 495 {
plskeggs 4:0a17a8a82c4c 496 for(int y=y0; y<y1; y++){
plskeggs 4:0a17a8a82c4c 497 _window(x0, y, 1, 1);
plskeggs 4:0a17a8a82c4c 498 _putp(colour);
plskeggs 4:0a17a8a82c4c 499 }
plskeggs 4:0a17a8a82c4c 500 return;
plskeggs 4:0a17a8a82c4c 501 }
plskeggs 4:0a17a8a82c4c 502
plskeggs 4:0a17a8a82c4c 503 if(dx > 0)
plskeggs 4:0a17a8a82c4c 504 {
plskeggs 4:0a17a8a82c4c 505 dx_sym = 1;
plskeggs 4:0a17a8a82c4c 506 }
plskeggs 4:0a17a8a82c4c 507 else
plskeggs 4:0a17a8a82c4c 508 {
plskeggs 4:0a17a8a82c4c 509 dx_sym = -1;
plskeggs 4:0a17a8a82c4c 510 }
plskeggs 4:0a17a8a82c4c 511
plskeggs 4:0a17a8a82c4c 512
plskeggs 4:0a17a8a82c4c 513 if(dy == 0) /* horizontal line */
plskeggs 4:0a17a8a82c4c 514 {
plskeggs 4:0a17a8a82c4c 515 for(int x=x0; x<x1; x++){
plskeggs 4:0a17a8a82c4c 516 _window(x, y0, 1, 1);
plskeggs 4:0a17a8a82c4c 517 _putp(colour);
plskeggs 4:0a17a8a82c4c 518 }
plskeggs 4:0a17a8a82c4c 519 return;
plskeggs 4:0a17a8a82c4c 520 }
plskeggs 4:0a17a8a82c4c 521
plskeggs 4:0a17a8a82c4c 522
plskeggs 4:0a17a8a82c4c 523 if(dy > 0)
plskeggs 4:0a17a8a82c4c 524 {
plskeggs 4:0a17a8a82c4c 525 dy_sym = 1;
plskeggs 4:0a17a8a82c4c 526 }
plskeggs 4:0a17a8a82c4c 527 else
plskeggs 4:0a17a8a82c4c 528 {
plskeggs 4:0a17a8a82c4c 529 dy_sym = -1;
plskeggs 4:0a17a8a82c4c 530 }
plskeggs 4:0a17a8a82c4c 531
plskeggs 4:0a17a8a82c4c 532 dx = dx_sym*dx;
plskeggs 4:0a17a8a82c4c 533 dy = dy_sym*dy;
plskeggs 4:0a17a8a82c4c 534
plskeggs 4:0a17a8a82c4c 535 dx_x2 = dx*2;
plskeggs 4:0a17a8a82c4c 536 dy_x2 = dy*2;
plskeggs 4:0a17a8a82c4c 537
plskeggs 4:0a17a8a82c4c 538 if(dx >= dy)
plskeggs 4:0a17a8a82c4c 539 {
plskeggs 4:0a17a8a82c4c 540 di = dy_x2 - dx;
plskeggs 4:0a17a8a82c4c 541 while(x0 != x1)
plskeggs 4:0a17a8a82c4c 542 {
plskeggs 4:0a17a8a82c4c 543
plskeggs 4:0a17a8a82c4c 544 _window(x0, y0, 1, 1);
plskeggs 4:0a17a8a82c4c 545 _putp(colour);
plskeggs 4:0a17a8a82c4c 546 x0 += dx_sym;
plskeggs 4:0a17a8a82c4c 547 if(di<0)
plskeggs 4:0a17a8a82c4c 548 {
plskeggs 4:0a17a8a82c4c 549 di += dy_x2;
plskeggs 4:0a17a8a82c4c 550 }
plskeggs 4:0a17a8a82c4c 551 else
plskeggs 4:0a17a8a82c4c 552 {
plskeggs 4:0a17a8a82c4c 553 di += dy_x2 - dx_x2;
plskeggs 4:0a17a8a82c4c 554 y0 += dy_sym;
plskeggs 4:0a17a8a82c4c 555 }
plskeggs 4:0a17a8a82c4c 556 }
plskeggs 4:0a17a8a82c4c 557 _window(x0, y0, 1, 1);
plskeggs 4:0a17a8a82c4c 558 _putp(colour);
plskeggs 4:0a17a8a82c4c 559 }
plskeggs 4:0a17a8a82c4c 560 else
plskeggs 4:0a17a8a82c4c 561 {
plskeggs 4:0a17a8a82c4c 562 di = dx_x2 - dy;
plskeggs 4:0a17a8a82c4c 563 while(y0 != y1)
plskeggs 4:0a17a8a82c4c 564 {
plskeggs 4:0a17a8a82c4c 565 _window(x0, y0, 1, 1);
plskeggs 4:0a17a8a82c4c 566 _putp(colour);
plskeggs 4:0a17a8a82c4c 567 y0 += dy_sym;
plskeggs 4:0a17a8a82c4c 568 if(di < 0)
plskeggs 4:0a17a8a82c4c 569 {
plskeggs 4:0a17a8a82c4c 570 di += dx_x2;
plskeggs 4:0a17a8a82c4c 571 }
plskeggs 4:0a17a8a82c4c 572 else
plskeggs 4:0a17a8a82c4c 573 {
plskeggs 4:0a17a8a82c4c 574 di += dx_x2 - dy_x2;
plskeggs 4:0a17a8a82c4c 575 x0 += dx_sym;
plskeggs 4:0a17a8a82c4c 576 }
plskeggs 4:0a17a8a82c4c 577 }
plskeggs 4:0a17a8a82c4c 578 _window(x0, y0, 1, 1);
plskeggs 4:0a17a8a82c4c 579 _putp(colour);
plskeggs 4:0a17a8a82c4c 580 }
plskeggs 4:0a17a8a82c4c 581 _cs = 1;
plskeggs 4:0a17a8a82c4c 582 return;
plskeggs 4:0a17a8a82c4c 583 }
plskeggs 4:0a17a8a82c4c 584
simon 0:ff874f85ed33 585 void NokiaLCD::blit(int x, int y, int width, int height, const int* colour) {
simon 0:ff874f85ed33 586 _cs = 0;
simon 0:ff874f85ed33 587 _window(x, y, width, height);
simon 1:8f005b0dcfa7 588
simon 1:8f005b0dcfa7 589 switch (_type) {
simon 1:8f005b0dcfa7 590 case LCD6100:
simon 1:8f005b0dcfa7 591 case PCF8833:
simon 1:8f005b0dcfa7 592 for (int i=0; i<width*height; i++) {
simon 1:8f005b0dcfa7 593 _putp(colour[i]);
simon 1:8f005b0dcfa7 594 }
simon 1:8f005b0dcfa7 595 break;
simon 1:8f005b0dcfa7 596 case LCD6610:
simon 1:8f005b0dcfa7 597 for (int i=0; i<width*height/2; i++) {
ichoudhury6 3:ea0c085881f3 598 int r41 = (colour[i*2] >> (16 + 4)) & 0xF;
ichoudhury6 3:ea0c085881f3 599 int g41 = (colour[i*2] >> (8 + 4)) & 0xF;
ichoudhury6 3:ea0c085881f3 600 int b41 = (colour[i*2] >> (0 + 4)) & 0xF;
ichoudhury6 3:ea0c085881f3 601
simon 1:8f005b0dcfa7 602 int r42 = (colour[i*2+1] >> (16 + 4)) & 0xF;
ichoudhury6 3:ea0c085881f3 603 int g42 = (colour[i*2+1] >> (8 + 4)) & 0xF;
ichoudhury6 3:ea0c085881f3 604 int b42 = (colour[i*2+1] >> (0 + 4)) & 0xF;
ichoudhury6 3:ea0c085881f3 605 int d1 = (r41 << 4) | g41;
ichoudhury6 3:ea0c085881f3 606 int d2 = (b41 << 4) | r42;
ichoudhury6 3:ea0c085881f3 607 int d3 = (g42 << 4) | b42;
ichoudhury6 3:ea0c085881f3 608 data(d1);
ichoudhury6 3:ea0c085881f3 609 data(d2);
ichoudhury6 3:ea0c085881f3 610 data(d3);
simon 1:8f005b0dcfa7 611 }
simon 1:8f005b0dcfa7 612 break;
simon 1:8f005b0dcfa7 613 }
simon 0:ff874f85ed33 614 _window(0, 0, NOKIALCD_WIDTH, NOKIALCD_HEIGHT);
simon 0:ff874f85ed33 615 _cs = 1;
simon 0:ff874f85ed33 616 }
simon 0:ff874f85ed33 617
simon 0:ff874f85ed33 618 void NokiaLCD::bitblit(int x, int y, int width, int height, const char* bitstream) {
simon 0:ff874f85ed33 619 _cs = 0;
simon 0:ff874f85ed33 620 _window(x, y, width, height);
simon 1:8f005b0dcfa7 621
simon 1:8f005b0dcfa7 622 switch (_type) {
simon 1:8f005b0dcfa7 623 case LCD6100:
simon 1:8f005b0dcfa7 624 case PCF8833:
simon 1:8f005b0dcfa7 625 for (int i=0; i<height*width; i++) {
simon 1:8f005b0dcfa7 626 int byte = i / 8;
simon 1:8f005b0dcfa7 627 int bit = i % 8;
simon 1:8f005b0dcfa7 628 int colour = ((bitstream[byte] << bit) & 0x80) ? _foreground : _background;
simon 1:8f005b0dcfa7 629 _putp(colour);
simon 1:8f005b0dcfa7 630 }
simon 1:8f005b0dcfa7 631 break;
simon 1:8f005b0dcfa7 632 case LCD6610:
simon 1:8f005b0dcfa7 633 for(int i=0; i<height*width/2; i++) {
simon 1:8f005b0dcfa7 634 int byte1 = (i*2) / 8;
simon 1:8f005b0dcfa7 635 int bit1 = (i*2) % 8;
ichoudhury6 3:ea0c085881f3 636 int colour1 = ((bitstream[byte1] << bit1) & 0x80) ? _foreground : _background;
ichoudhury6 3:ea0c085881f3 637 int byte2 = (i*2+1) / 8;
simon 1:8f005b0dcfa7 638 int bit2 = (i*2+1) % 8;
simon 1:8f005b0dcfa7 639 int colour2 = ((bitstream[byte2] << bit2) & 0x80) ? _foreground : _background;
ichoudhury6 3:ea0c085881f3 640
ichoudhury6 3:ea0c085881f3 641 int r41 = (colour1 >> (16 + 4)) & 0xF;
ichoudhury6 3:ea0c085881f3 642 int g41 = (colour1 >> (8 + 4)) & 0xF;
ichoudhury6 3:ea0c085881f3 643 int b41 = (colour1 >> (0 + 4)) & 0xF;
ichoudhury6 3:ea0c085881f3 644
simon 1:8f005b0dcfa7 645 int r42 = (colour2 >> (16 + 4)) & 0xF;
ichoudhury6 3:ea0c085881f3 646 int g42 = (colour2 >> (8 + 4)) & 0xF;
ichoudhury6 3:ea0c085881f3 647 int b42 = (colour2 >> (0 + 4)) & 0xF;
ichoudhury6 3:ea0c085881f3 648 int d1 = (r41 << 4) | g41;
ichoudhury6 3:ea0c085881f3 649 int d2 = (b41 << 4) | r42;
ichoudhury6 3:ea0c085881f3 650 int d3 = (g42 << 4) | b42;
ichoudhury6 3:ea0c085881f3 651 data(d1);
ichoudhury6 3:ea0c085881f3 652 data(d2);
ichoudhury6 3:ea0c085881f3 653 data(d3);
simon 1:8f005b0dcfa7 654 }
simon 1:8f005b0dcfa7 655 break;
simon 1:8f005b0dcfa7 656 }
simon 0:ff874f85ed33 657 _window(0, 0, _width, _height);
simon 0:ff874f85ed33 658 _cs = 1;
simon 0:ff874f85ed33 659 }
simon 0:ff874f85ed33 660
simon 0:ff874f85ed33 661 void NokiaLCD::foreground(int c) {
simon 0:ff874f85ed33 662 _foreground = c;
simon 0:ff874f85ed33 663 }
simon 0:ff874f85ed33 664
simon 0:ff874f85ed33 665 void NokiaLCD::background(int c) {
simon 0:ff874f85ed33 666 _background = c;
simon 0:ff874f85ed33 667 }
simon 0:ff874f85ed33 668
simon 0:ff874f85ed33 669 int NokiaLCD::width() {
simon 0:ff874f85ed33 670 return NOKIALCD_WIDTH;
simon 0:ff874f85ed33 671 }
simon 0:ff874f85ed33 672
simon 0:ff874f85ed33 673 int NokiaLCD::height() {
simon 0:ff874f85ed33 674 return NOKIALCD_HEIGHT;
simon 0:ff874f85ed33 675 }
simon 0:ff874f85ed33 676
simon 0:ff874f85ed33 677 int NokiaLCD::columns() {
simon 0:ff874f85ed33 678 return NOKIALCD_COLS;
simon 0:ff874f85ed33 679 }
simon 0:ff874f85ed33 680
simon 0:ff874f85ed33 681 int NokiaLCD::rows() {
simon 0:ff874f85ed33 682 return NOKIALCD_ROWS;
simon 0:ff874f85ed33 683 }