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#include <linux/kernel.h>
28#include <linux/module.h>
29#include <linux/init.h>
30#include <linux/parport.h>
31#include <linux/i2c.h>
32#include <linux/i2c-algo-bit.h>
33#include "i2c-parport.h"
34
35
36
37struct i2c_par {
38 struct pardevice *pdev;
39 struct i2c_adapter adapter;
40 struct i2c_algo_bit_data algo_data;
41 struct i2c_par *next;
42};
43
44static struct i2c_par *adapter_list;
45
46
47
48static void port_write_data(struct parport *p, unsigned char d)
49{
50 parport_write_data(p, d);
51}
52
53static void port_write_control(struct parport *p, unsigned char d)
54{
55 parport_write_control(p, d);
56}
57
58static unsigned char port_read_data(struct parport *p)
59{
60 return parport_read_data(p);
61}
62
63static unsigned char port_read_status(struct parport *p)
64{
65 return parport_read_status(p);
66}
67
68static unsigned char port_read_control(struct parport *p)
69{
70 return parport_read_control(p);
71}
72
73static void (*port_write[])(struct parport *, unsigned char) = {
74 port_write_data,
75 NULL,
76 port_write_control,
77};
78
79static unsigned char (*port_read[])(struct parport *) = {
80 port_read_data,
81 port_read_status,
82 port_read_control,
83};
84
85
86
87static inline void line_set(struct parport *data, int state,
88 const struct lineop *op)
89{
90 u8 oldval = port_read[op->port](data);
91
92
93 if ((op->inverted && !state) || (!op->inverted && state))
94 port_write[op->port](data, oldval | op->val);
95 else
96 port_write[op->port](data, oldval & ~op->val);
97}
98
99static inline int line_get(struct parport *data,
100 const struct lineop *op)
101{
102 u8 oldval = port_read[op->port](data);
103
104 return ((op->inverted && (oldval & op->val) != op->val)
105 || (!op->inverted && (oldval & op->val) == op->val));
106}
107
108
109
110static void parport_setscl(void *data, int state)
111{
112 line_set((struct parport *) data, state, &adapter_parm[type].setscl);
113}
114
115static void parport_setsda(void *data, int state)
116{
117 line_set((struct parport *) data, state, &adapter_parm[type].setsda);
118}
119
120static int parport_getscl(void *data)
121{
122 return line_get((struct parport *) data, &adapter_parm[type].getscl);
123}
124
125static int parport_getsda(void *data)
126{
127 return line_get((struct parport *) data, &adapter_parm[type].getsda);
128}
129
130
131
132
133
134
135static struct i2c_algo_bit_data parport_algo_data = {
136 .setsda = parport_setsda,
137 .setscl = parport_setscl,
138 .getsda = parport_getsda,
139 .getscl = parport_getscl,
140 .udelay = 10,
141 .timeout = HZ,
142};
143
144
145
146static void i2c_parport_attach (struct parport *port)
147{
148 struct i2c_par *adapter;
149
150 adapter = kzalloc(sizeof(struct i2c_par), GFP_KERNEL);
151 if (adapter == NULL) {
152 printk(KERN_ERR "i2c-parport: Failed to kzalloc\n");
153 return;
154 }
155
156 pr_debug("i2c-parport: attaching to %s\n", port->name);
157 adapter->pdev = parport_register_device(port, "i2c-parport",
158 NULL, NULL, NULL, PARPORT_FLAG_EXCL, NULL);
159 if (!adapter->pdev) {
160 printk(KERN_ERR "i2c-parport: Unable to register with parport\n");
161 goto ERROR0;
162 }
163
164
165 adapter->adapter.owner = THIS_MODULE;
166 adapter->adapter.class = I2C_CLASS_HWMON;
167 strlcpy(adapter->adapter.name, "Parallel port adapter",
168 sizeof(adapter->adapter.name));
169 adapter->algo_data = parport_algo_data;
170
171 if (!adapter_parm[type].getscl.val) {
172 adapter->algo_data.getscl = NULL;
173 adapter->algo_data.udelay = 50;
174 }
175 adapter->algo_data.data = port;
176 adapter->adapter.algo_data = &adapter->algo_data;
177 adapter->adapter.dev.parent = port->physport->dev;
178
179 if (parport_claim_or_block(adapter->pdev) < 0) {
180 printk(KERN_ERR "i2c-parport: Could not claim parallel port\n");
181 goto ERROR1;
182 }
183
184
185 parport_setsda(port, 1);
186 parport_setscl(port, 1);
187
188 if (adapter_parm[type].init.val)
189 line_set(port, 1, &adapter_parm[type].init);
190
191 if (i2c_bit_add_bus(&adapter->adapter) < 0) {
192 printk(KERN_ERR "i2c-parport: Unable to register with I2C\n");
193 goto ERROR1;
194 }
195
196
197 adapter->next = adapter_list;
198 adapter_list = adapter;
199 return;
200
201ERROR1:
202 parport_release(adapter->pdev);
203 parport_unregister_device(adapter->pdev);
204ERROR0:
205 kfree(adapter);
206}
207
208static void i2c_parport_detach (struct parport *port)
209{
210 struct i2c_par *adapter, *prev;
211
212
213 for (prev = NULL, adapter = adapter_list; adapter;
214 prev = adapter, adapter = adapter->next) {
215 if (adapter->pdev->port == port) {
216 i2c_del_adapter(&adapter->adapter);
217
218
219 if (adapter_parm[type].init.val)
220 line_set(port, 0, &adapter_parm[type].init);
221
222 parport_release(adapter->pdev);
223 parport_unregister_device(adapter->pdev);
224 if (prev)
225 prev->next = adapter->next;
226 else
227 adapter_list = adapter->next;
228 kfree(adapter);
229 return;
230 }
231 }
232}
233
234static struct parport_driver i2c_parport_driver = {
235 .name = "i2c-parport",
236 .attach = i2c_parport_attach,
237 .detach = i2c_parport_detach,
238};
239
240
241
242static int __init i2c_parport_init(void)
243{
244 if (type < 0) {
245 printk(KERN_WARNING "i2c-parport: adapter type unspecified\n");
246 return -ENODEV;
247 }
248
249 if (type >= ARRAY_SIZE(adapter_parm)) {
250 printk(KERN_WARNING "i2c-parport: invalid type (%d)\n", type);
251 return -ENODEV;
252 }
253
254 return parport_register_driver(&i2c_parport_driver);
255}
256
257static void __exit i2c_parport_exit(void)
258{
259 parport_unregister_driver(&i2c_parport_driver);
260}
261
262MODULE_AUTHOR("Jean Delvare <khali@linux-fr.org>");
263MODULE_DESCRIPTION("I2C bus over parallel port");
264MODULE_LICENSE("GPL");
265
266module_init(i2c_parport_init);
267module_exit(i2c_parport_exit);
268