From a5db35ae86f652e520bacfe9c98e92ec3b4b4d66 Mon Sep 17 00:00:00 2001 From: reinelt Date: Fri, 4 Apr 2003 06:02:04 +0000 Subject: [lcd4linux @ 2003-04-04 06:01:59 by reinelt] new parallel port abstraction scheme git-svn-id: https://ssl.bulix.org/svn/lcd4linux/trunk@187 3ae390bd-cb1e-0410-b409-cd5a39f66f1f --- parport.c | 346 ++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++ 1 file changed, 346 insertions(+) create mode 100644 parport.c (limited to 'parport.c') diff --git a/parport.c b/parport.c new file mode 100644 index 0000000..6e7cbe4 --- /dev/null +++ b/parport.c @@ -0,0 +1,346 @@ +/* $Id: parport.c,v 1.1 2003/04/04 06:02:03 reinelt Exp $ + * + * generic parallel port handling + * + * Copyright 2003 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: parport.c,v $ + * Revision 1.1 2003/04/04 06:02:03 reinelt + * new parallel port abstraction scheme + * + */ + +/* + * exported functions: + * + * int parport_open (void) + * reads 'Port' entry from config and opens + * the parallel port + * returns 0 if ok, -1 on failure + * + * int parport_close (void) + * closes parallel port + * returns 0 if ok, -1 on failure + * + * unsigned char parport_wire (char *name, char *deflt) + * reads wiring for one control signal from config + * returns PARPORT_CONTROL_* or 255 on error + * + * void parport_control (unsigned char mask, unsigned char value) + * frobs control line and takes care of inverted signals + * + * void parport_toggle (unsigned char bit, int level, int delay) + * toggles the line to for nanoseconds + * + * void parport_data (unsigned char value) + * put data bits on DB1..DB8 + * + */ + + +#include "config.h" + +#include +#include +#include +#include +#include +#include +#include +#include + + +#ifdef HAVE_SYS_IO_H +#include +#define WITH_OUTB +#else +#ifdef HAVE_ASM_IO_H +#include +#define WITH_OUTB +#endif +#endif + +#if defined (HAVE_LINUX_PARPORT_H) && defined (HAVE_LINUX_PPDEV_H) +#define WITH_PPDEV +#include +#include +#else +#define PARPORT_CONTROL_STROBE 0x1 +#define PARPORT_CONTROL_AUTOFD 0x2 +#define PARPORT_CONTROL_INIT 0x4 +#define PARPORT_CONTROL_SELECT 0x8 +#endif + +#if !defined(WITH_OUTB) && !defined(WITH_PPDEV) +#error neither outb() nor ppdev() possible +#error cannot compile parallel port driver +#endif + + +#include "debug.h" +#include "cfg.h" +#include "udelay.h" +#include "parport.h" + + +static unsigned short Port=0; +static char *PPdev=NULL; + +// initial value taken from linux/parport_pc.c +static unsigned char ctr = 0xc; + +#ifdef WITH_PPDEV +static int PPfd=-1; +#endif + +int parport_open (void) +{ + char *s, *e; + +#ifdef USE_OLD_UDELAY + s=cfg_get ("Delay",NULL); + if (s==NULL || *s=='\0') { + error ("parport: no 'Delay' entry in %s", cfg_file()); + return -1; + } + if ((loops_per_usec=strtol(s, &e, 0))==0 || *e!='\0') { + error ("parport: bad delay '%s' in %s", s, cfg_file()); + return -1; + } +#else + udelay_init(); +#endif + + s=cfg_get ("Port",NULL); + if (s==NULL || *s=='\0') { + error ("parport: 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 ("parport: bad Port '%s' in %s", s, cfg_file()); + return -1; +#endif + } + + +#ifdef WITH_PPDEV + + if (PPdev) { + debug ("using ppdev %s", PPdev); + PPfd=open(PPdev, O_RDWR); + if (PPfd==-1) { + error ("parport: open(%s) failed: %s", PPdev, strerror(errno)); + return -1; + } + +#if 0 + // Fixme + 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 ("parport: 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 ("parport: ioperm(0x%x) failed: %s", Port, strerror(errno)); + return -1; + } + } + return 0; +} + + +int parport_close (void) +{ +#ifdef WITH_PPDEV + if (PPdev) { + debug ("closing ppdev %s", PPdev); + if (ioctl(PPfd, PPRELEASE)) { + error ("parport: ioctl(%s, PPRELEASE) failed: %s", PPdev, strerror(errno)); + } + if (close(PPfd)==-1) { + error ("parport: 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 ("parport: ioperm(0x%x) failed: %s", Port, strerror(errno)); + return -1; + } + } + return 0; +} + + +unsigned char parport_wire (char *name, unsigned char *deflt) +{ + unsigned char w; + char wire[256]; + char *s; + int n; + + snprintf (wire, sizeof(wire), "Wire.%s", name); + s=cfg_get (wire,deflt); + if (strcasecmp(s,"STROBE")==0) { + w=PARPORT_CONTROL_STROBE; + } else if(strcasecmp(s,"AUTOFD")==0) { + w=PARPORT_CONTROL_AUTOFD; + } else if(strcasecmp(s,"INIT")==0) { + w=PARPORT_CONTROL_INIT; + } else if(strcasecmp(s,"SELECT")==0) { + w=PARPORT_CONTROL_SELECT; + } else { + error ("parport: unknown signal <%s> for wire <%s>", s, name); + error (" should be STROBE, AUTOFD, INIT or SELECT"); + return 255; + } + + n=0; + if (w&PARPORT_CONTROL_STROBE) { + n++; + info ("wiring: [DISPLAY:%s]==[PARPORT:STROBE]", name); + } + if (w&PARPORT_CONTROL_AUTOFD) { + n++; + info ("wiring: [DISPLAY:%s]==[PARPORT:AUTOFD]", name); + } + if (w&PARPORT_CONTROL_INIT) { + n++; + info ("wiring: [DISPLAY:%s]==[PARPORT:INIT]", name); + } + if (w&PARPORT_CONTROL_SELECT) { + n++; + info ("wiring: [DISPLAY:%s]==[PARPORT:SELECT]", name); + } + if (n<1) { + error ("parport: no signal for wire <%s> found!", name); + return 255; + } + if (n>1) { + error ("parport: more than one signal for wire <%s> found!", name); + return 255; + } + return w; +} + + +void parport_control (unsigned char mask, unsigned char value) +{ + + // sanity check + if (mask==0) { + error ("parport: internal error: control without signal called!"); + return; + } + + // Strobe, Select and AutoFeed are inverted! + value ^= PARPORT_CONTROL_STROBE|PARPORT_CONTROL_SELECT|PARPORT_CONTROL_AUTOFD; + +#ifdef WITH_PPDEV + if (PPdev) { + struct ppdev_frob_struct frob; + frob.mask=mask; + frob.val=value; + ioctl (PPfd, PPFCONTROL, &frob); + } else +#endif + { + // code stolen from linux/parport_pc.h + ctr = (ctr & ~mask) ^ value; + outb (ctr, Port+2); + } +} + + +void parport_toggle (unsigned char bit, int level, int delay) +{ + + // sanity check + if (bit==0) { + error ("parport: internal error: toggle without signal called!"); + return; + } + + // Strobe, Select and AutoFeed are inverted! + if (bit & (PARPORT_CONTROL_STROBE|PARPORT_CONTROL_SELECT|PARPORT_CONTROL_AUTOFD)) { + level=!level; + } + +#ifdef WITH_PPDEV + if (PPdev) { + struct ppdev_frob_struct frob; + frob.mask=bit; + + // rise + frob.val=level?bit:0; + ioctl (PPfd, PPFCONTROL, &frob); + + // pulse width + ndelay(delay); + + // lower + frob.val=level?0:bit; + ioctl (PPfd, PPFCONTROL, &frob); + } else +#endif + { + // rise + ctr = (ctr & ~bit) ^ (level?bit:0); + outb (ctr, Port+2); + + // pulse width + ndelay(delay); + + // lower + ctr = (ctr & ~bit) ^ (level?0:bit); + outb (ctr, Port+2); + } +} + + +void parport_data (unsigned char data) +{ +#ifdef WITH_PPDEV + if (PPdev) { + ioctl(PPfd, PPWDATA, &data); + } else +#endif + { + outb (data, Port); + } +} + -- cgit v1.2.3