674 lines
14 KiB
C
674 lines
14 KiB
C
/*
|
|
* lcd128x64.c:
|
|
* Graphics-based LCD driver.
|
|
* This is designed to drive the parallel interface LCD drivers
|
|
* based on the generic 12864H chips
|
|
*
|
|
* There are many variations on these chips, however they all mostly
|
|
* seem to be similar.
|
|
* This implementation has the Pins from the Pi hard-wired into it,
|
|
* in particular wiringPi pins 0-7 so that we can use
|
|
* digitalWriteByete() to speed things up somewhat.
|
|
*
|
|
* Copyright (c) 2013 Gordon Henderson.
|
|
***********************************************************************
|
|
* This file is part of wiringPi:
|
|
* https://projects.drogon.net/raspberry-pi/wiringpi/
|
|
*
|
|
* wiringPi 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 3 of the License, or
|
|
* (at your option) any later version.
|
|
*
|
|
* wiringPi 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 wiringPi. If not, see <http://www.gnu.org/licenses/>.
|
|
***********************************************************************
|
|
*/
|
|
|
|
#include <stdio.h>
|
|
#include <stdlib.h>
|
|
|
|
#include <wiringPi.h>
|
|
|
|
#include "font.h"
|
|
#include "lcd128x64.h"
|
|
|
|
// Size
|
|
|
|
#define LCD_WIDTH 128
|
|
#define LCD_HEIGHT 64
|
|
|
|
// Hardware Pins
|
|
// Note pins 0-7 are the 8-bit data port
|
|
|
|
#define CS1 10
|
|
#define CS2 11
|
|
#define STROBE 12
|
|
#define RS 13
|
|
|
|
// Software copy of the framebuffer
|
|
// it's 8-bit deep although the display itself is only 1-bit deep.
|
|
|
|
static unsigned char frameBuffer [LCD_WIDTH * LCD_HEIGHT] ;
|
|
|
|
static int maxX, maxY ;
|
|
static int lastX, lastY ;
|
|
static int xOrigin, yOrigin ;
|
|
static int lcdOrientation = 0 ;
|
|
|
|
/*
|
|
* strobe:
|
|
* Toggle the strobe (Really the "E") pin to the device.
|
|
* According to the docs, data is latched on the falling edge.
|
|
*********************************************************************************
|
|
*/
|
|
|
|
static void strobe (void)
|
|
{
|
|
digitalWrite (STROBE, 1) ; delayMicroseconds (1) ;
|
|
digitalWrite (STROBE, 0) ; delayMicroseconds (5) ;
|
|
}
|
|
|
|
|
|
/*
|
|
* sentData:
|
|
* Send an data or command byte to the display.
|
|
*********************************************************************************
|
|
*/
|
|
|
|
static void sendData (const int data, const int chip)
|
|
{
|
|
digitalWrite (chip, 0) ;
|
|
digitalWriteByte (data) ;
|
|
strobe () ;
|
|
digitalWrite (chip, 1) ;
|
|
}
|
|
|
|
|
|
/*
|
|
* sendCommand:
|
|
* Send a command byte to the display
|
|
*********************************************************************************
|
|
*/
|
|
|
|
static void sendCommand (const int command, const int chip)
|
|
{
|
|
digitalWrite (RS, 0) ;
|
|
sendData (command, chip) ;
|
|
digitalWrite (RS, 1) ;
|
|
}
|
|
|
|
|
|
/*
|
|
* setCol: SetLine:
|
|
* Set the column and line addresses
|
|
*********************************************************************************
|
|
*/
|
|
|
|
static void setCol (int col, const int chip)
|
|
{ sendCommand (0x40 | (col & 0x3F), chip) ; }
|
|
|
|
static void setLine (int line, const int chip)
|
|
{ sendCommand (0xB8 | (line & 0x07), chip) ; }
|
|
|
|
|
|
/*
|
|
* lcd128x64update:
|
|
* Copy our software version to the real display
|
|
*********************************************************************************
|
|
*/
|
|
|
|
void lcd128x64update (void)
|
|
{
|
|
int line, x, y, fbLoc ;
|
|
unsigned char byte ;
|
|
|
|
// Left side
|
|
|
|
for (line = 0 ; line < 8 ; ++line)
|
|
{
|
|
setCol (0, CS1) ;
|
|
setLine (line, CS1) ;
|
|
|
|
for (x = 63 ; x >= 0 ; --x)
|
|
{
|
|
byte = 0 ;
|
|
for (y = 0 ; y < 8 ; ++y)
|
|
{
|
|
fbLoc = x + (((7 - line) * 8) + (7 - y)) * LCD_WIDTH ;
|
|
if (frameBuffer [fbLoc] != 0)
|
|
byte |= (1 << y) ;
|
|
}
|
|
sendData (byte, CS1) ;
|
|
}
|
|
}
|
|
|
|
// Right side
|
|
|
|
for (line = 0 ; line < 8 ; ++line)
|
|
{
|
|
setCol (0, CS2) ;
|
|
setLine (line, CS2) ;
|
|
|
|
for (x = 127 ; x >= 64 ; --x)
|
|
{
|
|
byte = 0 ;
|
|
for (y = 0 ; y < 8 ; ++y)
|
|
{
|
|
fbLoc = x + (((7 - line) * 8) + (7 - y)) * LCD_WIDTH ;
|
|
if (frameBuffer [fbLoc] != 0)
|
|
byte |= (1 << y) ;
|
|
}
|
|
sendData (byte, CS2) ;
|
|
}
|
|
}
|
|
}
|
|
|
|
|
|
/*
|
|
* lcd128x64setOrigin:
|
|
* Set the display offset origin
|
|
*********************************************************************************
|
|
*/
|
|
|
|
void lcd128x64setOrigin (int x, int y)
|
|
{
|
|
xOrigin = x ;
|
|
yOrigin = y ;
|
|
}
|
|
|
|
|
|
/*
|
|
* lcd128x64setOrientation:
|
|
* Set the display orientation:
|
|
* 0: Normal, the display is portrait mode, 0,0 is top left
|
|
* 1: Landscape
|
|
* 2: Portrait, flipped
|
|
* 3: Landscape, flipped
|
|
*********************************************************************************
|
|
*/
|
|
|
|
void lcd128x64setOrientation (int orientation)
|
|
{
|
|
lcdOrientation = orientation & 3 ;
|
|
|
|
lcd128x64setOrigin (0,0) ;
|
|
|
|
switch (lcdOrientation)
|
|
{
|
|
case 0:
|
|
maxX = LCD_WIDTH ;
|
|
maxY = LCD_HEIGHT ;
|
|
break ;
|
|
|
|
case 1:
|
|
maxX = LCD_HEIGHT ;
|
|
maxY = LCD_WIDTH ;
|
|
break ;
|
|
|
|
case 2:
|
|
maxX = LCD_WIDTH ;
|
|
maxY = LCD_HEIGHT ;
|
|
break ;
|
|
|
|
case 3:
|
|
maxX = LCD_HEIGHT ;
|
|
maxY = LCD_WIDTH ;
|
|
break ;
|
|
}
|
|
}
|
|
|
|
|
|
/*
|
|
* lcd128x64orientCoordinates:
|
|
* Adjust the coordinates given to the display orientation
|
|
*********************************************************************************
|
|
*/
|
|
|
|
void lcd128x64orientCoordinates (int *x, int *y)
|
|
{
|
|
register int tmp ;
|
|
|
|
*x += xOrigin ;
|
|
*y += yOrigin ;
|
|
*y = maxY - *y - 1 ;
|
|
|
|
switch (lcdOrientation)
|
|
{
|
|
case 0:
|
|
break;
|
|
|
|
case 1:
|
|
tmp = maxY - *y - 1 ;
|
|
*y = *x ;
|
|
*x = tmp ;
|
|
break;
|
|
|
|
case 2:
|
|
*x = maxX - *x - 1 ;
|
|
*y = maxY - *y - 1 ;
|
|
break;
|
|
|
|
case 3:
|
|
*x = maxX - *x - 1 ;
|
|
tmp = *y ;
|
|
*y = *x ;
|
|
*x = tmp ;
|
|
break ;
|
|
}
|
|
}
|
|
|
|
|
|
/*
|
|
* lcd128x64getScreenSize:
|
|
* Return the max X & Y screen sizes. Needs to be called again, if you
|
|
* change screen orientation.
|
|
*********************************************************************************
|
|
*/
|
|
|
|
void lcd128x64getScreenSize (int *x, int *y)
|
|
{
|
|
*x = maxX ;
|
|
*y = maxY ;
|
|
}
|
|
|
|
|
|
/*
|
|
*********************************************************************************
|
|
* Standard Graphical Functions
|
|
*********************************************************************************
|
|
*/
|
|
|
|
|
|
/*
|
|
* lcd128x64point:
|
|
* Plot a pixel.
|
|
*********************************************************************************
|
|
*/
|
|
|
|
void lcd128x64point (int x, int y, int colour)
|
|
{
|
|
lastX = x ;
|
|
lastY = y ;
|
|
|
|
lcd128x64orientCoordinates (&x, &y) ;
|
|
|
|
if ((x < 0) || (x >= LCD_WIDTH) || (y < 0) || (y >= LCD_HEIGHT))
|
|
return ;
|
|
|
|
frameBuffer [x + y * LCD_WIDTH] = colour ;
|
|
}
|
|
|
|
|
|
/*
|
|
* lcd128x64line: lcd128x64lineTo:
|
|
* Classic Bressenham Line code
|
|
*********************************************************************************
|
|
*/
|
|
|
|
void lcd128x64line (int x0, int y0, int x1, int y1, int colour)
|
|
{
|
|
int dx, dy ;
|
|
int sx, sy ;
|
|
int err, e2 ;
|
|
|
|
lastX = x1 ;
|
|
lastY = y1 ;
|
|
|
|
dx = abs (x1 - x0) ;
|
|
dy = abs (y1 - y0) ;
|
|
|
|
sx = (x0 < x1) ? 1 : -1 ;
|
|
sy = (y0 < y1) ? 1 : -1 ;
|
|
|
|
err = dx - dy ;
|
|
|
|
for (;;)
|
|
{
|
|
lcd128x64point (x0, y0, colour) ;
|
|
|
|
if ((x0 == x1) && (y0 == y1))
|
|
break ;
|
|
|
|
e2 = 2 * err ;
|
|
|
|
if (e2 > -dy)
|
|
{
|
|
err -= dy ;
|
|
x0 += sx ;
|
|
}
|
|
|
|
if (e2 < dx)
|
|
{
|
|
err += dx ;
|
|
y0 += sy ;
|
|
}
|
|
}
|
|
|
|
}
|
|
|
|
void lcd128x64lineTo (int x, int y, int colour)
|
|
{
|
|
lcd128x64line (lastX, lastY, x, y, colour) ;
|
|
}
|
|
|
|
|
|
/*
|
|
* lcd128x64rectangle:
|
|
* A rectangle is a spoilt days fishing
|
|
*********************************************************************************
|
|
*/
|
|
|
|
void lcd128x64rectangle (int x1, int y1, int x2, int y2, int colour, int filled)
|
|
{
|
|
register int x ;
|
|
|
|
if (filled)
|
|
{
|
|
/**/ if (x1 == x2)
|
|
lcd128x64line (x1, y1, x2, y2, colour) ;
|
|
else if (x1 < x2)
|
|
for (x = x1 ; x <= x2 ; ++x)
|
|
lcd128x64line (x, y1, x, y2, colour) ;
|
|
else
|
|
for (x = x2 ; x <= x1 ; ++x)
|
|
lcd128x64line (x, y1, x, y2, colour) ;
|
|
}
|
|
else
|
|
{
|
|
lcd128x64line (x1, y1, x2, y1, colour) ;
|
|
lcd128x64lineTo (x2, y2, colour) ;
|
|
lcd128x64lineTo (x1, y2, colour) ;
|
|
lcd128x64lineTo (x1, y1, colour) ;
|
|
}
|
|
}
|
|
|
|
|
|
/*
|
|
* lcd128x64circle:
|
|
* This is the midpoint circle algorithm.
|
|
*********************************************************************************
|
|
*/
|
|
|
|
void lcd128x64circle (int x, int y, int r, int colour, int filled)
|
|
{
|
|
int ddF_x = 1 ;
|
|
int ddF_y = -2 * r ;
|
|
|
|
int f = 1 - r ;
|
|
int x1 = 0 ;
|
|
int y1 = r ;
|
|
|
|
if (filled)
|
|
{
|
|
lcd128x64line (x, y + r, x, y - r, colour) ;
|
|
lcd128x64line (x + r, y, x - r, y, colour) ;
|
|
}
|
|
else
|
|
{
|
|
lcd128x64point (x, y + r, colour) ;
|
|
lcd128x64point (x, y - r, colour) ;
|
|
lcd128x64point (x + r, y, colour) ;
|
|
lcd128x64point (x - r, y, colour) ;
|
|
}
|
|
|
|
while (x1 < y1)
|
|
{
|
|
if (f >= 0)
|
|
{
|
|
y1-- ;
|
|
ddF_y += 2 ;
|
|
f += ddF_y ;
|
|
}
|
|
x1++ ;
|
|
ddF_x += 2 ;
|
|
f += ddF_x ;
|
|
if (filled)
|
|
{
|
|
lcd128x64line (x + x1, y + y1, x - x1, y + y1, colour) ;
|
|
lcd128x64line (x + x1, y - y1, x - x1, y - y1, colour) ;
|
|
lcd128x64line (x + y1, y + x1, x - y1, y + x1, colour) ;
|
|
lcd128x64line (x + y1, y - x1, x - y1, y - x1, colour) ;
|
|
}
|
|
else
|
|
{
|
|
lcd128x64point (x + x1, y + y1, colour) ; lcd128x64point (x - x1, y + y1, colour) ;
|
|
lcd128x64point (x + x1, y - y1, colour) ; lcd128x64point (x - x1, y - y1, colour) ;
|
|
lcd128x64point (x + y1, y + x1, colour) ; lcd128x64point (x - y1, y + x1, colour) ;
|
|
lcd128x64point (x + y1, y - x1, colour) ; lcd128x64point (x - y1, y - x1, colour) ;
|
|
}
|
|
}
|
|
}
|
|
|
|
|
|
/*
|
|
* lcd128x64ellipse:
|
|
* Fast ellipse drawing algorithm by
|
|
* John Kennedy
|
|
* Mathematics Department
|
|
* Santa Monica College
|
|
* 1900 Pico Blvd.
|
|
* Santa Monica, CA 90405
|
|
* jrkennedy6@gmail.com
|
|
* -Confirned in email this algorithm is in the public domain -GH-
|
|
*********************************************************************************
|
|
*/
|
|
|
|
static void plot4ellipsePoints (int cx, int cy, int x, int y, int colour, int filled)
|
|
{
|
|
if (filled)
|
|
{
|
|
lcd128x64line (cx + x, cy + y, cx - x, cy + y, colour) ;
|
|
lcd128x64line (cx - x, cy - y, cx + x, cy - y, colour) ;
|
|
}
|
|
else
|
|
{
|
|
lcd128x64point (cx + x, cy + y, colour) ;
|
|
lcd128x64point (cx - x, cy + y, colour) ;
|
|
lcd128x64point (cx - x, cy - y, colour) ;
|
|
lcd128x64point (cx + x, cy - y, colour) ;
|
|
}
|
|
}
|
|
|
|
void lcd128x64ellipse (int cx, int cy, int xRadius, int yRadius, int colour, int filled)
|
|
{
|
|
int x, y ;
|
|
int xChange, yChange, ellipseError ;
|
|
int twoAsquare, twoBsquare ;
|
|
int stoppingX, stoppingY ;
|
|
|
|
twoAsquare = 2 * xRadius * xRadius ;
|
|
twoBsquare = 2 * yRadius * yRadius ;
|
|
|
|
x = xRadius ;
|
|
y = 0 ;
|
|
|
|
xChange = yRadius * yRadius * (1 - 2 * xRadius) ;
|
|
yChange = xRadius * xRadius ;
|
|
|
|
ellipseError = 0 ;
|
|
stoppingX = twoBsquare * xRadius ;
|
|
stoppingY = 0 ;
|
|
|
|
while (stoppingX >= stoppingY) // 1st set of points
|
|
{
|
|
plot4ellipsePoints (cx, cy, x, y, colour, filled) ;
|
|
++y ;
|
|
stoppingY += twoAsquare ;
|
|
ellipseError += yChange ;
|
|
yChange += twoAsquare ;
|
|
|
|
if ((2 * ellipseError + xChange) > 0 )
|
|
{
|
|
--x ;
|
|
stoppingX -= twoBsquare ;
|
|
ellipseError += xChange ;
|
|
xChange += twoBsquare ;
|
|
}
|
|
}
|
|
|
|
x = 0 ;
|
|
y = yRadius ;
|
|
|
|
xChange = yRadius * yRadius ;
|
|
yChange = xRadius * xRadius * (1 - 2 * yRadius) ;
|
|
|
|
ellipseError = 0 ;
|
|
stoppingX = 0 ;
|
|
stoppingY = twoAsquare * yRadius ;
|
|
|
|
while (stoppingX <= stoppingY) //2nd set of points
|
|
{
|
|
plot4ellipsePoints (cx, cy, x, y, colour, filled) ;
|
|
++x ;
|
|
stoppingX += twoBsquare ;
|
|
ellipseError += xChange ;
|
|
xChange += twoBsquare ;
|
|
|
|
if ((2 * ellipseError + yChange) > 0 )
|
|
{
|
|
--y ;
|
|
stoppingY -= twoAsquare ;
|
|
ellipseError += yChange ;
|
|
yChange += twoAsquare ;
|
|
}
|
|
}
|
|
}
|
|
|
|
|
|
/*
|
|
* lcd128x64putchar:
|
|
* Print a single character to the screen
|
|
*********************************************************************************
|
|
*/
|
|
|
|
void lcd128x64putchar (int x, int y, int c, int bgCol, int fgCol)
|
|
{
|
|
int y1, y2 ;
|
|
|
|
unsigned char line ;
|
|
unsigned char *fontPtr ;
|
|
|
|
// Can't print if we're offscreen
|
|
|
|
//if ((x < 0) || (x >= (maxX - fontWidth)) || (y < 0) || (y >= (maxY - fontHeight)))
|
|
// return ;
|
|
|
|
fontPtr = font + c * fontHeight ;
|
|
|
|
for (y1 = fontHeight - 1 ; y1 >= 0 ; --y1)
|
|
{
|
|
y2 = y + y1 ;
|
|
line = *fontPtr++ ;
|
|
lcd128x64point (x + 0, y2, (line & 0x80) == 0 ? bgCol : fgCol) ;
|
|
lcd128x64point (x + 1, y2, (line & 0x40) == 0 ? bgCol : fgCol) ;
|
|
lcd128x64point (x + 2, y2, (line & 0x20) == 0 ? bgCol : fgCol) ;
|
|
lcd128x64point (x + 3, y2, (line & 0x10) == 0 ? bgCol : fgCol) ;
|
|
lcd128x64point (x + 4, y2, (line & 0x08) == 0 ? bgCol : fgCol) ;
|
|
lcd128x64point (x + 5, y2, (line & 0x04) == 0 ? bgCol : fgCol) ;
|
|
lcd128x64point (x + 6, y2, (line & 0x02) == 0 ? bgCol : fgCol) ;
|
|
lcd128x64point (x + 7, y2, (line & 0x01) == 0 ? bgCol : fgCol) ;
|
|
}
|
|
}
|
|
|
|
|
|
/*
|
|
* lcd128x64puts:
|
|
* Send a string to the display. Obeys \n and \r formatting
|
|
*********************************************************************************
|
|
*/
|
|
|
|
void lcd128x64puts (int x, int y, const char *str, int bgCol, int fgCol)
|
|
{
|
|
int c, mx, my ;
|
|
|
|
mx = x ; my = y ;
|
|
|
|
while (*str)
|
|
{
|
|
c = *str++ ;
|
|
|
|
if (c == '\r')
|
|
{
|
|
mx = x ;
|
|
continue ;
|
|
}
|
|
|
|
if (c == '\n')
|
|
{
|
|
mx = x ;
|
|
my -= fontHeight ;
|
|
continue ;
|
|
}
|
|
|
|
lcd128x64putchar (mx, my, c, bgCol, fgCol) ;
|
|
|
|
mx += fontWidth ;
|
|
if (mx >= (maxX - fontWidth))
|
|
{
|
|
mx = 0 ;
|
|
my -= fontHeight ;
|
|
}
|
|
}
|
|
}
|
|
|
|
|
|
/*
|
|
* lcd128x64clear:
|
|
* Clear the display to the given colour.
|
|
*********************************************************************************
|
|
*/
|
|
|
|
void lcd128x64clear (int colour)
|
|
{
|
|
register int i ;
|
|
register unsigned char *ptr = frameBuffer ;
|
|
|
|
for (i = 0 ; i < (maxX * maxY) ; ++i)
|
|
*ptr++ = colour ;
|
|
}
|
|
|
|
|
|
|
|
|
|
/*
|
|
* lcd128x64setup:
|
|
* Initialise the display and GPIO.
|
|
*********************************************************************************
|
|
*/
|
|
|
|
int lcd128x64setup (void)
|
|
{
|
|
int i ;
|
|
|
|
for (i = 0 ; i < 8 ; ++i)
|
|
pinMode (i, OUTPUT) ;
|
|
|
|
digitalWrite (CS1, 1) ;
|
|
digitalWrite (CS2, 1) ;
|
|
digitalWrite (STROBE, 0) ;
|
|
digitalWrite (RS, 1) ;
|
|
|
|
pinMode (CS1, OUTPUT) ;
|
|
pinMode (CS2, OUTPUT) ;
|
|
pinMode (STROBE, OUTPUT) ;
|
|
pinMode (RS, OUTPUT) ;
|
|
|
|
sendCommand (0x3F, CS1) ; // Display ON
|
|
sendCommand (0xC0, CS1) ; // Set display start line to 0
|
|
|
|
sendCommand (0x3F, CS2) ; // Display ON
|
|
sendCommand (0xC0, CS2) ; // Set display start line to 0
|
|
|
|
lcd128x64clear (0) ;
|
|
lcd128x64setOrientation (0) ;
|
|
lcd128x64update () ;
|
|
|
|
return 0 ;
|
|
}
|