675 lines
14 KiB
C
675 lines
14 KiB
C
#include <stdlib.h>
|
|
#include <stdio.h>
|
|
#include <unistd.h>
|
|
#include <termios.h>
|
|
#include <fcntl.h>
|
|
#include <string.h>
|
|
#include <errno.h>
|
|
#include "lcd.h"
|
|
#include "CFontz.h"
|
|
#include "drv_base.h"
|
|
|
|
#include "../render.h"
|
|
|
|
#include "../../shared/debug.h"
|
|
#include "../../shared/str.h"
|
|
|
|
static int custom = 0;
|
|
typedef enum {
|
|
hbar = 1,
|
|
vbar = 2,
|
|
bign = 4,
|
|
beat = 8
|
|
} custom_type;
|
|
|
|
static int fd;
|
|
|
|
static void CFontz_linewrap (int on);
|
|
static void CFontz_autoscroll (int on);
|
|
static void CFontz_hidecursor ();
|
|
static void CFontz_reboot ();
|
|
|
|
// TODO: Get rid of this variable?
|
|
lcd_logical_driver *CFontz;
|
|
// TODO: Get the frame buffers working right
|
|
|
|
/////////////////////////////////////////////////////////////////
|
|
// Opens com port and sets baud correctly...
|
|
//
|
|
int
|
|
CFontz_init (lcd_logical_driver * driver, char *args)
|
|
{
|
|
char *argv[64];
|
|
int argc;
|
|
struct termios portset;
|
|
int i;
|
|
int tmp;
|
|
int reboot = 0;
|
|
|
|
int contrast = 140;
|
|
char device[256] = "/dev/lcd";
|
|
int speed = B9600;
|
|
|
|
CFontz = driver;
|
|
|
|
//debug("CFontz_init: Args(all): %s\n", args);
|
|
|
|
argc = get_args (argv, args, 64);
|
|
|
|
/*
|
|
for(i=0; i<argc; i++)
|
|
{
|
|
printf("Arg(%i): %s\n", i, argv[i]);
|
|
}
|
|
*/
|
|
|
|
for (i = 0; i < argc; i++) {
|
|
//printf("Arg(%i): %s\n", i, argv[i]);
|
|
if (0 == strcmp (argv[i], "-d") || 0 == strcmp (argv[i], "--device")) {
|
|
if (i + 1 > argc) {
|
|
fprintf (stderr, "CFontz_init: %s requires an argument\n", argv[i]);
|
|
return -1;
|
|
}
|
|
strcpy (device, argv[++i]);
|
|
} else if (0 == strcmp (argv[i], "-c") || 0 == strcmp (argv[i], "--contrast")) {
|
|
if (i + 1 > argc) {
|
|
fprintf (stderr, "CFontz_init: %s requires an argument\n", argv[i]);
|
|
return -1;
|
|
}
|
|
tmp = atoi (argv[++i]);
|
|
if ((tmp < 0) || (tmp > 255)) {
|
|
fprintf (stderr, "CFontz_init: %s argument must between 0 and 255. Using default value.\n", argv[i]);
|
|
} else
|
|
contrast = tmp;
|
|
} else if (0 == strcmp (argv[i], "-b") || 0 == strcmp (argv[i], "--brightness")) {
|
|
if (i + 1 > argc) {
|
|
fprintf (stderr, "CFontz_init: %s requires an argument\n", argv[i]);
|
|
return -1;
|
|
}
|
|
tmp = atoi (argv[++i]);
|
|
if ((tmp < 0) || (tmp > 255)) {
|
|
fprintf (stderr, "CFontz_init: %s argument must between 0 and 255. Using default value.\n", argv[i]);
|
|
} else
|
|
backlight_brightness = tmp;
|
|
} else if (0 == strcmp (argv[i], "-o") || 0 == strcmp (argv[i], "--off-bright")) {
|
|
if (i + 1 > argc) {
|
|
fprintf (stderr, "CFontz_init: %s requires an argument\n", argv[i]);
|
|
return -1;
|
|
}
|
|
tmp = atoi (argv[++i]);
|
|
if ((tmp < 0) || (tmp > 255)) {
|
|
fprintf (stderr, "CFontz_init: %s argument must between 0 and 255. Using default value.\n", argv[i]);
|
|
} else
|
|
backlight_off_brightness = tmp;
|
|
} else if (0 == strcmp (argv[i], "-s") || 0 == strcmp (argv[i], "--speed")) {
|
|
if (i + 1 > argc) {
|
|
fprintf (stderr, "CFontz_init: %s requires an argument\n", argv[i]);
|
|
return -1;
|
|
}
|
|
tmp = atoi (argv[++i]);
|
|
if (tmp == 1200)
|
|
speed = B1200;
|
|
else if (tmp == 2400)
|
|
speed = B2400;
|
|
else if (tmp == 9600)
|
|
speed = B9600;
|
|
else if (tmp == 19200)
|
|
speed = B19200;
|
|
else {
|
|
fprintf (stderr, "CFontz_init: %s argument must be 1200, 2400, or 9600. Using default value.\n", argv[i]);
|
|
}
|
|
} else if (0 == strcmp (argv[i], "-h") || 0 == strcmp (argv[i], "--help")) {
|
|
printf ("LCDproc CrystalFontz LCD driver\n" "\t-d\t--device\tSelect the output device to use [/dev/lcd]\n" "\t-t\t--type\t\tSelect the LCD type (size) [20x4]\n" "\t-c\t--contrast\tSet the initial contrast [140]\n" "\t-b\t--brightness\tSet the initial brightness [255]\n" "\t-o\t--off-bright\tSet the initial brightness [0]\n" "\t-s\t--speed\t\tSet the communication speed [9600]\n" "\t-r\t--reboot\tReinitialize the LCD's BIOS\n" "\t-h\t--help\t\tShow this help information\n");
|
|
return -1;
|
|
} else if (0 == strcmp (argv[i], "-r") || 0 == strcmp (argv[i], "--reboot")) {
|
|
printf ("LCDd: rebooting CrystalFontz LCD...\n");
|
|
reboot = 1;
|
|
} else {
|
|
printf ("Invalid parameter: %s\n", argv[i]);
|
|
}
|
|
|
|
}
|
|
|
|
// Set up io port correctly, and open it...
|
|
fd = open (device, O_RDWR | O_NOCTTY | O_NDELAY);
|
|
if (fd == -1) {
|
|
fprintf (stderr, "CFontz_init: failed (%s)\n", strerror (errno));
|
|
return -1;
|
|
}
|
|
//else fprintf(stderr, "CFontz_init: opened device %s\n", device);
|
|
tcgetattr (fd, &portset);
|
|
// This is necessary in Linux, but does not exist in irix.
|
|
#ifndef IRIX
|
|
cfmakeraw (&portset);
|
|
#endif
|
|
cfsetospeed (&portset, speed);
|
|
cfsetispeed (&portset, speed);
|
|
tcsetattr (fd, TCSANOW, &portset);
|
|
|
|
// Set display-specific stuff..
|
|
if (reboot) {
|
|
CFontz_reboot ();
|
|
sleep (4);
|
|
reboot = 0;
|
|
}
|
|
sleep (1);
|
|
CFontz_hidecursor ();
|
|
CFontz_linewrap (1);
|
|
CFontz_autoscroll (0);
|
|
CFontz_backlight (backlight_brightness);
|
|
|
|
if (!driver->framebuf) {
|
|
fprintf (stderr, "CFontz_init: No frame buffer.\n");
|
|
driver->close ();
|
|
return -1;
|
|
}
|
|
// Set the functions the driver supports...
|
|
|
|
driver->clear = (void *) -1;
|
|
driver->string = (void *) -1;
|
|
// driver->chr = CFontz_chr;
|
|
driver->chr = CFontz_chr;
|
|
driver->vbar = CFontz_vbar;
|
|
driver->init_vbar = CFontz_init_vbar;
|
|
driver->hbar = CFontz_hbar;
|
|
driver->init_hbar = CFontz_init_hbar;
|
|
driver->num = CFontz_num;
|
|
driver->init_num = CFontz_init_num;
|
|
|
|
driver->init = CFontz_init;
|
|
driver->close = CFontz_close;
|
|
driver->flush = CFontz_flush;
|
|
driver->flush_box = CFontz_flush_box;
|
|
driver->contrast = CFontz_contrast;
|
|
driver->backlight = CFontz_backlight;
|
|
driver->set_char = CFontz_set_char;
|
|
driver->icon = CFontz_icon;
|
|
driver->draw_frame = CFontz_draw_frame;
|
|
|
|
CFontz_contrast (contrast);
|
|
|
|
lcd.cellwid = 6;
|
|
lcd.cellhgt = 8;
|
|
|
|
debug ("CFontz: foo!\n");
|
|
|
|
return fd;
|
|
}
|
|
|
|
/////////////////////////////////////////////////////////////////
|
|
// Clean-up
|
|
//
|
|
void
|
|
CFontz_close ()
|
|
{
|
|
close (fd);
|
|
|
|
if (CFontz->framebuf)
|
|
free (CFontz->framebuf);
|
|
|
|
CFontz->framebuf = NULL;
|
|
}
|
|
|
|
void
|
|
CFontz_flush ()
|
|
{
|
|
CFontz_draw_frame (lcd.framebuf);
|
|
}
|
|
|
|
void
|
|
CFontz_flush_box (int lft, int top, int rgt, int bot)
|
|
{
|
|
int y;
|
|
char out[LCD_MAX_WIDTH];
|
|
|
|
// printf("Flush (%i,%i)-(%i,%i)\n", lft, top, rgt, bot);
|
|
|
|
for (y = top; y <= bot; y++) {
|
|
sprintf (out, "%c%c%c", 17, lft, y);
|
|
write (fd, out, 4);
|
|
write (fd, lcd.framebuf + (y * lcd.wid) + lft, rgt - lft + 1);
|
|
|
|
}
|
|
|
|
}
|
|
|
|
/////////////////////////////////////////////////////////////////
|
|
// Prints a character on the lcd display, at position (x,y). The
|
|
// upper-left is (1,1), and the lower right should be (20,4).
|
|
//
|
|
void
|
|
CFontz_chr (int x, int y, char c)
|
|
{
|
|
y--;
|
|
x--;
|
|
|
|
if (c < 32 && c >= 0)
|
|
c += 128;
|
|
lcd.framebuf[(y * lcd.wid) + x] = c;
|
|
}
|
|
|
|
/////////////////////////////////////////////////////////////////
|
|
// Changes screen contrast (0-255; 140 seems good)
|
|
//
|
|
int
|
|
CFontz_contrast (int contrast)
|
|
{
|
|
int realcontrast;
|
|
char out[4];
|
|
static int status = 140;
|
|
|
|
if (contrast > 0) {
|
|
status = contrast;
|
|
realcontrast = (((int) (status)) * 100) / 255;
|
|
sprintf (out, "%c%c", 15, realcontrast);
|
|
write (fd, out, 3);
|
|
}
|
|
|
|
return status;
|
|
}
|
|
|
|
/////////////////////////////////////////////////////////////////
|
|
// Sets the backlight on or off -- can be done quickly for
|
|
// an intermediate brightness...
|
|
//
|
|
void
|
|
CFontz_backlight (int on)
|
|
{
|
|
char out[4];
|
|
if (on) {
|
|
sprintf (out, "%c%c", 14, (unsigned char) (on * 100 / 255));
|
|
//sprintf(out, "%c%c", 14, 100);
|
|
} else {
|
|
sprintf (out, "%c%c", 14, 0);
|
|
}
|
|
write (fd, out, 3);
|
|
}
|
|
|
|
/////////////////////////////////////////////////////////////////
|
|
// Toggle the built-in linewrapping feature
|
|
//
|
|
static void
|
|
CFontz_linewrap (int on)
|
|
{
|
|
char out[4];
|
|
if (on)
|
|
sprintf (out, "%c", 23);
|
|
else
|
|
sprintf (out, "%c", 24);
|
|
write (fd, out, 1);
|
|
}
|
|
|
|
/////////////////////////////////////////////////////////////////
|
|
// Toggle the built-in automatic scrolling feature
|
|
//
|
|
static void
|
|
CFontz_autoscroll (int on)
|
|
{
|
|
char out[4];
|
|
if (on)
|
|
sprintf (out, "%c", 19);
|
|
else
|
|
sprintf (out, "%c", 20);
|
|
write (fd, out, 1);
|
|
}
|
|
|
|
/////////////////////////////////////////////////////////////////
|
|
// Get rid of the blinking curson
|
|
//
|
|
static void
|
|
CFontz_hidecursor ()
|
|
{
|
|
char out[4];
|
|
sprintf (out, "%c", 4);
|
|
write (fd, out, 1);
|
|
}
|
|
|
|
/////////////////////////////////////////////////////////////////
|
|
// Reset the display bios
|
|
//
|
|
static void
|
|
CFontz_reboot ()
|
|
{
|
|
char out[4];
|
|
sprintf (out, "%c", 26);
|
|
write (fd, out, 1);
|
|
}
|
|
|
|
/////////////////////////////////////////////////////////////////
|
|
// Sets up for vertical bars. Call before lcd.vbar()
|
|
//
|
|
void
|
|
CFontz_init_vbar ()
|
|
{
|
|
char a[] = {
|
|
0, 0, 0, 0, 0, 0,
|
|
0, 0, 0, 0, 0, 0,
|
|
0, 0, 0, 0, 0, 0,
|
|
0, 0, 0, 0, 0, 0,
|
|
0, 0, 0, 0, 0, 0,
|
|
0, 0, 0, 0, 0, 0,
|
|
0, 0, 0, 0, 0, 0,
|
|
0, 1, 1, 1, 1, 1,
|
|
};
|
|
char b[] = {
|
|
0, 0, 0, 0, 0, 0,
|
|
0, 0, 0, 0, 0, 0,
|
|
0, 0, 0, 0, 0, 0,
|
|
0, 0, 0, 0, 0, 0,
|
|
0, 0, 0, 0, 0, 0,
|
|
0, 0, 0, 0, 0, 0,
|
|
0, 1, 1, 1, 1, 1,
|
|
0, 1, 1, 1, 1, 1,
|
|
};
|
|
char c[] = {
|
|
0, 0, 0, 0, 0, 0,
|
|
0, 0, 0, 0, 0, 0,
|
|
0, 0, 0, 0, 0, 0,
|
|
0, 0, 0, 0, 0, 0,
|
|
0, 0, 0, 0, 0, 0,
|
|
0, 1, 1, 1, 1, 1,
|
|
0, 1, 1, 1, 1, 1,
|
|
0, 1, 1, 1, 1, 1,
|
|
};
|
|
char d[] = {
|
|
0, 0, 0, 0, 0, 0,
|
|
0, 0, 0, 0, 0, 0,
|
|
0, 0, 0, 0, 0, 0,
|
|
0, 0, 0, 0, 0, 0,
|
|
0, 1, 1, 1, 1, 1,
|
|
0, 1, 1, 1, 1, 1,
|
|
0, 1, 1, 1, 1, 1,
|
|
0, 1, 1, 1, 1, 1,
|
|
};
|
|
char e[] = {
|
|
0, 0, 0, 0, 0, 0,
|
|
0, 0, 0, 0, 0, 0,
|
|
0, 0, 0, 0, 0, 0,
|
|
0, 1, 1, 1, 1, 1,
|
|
0, 1, 1, 1, 1, 1,
|
|
0, 1, 1, 1, 1, 1,
|
|
0, 1, 1, 1, 1, 1,
|
|
0, 1, 1, 1, 1, 1,
|
|
};
|
|
char f[] = {
|
|
0, 0, 0, 0, 0, 0,
|
|
0, 0, 0, 0, 0, 0,
|
|
0, 1, 1, 1, 1, 1,
|
|
0, 1, 1, 1, 1, 1,
|
|
0, 1, 1, 1, 1, 1,
|
|
0, 1, 1, 1, 1, 1,
|
|
0, 1, 1, 1, 1, 1,
|
|
0, 1, 1, 1, 1, 1,
|
|
};
|
|
char g[] = {
|
|
0, 0, 0, 0, 0, 0,
|
|
0, 1, 1, 1, 1, 1,
|
|
0, 1, 1, 1, 1, 1,
|
|
0, 1, 1, 1, 1, 1,
|
|
0, 1, 1, 1, 1, 1,
|
|
0, 1, 1, 1, 1, 1,
|
|
0, 1, 1, 1, 1, 1,
|
|
0, 1, 1, 1, 1, 1,
|
|
};
|
|
|
|
if (custom != vbar) {
|
|
CFontz_set_char (1, a);
|
|
CFontz_set_char (2, b);
|
|
CFontz_set_char (3, c);
|
|
CFontz_set_char (4, d);
|
|
CFontz_set_char (5, e);
|
|
CFontz_set_char (6, f);
|
|
CFontz_set_char (7, g);
|
|
custom = vbar;
|
|
}
|
|
}
|
|
|
|
/////////////////////////////////////////////////////////////////
|
|
// Inits horizontal bars...
|
|
//
|
|
void
|
|
CFontz_init_hbar ()
|
|
{
|
|
|
|
char a[] = {
|
|
1, 0, 0, 0, 0, 0,
|
|
1, 0, 0, 0, 0, 0,
|
|
1, 0, 0, 0, 0, 0,
|
|
1, 0, 0, 0, 0, 0,
|
|
1, 0, 0, 0, 0, 0,
|
|
1, 0, 0, 0, 0, 0,
|
|
1, 0, 0, 0, 0, 0,
|
|
1, 0, 0, 0, 0, 0,
|
|
};
|
|
char b[] = {
|
|
1, 1, 0, 0, 0, 0,
|
|
1, 1, 0, 0, 0, 0,
|
|
1, 1, 0, 0, 0, 0,
|
|
1, 1, 0, 0, 0, 0,
|
|
1, 1, 0, 0, 0, 0,
|
|
1, 1, 0, 0, 0, 0,
|
|
1, 1, 0, 0, 0, 0,
|
|
1, 1, 0, 0, 0, 0,
|
|
};
|
|
char c[] = {
|
|
1, 1, 1, 0, 0, 0,
|
|
1, 1, 1, 0, 0, 0,
|
|
1, 1, 1, 0, 0, 0,
|
|
1, 1, 1, 0, 0, 0,
|
|
1, 1, 1, 0, 0, 0,
|
|
1, 1, 1, 0, 0, 0,
|
|
1, 1, 1, 0, 0, 0,
|
|
1, 1, 1, 0, 0, 0,
|
|
};
|
|
char d[] = {
|
|
1, 1, 1, 1, 0, 0,
|
|
1, 1, 1, 1, 0, 0,
|
|
1, 1, 1, 1, 0, 0,
|
|
1, 1, 1, 1, 0, 0,
|
|
1, 1, 1, 1, 0, 0,
|
|
1, 1, 1, 1, 0, 0,
|
|
1, 1, 1, 1, 0, 0,
|
|
1, 1, 1, 1, 0, 0,
|
|
};
|
|
char e[] = {
|
|
1, 1, 1, 1, 1, 0,
|
|
1, 1, 1, 1, 1, 0,
|
|
1, 1, 1, 1, 1, 0,
|
|
1, 1, 1, 1, 1, 0,
|
|
1, 1, 1, 1, 1, 0,
|
|
1, 1, 1, 1, 1, 0,
|
|
1, 1, 1, 1, 1, 0,
|
|
1, 1, 1, 1, 1, 0,
|
|
};
|
|
char f[] = {
|
|
1, 1, 1, 1, 1, 1,
|
|
1, 1, 1, 1, 1, 1,
|
|
1, 1, 1, 1, 1, 1,
|
|
1, 1, 1, 1, 1, 1,
|
|
1, 1, 1, 1, 1, 1,
|
|
1, 1, 1, 1, 1, 1,
|
|
1, 1, 1, 1, 1, 1,
|
|
1, 1, 1, 1, 1, 1,
|
|
};
|
|
|
|
if (custom != hbar) {
|
|
CFontz_set_char (1, a);
|
|
CFontz_set_char (2, b);
|
|
CFontz_set_char (3, c);
|
|
CFontz_set_char (4, d);
|
|
CFontz_set_char (5, e);
|
|
CFontz_set_char (6, f);
|
|
custom = hbar;
|
|
}
|
|
}
|
|
|
|
/////////////////////////////////////////////////////////////////
|
|
// Draws a vertical bar...
|
|
//
|
|
void
|
|
CFontz_vbar (int x, int len)
|
|
{
|
|
char map[9] = { 32, 1, 2, 3, 4, 5, 6, 7, 255 };
|
|
|
|
int y;
|
|
for (y = lcd.hgt; y > 0 && len > 0; y--) {
|
|
if (len >= lcd.cellhgt)
|
|
CFontz_chr (x, y, 255);
|
|
else
|
|
CFontz_chr (x, y, map[len]);
|
|
|
|
len -= lcd.cellhgt;
|
|
}
|
|
|
|
}
|
|
|
|
/////////////////////////////////////////////////////////////////
|
|
// Draws a horizontal bar to the right.
|
|
//
|
|
void
|
|
CFontz_hbar (int x, int y, int len)
|
|
{
|
|
char map[7] = { 32, 1, 2, 3, 4, 5, 6 };
|
|
|
|
for (; x <= lcd.wid && len > 0; x++) {
|
|
if (len >= lcd.cellwid)
|
|
CFontz_chr (x, y, map[6]);
|
|
else
|
|
CFontz_chr (x, y, map[len]);
|
|
|
|
len -= lcd.cellwid;
|
|
|
|
}
|
|
|
|
}
|
|
|
|
/////////////////////////////////////////////////////////////////
|
|
// Sets up for big numbers.
|
|
//
|
|
void
|
|
CFontz_init_num ()
|
|
{
|
|
}
|
|
|
|
/////////////////////////////////////////////////////////////////
|
|
// Writes a big number.
|
|
//
|
|
void
|
|
CFontz_num (int x, int num)
|
|
{
|
|
char out[5];
|
|
sprintf (out, "%c%c%c", 28, x, num);
|
|
write (fd, out, 3);
|
|
}
|
|
|
|
/////////////////////////////////////////////////////////////////
|
|
// Sets a custom character from 0-7...
|
|
//
|
|
// For input, values > 0 mean "on" and values <= 0 are "off".
|
|
//
|
|
// The input is just an array of characters...
|
|
//
|
|
void
|
|
CFontz_set_char (int n, char *dat)
|
|
{
|
|
char out[4];
|
|
int row, col;
|
|
int letter;
|
|
|
|
if (n < 0 || n > 7)
|
|
return;
|
|
if (!dat)
|
|
return;
|
|
|
|
sprintf (out, "%c%c", 25, n);
|
|
write (fd, out, 2);
|
|
|
|
for (row = 0; row < lcd.cellhgt; row++) {
|
|
letter = 0;
|
|
for (col = 0; col < lcd.cellwid; col++) {
|
|
letter <<= 1;
|
|
letter |= (dat[(row * lcd.cellwid) + col] > 0);
|
|
}
|
|
write (fd, &letter, 1);
|
|
}
|
|
}
|
|
|
|
void
|
|
CFontz_icon (int which, char dest)
|
|
{
|
|
char icons[3][6 * 8] = {
|
|
{
|
|
1, 1, 1, 1, 1, 1, // Empty Heart
|
|
1, 0, 1, 0, 1, 1,
|
|
0, 0, 0, 0, 0, 1,
|
|
0, 0, 0, 0, 0, 1,
|
|
0, 0, 0, 0, 0, 1,
|
|
1, 0, 0, 0, 1, 1,
|
|
1, 1, 0, 1, 1, 1,
|
|
1, 1, 1, 1, 1, 1,
|
|
},
|
|
|
|
{
|
|
1, 1, 1, 1, 1, 1, // Filled Heart
|
|
1, 0, 1, 0, 1, 1,
|
|
0, 1, 0, 1, 0, 1,
|
|
0, 1, 1, 1, 0, 1,
|
|
0, 1, 1, 1, 0, 1,
|
|
1, 0, 1, 0, 1, 1,
|
|
1, 1, 0, 1, 1, 1,
|
|
1, 1, 1, 1, 1, 1,
|
|
},
|
|
|
|
{
|
|
0, 0, 0, 0, 0, 0, // Ellipsis
|
|
0, 0, 0, 0, 0, 0,
|
|
0, 0, 0, 0, 0, 0,
|
|
0, 0, 0, 0, 0, 0,
|
|
0, 0, 0, 0, 0, 0,
|
|
0, 0, 0, 0, 0, 0,
|
|
0, 0, 0, 0, 0, 0,
|
|
1, 0, 1, 0, 1, 0,
|
|
},
|
|
|
|
};
|
|
|
|
if (custom == bign)
|
|
custom = beat;
|
|
CFontz_set_char (dest, &icons[which][0]);
|
|
}
|
|
|
|
/////////////////////////////////////////////////////////////
|
|
// Blasts a single frame onscreen, to the lcd...
|
|
//
|
|
// Input is a character array, sized lcd.wid*lcd.hgt
|
|
//
|
|
void
|
|
CFontz_draw_frame (char *dat)
|
|
{
|
|
char out[LCD_MAX_WIDTH * LCD_MAX_HEIGHT];
|
|
int i;
|
|
|
|
if (!dat)
|
|
return;
|
|
|
|
// Custom characters start at 128, not at 0.
|
|
/*
|
|
for(i=0; i<lcd.wid*lcd.hgt; i++)
|
|
{
|
|
if(dat[i] < 32 && dat[i] >= 0) dat[i] += 128;
|
|
}
|
|
*/
|
|
|
|
for (i = 0; i < lcd.hgt; i++) {
|
|
sprintf (out, "%c%c%c", 17, 0, i);
|
|
write (fd, out, 3);
|
|
write (fd, dat + (lcd.wid * i), lcd.wid);
|
|
}
|
|
/*
|
|
sprintf(out, "%c", 1);
|
|
write(fd, out, 1);
|
|
write(fd, dat, lcd.wid*lcd.hgt);
|
|
*/
|
|
|
|
}
|