FEX-Emu/linux
1
0
Fork 0
mirror of https://github.com/FEX-Emu/linux.git synced 2025-02-06 11:19:56 +00:00
Code Issues Actions Packages Projects Releases Wiki Activity

Staging: comedi: add ssv_dnp driver

Browse Source 
driver for SSV Embedded Systems' DIL/Net-PCs

From: Robert Schwebel <robert@schwebel.de>
Cc: David Schleef <ds@schleef.org>
Cc: Frank Mori Hess <fmhess@users.sourceforge.net>
Cc: Ian Abbott <abbotti@mev.co.uk>
Signed-off-by: Greg Kroah-Hartman <gregkh@suse.de>
This commit is contained in:
Robert Schwebel 2009-02-12 16:25:34 -08:00 committed by Greg Kroah-Hartman
parent 110526ed6b
commit 18222f9822
1 changed files with 309 additions and 0 deletions
Show Stats Download Patch File Download Diff File Expand all files Collapse all files

309
drivers/staging/comedi/drivers/ssv_dnp.c Normal file
View File

@ -0,0 +1,309 @@
/*
comedi/drivers/ssv_dnp.c
generic comedi driver for SSV Embedded Systems' DIL/Net-PCs
Copyright (C) 2001 Robert Schwebel <robert@schwebel.de>
COMEDI - Linux Control and Measurement Device Interface
Copyright (C) 2000 David A. Schleef <ds@schleef.org>
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 of the License, 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.
*/
/*
Driver: ssv_dnp
Description: SSV Embedded Systems DIL/Net-PC
Author: Robert Schwebel <robert@schwebel.de>
Devices: [SSV Embedded Systems] DIL/Net-PC 1486 (dnp-1486)
Status: unknown
*/
/* include files ----------------------------------------------------------- */
#include "../comedidev.h"
/* Some global definitions: the registers of the DNP ----------------------- */
/* */
/* For port A and B the mode register has bits corresponding to the output */
/* pins, where Bit-N = 0 -> input, Bit-N = 1 -> output. Note that bits */
/* 4 to 7 correspond to pin 0..3 for port C data register. Ensure that bits */
/* 0..3 remain unchanged! For details about Port C Mode Register see */
/* the remarks in dnp_insn_config() below. */
#define CSCIR 0x22 /* Chip Setup and Control Index Register */
#define CSCDR 0x23 /* Chip Setup and Control Data Register */
#define PAMR 0xa5 /* Port A Mode Register */
#define PADR 0xa9 /* Port A Data Register */
#define PBMR 0xa4 /* Port B Mode Register */
#define PBDR 0xa8 /* Port B Data Register */
#define PCMR 0xa3 /* Port C Mode Register */
#define PCDR 0xa7 /* Port C Data Register */
/* This data structure holds information about the supported boards -------- */
typedef struct dnp_board_struct {
const char *name;
int ai_chans;
int ai_bits;
int have_dio;
} dnp_board;
static const dnp_board dnp_boards[] = { /* we only support one DNP 'board' */
{ /* variant at the moment */
name: "dnp-1486",
ai_chans:16,
ai_bits: 12,
have_dio:1,
},
};
/* Useful for shorthand access to the particular board structure ----------- */
#define thisboard ((const dnp_board *)dev->board_ptr)
/* This structure is for data unique to the DNP driver --------------------- */
typedef struct {
//
} dnp_private_data;
/* Shorthand macro for faster access to the private data ------------------- */
#define devpriv ((dnp_private *)dev->private)
/* ------------------------------------------------------------------------- */
/* The comedi_driver structure tells the Comedi core module which functions */
/* to call to configure/deconfigure (attach/detach) the board, and also */
/* about the kernel module that contains the device code. */
/* */
/* In the following section we define the API of this driver. */
/* ------------------------------------------------------------------------- */
static int dnp_attach(comedi_device * dev, comedi_devconfig * it);
static int dnp_detach(comedi_device * dev);
static comedi_driver driver_dnp = {
driver_name:"ssv_dnp",
module:THIS_MODULE,
attach:dnp_attach,
detach:dnp_detach,
board_name:&dnp_boards[0].name,
/* only necessary for non-PnP devs */
offset:sizeof(dnp_board),/* like ISA-PnP, PCI or PCMCIA. */
num_names:sizeof(dnp_boards) / sizeof(dnp_board),
};
COMEDI_INITCLEANUP(driver_dnp);
static int dnp_dio_insn_bits(comedi_device * dev,
comedi_subdevice * s, comedi_insn * insn, lsampl_t * data);
static int dnp_dio_insn_config(comedi_device * dev,
comedi_subdevice * s, comedi_insn * insn, lsampl_t * data);
/* ------------------------------------------------------------------------- */
/* Attach is called by comedi core to configure the driver for a particular */
/* board. If you specified a board_name array in the driver structure, */
/* dev->board_ptr contains that address. */
/* ------------------------------------------------------------------------- */
static int dnp_attach(comedi_device * dev, comedi_devconfig * it)
{
comedi_subdevice *s;
printk("comedi%d: dnp: ", dev->minor);
/* Autoprobing: this should find out which board we have. Currently only */
/* the 1486 board is supported and autoprobing is not implemented :-) */
//dev->board_ptr = dnp_probe(dev);
/* Initialize the name of the board. We can use the "thisboard" macro now. */
dev->board_name = thisboard->name;
/* Allocate the private structure area. alloc_private() is a convenient */
/* macro defined in comedidev.h. */
if (alloc_private(dev, sizeof(dnp_private_data)) < 0)
return -ENOMEM;
/* Allocate the subdevice structures. alloc_subdevice() is a convenient */
/* macro defined in comedidev.h. */
if (alloc_subdevices(dev, 1) < 0)
return -ENOMEM;
s = dev->subdevices + 0;
/* digital i/o subdevice */
s->type = COMEDI_SUBD_DIO;
s->subdev_flags = SDF_READABLE | SDF_WRITABLE;
s->n_chan = 20;
s->maxdata = 1;
s->range_table = &range_digital;
s->insn_bits = dnp_dio_insn_bits;
s->insn_config = dnp_dio_insn_config;
printk("attached\n");
/* We use the I/O ports 0x22,0x23 and 0xa3-0xa9, which are always
* allocated for the primary 8259, so we don't need to allocate them
* ourselves. */
/* configure all ports as input (default) */
outb(PAMR, CSCIR);
outb(0x00, CSCDR);
outb(PBMR, CSCIR);
outb(0x00, CSCDR);
outb(PCMR, CSCIR);
outb((inb(CSCDR) & 0xAA), CSCDR);
return 1;
}
/* ------------------------------------------------------------------------- */
/* detach is called to deconfigure a device. It should deallocate the */
/* resources. This function is also called when _attach() fails, so it */
/* should be careful not to release resources that were not necessarily */
/* allocated by _attach(). dev->private and dev->subdevices are */
/* deallocated automatically by the core. */
/* ------------------------------------------------------------------------- */
static int dnp_detach(comedi_device * dev)
{
/* configure all ports as input (default) */
outb(PAMR, CSCIR);
outb(0x00, CSCDR);
outb(PBMR, CSCIR);
outb(0x00, CSCDR);
outb(PCMR, CSCIR);
outb((inb(CSCDR) & 0xAA), CSCDR);
/* announce that we are finished */
printk("comedi%d: dnp: remove\n", dev->minor);
return 0;
}
/* ------------------------------------------------------------------------- */
/* The insn_bits interface allows packed reading/writing of DIO channels. */
/* The comedi core can convert between insn_bits and insn_read/write, so you */
/* are able to use these instructions as well. */
/* ------------------------------------------------------------------------- */
static int dnp_dio_insn_bits(comedi_device * dev,
comedi_subdevice * s, comedi_insn * insn, lsampl_t * data)
{
if (insn->n != 2)
return -EINVAL; /* insn uses data[0] and data[1] */
/* The insn data is a mask in data[0] and the new data in data[1], each */
/* channel cooresponding to a bit. */
/* Ports A and B are straight forward: each bit corresponds to an output */
/* pin with the same order. Port C is different: bits 0...3 correspond to */
/* bits 4...7 of the output register (PCDR). */
if (data[0]) {
outb(PADR, CSCIR);
outb((inb(CSCDR)
& ~(u8) (data[0] & 0x0000FF))
| (u8) (data[1] & 0x0000FF), CSCDR);
outb(PBDR, CSCIR);
outb((inb(CSCDR)
& ~(u8) ((data[0] & 0x00FF00) >> 8))
| (u8) ((data[1] & 0x00FF00) >> 8), CSCDR);
outb(PCDR, CSCIR);
outb((inb(CSCDR)
& ~(u8) ((data[0] & 0x0F0000) >> 12))
| (u8) ((data[1] & 0x0F0000) >> 12), CSCDR);
}
/* on return, data[1] contains the value of the digital input lines. */
outb(PADR, CSCIR);
data[0] = inb(CSCDR);
outb(PBDR, CSCIR);
data[0] += inb(CSCDR) << 8;
outb(PCDR, CSCIR);
data[0] += ((inb(CSCDR) & 0xF0) << 12);
return 2;
}
/* ------------------------------------------------------------------------- */
/* Configure the direction of the bidirectional digital i/o pins. chanspec */
/* contains the channel to be changed and data[0] contains either */
/* COMEDI_INPUT or COMEDI_OUTPUT. */
/* ------------------------------------------------------------------------- */
static int dnp_dio_insn_config(comedi_device * dev,
comedi_subdevice * s, comedi_insn * insn, lsampl_t * data)
{
u8 register_buffer;
int chan = CR_CHAN(insn->chanspec); /* reduces chanspec to lower 16 bits */
switch (data[0]) {
case INSN_CONFIG_DIO_OUTPUT:
case INSN_CONFIG_DIO_INPUT:
break;
case INSN_CONFIG_DIO_QUERY:
data[1] =
(inb(CSCDR) & (1 << chan)) ? COMEDI_OUTPUT :
COMEDI_INPUT;
return insn->n;
break;
default:
return -EINVAL;
break;
}
/* Test: which port does the channel belong to? */
/* We have to pay attention with port C: this is the meaning of PCMR: */
/* Bit in PCMR: 7 6 5 4 3 2 1 0 */
/* Corresponding port C pin: d 3 d 2 d 1 d 0 d= don't touch */
if ((chan >= 0) && (chan <= 7)) {
/* this is port A */
outb(PAMR, CSCIR);
} else if ((chan >= 8) && (chan <= 15)) {
/* this is port B */
chan -= 8;
outb(PBMR, CSCIR);
} else if ((chan >= 16) && (chan <= 19)) {
/* this is port C; multiplication with 2 brings bits into correct */
/* position for PCMR! */
chan -= 16;
chan *= 2;
outb(PCMR, CSCIR);
} else {
return -EINVAL;
}
/* read 'old' direction of the port and set bits (out=1, in=0) */
register_buffer = inb(CSCDR);
if (data[0] == COMEDI_OUTPUT) {
register_buffer |= (1 << chan);
} else {
register_buffer &= ~(1 << chan);
}
outb(register_buffer, CSCDR);
return 1;
}