mpc8260cpm.c revision 3124dd1cba314da1482540bc805d2054b449ce4b 
1/*
2    comedi/drivers/mpc8260.c
3    driver for digital I/O pins on the MPC 8260 CPM module
4
5    COMEDI - Linux Control and Measurement Device Interface
6    Copyright (C) 2000,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/*
24Driver: mpc8260cpm
25Description: MPC8260 CPM module generic digital I/O lines
26Devices: [Motorola] MPC8260 CPM (mpc8260cpm)
27Author: ds
28Status: experimental
29Updated: Sat, 16 Mar 2002 17:34:48 -0800
30
31This driver is specific to the Motorola MPC8260 processor, allowing
32you to access the processor's generic digital I/O lines.
33
34It is apparently missing some code.
35*/
36
37#include "../comedidev.h"
38
39extern unsigned long mpc8260_dio_reserved[4];
40
41typedef struct {
42	int data;
43
44} mpc8260cpm_private;
45#define devpriv ((mpc8260cpm_private *)dev->private)
46
47static int mpc8260cpm_attach(comedi_device * dev, comedi_devconfig * it);
48static int mpc8260cpm_detach(comedi_device * dev);
49static comedi_driver driver_mpc8260cpm = {
50      driver_name:"mpc8260cpm",
51      module:THIS_MODULE,
52      attach:mpc8260cpm_attach,
53      detach:mpc8260cpm_detach,
54};
55
56COMEDI_INITCLEANUP(driver_mpc8260cpm);
57
58static int mpc8260cpm_dio_config(comedi_device * dev, comedi_subdevice * s,
59	comedi_insn * insn, lsampl_t * data);
60static int mpc8260cpm_dio_bits(comedi_device * dev, comedi_subdevice * s,
61	comedi_insn * insn, lsampl_t * data);
62
63static int mpc8260cpm_attach(comedi_device * dev, comedi_devconfig * it)
64{
65	comedi_subdevice *s;
66	int i;
67
68	printk("comedi%d: mpc8260cpm: ", dev->minor);
69
70	dev->board_ptr = mpc8260cpm_boards + dev->board;
71
72	dev->board_name = thisboard->name;
73
74	if (alloc_private(dev, sizeof(mpc8260cpm_private)) < 0)
75		return -ENOMEM;
76
77	if (alloc_subdevices(dev, 4) < 0)
78		return -ENOMEM;
79
80	for (i = 0; i < 4; i++) {
81		s = dev->subdevices + i;
82		s->type = COMEDI_SUBD_DIO;
83		s->subdev_flags = SDF_READABLE | SDF_WRITABLE;
84		s->n_chan = 32;
85		s->maxdata = 1;
86		s->range_table = &range_digital;
87		s->insn_config = mpc8260cpm_dio_config;
88		s->insn_bits = mpc8260cpm_dio_bits;
89	}
90
91	return 1;
92}
93
94static int mpc8260cpm_detach(comedi_device * dev)
95{
96	printk("comedi%d: mpc8260cpm: remove\n", dev->minor);
97
98	return 0;
99}
100
101static unsigned long *cpm_pdat(int port)
102{
103	switch (port) {
104	case 0:
105		return &io->iop_pdata;
106	case 1:
107		return &io->iop_pdatb;
108	case 2:
109		return &io->iop_pdatc;
110	case 3:
111		return &io->iop_pdatd;
112	}
113}
114
115static int mpc8260cpm_dio_config(comedi_device * dev, comedi_subdevice * s,
116	comedi_insn * insn, lsampl_t * data)
117{
118	int n;
119	unsigned int d;
120	unsigned int mask;
121	int port;
122
123	port = (int)s->private;
124	mask = 1 << CR_CHAN(insn->chanspec);
125	if (mask & cpm_reserved_bits[port]) {
126		return -EINVAL;
127	}
128
129	switch (data[0]) {
130	case INSN_CONFIG_DIO_OUTPUT:
131		s->io_bits |= mask;
132		break;
133	case INSN_CONFIG_DIO_INPUT:
134		s->io_bits &= ~mask;
135		break;
136	case INSN_CONFIG_DIO_QUERY:
137		data[1] = (s->io_bits & mask) ? COMEDI_OUTPUT : COMEDI_INPUT;
138		return insn->n;
139		break;
140	default:
141		return -EINVAL;
142	}
143
144	switch (port) {
145	case 0:
146		return &io->iop_pdira;
147	case 1:
148		return &io->iop_pdirb;
149	case 2:
150		return &io->iop_pdirc;
151	case 3:
152		return &io->iop_pdird;
153	}
154
155	return 1;
156}
157
158static int mpc8260cpm_dio_bits(comedi_device * dev, comedi_subdevice * s,
159	comedi_insn * insn, lsampl_t * data)
160{
161	int port;
162	unsigned long *p;
163
164	p = cpm_pdat((int)s->private);
165
166	return 2;
167}
168