SP1 vers 3

Dependencies:   Fonts

Revision:
2:5641e6bc9934
Parent:
1:03129e57a003
diff -r 03129e57a003 -r 5641e6bc9934 EADOG.cpp
--- a/EADOG.cpp	Thu Sep 22 11:28:11 2016 +0000
+++ b/EADOG.cpp	Tue Jun 08 10:36:48 2021 +0000
@@ -17,457 +17,488 @@
 #include "stdio.h"
 #include "Small_7.h"
 
-EADOG::EADOG(PinName mosi, PinName sck, PinName reset, PinName a0, PinName cs, uint8_t type) : _spi(mosi, NC, sck), _reset(reset), _a0(a0), _cs(cs), _type(type), graphic_buffer() {
-  if (_type == DOGM132) {
-    width = 132;
-    height = 32;
-    graphic_buffer_size = 528;
-    graphic_buffer = new uint8_t [graphic_buffer_size];
+EADOG::EADOG(PinName mosi, PinName sck, PinName reset, PinName a0, PinName cs, uint8_t type) : _spi(mosi, NC, sck), _reset(reset), _a0(a0), _cs(cs), _type(type), graphic_buffer()
+{
+    if (_type == DOGM132) {
+        width = 132;
+        height = 32;
+        graphic_buffer_size = 528;
+        graphic_buffer = new uint8_t [graphic_buffer_size];
     }
 
-  if (_type == DOGM128 || _type == DOGL128) {
-    width = 128;
-    height = 64;
-    graphic_buffer_size = 1024;
-    graphic_buffer = new uint8_t [graphic_buffer_size];
+    if (_type == DOGM128 || _type == DOGL128) {
+        width = 128;
+        height = 64;
+        graphic_buffer_size = 1024;
+        graphic_buffer = new uint8_t [graphic_buffer_size];
     }
     init();
-  }
+}
 
-static void inline swap(int &a, int &b) {
-  int c = a;
-  a = b;
-  b = c;
-  }
+static void inline swap(int &a, int &b)
+{
+    int c = a;
+    a = b;
+    b = c;
+}
 
-void EADOG::display(uint8_t display) {
-  if (display == ON) { // display on
-    write_command(0xA4);
-    write_command(0xAF);
+void EADOG::display(uint8_t display)
+{
+    if (display == ON) { // display on
+        write_command(0xA4);
+        write_command(0xAF);
     }
-  if (display == OFF) { // display off
-    write_command(0xAE);
+    if (display == OFF) { // display off
+        write_command(0xAE);
     }
 
-  if (display == SLEEP) {// display sleep
-    write_command(0xA5);
-    write_command(0xAE);
+    if (display == SLEEP) {// display sleep
+        write_command(0xA5);
+        write_command(0xAE);
     }
-  if(display == INVERT) { // invert display
-    write_command(0xA7);
+    if(display == INVERT) { // invert display
+        write_command(0xA7);
     }
-  if(display == DEFAULT) { // set to normal display
-    write_command(0xA6);
+    if(display == DEFAULT) { // set to normal display
+        write_command(0xA6);
     }
-  if (display == TOPVIEW) { // reverse orientation
-    write_command(0xA0); // ADC normal
-    write_command(0xC8); // reversed com31-com0
-    update(); // update necessary
-      }
-  if (display == BOTTOM) { // normal orientation
-    write_command(0xA1); // ADC reverse
-    write_command(0xC0); // normal com0-com31
-    update(); // update necessary
+    if (display == TOPVIEW) { // reverse orientation
+        write_command(0xA0); // ADC normal
+        write_command(0xC8); // reversed com31-com0
+        update(); // update necessary
+    }
+    if (display == BOTTOM) { // normal orientation
+        write_command(0xA1); // ADC reverse
+        write_command(0xC0); // normal com0-com31
+        update(); // update necessary
     }
-  if (display == CONTRAST) {
-    if (_type == DOGM132) {
-      write_command(0x81); //  set contrast to default for dogm 128
-      write_command(0x1F);
-      }
-    if (_type == DOGM128) {
-      write_command(0x81); //  set contrast to default for dogm132
-      write_command(0x16);
-      }
-    if (_type == DOGL128) {
-      write_command(0x81); //  set contrast to default for dogl132
-      write_command(0x10);
-      }
+    if (display == CONTRAST) {
+        if (_type == DOGM132) {
+            write_command(0x81); //  set contrast to default for dogm 128
+            write_command(0x1F);
+        }
+        if (_type == DOGM128) {
+            write_command(0x81); //  set contrast to default for dogm132
+            write_command(0x16);
+        }
+        if (_type == DOGL128) {
+            write_command(0x81); //  set contrast to default for dogl132
+            write_command(0x10);
+        }
     }
-  }
+}
 
-void EADOG::display(uint8_t display, uint8_t value) {
-  if (display == CONTRAST) {
-    if (value < 64) {
-      write_command(0x81); //  set contrast
-      write_command(value & 0x3F);
-      }
+void EADOG::display(uint8_t display, uint8_t value)
+{
+    if (display == CONTRAST) {
+        if (value < 64) {
+            write_command(0x81); //  set contrast
+            write_command(value & 0x3F);
+        }
     }
-  }
+}
 
 // write command to lcd controller
-void EADOG::write_command(uint8_t command) {
-  _a0 = 0;
-  _cs = 0;
-  _spi.write(command);
-  _cs = 1;
-  }
+void EADOG::write_command(uint8_t command)
+{
+    _a0 = 0;
+    _cs = 0;
+    _spi.write(command);
+    _cs = 1;
+}
 
 // write data to lcd controller
-void EADOG::write_data(uint8_t data) {
-  _a0 = 1;
-  _cs = 0;
-  _spi.write(data);
-  _cs = 1;
-  }
+void EADOG::write_data(uint8_t data)
+{
+    _a0 = 1;
+    _cs = 0;
+    _spi.write(data);
+    _cs = 1;
+}
 
 // reset and init the lcd controller
-void EADOG::init() {
-  _spi.format(8, 3);                 // 8 bit spi mode 3
-  _spi.frequency(20000000);          // 19,2 Mhz SPI clock
+void EADOG::init()
+{
+    _cs = 0;
+    _spi.format(8, 3);                 // 8 bit spi mode 3
+    _spi.frequency(20000000);          // 19,2 Mhz SPI clock
+
+    _a0 = 0;
 
-  //DigitalOut _reset(A1);
-  _a0 = 0;
-  _cs = 1;
-  _reset = 0;                        // display reset
-  wait_us(50);
-  _reset = 1;                       // end reset
-  wait_ms(5);
+    _reset = 0;                        // display reset
+    write_command(0xFF); // display start line 0    
+    wait_us(50);
+    _reset = 1;                       // end reset
+    wait_ms(5);
+    _cs = 1;
+    
+    // Start Initial Sequence
+    write_command(0x40); // display start line 0   
+    write_command(0xA1); // ADC reverse
+    write_command(0xC0); // normal com0-com31
+    write_command(0xA6); // display normal
+    write_command(0xA2); // set bias 1/9 (duty 1/33)
+    write_command(0x2F); // booster, regulator and follower on
+    write_command(0xF8); // set internal booster to 3x/4x
+    write_command(0x00);
 
-  // Start Initial Sequence
-  write_command(0x40); // display start line 0
-  write_command(0xA1); // ADC reverse
-  write_command(0xC0); // normal com0-com31
-  write_command(0xA6); // display normal
-  write_command(0xA2); // set bias 1/9 (duty 1/33)
-  write_command(0x2F); // booster, regulator and follower on
-  write_command(0xF8); // set internal booster to 3x/4x
-  write_command(0x00);
-  if (_type == DOGM132) {
-    write_command(0x23); //  set contrast
-    write_command(0x81);
-    write_command(0x1F);
+    if (_type == DOGM132) {
+        write_command(0x23); //  set contrast
+        write_command(0x81);
+        write_command(0x1F);
+    }
+    if (_type == DOGM128) {
+        write_command(0x27); //  set contrast
+        write_command(0x81);
+        write_command(0x16);
     }
-  if (_type == DOGM128) {
-    write_command(0x27); //  set contrast
-    write_command(0x81);
-    write_command(0x16);
-    }
-  if (_type == DOGL128) {
-    write_command(0x27); //  set contrast
-    write_command(0x81);
-    write_command(0x10);
+    if (_type == DOGL128) {
+        write_command(0x27); //  set contrast
+        write_command(0x81);
+        write_command(0x10);
     }
-  write_command(0xAC); // no indicator
-  write_command(0x00);
-  write_command(0xAF); // display on
+    write_command(0xAC); // no indicator
+    write_command(0x00);
+    write_command(0xAF); // display on
 
-  // clear and update LCD
-  cls();
-  auto_update = 1;              // switch on auto update
-  locate(0, 0);
-  font((unsigned char*)Small_7);  // standard font
-  }
+    // clear and update LCD
+    cls();
+    auto_update = 1;              // switch on auto update
+    locate(0, 0);
+    font((unsigned char*)Small_7);  // standard font
+}
 
 // update lcd
-void EADOG::update() {
-  //page 0
-  write_command(0x00);      // set column low nibble 0
-  write_command(0x10);      // set column hi  nibble 0
-  write_command(0xB0);      // set page address  0
-  _a0 = 1;
+void EADOG::update()
+{
+    //page 0
+    write_command(0x00);      // set column low nibble 0
+    write_command(0x10);      // set column hi  nibble 0
+    write_command(0xB0);      // set page address  0
+    _a0 = 1;
 
-  for (int i = 0; i < width; i++) {
-    write_data(graphic_buffer[i]);
+    for (int i = 0; i < width; i++) {
+        write_data(graphic_buffer[i]);
     }
 
-  // page 1
-  write_command(0x00);      // set column low nibble 0
-  write_command(0x10);      // set column hi  nibble 0
-  write_command(0xB1);      // set page address  1
-  _a0 = 1;
+    // page 1
+    write_command(0x00);      // set column low nibble 0
+    write_command(0x10);      // set column hi  nibble 0
+    write_command(0xB1);      // set page address  1
+    _a0 = 1;
 
-  for (int i = width; i < width * 2; i++) {
-    write_data(graphic_buffer[i]);
+    for (int i = width; i < width * 2; i++) {
+        write_data(graphic_buffer[i]);
     }
 
-  //page 2
-  write_command(0x00);      // set column low nibble 0
-  write_command(0x10);      // set column hi  nibble 0
-  write_command(0xB2);      // set page address  2
-  _a0 = 1;
+    //page 2
+    write_command(0x00);      // set column low nibble 0
+    write_command(0x10);      // set column hi  nibble 0
+    write_command(0xB2);      // set page address  2
+    _a0 = 1;
 
-  for (int i = width * 2; i < width * 3; i++) {
-    write_data(graphic_buffer[i]);
+    for (int i = width * 2; i < width * 3; i++) {
+        write_data(graphic_buffer[i]);
     }
 
-  //page 3
-  write_command(0x00);      // set column low nibble 0
-  write_command(0x10);      // set column hi  nibble 0
-  write_command(0xB3);      // set page address  3
-  _a0 = 1;
-
-  for (int i = width * 3; i < width * 4; i++) {
-    write_data(graphic_buffer[i]);
-    }
-
-  if (_type == DOGM128 || _type == DOGL128) {
-    //page 4
+    //page 3
     write_command(0x00);      // set column low nibble 0
     write_command(0x10);      // set column hi  nibble 0
-    write_command(0xB4);      // set page address  3
-    _a0 = 1;
-
-    for (int i = width * 4; i < width * 5; i++) {
-      write_data(graphic_buffer[i]);
-      }
-
-    //page 5
-    write_command(0x00);      // set column low nibble 0
-    write_command(0x10);      // set column hi  nibble 0
-    write_command(0xB5);      // set page address  3
+    write_command(0xB3);      // set page address  3
     _a0 = 1;
 
-    for (int i = width * 5; i < width * 6; i++) {
-      write_data(graphic_buffer[i]);
-      }
+    for (int i = width * 3; i < width * 4; i++) {
+        write_data(graphic_buffer[i]);
+    }
 
-    //page 6
-    write_command(0x00);      // set column low nibble 0
-    write_command(0x10);      // set column hi  nibble 0
-    write_command(0xB6);      // set page address  3
-    _a0 = 1;
+    if (_type == DOGM128 || _type == DOGL128) {
+        //page 4
+        write_command(0x00);      // set column low nibble 0
+        write_command(0x10);      // set column hi  nibble 0
+        write_command(0xB4);      // set page address  3
+        _a0 = 1;
+
+        for (int i = width * 4; i < width * 5; i++) {
+            write_data(graphic_buffer[i]);
+        }
+
+        //page 5
+        write_command(0x00);      // set column low nibble 0
+        write_command(0x10);      // set column hi  nibble 0
+        write_command(0xB5);      // set page address  3
+        _a0 = 1;
 
-    for (int i = width * 6; i < width *7; i++) {
-      write_data(graphic_buffer[i]);
-      }
+        for (int i = width * 5; i < width * 6; i++) {
+            write_data(graphic_buffer[i]);
+        }
+
+        //page 6
+        write_command(0x00);      // set column low nibble 0
+        write_command(0x10);      // set column hi  nibble 0
+        write_command(0xB6);      // set page address  3
+        _a0 = 1;
 
-    //page 7
-    write_command(0x00);      // set column low nibble 0
-    write_command(0x10);      // set column hi  nibble 0
-    write_command(0xB7);      // set page address  3
-    _a0 = 1;
+        for (int i = width * 6; i < width *7; i++) {
+            write_data(graphic_buffer[i]);
+        }
 
-    for (int i = width * 7; i < width *8; i++) {
-      write_data(graphic_buffer[i]);
-      }
+        //page 7
+        write_command(0x00);      // set column low nibble 0
+        write_command(0x10);      // set column hi  nibble 0
+        write_command(0xB7);      // set page address  3
+        _a0 = 1;
+
+        for (int i = width * 7; i < width *8; i++) {
+            write_data(graphic_buffer[i]);
+        }
     }
 
-  _cs = 0;
+    _cs = 0;
 
-  }
-void EADOG::update(uint8_t mode) {
-  if (mode == MANUAL) auto_update = 0;
-  if (mode == AUTO) auto_update = 1;
-  }
+}
+void EADOG::update(uint8_t mode)
+{
+    if (mode == MANUAL) auto_update = 0;
+    if (mode == AUTO) auto_update = 1;
+}
 
 // clear screen
-void EADOG::cls() {
-  memset(graphic_buffer, 0x00, graphic_buffer_size);  // clear display graphic_buffer
-  update();
-  }
+void EADOG::cls()
+{
+    memset(graphic_buffer, 0x00, graphic_buffer_size);  // clear display graphic_buffer
+    update();
+}
 
 // set one pixel in graphic_buffer
-void EADOG::pixel(int x, int y, uint8_t color) {
-  if (x > width - 1 || y > height - 1 || x < 0 || y < 0) return;
-  if (color == 0) graphic_buffer[x + ((y / 8) * width)] &= ~(1 << (y % 8)); // erase pixel
-  else graphic_buffer[x + ((y / 8) * width)] |= (1 << (y % 8));   // set pixel
-  }
+void EADOG::pixel(int x, int y, uint8_t color)
+{
+    if (x > width - 1 || y > height - 1 || x < 0 || y < 0) return;
+    if (color == 0) graphic_buffer[x + ((y / 8) * width)] &= ~(1 << (y % 8)); // erase pixel
+    else graphic_buffer[x + ((y / 8) * width)] |= (1 << (y % 8));   // set pixel
+}
 
-void EADOG::point(int x, int y, uint8_t colour) {
-  pixel(x, y, colour);
-  if (auto_update) update();
-  }
+void EADOG::point(int x, int y, uint8_t colour)
+{
+    pixel(x, y, colour);
+    if (auto_update) update();
+}
 
 // This function uses Bresenham's algorithm to draw a straight line.
-void EADOG::line(int x0, int y0, int x1, int y1, uint8_t colour) {
-  int dx =  abs(x1 - x0), sx = x0 < x1 ? 1 : -1;
-  int dy = -abs(y1 - y0), sy = y0 < y1 ? 1 : -1;
-  int err = dx + dy, e2; /* error value e_xy */
-
-  while(1) {
-    pixel(x0, y0, 1);
-    if (x0 == x1 && y0 == y1) break;
-    e2 = 2 * err;
-    if (e2 > dy) { err += dy; x0 += sx; } /* e_xy+e_x > 0 */
-    if (e2 < dx) { err += dx; y0 += sy; } /* e_xy+e_y < 0 */
-    }
-  if (auto_update) update();
-  }
+void EADOG::line(int x0, int y0, int x1, int y1, uint8_t colour)
+{
+    int dx =  abs(x1 - x0), sx = x0 < x1 ? 1 : -1;
+    int dy = -abs(y1 - y0), sy = y0 < y1 ? 1 : -1;
+    int err = dx + dy, e2; /* error value e_xy */
 
-void EADOG::rectangle(int x0, int y0, int x1, int y1, uint8_t colour) {
-  uint8_t upd = auto_update;
-  auto_update = 0;
-  line(x0, y0, x1, y0, colour);
-  line(x0, y1, x1, y1, colour);
-  line(x0, y0, x0, y1, colour);
-  line(x1, y0, x1, y1, colour);
-  auto_update = upd;
-  if (auto_update) update();
-  }
-
-void EADOG::fillrect(int x0, int y0, int x1, int y1, uint8_t colour) {
-  if (x0 > x1) swap(x0, x1);
-  if (y0 > y1) swap(y0, y1);
-  for (int i = x0; i <= x1; i++) {
-    for (int j = y0; j <= y1; j++) {
-      pixel(i, j, colour);
-      }
+    while(1) {
+        pixel(x0, y0, 1);
+        if (x0 == x1 && y0 == y1) break;
+        e2 = 2 * err;
+        if (e2 > dy) {
+            err += dy;    /* e_xy+e_x > 0 */
+            x0 += sx;
+        }
+        if (e2 < dx) {
+            err += dx;    /* e_xy+e_y < 0 */
+            y0 += sy;
+        }
     }
-  if (auto_update) update();
-  }
+    if (auto_update) update();
+}
+
+void EADOG::rectangle(int x0, int y0, int x1, int y1, uint8_t colour)
+{
+    uint8_t upd = auto_update;
+    auto_update = 0;
+    line(x0, y0, x1, y0, colour);
+    line(x0, y1, x1, y1, colour);
+    line(x0, y0, x0, y1, colour);
+    line(x1, y0, x1, y1, colour);
+    auto_update = upd;
+    if (auto_update) update();
+}
+
+void EADOG::fillrect(int x0, int y0, int x1, int y1, uint8_t colour)
+{
+    if (x0 > x1) swap(x0, x1);
+    if (y0 > y1) swap(y0, y1);
+    for (int i = x0; i <= x1; i++) {
+        for (int j = y0; j <= y1; j++) {
+            pixel(i, j, colour);
+        }
+    }
+    if (auto_update) update();
+}
 
-void EADOG::roundrect(int x0, int y0, int x1, int y1, int rnd, uint8_t colour) {
-  if (x0 > x1) swap(x0, x1);
-  if (y0 > y1) swap(y0, y1);
-  uint8_t upd = auto_update;
-  auto_update = 0;
-  int r = rnd;
-  int x = -r, y = 0, err = 2 - 2 * r;
-  line(x0 + rnd, y0, x1 - rnd, y0, colour);
-  line(x0 + rnd, y1, x1 - rnd, y1, colour);
-  line(x0, y0 + rnd, x0, y1 - rnd, colour);
-  line(x1, y0 + rnd, x1, y1 - rnd, colour);
-  do {
-    pixel(x1 - rnd + y, y0 + x + rnd, 1); // 1 I. quadrant
-    pixel(x1 - rnd - x, y1 + y - rnd, 1); // 2 IV. quadrant
-    pixel(x0 + rnd - y, y1 - rnd - x, 1); // 3 III. quadrant
-    pixel(x0 + rnd + x, y0 + rnd - y, 1); // 4 II. quadrant
-    r = err;
-    if (r <= y) err += ++y * 2 + 1;
-    if (r > x || err > y) err += ++x * 2 + 1;
+void EADOG::roundrect(int x0, int y0, int x1, int y1, int rnd, uint8_t colour)
+{
+    if (x0 > x1) swap(x0, x1);
+    if (y0 > y1) swap(y0, y1);
+    uint8_t upd = auto_update;
+    auto_update = 0;
+    int r = rnd;
+    int x = -r, y = 0, err = 2 - 2 * r;
+    line(x0 + rnd, y0, x1 - rnd, y0, colour);
+    line(x0 + rnd, y1, x1 - rnd, y1, colour);
+    line(x0, y0 + rnd, x0, y1 - rnd, colour);
+    line(x1, y0 + rnd, x1, y1 - rnd, colour);
+    do {
+        pixel(x1 - rnd + y, y0 + x + rnd, 1); // 1 I. quadrant
+        pixel(x1 - rnd - x, y1 + y - rnd, 1); // 2 IV. quadrant
+        pixel(x0 + rnd - y, y1 - rnd - x, 1); // 3 III. quadrant
+        pixel(x0 + rnd + x, y0 + rnd - y, 1); // 4 II. quadrant
+        r = err;
+        if (r <= y) err += ++y * 2 + 1;
+        if (r > x || err > y) err += ++x * 2 + 1;
     } while (x < 0);
-  auto_update = upd;
-  if (auto_update) update();
-  }
+    auto_update = upd;
+    if (auto_update) update();
+}
 
-void EADOG::fillrrect(int x0, int y0, int x1, int y1, int rnd, uint8_t colour) {
-  if (x0 > x1) swap(x0, x1);
-  if (y0 > y1) swap(y0, y1);
-  uint8_t upd = auto_update;
-  auto_update = 0;
-  int r = rnd;
-  int x = -r, y = 0, err = 2 - 2 * r;
-  for (int i = x0; i <= x1; i++) {
-    for (int j = y0+rnd; j <= y1-rnd; j++) {
-      pixel(i, j, colour);
-      }
+void EADOG::fillrrect(int x0, int y0, int x1, int y1, int rnd, uint8_t colour)
+{
+    if (x0 > x1) swap(x0, x1);
+    if (y0 > y1) swap(y0, y1);
+    uint8_t upd = auto_update;
+    auto_update = 0;
+    int r = rnd;
+    int x = -r, y = 0, err = 2 - 2 * r;
+    for (int i = x0; i <= x1; i++) {
+        for (int j = y0+rnd; j <= y1-rnd; j++) {
+            pixel(i, j, colour);
+        }
     }
-  do {
-    line(x0 + rnd - y, y0 + rnd + x, x1 - rnd + y, y0 + rnd + x, 1);
-    line(x0 + rnd + x, y1 - rnd + y, x1 - rnd - x, y1 - rnd + y, 1);
-    r = err;
-    if (r <= y) err += ++y * 2 + 1;
-    if (r > x || err > y) err += ++x * 2 + 1;
+    do {
+        line(x0 + rnd - y, y0 + rnd + x, x1 - rnd + y, y0 + rnd + x, 1);
+        line(x0 + rnd + x, y1 - rnd + y, x1 - rnd - x, y1 - rnd + y, 1);
+        r = err;
+        if (r <= y) err += ++y * 2 + 1;
+        if (r > x || err > y) err += ++x * 2 + 1;
     } while (x < 0);
-  auto_update = upd;
-  if (auto_update) update();
-  }
+    auto_update = upd;
+    if (auto_update) update();
+}
 
-void EADOG::circle(int x0, int y0, int r, uint8_t colour) {
-  int x = -r, y = 0, err = 2 - 2 * r;
-  do {
-    pixel(x0 + y, y0 + x, 1); // 1 I. quadrant
-    pixel(x0 - x, y0 + y, 1); // 2 IV. quadrant
-    pixel(x0 - y, y0 - x, 1); // 3 III. quadrant
-    pixel(x0 + x, y0 - y, 1); // 4 II. quadrant
-    r = err;
-    if (r <= y) err += ++y * 2 + 1;
-    if (r > x || err > y) err += ++x * 2 + 1;
+void EADOG::circle(int x0, int y0, int r, uint8_t colour)
+{
+    int x = -r, y = 0, err = 2 - 2 * r;
+    do {
+        pixel(x0 + y, y0 + x, 1); // 1 I. quadrant
+        pixel(x0 - x, y0 + y, 1); // 2 IV. quadrant
+        pixel(x0 - y, y0 - x, 1); // 3 III. quadrant
+        pixel(x0 + x, y0 - y, 1); // 4 II. quadrant
+        r = err;
+        if (r <= y) err += ++y * 2 + 1;
+        if (r > x || err > y) err += ++x * 2 + 1;
     } while (x < 0);
-  if (auto_update) update();
-  }
+    if (auto_update) update();
+}
 
-void EADOG::fillcircle(int x0, int y0, int r, uint8_t colour) {
-  uint8_t upd;
-  upd = auto_update;
-  auto_update = 0;
-  int x = -r, y = 0, err = 2 - 2 * r;
-  do {
-    line(x0 - y, y0 + x, x0 + y, y0 + x, 1);
-    line(x0 + x, y0 + y, x0 - x, y0 + y, 1);
-    r = err;
-    if (r <= y) err += ++y * 2 + 1;
-    if (r > x || err > y) err += ++x * 2 + 1;
+void EADOG::fillcircle(int x0, int y0, int r, uint8_t colour)
+{
+    uint8_t upd;
+    upd = auto_update;
+    auto_update = 0;
+    int x = -r, y = 0, err = 2 - 2 * r;
+    do {
+        line(x0 - y, y0 + x, x0 + y, y0 + x, 1);
+        line(x0 + x, y0 + y, x0 - x, y0 + y, 1);
+        r = err;
+        if (r <= y) err += ++y * 2 + 1;
+        if (r > x || err > y) err += ++x * 2 + 1;
     } while (x < 0);
-  auto_update = upd;
-  if (auto_update) update();
-  }
+    auto_update = upd;
+    if (auto_update) update();
+}
 
-void EADOG::locate(uint8_t x, uint8_t y) {
-  char_x = x;
-  char_y = y;
-  }
+void EADOG::locate(uint8_t x, uint8_t y)
+{
+    char_x = x;
+    char_y = y;
+}
 
-int EADOG::_putc(int value) {
-  if (value == '\n') {    // new line
-    char_x = 0;
-    char_y = char_y + font_buffer[2];
-    if (char_y >= height - font_buffer[2]) {
-      char_y = 0;
-      }
+int EADOG::_putc(int value)
+{
+    if (value == '\n') {    // new line
+        char_x = 0;
+        char_y = char_y + font_buffer[2];
+        if (char_y >= height - font_buffer[2]) {
+            char_y = 0;
+        }
+    } else {
+        character(char_x, char_y, value);
+        if (auto_update) update();
     }
-  else {
-    character(char_x, char_y, value);
-    if (auto_update) update();
-    }
-  return value;
-  }
+    return value;
+}
 
-int EADOG::_getc() {
-      return -1;
-  }
+int EADOG::_getc()
+{
+    return -1;
+}
 
-void EADOG::character(uint8_t x, uint8_t y, uint8_t c) {
-  unsigned int hor, vert, offset, bpl, b;
-  uint8_t *sign;
-  uint8_t z, w;
+void EADOG::character(uint8_t x, uint8_t y, uint8_t c)
+{
+    unsigned int hor, vert, offset, bpl, b;
+    uint8_t *sign;
+    uint8_t z, w;
 
-  if ((c < 31) || (c > 127)) return;   // test char range
+    if ((c < 31) || (c > 127)) return;   // test char range
 
-  // read font parameter from start of array
-  offset = font_buffer[0];                    // bytes / char
-  hor = font_buffer[1];                       // get hor size of font
-  vert = font_buffer[2];                      // get vert size of font
-  bpl = font_buffer[3];                       // bytes per line
+    // read font parameter from start of array
+    offset = font_buffer[0];                    // bytes / char
+    hor = font_buffer[1];                       // get hor size of font
+    vert = font_buffer[2];                      // get vert size of font
+    bpl = font_buffer[3];                       // bytes per line
 
-  if (char_x + hor > width) {
-    char_x = 0;
-    char_y = char_y + vert;
-    if (char_y >= height - font_buffer[2]) {
-      char_y = 0;
-      }
+    if (char_x + hor > width) {
+        char_x = 0;
+        char_y = char_y + vert;
+        if (char_y >= height - font_buffer[2]) {
+            char_y = 0;
+        }
     }
 
-  sign = &font_buffer[((c - 32) * offset) + 4]; // start of char bitmap
-  w = sign[0];                          // width of actual char
-  // construct the char into the font_graphic_buffer
-  for (unsigned int j = 0; j < vert; j++) {  //  vert line
-    for (unsigned int i = 0; i < hor; i++) {   //  horz line
-      z =  sign[bpl * i + ((j & 0xF8) >> 3) + 1];
-      b = 1 << (j & 0x07);
-      if (( z & b ) == 0x00) {
-        pixel(x+i, y+j, 0);
+    sign = &font_buffer[((c - 32) * offset) + 4]; // start of char bitmap
+    w = sign[0];                          // width of actual char
+    // construct the char into the font_graphic_buffer
+    for (unsigned int j = 0; j < vert; j++) {  //  vert line
+        for (unsigned int i = 0; i < hor; i++) {   //  horz line
+            z =  sign[bpl * i + ((j & 0xF8) >> 3) + 1];
+            b = 1 << (j & 0x07);
+            if (( z & b ) == 0x00) {
+                pixel(x+i, y+j, 0);
+            } else {
+                pixel(x+i, y+j, 1);
+            }
         }
-      else {
-        pixel(x+i, y+j, 1);
-        }
-      }
     }
-  char_x += w;
-  }
+    char_x += w;
+}
 
 
-void EADOG::font(uint8_t *f) {
-  font_buffer = f;
-  }
+void EADOG::font(uint8_t *f)
+{
+    font_buffer = f;
+}
 
-void EADOG::bitmap(Bitmap bm, int x, int y) {
-  int b;
-  char d;
+void EADOG::bitmap(Bitmap bm, int x, int y)
+{
+    int b;
+    char d;
 
-  for (int v = 0; v < bm.ySize; v++) {   // lines
-    for (int h = 0; h < bm.xSize; h++) { // pixel
-      if (h + x >= width) break;
-      if (v + y >= height) break;
-      d = bm.data[bm.byte_in_Line * v + ((h & 0xF8) >> 3)];
-      b = 0x80 >> (h & 0x07);
-      if ((d & b) == 0) {
-        pixel(x+h, y+v, 0);
+    for (int v = 0; v < bm.ySize; v++) {   // lines
+        for (int h = 0; h < bm.xSize; h++) { // pixel
+            if (h + x >= width) break;
+            if (v + y >= height) break;
+            d = bm.data[bm.byte_in_Line * v + ((h & 0xF8) >> 3)];
+            b = 0x80 >> (h & 0x07);
+            if ((d & b) == 0) {
+                pixel(x+h, y+v, 0);
+            } else {
+                pixel(x+h, y+v, 1);
+            }
         }
-      else {
-        pixel(x+h, y+v, 1);
-        }
-      }
     }
     if (auto_update) update();
-  }
+}