bo barry / Menu2

Menu/joystick/HMC5883L/MMA7660/application board program

Fork of C12832_lcd by Peter Drescher

C12832_lcd.cpp@0:4bbc531be6e2, 2012-10-16 (annotated)

Committer:
dreschpe
Date:
Tue Oct 16 14:05:57 2012 +0000
Revision:
0:4bbc531be6e2
Child:
1:66dd8afbfd06
version 1.0

Who changed what in which revision?

UserRevisionLine numberNew contents of line
dreschpe 0:4bbc531be6e2 1 /* mbed library for the mbed Lab Board 128*32 pixel LCD
dreschpe 0:4bbc531be6e2 2 * use C12832 controller
dreschpe 0:4bbc531be6e2 3 * Copyright (c) 2012 Peter Drescher - DC2PD
dreschpe 0:4bbc531be6e2 4 * Released under the MIT License: http://mbed.org/license/mit
dreschpe 0:4bbc531be6e2 5 *
dreschpe 0:4bbc531be6e2 6 * THE SOFTWARE IS PROVIDED "AS IS", WITHOUT WARRANTY OF ANY KIND, EXPRESS OR
dreschpe 0:4bbc531be6e2 7 * IMPLIED, INCLUDING BUT NOT LIMITED TO THE WARRANTIES OF MERCHANTABILITY,
dreschpe 0:4bbc531be6e2 8 * FITNESS FOR A PARTICULAR PURPOSE AND NONINFRINGEMENT. IN NO EVENT SHALL THE
dreschpe 0:4bbc531be6e2 9 * AUTHORS OR COPYRIGHT HOLDERS BE LIABLE FOR ANY CLAIM, DAMAGES OR OTHER
dreschpe 0:4bbc531be6e2 10 * LIABILITY, WHETHER IN AN ACTION OF CONTRACT, TORT OR OTHERWISE, ARISING FROM,
dreschpe 0:4bbc531be6e2 11 * OUT OF OR IN CONNECTION WITH THE SOFTWARE OR THE USE OR OTHER DEALINGS IN
dreschpe 0:4bbc531be6e2 12 * THE SOFTWARE.
dreschpe 0:4bbc531be6e2 13 */
dreschpe 0:4bbc531be6e2 14
dreschpe 0:4bbc531be6e2 15 // 13.10.12 initial design
dreschpe 0:4bbc531be6e2 16 // optional defines :
dreschpe 0:4bbc531be6e2 17 #define debug_lcd 1
dreschpe 0:4bbc531be6e2 18
dreschpe 0:4bbc531be6e2 19 #include "C12832_lcd.h"
dreschpe 0:4bbc531be6e2 20 #include "mbed.h"
dreschpe 0:4bbc531be6e2 21 #include "stdio.h"
dreschpe 0:4bbc531be6e2 22
dreschpe 0:4bbc531be6e2 23 #define BPP 1 // Bits per pixel
dreschpe 0:4bbc531be6e2 24
dreschpe 0:4bbc531be6e2 25 C12832_LCD::C12832_LCD(const char* name)
dreschpe 0:4bbc531be6e2 26 : _spi(p5,NC,p7),_reset(p6),_A0(p8),_CS(p11),GraphicsDisplay(name)
dreschpe 0:4bbc531be6e2 27 {
dreschpe 0:4bbc531be6e2 28 orientation = 1;
dreschpe 0:4bbc531be6e2 29 draw_mode = NORMAL;
dreschpe 0:4bbc531be6e2 30 char_x = 0;
dreschpe 0:4bbc531be6e2 31 lcd_reset();
dreschpe 0:4bbc531be6e2 32 }
dreschpe 0:4bbc531be6e2 33
dreschpe 0:4bbc531be6e2 34 int C12832_LCD::width()
dreschpe 0:4bbc531be6e2 35 {
dreschpe 0:4bbc531be6e2 36 if (orientation == 0 || orientation == 2) return 32;
dreschpe 0:4bbc531be6e2 37 else return 128;
dreschpe 0:4bbc531be6e2 38 }
dreschpe 0:4bbc531be6e2 39
dreschpe 0:4bbc531be6e2 40 int C12832_LCD::height()
dreschpe 0:4bbc531be6e2 41 {
dreschpe 0:4bbc531be6e2 42 if (orientation == 0 || orientation == 2) return 128;
dreschpe 0:4bbc531be6e2 43 else return 32;
dreschpe 0:4bbc531be6e2 44 }
dreschpe 0:4bbc531be6e2 45
dreschpe 0:4bbc531be6e2 46
dreschpe 0:4bbc531be6e2 47 void C12832_LCD::set_orientation(unsigned int o)
dreschpe 0:4bbc531be6e2 48 {
dreschpe 0:4bbc531be6e2 49 orientation = o;
dreschpe 0:4bbc531be6e2 50 switch (o) {
dreschpe 0:4bbc531be6e2 51 case (0):
dreschpe 0:4bbc531be6e2 52 wr_cmd(0xA0);
dreschpe 0:4bbc531be6e2 53 wr_cmd(0xC0);
dreschpe 0:4bbc531be6e2 54 break;
dreschpe 0:4bbc531be6e2 55 case (1):
dreschpe 0:4bbc531be6e2 56 wr_cmd(0xA0);
dreschpe 0:4bbc531be6e2 57 wr_cmd(0xC8);
dreschpe 0:4bbc531be6e2 58 break;
dreschpe 0:4bbc531be6e2 59 case (2):
dreschpe 0:4bbc531be6e2 60 wr_cmd(0xA1);
dreschpe 0:4bbc531be6e2 61 wr_cmd(0xC8);
dreschpe 0:4bbc531be6e2 62 break;
dreschpe 0:4bbc531be6e2 63 case (3):
dreschpe 0:4bbc531be6e2 64 wr_cmd(0xA1);
dreschpe 0:4bbc531be6e2 65 wr_cmd(0xC0);
dreschpe 0:4bbc531be6e2 66 break;
dreschpe 0:4bbc531be6e2 67 }
dreschpe 0:4bbc531be6e2 68 }
dreschpe 0:4bbc531be6e2 69
dreschpe 0:4bbc531be6e2 70 void C12832_LCD::invert(unsigned int o)
dreschpe 0:4bbc531be6e2 71 {
dreschpe 0:4bbc531be6e2 72 if(o == 0) wr_cmd(0xA6);
dreschpe 0:4bbc531be6e2 73 else wr_cmd(0xA7);
dreschpe 0:4bbc531be6e2 74 }
dreschpe 0:4bbc531be6e2 75
dreschpe 0:4bbc531be6e2 76
dreschpe 0:4bbc531be6e2 77 void C12832_LCD::set_contrast(unsigned int o)
dreschpe 0:4bbc531be6e2 78 {
dreschpe 0:4bbc531be6e2 79 wr_cmd(0x81); // set volume
dreschpe 0:4bbc531be6e2 80 wr_cmd(o & 0x2F);
dreschpe 0:4bbc531be6e2 81 }
dreschpe 0:4bbc531be6e2 82
dreschpe 0:4bbc531be6e2 83
dreschpe 0:4bbc531be6e2 84 // write command to lcd controller
dreschpe 0:4bbc531be6e2 85
dreschpe 0:4bbc531be6e2 86 void C12832_LCD::wr_cmd(unsigned char cmd)
dreschpe 0:4bbc531be6e2 87 {
dreschpe 0:4bbc531be6e2 88 _A0 = 0;
dreschpe 0:4bbc531be6e2 89 _CS = 0;
dreschpe 0:4bbc531be6e2 90 LPC_SSP1->DR = cmd;
dreschpe 0:4bbc531be6e2 91 do {
dreschpe 0:4bbc531be6e2 92 } while ((LPC_SSP1->SR & 0x10) == 0x10); // wait for SPI1 idle
dreschpe 0:4bbc531be6e2 93 _CS = 1;
dreschpe 0:4bbc531be6e2 94 }
dreschpe 0:4bbc531be6e2 95
dreschpe 0:4bbc531be6e2 96 // write data to lcd controller
dreschpe 0:4bbc531be6e2 97
dreschpe 0:4bbc531be6e2 98 void C12832_LCD::wr_dat(unsigned char dat)
dreschpe 0:4bbc531be6e2 99 {
dreschpe 0:4bbc531be6e2 100 _A0 = 1;
dreschpe 0:4bbc531be6e2 101 _CS = 0;
dreschpe 0:4bbc531be6e2 102 LPC_SSP1->DR = dat;
dreschpe 0:4bbc531be6e2 103 do {
dreschpe 0:4bbc531be6e2 104 } while ((LPC_SSP1->SR & 0x10) == 0x10); // wait for SPI1 idle
dreschpe 0:4bbc531be6e2 105 _CS = 1;
dreschpe 0:4bbc531be6e2 106 }
dreschpe 0:4bbc531be6e2 107
dreschpe 0:4bbc531be6e2 108 // reset and init the lcd controller
dreschpe 0:4bbc531be6e2 109
dreschpe 0:4bbc531be6e2 110 void C12832_LCD::lcd_reset()
dreschpe 0:4bbc531be6e2 111 {
dreschpe 0:4bbc531be6e2 112
dreschpe 0:4bbc531be6e2 113 _spi.format(8,3); // 8 bit spi mode 3
dreschpe 0:4bbc531be6e2 114 _spi.frequency(20000000); // 19,2 Mhz SPI clock
dreschpe 0:4bbc531be6e2 115 DigitalOut _reset(p6);
dreschpe 0:4bbc531be6e2 116 _A0 = 0;
dreschpe 0:4bbc531be6e2 117 _CS = 1;
dreschpe 0:4bbc531be6e2 118 _reset = 0; // display reset
dreschpe 0:4bbc531be6e2 119 wait_us(50);
dreschpe 0:4bbc531be6e2 120 _reset = 1; // end reset
dreschpe 0:4bbc531be6e2 121 wait_ms(5);
dreschpe 0:4bbc531be6e2 122
dreschpe 0:4bbc531be6e2 123 /* Start Initial Sequence ----------------------------------------------------*/
dreschpe 0:4bbc531be6e2 124
dreschpe 0:4bbc531be6e2 125 wr_cmd(0xAE); // display off
dreschpe 0:4bbc531be6e2 126 wr_cmd(0xA2); // bias voltage
dreschpe 0:4bbc531be6e2 127
dreschpe 0:4bbc531be6e2 128 wr_cmd(0xA0);
dreschpe 0:4bbc531be6e2 129 wr_cmd(0xC8); // colum normal
dreschpe 0:4bbc531be6e2 130
dreschpe 0:4bbc531be6e2 131 wr_cmd(0x22); // voltage resistor ratio
dreschpe 0:4bbc531be6e2 132 wr_cmd(0x2F); // power on
dreschpe 0:4bbc531be6e2 133 wr_cmd(0xA4); // LCD display ram
dreschpe 0:4bbc531be6e2 134 wr_cmd(0x40); // start line = 0
dreschpe 0:4bbc531be6e2 135 wr_cmd(0xAF); // display ON
dreschpe 0:4bbc531be6e2 136
dreschpe 0:4bbc531be6e2 137 wr_cmd(0x81); // set contrast
dreschpe 0:4bbc531be6e2 138 wr_cmd(0x17); // set contrast
dreschpe 0:4bbc531be6e2 139
dreschpe 0:4bbc531be6e2 140 wr_cmd(0xA6); // display normal
dreschpe 0:4bbc531be6e2 141
dreschpe 0:4bbc531be6e2 142 //setup DMA channel 0
dreschpe 0:4bbc531be6e2 143 LPC_SC->PCONP |= (1UL << 29); // Power up the GPDMA
dreschpe 0:4bbc531be6e2 144 LPC_GPDMA->DMACConfig = 1; // enable DMA controller
dreschpe 0:4bbc531be6e2 145 LPC_GPDMA->DMACIntTCClear = 0x1;
dreschpe 0:4bbc531be6e2 146 LPC_GPDMA->DMACIntErrClr = 0x1;
dreschpe 0:4bbc531be6e2 147 LPC_GPDMACH0->DMACCLLI = 0;
dreschpe 0:4bbc531be6e2 148 // clear and update LCD
dreschpe 0:4bbc531be6e2 149 memset(buffer,0x00,512); // clear display buffer
dreschpe 0:4bbc531be6e2 150 copy_to_lcd();
dreschpe 0:4bbc531be6e2 151 }
dreschpe 0:4bbc531be6e2 152
dreschpe 0:4bbc531be6e2 153 // set one pixel in buffer
dreschpe 0:4bbc531be6e2 154
dreschpe 0:4bbc531be6e2 155 void C12832_LCD::pixel(int x, int y, int color)
dreschpe 0:4bbc531be6e2 156 {
dreschpe 0:4bbc531be6e2 157 // first check parameter
dreschpe 0:4bbc531be6e2 158 if(x > 128 || y > 32 || x < 0 || y < 0) return;
dreschpe 0:4bbc531be6e2 159
dreschpe 0:4bbc531be6e2 160 if(draw_mode == NORMAL) {
dreschpe 0:4bbc531be6e2 161 if(color == 0)
dreschpe 0:4bbc531be6e2 162 buffer[x + ((y/8) * 128)] &= ~(1 << (y%8)); // erase pixel
dreschpe 0:4bbc531be6e2 163 else
dreschpe 0:4bbc531be6e2 164 buffer[x + ((y/8) * 128)] |= (1 << (y%8)); // set pixel
dreschpe 0:4bbc531be6e2 165 } else { // XOR mode
dreschpe 0:4bbc531be6e2 166 if(color == 1)
dreschpe 0:4bbc531be6e2 167 buffer[x + ((y/8) * 128)] ^= (1 << (y%8)); // xor pixel
dreschpe 0:4bbc531be6e2 168 }
dreschpe 0:4bbc531be6e2 169 }
dreschpe 0:4bbc531be6e2 170
dreschpe 0:4bbc531be6e2 171 // update lcd
dreschpe 0:4bbc531be6e2 172
dreschpe 0:4bbc531be6e2 173 void C12832_LCD::copy_to_lcd(void)
dreschpe 0:4bbc531be6e2 174 {
dreschpe 0:4bbc531be6e2 175 //page 0
dreschpe 0:4bbc531be6e2 176 wr_cmd(0x00); // set column low nibble 0
dreschpe 0:4bbc531be6e2 177 wr_cmd(0x10); // set column hi nibble 0
dreschpe 0:4bbc531be6e2 178 wr_cmd(0xB0); // set page address 0
dreschpe 0:4bbc531be6e2 179 _CS = 0;
dreschpe 0:4bbc531be6e2 180 _A0 = 1;
dreschpe 0:4bbc531be6e2 181 // start 128 byte DMA transfer to SPI1
dreschpe 0:4bbc531be6e2 182 LPC_GPDMACH0->DMACCDestAddr = (uint32_t)&LPC_SSP1->DR; // we send to SSP1
dreschpe 0:4bbc531be6e2 183 LPC_SSP1->DMACR = 0x2; // Enable SSP1 for DMA.
dreschpe 0:4bbc531be6e2 184 LPC_GPDMA->DMACIntTCClear = 0x1;
dreschpe 0:4bbc531be6e2 185 LPC_GPDMA->DMACIntErrClr = 0x1;
dreschpe 0:4bbc531be6e2 186 LPC_GPDMACH0->DMACCSrcAddr = (uint32_t) (buffer);
dreschpe 0:4bbc531be6e2 187 LPC_GPDMACH0->DMACCControl = 128 | (1UL << 31) | DMA_CHANNEL_SRC_INC ; // 8 bit transfer , address increment, interrupt
dreschpe 0:4bbc531be6e2 188 LPC_GPDMACH0->DMACCConfig = DMA_CHANNEL_ENABLE | DMA_TRANSFER_TYPE_M2P | DMA_DEST_SSP1_TX;
dreschpe 0:4bbc531be6e2 189 LPC_GPDMA->DMACSoftSReq = 0x1;
dreschpe 0:4bbc531be6e2 190 do {
dreschpe 0:4bbc531be6e2 191 } while ((LPC_GPDMA->DMACRawIntTCStat & 0x01) == 0); // DMA is running
dreschpe 0:4bbc531be6e2 192 do {
dreschpe 0:4bbc531be6e2 193 } while ((LPC_SSP1->SR & 0x10) == 0x10); // SPI1 not idle
dreschpe 0:4bbc531be6e2 194 _CS = 1;
dreschpe 0:4bbc531be6e2 195
dreschpe 0:4bbc531be6e2 196 // page 1
dreschpe 0:4bbc531be6e2 197 wr_cmd(0x00); // set column low nibble 0
dreschpe 0:4bbc531be6e2 198 wr_cmd(0x10); // set column hi nibble 0
dreschpe 0:4bbc531be6e2 199 wr_cmd(0xB1); // set page address 1
dreschpe 0:4bbc531be6e2 200 _CS = 0;
dreschpe 0:4bbc531be6e2 201 _A0 = 1;
dreschpe 0:4bbc531be6e2 202 // start 128 byte DMA transfer to SPI1
dreschpe 0:4bbc531be6e2 203 LPC_GPDMA->DMACIntTCClear = 0x1;
dreschpe 0:4bbc531be6e2 204 LPC_GPDMA->DMACIntErrClr = 0x1;
dreschpe 0:4bbc531be6e2 205 LPC_GPDMACH0->DMACCSrcAddr = (uint32_t) (buffer + 128);
dreschpe 0:4bbc531be6e2 206 LPC_GPDMACH0->DMACCControl = 128 | (1UL << 31) | DMA_CHANNEL_SRC_INC ; // 8 bit transfer , address increment, interrupt
dreschpe 0:4bbc531be6e2 207 LPC_GPDMACH0->DMACCConfig = DMA_CHANNEL_ENABLE | DMA_TRANSFER_TYPE_M2P | DMA_DEST_SSP1_TX;
dreschpe 0:4bbc531be6e2 208 LPC_GPDMA->DMACSoftSReq = 0x1;
dreschpe 0:4bbc531be6e2 209 do {
dreschpe 0:4bbc531be6e2 210 } while ((LPC_GPDMA->DMACRawIntTCStat & 0x01) == 0); // DMA is running
dreschpe 0:4bbc531be6e2 211 do {
dreschpe 0:4bbc531be6e2 212 } while ((LPC_SSP1->SR & 0x10) == 0x10); // SPI1 not idle
dreschpe 0:4bbc531be6e2 213 _CS = 1;
dreschpe 0:4bbc531be6e2 214
dreschpe 0:4bbc531be6e2 215 //page 2
dreschpe 0:4bbc531be6e2 216 wr_cmd(0x00); // set column low nibble 0
dreschpe 0:4bbc531be6e2 217 wr_cmd(0x10); // set column hi nibble 0
dreschpe 0:4bbc531be6e2 218 wr_cmd(0xB2); // set page address 2
dreschpe 0:4bbc531be6e2 219 _CS = 0;
dreschpe 0:4bbc531be6e2 220 _A0 = 1;
dreschpe 0:4bbc531be6e2 221 // start 128 byte DMA transfer to SPI1
dreschpe 0:4bbc531be6e2 222 LPC_GPDMA->DMACIntTCClear = 0x1;
dreschpe 0:4bbc531be6e2 223 LPC_GPDMA->DMACIntErrClr = 0x1;
dreschpe 0:4bbc531be6e2 224 LPC_GPDMACH0->DMACCSrcAddr = (uint32_t) (buffer + 256);
dreschpe 0:4bbc531be6e2 225 LPC_GPDMACH0->DMACCControl = 128 | (1UL << 31) | DMA_CHANNEL_SRC_INC ; // 8 bit transfer , address increment, interrupt
dreschpe 0:4bbc531be6e2 226 LPC_GPDMACH0->DMACCConfig = DMA_CHANNEL_ENABLE | DMA_TRANSFER_TYPE_M2P | DMA_DEST_SSP1_TX ;
dreschpe 0:4bbc531be6e2 227 LPC_GPDMA->DMACSoftSReq = 0x1;
dreschpe 0:4bbc531be6e2 228 do {
dreschpe 0:4bbc531be6e2 229 } while ((LPC_GPDMA->DMACRawIntTCStat & 0x01) == 0); // DMA is running
dreschpe 0:4bbc531be6e2 230 do {
dreschpe 0:4bbc531be6e2 231 } while ((LPC_SSP1->SR & 0x10) == 0x10); // SPI1 not idle
dreschpe 0:4bbc531be6e2 232 _CS = 1;
dreschpe 0:4bbc531be6e2 233
dreschpe 0:4bbc531be6e2 234 //page 3
dreschpe 0:4bbc531be6e2 235 wr_cmd(0x00); // set column low nibble 0
dreschpe 0:4bbc531be6e2 236 wr_cmd(0x10); // set column hi nibble 0
dreschpe 0:4bbc531be6e2 237 wr_cmd(0xB3); // set page address 3
dreschpe 0:4bbc531be6e2 238 _CS = 0;
dreschpe 0:4bbc531be6e2 239 _A0 = 1;
dreschpe 0:4bbc531be6e2 240 // start 128 byte DMA transfer to SPI1
dreschpe 0:4bbc531be6e2 241 LPC_GPDMA->DMACIntTCClear = 0x1;
dreschpe 0:4bbc531be6e2 242 LPC_GPDMA->DMACIntErrClr = 0x1;
dreschpe 0:4bbc531be6e2 243 LPC_GPDMACH0->DMACCSrcAddr = (uint32_t) (buffer + 384);
dreschpe 0:4bbc531be6e2 244 LPC_GPDMACH0->DMACCControl = 128 | (1UL << 31) | DMA_CHANNEL_SRC_INC ; // 8 bit transfer , address increment, interrupt
dreschpe 0:4bbc531be6e2 245 LPC_GPDMACH0->DMACCConfig = DMA_CHANNEL_ENABLE | DMA_TRANSFER_TYPE_M2P | DMA_DEST_SSP1_TX;
dreschpe 0:4bbc531be6e2 246 LPC_GPDMA->DMACSoftSReq = 0x1;
dreschpe 0:4bbc531be6e2 247 do {
dreschpe 0:4bbc531be6e2 248 } while ((LPC_GPDMA->DMACRawIntTCStat & 0x01) == 0); // DMA is running
dreschpe 0:4bbc531be6e2 249 do {
dreschpe 0:4bbc531be6e2 250 } while ((LPC_SSP1->SR & 0x10) == 0x10); // SPI1 not idle
dreschpe 0:4bbc531be6e2 251 _CS = 1;
dreschpe 0:4bbc531be6e2 252 }
dreschpe 0:4bbc531be6e2 253
dreschpe 0:4bbc531be6e2 254 void C12832_LCD::cls(void)
dreschpe 0:4bbc531be6e2 255 {
dreschpe 0:4bbc531be6e2 256 memset(buffer,0x00,512); // clear display buffer
dreschpe 0:4bbc531be6e2 257 copy_to_lcd();
dreschpe 0:4bbc531be6e2 258 }
dreschpe 0:4bbc531be6e2 259
dreschpe 0:4bbc531be6e2 260
dreschpe 0:4bbc531be6e2 261 void C12832_LCD::line(int x0, int y0, int x1, int y1, int color)
dreschpe 0:4bbc531be6e2 262 {
dreschpe 0:4bbc531be6e2 263 int dx = 0, dy = 0;
dreschpe 0:4bbc531be6e2 264 int dx_sym = 0, dy_sym = 0;
dreschpe 0:4bbc531be6e2 265 int dx_x2 = 0, dy_x2 = 0;
dreschpe 0:4bbc531be6e2 266 int di = 0;
dreschpe 0:4bbc531be6e2 267
dreschpe 0:4bbc531be6e2 268 dx = x1-x0;
dreschpe 0:4bbc531be6e2 269 dy = y1-y0;
dreschpe 0:4bbc531be6e2 270
dreschpe 0:4bbc531be6e2 271 // if (dx == 0) { /* vertical line */
dreschpe 0:4bbc531be6e2 272 // if (y1 > y0) vline(x0,y0,y1,color);
dreschpe 0:4bbc531be6e2 273 // else vline(x0,y1,y0,color);
dreschpe 0:4bbc531be6e2 274 // return;
dreschpe 0:4bbc531be6e2 275 // }
dreschpe 0:4bbc531be6e2 276
dreschpe 0:4bbc531be6e2 277 if (dx > 0) {
dreschpe 0:4bbc531be6e2 278 dx_sym = 1;
dreschpe 0:4bbc531be6e2 279 } else {
dreschpe 0:4bbc531be6e2 280 dx_sym = -1;
dreschpe 0:4bbc531be6e2 281 }
dreschpe 0:4bbc531be6e2 282 // if (dy == 0) { /* horizontal line */
dreschpe 0:4bbc531be6e2 283 // if (x1 > x0) hline(x0,x1,y0,color);
dreschpe 0:4bbc531be6e2 284 // else hline(x1,x0,y0,color);
dreschpe 0:4bbc531be6e2 285 // return;
dreschpe 0:4bbc531be6e2 286 // }
dreschpe 0:4bbc531be6e2 287
dreschpe 0:4bbc531be6e2 288 if (dy > 0) {
dreschpe 0:4bbc531be6e2 289 dy_sym = 1;
dreschpe 0:4bbc531be6e2 290 } else {
dreschpe 0:4bbc531be6e2 291 dy_sym = -1;
dreschpe 0:4bbc531be6e2 292 }
dreschpe 0:4bbc531be6e2 293
dreschpe 0:4bbc531be6e2 294 dx = dx_sym*dx;
dreschpe 0:4bbc531be6e2 295 dy = dy_sym*dy;
dreschpe 0:4bbc531be6e2 296
dreschpe 0:4bbc531be6e2 297 dx_x2 = dx*2;
dreschpe 0:4bbc531be6e2 298 dy_x2 = dy*2;
dreschpe 0:4bbc531be6e2 299
dreschpe 0:4bbc531be6e2 300 if (dx >= dy) {
dreschpe 0:4bbc531be6e2 301 di = dy_x2 - dx;
dreschpe 0:4bbc531be6e2 302 while (x0 != x1) {
dreschpe 0:4bbc531be6e2 303
dreschpe 0:4bbc531be6e2 304 pixel(x0, y0, color);
dreschpe 0:4bbc531be6e2 305 x0 += dx_sym;
dreschpe 0:4bbc531be6e2 306 if (di<0) {
dreschpe 0:4bbc531be6e2 307 di += dy_x2;
dreschpe 0:4bbc531be6e2 308 } else {
dreschpe 0:4bbc531be6e2 309 di += dy_x2 - dx_x2;
dreschpe 0:4bbc531be6e2 310 y0 += dy_sym;
dreschpe 0:4bbc531be6e2 311 }
dreschpe 0:4bbc531be6e2 312 }
dreschpe 0:4bbc531be6e2 313 pixel(x0, y0, color);
dreschpe 0:4bbc531be6e2 314 } else {
dreschpe 0:4bbc531be6e2 315 di = dx_x2 - dy;
dreschpe 0:4bbc531be6e2 316 while (y0 != y1) {
dreschpe 0:4bbc531be6e2 317 pixel(x0, y0, color);
dreschpe 0:4bbc531be6e2 318 y0 += dy_sym;
dreschpe 0:4bbc531be6e2 319 if (di < 0) {
dreschpe 0:4bbc531be6e2 320 di += dx_x2;
dreschpe 0:4bbc531be6e2 321 } else {
dreschpe 0:4bbc531be6e2 322 di += dx_x2 - dy_x2;
dreschpe 0:4bbc531be6e2 323 x0 += dx_sym;
dreschpe 0:4bbc531be6e2 324 }
dreschpe 0:4bbc531be6e2 325 }
dreschpe 0:4bbc531be6e2 326 pixel(x0, y0, color);
dreschpe 0:4bbc531be6e2 327 }
dreschpe 0:4bbc531be6e2 328 return;
dreschpe 0:4bbc531be6e2 329 }
dreschpe 0:4bbc531be6e2 330
dreschpe 0:4bbc531be6e2 331 void C12832_LCD::rect(int x0, int y0, int x1, int y1, int color)
dreschpe 0:4bbc531be6e2 332 {
dreschpe 0:4bbc531be6e2 333
dreschpe 0:4bbc531be6e2 334 if (x1 > x0) line(x0,y0,x1,y0,color);
dreschpe 0:4bbc531be6e2 335 else line(x1,y0,x0,y0,color);
dreschpe 0:4bbc531be6e2 336
dreschpe 0:4bbc531be6e2 337 if (y1 > y0) line(x0,y0,x0,y1,color);
dreschpe 0:4bbc531be6e2 338 else line(x0,y1,x0,y0,color);
dreschpe 0:4bbc531be6e2 339
dreschpe 0:4bbc531be6e2 340 if (x1 > x0) line(x0,y1,x1,y1,color);
dreschpe 0:4bbc531be6e2 341 else line(x1,y1,x0,y1,color);
dreschpe 0:4bbc531be6e2 342
dreschpe 0:4bbc531be6e2 343 if (y1 > y0) line(x1,y0,x1,y1,color);
dreschpe 0:4bbc531be6e2 344 else line(x1,y1,x1,y0,color);
dreschpe 0:4bbc531be6e2 345
dreschpe 0:4bbc531be6e2 346 return;
dreschpe 0:4bbc531be6e2 347 }
dreschpe 0:4bbc531be6e2 348
dreschpe 0:4bbc531be6e2 349 void C12832_LCD::fillrect(int x0, int y0, int x1, int y1, int color)
dreschpe 0:4bbc531be6e2 350 {
dreschpe 0:4bbc531be6e2 351 int l,c,i;
dreschpe 0:4bbc531be6e2 352 if(x0 > x1) {
dreschpe 0:4bbc531be6e2 353 i = x0;
dreschpe 0:4bbc531be6e2 354 x0 = x1;
dreschpe 0:4bbc531be6e2 355 x1 = i;
dreschpe 0:4bbc531be6e2 356 }
dreschpe 0:4bbc531be6e2 357
dreschpe 0:4bbc531be6e2 358 if(y0 > y1) {
dreschpe 0:4bbc531be6e2 359 i = y0;
dreschpe 0:4bbc531be6e2 360 y0 = y1;
dreschpe 0:4bbc531be6e2 361 y1 = i;
dreschpe 0:4bbc531be6e2 362 }
dreschpe 0:4bbc531be6e2 363
dreschpe 0:4bbc531be6e2 364 for(l = x0; l<= x1; l ++) {
dreschpe 0:4bbc531be6e2 365 for(c = y0; c<= y1; c++) {
dreschpe 0:4bbc531be6e2 366 pixel(l,c,color);
dreschpe 0:4bbc531be6e2 367 }
dreschpe 0:4bbc531be6e2 368 }
dreschpe 0:4bbc531be6e2 369 }
dreschpe 0:4bbc531be6e2 370
dreschpe 0:4bbc531be6e2 371
dreschpe 0:4bbc531be6e2 372
dreschpe 0:4bbc531be6e2 373 void C12832_LCD::circle(int x0, int y0, int r, int color)
dreschpe 0:4bbc531be6e2 374 {
dreschpe 0:4bbc531be6e2 375
dreschpe 0:4bbc531be6e2 376 int draw_x0, draw_y0;
dreschpe 0:4bbc531be6e2 377 int draw_x1, draw_y1;
dreschpe 0:4bbc531be6e2 378 int draw_x2, draw_y2;
dreschpe 0:4bbc531be6e2 379 int draw_x3, draw_y3;
dreschpe 0:4bbc531be6e2 380 int draw_x4, draw_y4;
dreschpe 0:4bbc531be6e2 381 int draw_x5, draw_y5;
dreschpe 0:4bbc531be6e2 382 int draw_x6, draw_y6;
dreschpe 0:4bbc531be6e2 383 int draw_x7, draw_y7;
dreschpe 0:4bbc531be6e2 384 int xx, yy;
dreschpe 0:4bbc531be6e2 385 int di;
dreschpe 0:4bbc531be6e2 386 //WindowMax();
dreschpe 0:4bbc531be6e2 387 if (r == 0) { /* no radius */
dreschpe 0:4bbc531be6e2 388 return;
dreschpe 0:4bbc531be6e2 389 }
dreschpe 0:4bbc531be6e2 390
dreschpe 0:4bbc531be6e2 391 draw_x0 = draw_x1 = x0;
dreschpe 0:4bbc531be6e2 392 draw_y0 = draw_y1 = y0 + r;
dreschpe 0:4bbc531be6e2 393 if (draw_y0 < height()) {
dreschpe 0:4bbc531be6e2 394 pixel(draw_x0, draw_y0, color); /* 90 degree */
dreschpe 0:4bbc531be6e2 395 }
dreschpe 0:4bbc531be6e2 396
dreschpe 0:4bbc531be6e2 397 draw_x2 = draw_x3 = x0;
dreschpe 0:4bbc531be6e2 398 draw_y2 = draw_y3 = y0 - r;
dreschpe 0:4bbc531be6e2 399 if (draw_y2 >= 0) {
dreschpe 0:4bbc531be6e2 400 pixel(draw_x2, draw_y2, color); /* 270 degree */
dreschpe 0:4bbc531be6e2 401 }
dreschpe 0:4bbc531be6e2 402
dreschpe 0:4bbc531be6e2 403 draw_x4 = draw_x6 = x0 + r;
dreschpe 0:4bbc531be6e2 404 draw_y4 = draw_y6 = y0;
dreschpe 0:4bbc531be6e2 405 if (draw_x4 < width()) {
dreschpe 0:4bbc531be6e2 406 pixel(draw_x4, draw_y4, color); /* 0 degree */
dreschpe 0:4bbc531be6e2 407 }
dreschpe 0:4bbc531be6e2 408
dreschpe 0:4bbc531be6e2 409 draw_x5 = draw_x7 = x0 - r;
dreschpe 0:4bbc531be6e2 410 draw_y5 = draw_y7 = y0;
dreschpe 0:4bbc531be6e2 411 if (draw_x5>=0) {
dreschpe 0:4bbc531be6e2 412 pixel(draw_x5, draw_y5, color); /* 180 degree */
dreschpe 0:4bbc531be6e2 413 }
dreschpe 0:4bbc531be6e2 414
dreschpe 0:4bbc531be6e2 415 if (r == 1) {
dreschpe 0:4bbc531be6e2 416 return;
dreschpe 0:4bbc531be6e2 417 }
dreschpe 0:4bbc531be6e2 418
dreschpe 0:4bbc531be6e2 419 di = 3 - 2*r;
dreschpe 0:4bbc531be6e2 420 xx = 0;
dreschpe 0:4bbc531be6e2 421 yy = r;
dreschpe 0:4bbc531be6e2 422 while (xx < yy) {
dreschpe 0:4bbc531be6e2 423
dreschpe 0:4bbc531be6e2 424 if (di < 0) {
dreschpe 0:4bbc531be6e2 425 di += 4*xx + 6;
dreschpe 0:4bbc531be6e2 426 } else {
dreschpe 0:4bbc531be6e2 427 di += 4*(xx - yy) + 10;
dreschpe 0:4bbc531be6e2 428 yy--;
dreschpe 0:4bbc531be6e2 429 draw_y0--;
dreschpe 0:4bbc531be6e2 430 draw_y1--;
dreschpe 0:4bbc531be6e2 431 draw_y2++;
dreschpe 0:4bbc531be6e2 432 draw_y3++;
dreschpe 0:4bbc531be6e2 433 draw_x4--;
dreschpe 0:4bbc531be6e2 434 draw_x5++;
dreschpe 0:4bbc531be6e2 435 draw_x6--;
dreschpe 0:4bbc531be6e2 436 draw_x7++;
dreschpe 0:4bbc531be6e2 437 }
dreschpe 0:4bbc531be6e2 438 xx++;
dreschpe 0:4bbc531be6e2 439 draw_x0++;
dreschpe 0:4bbc531be6e2 440 draw_x1--;
dreschpe 0:4bbc531be6e2 441 draw_x2++;
dreschpe 0:4bbc531be6e2 442 draw_x3--;
dreschpe 0:4bbc531be6e2 443 draw_y4++;
dreschpe 0:4bbc531be6e2 444 draw_y5++;
dreschpe 0:4bbc531be6e2 445 draw_y6--;
dreschpe 0:4bbc531be6e2 446 draw_y7--;
dreschpe 0:4bbc531be6e2 447
dreschpe 0:4bbc531be6e2 448 if ( (draw_x0 <= width()) && (draw_y0>=0) ) {
dreschpe 0:4bbc531be6e2 449 pixel(draw_x0, draw_y0, color);
dreschpe 0:4bbc531be6e2 450 }
dreschpe 0:4bbc531be6e2 451
dreschpe 0:4bbc531be6e2 452 if ( (draw_x1 >= 0) && (draw_y1 >= 0) ) {
dreschpe 0:4bbc531be6e2 453 pixel(draw_x1, draw_y1, color);
dreschpe 0:4bbc531be6e2 454 }
dreschpe 0:4bbc531be6e2 455
dreschpe 0:4bbc531be6e2 456 if ( (draw_x2 <= width()) && (draw_y2 <= height()) ) {
dreschpe 0:4bbc531be6e2 457 pixel(draw_x2, draw_y2, color);
dreschpe 0:4bbc531be6e2 458 }
dreschpe 0:4bbc531be6e2 459
dreschpe 0:4bbc531be6e2 460 if ( (draw_x3 >=0 ) && (draw_y3 <= height()) ) {
dreschpe 0:4bbc531be6e2 461 pixel(draw_x3, draw_y3, color);
dreschpe 0:4bbc531be6e2 462 }
dreschpe 0:4bbc531be6e2 463
dreschpe 0:4bbc531be6e2 464 if ( (draw_x4 <= width()) && (draw_y4 >= 0) ) {
dreschpe 0:4bbc531be6e2 465 pixel(draw_x4, draw_y4, color);
dreschpe 0:4bbc531be6e2 466 }
dreschpe 0:4bbc531be6e2 467
dreschpe 0:4bbc531be6e2 468 if ( (draw_x5 >= 0) && (draw_y5 >= 0) ) {
dreschpe 0:4bbc531be6e2 469 pixel(draw_x5, draw_y5, color);
dreschpe 0:4bbc531be6e2 470 }
dreschpe 0:4bbc531be6e2 471 if ( (draw_x6 <=width()) && (draw_y6 <= height()) ) {
dreschpe 0:4bbc531be6e2 472 pixel(draw_x6, draw_y6, color);
dreschpe 0:4bbc531be6e2 473 }
dreschpe 0:4bbc531be6e2 474 if ( (draw_x7 >= 0) && (draw_y7 <= height()) ) {
dreschpe 0:4bbc531be6e2 475 pixel(draw_x7, draw_y7, color);
dreschpe 0:4bbc531be6e2 476 }
dreschpe 0:4bbc531be6e2 477 }
dreschpe 0:4bbc531be6e2 478 return;
dreschpe 0:4bbc531be6e2 479 }
dreschpe 0:4bbc531be6e2 480
dreschpe 0:4bbc531be6e2 481 void C12832_LCD::fillcircle(int x, int y, int r, int color)
dreschpe 0:4bbc531be6e2 482 {
dreschpe 0:4bbc531be6e2 483 int i;
dreschpe 0:4bbc531be6e2 484 for (i = 0; i <= r; i++)
dreschpe 0:4bbc531be6e2 485 circle(x,y,i,color);
dreschpe 0:4bbc531be6e2 486 }
dreschpe 0:4bbc531be6e2 487
dreschpe 0:4bbc531be6e2 488 void C12832_LCD::setmode(int mode)
dreschpe 0:4bbc531be6e2 489 {
dreschpe 0:4bbc531be6e2 490 draw_mode = mode;
dreschpe 0:4bbc531be6e2 491 }
dreschpe 0:4bbc531be6e2 492
dreschpe 0:4bbc531be6e2 493 void C12832_LCD::locate(int x, int y)
dreschpe 0:4bbc531be6e2 494 {
dreschpe 0:4bbc531be6e2 495 char_x = x;
dreschpe 0:4bbc531be6e2 496 char_y = y;
dreschpe 0:4bbc531be6e2 497 }
dreschpe 0:4bbc531be6e2 498
dreschpe 0:4bbc531be6e2 499
dreschpe 0:4bbc531be6e2 500
dreschpe 0:4bbc531be6e2 501 int C12832_LCD::columns()
dreschpe 0:4bbc531be6e2 502 {
dreschpe 0:4bbc531be6e2 503 return width() / font[1];
dreschpe 0:4bbc531be6e2 504 }
dreschpe 0:4bbc531be6e2 505
dreschpe 0:4bbc531be6e2 506
dreschpe 0:4bbc531be6e2 507
dreschpe 0:4bbc531be6e2 508 int C12832_LCD::rows()
dreschpe 0:4bbc531be6e2 509 {
dreschpe 0:4bbc531be6e2 510 return height() / font[2];
dreschpe 0:4bbc531be6e2 511 }
dreschpe 0:4bbc531be6e2 512
dreschpe 0:4bbc531be6e2 513
dreschpe 0:4bbc531be6e2 514
dreschpe 0:4bbc531be6e2 515 int C12832_LCD::_putc(int value)
dreschpe 0:4bbc531be6e2 516 {
dreschpe 0:4bbc531be6e2 517 if (value == '\n') { // new line
dreschpe 0:4bbc531be6e2 518 char_x = 0;
dreschpe 0:4bbc531be6e2 519 char_y = char_y + font[2];
dreschpe 0:4bbc531be6e2 520 if (char_y >= height() - font[2]) {
dreschpe 0:4bbc531be6e2 521 char_y = 0;
dreschpe 0:4bbc531be6e2 522 }
dreschpe 0:4bbc531be6e2 523 } else {
dreschpe 0:4bbc531be6e2 524 character(char_x, char_y, value);
dreschpe 0:4bbc531be6e2 525 }
dreschpe 0:4bbc531be6e2 526 return value;
dreschpe 0:4bbc531be6e2 527 }
dreschpe 0:4bbc531be6e2 528
dreschpe 0:4bbc531be6e2 529 void C12832_LCD::character(int x, int y, int c)
dreschpe 0:4bbc531be6e2 530 {
dreschpe 0:4bbc531be6e2 531 unsigned int hor,vert,offset,bpl,j,i,b;
dreschpe 0:4bbc531be6e2 532 unsigned char* zeichen;
dreschpe 0:4bbc531be6e2 533 unsigned char z,w;
dreschpe 0:4bbc531be6e2 534
dreschpe 0:4bbc531be6e2 535 if ((c < 31) || (c > 127)) return; // test char range
dreschpe 0:4bbc531be6e2 536
dreschpe 0:4bbc531be6e2 537 // read font parameter from start of array
dreschpe 0:4bbc531be6e2 538 offset = font[0]; // bytes / char
dreschpe 0:4bbc531be6e2 539 hor = font[1]; // get hor size of font
dreschpe 0:4bbc531be6e2 540 vert = font[2]; // get vert size of font
dreschpe 0:4bbc531be6e2 541 bpl = font[3]; // bytes per line
dreschpe 0:4bbc531be6e2 542
dreschpe 0:4bbc531be6e2 543 if (char_x + hor > width()) {
dreschpe 0:4bbc531be6e2 544 char_x = 0;
dreschpe 0:4bbc531be6e2 545 char_y = char_y + vert;
dreschpe 0:4bbc531be6e2 546 if (char_y >= height() - font[2]) {
dreschpe 0:4bbc531be6e2 547 char_y = 0;
dreschpe 0:4bbc531be6e2 548 }
dreschpe 0:4bbc531be6e2 549 }
dreschpe 0:4bbc531be6e2 550
dreschpe 0:4bbc531be6e2 551 zeichen = &font[((c -32) * offset) + 4]; // start of char bitmap
dreschpe 0:4bbc531be6e2 552 w = zeichen[0]; // width of actual char
dreschpe 0:4bbc531be6e2 553 // construct the char into the buffer
dreschpe 0:4bbc531be6e2 554 for (j=0; j<vert; j++) { // vert line
dreschpe 0:4bbc531be6e2 555 for (i=0; i<hor; i++) { // horz line
dreschpe 0:4bbc531be6e2 556 z = zeichen[bpl * i + ((j & 0xF8) >> 3)+1];
dreschpe 0:4bbc531be6e2 557 b = 1 << (j & 0x07);
dreschpe 0:4bbc531be6e2 558 if (( z & b ) == 0x00) {
dreschpe 0:4bbc531be6e2 559 pixel(x+i,y+j,0);
dreschpe 0:4bbc531be6e2 560 } else {
dreschpe 0:4bbc531be6e2 561 pixel(x+i,y+j,1);
dreschpe 0:4bbc531be6e2 562 }
dreschpe 0:4bbc531be6e2 563
dreschpe 0:4bbc531be6e2 564 }
dreschpe 0:4bbc531be6e2 565 }
dreschpe 0:4bbc531be6e2 566
dreschpe 0:4bbc531be6e2 567 char_x += w;
dreschpe 0:4bbc531be6e2 568 }
dreschpe 0:4bbc531be6e2 569
dreschpe 0:4bbc531be6e2 570
dreschpe 0:4bbc531be6e2 571 void C12832_LCD::set_font(unsigned char* f)
dreschpe 0:4bbc531be6e2 572 {
dreschpe 0:4bbc531be6e2 573 font = f;
dreschpe 0:4bbc531be6e2 574 }
dreschpe 0:4bbc531be6e2 575
dreschpe 0:4bbc531be6e2 576
dreschpe 0:4bbc531be6e2 577