[deliverable/linux.git] / drivers / staging / comedi / drivers / mpc624.c

/*
    comedi/drivers/mpc624.c
    Hardware driver for a Micro/sys inc. MPC-624 PC/104 board

    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: mpc624
Description: Micro/sys MPC-624 PC/104 board
Devices: [Micro/sys] MPC-624 (mpc624)
Author: Stanislaw Raczynski <sraczynski@op.pl>
Updated: Thu, 15 Sep 2005 12:01:18 +0200
Status: working

    The Micro/sys MPC-624 board is based on the LTC2440 24-bit sigma-delta
    ADC chip.

    Subdevices supported by the driver:
    - Analog In:   supported
    - Digital I/O: not supported
    - LEDs:        not supported
    - EEPROM:      not supported

Configuration Options:
  [0] - I/O base address
  [1] - conversion rate
	Conversion rate  RMS noise  Effective Number Of Bits
	0      3.52kHz        23uV                17
	1      1.76kHz       3.5uV                20
	2       880Hz         2uV                21.3
	3       440Hz        1.4uV               21.8
	4       220Hz         1uV                22.4
	5       110Hz        750uV               22.9
	6       55Hz         510nV               23.4
	7      27.5Hz        375nV                24
	8      13.75Hz       250nV               24.4
	9      6.875Hz       200nV               24.6
  [2] - voltage range
	0      -1.01V .. +1.01V
	1      -10.1V .. +10.1V
*/

#include "../comedidev.h"

#include <linux/ioport.h>
#include <linux/delay.h>

/* Consecutive I/O port addresses */
#define MPC624_SIZE             16

/* Offsets of different ports */
#define MPC624_MASTER_CONTROL	0 /* not used */
#define MPC624_GNMUXCH          1 /* Gain, Mux, Channel of ADC */
#define MPC624_ADC              2 /* read/write to/from ADC */
#define MPC624_EE               3 /* read/write to/from serial EEPROM via I2C */
#define MPC624_LEDS             4 /* write to LEDs */
#define MPC624_DIO              5 /* read/write to/from digital I/O ports */
#define MPC624_IRQ_MASK         6 /* IRQ masking enable/disable */

/* Register bits' names */
#define MPC624_ADBUSY           (1<<5)
#define MPC624_ADSDO            (1<<4)
#define MPC624_ADFO             (1<<3)
#define MPC624_ADCS             (1<<2)
#define MPC624_ADSCK            (1<<1)
#define MPC624_ADSDI            (1<<0)

/* SDI Speed/Resolution Programming bits */
#define MPC624_OSR4             (1<<31)
#define MPC624_OSR3             (1<<30)
#define MPC624_OSR2             (1<<29)
#define MPC624_OSR1             (1<<28)
#define MPC624_OSR0             (1<<27)

/* 32-bit output value bits' names */
#define MPC624_EOC_BIT          (1<<31)
#define MPC624_DMY_BIT          (1<<30)
#define MPC624_SGN_BIT          (1<<29)

/* Conversion speeds */
/* OSR4 OSR3 OSR2 OSR1 OSR0  Conversion rate  RMS noise  ENOB^
 *  X    0    0    0    1        3.52kHz        23uV      17
 *  X    0    0    1    0        1.76kHz       3.5uV      20
 *  X    0    0    1    1         880Hz         2uV      21.3
 *  X    0    1    0    0         440Hz        1.4uV     21.8
 *  X    0    1    0    1         220Hz         1uV      22.4
 *  X    0    1    1    0         110Hz        750uV     22.9
 *  X    0    1    1    1          55Hz        510nV     23.4
 *  X    1    0    0    0         27.5Hz       375nV      24
 *  X    1    0    0    1        13.75Hz       250nV     24.4
 *  X    1    1    1    1        6.875Hz       200nV     24.6
 *
 * ^ - Effective Number Of Bits
 */

#define MPC624_SPEED_3_52_kHz (MPC624_OSR4 | MPC624_OSR0)
#define MPC624_SPEED_1_76_kHz (MPC624_OSR4 | MPC624_OSR1)
#define MPC624_SPEED_880_Hz   (MPC624_OSR4 | MPC624_OSR1 | MPC624_OSR0)
#define MPC624_SPEED_440_Hz   (MPC624_OSR4 | MPC624_OSR2)
#define MPC624_SPEED_220_Hz   (MPC624_OSR4 | MPC624_OSR2 | MPC624_OSR0)
#define MPC624_SPEED_110_Hz   (MPC624_OSR4 | MPC624_OSR2 | MPC624_OSR1)
#define MPC624_SPEED_55_Hz \
	(MPC624_OSR4 | MPC624_OSR2 | MPC624_OSR1 | MPC624_OSR0)
#define MPC624_SPEED_27_5_Hz  (MPC624_OSR4 | MPC624_OSR3)
#define MPC624_SPEED_13_75_Hz (MPC624_OSR4 | MPC624_OSR3 | MPC624_OSR0)
#define MPC624_SPEED_6_875_Hz \
	(MPC624_OSR4 | MPC624_OSR3 | MPC624_OSR2 | MPC624_OSR1 | MPC624_OSR0)
/* -------------------------------------------------------------------------- */
struct mpc624_private {

	/*  set by mpc624_attach() from driver's parameters */
	unsigned long int ulConvertionRate;
};

/* -------------------------------------------------------------------------- */
static const struct comedi_lrange range_mpc624_bipolar1 = {
	1,
	{
/* BIP_RANGE(1.01)  this is correct, */
	 /*  but my MPC-624 actually seems to have a range of 2.02 */
	 BIP_RANGE(2.02)
	 }
};

static const struct comedi_lrange range_mpc624_bipolar10 = {
	1,
	{
/* BIP_RANGE(10.1)   this is correct, */
	 /*  but my MPC-624 actually seems to have a range of 20.2 */
	 BIP_RANGE(20.2)
	 }
};

/* Timeout 200ms */
#define TIMEOUT 200

static int mpc624_ai_rinsn(struct comedi_device *dev,
			   struct comedi_subdevice *s, struct comedi_insn *insn,
			   unsigned int *data)
{
	struct mpc624_private *devpriv = dev->private;
	int n, i;
	unsigned long int data_in, data_out;
	unsigned char ucPort;

	/*
	 *  WARNING:
	 *  We always write 0 to GNSWA bit, so the channel range is +-/10.1Vdc
	 */
	outb(insn->chanspec, dev->iobase + MPC624_GNMUXCH);
/* printk("Channel %d:\n", insn->chanspec); */
	if (!insn->n) {
		printk(KERN_INFO "MPC624: Warning, no data to acquire\n");
		return 0;
	}

	for (n = 0; n < insn->n; n++) {
		/*  Trigger the conversion */
		outb(MPC624_ADSCK, dev->iobase + MPC624_ADC);
		udelay(1);
		outb(MPC624_ADCS | MPC624_ADSCK, dev->iobase + MPC624_ADC);
		udelay(1);
		outb(0, dev->iobase + MPC624_ADC);
		udelay(1);

		/*  Wait for the conversion to end */
		for (i = 0; i < TIMEOUT; i++) {
			ucPort = inb(dev->iobase + MPC624_ADC);
			if (ucPort & MPC624_ADBUSY)
				udelay(1000);
			else
				break;
		}
		if (i == TIMEOUT) {
			printk(KERN_ERR "MPC624: timeout (%dms)\n", TIMEOUT);
			data[n] = 0;
			return -ETIMEDOUT;
		}
		/*  Start reading data */
		data_in = 0;
		data_out = devpriv->ulConvertionRate;
		udelay(1);
		for (i = 0; i < 32; i++) {
			/*  Set the clock low */
			outb(0, dev->iobase + MPC624_ADC);
			udelay(1);

			if (data_out & (1 << 31)) { /*  the next bit is a 1 */
				/*  Set the ADSDI line (send to MPC624) */
				outb(MPC624_ADSDI, dev->iobase + MPC624_ADC);
				udelay(1);
				/*  Set the clock high */
				outb(MPC624_ADSCK | MPC624_ADSDI,
				     dev->iobase + MPC624_ADC);
			} else {	/*  the next bit is a 0 */

				/*  Set the ADSDI line (send to MPC624) */
				outb(0, dev->iobase + MPC624_ADC);
				udelay(1);
				/*  Set the clock high */
				outb(MPC624_ADSCK, dev->iobase + MPC624_ADC);
			}
			/*  Read ADSDO on high clock (receive from MPC624) */
			udelay(1);
			data_in <<= 1;
			data_in |=
			    (inb(dev->iobase + MPC624_ADC) & MPC624_ADSDO) >> 4;
			udelay(1);

			data_out <<= 1;
		}

		/*
		 *  Received 32-bit long value consist of:
		 *    31: EOC -
		 *          (End Of Transmission) bit - should be 0
		 *    30: DMY
		 *          (Dummy) bit - should be 0
		 *    29: SIG
		 *          (Sign) bit- 1 if the voltage is positive,
		 *                      0 if negative
		 *    28: MSB
		 *          (Most Significant Bit) - the first bit of
		 *                                   the conversion result
		 *    ....
		 *    05: LSB
		 *          (Least Significant Bit)- the last bit of the
		 *                                   conversion result
		 *    04-00: sub-LSB
		 *          - sub-LSBs are basically noise, but when
		 *            averaged properly, they can increase conversion
		 *            precision up to 29 bits; they can be discarded
		 *            without loss of resolution.
		 */

		if (data_in & MPC624_EOC_BIT)
			printk(KERN_INFO "MPC624:EOC bit is set (data_in=%lu)!",
			       data_in);
		if (data_in & MPC624_DMY_BIT)
			printk(KERN_INFO "MPC624:DMY bit is set (data_in=%lu)!",
			       data_in);
		if (data_in & MPC624_SGN_BIT) {	/* Volatge is positive */
			/*
			 * comedi operates on unsigned numbers, so mask off EOC
			 * and DMY and don't clear the SGN bit
			 */
			data_in &= 0x3FFFFFFF;
			data[n] = data_in;
		} else { /*  The voltage is negative */
			/*
			 * data_in contains a number in 30-bit two's complement
			 * code and we must deal with it
			 */
			data_in |= MPC624_SGN_BIT;
			data_in = ~data_in;
			data_in += 1;
			data_in &= ~(MPC624_EOC_BIT | MPC624_DMY_BIT);
			/*  clear EOC and DMY bits */
			data_in = 0x20000000 - data_in;
			data[n] = data_in;
		}
	}

	/*  Return the number of samples read/written */
	return n;
}

static int mpc624_attach(struct comedi_device *dev, struct comedi_devconfig *it)
{
	struct mpc624_private *devpriv;
	struct comedi_subdevice *s;
	unsigned long iobase;
	int ret;

	iobase = it->options[0];
	printk(KERN_INFO "comedi%d: mpc624 [0x%04lx, ", dev->minor, iobase);
	if (request_region(iobase, MPC624_SIZE, "mpc624") == NULL) {
		printk(KERN_ERR "I/O port(s) in use\n");
		return -EIO;
	}

	dev->iobase = iobase;
	dev->board_name = "mpc624";

	devpriv = kzalloc(sizeof(*devpriv), GFP_KERNEL);
	if (!devpriv)
		return -ENOMEM;
	dev->private = devpriv;

	switch (it->options[1]) {
	case 0:
		devpriv->ulConvertionRate = MPC624_SPEED_3_52_kHz;
		printk(KERN_INFO "3.52 kHz, ");
		break;
	case 1:
		devpriv->ulConvertionRate = MPC624_SPEED_1_76_kHz;
		printk(KERN_INFO "1.76 kHz, ");
		break;
	case 2:
		devpriv->ulConvertionRate = MPC624_SPEED_880_Hz;
		printk(KERN_INFO "880 Hz, ");
		break;
	case 3:
		devpriv->ulConvertionRate = MPC624_SPEED_440_Hz;
		printk(KERN_INFO "440 Hz, ");
		break;
	case 4:
		devpriv->ulConvertionRate = MPC624_SPEED_220_Hz;
		printk(KERN_INFO "220 Hz, ");
		break;
	case 5:
		devpriv->ulConvertionRate = MPC624_SPEED_110_Hz;
		printk(KERN_INFO "110 Hz, ");
		break;
	case 6:
		devpriv->ulConvertionRate = MPC624_SPEED_55_Hz;
		printk(KERN_INFO "55 Hz, ");
		break;
	case 7:
		devpriv->ulConvertionRate = MPC624_SPEED_27_5_Hz;
		printk(KERN_INFO "27.5 Hz, ");
		break;
	case 8:
		devpriv->ulConvertionRate = MPC624_SPEED_13_75_Hz;
		printk(KERN_INFO "13.75 Hz, ");
		break;
	case 9:
		devpriv->ulConvertionRate = MPC624_SPEED_6_875_Hz;
		printk(KERN_INFO "6.875 Hz, ");
		break;
	default:
		printk
		    (KERN_ERR "illegal conversion rate setting!"
			" Valid numbers are 0..9. Using 9 => 6.875 Hz, ");
		devpriv->ulConvertionRate = MPC624_SPEED_3_52_kHz;
	}

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

	s = &dev->subdevices[0];
	s->type = COMEDI_SUBD_AI;
	s->subdev_flags = SDF_READABLE | SDF_DIFF;
	s->n_chan = 8;
	switch (it->options[1]) {
	default:
		s->maxdata = 0x3FFFFFFF;
		printk(KERN_INFO "30 bit, ");
	}

	switch (it->options[1]) {
	case 0:
		s->range_table = &range_mpc624_bipolar1;
		printk(KERN_INFO "1.01V]: ");
		break;
	default:
		s->range_table = &range_mpc624_bipolar10;
		printk(KERN_INFO "10.1V]: ");
	}
	s->len_chanlist = 1;
	s->insn_read = mpc624_ai_rinsn;

	printk(KERN_INFO "attached\n");

	return 1;
}

static void mpc624_detach(struct comedi_device *dev)
{
	if (dev->iobase)
		release_region(dev->iobase, MPC624_SIZE);
}

static struct comedi_driver mpc624_driver = {
	.driver_name	= "mpc624",
	.module		= THIS_MODULE,
	.attach		= mpc624_attach,
	.detach		= mpc624_detach
};
module_comedi_driver(mpc624_driver);

MODULE_AUTHOR("Comedi http://www.comedi.org");
MODULE_DESCRIPTION("Comedi low-level driver");
MODULE_LICENSE("GPL");
Commit	Line	Data
90a5038d SR	1	/*
	2	comedi/drivers/mpc624.c
	3	Hardware driver for a Micro/sys inc. MPC-624 PC/104 board
	4
	5	COMEDI - Linux Control and Measurement Device Interface
	6	Copyright (C) 2000 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: mpc624
	25	Description: Micro/sys MPC-624 PC/104 board
	26	Devices: [Micro/sys] MPC-624 (mpc624)
	27	Author: Stanislaw Raczynski <sraczynski@op.pl>
	28	Updated: Thu, 15 Sep 2005 12:01:18 +0200
	29	Status: working
	30
	31	The Micro/sys MPC-624 board is based on the LTC2440 24-bit sigma-delta
	32	ADC chip.
	33
	34	Subdevices supported by the driver:
	35	- Analog In: supported
	36	- Digital I/O: not supported
	37	- LEDs: not supported
	38	- EEPROM: not supported
	39
	40	Configuration Options:
	41	[0] - I/O base address
25985edc LDM	42	[1] - conversion rate
25985edc LDM	43	Conversion rate RMS noise Effective Number Of Bits
b8c623e5 IC	44	0 3.52kHz 23uV 17
	45	1 1.76kHz 3.5uV 20
	46	2 880Hz 2uV 21.3
	47	3 440Hz 1.4uV 21.8
	48	4 220Hz 1uV 22.4
	49	5 110Hz 750uV 22.9
	50	6 55Hz 510nV 23.4
	51	7 27.5Hz 375nV 24
	52	8 13.75Hz 250nV 24.4
	53	9 6.875Hz 200nV 24.6
	54	[2] - voltage range
	55	0 -1.01V .. +1.01V
	56	1 -10.1V .. +10.1V
90a5038d SR	57	*/
	58
	59	#include "../comedidev.h"
	60
	61	#include <linux/ioport.h>
	62	#include <linux/delay.h>
	63
79a31bae	64	/* Consecutive I/O port addresses */
90a5038d SR	65	#define MPC624_SIZE 16
90a5038d SR	66
79a31bae	67	/* Offsets of different ports */
b8c623e5 IC	68	#define MPC624_MASTER_CONTROL 0 /* not used */
	69	#define MPC624_GNMUXCH 1 /* Gain, Mux, Channel of ADC */
	70	#define MPC624_ADC 2 /* read/write to/from ADC */
	71	#define MPC624_EE 3 /* read/write to/from serial EEPROM via I2C */
	72	#define MPC624_LEDS 4 /* write to LEDs */
	73	#define MPC624_DIO 5 /* read/write to/from digital I/O ports */
	74	#define MPC624_IRQ_MASK 6 /* IRQ masking enable/disable */
90a5038d	75
79a31bae	76	/* Register bits' names */
90a5038d SR	77	#define MPC624_ADBUSY (1<<5)
	78	#define MPC624_ADSDO (1<<4)
	79	#define MPC624_ADFO (1<<3)
	80	#define MPC624_ADCS (1<<2)
	81	#define MPC624_ADSCK (1<<1)
	82	#define MPC624_ADSDI (1<<0)
	83
79a31bae	84	/* SDI Speed/Resolution Programming bits */
90a5038d SR	85	#define MPC624_OSR4 (1<<31)
	86	#define MPC624_OSR3 (1<<30)
	87	#define MPC624_OSR2 (1<<29)
	88	#define MPC624_OSR1 (1<<28)
	89	#define MPC624_OSR0 (1<<27)
	90
79a31bae	91	/* 32-bit output value bits' names */
90a5038d SR	92	#define MPC624_EOC_BIT (1<<31)
	93	#define MPC624_DMY_BIT (1<<30)
	94	#define MPC624_SGN_BIT (1<<29)
	95
25985edc LDM	96	/* Conversion speeds */
25985edc LDM	97	/* OSR4 OSR3 OSR2 OSR1 OSR0 Conversion rate RMS noise ENOB^
90a5038d SR	98	* X 0 0 0 1 3.52kHz 23uV 17
	99	* X 0 0 1 0 1.76kHz 3.5uV 20
	100	* X 0 0 1 1 880Hz 2uV 21.3
	101	* X 0 1 0 0 440Hz 1.4uV 21.8
	102	* X 0 1 0 1 220Hz 1uV 22.4
	103	* X 0 1 1 0 110Hz 750uV 22.9
	104	* X 0 1 1 1 55Hz 510nV 23.4
	105	* X 1 0 0 0 27.5Hz 375nV 24
	106	* X 1 0 0 1 13.75Hz 250nV 24.4
	107	* X 1 1 1 1 6.875Hz 200nV 24.6
	108	*
	109	* ^ - Effective Number Of Bits
	110	*/
	111
b8c623e5 IC	112	#define MPC624_SPEED_3_52_kHz (MPC624_OSR4 \| MPC624_OSR0)
	113	#define MPC624_SPEED_1_76_kHz (MPC624_OSR4 \| MPC624_OSR1)
	114	#define MPC624_SPEED_880_Hz (MPC624_OSR4 \| MPC624_OSR1 \| MPC624_OSR0)
	115	#define MPC624_SPEED_440_Hz (MPC624_OSR4 \| MPC624_OSR2)
	116	#define MPC624_SPEED_220_Hz (MPC624_OSR4 \| MPC624_OSR2 \| MPC624_OSR0)
	117	#define MPC624_SPEED_110_Hz (MPC624_OSR4 \| MPC624_OSR2 \| MPC624_OSR1)
	118	#define MPC624_SPEED_55_Hz \
	119	(MPC624_OSR4 \| MPC624_OSR2 \| MPC624_OSR1 \| MPC624_OSR0)
	120	#define MPC624_SPEED_27_5_Hz (MPC624_OSR4 \| MPC624_OSR3)
	121	#define MPC624_SPEED_13_75_Hz (MPC624_OSR4 \| MPC624_OSR3 \| MPC624_OSR0)
	122	#define MPC624_SPEED_6_875_Hz \
	123	(MPC624_OSR4 \| MPC624_OSR3 \| MPC624_OSR2 \| MPC624_OSR1 \| MPC624_OSR0)
	124	/* -------------------------------------------------------------------------- */
9a1a6cf8	125	struct mpc624_private {
16450130	126
b8c623e5 IC	127	/* set by mpc624_attach() from driver's parameters */
b8c623e5 IC	128	unsigned long int ulConvertionRate;
16450130 BP	129	};
16450130 BP	130
b8c623e5	131	/* -------------------------------------------------------------------------- */
9ced1de6	132	static const struct comedi_lrange range_mpc624_bipolar1 = {
90a5038d SR	133	1,
90a5038d SR	134	{
79a31bae	135	/* BIP_RANGE(1.01) this is correct, */
0a85b6f0 MT	136	/* but my MPC-624 actually seems to have a range of 2.02 */
	137	BIP_RANGE(2.02)
	138	}
90a5038d	139	};
0a85b6f0	140
9ced1de6	141	static const struct comedi_lrange range_mpc624_bipolar10 = {
90a5038d SR	142	1,
90a5038d SR	143	{
79a31bae	144	/* BIP_RANGE(10.1) this is correct, */
0a85b6f0 MT	145	/* but my MPC-624 actually seems to have a range of 20.2 */
	146	BIP_RANGE(20.2)
	147	}
90a5038d SR	148	};
90a5038d SR	149
79a31bae	150	/* Timeout 200ms */
90a5038d SR	151	#define TIMEOUT 200
90a5038d SR	152
0a85b6f0 MT	153	static int mpc624_ai_rinsn(struct comedi_device *dev,
	154	struct comedi_subdevice s, struct comedi_insn insn,
	155	unsigned int *data)
90a5038d	156	{
9a1a6cf8	157	struct mpc624_private *devpriv = dev->private;
90a5038d SR	158	int n, i;
	159	unsigned long int data_in, data_out;
	160	unsigned char ucPort;
	161
b8c623e5 IC	162	/*
	163	* WARNING:
	164	* We always write 0 to GNSWA bit, so the channel range is +-/10.1Vdc
	165	*/
90a5038d	166	outb(insn->chanspec, dev->iobase + MPC624_GNMUXCH);
b8c623e5	167	/* printk("Channel %d:\n", insn->chanspec); */
90a5038d	168	if (!insn->n) {
b8c623e5	169	printk(KERN_INFO "MPC624: Warning, no data to acquire\n");
90a5038d SR	170	return 0;
	171	}
	172
	173	for (n = 0; n < insn->n; n++) {
25985edc	174	/* Trigger the conversion */
90a5038d	175	outb(MPC624_ADSCK, dev->iobase + MPC624_ADC);
5f74ea14	176	udelay(1);
90a5038d	177	outb(MPC624_ADCS \| MPC624_ADSCK, dev->iobase + MPC624_ADC);
5f74ea14	178	udelay(1);
90a5038d	179	outb(0, dev->iobase + MPC624_ADC);
5f74ea14	180	udelay(1);
90a5038d	181
25985edc	182	/* Wait for the conversion to end */
90a5038d SR	183	for (i = 0; i < TIMEOUT; i++) {
	184	ucPort = inb(dev->iobase + MPC624_ADC);
	185	if (ucPort & MPC624_ADBUSY)
5f74ea14	186	udelay(1000);
90a5038d SR	187	else
	188	break;
	189	}
	190	if (i == TIMEOUT) {
b8c623e5	191	printk(KERN_ERR "MPC624: timeout (%dms)\n", TIMEOUT);
90a5038d SR	192	data[n] = 0;
	193	return -ETIMEDOUT;
	194	}
79a31bae	195	/* Start reading data */
90a5038d SR	196	data_in = 0;
90a5038d SR	197	data_out = devpriv->ulConvertionRate;
5f74ea14	198	udelay(1);
90a5038d	199	for (i = 0; i < 32; i++) {
79a31bae	200	/* Set the clock low */
90a5038d	201	outb(0, dev->iobase + MPC624_ADC);
5f74ea14	202	udelay(1);
90a5038d	203
b8c623e5	204	if (data_out & (1 << 31)) { /* the next bit is a 1 */
79a31bae	205	/* Set the ADSDI line (send to MPC624) */
90a5038d	206	outb(MPC624_ADSDI, dev->iobase + MPC624_ADC);
5f74ea14	207	udelay(1);
79a31bae	208	/* Set the clock high */
90a5038d	209	outb(MPC624_ADSCK \| MPC624_ADSDI,
0a85b6f0 MT	210	dev->iobase + MPC624_ADC);
	211	} else { /* the next bit is a 0 */
	212
79a31bae	213	/* Set the ADSDI line (send to MPC624) */
90a5038d	214	outb(0, dev->iobase + MPC624_ADC);
5f74ea14	215	udelay(1);
79a31bae	216	/* Set the clock high */
90a5038d SR	217	outb(MPC624_ADSCK, dev->iobase + MPC624_ADC);
90a5038d SR	218	}
79a31bae	219	/* Read ADSDO on high clock (receive from MPC624) */
5f74ea14	220	udelay(1);
90a5038d SR	221	data_in <<= 1;
90a5038d SR	222	data_in \|=
0a85b6f0	223	(inb(dev->iobase + MPC624_ADC) & MPC624_ADSDO) >> 4;
5f74ea14	224	udelay(1);
90a5038d SR	225
	226	data_out <<= 1;
	227	}
	228
b8c623e5 IC	229	/*
	230	* Received 32-bit long value consist of:
	231	* 31: EOC -
	232	* (End Of Transmission) bit - should be 0
	233	* 30: DMY
	234	* (Dummy) bit - should be 0
	235	* 29: SIG
	236	* (Sign) bit- 1 if the voltage is positive,
	237	* 0 if negative
	238	* 28: MSB
	239	* (Most Significant Bit) - the first bit of
	240	* the conversion result
	241	* ....
	242	* 05: LSB
	243	* (Least Significant Bit)- the last bit of the
	244	* conversion result
	245	* 04-00: sub-LSB
	246	* - sub-LSBs are basically noise, but when
	247	* averaged properly, they can increase conversion
	248	* precision up to 29 bits; they can be discarded
	249	* without loss of resolution.
	250	*/
90a5038d SR	251
90a5038d SR	252	if (data_in & MPC624_EOC_BIT)
b8c623e5	253	printk(KERN_INFO "MPC624:EOC bit is set (data_in=%lu)!",
0a85b6f0	254	data_in);
90a5038d	255	if (data_in & MPC624_DMY_BIT)
b8c623e5	256	printk(KERN_INFO "MPC624:DMY bit is set (data_in=%lu)!",
0a85b6f0	257	data_in);
b8c623e5 IC	258	if (data_in & MPC624_SGN_BIT) { /* Volatge is positive */
	259	/*
	260	* comedi operates on unsigned numbers, so mask off EOC
	261	* and DMY and don't clear the SGN bit
	262	*/
	263	data_in &= 0x3FFFFFFF;
	264	data[n] = data_in;
	265	} else { /* The voltage is negative */
	266	/*
	267	* data_in contains a number in 30-bit two's complement
	268	* code and we must deal with it
	269	*/
90a5038d SR	270	data_in \|= MPC624_SGN_BIT;
	271	data_in = ~data_in;
	272	data_in += 1;
	273	data_in &= ~(MPC624_EOC_BIT \| MPC624_DMY_BIT);
79a31bae	274	/* clear EOC and DMY bits */
90a5038d SR	275	data_in = 0x20000000 - data_in;
	276	data[n] = data_in;
	277	}
	278	}
	279
79a31bae	280	/* Return the number of samples read/written */
90a5038d SR	281	return n;
	282	}
	283
9142e00e	284	static int mpc624_attach(struct comedi_device dev, struct comedi_devconfig it)
7114a280	285	{
9a1a6cf8	286	struct mpc624_private *devpriv;
9142e00e HS	287	struct comedi_subdevice *s;
9142e00e HS	288	unsigned long iobase;
8b6c5694	289	int ret;
9142e00e HS	290
	291	iobase = it->options[0];
	292	printk(KERN_INFO "comedi%d: mpc624 [0x%04lx, ", dev->minor, iobase);
	293	if (request_region(iobase, MPC624_SIZE, "mpc624") == NULL) {
	294	printk(KERN_ERR "I/O port(s) in use\n");
	295	return -EIO;
	296	}
	297
	298	dev->iobase = iobase;
	299	dev->board_name = "mpc624";
	300
c34fa261 HS	301	devpriv = kzalloc(sizeof(*devpriv), GFP_KERNEL);
	302	if (!devpriv)
	303	return -ENOMEM;
	304	dev->private = devpriv;
9142e00e HS	305
	306	switch (it->options[1]) {
	307	case 0:
	308	devpriv->ulConvertionRate = MPC624_SPEED_3_52_kHz;
	309	printk(KERN_INFO "3.52 kHz, ");
	310	break;
	311	case 1:
	312	devpriv->ulConvertionRate = MPC624_SPEED_1_76_kHz;
	313	printk(KERN_INFO "1.76 kHz, ");
	314	break;
	315	case 2:
	316	devpriv->ulConvertionRate = MPC624_SPEED_880_Hz;
	317	printk(KERN_INFO "880 Hz, ");
	318	break;
	319	case 3:
	320	devpriv->ulConvertionRate = MPC624_SPEED_440_Hz;
	321	printk(KERN_INFO "440 Hz, ");
	322	break;
	323	case 4:
	324	devpriv->ulConvertionRate = MPC624_SPEED_220_Hz;
	325	printk(KERN_INFO "220 Hz, ");
	326	break;
	327	case 5:
	328	devpriv->ulConvertionRate = MPC624_SPEED_110_Hz;
	329	printk(KERN_INFO "110 Hz, ");
	330	break;
	331	case 6:
	332	devpriv->ulConvertionRate = MPC624_SPEED_55_Hz;
	333	printk(KERN_INFO "55 Hz, ");
	334	break;
	335	case 7:
	336	devpriv->ulConvertionRate = MPC624_SPEED_27_5_Hz;
	337	printk(KERN_INFO "27.5 Hz, ");
	338	break;
	339	case 8:
	340	devpriv->ulConvertionRate = MPC624_SPEED_13_75_Hz;
	341	printk(KERN_INFO "13.75 Hz, ");
	342	break;
	343	case 9:
	344	devpriv->ulConvertionRate = MPC624_SPEED_6_875_Hz;
	345	printk(KERN_INFO "6.875 Hz, ");
	346	break;
	347	default:
	348	printk
	349	(KERN_ERR "illegal conversion rate setting!"
	350	" Valid numbers are 0..9. Using 9 => 6.875 Hz, ");
	351	devpriv->ulConvertionRate = MPC624_SPEED_3_52_kHz;
	352	}
	353
8b6c5694 HS	354	ret = comedi_alloc_subdevices(dev, 1);
	355	if (ret)
	356	return ret;
9142e00e	357
283fd0b2	358	s = &dev->subdevices[0];
9142e00e HS	359	s->type = COMEDI_SUBD_AI;
	360	s->subdev_flags = SDF_READABLE \| SDF_DIFF;
	361	s->n_chan = 8;
	362	switch (it->options[1]) {
	363	default:
	364	s->maxdata = 0x3FFFFFFF;
	365	printk(KERN_INFO "30 bit, ");
	366	}
	367
	368	switch (it->options[1]) {
	369	case 0:
	370	s->range_table = &range_mpc624_bipolar1;
	371	printk(KERN_INFO "1.01V]: ");
	372	break;
	373	default:
	374	s->range_table = &range_mpc624_bipolar10;
	375	printk(KERN_INFO "10.1V]: ");
	376	}
	377	s->len_chanlist = 1;
	378	s->insn_read = mpc624_ai_rinsn;
	379
	380	printk(KERN_INFO "attached\n");
	381
	382	return 1;
7114a280 AT	383	}
7114a280 AT	384
484ecc95	385	static void mpc624_detach(struct comedi_device *dev)
7114a280	386	{
9142e00e HS	387	if (dev->iobase)
9142e00e HS	388	release_region(dev->iobase, MPC624_SIZE);
7114a280 AT	389	}
7114a280 AT	390
9142e00e HS	391	static struct comedi_driver mpc624_driver = {
	392	.driver_name = "mpc624",
	393	.module = THIS_MODULE,
	394	.attach = mpc624_attach,
	395	.detach = mpc624_detach
	396	};
	397	module_comedi_driver(mpc624_driver);
90f703d3 AT	398
	399	MODULE_AUTHOR("Comedi http://www.comedi.org");
	400	MODULE_DESCRIPTION("Comedi low-level driver");
	401	MODULE_LICENSE("GPL");