Commit | Line | Data |
---|---|---|
f01312d8 LP |
1 | /* |
2 | * Nano River Technologies viperboard driver | |
3 | * | |
4 | * This is the core driver for the viperboard. There are cell drivers | |
5 | * available for I2C, ADC and both GPIOs. SPI is not yet supported. | |
6 | * The drivers do not support all features the board exposes. See user | |
7 | * manual of the viperboard. | |
8 | * | |
9 | * (C) 2012 by Lemonage GmbH | |
10 | * Author: Lars Poeschel <poeschel@lemonage.de> | |
11 | * All rights reserved. | |
12 | * | |
13 | * This program is free software; you can redistribute it and/or modify it | |
14 | * under the terms of the GNU General Public License as published by the | |
15 | * Free Software Foundation; either version 2 of the License, or (at your | |
16 | * option) any later version. | |
17 | * | |
18 | */ | |
19 | ||
20 | #include <linux/kernel.h> | |
21 | #include <linux/errno.h> | |
22 | #include <linux/module.h> | |
23 | #include <linux/slab.h> | |
24 | #include <linux/types.h> | |
25 | #include <linux/mutex.h> | |
26 | ||
27 | #include <linux/mfd/core.h> | |
28 | #include <linux/mfd/viperboard.h> | |
29 | ||
30 | #include <linux/usb.h> | |
31 | ||
32 | ||
33 | static const struct usb_device_id vprbrd_table[] = { | |
34 | { USB_DEVICE(0x2058, 0x1005) }, /* Nano River Technologies */ | |
35 | { } /* Terminating entry */ | |
36 | }; | |
37 | ||
38 | MODULE_DEVICE_TABLE(usb, vprbrd_table); | |
39 | ||
40 | static struct mfd_cell vprbrd_devs[] = { | |
9d5b72de LP |
41 | { |
42 | .name = "viperboard-gpio", | |
43 | }, | |
f01312d8 LP |
44 | }; |
45 | ||
46 | static int vprbrd_probe(struct usb_interface *interface, | |
47 | const struct usb_device_id *id) | |
48 | { | |
49 | struct vprbrd *vb; | |
50 | ||
51 | u16 version = 0; | |
52 | int pipe, ret; | |
53 | unsigned char buf[1]; | |
54 | ||
55 | /* allocate memory for our device state and initialize it */ | |
56 | vb = kzalloc(sizeof(*vb), GFP_KERNEL); | |
57 | if (vb == NULL) { | |
58 | dev_err(&interface->dev, "Out of memory\n"); | |
59 | return -ENOMEM; | |
60 | } | |
61 | ||
62 | mutex_init(&vb->lock); | |
63 | ||
64 | vb->usb_dev = usb_get_dev(interface_to_usbdev(interface)); | |
65 | ||
66 | /* save our data pointer in this interface device */ | |
67 | usb_set_intfdata(interface, vb); | |
68 | dev_set_drvdata(&vb->pdev.dev, vb); | |
69 | ||
70 | /* get version information, major first, minor then */ | |
71 | pipe = usb_rcvctrlpipe(vb->usb_dev, 0); | |
72 | ret = usb_control_msg(vb->usb_dev, pipe, VPRBRD_USB_REQUEST_MAJOR, | |
73 | VPRBRD_USB_TYPE_IN, 0x0000, 0x0000, buf, 1, | |
74 | VPRBRD_USB_TIMEOUT_MS); | |
75 | if (ret == 1) | |
76 | version = buf[0]; | |
77 | ||
78 | ret = usb_control_msg(vb->usb_dev, pipe, VPRBRD_USB_REQUEST_MINOR, | |
79 | VPRBRD_USB_TYPE_IN, 0x0000, 0x0000, buf, 1, | |
80 | VPRBRD_USB_TIMEOUT_MS); | |
81 | if (ret == 1) { | |
82 | version <<= 8; | |
83 | version = version | buf[0]; | |
84 | } | |
85 | ||
86 | dev_info(&interface->dev, | |
87 | "version %x.%02x found at bus %03d address %03d\n", | |
88 | version >> 8, version & 0xff, | |
89 | vb->usb_dev->bus->busnum, vb->usb_dev->devnum); | |
90 | ||
91 | ret = mfd_add_devices(&interface->dev, -1, vprbrd_devs, | |
92 | ARRAY_SIZE(vprbrd_devs), NULL, 0, NULL); | |
93 | if (ret != 0) { | |
94 | dev_err(&interface->dev, "Failed to add mfd devices to core."); | |
95 | goto error; | |
96 | } | |
97 | ||
98 | return 0; | |
99 | ||
100 | error: | |
101 | if (vb) { | |
102 | usb_put_dev(vb->usb_dev); | |
103 | kfree(vb); | |
104 | } | |
105 | ||
106 | return ret; | |
107 | } | |
108 | ||
109 | static void vprbrd_disconnect(struct usb_interface *interface) | |
110 | { | |
111 | struct vprbrd *vb = usb_get_intfdata(interface); | |
112 | ||
113 | mfd_remove_devices(&interface->dev); | |
114 | usb_set_intfdata(interface, NULL); | |
115 | usb_put_dev(vb->usb_dev); | |
116 | kfree(vb); | |
117 | ||
118 | dev_dbg(&interface->dev, "disconnected\n"); | |
119 | } | |
120 | ||
121 | static struct usb_driver vprbrd_driver = { | |
122 | .name = "viperboard", | |
123 | .probe = vprbrd_probe, | |
124 | .disconnect = vprbrd_disconnect, | |
125 | .id_table = vprbrd_table, | |
126 | }; | |
127 | ||
128 | module_usb_driver(vprbrd_driver); | |
129 | ||
130 | MODULE_DESCRIPTION("Nano River Technologies viperboard mfd core driver"); | |
131 | MODULE_AUTHOR("Lars Poeschel <poeschel@lemonage.de>"); | |
132 | MODULE_LICENSE("GPL"); |