[mirror_ubuntu-bionic-kernel.git] / drivers / staging / comedi / drivers / ni_670x.c

/*
    comedi/drivers/ni_670x.c
    Hardware driver for NI 670x devices

    COMEDI - Linux Control and Measurement Device Interface
    Copyright (C) 1997-2001 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: ni_670x
Description: National Instruments 670x
Author: Bart Joris <bjoris@advalvas.be>
Updated: Wed, 11 Dec 2002 18:25:35 -0800
Devices: [National Instruments] PCI-6703 (ni_670x), PCI-6704
Status: unknown

Commands are not supported.
*/

/*
	Bart Joris <bjoris@advalvas.be> Last updated on 20/08/2001

	Manuals:

	322110a.pdf	PCI/PXI-6704 User Manual
	322110b.pdf	PCI/PXI-6703/6704 User Manual

*/

#include <linux/interrupt.h>
#include <linux/slab.h>
#include "../comedidev.h"

#include "mite.h"

#define PCI_VENDOR_ID_NATINST	0x1093

#define AO_VALUE_OFFSET			0x00
#define	AO_CHAN_OFFSET			0x0c
#define	AO_STATUS_OFFSET		0x10
#define AO_CONTROL_OFFSET		0x10
#define	DIO_PORT0_DIR_OFFSET	0x20
#define	DIO_PORT0_DATA_OFFSET	0x24
#define	DIO_PORT1_DIR_OFFSET	0x28
#define	DIO_PORT1_DATA_OFFSET	0x2c
#define	MISC_STATUS_OFFSET		0x14
#define	MISC_CONTROL_OFFSET		0x14

/* Board description*/

struct ni_670x_board {
	unsigned short dev_id;
	const char *name;
	unsigned short ao_chans;
	unsigned short ao_bits;
};

static const struct ni_670x_board ni_670x_boards[] = {
	{
	 .dev_id = 0x2c90,
	 .name = "PCI-6703",
	 .ao_chans = 16,
	 .ao_bits = 16,
	 },
	{
	 .dev_id = 0x1920,
	 .name = "PXI-6704",
	 .ao_chans = 32,
	 .ao_bits = 16,
	 },
	{
	 .dev_id = 0x1290,
	 .name = "PCI-6704",
	 .ao_chans = 32,
	 .ao_bits = 16,
	 },
};

static DEFINE_PCI_DEVICE_TABLE(ni_670x_pci_table) = {
	{
	PCI_VENDOR_ID_NATINST, 0x2c90, PCI_ANY_ID, PCI_ANY_ID, 0, 0, 0}, {
	PCI_VENDOR_ID_NATINST, 0x1920, PCI_ANY_ID, PCI_ANY_ID, 0, 0, 0},
	/*{ PCI_VENDOR_ID_NATINST, 0x0000, PCI_ANY_ID, PCI_ANY_ID, 0, 0, 0 },*/
	{
	0}
};

MODULE_DEVICE_TABLE(pci, ni_670x_pci_table);

#define thisboard ((struct ni_670x_board *)dev->board_ptr)

struct ni_670x_private {

	struct mite_struct *mite;
	int boardtype;
	int dio;
	unsigned int ao_readback[32];
};

#define devpriv ((struct ni_670x_private *)dev->private)
#define n_ni_670x_boards ARRAY_SIZE(ni_670x_boards)

static int ni_670x_attach(struct comedi_device *dev,
			  struct comedi_devconfig *it);
static int ni_670x_detach(struct comedi_device *dev);

static struct comedi_driver driver_ni_670x = {
	.driver_name = "ni_670x",
	.module = THIS_MODULE,
	.attach = ni_670x_attach,
	.detach = ni_670x_detach,
};

COMEDI_PCI_INITCLEANUP(driver_ni_670x, ni_670x_pci_table);

static struct comedi_lrange range_0_20mA = { 1, {RANGE_mA(0, 20)} };

static int ni_670x_find_device(struct comedi_device *dev, int bus, int slot);

static int ni_670x_ao_winsn(struct comedi_device *dev,
			    struct comedi_subdevice *s,
			    struct comedi_insn *insn, unsigned int *data);
static int ni_670x_ao_rinsn(struct comedi_device *dev,
			    struct comedi_subdevice *s,
			    struct comedi_insn *insn, unsigned int *data);
static int ni_670x_dio_insn_bits(struct comedi_device *dev,
				 struct comedi_subdevice *s,
				 struct comedi_insn *insn, unsigned int *data);
static int ni_670x_dio_insn_config(struct comedi_device *dev,
				   struct comedi_subdevice *s,
				   struct comedi_insn *insn,
				   unsigned int *data);

static int ni_670x_attach(struct comedi_device *dev,
			  struct comedi_devconfig *it)
{
	struct comedi_subdevice *s;
	int ret;
	int i;

	printk(KERN_INFO "comedi%d: ni_670x: ", dev->minor);

	ret = alloc_private(dev, sizeof(struct ni_670x_private));
	if (ret < 0)
		return ret;

	ret = ni_670x_find_device(dev, it->options[0], it->options[1]);
	if (ret < 0)
		return ret;

	ret = mite_setup(devpriv->mite);
	if (ret < 0) {
		printk(KERN_WARNING "error setting up mite\n");
		return ret;
	}
	dev->board_name = thisboard->name;
	dev->irq = mite_irq(devpriv->mite);
	printk(KERN_INFO " %s", dev->board_name);

	if (alloc_subdevices(dev, 2) < 0)
		return -ENOMEM;

	s = dev->subdevices + 0;
	/* analog output subdevice */
	s->type = COMEDI_SUBD_AO;
	s->subdev_flags = SDF_WRITABLE;
	s->n_chan = thisboard->ao_chans;
	s->maxdata = 0xffff;
	if (s->n_chan == 32) {
		const struct comedi_lrange **range_table_list;

		range_table_list = kmalloc(sizeof(struct comedi_lrange *) * 32,
					   GFP_KERNEL);
		if (!range_table_list)
			return -ENOMEM;
		s->range_table_list = range_table_list;
		for (i = 0; i < 16; i++) {
			range_table_list[i] = &range_bipolar10;
			range_table_list[16 + i] = &range_0_20mA;
		}
	} else {
		s->range_table = &range_bipolar10;
	}
	s->insn_write = &ni_670x_ao_winsn;
	s->insn_read = &ni_670x_ao_rinsn;

	s = dev->subdevices + 1;
	/* digital i/o subdevice */
	s->type = COMEDI_SUBD_DIO;
	s->subdev_flags = SDF_READABLE | SDF_WRITABLE;
	s->n_chan = 8;
	s->maxdata = 1;
	s->range_table = &range_digital;
	s->insn_bits = ni_670x_dio_insn_bits;
	s->insn_config = ni_670x_dio_insn_config;

	/* Config of misc registers */
	writel(0x10, devpriv->mite->daq_io_addr + MISC_CONTROL_OFFSET);
	/* Config of ao registers */
	writel(0x00, devpriv->mite->daq_io_addr + AO_CONTROL_OFFSET);

	printk(KERN_INFO "attached\n");

	return 1;
}

static int ni_670x_detach(struct comedi_device *dev)
{
	printk(KERN_INFO "comedi%d: ni_670x: remove\n", dev->minor);

	kfree(dev->subdevices[0].range_table_list);

	if (dev->private && devpriv->mite)
		mite_unsetup(devpriv->mite);

	if (dev->irq)
		free_irq(dev->irq, dev);

	return 0;
}

static int ni_670x_ao_winsn(struct comedi_device *dev,
			    struct comedi_subdevice *s,
			    struct comedi_insn *insn, unsigned int *data)
{
	int i;
	int chan = CR_CHAN(insn->chanspec);

	/* Channel number mapping :

	   NI 6703/ NI 6704     | NI 6704 Only
	   ----------------------------------------------------
	   vch(0)       :       0       | ich(16)       :       1
	   vch(1)       :       2       | ich(17)       :       3
	   .    :       .       |   .                   .
	   .    :       .       |   .                   .
	   .    :       .       |   .                   .
	   vch(15)      :       30      | ich(31)       :       31      */

	for (i = 0; i < insn->n; i++) {
		/* First write in channel register which channel to use */
		writel(((chan & 15) << 1) | ((chan & 16) >> 4),
		       devpriv->mite->daq_io_addr + AO_CHAN_OFFSET);
		/* write channel value */
		writel(data[i], devpriv->mite->daq_io_addr + AO_VALUE_OFFSET);
		devpriv->ao_readback[chan] = data[i];
	}

	return i;
}

static int ni_670x_ao_rinsn(struct comedi_device *dev,
			    struct comedi_subdevice *s,
			    struct comedi_insn *insn, unsigned int *data)
{
	int i;
	int chan = CR_CHAN(insn->chanspec);

	for (i = 0; i < insn->n; i++)
		data[i] = devpriv->ao_readback[chan];

	return i;
}

static int ni_670x_dio_insn_bits(struct comedi_device *dev,
				 struct comedi_subdevice *s,
				 struct comedi_insn *insn, unsigned int *data)
{
	if (insn->n != 2)
		return -EINVAL;

	/* The insn data is a mask in data[0] and the new data
	 * in data[1], each channel cooresponding to a bit. */
	if (data[0]) {
		s->state &= ~data[0];
		s->state |= data[0] & data[1];
		writel(s->state,
		       devpriv->mite->daq_io_addr + DIO_PORT0_DATA_OFFSET);
	}

	/* on return, data[1] contains the value of the digital
	 * input lines. */
	data[1] = readl(devpriv->mite->daq_io_addr + DIO_PORT0_DATA_OFFSET);

	return 2;
}

static int ni_670x_dio_insn_config(struct comedi_device *dev,
				   struct comedi_subdevice *s,
				   struct comedi_insn *insn, unsigned int *data)
{
	int chan = CR_CHAN(insn->chanspec);

	switch (data[0]) {
	case INSN_CONFIG_DIO_OUTPUT:
		s->io_bits |= 1 << chan;
		break;
	case INSN_CONFIG_DIO_INPUT:
		s->io_bits &= ~(1 << chan);
		break;
	case INSN_CONFIG_DIO_QUERY:
		data[1] =
		    (s->io_bits & (1 << chan)) ? COMEDI_OUTPUT : COMEDI_INPUT;
		return insn->n;
		break;
	default:
		return -EINVAL;
		break;
	}
	writel(s->io_bits, devpriv->mite->daq_io_addr + DIO_PORT0_DIR_OFFSET);

	return insn->n;
}

static int ni_670x_find_device(struct comedi_device *dev, int bus, int slot)
{
	struct mite_struct *mite;
	int i;

	for (mite = mite_devices; mite; mite = mite->next) {
		if (mite->used)
			continue;
		if (bus || slot) {
			if (bus != mite->pcidev->bus->number
			    || slot != PCI_SLOT(mite->pcidev->devfn))
				continue;
		}

		for (i = 0; i < n_ni_670x_boards; i++) {
			if (mite_device_id(mite) == ni_670x_boards[i].dev_id) {
				dev->board_ptr = ni_670x_boards + i;
				devpriv->mite = mite;

				return 0;
			}
		}
	}
	printk(KERN_INFO "no device found\n");
	mite_list_devices();
	return -EIO;
}
Commit	Line	Data
3c5e1722 BJ	1	/*
	2	comedi/drivers/ni_670x.c
	3	Hardware driver for NI 670x devices
	4
	5	COMEDI - Linux Control and Measurement Device Interface
	6	Copyright (C) 1997-2001 David A. Schleef <ds@schleef.org>
	7
	8	This program is free software; you can redistribute it and/or modify
	9	it under the terms of the GNU General Public License as published by
	10	the Free Software Foundation; either version 2 of the License, or
	11	(at your option) any later version.
	12
	13	This program is distributed in the hope that it will be useful,
	14	but WITHOUT ANY WARRANTY; without even the implied warranty of
	15	MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE. See the
	16	GNU General Public License for more details.
	17
	18	You should have received a copy of the GNU General Public License
	19	along with this program; if not, write to the Free Software
	20	Foundation, Inc., 675 Mass Ave, Cambridge, MA 02139, USA.
	21
	22	*/
	23	/*
	24	Driver: ni_670x
	25	Description: National Instruments 670x
	26	Author: Bart Joris <bjoris@advalvas.be>
	27	Updated: Wed, 11 Dec 2002 18:25:35 -0800
	28	Devices: [National Instruments] PCI-6703 (ni_670x), PCI-6704
	29	Status: unknown
	30
	31	Commands are not supported.
	32	*/
	33
	34	/*
	35	Bart Joris <bjoris@advalvas.be> Last updated on 20/08/2001
	36
	37	Manuals:
	38
	39	322110a.pdf PCI/PXI-6704 User Manual
	40	322110b.pdf PCI/PXI-6703/6704 User Manual
	41
	42	*/
	43
25436dc9	44	#include <linux/interrupt.h>
5a0e3ad6	45	#include <linux/slab.h>
3c5e1722 BJ	46	#include "../comedidev.h"
	47
	48	#include "mite.h"
	49
	50	#define PCI_VENDOR_ID_NATINST 0x1093
	51
	52	#define AO_VALUE_OFFSET 0x00
	53	#define AO_CHAN_OFFSET 0x0c
	54	#define AO_STATUS_OFFSET 0x10
	55	#define AO_CONTROL_OFFSET 0x10
	56	#define DIO_PORT0_DIR_OFFSET 0x20
	57	#define DIO_PORT0_DATA_OFFSET 0x24
	58	#define DIO_PORT1_DIR_OFFSET 0x28
	59	#define DIO_PORT1_DATA_OFFSET 0x2c
	60	#define MISC_STATUS_OFFSET 0x14
	61	#define MISC_CONTROL_OFFSET 0x14
	62
	63	/* Board description*/
	64
43313b07	65	struct ni_670x_board {
3c5e1722 BJ	66	unsigned short dev_id;
	67	const char *name;
	68	unsigned short ao_chans;
	69	unsigned short ao_bits;
43313b07 BP	70	};
	71
	72	static const struct ni_670x_board ni_670x_boards[] = {
3c5e1722	73	{
0a85b6f0 MT	74	.dev_id = 0x2c90,
	75	.name = "PCI-6703",
	76	.ao_chans = 16,
	77	.ao_bits = 16,
	78	},
3c5e1722	79	{
0a85b6f0 MT	80	.dev_id = 0x1920,
	81	.name = "PXI-6704",
	82	.ao_chans = 32,
	83	.ao_bits = 16,
	84	},
3c5e1722	85	{
0a85b6f0 MT	86	.dev_id = 0x1290,
	87	.name = "PCI-6704",
	88	.ao_chans = 32,
	89	.ao_bits = 16,
	90	},
3c5e1722 BJ	91	};
	92
	93	static DEFINE_PCI_DEVICE_TABLE(ni_670x_pci_table) = {
0a85b6f0 MT	94	{
	95	PCI_VENDOR_ID_NATINST, 0x2c90, PCI_ANY_ID, PCI_ANY_ID, 0, 0, 0}, {
	96	PCI_VENDOR_ID_NATINST, 0x1920, PCI_ANY_ID, PCI_ANY_ID, 0, 0, 0},
c733110a	97	/{ PCI_VENDOR_ID_NATINST, 0x0000, PCI_ANY_ID, PCI_ANY_ID, 0, 0, 0 },/
0a85b6f0 MT	98	{
0a85b6f0 MT	99	0}
3c5e1722 BJ	100	};
	101
	102	MODULE_DEVICE_TABLE(pci, ni_670x_pci_table);
	103
43313b07	104	#define thisboard ((struct ni_670x_board *)dev->board_ptr)
3c5e1722	105
8ce8a1ff BP	106	struct ni_670x_private {
8ce8a1ff BP	107
3c5e1722 BJ	108	struct mite_struct *mite;
	109	int boardtype;
	110	int dio;
790c5541	111	unsigned int ao_readback[32];
8ce8a1ff BP	112	};
8ce8a1ff BP	113
8ce8a1ff	114	#define devpriv ((struct ni_670x_private *)dev->private)
b6ac1613	115	#define n_ni_670x_boards ARRAY_SIZE(ni_670x_boards)
3c5e1722	116
0a85b6f0 MT	117	static int ni_670x_attach(struct comedi_device *dev,
0a85b6f0 MT	118	struct comedi_devconfig *it);
da91b269	119	static int ni_670x_detach(struct comedi_device *dev);
3c5e1722	120
139dfbdf	121	static struct comedi_driver driver_ni_670x = {
68c3dbff BP	122	.driver_name = "ni_670x",
	123	.module = THIS_MODULE,
	124	.attach = ni_670x_attach,
	125	.detach = ni_670x_detach,
3c5e1722 BJ	126	};
	127
	128	COMEDI_PCI_INITCLEANUP(driver_ni_670x, ni_670x_pci_table);
	129
9ced1de6	130	static struct comedi_lrange range_0_20mA = { 1, {RANGE_mA(0, 20)} };
3c5e1722	131
da91b269	132	static int ni_670x_find_device(struct comedi_device *dev, int bus, int slot);
3c5e1722	133
0a85b6f0 MT	134	static int ni_670x_ao_winsn(struct comedi_device *dev,
	135	struct comedi_subdevice *s,
	136	struct comedi_insn insn, unsigned int data);
	137	static int ni_670x_ao_rinsn(struct comedi_device *dev,
	138	struct comedi_subdevice *s,
	139	struct comedi_insn insn, unsigned int data);
	140	static int ni_670x_dio_insn_bits(struct comedi_device *dev,
	141	struct comedi_subdevice *s,
	142	struct comedi_insn insn, unsigned int data);
	143	static int ni_670x_dio_insn_config(struct comedi_device *dev,
	144	struct comedi_subdevice *s,
	145	struct comedi_insn *insn,
	146	unsigned int *data);
	147
	148	static int ni_670x_attach(struct comedi_device *dev,
	149	struct comedi_devconfig *it)
3c5e1722	150	{
34c43922	151	struct comedi_subdevice *s;
3c5e1722 BJ	152	int ret;
	153	int i;
	154
c733110a	155	printk(KERN_INFO "comedi%d: ni_670x: ", dev->minor);
3c5e1722	156
c3744138 BP	157	ret = alloc_private(dev, sizeof(struct ni_670x_private));
c3744138 BP	158	if (ret < 0)
3c5e1722 BJ	159	return ret;
	160
	161	ret = ni_670x_find_device(dev, it->options[0], it->options[1]);
	162	if (ret < 0)
	163	return ret;
	164
	165	ret = mite_setup(devpriv->mite);
	166	if (ret < 0) {
c733110a	167	printk(KERN_WARNING "error setting up mite\n");
3c5e1722 BJ	168	return ret;
	169	}
	170	dev->board_name = thisboard->name;
	171	dev->irq = mite_irq(devpriv->mite);
c733110a	172	printk(KERN_INFO " %s", dev->board_name);
3c5e1722 BJ	173
	174	if (alloc_subdevices(dev, 2) < 0)
	175	return -ENOMEM;
	176
	177	s = dev->subdevices + 0;
	178	/* analog output subdevice */
	179	s->type = COMEDI_SUBD_AO;
	180	s->subdev_flags = SDF_WRITABLE;
	181	s->n_chan = thisboard->ao_chans;
	182	s->maxdata = 0xffff;
	183	if (s->n_chan == 32) {
9ced1de6	184	const struct comedi_lrange **range_table_list;
3c5e1722	185
9ced1de6	186	range_table_list = kmalloc(sizeof(struct comedi_lrange ) 32,
0a85b6f0	187	GFP_KERNEL);
3c5e1722 BJ	188	if (!range_table_list)
	189	return -ENOMEM;
	190	s->range_table_list = range_table_list;
	191	for (i = 0; i < 16; i++) {
	192	range_table_list[i] = &range_bipolar10;
	193	range_table_list[16 + i] = &range_0_20mA;
	194	}
	195	} else {
	196	s->range_table = &range_bipolar10;
	197	}
	198	s->insn_write = &ni_670x_ao_winsn;
	199	s->insn_read = &ni_670x_ao_rinsn;
	200
	201	s = dev->subdevices + 1;
	202	/* digital i/o subdevice */
	203	s->type = COMEDI_SUBD_DIO;
	204	s->subdev_flags = SDF_READABLE \| SDF_WRITABLE;
	205	s->n_chan = 8;
	206	s->maxdata = 1;
	207	s->range_table = &range_digital;
	208	s->insn_bits = ni_670x_dio_insn_bits;
	209	s->insn_config = ni_670x_dio_insn_config;
	210
c733110a BA	211	/* Config of misc registers */
	212	writel(0x10, devpriv->mite->daq_io_addr + MISC_CONTROL_OFFSET);
	213	/* Config of ao registers */
	214	writel(0x00, devpriv->mite->daq_io_addr + AO_CONTROL_OFFSET);
3c5e1722	215
c733110a	216	printk(KERN_INFO "attached\n");
3c5e1722 BJ	217
	218	return 1;
	219	}
	220
da91b269	221	static int ni_670x_detach(struct comedi_device *dev)
3c5e1722	222	{
c733110a BA	223	printk(KERN_INFO "comedi%d: ni_670x: remove\n", dev->minor);
	224
	225	kfree(dev->subdevices[0].range_table_list);
3c5e1722	226
3c5e1722 BJ	227	if (dev->private && devpriv->mite)
	228	mite_unsetup(devpriv->mite);
	229
	230	if (dev->irq)
5f74ea14	231	free_irq(dev->irq, dev);
3c5e1722 BJ	232
	233	return 0;
	234	}
	235
0a85b6f0 MT	236	static int ni_670x_ao_winsn(struct comedi_device *dev,
	237	struct comedi_subdevice *s,
	238	struct comedi_insn insn, unsigned int data)
3c5e1722 BJ	239	{
	240	int i;
	241	int chan = CR_CHAN(insn->chanspec);
	242
	243	/* Channel number mapping :
	244
	245	NI 6703/ NI 6704 \| NI 6704 Only
	246	----------------------------------------------------
	247	vch(0) : 0 \| ich(16) : 1
	248	vch(1) : 2 \| ich(17) : 3
	249	. : . \| . .
	250	. : . \| . .
	251	. : . \| . .
	252	vch(15) : 30 \| ich(31) : 31 */
	253
	254	for (i = 0; i < insn->n; i++) {
c733110a BA	255	/* First write in channel register which channel to use */
	256	writel(((chan & 15) << 1) \| ((chan & 16) >> 4),
	257	devpriv->mite->daq_io_addr + AO_CHAN_OFFSET);
	258	/* write channel value */
	259	writel(data[i], devpriv->mite->daq_io_addr + AO_VALUE_OFFSET);
3c5e1722 BJ	260	devpriv->ao_readback[chan] = data[i];
	261	}
	262
	263	return i;
	264	}
	265
0a85b6f0 MT	266	static int ni_670x_ao_rinsn(struct comedi_device *dev,
	267	struct comedi_subdevice *s,
	268	struct comedi_insn insn, unsigned int data)
3c5e1722 BJ	269	{
	270	int i;
	271	int chan = CR_CHAN(insn->chanspec);
	272
	273	for (i = 0; i < insn->n; i++)
	274	data[i] = devpriv->ao_readback[chan];
	275
	276	return i;
	277	}
	278
0a85b6f0 MT	279	static int ni_670x_dio_insn_bits(struct comedi_device *dev,
	280	struct comedi_subdevice *s,
	281	struct comedi_insn insn, unsigned int data)
3c5e1722 BJ	282	{
	283	if (insn->n != 2)
	284	return -EINVAL;
	285
	286	/* The insn data is a mask in data[0] and the new data
	287	* in data[1], each channel cooresponding to a bit. */
	288	if (data[0]) {
	289	s->state &= ~data[0];
	290	s->state \|= data[0] & data[1];
	291	writel(s->state,
0a85b6f0	292	devpriv->mite->daq_io_addr + DIO_PORT0_DATA_OFFSET);
3c5e1722 BJ	293	}
	294
	295	/* on return, data[1] contains the value of the digital
	296	* input lines. */
	297	data[1] = readl(devpriv->mite->daq_io_addr + DIO_PORT0_DATA_OFFSET);
	298
	299	return 2;
	300	}
	301
0a85b6f0 MT	302	static int ni_670x_dio_insn_config(struct comedi_device *dev,
	303	struct comedi_subdevice *s,
	304	struct comedi_insn insn, unsigned int data)
3c5e1722 BJ	305	{
	306	int chan = CR_CHAN(insn->chanspec);
	307
	308	switch (data[0]) {
	309	case INSN_CONFIG_DIO_OUTPUT:
	310	s->io_bits \|= 1 << chan;
	311	break;
	312	case INSN_CONFIG_DIO_INPUT:
	313	s->io_bits &= ~(1 << chan);
	314	break;
	315	case INSN_CONFIG_DIO_QUERY:
	316	data[1] =
0a85b6f0	317	(s->io_bits & (1 << chan)) ? COMEDI_OUTPUT : COMEDI_INPUT;
3c5e1722 BJ	318	return insn->n;
	319	break;
	320	default:
	321	return -EINVAL;
	322	break;
	323	}
	324	writel(s->io_bits, devpriv->mite->daq_io_addr + DIO_PORT0_DIR_OFFSET);
	325
	326	return insn->n;
	327	}
	328
da91b269	329	static int ni_670x_find_device(struct comedi_device *dev, int bus, int slot)
3c5e1722 BJ	330	{
	331	struct mite_struct *mite;
	332	int i;
	333
	334	for (mite = mite_devices; mite; mite = mite->next) {
	335	if (mite->used)
	336	continue;
	337	if (bus \|\| slot) {
	338	if (bus != mite->pcidev->bus->number
0a85b6f0	339	\|\| slot != PCI_SLOT(mite->pcidev->devfn))
3c5e1722 BJ	340	continue;
	341	}
	342
	343	for (i = 0; i < n_ni_670x_boards; i++) {
	344	if (mite_device_id(mite) == ni_670x_boards[i].dev_id) {
	345	dev->board_ptr = ni_670x_boards + i;
	346	devpriv->mite = mite;
	347
	348	return 0;
	349	}
	350	}
	351	}
c733110a	352	printk(KERN_INFO "no device found\n");
3c5e1722 BJ	353	mite_list_devices();
	354	return -EIO;
	355	}