diff options
Diffstat (limited to '')
| -rw-r--r-- | M50530.c | 669 |
1 files changed, 669 insertions, 0 deletions
diff --git a/M50530.c b/M50530.c new file mode 100644 index 0000000..e7f39cc --- /dev/null +++ b/M50530.c @@ -0,0 +1,669 @@ +/* $Id: M50530.c,v 1.1 2001/09/11 05:31:37 reinelt Exp $ + * + * driver for display modules based on the M50530 chip + * + * Copyright 1999, 2000 by Michael Reinelt (reinelt@eunet.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: M50530.c,v $ + * Revision 1.1 2001/09/11 05:31:37 reinelt + * M50530 driver + * + * + */ + +/* + * + * exported fuctions: + * + * struct LCD M50530[] + * + */ + +#include "config.h" + +#include <stdlib.h> +#include <stdio.h> +#include <string.h> +#include <unistd.h> +#include <fcntl.h> +#include <time.h> +#include <errno.h> +#include <sys/ioctl.h> + +#ifdef HAVE_SYS_IO_H +#include <sys/io.h> +#define WITH_OUTB +#else +#ifdef HAVE_ASM_IO_H +#include <asm/io.h> +#define WITH_OUTB +#endif +#endif + +#if defined (HAVE_LINUX_PARPORT_H) && defined (HAVE_LINUX_PPDEV_H) +#define WITH_PPDEV +#include <linux/parport.h> +#include <linux/ppdev.h> +#endif + + +#if !defined(WITH_OUTB) && !defined(WITH_PPDEV) +#error neither outb() nor ppdev() possible +#error cannot compile M50530 driver +#endif + +#include "debug.h" +#include "cfg.h" +#include "display.h" +#include "udelay.h" + +#define XRES 5 +#define YRES 8 +#define CHARS 8 +#define BARS ( BAR_L | BAR_R | BAR_U | BAR_D | BAR_H2 ) + +typedef struct { + int len1; + int len2; + int type; + int segment; +} BAR; + +typedef struct { + int len1; + int len2; + int type; + int used; + int ascii; +} SEGMENT; + +static LCD Lcd; + + +static unsigned short Port=0; + +static char *PPdev=NULL; + +#ifdef WITH_PPDEV +static int PPfd=-1; +#endif + +static char Txt[8][40]; +static BAR Bar[8][40]; +static int GPO=0; + +static int nSegment=1; +static SEGMENT Segment[128] = {{ len1:0, len2:0, type:255, used:0, ascii:32 }}; + +static void M5_command (unsigned int cmd, int delay) +{ +#ifdef WITH_PPDEV + if (PPdev) { + + unsigned char data; + struct ppdev_frob_struct frob; + + // set I/OC1 (Select inverted) + // set I/OC2 (AutoFeed inverted) + frob.mask=PARPORT_CONTROL_SELECT | PARPORT_CONTROL_AUTOFD; + frob.val=0; + if (!(cmd & 0x200)) { + frob.val|=PARPORT_CONTROL_SELECT; + } + if (!(cmd & 0x100)) { + frob.val|=PARPORT_CONTROL_AUTOFD; + } + ioctl (PPfd, PPFCONTROL, &frob); + + // rise EX (Strobe, inverted) + frob.mask=PARPORT_CONTROL_STROBE; + frob.val=0; + ioctl (PPfd, PPFCONTROL, &frob); + + // put data on DB1..DB8 + data=cmd&0xff; + ioctl(PPfd, PPWDATA, &data); + + // lower EX (Strobe, inverted) + frob.mask=PARPORT_CONTROL_STROBE; + frob.val=PARPORT_CONTROL_STROBE; + ioctl (PPfd, PPFCONTROL, &frob); + + // wait + udelay(delay); + + } else + +#endif + + { + // Fixme: not implemented + } +} + +static void M5_write (unsigned char *string, int len) +{ + unsigned int cmd; + + while (len--) { + cmd=*string++; + M5_command (0x100|cmd, 20); + } +} + +static void M5_setGPO (int bits) +{ + if (Lcd.gpos>0) { + +#ifdef WITH_PPDEV + + if (PPdev) { + + struct ppdev_frob_struct frob; + + // put data on DB1..DB8 + ioctl(PPfd, PPWDATA, &bits); + + // toggle INIT + frob.mask=PARPORT_CONTROL_INIT; + frob.val=PARPORT_CONTROL_INIT; // rise + ioctl (PPfd, PPFCONTROL, &frob); + udelay(1); + frob.val=0; // lower + ioctl (PPfd, PPFCONTROL, &frob); + + } else + +#endif + + { + // Fixme: not implemented + } + } +} + +static int M5_open (void) +{ +#ifdef WITH_PPDEV + + if (PPdev) { + debug ("using ppdev %s", PPdev); + PPfd=open(PPdev, O_RDWR); + if (PPfd==-1) { + error ("open(%s) failed: %s", PPdev, strerror(errno)); + return -1; + } + +#if 0 + if (ioctl(PPfd, PPEXCL)) { + debug ("ioctl(%s, PPEXCL) failed: %s", PPdev, strerror(errno)); + } else { + debug ("ioctl(%s, PPEXCL) succeded."); + } +#endif + + if (ioctl(PPfd, PPCLAIM)) { + error ("ioctl(%s, PPCLAIM) failed: %d %s", PPdev, errno, strerror(errno)); + return -1; + } + } else + +#endif + + { + debug ("using raw port 0x%x", Port); + if (ioperm(Port, 3, 1)!=0) { + error ("M50530: ioperm(0x%x) failed: %s", Port, strerror(errno)); + return -1; + } + } + + M5_command (0x00FA, 20); // set function mode + M5_command (0x0020, 20); // set display mode + M5_command (0x0050, 20); // set entry mode + M5_command (0x0030, 20); // set display mode + M5_command (0x0001, 1250); // clear display + + return 0; +} + +static void M5_process_bars (void) +{ + int row, col; + int i, j; + + for (i=1; i<nSegment && Segment[i].used; i++); + for (j=i+1; j<nSegment; j++) { + if (Segment[j].used) + Segment[i++]=Segment[j]; + } + nSegment=i; + + for (row=0; row<Lcd.rows; row++) { + for (col=0; col<Lcd.cols; col++) { + if (Bar[row][col].type==0) continue; + for (i=0; i<nSegment; i++) { + if (Segment[i].type & Bar[row][col].type && + Segment[i].len1== Bar[row][col].len1 && + Segment[i].len2== Bar[row][col].len2) break; + } + if (i==nSegment) { + nSegment++; + Segment[i].len1=Bar[row][col].len1; + Segment[i].len2=Bar[row][col].len2; + Segment[i].type=Bar[row][col].type; + Segment[i].used=0; + Segment[i].ascii=-1; + } + Bar[row][col].segment=i; + } + } +} + +static int M5_segment_diff (int i, int j) +{ + int RES; + int i1, i2, j1, j2; + + if (i==j) return 65535; + if (!(Segment[i].type & Segment[j].type)) return 65535; + if (Segment[i].len1==0 && Segment[j].len1!=0) return 65535; + if (Segment[i].len2==0 && Segment[j].len2!=0) return 65535; + RES=Segment[i].type & BAR_H ? XRES:YRES; + if (Segment[i].len1>=RES && Segment[j].len1<RES) return 65535; + if (Segment[i].len2>=RES && Segment[j].len2<RES) return 65535; + if (Segment[i].len1==Segment[i].len2 && Segment[j].len1!=Segment[j].len2) return 65535; + + i1=Segment[i].len1; if (i1>RES) i1=RES; + i2=Segment[i].len2; if (i2>RES) i2=RES; + j1=Segment[j].len1; if (j1>RES) i1=RES; + j2=Segment[j].len2; if (j2>RES) i2=RES; + + return (i1-i2)*(i1-i2)+(j1-j2)*(j1-j2); +} + +static void M5_compact_bars (void) +{ + int i, j, r, c, min; + int pack_i, pack_j; + int pass1=1; + int deviation[nSegment][nSegment]; + + if (nSegment>CHARS+1) { + + for (i=1; i<nSegment; i++) { + for (j=0; j<nSegment; j++) { + deviation[i][j]=M5_segment_diff(i,j); + } + } + + while (nSegment>CHARS+1) { + min=65535; + pack_i=-1; + pack_j=-1; + for (i=2; i<nSegment; i++) { + if (pass1 && Segment[i].used) continue; + for (j=0; j<nSegment; j++) { + if (deviation[i][j]<min) { + min=deviation[i][j]; + pack_i=i; + pack_j=j; + } + } + } + if (pack_i==-1) { + if (pass1) { + pass1=0; + continue; + } else { + error ("M50530: unable to compact bar characters"); + nSegment=CHARS; + break; + } + } + + nSegment--; + Segment[pack_i]=Segment[nSegment]; + + for (i=0; i<nSegment; i++) { + deviation[pack_i][i]=deviation[nSegment][i]; + deviation[i][pack_i]=deviation[i][nSegment]; + } + + for (r=0; r<Lcd.rows; r++) { + for (c=0; c<Lcd.cols; c++) { + if (Bar[r][c].segment==pack_i) + Bar[r][c].segment=pack_j; + if (Bar[r][c].segment==nSegment) + Bar[r][c].segment=pack_i; + } + } + } + } +} + +static void M5_define_chars (void) +{ + int c, i, j; + char buffer[8]; + + for (i=1; i<nSegment; i++) { + if (Segment[i].used) continue; + if (Segment[i].ascii!=-1) continue; + for (c=0; c<CHARS; c++) { + for (j=1; j<nSegment; j++) { + if (Segment[j].ascii==248+c) break; + } + if (j==nSegment) break; + } + Segment[i].ascii=248+c; + switch (Segment[i].type) { + case BAR_L: + for (j=0; j<4; j++) { + char Pixel[] = { 0, 1, 3, 7, 15, 31 }; + buffer[j]=Pixel[Segment[i].len1]; + buffer[j+4]=Pixel[Segment[i].len2]; + } + break; + case BAR_R: + for (j=0; j<4; j++) { + char Pixel[] = { 0, 16, 24, 28, 30, 31 }; + buffer[j]=Pixel[Segment[i].len1]; + buffer[j+4]=Pixel[Segment[i].len2]; + } + break; + case BAR_U: + for (j=0; j<Segment[i].len1; j++) { + buffer[7-j]=31; + } + for (; j<YRES; j++) { + buffer[7-j]=0; + } + break; + case BAR_D: + for (j=0; j<Segment[i].len1; j++) { + buffer[j]=31; + } + for (; j<YRES; j++) { + buffer[j]=0; + } + break; + } + M5_command (0x300+192+8*c, 20); + M5_write (buffer, 8); + } +} + +int M5_clear (void) +{ + int row, col; + + for (row=0; row<Lcd.rows; row++) { + for (col=0; col<Lcd.cols; col++) { + Txt[row][col]='\t'; + Bar[row][col].len1=-1; + Bar[row][col].len2=-1; + Bar[row][col].type=0; + Bar[row][col].segment=-1; + } + } + GPO=0; + M5_setGPO (GPO); // All GPO's off + M5_command (0x0001, 1250); // clear display + return 0; +} + +int M5_init (LCD *Self) +{ + int rows=-1, cols=-1, gpos=-1; + char *s, *e; + + s=cfg_get ("Port"); + if (s==NULL || *s=='\0') { + error ("M50530: no 'Port' entry in %s", cfg_file()); + return -1; + } + PPdev=NULL; + if ((Port=strtol(s, &e, 0))==0 || *e!='\0') { +#ifdef WITH_PPDEV + Port=0; + PPdev=s; +#else + error ("M50530: bad port '%s' in %s", s, cfg_file()); + return -1; +#endif + } + +#ifdef USE_OLD_UDELAY + s=cfg_get ("Delay"); + if (s==NULL || *s=='\0') { + error ("M50530: no 'Delay' entry in %s", cfg_file()); + return -1; + } + if ((loops_per_usec=strtol(s, &e, 0))==0 || *e!='\0') { + error ("M50530: bad delay '%s' in %s", s, cfg_file()); + return -1; + } +#endif + + s=cfg_get("Size"); + if (s==NULL || *s=='\0') { + error ("M50530: no 'Size' entry in %s", cfg_file()); + return -1; + } + if (sscanf(s,"%dx%d",&cols,&rows)!=2 || rows<1 || cols<1) { + error ("M50530: bad size '%s'",s); + return -1; + } + + s=cfg_get ("GPOs"); + if (s==NULL) { + gpos=0; + } + else if ((gpos=strtol(s, &e, 0))==0 || *e!='\0' || gpos<0 || gpos>8) { + error ("M50530: bad GPOs '%s' in %s", s, cfg_file()); + return -1; + } + + Self->rows=rows; + Self->cols=cols; + Self->gpos=gpos; + Lcd=*Self; + +#ifndef USE_OLD_UDELAY + udelay_init(); +#endif + + if (M5_open()!=0) + return -1; + + M5_clear(); + + return 0; +} + +void M5_goto (int row, int col) +{ + int pos; + + pos=row*48+col; + if (row>3) pos-=168; + M5_command (0x300|pos, 20); +} + +int M5_put (int row, int col, char *text) +{ + char *p=&Txt[row][col]; + char *t=text; + + while (*t && col++<=Lcd.cols) { + *p++=*t++; + } + return 0; +} + +int M5_bar (int type, int row, int col, int max, int len1, int len2) +{ + int rev=0; + + if (len1<1) len1=1; + else if (len1>max) len1=max; + + if (len2<1) len2=1; + else if (len2>max) len2=max; + + switch (type) { + case BAR_L: + len1=max-len1; + len2=max-len2; + rev=1; + + case BAR_R: + while (max>0 && col<=Lcd.cols) { + Bar[row][col].type=type; + Bar[row][col].segment=-1; + if (len1>=XRES) { + Bar[row][col].len1=rev?0:XRES; + len1-=XRES; + } else { + Bar[row][col].len1=rev?XRES-len1:len1; + len1=0; + } + if (len2>=XRES) { + Bar[row][col].len2=rev?0:XRES; + len2-=XRES; + } else { + Bar[row][col].len2=rev?XRES-len2:len2; + len2=0; + } + max-=XRES; + col++; + } + break; + + case BAR_U: + len1=max-len1; + len2=max-len2; + rev=1; + + case BAR_D: + while (max>0 && row<=Lcd.rows) { + Bar[row][col].type=type; + Bar[row][col].segment=-1; + if (len1>=YRES) { + Bar[row][col].len1=rev?0:YRES; + len1-=YRES; + } else { + Bar[row][col].len1=rev?YRES-len1:len1; + len1=0; + } + if (len2>=YRES) { + Bar[row][col].len2=rev?0:YRES; + len2-=YRES; + } else { + Bar[row][col].len2=rev?YRES-len2:len2; + len2=0; + } + max-=YRES; + row++; + } + break; + + } + return 0; +} + +int M5_gpo (int num, int val) +{ + if (num>=Lcd.gpos) + return -1; + + if (val) { + GPO |= 1<<num; // set bit + } else { + GPO &= ~(1<<num); // clear bit + } + return 0; +} + +int M5_flush (void) +{ + unsigned char buffer[256]; + unsigned char *p; + int s, row, col; + + M5_process_bars(); + M5_compact_bars(); + M5_define_chars(); + + for (s=0; s<nSegment; s++) { + Segment[s].used=0; + } + + for (row=0; row<Lcd.rows; row++) { + for (col=0; col<Lcd.cols; col++) { + s=Bar[row][col].segment; + if (s!=-1) { + Segment[s].used=1; + Txt[row][col]=Segment[s].ascii; + } + } + for (col=0; col<Lcd.cols; col++) { + if (Txt[row][col]=='\t') continue; + M5_goto (row, col); + for (p=buffer; col<Lcd.cols; col++, p++) { + if (Txt[row][col]=='\t') break; + *p=Txt[row][col]; + } + M5_write (buffer, p-buffer); + } + } + + M5_setGPO(GPO); + + return 0; +} + +int M5_quit (void) +{ +#ifdef WITH_PPDEV + if (PPdev) { + debug ("closing ppdev %s", PPdev); + if (ioctl(PPfd, PPRELEASE)) { + error ("ioctl(%s, PPRELEASE) failed: %s", PPdev, strerror(errno)); + } + if (close(PPfd)==-1) { + error ("close(%s) failed: %s", PPdev, strerror(errno)); + return -1; + } + } else +#endif + { + debug ("closing raw port 0x%x", Port); + if (ioperm(Port, 3, 0)!=0) { + error ("M50530: ioperm(0x%x) failed: %s", Port, strerror(errno)); + return -1; + } + } + return 0; +} + +LCD M50530[] = { + { "M50530",0,0,XRES,YRES,BARS,0,M5_init,M5_clear,M5_put,M5_bar,M5_gpo,M5_flush,M5_quit }, + { NULL } +}; |