[mirror_ubuntu-hirsute-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 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_DEVICE(PCI_VENDOR_ID_NI, 0x2c90)},
	{PCI_DEVICE(PCI_VENDOR_ID_NI, 0x1920)},
	{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 void 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,
};

static int __devinit driver_ni_670x_pci_probe(struct pci_dev *dev,
					      const struct pci_device_id *ent)
{
	return comedi_pci_auto_config(dev, &driver_ni_670x);
}

static void __devexit driver_ni_670x_pci_remove(struct pci_dev *dev)
{
	comedi_pci_auto_unconfig(dev);
}

static struct pci_driver driver_ni_670x_pci_driver = {
	.id_table = ni_670x_pci_table,
	.probe = &driver_ni_670x_pci_probe,
	.remove = __devexit_p(&driver_ni_670x_pci_remove)
};

static int __init driver_ni_670x_init_module(void)
{
	int retval;

	retval = comedi_driver_register(&driver_ni_670x);
	if (retval < 0)
		return retval;

	driver_ni_670x_pci_driver.name = (char *)driver_ni_670x.driver_name;
	return pci_register_driver(&driver_ni_670x_pci_driver);
}

static void __exit driver_ni_670x_cleanup_module(void)
{
	pci_unregister_driver(&driver_ni_670x_pci_driver);
	comedi_driver_unregister(&driver_ni_670x);
}

module_init(driver_ni_670x_init_module);
module_exit(driver_ni_670x_cleanup_module);

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);

	ret = comedi_alloc_subdevices(dev, 2);
	if (ret)
		return ret;

	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 void ni_670x_detach(struct comedi_device *dev)
{
	kfree(dev->subdevices[0].range_table_list);
	if (dev->private && devpriv->mite)
		mite_unsetup(devpriv->mite);
	if (dev->irq)
		free_irq(dev->irq, dev);
}

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)
{
	/* 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 insn->n;
}

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;
}

MODULE_AUTHOR("Comedi http://www.comedi.org");
MODULE_DESCRIPTION("Comedi low-level driver");
MODULE_LICENSE("GPL");
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
3c5e1722 BJ	50	#define AO_VALUE_OFFSET 0x00
	51	#define AO_CHAN_OFFSET 0x0c
	52	#define AO_STATUS_OFFSET 0x10
	53	#define AO_CONTROL_OFFSET 0x10
	54	#define DIO_PORT0_DIR_OFFSET 0x20
	55	#define DIO_PORT0_DATA_OFFSET 0x24
	56	#define DIO_PORT1_DIR_OFFSET 0x28
	57	#define DIO_PORT1_DATA_OFFSET 0x2c
	58	#define MISC_STATUS_OFFSET 0x14
	59	#define MISC_CONTROL_OFFSET 0x14
	60
	61	/* Board description*/
	62
43313b07	63	struct ni_670x_board {
3c5e1722 BJ	64	unsigned short dev_id;
	65	const char *name;
	66	unsigned short ao_chans;
	67	unsigned short ao_bits;
43313b07 BP	68	};
	69
	70	static const struct ni_670x_board ni_670x_boards[] = {
3c5e1722	71	{
0a85b6f0 MT	72	.dev_id = 0x2c90,
	73	.name = "PCI-6703",
	74	.ao_chans = 16,
	75	.ao_bits = 16,
	76	},
3c5e1722	77	{
0a85b6f0 MT	78	.dev_id = 0x1920,
	79	.name = "PXI-6704",
	80	.ao_chans = 32,
	81	.ao_bits = 16,
	82	},
3c5e1722	83	{
0a85b6f0 MT	84	.dev_id = 0x1290,
	85	.name = "PCI-6704",
	86	.ao_chans = 32,
	87	.ao_bits = 16,
	88	},
3c5e1722 BJ	89	};
	90
	91	static DEFINE_PCI_DEVICE_TABLE(ni_670x_pci_table) = {
4e40cee9 GKH	92	{PCI_DEVICE(PCI_VENDOR_ID_NI, 0x2c90)},
	93	{PCI_DEVICE(PCI_VENDOR_ID_NI, 0x1920)},
	94	{0}
3c5e1722 BJ	95	};
	96
	97	MODULE_DEVICE_TABLE(pci, ni_670x_pci_table);
	98
43313b07	99	#define thisboard ((struct ni_670x_board *)dev->board_ptr)
3c5e1722	100
8ce8a1ff BP	101	struct ni_670x_private {
8ce8a1ff BP	102
3c5e1722 BJ	103	struct mite_struct *mite;
	104	int boardtype;
	105	int dio;
790c5541	106	unsigned int ao_readback[32];
8ce8a1ff BP	107	};
8ce8a1ff BP	108
8ce8a1ff	109	#define devpriv ((struct ni_670x_private *)dev->private)
b6ac1613	110	#define n_ni_670x_boards ARRAY_SIZE(ni_670x_boards)
3c5e1722	111
0a85b6f0 MT	112	static int ni_670x_attach(struct comedi_device *dev,
0a85b6f0 MT	113	struct comedi_devconfig *it);
484ecc95	114	static void ni_670x_detach(struct comedi_device *dev);
3c5e1722	115
139dfbdf	116	static struct comedi_driver driver_ni_670x = {
68c3dbff BP	117	.driver_name = "ni_670x",
	118	.module = THIS_MODULE,
	119	.attach = ni_670x_attach,
	120	.detach = ni_670x_detach,
3c5e1722 BJ	121	};
3c5e1722 BJ	122
727b286b AT	123	static int __devinit driver_ni_670x_pci_probe(struct pci_dev *dev,
	124	const struct pci_device_id *ent)
	125	{
4c093a6d	126	return comedi_pci_auto_config(dev, &driver_ni_670x);
727b286b AT	127	}
	128
	129	static void __devexit driver_ni_670x_pci_remove(struct pci_dev *dev)
	130	{
	131	comedi_pci_auto_unconfig(dev);
	132	}
	133
	134	static struct pci_driver driver_ni_670x_pci_driver = {
	135	.id_table = ni_670x_pci_table,
	136	.probe = &driver_ni_670x_pci_probe,
	137	.remove = __devexit_p(&driver_ni_670x_pci_remove)
	138	};
	139
	140	static int __init driver_ni_670x_init_module(void)
	141	{
	142	int retval;
	143
	144	retval = comedi_driver_register(&driver_ni_670x);
	145	if (retval < 0)
	146	return retval;
	147
	148	driver_ni_670x_pci_driver.name = (char *)driver_ni_670x.driver_name;
	149	return pci_register_driver(&driver_ni_670x_pci_driver);
	150	}
	151
	152	static void __exit driver_ni_670x_cleanup_module(void)
	153	{
	154	pci_unregister_driver(&driver_ni_670x_pci_driver);
	155	comedi_driver_unregister(&driver_ni_670x);
	156	}
	157
	158	module_init(driver_ni_670x_init_module);
	159	module_exit(driver_ni_670x_cleanup_module);
3c5e1722	160
9ced1de6	161	static struct comedi_lrange range_0_20mA = { 1, {RANGE_mA(0, 20)} };
3c5e1722	162
da91b269	163	static int ni_670x_find_device(struct comedi_device *dev, int bus, int slot);
3c5e1722	164
0a85b6f0 MT	165	static int ni_670x_ao_winsn(struct comedi_device *dev,
	166	struct comedi_subdevice *s,
	167	struct comedi_insn insn, unsigned int data);
	168	static int ni_670x_ao_rinsn(struct comedi_device *dev,
	169	struct comedi_subdevice *s,
	170	struct comedi_insn insn, unsigned int data);
	171	static int ni_670x_dio_insn_bits(struct comedi_device *dev,
	172	struct comedi_subdevice *s,
	173	struct comedi_insn insn, unsigned int data);
	174	static int ni_670x_dio_insn_config(struct comedi_device *dev,
	175	struct comedi_subdevice *s,
	176	struct comedi_insn *insn,
	177	unsigned int *data);
	178
	179	static int ni_670x_attach(struct comedi_device *dev,
	180	struct comedi_devconfig *it)
3c5e1722	181	{
34c43922	182	struct comedi_subdevice *s;
3c5e1722 BJ	183	int ret;
	184	int i;
	185
c733110a	186	printk(KERN_INFO "comedi%d: ni_670x: ", dev->minor);
3c5e1722	187
c3744138 BP	188	ret = alloc_private(dev, sizeof(struct ni_670x_private));
c3744138 BP	189	if (ret < 0)
3c5e1722 BJ	190	return ret;
	191
	192	ret = ni_670x_find_device(dev, it->options[0], it->options[1]);
	193	if (ret < 0)
	194	return ret;
	195
	196	ret = mite_setup(devpriv->mite);
	197	if (ret < 0) {
c733110a	198	printk(KERN_WARNING "error setting up mite\n");
3c5e1722 BJ	199	return ret;
	200	}
	201	dev->board_name = thisboard->name;
	202	dev->irq = mite_irq(devpriv->mite);
c733110a	203	printk(KERN_INFO " %s", dev->board_name);
3c5e1722	204
8b6c5694 HS	205	ret = comedi_alloc_subdevices(dev, 2);
	206	if (ret)
	207	return ret;
3c5e1722 BJ	208
	209	s = dev->subdevices + 0;
	210	/* analog output subdevice */
	211	s->type = COMEDI_SUBD_AO;
	212	s->subdev_flags = SDF_WRITABLE;
	213	s->n_chan = thisboard->ao_chans;
	214	s->maxdata = 0xffff;
	215	if (s->n_chan == 32) {
9ced1de6	216	const struct comedi_lrange **range_table_list;
3c5e1722	217
9ced1de6	218	range_table_list = kmalloc(sizeof(struct comedi_lrange ) 32,
0a85b6f0	219	GFP_KERNEL);
3c5e1722 BJ	220	if (!range_table_list)
	221	return -ENOMEM;
	222	s->range_table_list = range_table_list;
	223	for (i = 0; i < 16; i++) {
	224	range_table_list[i] = &range_bipolar10;
	225	range_table_list[16 + i] = &range_0_20mA;
	226	}
	227	} else {
	228	s->range_table = &range_bipolar10;
	229	}
	230	s->insn_write = &ni_670x_ao_winsn;
	231	s->insn_read = &ni_670x_ao_rinsn;
	232
	233	s = dev->subdevices + 1;
	234	/* digital i/o subdevice */
	235	s->type = COMEDI_SUBD_DIO;
	236	s->subdev_flags = SDF_READABLE \| SDF_WRITABLE;
	237	s->n_chan = 8;
	238	s->maxdata = 1;
	239	s->range_table = &range_digital;
	240	s->insn_bits = ni_670x_dio_insn_bits;
	241	s->insn_config = ni_670x_dio_insn_config;
	242
c733110a BA	243	/* Config of misc registers */
	244	writel(0x10, devpriv->mite->daq_io_addr + MISC_CONTROL_OFFSET);
	245	/* Config of ao registers */
	246	writel(0x00, devpriv->mite->daq_io_addr + AO_CONTROL_OFFSET);
3c5e1722	247
c733110a	248	printk(KERN_INFO "attached\n");
3c5e1722 BJ	249
	250	return 1;
	251	}
	252
484ecc95	253	static void ni_670x_detach(struct comedi_device *dev)
3c5e1722	254	{
c733110a	255	kfree(dev->subdevices[0].range_table_list);
3c5e1722 BJ	256	if (dev->private && devpriv->mite)
3c5e1722 BJ	257	mite_unsetup(devpriv->mite);
3c5e1722	258	if (dev->irq)
5f74ea14	259	free_irq(dev->irq, dev);
3c5e1722 BJ	260	}
3c5e1722 BJ	261
0a85b6f0 MT	262	static int ni_670x_ao_winsn(struct comedi_device *dev,
	263	struct comedi_subdevice *s,
	264	struct comedi_insn insn, unsigned int data)
3c5e1722 BJ	265	{
	266	int i;
	267	int chan = CR_CHAN(insn->chanspec);
	268
	269	/* Channel number mapping :
	270
	271	NI 6703/ NI 6704 \| NI 6704 Only
	272	----------------------------------------------------
	273	vch(0) : 0 \| ich(16) : 1
	274	vch(1) : 2 \| ich(17) : 3
	275	. : . \| . .
	276	. : . \| . .
	277	. : . \| . .
	278	vch(15) : 30 \| ich(31) : 31 */
	279
	280	for (i = 0; i < insn->n; i++) {
c733110a BA	281	/* First write in channel register which channel to use */
	282	writel(((chan & 15) << 1) \| ((chan & 16) >> 4),
	283	devpriv->mite->daq_io_addr + AO_CHAN_OFFSET);
	284	/* write channel value */
	285	writel(data[i], devpriv->mite->daq_io_addr + AO_VALUE_OFFSET);
3c5e1722 BJ	286	devpriv->ao_readback[chan] = data[i];
	287	}
	288
	289	return i;
	290	}
	291
0a85b6f0 MT	292	static int ni_670x_ao_rinsn(struct comedi_device *dev,
	293	struct comedi_subdevice *s,
	294	struct comedi_insn insn, unsigned int data)
3c5e1722 BJ	295	{
	296	int i;
	297	int chan = CR_CHAN(insn->chanspec);
	298
	299	for (i = 0; i < insn->n; i++)
	300	data[i] = devpriv->ao_readback[chan];
	301
	302	return i;
	303	}
	304
0a85b6f0 MT	305	static int ni_670x_dio_insn_bits(struct comedi_device *dev,
	306	struct comedi_subdevice *s,
	307	struct comedi_insn insn, unsigned int data)
3c5e1722	308	{
3c5e1722 BJ	309	/* The insn data is a mask in data[0] and the new data
	310	* in data[1], each channel cooresponding to a bit. */
	311	if (data[0]) {
	312	s->state &= ~data[0];
	313	s->state \|= data[0] & data[1];
	314	writel(s->state,
0a85b6f0	315	devpriv->mite->daq_io_addr + DIO_PORT0_DATA_OFFSET);
3c5e1722 BJ	316	}
	317
	318	/* on return, data[1] contains the value of the digital
	319	* input lines. */
	320	data[1] = readl(devpriv->mite->daq_io_addr + DIO_PORT0_DATA_OFFSET);
	321
a2714e3e	322	return insn->n;
3c5e1722 BJ	323	}
3c5e1722 BJ	324
0a85b6f0 MT	325	static int ni_670x_dio_insn_config(struct comedi_device *dev,
	326	struct comedi_subdevice *s,
	327	struct comedi_insn insn, unsigned int data)
3c5e1722 BJ	328	{
	329	int chan = CR_CHAN(insn->chanspec);
	330
	331	switch (data[0]) {
	332	case INSN_CONFIG_DIO_OUTPUT:
	333	s->io_bits \|= 1 << chan;
	334	break;
	335	case INSN_CONFIG_DIO_INPUT:
	336	s->io_bits &= ~(1 << chan);
	337	break;
	338	case INSN_CONFIG_DIO_QUERY:
	339	data[1] =
0a85b6f0	340	(s->io_bits & (1 << chan)) ? COMEDI_OUTPUT : COMEDI_INPUT;
3c5e1722 BJ	341	return insn->n;
	342	break;
	343	default:
	344	return -EINVAL;
	345	break;
	346	}
	347	writel(s->io_bits, devpriv->mite->daq_io_addr + DIO_PORT0_DIR_OFFSET);
	348
	349	return insn->n;
	350	}
	351
da91b269	352	static int ni_670x_find_device(struct comedi_device *dev, int bus, int slot)
3c5e1722 BJ	353	{
	354	struct mite_struct *mite;
	355	int i;
	356
	357	for (mite = mite_devices; mite; mite = mite->next) {
	358	if (mite->used)
	359	continue;
	360	if (bus \|\| slot) {
	361	if (bus != mite->pcidev->bus->number
0a85b6f0	362	\|\| slot != PCI_SLOT(mite->pcidev->devfn))
3c5e1722 BJ	363	continue;
	364	}
	365
	366	for (i = 0; i < n_ni_670x_boards; i++) {
	367	if (mite_device_id(mite) == ni_670x_boards[i].dev_id) {
	368	dev->board_ptr = ni_670x_boards + i;
	369	devpriv->mite = mite;
	370
	371	return 0;
	372	}
	373	}
	374	}
c733110a	375	printk(KERN_INFO "no device found\n");
3c5e1722 BJ	376	mite_list_devices();
	377	return -EIO;
	378	}
3c323c01 IA	379
	380	MODULE_AUTHOR("Comedi http://www.comedi.org");
	381	MODULE_DESCRIPTION("Comedi low-level driver");
	382	MODULE_LICENSE("GPL");