diff service/arduinoNode/arduino-libraries/ST7565/ST7565.cpp @ 168:b2f909325bb2

core files from https://github.com/adafruit/ST7565-LCD Ignore-this: 8dfadccdfb732e632cf7221c2fb527e4
author drewp@bigasterisk.com
date Sun, 12 Apr 2015 03:43:20 -0700
parents
children
line wrap: on
line diff
--- /dev/null	Thu Jan 01 00:00:00 1970 +0000
+++ b/service/arduinoNode/arduino-libraries/ST7565/ST7565.cpp	Sun Apr 12 03:43:20 2015 -0700
@@ -0,0 +1,612 @@
+/*
+$Id:$
+
+ST7565 LCD library!
+
+Copyright (C) 2010 Limor Fried, Adafruit Industries
+
+This library is free software; you can redistribute it and/or
+modify it under the terms of the GNU Lesser General Public
+License as published by the Free Software Foundation; either
+version 2.1 of the License, or (at your option) any later version.
+
+This library is distributed in the hope that it will be useful,
+but WITHOUT ANY WARRANTY; without even the implied warranty of
+MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE.  See the GNU
+Lesser General Public License for more details.
+
+You should have received a copy of the GNU Lesser General Public
+License along with this library; if not, write to the Free Software
+Foundation, Inc., 51 Franklin Street, Fifth Floor, Boston, MA  02110-1301  USA
+
+// some of this code was written by <cstone@pobox.com> originally; it is in the public domain.
+*/
+
+//#include <Wire.h>
+#include <avr/pgmspace.h>
+#include <util/delay.h>
+#include <stdlib.h>
+
+#include "ST7565.h"
+
+#define ST7565_STARTBYTES 1
+
+uint8_t is_reversed = 0;
+
+// a handy reference to where the pages are on the screen
+const uint8_t pagemap[] = { 3, 2, 1, 0, 7, 6, 5, 4 };
+
+// a 5x7 font table
+const extern uint8_t PROGMEM font[];
+
+// the memory buffer for the LCD
+uint8_t st7565_buffer[1024] = { 
+0x0, 0x0, 0x0, 0x0, 0x0, 0x0, 0x0, 0x0, 0x0, 0x0, 0x0, 0x0, 0x0, 0x0, 0x0, 0x0, 
+0x0, 0x0, 0x0, 0x0, 0x0, 0x0, 0x0, 0x0, 0x0, 0x0, 0x0, 0x0, 0x0, 0x0, 0x0, 0x0, 
+0x0, 0x0, 0x0, 0x0, 0x0, 0x0, 0x0, 0x0, 0x0, 0x0, 0x0, 0x0, 0x0, 0x0, 0x0, 0x0, 
+0x0, 0x0, 0x0, 0x0, 0x0, 0x0, 0x0, 0x0, 0x0, 0x0, 0x0, 0x0, 0x0, 0x0, 0x0, 0x0, 
+0x0, 0x0, 0x0, 0x0, 0x0, 0x0, 0x0, 0x0, 0x0, 0x0, 0x0, 0x0, 0x0, 0x0, 0x0, 0x0, 
+0x0, 0x0, 0x0, 0x0, 0x0, 0x0, 0x0, 0x0, 0x0, 0x0, 0x0, 0x0, 0x0, 0x0, 0x0, 0x0, 
+0x0, 0x0, 0x0, 0x0, 0x0, 0x0, 0x0, 0x0, 0x0, 0x0, 0x0, 0x0, 0x0, 0x0, 0x0, 0x0, 
+0x0, 0x0, 0x0, 0x0, 0x0, 0x0, 0x0, 0x0, 0x0, 0x0, 0x0, 0x0, 0x0, 0x0, 0x0, 0x0, 
+
+0x0, 0x0, 0x0, 0x0, 0x0, 0x0, 0x0, 0x0, 0x0, 0x0, 0x0, 0x0, 0x0, 0x0, 0x0, 0x0, 
+0x0, 0x0, 0x0, 0x3, 0x7, 0xF, 0x1F, 0x1F, 0x3F, 0x3F, 0x3F, 0x3F, 0x7, 0x0, 0x0, 0x0, 
+0x0, 0x0, 0x0, 0x0, 0x0, 0x0, 0x0, 0x0, 0x0, 0x0, 0x0, 0x0, 0x0, 0x0, 0x0, 0x0, 
+0x0, 0x0, 0x0, 0x0, 0x0, 0x0, 0x0, 0x0, 0x0, 0x0, 0x0, 0x0, 0x0, 0x0, 0x0, 0x0, 
+0x0, 0x0, 0x7F, 0x3F, 0x0, 0x0, 0x0, 0x0, 0x0, 0x0, 0x0, 0x0, 0x0, 0x0, 0x0, 0x0, 
+0x0, 0x0, 0x1F, 0x3F, 0x70, 0x70, 0x0, 0x0, 0x0, 0x0, 0x0, 0x0, 0x0, 0x0, 0x0, 0x0, 
+0x0, 0x0, 0x0, 0x0, 0x0, 0x0, 0x0, 0x0, 0x0, 0x6, 0x6, 0x0, 0x0, 0x0, 0x3, 0x3, 
+0x0, 0x0, 0x0, 0x0, 0x0, 0x0, 0x0, 0x0, 0x0, 0x0, 0x0, 0x0, 0x0, 0x0, 0x0, 0x0, 
+
+0x1F, 0x1F, 0x1F, 0x1F, 0x1F, 0x1F, 0x1F, 0x1F, 0x1F, 0x1F, 0x1F, 0x1F, 0x1F, 0xF, 0x7, 0x7, 
+0x7, 0x3F, 0xFF, 0xFF, 0xFF, 0xFF, 0xFF, 0xFE, 0xFF, 0xFF, 0xFF, 0xFF, 0xFF, 0x3E, 0x0, 0x0, 
+0x0, 0x0, 0x0, 0x0, 0x0, 0x0, 0x0, 0x0, 0x0, 0x0, 0x0, 0x0, 0x0, 0x0, 0xF, 0x3F, 
+0x70, 0x60, 0x60, 0x60, 0x60, 0x30, 0x7F, 0x3F, 0x0, 0x0, 0x1F, 0x3F, 0x70, 0x60, 0x60, 0x60, 
+0x60, 0x39, 0xFF, 0xFF, 0x0, 0x6, 0x1F, 0x39, 0x60, 0x60, 0x60, 0x60, 0x30, 0x3F, 0x7F, 0x0, 
+0x0, 0x60, 0xFF, 0xFF, 0x60, 0x60, 0x0, 0x7F, 0x7F, 0x70, 0x60, 0x60, 0x40, 0x0, 0x7F, 0x7F, 
+0x0, 0x0, 0x0, 0x0, 0x7F, 0x7F, 0x0, 0x0, 0x0, 0x7F, 0x7F, 0x0, 0x0, 0x60, 0xFF, 0xFF, 
+0x60, 0x60, 0x0, 0x0, 0x0, 0x0, 0x0, 0x0, 0x0, 0x0, 0x0, 0x0, 0x0, 0x0, 0x0, 0x0, 
+
+0x80, 0xF8, 0xFC, 0xFE, 0xFE, 0xFF, 0xFF, 0xFF, 0xFF, 0xFF, 0xFF, 0xFF, 0xEF, 0xE7, 0xE7, 0xE3, 
+0xF3, 0xF9, 0xFF, 0xFF, 0xFF, 0xF7, 0x7, 0x1F, 0xFF, 0xFF, 0xFF, 0xFF, 0xFF, 0xFF, 0x7F, 0xFF, 
+0x7F, 0x7F, 0x7F, 0x7F, 0x7F, 0x7F, 0x3F, 0x3F, 0x1F, 0xF, 0x7, 0x3, 0x0, 0x0, 0x0, 0xC0, 
+0xE0, 0x60, 0x20, 0x20, 0x60, 0xE0, 0xE0, 0xE0, 0x0, 0x0, 0x80, 0xC0, 0xE0, 0x60, 0x20, 0x60, 
+0x60, 0xE0, 0xE0, 0xE0, 0x0, 0x0, 0x80, 0xC0, 0x60, 0x60, 0x20, 0x60, 0x60, 0xE0, 0xE0, 0x0, 
+0x0, 0x0, 0xE0, 0xE0, 0x0, 0x0, 0x0, 0xE0, 0xE0, 0x0, 0x0, 0x0, 0x0, 0x0, 0x80, 0xE0, 
+0x60, 0x60, 0x60, 0x60, 0xE0, 0x80, 0x0, 0x0, 0x0, 0xE0, 0xE0, 0x0, 0x0, 0x0, 0xE0, 0xE0, 
+0x0, 0x0, 0x0, 0x0, 0x0, 0x0, 0x0, 0x0, 0x0, 0x0, 0x0, 0x0, 0x0, 0x0, 0x0, 0x0, 
+
+0x0, 0x0, 0x0, 0x3, 0x7, 0x1F, 0x9F, 0xFF, 0xFF, 0xFF, 0xFF, 0xFF, 0xFF, 0xFD, 0xF1, 0xE3, 
+0xE3, 0xCF, 0xFF, 0xFF, 0xFF, 0xFF, 0xF0, 0xFC, 0x7F, 0x3F, 0x3F, 0x3F, 0x3F, 0x7F, 0xFF, 0xFF, 
+0xFF, 0xFF, 0xFF, 0xFF, 0xFF, 0xFF, 0xFF, 0xFE, 0xFC, 0xF0, 0xE0, 0x80, 0x0, 0x0, 0x0, 0xC, 
+0x1C, 0x0, 0x0, 0x0, 0x0, 0x0, 0x0, 0x0, 0x0, 0x0, 0x0, 0x0, 0x0, 0x0, 0x0, 0x0, 
+0x0, 0x0, 0x0, 0x0, 0x0, 0x0, 0x7F, 0x7F, 0x0, 0x0, 0x0, 0x0, 0x0, 0x0, 0x0, 0x0, 
+0x0, 0x0, 0x0, 0x0, 0x0, 0x0, 0x0, 0x0, 0x0, 0x0, 0x0, 0x0, 0x0, 0x7, 0x7, 0x0, 
+0x0, 0x0, 0x0, 0x0, 0x0, 0x0, 0x0, 0x0, 0x0, 0x1C, 0xC, 0x0, 0x0, 0x0, 0x0, 0x0, 
+0x0, 0x0, 0x0, 0x0, 0x0, 0x0, 0x0, 0x0, 0x0, 0x0, 0x0, 0x0, 0x0, 0x0, 0x0, 0x0, 
+
+0x0, 0x7, 0xFF, 0xFF, 0xFF, 0xFF, 0xFF, 0xFF, 0xFF, 0xFF, 0xFE, 0xFE, 0xFE, 0xFE, 0xFC, 0xF8, 
+0xF8, 0xF0, 0xFE, 0xFF, 0xFF, 0xFF, 0x7F, 0x3F, 0xFF, 0xFF, 0xFF, 0xFF, 0xFF, 0xFF, 0xFF, 0x1F, 
+0x0, 0x0, 0x0, 0x0, 0x0, 0x0, 0x0, 0x0, 0x0, 0x0, 0x0, 0x0, 0x0, 0x0, 0x0, 0xFF, 
+0xFF, 0x0, 0x0, 0x0, 0xFF, 0xFF, 0xE0, 0xC0, 0xC0, 0xC0, 0xFF, 0x7F, 0x0, 0x0, 0x1E, 0x7F, 
+0xE1, 0xC0, 0xC0, 0xC0, 0xC0, 0x61, 0xFF, 0xFF, 0x0, 0x0, 0xFE, 0xFF, 0x1, 0x0, 0x0, 0x0, 
+0xFF, 0xFF, 0x0, 0x0, 0x21, 0xF9, 0xF8, 0xDC, 0xCC, 0xCF, 0x7, 0x0, 0xC0, 0xFF, 0xFF, 0xC0, 
+0x80, 0x0, 0xFF, 0xFF, 0xC0, 0xC0, 0x80, 0x0, 0x0, 0xFF, 0xFF, 0x0, 0x0, 0x1F, 0x7F, 0xF9, 
+0xC8, 0xC8, 0xC8, 0xC8, 0x79, 0x39, 0x0, 0x0, 0x71, 0xF9, 0xD8, 0xCC, 0xCE, 0x47, 0x3, 0x0, 
+
+0x0, 0x0, 0x0, 0x0, 0x80, 0x80, 0x0, 0x0, 0x0, 0x0, 0x0, 0x0, 0x0, 0x0, 0x0, 0x0, 
+0x0, 0x0, 0x0, 0x80, 0xC0, 0xE0, 0xF0, 0xF8, 0xF8, 0xFC, 0xFC, 0xFC, 0xFC, 0xF8, 0xF0, 0xC0, 
+0x0, 0x0, 0x0, 0x0, 0x0, 0x0, 0x0, 0x0, 0x0, 0x0, 0x0, 0x0, 0x0, 0x0, 0x0, 0xC0, 
+0xC0, 0x0, 0x0, 0x0, 0xC0, 0xC0, 0x0, 0x0, 0x0, 0x0, 0xC0, 0xC0, 0x0, 0x0, 0x0, 0x80, 
+0xC0, 0xC0, 0xC0, 0xC0, 0xC0, 0x80, 0xC0, 0xC0, 0x0, 0x0, 0x0, 0x80, 0xC0, 0xC0, 0xC0, 0xC0, 
+0xC0, 0x80, 0x0, 0x0, 0x80, 0xC0, 0xC0, 0xC0, 0xC0, 0xC0, 0x0, 0x0, 0x0, 0xC0, 0xC0, 0x0, 
+0x0, 0x0, 0xC0, 0x80, 0x0, 0x0, 0x0, 0x0, 0x0, 0xC0, 0xC0, 0x0, 0x0, 0x0, 0x80, 0xC0, 
+0xC0, 0xC0, 0xC0, 0xC0, 0x80, 0x80, 0x0, 0x0, 0x80, 0xC0, 0xC0, 0xC0, 0xC0, 0x80, 0x0, 0x0, 
+
+0x0, 0x0, 0x0, 0x0, 0x0, 0x0, 0x0, 0x0, 0x0, 0x0, 0x0, 0x0, 0x0, 0x0, 0x0, 0x0,
+0x0, 0x0, 0x0, 0x0, 0x0, 0x0, 0x0, 0x0, 0x0, 0x0, 0x0, 0x0, 0x0, 0x0, 0x0, 0x0,
+0x0, 0x0, 0x0, 0x0, 0x0, 0x0, 0x0, 0x0, 0x0, 0x0, 0x0, 0x0, 0x0, 0x0, 0x0, 0x0,
+0x0, 0x0, 0x0, 0x0, 0x0, 0x0, 0x0, 0x0, 0x0, 0x0, 0x0, 0x0, 0x0, 0x0, 0x0, 0x0,
+0x0, 0x0, 0x0, 0x0, 0x0, 0x0, 0x0, 0x0, 0x0, 0x0, 0x0, 0x0, 0x0, 0x0, 0x0, 0x0,
+0x0, 0x0, 0x0, 0x0, 0x0, 0x0, 0x0, 0x0, 0x0, 0x0, 0x0, 0x0, 0x0, 0x0, 0x0, 0x0,
+0x0, 0x0, 0x0, 0x0, 0x0, 0x0, 0x0, 0x0, 0x0, 0x0, 0x0, 0x0, 0x0, 0x0, 0x0, 0x0,
+0x0, 0x0, 0x0, 0x0, 0x0, 0x0, 0x0, 0x0, 0x0, 0x0, 0x0, 0x0, 0x0, 0x0, 0x0, 0x0,};
+
+// reduces how much is refreshed, which speeds it up!
+// originally derived from Steve Evans/JCW's mod but cleaned up and
+// optimized
+#define enablePartialUpdate
+
+#ifdef enablePartialUpdate
+static uint8_t xUpdateMin, xUpdateMax, yUpdateMin, yUpdateMax;
+#endif
+
+
+
+static void updateBoundingBox(uint8_t xmin, uint8_t ymin, uint8_t xmax, uint8_t ymax) {
+#ifdef enablePartialUpdate
+  if (xmin < xUpdateMin) xUpdateMin = xmin;
+  if (xmax > xUpdateMax) xUpdateMax = xmax;
+  if (ymin < yUpdateMin) yUpdateMin = ymin;
+  if (ymax > yUpdateMax) yUpdateMax = ymax;
+#endif
+}
+
+void ST7565::drawbitmap(uint8_t x, uint8_t y, 
+			const uint8_t *bitmap, uint8_t w, uint8_t h,
+			uint8_t color) {
+  for (uint8_t j=0; j<h; j++) {
+    for (uint8_t i=0; i<w; i++ ) {
+      if (pgm_read_byte(bitmap + i + (j/8)*w) & _BV(j%8)) {
+	my_setpixel(x+i, y+j, color);
+      }
+    }
+  }
+
+  updateBoundingBox(x, y, x+w, y+h);
+}
+
+void ST7565::drawstring(uint8_t x, uint8_t line, char *c) {
+  while (c[0] != 0) {
+    drawchar(x, line, c[0]);
+    c++;
+    x += 6; // 6 pixels wide
+    if (x + 6 >= LCDWIDTH) {
+      x = 0;    // ran out of this line
+      line++;
+    }
+    if (line >= (LCDHEIGHT/8))
+      return;        // ran out of space :(
+  }
+}
+
+
+void ST7565::drawstring_P(uint8_t x, uint8_t line, const char *str) {
+  while (1) {
+    char c = pgm_read_byte(str++);
+    if (! c)
+      return;
+    drawchar(x, line, c);
+    x += 6; // 6 pixels wide
+    if (x + 6 >= LCDWIDTH) {
+      x = 0;    // ran out of this line
+      line++;
+    }
+    if (line >= (LCDHEIGHT/8))
+      return;        // ran out of space :(
+  }
+}
+
+void  ST7565::drawchar(uint8_t x, uint8_t line, char c) {
+  for (uint8_t i =0; i<5; i++ ) {
+    st7565_buffer[x + (line*128) ] = pgm_read_byte(font+(c*5)+i);
+    x++;
+  }
+
+  updateBoundingBox(x, line*8, x+5, line*8 + 8);
+}
+
+
+// bresenham's algorithm - thx wikpedia
+void ST7565::drawline(uint8_t x0, uint8_t y0, uint8_t x1, uint8_t y1, 
+		      uint8_t color) {
+  uint8_t steep = abs(y1 - y0) > abs(x1 - x0);
+  if (steep) {
+    swap(x0, y0);
+    swap(x1, y1);
+  }
+
+  if (x0 > x1) {
+    swap(x0, x1);
+    swap(y0, y1);
+  }
+
+  // much faster to put the test here, since we've already sorted the points
+  updateBoundingBox(x0, y0, x1, y1);
+
+  uint8_t dx, dy;
+  dx = x1 - x0;
+  dy = abs(y1 - y0);
+
+  int8_t err = dx / 2;
+  int8_t ystep;
+
+  if (y0 < y1) {
+    ystep = 1;
+  } else {
+    ystep = -1;}
+
+  for (; x0<=x1; x0++) {
+    if (steep) {
+      my_setpixel(y0, x0, color);
+    } else {
+      my_setpixel(x0, y0, color);
+    }
+    err -= dy;
+    if (err < 0) {
+      y0 += ystep;
+      err += dx;
+    }
+  }
+}
+
+// filled rectangle
+void ST7565::fillrect(uint8_t x, uint8_t y, uint8_t w, uint8_t h, 
+		      uint8_t color) {
+
+  // stupidest version - just pixels - but fast with internal buffer!
+  for (uint8_t i=x; i<x+w; i++) {
+    for (uint8_t j=y; j<y+h; j++) {
+      my_setpixel(i, j, color);
+    }
+  }
+
+  updateBoundingBox(x, y, x+w, y+h);
+}
+
+// draw a rectangle
+void ST7565::drawrect(uint8_t x, uint8_t y, uint8_t w, uint8_t h, 
+		      uint8_t color) {
+  // stupidest version - just pixels - but fast with internal buffer!
+  for (uint8_t i=x; i<x+w; i++) {
+    my_setpixel(i, y, color);
+    my_setpixel(i, y+h-1, color);
+  }
+  for (uint8_t i=y; i<y+h; i++) {
+    my_setpixel(x, i, color);
+    my_setpixel(x+w-1, i, color);
+  } 
+
+  updateBoundingBox(x, y, x+w, y+h);
+}
+
+// draw a circle outline
+void ST7565::drawcircle(uint8_t x0, uint8_t y0, uint8_t r, 
+			uint8_t color) {
+  updateBoundingBox(x0-r, y0-r, x0+r, y0+r);
+
+  int8_t f = 1 - r;
+  int8_t ddF_x = 1;
+  int8_t ddF_y = -2 * r;
+  int8_t x = 0;
+  int8_t y = r;
+
+  my_setpixel(x0, y0+r, color);
+  my_setpixel(x0, y0-r, color);
+  my_setpixel(x0+r, y0, color);
+  my_setpixel(x0-r, y0, color);
+
+  while (x<y) {
+    if (f >= 0) {
+      y--;
+      ddF_y += 2;
+      f += ddF_y;
+    }
+    x++;
+    ddF_x += 2;
+    f += ddF_x;
+  
+    my_setpixel(x0 + x, y0 + y, color);
+    my_setpixel(x0 - x, y0 + y, color);
+    my_setpixel(x0 + x, y0 - y, color);
+    my_setpixel(x0 - x, y0 - y, color);
+    
+    my_setpixel(x0 + y, y0 + x, color);
+    my_setpixel(x0 - y, y0 + x, color);
+    my_setpixel(x0 + y, y0 - x, color);
+    my_setpixel(x0 - y, y0 - x, color);
+    
+  }
+
+
+
+}
+
+void ST7565::fillcircle(uint8_t x0, uint8_t y0, uint8_t r, 
+			uint8_t color) {
+  updateBoundingBox(x0-r, y0-r, x0+r, y0+r);
+
+  int8_t f = 1 - r;
+  int8_t ddF_x = 1;
+  int8_t ddF_y = -2 * r;
+  int8_t x = 0;
+  int8_t y = r;
+
+  for (uint8_t i=y0-r; i<=y0+r; i++) {
+    my_setpixel(x0, i, color);
+  }
+
+  while (x<y) {
+    if (f >= 0) {
+      y--;
+      ddF_y += 2;
+      f += ddF_y;
+    }
+    x++;
+    ddF_x += 2;
+    f += ddF_x;
+  
+    for (uint8_t i=y0-y; i<=y0+y; i++) {
+      my_setpixel(x0+x, i, color);
+      my_setpixel(x0-x, i, color);
+    } 
+    for (uint8_t i=y0-x; i<=y0+x; i++) {
+      my_setpixel(x0+y, i, color);
+      my_setpixel(x0-y, i, color);
+    }    
+  }
+}
+
+void ST7565::my_setpixel(uint8_t x, uint8_t y, uint8_t color) {
+  if ((x >= LCDWIDTH) || (y >= LCDHEIGHT))
+    return;
+
+  // x is which column
+  if (color) 
+    st7565_buffer[x+ (y/8)*128] |= _BV(7-(y%8));  
+  else
+    st7565_buffer[x+ (y/8)*128] &= ~_BV(7-(y%8)); 
+}
+
+// the most basic function, set a single pixel
+void ST7565::setpixel(uint8_t x, uint8_t y, uint8_t color) {
+  if ((x >= LCDWIDTH) || (y >= LCDHEIGHT))
+    return;
+
+  // x is which column
+  if (color) 
+    st7565_buffer[x+ (y/8)*128] |= _BV(7-(y%8));  
+  else
+    st7565_buffer[x+ (y/8)*128] &= ~_BV(7-(y%8)); 
+
+  updateBoundingBox(x,y,x,y);
+}
+
+
+// the most basic function, get a single pixel
+uint8_t ST7565::getpixel(uint8_t x, uint8_t y) {
+  if ((x >= LCDWIDTH) || (y >= LCDHEIGHT))
+    return 0;
+
+  return (st7565_buffer[x+ (y/8)*128] >> (7-(y%8))) & 0x1;  
+}
+
+void ST7565::begin(uint8_t contrast) {
+  st7565_init();
+  st7565_command(CMD_DISPLAY_ON);
+  st7565_command(CMD_SET_ALLPTS_NORMAL);
+  st7565_set_brightness(contrast);
+}
+
+void ST7565::st7565_init(void) {
+  // set pin directions
+  pinMode(sid, OUTPUT);
+  pinMode(sclk, OUTPUT);
+  pinMode(a0, OUTPUT);
+  pinMode(rst, OUTPUT);
+  pinMode(cs, OUTPUT);
+
+  // toggle RST low to reset; CS low so it'll listen to us
+  if (cs > 0)
+    digitalWrite(cs, LOW);
+
+  digitalWrite(rst, LOW);
+  _delay_ms(500);
+  digitalWrite(rst, HIGH);
+
+  // LCD bias select
+  st7565_command(CMD_SET_BIAS_7);
+  // ADC select
+  st7565_command(CMD_SET_ADC_NORMAL);
+  // SHL select
+  st7565_command(CMD_SET_COM_NORMAL);
+  // Initial display line
+  st7565_command(CMD_SET_DISP_START_LINE);
+
+  // turn on voltage converter (VC=1, VR=0, VF=0)
+  st7565_command(CMD_SET_POWER_CONTROL | 0x4);
+  // wait for 50% rising
+  _delay_ms(50);
+
+  // turn on voltage regulator (VC=1, VR=1, VF=0)
+  st7565_command(CMD_SET_POWER_CONTROL | 0x6);
+  // wait >=50ms
+  _delay_ms(50);
+
+  // turn on voltage follower (VC=1, VR=1, VF=1)
+  st7565_command(CMD_SET_POWER_CONTROL | 0x7);
+  // wait
+  _delay_ms(10);
+
+  // set lcd operating voltage (regulator resistor, ref voltage resistor)
+  st7565_command(CMD_SET_RESISTOR_RATIO | 0x6);
+
+  // initial display line
+  // set page address
+  // set column address
+  // write display data
+
+  // set up a bounding box for screen updates
+
+  updateBoundingBox(0, 0, LCDWIDTH-1, LCDHEIGHT-1);
+}
+
+inline void ST7565::spiwrite(uint8_t c) {
+  shiftOut(sid, sclk, MSBFIRST, c);
+  /*
+  int8_t i;
+  for (i=7; i>=0; i--) {
+    SCLK_PORT &= ~_BV(SCLK);
+    if (c & _BV(i))
+      SID_PORT |= _BV(SID);
+    else
+      SID_PORT &= ~_BV(SID);
+    SCLK_PORT |= _BV(SCLK);
+  }
+  */
+
+  /*
+  // loop unwrapped! too fast doesnt work :(
+ 
+  SCLK_PORT &= ~_BV(SCLK);
+  if (c & _BV(7))
+    SID_PORT |= _BV(SID);
+  else
+    SID_PORT &= ~_BV(SID);
+  SCLK_PORT |= _BV(SCLK);
+
+  SCLK_PORT &= ~_BV(SCLK);
+  if (c & _BV(6))
+    SID_PORT |= _BV(SID);
+  else
+    SID_PORT &= ~_BV(SID);
+  SCLK_PORT |= _BV(SCLK);
+ 
+  SCLK_PORT &= ~_BV(SCLK);
+  if (c & _BV(5))
+    SID_PORT |= _BV(SID);
+  else
+    SID_PORT &= ~_BV(SID);
+  SCLK_PORT |= _BV(SCLK);
+
+  SCLK_PORT &= ~_BV(SCLK);
+  if (c & _BV(4))
+    SID_PORT |= _BV(SID);
+  else
+    SID_PORT &= ~_BV(SID);
+  SCLK_PORT |= _BV(SCLK);
+
+  SCLK_PORT &= ~_BV(SCLK);
+  if (c & _BV(3))
+    SID_PORT |= _BV(SID);
+  else
+    SID_PORT &= ~_BV(SID);
+  SCLK_PORT |= _BV(SCLK);
+
+  SCLK_PORT &= ~_BV(SCLK);
+  if (c & _BV(2))
+    SID_PORT |= _BV(SID);
+  else
+    SID_PORT &= ~_BV(SID);
+  SCLK_PORT |= _BV(SCLK);
+
+
+  SCLK_PORT &= ~_BV(SCLK);
+  if (c & _BV(1))
+    SID_PORT |= _BV(SID);
+  else
+    SID_PORT &= ~_BV(SID);
+  SCLK_PORT |= _BV(SCLK);
+
+  SCLK_PORT &= ~_BV(SCLK);
+  if (c & _BV(0))
+    SID_PORT |= _BV(SID);
+  else
+    SID_PORT &= ~_BV(SID);
+  SCLK_PORT |= _BV(SCLK);
+*/
+
+}
+void ST7565::st7565_command(uint8_t c) {
+  digitalWrite(a0, LOW);
+
+  spiwrite(c);
+}
+
+void ST7565::st7565_data(uint8_t c) {
+  digitalWrite(a0, HIGH);
+
+  spiwrite(c);
+}
+void ST7565::st7565_set_brightness(uint8_t val) {
+    st7565_command(CMD_SET_VOLUME_FIRST);
+    st7565_command(CMD_SET_VOLUME_SECOND | (val & 0x3f));
+}
+
+
+void ST7565::display(void) {
+  uint8_t col, maxcol, p;
+
+  /*
+  Serial.print("Refresh ("); Serial.print(xUpdateMin, DEC); 
+  Serial.print(", "); Serial.print(xUpdateMax, DEC);
+  Serial.print(","); Serial.print(yUpdateMin, DEC); 
+  Serial.print(", "); Serial.print(yUpdateMax, DEC); Serial.println(")");
+  */
+
+  for(p = 0; p < 8; p++) {
+    /*
+      putstring("new page! ");
+      uart_putw_dec(p);
+      putstring_nl("");
+    */
+#ifdef enablePartialUpdate
+    // check if this page is part of update
+    if ( yUpdateMin >= ((p+1)*8) ) {
+      continue;   // nope, skip it!
+    }
+    if (yUpdateMax < p*8) {
+      break;
+    }
+#endif
+
+    st7565_command(CMD_SET_PAGE | pagemap[p]);
+
+
+#ifdef enablePartialUpdate
+    col = xUpdateMin;
+    maxcol = xUpdateMax;
+#else
+    // start at the beginning of the row
+    col = 0;
+    maxcol = LCDWIDTH-1;
+#endif
+
+    st7565_command(CMD_SET_COLUMN_LOWER | ((col+ST7565_STARTBYTES) & 0xf));
+    st7565_command(CMD_SET_COLUMN_UPPER | (((col+ST7565_STARTBYTES) >> 4) & 0x0F));
+    st7565_command(CMD_RMW);
+    
+    for(; col <= maxcol; col++) {
+      //uart_putw_dec(col);
+      //uart_putchar(' ');
+      st7565_data(st7565_buffer[(128*p)+col]);
+    }
+  }
+
+#ifdef enablePartialUpdate
+  xUpdateMin = LCDWIDTH - 1;
+  xUpdateMax = 0;
+  yUpdateMin = LCDHEIGHT-1;
+  yUpdateMax = 0;
+#endif
+}
+
+// clear everything
+void ST7565::clear(void) {
+  memset(st7565_buffer, 0, 1024);
+  updateBoundingBox(0, 0, LCDWIDTH-1, LCDHEIGHT-1);
+}
+
+
+// this doesnt touch the buffer, just clears the display RAM - might be handy
+void ST7565::clear_display(void) {
+  uint8_t p, c;
+  
+  for(p = 0; p < 8; p++) {
+    /*
+      putstring("new page! ");
+      uart_putw_dec(p);
+      putstring_nl("");
+    */
+
+    st7565_command(CMD_SET_PAGE | p);
+    for(c = 0; c < 129; c++) {
+      //uart_putw_dec(c);
+      //uart_putchar(' ');
+      st7565_command(CMD_SET_COLUMN_LOWER | (c & 0xf));
+      st7565_command(CMD_SET_COLUMN_UPPER | ((c >> 4) & 0xf));
+      st7565_data(0x0);
+    }     
+  }
+}