Toyomasa Watarai / ST7567

LPC General Purpose Shield (OM13082) LCD module library

Dependents:   OM13082-LCD OM13082-test LPCXpresso4337_OM13082_test lpc4337_acc_demo ... more

Fork of KT7567 by Toyomasa Watarai

ST7567.cpp@18:743aff4786ba, 2015-07-30 (annotated)

Committer:
MACRUM
Date:
Thu Jul 30 01:08:10 2015 +0000
Revision:
18:743aff4786ba
Parent:
K7567.cpp@17:6153719b6d99 
Corrected class/library naming

Who changed what in which revision?

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