WiringPi: Bring back all of the stuffs I removed to do with peripherals
Imported from the official WiringPi repository, version 2.60. Signed-off-by: Deokgyu Yang <secugyu@gmail.com> Change-Id: I82dc00ab9f038f9bc4c6a9c4ca3affe5a5d33ae1
This commit is contained in:
Deokgyu Yang
430
devLib/scrollPhat.c
Normal file
430
devLib/scrollPhat.c
Normal file
@@ -0,0 +1,430 @@
|
||||
/*
|
||||
* scrollPhat.c:
|
||||
* Simple driver for the Pimoroni Scroll Phat device
|
||||
*
|
||||
* Copyright (c) 2015 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 <stdarg.h>
|
||||
#include <string.h>
|
||||
#include <time.h>
|
||||
|
||||
#include <wiringPiI2C.h>
|
||||
|
||||
#include "scrollPhatFont.h"
|
||||
#include "scrollPhat.h"
|
||||
|
||||
// Size
|
||||
|
||||
#define SP_WIDTH 11
|
||||
#define SP_HEIGHT 5
|
||||
|
||||
// I2C
|
||||
|
||||
#define PHAT_I2C_ADDR 0x60
|
||||
|
||||
// Software copy of the framebuffer
|
||||
// it's 8-bit deep although the display itself is only 1-bit deep.
|
||||
|
||||
static unsigned char frameBuffer [SP_WIDTH * SP_HEIGHT] ;
|
||||
|
||||
static int lastX, lastY ;
|
||||
static int printDelayFactor ;
|
||||
static int scrollPhatFd ;
|
||||
|
||||
static int putcharX ;
|
||||
|
||||
#undef DEBUG
|
||||
|
||||
|
||||
/*
|
||||
* delay:
|
||||
* Wait for some number of milliseconds.
|
||||
* This taken from wiringPi as there is no-need to include the whole of
|
||||
* wiringPi just for the delay function.
|
||||
*********************************************************************************
|
||||
*/
|
||||
|
||||
static void delay (unsigned int howLong)
|
||||
{
|
||||
struct timespec sleeper, dummy ;
|
||||
|
||||
sleeper.tv_sec = (time_t)(howLong / 1000) ;
|
||||
sleeper.tv_nsec = (long)(howLong % 1000) * 1000000 ;
|
||||
|
||||
nanosleep (&sleeper, &dummy) ;
|
||||
}
|
||||
|
||||
|
||||
|
||||
/*
|
||||
* scrollPhatUpdate:
|
||||
* Copy our software version to the real display
|
||||
*********************************************************************************
|
||||
*/
|
||||
|
||||
void scrollPhatUpdate (void)
|
||||
{
|
||||
register int x, y ;
|
||||
register unsigned char data, pixel ;
|
||||
unsigned char pixels [SP_WIDTH] ;
|
||||
|
||||
#ifdef DEBUG
|
||||
printf ("+-----------+\n") ;
|
||||
for (y = 0 ; y < SP_HEIGHT ; ++y)
|
||||
{
|
||||
putchar ('|') ;
|
||||
for (x = 0 ; x < SP_WIDTH ; ++x)
|
||||
{
|
||||
pixel = frameBuffer [x + y * SP_WIDTH] ;
|
||||
putchar (pixel == 0 ? ' ' : '*') ;
|
||||
}
|
||||
printf ("|\n") ;
|
||||
}
|
||||
printf ("+-----------+\n") ;
|
||||
#endif
|
||||
|
||||
for (x = 0 ; x < SP_WIDTH ; ++x)
|
||||
{
|
||||
data = 0 ;
|
||||
for (y = 0 ; y < SP_HEIGHT ; ++y)
|
||||
{
|
||||
pixel = frameBuffer [x + y * SP_WIDTH] ;
|
||||
data = (data << 1) | ((pixel == 0) ? 0 : 1) ;
|
||||
}
|
||||
pixels [x] = data ;
|
||||
}
|
||||
|
||||
for (x = 0 ; x < SP_WIDTH ; ++x)
|
||||
wiringPiI2CWriteReg8 (scrollPhatFd, 1 + x, pixels [x]) ;
|
||||
|
||||
wiringPiI2CWriteReg8 (scrollPhatFd, 0x0C, 0) ;
|
||||
}
|
||||
|
||||
|
||||
/*
|
||||
*********************************************************************************
|
||||
* Standard Graphical Functions
|
||||
*********************************************************************************
|
||||
*/
|
||||
|
||||
|
||||
/*
|
||||
* scrollPhatPoint:
|
||||
* Plot a pixel. Crude clipping - speed is not the essence here.
|
||||
*********************************************************************************
|
||||
*/
|
||||
|
||||
void scrollPhatPoint (int x, int y, int colour)
|
||||
{
|
||||
lastX = x ;
|
||||
lastY = y ;
|
||||
|
||||
if ((x < 0) || (x >= SP_WIDTH) || (y < 0) || (y >= SP_HEIGHT))
|
||||
return ;
|
||||
|
||||
frameBuffer [x + y * SP_WIDTH] = colour ;
|
||||
}
|
||||
|
||||
|
||||
/*
|
||||
* scrollPhatLine: scrollPhatLineTo:
|
||||
* Classic Bressenham Line code - rely on the point function to do the
|
||||
* clipping for us here.
|
||||
*********************************************************************************
|
||||
*/
|
||||
|
||||
void scrollPhatLine (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 (;;)
|
||||
{
|
||||
scrollPhatPoint (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 scrollPhatLineTo (int x, int y, int colour)
|
||||
{
|
||||
scrollPhatLine (lastX, lastY, x, y, colour) ;
|
||||
}
|
||||
|
||||
|
||||
/*
|
||||
* scrollPhatRectangle:
|
||||
* A rectangle is a spoilt days fishing
|
||||
*********************************************************************************
|
||||
*/
|
||||
|
||||
void scrollPhatRectangle (int x1, int y1, int x2, int y2, int colour, int filled)
|
||||
{
|
||||
register int x ;
|
||||
|
||||
if (filled)
|
||||
{
|
||||
/**/ if (x1 == x2)
|
||||
scrollPhatLine (x1, y1, x2, y2, colour) ;
|
||||
else if (x1 < x2)
|
||||
for (x = x1 ; x <= x2 ; ++x)
|
||||
scrollPhatLine (x, y1, x, y2, colour) ;
|
||||
else
|
||||
for (x = x2 ; x <= x1 ; ++x)
|
||||
scrollPhatLine (x, y1, x, y2, colour) ;
|
||||
}
|
||||
else
|
||||
{
|
||||
scrollPhatLine (x1, y1, x2, y1, colour) ;
|
||||
scrollPhatLineTo (x2, y2, colour) ;
|
||||
scrollPhatLineTo (x1, y2, colour) ;
|
||||
scrollPhatLineTo (x1, y1, colour) ;
|
||||
}
|
||||
}
|
||||
|
||||
|
||||
/*
|
||||
* scrollPhatPutchar:
|
||||
* Print a single character to the screen then advance the pointer by an
|
||||
* appropriate ammount (variable width font).
|
||||
* We rely on the clipping done by the pixel plot function to keep us
|
||||
* out of trouble.
|
||||
* Return the width + space
|
||||
*********************************************************************************
|
||||
*/
|
||||
|
||||
int scrollPhatPutchar (int c)
|
||||
{
|
||||
register int x, y ;
|
||||
|
||||
unsigned char line ;
|
||||
unsigned char *fontPtr ;
|
||||
unsigned char *p2 ;
|
||||
int lineWidth, width, mask ;
|
||||
|
||||
// The font is printable characters, uppercase only...
|
||||
// and somewhat varaible width...
|
||||
|
||||
c &= 0x7F ;
|
||||
if (c > 0x60)
|
||||
c -= 64 ;
|
||||
else
|
||||
c -= 32 ;
|
||||
|
||||
fontPtr = scrollPhatFont + c * fontHeight ;
|
||||
|
||||
// Work out width of this character
|
||||
// There probably is a more efficient way to do this, but...
|
||||
|
||||
p2 = fontPtr ;
|
||||
width = 0 ;
|
||||
for (y = 0 ; y < fontHeight ; ++y)
|
||||
{
|
||||
mask = 0x80 ;
|
||||
for (lineWidth = 8 ; lineWidth > 0 ; --lineWidth)
|
||||
{
|
||||
if ((*p2 & mask) != 0)
|
||||
break ;
|
||||
mask >>= 1 ;
|
||||
}
|
||||
if (lineWidth > width)
|
||||
width = lineWidth ;
|
||||
|
||||
++p2 ;
|
||||
}
|
||||
|
||||
if (width == 0) // Likely to be a blank or space character
|
||||
width = 3 ;
|
||||
|
||||
for (y = fontHeight - 1 ; y >= 0 ; --y)
|
||||
{
|
||||
x = 0 ;
|
||||
line = *fontPtr++ ;
|
||||
for (mask = 1 << (width - 1) ; mask != 0 ; mask >>= 1)
|
||||
{
|
||||
scrollPhatPoint (putcharX + x, y, (line & mask)) ;
|
||||
++x ;
|
||||
}
|
||||
}
|
||||
|
||||
// make a line of space
|
||||
|
||||
for (y = fontHeight - 1 ; y >= 0 ; --y)
|
||||
scrollPhatPoint (putcharX + width, y, 0) ;
|
||||
|
||||
putcharX = putcharX + width + 1 ;
|
||||
|
||||
return width + 1 ;
|
||||
}
|
||||
|
||||
|
||||
/*
|
||||
* scrollPhatPuts:
|
||||
* Send a string to the display - and scroll it across.
|
||||
* This is somewhat of a hack in that we print the entire string to the
|
||||
* display and let the point clipping take care of what's off-screen...
|
||||
*********************************************************************************
|
||||
*/
|
||||
|
||||
void scrollPhatPuts (const char *str)
|
||||
{
|
||||
int i ;
|
||||
int movingX = 0 ;
|
||||
const char *s ;
|
||||
int pixelLen ;
|
||||
|
||||
// Print it once, then we know the width in pixels...
|
||||
|
||||
putcharX = 0 ;
|
||||
s = str ;
|
||||
while (*s)
|
||||
scrollPhatPutchar (*s++) ;
|
||||
|
||||
pixelLen = putcharX ;
|
||||
|
||||
// Now scroll it by printing it and moving left one pixel
|
||||
|
||||
movingX = 0 ;
|
||||
for (i = 0 ; i < pixelLen ; ++i)
|
||||
{
|
||||
putcharX = movingX ;
|
||||
s = str ;
|
||||
while (*s)
|
||||
scrollPhatPutchar (*s++) ;
|
||||
--movingX ;
|
||||
scrollPhatUpdate () ;
|
||||
delay (printDelayFactor) ;
|
||||
}
|
||||
}
|
||||
|
||||
|
||||
/*
|
||||
* scrollPhatPrintf:
|
||||
* Does what it says
|
||||
*********************************************************************************
|
||||
*/
|
||||
|
||||
void scrollPhatPrintf (const char *message, ...)
|
||||
{
|
||||
va_list argp ;
|
||||
char buffer [1024] ;
|
||||
|
||||
va_start (argp, message) ;
|
||||
vsnprintf (buffer, 1023, message, argp) ;
|
||||
va_end (argp) ;
|
||||
|
||||
scrollPhatPuts (buffer) ;
|
||||
}
|
||||
|
||||
|
||||
/*
|
||||
* scrollPhatPrintSpeed:
|
||||
* Change the print speed - mS per shift by 1 pixel
|
||||
*********************************************************************************
|
||||
*/
|
||||
|
||||
void scrollPhatPrintSpeed (const int pps)
|
||||
{
|
||||
if (pps < 0)
|
||||
printDelayFactor = 0 ;
|
||||
else
|
||||
printDelayFactor = pps ;
|
||||
}
|
||||
|
||||
|
||||
/*
|
||||
* scrollPhatClear:
|
||||
* Clear the display
|
||||
*********************************************************************************
|
||||
*/
|
||||
|
||||
void scrollPhatClear (void)
|
||||
{
|
||||
register int i ;
|
||||
register unsigned char *ptr = frameBuffer ;
|
||||
|
||||
for (i = 0 ; i < (SP_WIDTH * SP_HEIGHT) ; ++i)
|
||||
*ptr++ = 0 ;
|
||||
|
||||
scrollPhatUpdate () ;
|
||||
}
|
||||
|
||||
|
||||
/*
|
||||
* scrollPhatIntensity:
|
||||
* Set the display brightness - percentage
|
||||
*********************************************************************************
|
||||
*/
|
||||
|
||||
void scrollPhatIntensity (const int percent)
|
||||
{
|
||||
wiringPiI2CWriteReg8 (scrollPhatFd, 0x19, (127 * percent) / 100) ;
|
||||
}
|
||||
|
||||
|
||||
/*
|
||||
* scrollPhatSetup:
|
||||
* Initialise the Scroll Phat display
|
||||
*********************************************************************************
|
||||
*/
|
||||
|
||||
int scrollPhatSetup (void)
|
||||
{
|
||||
if ((scrollPhatFd = wiringPiI2CSetup (PHAT_I2C_ADDR)) < 0)
|
||||
return scrollPhatFd ;
|
||||
|
||||
wiringPiI2CWriteReg8 (scrollPhatFd, 0x00, 0x03) ; // Enable display, set to 5x11 mode
|
||||
scrollPhatIntensity (10) ;
|
||||
scrollPhatClear () ;
|
||||
scrollPhatPrintSpeed (100) ;
|
||||
|
||||
return 0 ;
|
||||
}
|
||||
Reference in New Issue
Block a user