1
2
3
4
5
6
7
8
9
10
11
12
13
14
15
16
17#include <linux/kernel.h>
18#include <linux/errno.h>
19#include <linux/slab.h>
20#include <linux/module.h>
21#include <linux/usb.h>
22
23#define DRIVER_VERSION "v1.0"
24#define DRIVER_AUTHOR "Erik Rigtorp"
25#define DRIVER_DESC "Cypress USB Thermometer driver"
26
27#define USB_SKEL_VENDOR_ID 0x04b4
28#define USB_SKEL_PRODUCT_ID 0x0002
29
30static const struct usb_device_id id_table[] = {
31 { USB_DEVICE(USB_SKEL_VENDOR_ID, USB_SKEL_PRODUCT_ID) },
32 { }
33};
34MODULE_DEVICE_TABLE (usb, id_table);
35
36
37struct usb_cytherm {
38 struct usb_device *udev;
39 struct usb_interface *interface;
40 int brightness;
41};
42
43
44
45static int cytherm_probe(struct usb_interface *interface,
46 const struct usb_device_id *id);
47static void cytherm_disconnect(struct usb_interface *interface);
48
49
50
51static struct usb_driver cytherm_driver = {
52 .name = "cytherm",
53 .probe = cytherm_probe,
54 .disconnect = cytherm_disconnect,
55 .id_table = id_table,
56};
57
58
59
60#define PING 0x00
61#define READ_ROM 0x01
62#define READ_RAM 0x02
63#define WRITE_RAM 0x03
64#define READ_PORT 0x04
65#define WRITE_PORT 0x05
66
67
68
69static int vendor_command(struct usb_device *dev, unsigned char request,
70 unsigned char value, unsigned char index,
71 void *buf, int size)
72{
73 return usb_control_msg(dev, usb_rcvctrlpipe(dev, 0),
74 request,
75 USB_DIR_IN | USB_TYPE_VENDOR | USB_RECIP_OTHER,
76 value,
77 index, buf, size,
78 USB_CTRL_GET_TIMEOUT);
79}
80
81
82
83#define BRIGHTNESS 0x2c
84#define BRIGHTNESS_SEM 0x2b
85
86static ssize_t show_brightness(struct device *dev, struct device_attribute *attr, char *buf)
87{
88 struct usb_interface *intf = to_usb_interface(dev);
89 struct usb_cytherm *cytherm = usb_get_intfdata(intf);
90
91 return sprintf(buf, "%i", cytherm->brightness);
92}
93
94static ssize_t set_brightness(struct device *dev, struct device_attribute *attr, const char *buf,
95 size_t count)
96{
97 struct usb_interface *intf = to_usb_interface(dev);
98 struct usb_cytherm *cytherm = usb_get_intfdata(intf);
99
100 unsigned char *buffer;
101 int retval;
102
103 buffer = kmalloc(8, GFP_KERNEL);
104 if (!buffer) {
105 dev_err(&cytherm->udev->dev, "out of memory\n");
106 return 0;
107 }
108
109 cytherm->brightness = simple_strtoul(buf, NULL, 10);
110
111 if (cytherm->brightness > 0xFF)
112 cytherm->brightness = 0xFF;
113 else if (cytherm->brightness < 0)
114 cytherm->brightness = 0;
115
116
117 retval = vendor_command(cytherm->udev, WRITE_RAM, BRIGHTNESS,
118 cytherm->brightness, buffer, 8);
119 if (retval)
120 dev_dbg(&cytherm->udev->dev, "retval = %d\n", retval);
121
122 retval = vendor_command(cytherm->udev, WRITE_RAM, BRIGHTNESS_SEM,
123 0x01, buffer, 8);
124 if (retval)
125 dev_dbg(&cytherm->udev->dev, "retval = %d\n", retval);
126
127 kfree(buffer);
128
129 return count;
130}
131
132static DEVICE_ATTR(brightness, S_IRUGO | S_IWUSR | S_IWGRP,
133 show_brightness, set_brightness);
134
135
136#define TEMP 0x33
137#define SIGN 0x34
138
139static ssize_t show_temp(struct device *dev, struct device_attribute *attr, char *buf)
140{
141
142 struct usb_interface *intf = to_usb_interface(dev);
143 struct usb_cytherm *cytherm = usb_get_intfdata(intf);
144
145 int retval;
146 unsigned char *buffer;
147
148 int temp, sign;
149
150 buffer = kmalloc(8, GFP_KERNEL);
151 if (!buffer) {
152 dev_err(&cytherm->udev->dev, "out of memory\n");
153 return 0;
154 }
155
156
157 retval = vendor_command(cytherm->udev, READ_RAM, TEMP, 0, buffer, 8);
158 if (retval)
159 dev_dbg(&cytherm->udev->dev, "retval = %d\n", retval);
160 temp = buffer[1];
161
162
163 retval = vendor_command(cytherm->udev, READ_RAM, SIGN, 0, buffer, 8);
164 if (retval)
165 dev_dbg(&cytherm->udev->dev, "retval = %d\n", retval);
166 sign = buffer[1];
167
168 kfree(buffer);
169
170 return sprintf(buf, "%c%i.%i", sign ? '-' : '+', temp >> 1,
171 5*(temp - ((temp >> 1) << 1)));
172}
173
174
175static ssize_t set_temp(struct device *dev, struct device_attribute *attr, const char *buf, size_t count)
176{
177 return count;
178}
179
180static DEVICE_ATTR(temp, S_IRUGO, show_temp, set_temp);
181
182
183#define BUTTON 0x7a
184
185static ssize_t show_button(struct device *dev, struct device_attribute *attr, char *buf)
186{
187
188 struct usb_interface *intf = to_usb_interface(dev);
189 struct usb_cytherm *cytherm = usb_get_intfdata(intf);
190
191 int retval;
192 unsigned char *buffer;
193
194 buffer = kmalloc(8, GFP_KERNEL);
195 if (!buffer) {
196 dev_err(&cytherm->udev->dev, "out of memory\n");
197 return 0;
198 }
199
200
201 retval = vendor_command(cytherm->udev, READ_RAM, BUTTON, 0, buffer, 8);
202 if (retval)
203 dev_dbg(&cytherm->udev->dev, "retval = %d\n", retval);
204
205 retval = buffer[1];
206
207 kfree(buffer);
208
209 if (retval)
210 return sprintf(buf, "1");
211 else
212 return sprintf(buf, "0");
213}
214
215
216static ssize_t set_button(struct device *dev, struct device_attribute *attr, const char *buf, size_t count)
217{
218 return count;
219}
220
221static DEVICE_ATTR(button, S_IRUGO, show_button, set_button);
222
223
224static ssize_t show_port0(struct device *dev, struct device_attribute *attr, char *buf)
225{
226 struct usb_interface *intf = to_usb_interface(dev);
227 struct usb_cytherm *cytherm = usb_get_intfdata(intf);
228
229 int retval;
230 unsigned char *buffer;
231
232 buffer = kmalloc(8, GFP_KERNEL);
233 if (!buffer) {
234 dev_err(&cytherm->udev->dev, "out of memory\n");
235 return 0;
236 }
237
238 retval = vendor_command(cytherm->udev, READ_PORT, 0, 0, buffer, 8);
239 if (retval)
240 dev_dbg(&cytherm->udev->dev, "retval = %d\n", retval);
241
242 retval = buffer[1];
243
244 kfree(buffer);
245
246 return sprintf(buf, "%d", retval);
247}
248
249
250static ssize_t set_port0(struct device *dev, struct device_attribute *attr, const char *buf, size_t count)
251{
252 struct usb_interface *intf = to_usb_interface(dev);
253 struct usb_cytherm *cytherm = usb_get_intfdata(intf);
254
255 unsigned char *buffer;
256 int retval;
257 int tmp;
258
259 buffer = kmalloc(8, GFP_KERNEL);
260 if (!buffer) {
261 dev_err(&cytherm->udev->dev, "out of memory\n");
262 return 0;
263 }
264
265 tmp = simple_strtoul(buf, NULL, 10);
266
267 if (tmp > 0xFF)
268 tmp = 0xFF;
269 else if (tmp < 0)
270 tmp = 0;
271
272 retval = vendor_command(cytherm->udev, WRITE_PORT, 0,
273 tmp, buffer, 8);
274 if (retval)
275 dev_dbg(&cytherm->udev->dev, "retval = %d\n", retval);
276
277 kfree(buffer);
278
279 return count;
280}
281
282static DEVICE_ATTR(port0, S_IRUGO | S_IWUSR | S_IWGRP, show_port0, set_port0);
283
284static ssize_t show_port1(struct device *dev, struct device_attribute *attr, char *buf)
285{
286 struct usb_interface *intf = to_usb_interface(dev);
287 struct usb_cytherm *cytherm = usb_get_intfdata(intf);
288
289 int retval;
290 unsigned char *buffer;
291
292 buffer = kmalloc(8, GFP_KERNEL);
293 if (!buffer) {
294 dev_err(&cytherm->udev->dev, "out of memory\n");
295 return 0;
296 }
297
298 retval = vendor_command(cytherm->udev, READ_PORT, 1, 0, buffer, 8);
299 if (retval)
300 dev_dbg(&cytherm->udev->dev, "retval = %d\n", retval);
301
302 retval = buffer[1];
303
304 kfree(buffer);
305
306 return sprintf(buf, "%d", retval);
307}
308
309
310static ssize_t set_port1(struct device *dev, struct device_attribute *attr, const char *buf, size_t count)
311{
312 struct usb_interface *intf = to_usb_interface(dev);
313 struct usb_cytherm *cytherm = usb_get_intfdata(intf);
314
315 unsigned char *buffer;
316 int retval;
317 int tmp;
318
319 buffer = kmalloc(8, GFP_KERNEL);
320 if (!buffer) {
321 dev_err(&cytherm->udev->dev, "out of memory\n");
322 return 0;
323 }
324
325 tmp = simple_strtoul(buf, NULL, 10);
326
327 if (tmp > 0xFF)
328 tmp = 0xFF;
329 else if (tmp < 0)
330 tmp = 0;
331
332 retval = vendor_command(cytherm->udev, WRITE_PORT, 1,
333 tmp, buffer, 8);
334 if (retval)
335 dev_dbg(&cytherm->udev->dev, "retval = %d\n", retval);
336
337 kfree(buffer);
338
339 return count;
340}
341
342static DEVICE_ATTR(port1, S_IRUGO | S_IWUSR | S_IWGRP, show_port1, set_port1);
343
344
345
346static int cytherm_probe(struct usb_interface *interface,
347 const struct usb_device_id *id)
348{
349 struct usb_device *udev = interface_to_usbdev(interface);
350 struct usb_cytherm *dev = NULL;
351 int retval = -ENOMEM;
352
353 dev = kzalloc (sizeof(struct usb_cytherm), GFP_KERNEL);
354 if (dev == NULL) {
355 dev_err (&interface->dev, "Out of memory\n");
356 goto error_mem;
357 }
358
359 dev->udev = usb_get_dev(udev);
360
361 usb_set_intfdata (interface, dev);
362
363 dev->brightness = 0xFF;
364
365 retval = device_create_file(&interface->dev, &dev_attr_brightness);
366 if (retval)
367 goto error;
368 retval = device_create_file(&interface->dev, &dev_attr_temp);
369 if (retval)
370 goto error;
371 retval = device_create_file(&interface->dev, &dev_attr_button);
372 if (retval)
373 goto error;
374 retval = device_create_file(&interface->dev, &dev_attr_port0);
375 if (retval)
376 goto error;
377 retval = device_create_file(&interface->dev, &dev_attr_port1);
378 if (retval)
379 goto error;
380
381 dev_info (&interface->dev,
382 "Cypress thermometer device now attached\n");
383 return 0;
384error:
385 device_remove_file(&interface->dev, &dev_attr_brightness);
386 device_remove_file(&interface->dev, &dev_attr_temp);
387 device_remove_file(&interface->dev, &dev_attr_button);
388 device_remove_file(&interface->dev, &dev_attr_port0);
389 device_remove_file(&interface->dev, &dev_attr_port1);
390 usb_set_intfdata (interface, NULL);
391 usb_put_dev(dev->udev);
392 kfree(dev);
393error_mem:
394 return retval;
395}
396
397static void cytherm_disconnect(struct usb_interface *interface)
398{
399 struct usb_cytherm *dev;
400
401 dev = usb_get_intfdata (interface);
402
403 device_remove_file(&interface->dev, &dev_attr_brightness);
404 device_remove_file(&interface->dev, &dev_attr_temp);
405 device_remove_file(&interface->dev, &dev_attr_button);
406 device_remove_file(&interface->dev, &dev_attr_port0);
407 device_remove_file(&interface->dev, &dev_attr_port1);
408
409
410 usb_set_intfdata (interface, NULL);
411
412 usb_put_dev(dev->udev);
413
414 kfree(dev);
415
416 dev_info(&interface->dev, "Cypress thermometer now disconnected\n");
417}
418
419module_usb_driver(cytherm_driver);
420
421MODULE_AUTHOR(DRIVER_AUTHOR);
422MODULE_DESCRIPTION(DRIVER_DESC);
423MODULE_LICENSE("GPL");
424
