source: npl/mediabox/lcdproc_edwin/src/server/drivers/MtxOrb.c.old @ c5c522c

#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 "MtxOrb.h"
#include "drv_base.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 MtxOrb_linewrap(int on);
static void MtxOrb_autoscroll(int on);

// TODO:  Get rid of this variable?
lcd_logical_driver *MtxOrb;
// TODO:  Get the frame buffers working right

/////////////////////////////////////////////////////////////////
// Opens com port and sets baud correctly...
//
int MtxOrb_init(lcd_logical_driver *driver, char *args)
{
   char *argv[64];
   int argc;
   struct termios portset;
   int i;
   int tmp;
   
   int contrast=140;
   char device[256] = "/dev/lcd";
   int speed=B19200;
   
   MtxOrb = driver;


   //debug("MtxOrb_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, "MtxOrb_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, "MtxOrb_init: %s requires an argument\n",
                    argv[i]);
            return -1;
         }
         tmp = atoi(argv[++i]);
         if((tmp < 0) || (tmp > 255)){
            fprintf(stderr, "MtxOrb_init: %s argument must between 0 and 255. Ussing default value.\n",
                    argv[i]);
         } else contrast = tmp;
      }
      else if(0 == strcmp(argv[i], "-s")  ||
         0 == strcmp(argv[i], "--speed"))
      {
         if(i + 1 > argc) {
            fprintf(stderr, "MtxOrb_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, "MtxOrb_init: %s argument must be 1200, 2400, 9600 or 19200. Ussing default value.\n",
                    argv[i]);
         }
      }
      else if(0 == strcmp(argv[i], "-h")  ||
         0 == strcmp(argv[i], "--help"))
      {
         printf("LCDproc Matrix-Orbital LCD driver\n"
                "\t-d\t--device\tSelect the output device to use [/dev/lcd]\n"
                "\t-c\t--contrast\tSet the initial contrast [140]\n"
                "\t-s\t--speed\t\tSet the communication speed [19200]\n"
                "\t-h\t--help\t\tShow this help information\n");
         return -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, "MtxOrb_init: failed (%s)\n", strerror(errno));
      return -1;
   }
   //else fprintf(stderr, "MtxOrb_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);
   tcsetattr(fd, TCSANOW, &portset);
   
   
   // Set display-specific stuff..
   MtxOrb_linewrap(1);
   MtxOrb_autoscroll(1);
   
   
   if(!driver->framebuf)
   {
      fprintf(stderr, "MtxOrb_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 =        MtxOrb_chr;
   driver->chr =        (void *)-1;
   driver->vbar =       MtxOrb_vbar;
   driver->init_vbar =  MtxOrb_init_vbar;
   driver->hbar =       MtxOrb_hbar;
   driver->init_hbar =  MtxOrb_init_hbar;
   driver->num =        MtxOrb_num;
   driver->init_num =   MtxOrb_init_num;

   driver->init =       MtxOrb_init;
   driver->close =      MtxOrb_close;
   driver->flush =      MtxOrb_flush;
   driver->flush_box =  MtxOrb_flush_box;
   driver->contrast =   MtxOrb_contrast;
   driver->backlight =  MtxOrb_backlight;
   driver->set_char =   MtxOrb_set_char;
   driver->icon =       MtxOrb_icon;
   driver->draw_frame = MtxOrb_draw_frame;

   driver->getkey =     MtxOrb_getkey;

   MtxOrb_contrast(contrast);
  
   return fd;
}



/////////////////////////////////////////////////////////////////
// Clean-up
//
void MtxOrb_close() 
{
  close (fd); 

  if(MtxOrb->framebuf) free(MtxOrb->framebuf);

  MtxOrb->framebuf = NULL;
}


void MtxOrb_flush()
{
   MtxOrb_draw_frame(lcd.framebuf);
}



void MtxOrb_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, "%cG%c%c", 254, 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 MtxOrb_chr(int x, int y, char c) 
{
  y--;
  x--;
  
  lcd.framebuf[(y*lcd.wid) + x] = c;
}


/////////////////////////////////////////////////////////////////
// Changes screen contrast (0-255; 140 seems good)
//
int MtxOrb_contrast(int contrast) 
{
  char out[4];
  static int status=140;

  if(contrast > 0)
  {
     status=contrast;
     sprintf(out, "%cP%c", 254, status);
     write(fd, out, 3);
  }

  return status;
}


/////////////////////////////////////////////////////////////////
// Sets the backlight on or off -- can be done quickly for
// an intermediate brightness...
//
void MtxOrb_backlight(int on)
{
  char out[4];
  if(on)
  {
    sprintf(out, "%cB%c", 254, 0);
    write(fd, out, 3);
  }
  else
  {
    sprintf(out, "%cF", 254);
    write(fd, out, 2);
  }
}


/////////////////////////////////////////////////////////////////
// Toggle the built-in linewrapping feature
//
static void MtxOrb_linewrap(int on)
{
  char out[4];
  if(on)
    sprintf(out, "%cC", 254);
  else
    sprintf(out, "%cD", 254);
  write(fd, out, 2);
}

/////////////////////////////////////////////////////////////////
// Toggle the built-in automatic scrolling feature
//
static void MtxOrb_autoscroll(int on)
{
  char out[4];
  if(on)
    sprintf(out, "%cQ", 254);
  else
    sprintf(out, "%cR", 254);
  write(fd, out, 2);
}


/////////////////////////////////////////////////////////////////
// Sets up for vertical bars.  Call before lcd.vbar()
//
void MtxOrb_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,
    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,
    1,1,1,1,1,
    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,
    1,1,1,1,1,
    1,1,1,1,1,
    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,
    1,1,1,1,1,
    1,1,1,1,1,
    1,1,1,1,1,
    1,1,1,1,1,
  };
  char e[] = {
    0,0,0,0,0,
    0,0,0,0,0,
    0,0,0,0,0,
    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,
  };
  char f[] = {
    0,0,0,0,0,
    0,0,0,0,0,
    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,
  };
  char g[] = {
    0,0,0,0,0,
    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!=vbar) {
    MtxOrb_set_char(1,a);
    MtxOrb_set_char(2,b);
    MtxOrb_set_char(3,c);
    MtxOrb_set_char(4,d);
    MtxOrb_set_char(5,e);
    MtxOrb_set_char(6,f);
    MtxOrb_set_char(7,g);
    custom=vbar;
  }
}

/////////////////////////////////////////////////////////////////
// Inits horizontal bars...
//
void MtxOrb_init_hbar() 
{

  char a[] = {
    1,0,0,0,0,
    1,0,0,0,0,
    1,0,0,0,0,
    1,0,0,0,0,
    1,0,0,0,0,
    1,0,0,0,0,
    1,0,0,0,0,
    1,0,0,0,0,
  };
  char b[] = {
    1,1,0,0,0,
    1,1,0,0,0,
    1,1,0,0,0,
    1,1,0,0,0,
    1,1,0,0,0,
    1,1,0,0,0,
    1,1,0,0,0,
    1,1,0,0,0,
  };
  char c[] = {
    1,1,1,0,0,
    1,1,1,0,0,
    1,1,1,0,0,
    1,1,1,0,0,
    1,1,1,0,0,
    1,1,1,0,0,
    1,1,1,0,0,
    1,1,1,0,0,
  };
  char d[] = {
    1,1,1,1,0,
    1,1,1,1,0,
    1,1,1,1,0,
    1,1,1,1,0,
    1,1,1,1,0,
    1,1,1,1,0,
    1,1,1,1,0,
    1,1,1,1,0,
  };

  if(custom!=hbar) {
    MtxOrb_set_char(1,a);
    MtxOrb_set_char(2,b);
    MtxOrb_set_char(3,c);
    MtxOrb_set_char(4,d);
    custom=hbar;
  }
}

/////////////////////////////////////////////////////////////////
// Draws a vertical bar...
//
void MtxOrb_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) MtxOrb_chr(x, y, 255);
      else MtxOrb_chr(x, y, map[len]);

      len -= lcd.cellhgt;
    }
  
}

/////////////////////////////////////////////////////////////////
// Draws a horizontal bar to the right.
//
void MtxOrb_hbar(int x, int y, int len)
{
  char map[6] = { 32, 1, 2, 3, 4, 255  };

  for(; x<=lcd.wid && len>0; x++)
    {
      if(len >= lcd.cellwid) MtxOrb_chr(x,y,255);
      else MtxOrb_chr(x, y, map[len]);
      
      len -= lcd.cellwid;
      
    }

}


/////////////////////////////////////////////////////////////////
// Sets up for big numbers.
//
void MtxOrb_init_num() 
{
  char out[3];
  if(custom!=bign) {
    sprintf(out, "%cn", 254);
    write(fd, out, 2);
    custom=bign;
  }
}


/////////////////////////////////////////////////////////////////
// Writes a big number.
//
void MtxOrb_num(int x, int num) 
{
  char out[5];
  sprintf(out, "%c#%c%c", 254, x, num);
  write(fd, out, 4);
}


/////////////////////////////////////////////////////////////////
// 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 MtxOrb_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, "%cN%c", 254, n);
  write(fd, out, 3);

  
  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 MtxOrb_icon(int which, char dest)
{
  char icons[3][5*8] = {
   {
     1,1,1,1,1,  // Empty Heart
     1,0,1,0,1,
     0,0,0,0,0,
     0,0,0,0,0,
     0,0,0,0,0,
     1,0,0,0,1,
     1,1,0,1,1,
     1,1,1,1,1,
   },   

   {
     1,1,1,1,1,  // Filled Heart
     1,0,1,0,1,
     0,1,0,1,0,
     0,1,1,1,0,
     0,1,1,1,0,
     1,0,1,0,1,
     1,1,0,1,1,
     1,1,1,1,1,
   },
   
   {
     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,
     1,0,1,0,1,
   },
   
  };
  
  if(custom==bign) custom=beat;
  MtxOrb_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 MtxOrb_draw_frame(char *dat)
{
  char out[LCD_MAX_WIDTH * LCD_MAX_HEIGHT];
  
  if(!dat) return;

  sprintf(out, "%cG%c%c", 254, 1, 1);
  write(fd, out, 4);
  write(fd, dat, lcd.wid*lcd.hgt);

}



/////////////////////////////////////////////////////////////
// returns one character from the keypad...
// (A-Z) on success, 0 on failure...
//
char MtxOrb_getkey()
{
  char in = 0;
  read(fd, &in, 1);
  return in;
}

void MtxOrb_led(int which, int on)
{
  char out[4];

  if(which < 0 || which > 7) return;

  if(!which){
    if(on)
      sprintf(out, "%cV", 254);
    else
      sprintf(out, "%cW", 254);
    write(fd, out, 2);
    }
  else{
    if(on)
      sprintf(out, "%cV%c", 254, which);
    else
      sprintf(out, "%cW%c", 254, which);
    write(fd, out, 3);
    }
}