aboutsummaryrefslogtreecommitdiff
path: root/drivers/staging/comedi/drivers/acl7225b.c
blob: 9e2c7aeea535844bfc464a7c1339e725f7d51a82 (plain)
1
2
3
4
5
6
7
8
9
10
11
12
13
14
15
16
17
18
19
20
21
22
23
24
25
26
27
28
29
30
31
32
33
34
35
36
37
38
39
40
41
42
43
44
45
46
47
48
49
50
51
52
53
54
55
56
57
58
59
60
61
62
63
64
65
66
67
68
69
70
71
72
73
74
75
76
77
78
79
80
81
82
83
84
85
86
87
88
89
90
91
92
93
94
95
96
97
98
99
100
101
102
103
104
105
106
107
108
109
110
111
112
113
114
115
116
117
118
119
120
121
122
123
124
125
126
127
128
129
130
131
132
133
134
135
136
/*
 * comedi/drivers/acl7225b.c
 * Driver for Adlink NuDAQ ACL-7225b and clones
 * José Luis Sánchez
 */
/*
Driver: acl7225b
Description: Adlink NuDAQ ACL-7225b & compatibles
Author: José Luis Sánchez (jsanchezv@teleline.es)
Status: testing
Devices: [Adlink] ACL-7225b (acl7225b), [ICP] P16R16DIO (p16r16dio)
*/

#include "../comedidev.h"

#include <linux/ioport.h>

#define ACL7225_RIO_LO 0	/* Relays input/output low byte (R0-R7) */
#define ACL7225_RIO_HI 1	/* Relays input/output high byte (R8-R15) */
#define ACL7225_DI_LO  2	/* Digital input low byte (DI0-DI7) */
#define ACL7225_DI_HI  3	/* Digital input high byte (DI8-DI15) */

struct acl7225b_boardinfo {
	const char *name;
	int io_range;
};

static const struct acl7225b_boardinfo acl7225b_boards[] = {
	{
		.name		= "acl7225b",
		.io_range	= 8,		/* only 4 are used */
	}, {
		.name		= "p16r16dio",
		.io_range	= 4,
	},
};

static int acl7225b_do_insn_bits(struct comedi_device *dev,
				 struct comedi_subdevice *s,
				 struct comedi_insn *insn,
				 unsigned int *data)
{
	unsigned long reg = (unsigned long)s->private;
	unsigned int mask = data[0];
	unsigned int bits = data[1];

	if (mask) {
		s->state &= ~mask;
		s->state |= (bits & mask);

		if (mask & 0x00ff)
			outb(s->state & 0xff, dev->iobase + reg);
		if (mask & 0xff00)
			outb((s->state >> 8), dev->iobase + reg + 1);
	}

	data[1] = s->state;

	return insn->n;
}

static int acl7225b_di_insn_bits(struct comedi_device *dev,
				 struct comedi_subdevice *s,
				 struct comedi_insn *insn,
				 unsigned int *data)
{
	unsigned long reg = (unsigned long)s->private;

	data[1] = inb(dev->iobase + reg) |
		  (inb(dev->iobase + reg + 1) << 8);

	return insn->n;
}

static int acl7225b_attach(struct comedi_device *dev,
			   struct comedi_devconfig *it)
{
	const struct acl7225b_boardinfo *board = comedi_board(dev);
	struct comedi_subdevice *s;
	int ret;

	ret = comedi_request_region(dev, it->options[0], board->io_range);
	if (ret)
		return ret;

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

	s = &dev->subdevices[0];
	/* Relays outputs */
	s->type		= COMEDI_SUBD_DO;
	s->subdev_flags	= SDF_WRITABLE;
	s->maxdata	= 1;
	s->n_chan	= 16;
	s->insn_bits	= acl7225b_do_insn_bits;
	s->range_table	= &range_digital;
	s->private	= (void *)ACL7225_RIO_LO;

	s = &dev->subdevices[1];
	/* Relays status */
	s->type		= COMEDI_SUBD_DI;
	s->subdev_flags	= SDF_READABLE;
	s->maxdata	= 1;
	s->n_chan	= 16;
	s->insn_bits	= acl7225b_di_insn_bits;
	s->range_table	= &range_digital;
	s->private	= (void *)ACL7225_RIO_LO;

	s = &dev->subdevices[2];
	/* Isolated digital inputs */
	s->type		= COMEDI_SUBD_DI;
	s->subdev_flags	= SDF_READABLE;
	s->maxdata	= 1;
	s->n_chan	= 16;
	s->insn_bits	= acl7225b_di_insn_bits;
	s->range_table	= &range_digital;
	s->private	= (void *)ACL7225_DI_LO;

	return 0;
}

static struct comedi_driver acl7225b_driver = {
	.driver_name	= "acl7225b",
	.module		= THIS_MODULE,
	.attach		= acl7225b_attach,
	.detach		= comedi_legacy_detach,
	.board_name	= &acl7225b_boards[0].name,
	.num_names	= ARRAY_SIZE(acl7225b_boards),
	.offset		= sizeof(struct acl7225b_boardinfo),
};
module_comedi_driver(acl7225b_driver);

MODULE_DESCRIPTION("Comedi: NuDAQ ACL-7225B, 16 Relay & 16 Isolated DI Card");
MODULE_AUTHOR("Comedi http://www.comedi.org");
MODULE_LICENSE("GPL");