/* $Id$ * $URL$ * * new style driver for Matrix Orbital serial display modules * * Copyright (C) 1999, 2000 Michael Reinelt * Copyright (C) 2004 The LCD4Linux Team * * This file is part of LCD4Linux. * * LCD4Linux is free software; you can redistribute it and/or modify * it under the terms of the GNU General Public License as published by * the Free Software Foundation; either version 2, or (at your option) * any later version. * * LCD4Linux 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 General Public License for more details. * * You should have received a copy of the GNU General Public License * along with this program; if not, write to the Free Software * Foundation, Inc., 675 Mass Ave, Cambridge, MA 02139, USA. * */ /* * * exported fuctions: * * struct DRIVER drv_MatrixOrbital * */ #include "config.h" #include #include #include #include #include #include "debug.h" #include "cfg.h" #include "plugin.h" #include "widget.h" #include "widget_text.h" #include "widget_icon.h" #include "widget_bar.h" #include "drv.h" #include "drv_generic_text.h" #include "drv_generic_gpio.h" #include "drv_generic_serial.h" static char Name[] = "MatrixOrbital"; static int Model; static int Protocol; static char dispBuffer[4][20]; typedef struct { int type; char *name; int rows; int cols; int gpis; int gpos; int protocol; } MODEL; /* Fixme #1: number of gpo's should be verified */ /* Fixme #2: protocol should be verified */ static MODEL Models[] = { {0x01, "LCD0821", 2, 8, 0, 1, 1}, {0x03, "LCD2021", 2, 20, 0, 1, 1}, {0x04, "LCD1641", 4, 16, 0, 1, 1}, {0x05, "LCD2041", 4, 20, 0, 1, 1}, {0x06, "LCD4021", 2, 40, 0, 1, 1}, {0x07, "LCD4041", 4, 40, 0, 1, 1}, {0x08, "LK202-25", 2, 20, 8, 8, 2}, {0x09, "LK204-25", 4, 20, 8, 8, 2}, {0x0a, "LK404-55", 4, 40, 8, 8, 2}, {0x0b, "VFD2021", 2, 20, 0, 1, 1}, {0x0c, "VFD2041", 4, 20, 0, 1, 1}, {0x0d, "VFD4021", 2, 40, 0, 1, 1}, {0x0e, "VK202-25", 2, 20, 0, 1, 1}, {0x0f, "VK204-25", 4, 20, 0, 1, 1}, {0x10, "GLC12232", -1, -1, 0, 1, 1}, {0x13, "GLC24064", -1, -1, 0, 1, 1}, {0x15, "GLK24064-25", -1, -1, 0, 1, 1}, {0x22, "GLK12232-25", -1, -1, 0, 1, 1}, {0x31, "LK404-AT", 4, 40, 8, 8, 2}, {0x32, "VFD1621", 2, 16, 0, 1, 1}, {0x33, "LK402-12", 2, 40, 8, 8, 2}, {0x34, "LK162-12", 2, 16, 8, 8, 2}, {0x35, "LK204-25PC", 4, 20, 8, 8, 2}, {0x36, "LK202-24-USB", 2, 20, 8, 8, 2}, {0x38, "LK204-24-USB", 4, 20, 8, 8, 2}, {0x39, "VK204-24-USB", 4, 20, 8, 8, 2}, {0x40, "DE-LD011", 2, 16, 0, 0, 3}, /* Sure electronics USB LCD board Rev.I */ {0x41, "DE-LD021", 4, 20, 0, 0, 3}, {0x42, "DE-LD023", 4, 20, 0, 0, 4}, {0xff, "Unknown", -1, -1, 0, 0, 0} }; /****************************************/ /*** hardware dependant functions ***/ /****************************************/ static void drv_MO_write(const int row, const int col, const char *data, const int len) { char cmd[5] = "\376Gyx"; if (Models[Model].protocol == 3 || Models[Model].protocol == 4) { // Sure electronics USB LCD board - full line output cmd[2] = (char) 1; cmd[3] = (char) row + 1; strncpy(&(dispBuffer[row][col]), data, len); drv_generic_serial_write(cmd, 4); drv_generic_serial_write(dispBuffer[row], Models[Model].cols); } else { cmd[2] = (char) col + 1; cmd[3] = (char) row + 1; drv_generic_serial_write(cmd, 4); drv_generic_serial_write(data, len); } } static void drv_MO_clear(void) { int i, j; switch (Protocol) { case 1: drv_generic_serial_write("\014", 1); /* Clear Screen */ break; case 2: drv_generic_serial_write("\376\130", 2); /* Clear Screen */ break; default: /* Sure electronics USB LCD board - clear buffer */ /* protocol 3 and 4 */ for (i = 0; i < Models[Model].rows; i++) { for (j = 0; j < Models[Model].cols; j++) { dispBuffer[i][j] = ' '; } drv_MO_write(1, i + 1, dispBuffer[i], Models[Model].cols); } break; } } static void drv_MO_defchar(const int ascii, const unsigned char *matrix) { int i; char cmd[11] = "\376N"; cmd[2] = (char) ascii; for (i = 0; i < 8; i++) { cmd[i + 3] = matrix[i] & 0x1f; } drv_generic_serial_write(cmd, 11); } static int drv_MO_contrast(int contrast) { static unsigned char Contrast = 0; char cmd[3] = "\376Pn"; /* -1 is used to query the current contrast */ if (contrast == -1) return Contrast; if (contrast < 0) contrast = 0; if (contrast > 255) contrast = 255; Contrast = contrast; cmd[2] = Contrast; drv_generic_serial_write(cmd, 3); return Contrast; } static int drv_MO_backlight(int backlight) { static unsigned char Backlight = 0; char cmd[3] = "\376Bn"; /* -1 is used to query the current backlight */ if (backlight == -1) return Backlight; if (backlight < 0) backlight = 0; if (backlight > 255) backlight = 255; Backlight = backlight; if (backlight <= 0) { /* backlight off */ drv_generic_serial_write("\376F", 2); } else { /* backlight on for n minutes */ cmd[2] = Backlight; drv_generic_serial_write(cmd, 3); } return Backlight; } static int drv_MO_GPI(const int num) { static int GPI[8] = { -1, -1, -1, -1, -1, -1, -1, -1 }; static time_t T[8], now; if (num < 0 || num > 7) { return 0; } /* read RPM every two seconds */ if (time(&now) - T[num] >= 2) { char cmd[3]; unsigned char ans[7]; T[num] = now; cmd[0] = '\376'; cmd[1] = '\301'; cmd[2] = (char) num + 1; drv_generic_serial_write(cmd, 3); usleep(100000); if (drv_generic_serial_read((char *) ans, 7) == 7) { if (ans[0] == 0x23 && ans[1] == 0x2a && ans[2] == 0x03 && ans[3] == 0x52 && ans[4] == num + 1) { GPI[num] = 18750000 / (256 * ans[5] + ans[6]); } else { error("%s: strange answer %02x %02x %02x %02x %02x %02x %02x", Name, ans[0], ans[1], ans[2], ans[3], ans[4], ans[5], ans[6]); } } } return GPI[num]; } static int drv_MO_GPO(const int num, const int val) { int v = 0; char cmd[4]; switch (Protocol) { case 1: if (num == 0) { if (val > 0) { v = 1; drv_generic_serial_write("\376W", 2); /* GPO on */ } else { v = 0; drv_generic_serial_write("\376V", 2); /* GPO off */ } } break; case 2: if (val <= 0) { v = 0; cmd[0] = '\376'; cmd[1] = 'V'; /* GPO off */ cmd[2] = (char) num + 1; drv_generic_serial_write(cmd, 3); } else if (val >= 255) { v = 255; cmd[0] = '\376'; cmd[1] = 'W'; /* GPO on */ cmd[2] = (char) num + 1; drv_generic_serial_write(cmd, 3); } else { v = val; cmd[0] = '\376'; cmd[1] = '\300'; /* PWM control */ cmd[2] = (char) num + 1; cmd[3] = (char) v; drv_generic_serial_write(cmd, 4); } break; } return v; } static int drv_MO_start(const char *section, const int quiet) { int i; char *model; char buffer[256]; model = cfg_get(section, "Model", NULL); if (model != NULL && *model != '\0') { for (i = 0; Models[i].type != 0xff; i++) { if (strcasecmp(Models[i].name, model) == 0) break; } if (Models[i].type == 0xff) { error("%s: %s.Model '%s' is unknown from %s", Name, section, model, cfg_source()); return -1; } Model = i; info("%s: using model '%s'", Name, Models[Model].name); } else { info("%s: no '%s.Model' entry from %s, auto-dedecting", Name, section, cfg_source()); Model = -1; } if (Model != -1 && (Models[Model].protocol == 3 || Models[Model].protocol == 4)) { // Sure electronics USB LCD board - full line output int i, j; for (i = 0; i < Models[Model].rows; i++) { // Clear buffer for (j = 0; j < Models[Model].cols; j++) { dispBuffer[i][j] = ' '; } } } if (drv_generic_serial_open(section, Name, 0) < 0) return -1; if (Model == -1 || Models[Model].protocol > 1) { /* read module type */ drv_generic_serial_write("\3767", 2); usleep(1000); if (drv_generic_serial_read(buffer, 1) == 1) { for (i = 0; Models[i].type != 0xff; i++) { if (Models[i].type == (int) *buffer) break; } info("%s: display reports model '%s' (type 0x%02x)", Name, Models[i].name, Models[i].type); /* auto-dedection */ if (Model == -1) Model = i; /* auto-dedection matches specified model? */ if (Models[i].type != 0xff && Model != i) { error("%s: %s.Model '%s' from %s does not match dedected Model '%s'", Name, section, model, cfg_source(), Models[i].name); return -1; } } else { info("%s: display detection failed.", Name); } } /* initialize global variables */ DROWS = Models[Model].rows; DCOLS = Models[Model].cols; GPIS = Models[Model].gpis; GPOS = Models[Model].gpos; Protocol = Models[Model].protocol; if (Protocol > 1) { /* read serial number */ drv_generic_serial_write("\3765", 2); usleep(100000); if (drv_generic_serial_read(buffer, 2) == 2) { info("%s: display reports serial number 0x%x", Name, *(short *) buffer); } /* read version number */ drv_generic_serial_write("\3766", 2); usleep(100000); if (drv_generic_serial_read(buffer, 1) == 1) { info("%s: display reports firmware version 0x%x", Name, *buffer); } } char cmd[5]; if (Protocol == 4) { /* send init string */ cmd[0] = '\376'; cmd[1] = 'S'; cmd[2] = 'u'; cmd[3] = 'r'; cmd[4] = 'e'; drv_generic_serial_write(cmd, 5); } drv_MO_clear(); drv_generic_serial_write("\376B", 3); /* backlight on */ drv_generic_serial_write("\376K", 2); /* cursor off */ drv_generic_serial_write("\376T", 2); /* blink off */ drv_generic_serial_write("\376D", 2); /* line wrapping off */ drv_generic_serial_write("\376R", 2); /* auto scroll off */ /* set contrast */ if (cfg_number(section, "Contrast", 0, 0, 255, &i) > 0) { drv_MO_contrast(i); } /* set backlight */ if (cfg_number(section, "Backlight", 0, 0, 255, &i) > 0) { drv_MO_backlight(i); } if (!quiet) { if (drv_generic_text_greet(Models[Model].name, "MatrixOrbital")) { sleep(3); drv_MO_clear(); } } return 0; } /****************************************/ /*** plugins ***/ /****************************************/ static void plugin_contrast(RESULT * result, const int argc, RESULT * argv[]) { double contrast; switch (argc) { case 0: contrast = drv_MO_contrast(-1); SetResult(&result, R_NUMBER, &contrast); break; case 1: contrast = drv_MO_contrast(R2N(argv[0])); SetResult(&result, R_NUMBER, &contrast); break; default: error("%s::contrast(): wrong number of parameters", Name); SetResult(&result, R_STRING, ""); } } static void plugin_backlight(RESULT * result, const int argc, RESULT * argv[]) { double backlight; switch (argc) { case 0: backlight = drv_MO_backlight(-1); SetResult(&result, R_NUMBER, &backlight); break; case 1: backlight = drv_MO_backlight(R2N(argv[0])); SetResult(&result, R_NUMBER, &backlight); break; default: error("%s::backlight(): wrong number of parameters", Name); SetResult(&result, R_STRING, ""); } } /****************************************/ /*** widget callbacks ***/ /****************************************/ /* using drv_generic_text_draw(W) */ /* using drv_generic_text_icon_draw(W) */ /* using drv_generic_text_bar_draw(W) */ /* using drv_generic_gpio_draw(W) */ /****************************************/ /*** exported functions ***/ /****************************************/ /* list models */ int drv_MO_list(void) { int i; for (i = 0; Models[i].type != 0xff; i++) { printf("%s ", Models[i].name); } return 0; } /* initialize driver & display */ int drv_MO_init(const char *section, const int quiet) { WIDGET_CLASS wc; int ret; int asc255bug; info("%s: %s", Name, "$Rev$"); /* display preferences */ XRES = 5; /* pixel width of one char */ YRES = 8; /* pixel height of one char */ CHARS = 8; /* number of user-defineable characters */ CHAR0 = 0; /* ASCII of first user-defineable char */ GOTO_COST = 4; /* number of bytes a goto command requires */ /* real worker functions */ drv_generic_text_real_write = drv_MO_write; drv_generic_text_real_defchar = drv_MO_defchar; drv_generic_gpio_real_get = drv_MO_GPI; drv_generic_gpio_real_set = drv_MO_GPO; /* start display */ if ((ret = drv_MO_start(section, quiet)) != 0) return ret; /* initialize generic text driver */ if ((ret = drv_generic_text_init(section, Name)) != 0) return ret; /* initialize generic icon driver */ if ((ret = drv_generic_text_icon_init()) != 0) return ret; /* initialize generic bar driver */ if ((ret = drv_generic_text_bar_init(0)) != 0) return ret; /* add fixed chars to the bar driver */ /* most displays have a full block on ascii 255, but some have kind of */ /* an 'inverted P'. If you specify 'asc255bug 1 in the config, this */ /* char will not be used, but rendered by the bar driver */ cfg_number(section, "asc255bug", 0, 0, 1, &asc255bug); drv_generic_text_bar_add_segment(0, 0, 255, 32); /* ASCII 32 = blank */ if (!asc255bug) drv_generic_text_bar_add_segment(255, 255, 255, 255); /* ASCII 255 = block */ /* initialize generic GPIO driver */ if ((ret = drv_generic_gpio_init(section, Name)) != 0) return ret; /* register text widget */ wc = Widget_Text; wc.draw = drv_generic_text_draw; widget_register(&wc); /* register icon widget */ wc = Widget_Icon; wc.draw = drv_generic_text_icon_draw; widget_register(&wc); /* register bar widget */ wc = Widget_Bar; wc.draw = drv_generic_text_bar_draw; widget_register(&wc); /* register plugins */ AddFunction("LCD::contrast", -1, plugin_contrast); AddFunction("LCD::backlight", -1, plugin_backlight); return 0; } /* close driver & display */ int drv_MO_quit(const int quiet) { info("%s: shutting down display.", Name); drv_generic_text_quit(); drv_generic_gpio_quit(); /* clear display */ drv_MO_clear(); usleep(300000); /* say goodbye... */ if (!quiet) { drv_generic_text_greet("goodbye!", NULL); } usleep(300000); drv_generic_serial_close(); return (0); } DRIVER drv_MatrixOrbital = { .name = Name, .list = drv_MO_list, .init = drv_MO_init, .quit = drv_MO_quit, }; n368' href='#n368'>368 369 370 371 372 373 374 375 376 377 378 379 380 381 382 383 384 385 386 387 388 389 390 391 392 393 394 395 396 397 398 399 400 401 402 403 404 405 406 407 408 409 410 411 412 413 414 415
/* $Id: Crystalfontz.c,v 1.12 2003/08/19 04:28:41 reinelt Exp $
 *
 * driver for display modules from Crystalfontz
 *
 * Copyright 2000 by Herbert Rosmanith (herp@wildsau.idv.uni-linz.ac.at)
 *
 * This program is free software; you can redistribute it and/or modify
 * it under the terms of the GNU General Public License as published by
 * the Free Software Foundation; either version 2, or (at your option)
 * any later version.
 *
 * This program 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 General Public License for more details.
 *
 * You should have received a copy of the GNU General Public License
 * along with this program; if not, write to the Free Software
 * Foundation, Inc., 675 Mass Ave, Cambridge, MA 02139, USA.
 *
 * $Log: Crystalfontz.c,v $
 * Revision 1.12  2003/08/19 04:28:41  reinelt
 * more Icon stuff, minor glitches fixed
 *
 * Revision 1.11  2003/08/17 06:57:04  reinelt
 * complete rewrite of the Crystalfontz driver
 *
 * Revision 1.10  2003/07/24 04:48:09  reinelt
 * 'soft clear' needed for virtual rows
 *
 * Revision 1.9  2003/02/22 07:53:09  reinelt
 * cfg_get(key,defval)
 *
 * Revision 1.8  2002/08/19 04:41:20  reinelt
 * introduced bar.c, moved bar stuff from display.h to bar.h
 *
 * Revision 1.7  2001/04/27 05:04:57  reinelt
 *
 * replaced OPEN_MAX with sysconf()
 * replaced mktemp() with mkstemp()
 * unlock serial port if open() fails
 *
 * Revision 1.6  2001/02/13 09:00:13  reinelt
 *
 * prepared framework for GPO's (general purpose outputs)
 *
 * Revision 1.5  2000/08/10 09:44:09  reinelt
 *
 * new debugging scheme: error(), info(), debug()
 * uses syslog if in daemon mode
 *
 * Revision 1.4  2000/08/09 09:50:29  reinelt
 *
 * opened 0.98 development
 * removed driver-specific signal-handlers
 * added 'quit'-function to driver structure
 * added global signal-handler
 *
 * Revision 1.3  2000/06/04 21:43:50  herp
 * minor bugfix (zero length)
 *
 */

#include <stdlib.h>
#include <stdio.h>
#include <string.h>
#include <errno.h>
#include <unistd.h>
#include <termios.h>
#include <fcntl.h>

#include "debug.h"
#include "cfg.h"
#include "lock.h"
#include "display.h"
#include "bar.h"

#define XRES 5
#define YRES 8
#define CHARS 8

static LCD Lcd;
static char *Port=NULL;
static speed_t Speed;
static int Device=-1;
static int GPO;

static char *FrameBuffer1=NULL;
static char *FrameBuffer2=NULL;


static int CF_open (void)
{
  int fd;
  pid_t pid;
  struct termios portset;
  
  if ((pid=lock_port(Port))!=0) {
    if (pid==-1)
      error ("Crystalfontz: port %s could not be locked", Port);
    else
      error ("Crystalfontz: port %s is locked by process %d", Port, pid);
    return -1;
  }
  fd = open(Port, O_RDWR | O_NOCTTY | O_NDELAY); 
  if (fd==-1) {
    error ("Crystalfontz: open(%s) failed: %s", Port, strerror(errno));
    unlock_port(Port);
    return -1;
  }
  if (tcgetattr(fd, &portset)==-1) {
    error ("Crystalfontz: tcgetattr(%s) failed: %s", Port, strerror(errno));
    unlock_port(Port);
    return -1;
  }
  cfmakeraw(&portset);
  cfsetospeed(&portset, Speed);
  if (tcsetattr(fd, TCSANOW, &portset)==-1) {
    error ("Crystalfontz: tcsetattr(%s) failed: %s", Port, strerror(errno));
    unlock_port(Port);
    return -1;
  }
  return fd;
}


static void CF_write (char *string, int len)
{
  if (Device==-1) return;
  if (write (Device, string, len)==-1) {
    if (errno==EAGAIN) {
      usleep(1000);
      if (write (Device, string, len)>=0) return;
    }
    error ("Crystalfontz: write(%s) failed: %s", Port, strerror(errno));
  }
}


static int CF_backlight (void)
{
  char buffer[3];
  int  backlight;

  backlight=atoi(cfg_get("Backlight","0"));
  snprintf (buffer, 3, "\016%c", backlight);
  CF_write (buffer, 2);
  return 0;
}


static int CF_contrast (void)
{
  char buffer[3];
  int  contrast;

  contrast=atoi(cfg_get("Contrast","50"));
  snprintf (buffer, 3, "\017%c", contrast);
  CF_write (buffer, 2);
  return 0;
}


static void CF_define_char (int ascii, char *buffer)
{
  char cmd[3]="031"; // set custom char bitmap

  cmd[1]=128+(char)ascii;
  CF_write (cmd, 2);
  CF_write (buffer, 8);
}


static int CF_clear (int full)
{
  memset (FrameBuffer1, ' ', Lcd.rows*Lcd.cols*sizeof(char));
  bar_clear();
  GPO=0;
  
  if (full) {
    memset (FrameBuffer2, ' ', Lcd.rows*Lcd.cols*sizeof(char));
    CF_write ("\014", 1);  // Form Feed (Clear Display)
  }
  
  return 0;
}


static int CF_init (LCD *Self)
{
  char *port;
  char *speed;

  Lcd=*Self;

  // Init the framebuffers
  FrameBuffer1 = (char*)malloc(Lcd.cols*Lcd.rows*sizeof(char));
  FrameBuffer2 = (char*)malloc(Lcd.cols*Lcd.rows*sizeof(char));
  if (FrameBuffer1==NULL || FrameBuffer2==NULL) {
    error ("Crystalfontz: framebuffer could not be allocated: malloc() failed");
    return -1;
  }

  if (Port) {
    free (Port);
    Port=NULL;
  }

  port=cfg_get ("Port",NULL);
  if (port==NULL || *port=='\0') {
    error ("Crystalfontz: no 'Port' entry in %s", cfg_file());
    return -1;
  }
  Port=strdup(port);

  speed=cfg_get("Speed","19200");
  
  switch (atoi(speed)) {
  case 1200:
    Speed=B1200;
    break;
  case 2400:
    Speed=B2400;
    break;
  case 9600:
    Speed=B9600;
    break;
  case 19200:
    Speed=B19200;
    break;
  default:
    error ("Crystalfontz: unsupported speed '%s' in %s", speed, cfg_file());
    return -1;
  }    

  debug ("using port %s at %d baud", Port, atoi(speed));

  Device=CF_open();
  if (Device==-1) return -1;

  bar_init(Lcd.rows, Lcd.cols, XRES, YRES, CHARS);
  bar_add_segment(  0,  0,255, 32); // ASCII  32 = blank
  bar_add_segment(255,255,255,255); // ASCII 255 = block

  // MR: why such a large delay?
  usleep(350000);

  CF_clear(1);

  CF_write ("\004", 1);  // hide cursor
  CF_write ("\024", 1);  // scroll off
  CF_write ("\030", 1);  // wrap off

  CF_backlight();
  CF_contrast();

  return 0;
}


void CF_goto (int row, int col)
{
  char cmd[3]="\021"; // set cursor position

  if (row==0 && col==0) {
    CF_write ("\001", 1); // cursor home
  } else {
    cmd[1]=(char)col;
    cmd[2]=(char)row;
    CF_write(cmd,3);
  }
}


int CF_put (int row, int col, char *text)
{
  char *p=FrameBuffer1+row*Lcd.cols+col;
  char *t=text;
  
  while (*t && col++<=Lcd.cols) {
    *p++=*t++;
  }
  return 0;
}


int CF_bar (int type, int row, int col, int max, int len1, int len2)
{
  return bar_draw (type, row, col, max, len1, len2);
}


static int CF_flush (void)
{
  int row, col, pos1, pos2;
  int c, equal;
  
  bar_process(CF_define_char);
  
  for (row=0; row<Lcd.rows; row++) {
    for (col=0; col<Lcd.cols; col++) {
      c=bar_peek(row, col);
      if (c!=-1) {
	if (c!=32) c+=128; //blank
	FrameBuffer1[row*Lcd.cols+col]=(char)c;
      }
    }
    for (col=0; col<Lcd.cols; col++) {
      if (FrameBuffer1[row*Lcd.cols+col]==FrameBuffer2[row*Lcd.cols+col]) continue;
      CF_goto (row, col);
      for (pos1=col++, pos2=pos1, equal=0; col<Lcd.cols; col++) {
	if (FrameBuffer1[row*Lcd.cols+col]==FrameBuffer2[row*Lcd.cols+col]) {
	  // If we find just one equal byte, we don't break, because this 
	  // would require a goto, which takes one byte, too.
	  if (++equal>4) break;
	} else {
	  pos2=col;
	  equal=0;
	}
      }
      CF_write (FrameBuffer1+row*Lcd.cols+pos1, pos2-pos1+1);
    }
  }
  
  memcpy (FrameBuffer2, FrameBuffer1, Lcd.rows*Lcd.cols*sizeof(char));

  return 0;
}


int CF_quit (void)
{
  info("Crystalfontz: shutting down.");

  debug ("closing port %s", Port);
  close (Device);
  unlock_port(Port);

  if (FrameBuffer1) {
    free(FrameBuffer1);
    FrameBuffer1=NULL;
  }

  if (FrameBuffer2) {
    free(FrameBuffer2);
    FrameBuffer2=NULL;
  }

  return (0);
}


LCD Crystalfontz[] = {
  { name: "626",
    rows:  2, 
    cols:  16,
    xres:  XRES,
    yres:  YRES,
    bars:  BAR_L | BAR_R | BAR_U | BAR_D | BAR_H2,
    gpos:  0,
    init:  CF_init,
    clear: CF_clear,
    put:   CF_put,
    bar:   CF_bar,
    gpo:   NULL,
    flush: CF_flush,
    quit:  CF_quit 
  },
  { name: "636",
    rows:  2, 
    cols:  16,
    xres:  XRES,
    yres:  YRES,
    bars:  BAR_L | BAR_R | BAR_U | BAR_D | BAR_H2,
    gpos:  0,
    init:  CF_init,
    clear: CF_clear,
    put:   CF_put,
    bar:   CF_bar,
    gpo:   NULL,
    flush: CF_flush,
    quit:  CF_quit 
  },
  { name: "632",
    rows:  2, 
    cols:  16,
    xres:  XRES,
    yres:  YRES,
    bars:  BAR_L | BAR_R | BAR_U | BAR_D | BAR_H2,
    gpos:  0,
    init:  CF_init,
    clear: CF_clear,
    put:   CF_put,
    bar:   CF_bar,
    gpo:   NULL,
    flush: CF_flush,
    quit:  CF_quit 
  },
  { name: "634",
    rows:  4, 
    cols:  20,
    xres:  XRES,
    yres:  YRES,
    bars:  BAR_L | BAR_R | BAR_U | BAR_D | BAR_H2,
    gpos:  0,
    init:  CF_init,
    clear: CF_clear,
    put:   CF_put,
    bar:   CF_bar,
    gpo:   NULL,
    flush: CF_flush,
    quit:  CF_quit 
  },
  { NULL }
};