2 * Nano River Technologies viperboard GPIO lib driver
4 * (C) 2012 by Lemonage GmbH
5 * Author: Lars Poeschel <poeschel@lemonage.de>
8 * This program is free software; you can redistribute it and/or modify it
9 * under the terms of the GNU General Public License as published by the
10 * Free Software Foundation; either version 2 of the License, or (at your
11 * option) any later version.
15 #include <linux/kernel.h>
16 #include <linux/errno.h>
17 #include <linux/module.h>
18 #include <linux/slab.h>
19 #include <linux/types.h>
20 #include <linux/mutex.h>
21 #include <linux/platform_device.h>
23 #include <linux/usb.h>
24 #include <linux/gpio.h>
26 #include <linux/mfd/viperboard.h>
28 #define VPRBRD_GPIOA_CLK_1MHZ 0
29 #define VPRBRD_GPIOA_CLK_100KHZ 1
30 #define VPRBRD_GPIOA_CLK_10KHZ 2
31 #define VPRBRD_GPIOA_CLK_1KHZ 3
32 #define VPRBRD_GPIOA_CLK_100HZ 4
33 #define VPRBRD_GPIOA_CLK_10HZ 5
35 #define VPRBRD_GPIOA_FREQ_DEFAULT 1000
37 #define VPRBRD_GPIOA_CMD_CONT 0x00
38 #define VPRBRD_GPIOA_CMD_PULSE 0x01
39 #define VPRBRD_GPIOA_CMD_PWM 0x02
40 #define VPRBRD_GPIOA_CMD_SETOUT 0x03
41 #define VPRBRD_GPIOA_CMD_SETIN 0x04
42 #define VPRBRD_GPIOA_CMD_SETINT 0x05
43 #define VPRBRD_GPIOA_CMD_GETIN 0x06
45 #define VPRBRD_GPIOB_CMD_SETDIR 0x00
46 #define VPRBRD_GPIOB_CMD_SETVAL 0x01
48 struct vprbrd_gpioa_msg
{
62 struct vprbrd_gpiob_msg
{
69 struct gpio_chip gpioa
; /* gpio a related things */
72 struct gpio_chip gpiob
; /* gpio b related things */
78 /* gpioa sampling clock module parameter */
79 static unsigned char gpioa_clk
;
80 static unsigned int gpioa_freq
= VPRBRD_GPIOA_FREQ_DEFAULT
;
81 module_param(gpioa_freq
, uint
, 0);
82 MODULE_PARM_DESC(gpioa_freq
,
83 "gpio-a sampling freq in Hz (default is 1000Hz) valid values: 10, 100, 1000, 10000, 100000, 1000000");
85 /* ----- begin of gipo a chip -------------------------------------------- */
87 static int vprbrd_gpioa_get(struct gpio_chip
*chip
,
90 int ret
, answer
, error
= 0;
91 struct vprbrd_gpio
*gpio
=
92 container_of(chip
, struct vprbrd_gpio
, gpioa
);
93 struct vprbrd
*vb
= gpio
->vb
;
94 struct vprbrd_gpioa_msg
*gamsg
= (struct vprbrd_gpioa_msg
*)vb
->buf
;
96 /* if io is set to output, just return the saved value */
97 if (gpio
->gpioa_out
& (1 << offset
))
98 return gpio
->gpioa_val
& (1 << offset
);
100 mutex_lock(&vb
->lock
);
102 gamsg
->cmd
= VPRBRD_GPIOA_CMD_GETIN
;
104 gamsg
->offset
= offset
;
107 gamsg
->invert
= 0x00;
108 gamsg
->pwmlevel
= 0x00;
109 gamsg
->outval
= 0x00;
110 gamsg
->risefall
= 0x00;
111 gamsg
->answer
= 0x00;
112 gamsg
->__fill
= 0x00;
114 ret
= usb_control_msg(vb
->usb_dev
, usb_sndctrlpipe(vb
->usb_dev
, 0),
115 VPRBRD_USB_REQUEST_GPIOA
, VPRBRD_USB_TYPE_OUT
, 0x0000,
116 0x0000, gamsg
, sizeof(struct vprbrd_gpioa_msg
),
117 VPRBRD_USB_TIMEOUT_MS
);
118 if (ret
!= sizeof(struct vprbrd_gpioa_msg
))
121 ret
= usb_control_msg(vb
->usb_dev
, usb_rcvctrlpipe(vb
->usb_dev
, 0),
122 VPRBRD_USB_REQUEST_GPIOA
, VPRBRD_USB_TYPE_IN
, 0x0000,
123 0x0000, gamsg
, sizeof(struct vprbrd_gpioa_msg
),
124 VPRBRD_USB_TIMEOUT_MS
);
125 answer
= gamsg
->answer
& 0x01;
127 mutex_unlock(&vb
->lock
);
129 if (ret
!= sizeof(struct vprbrd_gpioa_msg
))
138 static void vprbrd_gpioa_set(struct gpio_chip
*chip
,
139 unsigned offset
, int value
)
142 struct vprbrd_gpio
*gpio
=
143 container_of(chip
, struct vprbrd_gpio
, gpioa
);
144 struct vprbrd
*vb
= gpio
->vb
;
145 struct vprbrd_gpioa_msg
*gamsg
= (struct vprbrd_gpioa_msg
*)vb
->buf
;
147 if (gpio
->gpioa_out
& (1 << offset
)) {
149 gpio
->gpioa_val
|= (1 << offset
);
151 gpio
->gpioa_val
&= ~(1 << offset
);
153 mutex_lock(&vb
->lock
);
155 gamsg
->cmd
= VPRBRD_GPIOA_CMD_SETOUT
;
157 gamsg
->offset
= offset
;
160 gamsg
->invert
= 0x00;
161 gamsg
->pwmlevel
= 0x00;
162 gamsg
->outval
= value
;
163 gamsg
->risefall
= 0x00;
164 gamsg
->answer
= 0x00;
165 gamsg
->__fill
= 0x00;
167 ret
= usb_control_msg(vb
->usb_dev
,
168 usb_sndctrlpipe(vb
->usb_dev
, 0),
169 VPRBRD_USB_REQUEST_GPIOA
, VPRBRD_USB_TYPE_OUT
,
170 0x0000, 0x0000, gamsg
,
171 sizeof(struct vprbrd_gpioa_msg
), VPRBRD_USB_TIMEOUT_MS
);
173 mutex_unlock(&vb
->lock
);
175 if (ret
!= sizeof(struct vprbrd_gpioa_msg
))
176 dev_err(chip
->dev
, "usb error setting pin value\n");
180 static int vprbrd_gpioa_direction_input(struct gpio_chip
*chip
,
184 struct vprbrd_gpio
*gpio
=
185 container_of(chip
, struct vprbrd_gpio
, gpioa
);
186 struct vprbrd
*vb
= gpio
->vb
;
187 struct vprbrd_gpioa_msg
*gamsg
= (struct vprbrd_gpioa_msg
*)vb
->buf
;
189 gpio
->gpioa_out
&= ~(1 << offset
);
191 mutex_lock(&vb
->lock
);
193 gamsg
->cmd
= VPRBRD_GPIOA_CMD_SETIN
;
194 gamsg
->clk
= gpioa_clk
;
195 gamsg
->offset
= offset
;
198 gamsg
->invert
= 0x00;
199 gamsg
->pwmlevel
= 0x00;
200 gamsg
->outval
= 0x00;
201 gamsg
->risefall
= 0x00;
202 gamsg
->answer
= 0x00;
203 gamsg
->__fill
= 0x00;
205 ret
= usb_control_msg(vb
->usb_dev
, usb_sndctrlpipe(vb
->usb_dev
, 0),
206 VPRBRD_USB_REQUEST_GPIOA
, VPRBRD_USB_TYPE_OUT
, 0x0000,
207 0x0000, gamsg
, sizeof(struct vprbrd_gpioa_msg
),
208 VPRBRD_USB_TIMEOUT_MS
);
210 mutex_unlock(&vb
->lock
);
212 if (ret
!= sizeof(struct vprbrd_gpioa_msg
))
218 static int vprbrd_gpioa_direction_output(struct gpio_chip
*chip
,
219 unsigned offset
, int value
)
222 struct vprbrd_gpio
*gpio
=
223 container_of(chip
, struct vprbrd_gpio
, gpioa
);
224 struct vprbrd
*vb
= gpio
->vb
;
225 struct vprbrd_gpioa_msg
*gamsg
= (struct vprbrd_gpioa_msg
*)vb
->buf
;
227 gpio
->gpioa_out
|= (1 << offset
);
229 gpio
->gpioa_val
|= (1 << offset
);
231 gpio
->gpioa_val
&= ~(1 << offset
);
233 mutex_lock(&vb
->lock
);
235 gamsg
->cmd
= VPRBRD_GPIOA_CMD_SETOUT
;
237 gamsg
->offset
= offset
;
240 gamsg
->invert
= 0x00;
241 gamsg
->pwmlevel
= 0x00;
242 gamsg
->outval
= value
;
243 gamsg
->risefall
= 0x00;
244 gamsg
->answer
= 0x00;
245 gamsg
->__fill
= 0x00;
247 ret
= usb_control_msg(vb
->usb_dev
, usb_sndctrlpipe(vb
->usb_dev
, 0),
248 VPRBRD_USB_REQUEST_GPIOA
, VPRBRD_USB_TYPE_OUT
, 0x0000,
249 0x0000, gamsg
, sizeof(struct vprbrd_gpioa_msg
),
250 VPRBRD_USB_TIMEOUT_MS
);
252 mutex_unlock(&vb
->lock
);
254 if (ret
!= sizeof(struct vprbrd_gpioa_msg
))
260 /* ----- end of gpio a chip ---------------------------------------------- */
262 /* ----- begin of gipo b chip -------------------------------------------- */
264 static int vprbrd_gpiob_setdir(struct vprbrd
*vb
, unsigned offset
,
267 struct vprbrd_gpiob_msg
*gbmsg
= (struct vprbrd_gpiob_msg
*)vb
->buf
;
270 gbmsg
->cmd
= VPRBRD_GPIOB_CMD_SETDIR
;
271 gbmsg
->val
= cpu_to_be16(dir
<< offset
);
272 gbmsg
->mask
= cpu_to_be16(0x0001 << offset
);
274 ret
= usb_control_msg(vb
->usb_dev
, usb_sndctrlpipe(vb
->usb_dev
, 0),
275 VPRBRD_USB_REQUEST_GPIOB
, VPRBRD_USB_TYPE_OUT
, 0x0000,
276 0x0000, gbmsg
, sizeof(struct vprbrd_gpiob_msg
),
277 VPRBRD_USB_TIMEOUT_MS
);
279 if (ret
!= sizeof(struct vprbrd_gpiob_msg
))
285 static int vprbrd_gpiob_get(struct gpio_chip
*chip
,
290 struct vprbrd_gpio
*gpio
=
291 container_of(chip
, struct vprbrd_gpio
, gpiob
);
292 struct vprbrd
*vb
= gpio
->vb
;
293 struct vprbrd_gpiob_msg
*gbmsg
= (struct vprbrd_gpiob_msg
*)vb
->buf
;
295 /* if io is set to output, just return the saved value */
296 if (gpio
->gpiob_out
& (1 << offset
))
297 return gpio
->gpiob_val
& (1 << offset
);
299 mutex_lock(&vb
->lock
);
301 ret
= usb_control_msg(vb
->usb_dev
, usb_rcvctrlpipe(vb
->usb_dev
, 0),
302 VPRBRD_USB_REQUEST_GPIOB
, VPRBRD_USB_TYPE_IN
, 0x0000,
303 0x0000, gbmsg
, sizeof(struct vprbrd_gpiob_msg
),
304 VPRBRD_USB_TIMEOUT_MS
);
307 mutex_unlock(&vb
->lock
);
309 if (ret
!= sizeof(struct vprbrd_gpiob_msg
))
312 /* cache the read values */
313 gpio
->gpiob_val
= be16_to_cpu(val
);
315 return (gpio
->gpiob_val
>> offset
) & 0x1;
318 static void vprbrd_gpiob_set(struct gpio_chip
*chip
,
319 unsigned offset
, int value
)
322 struct vprbrd_gpio
*gpio
=
323 container_of(chip
, struct vprbrd_gpio
, gpiob
);
324 struct vprbrd
*vb
= gpio
->vb
;
325 struct vprbrd_gpiob_msg
*gbmsg
= (struct vprbrd_gpiob_msg
*)vb
->buf
;
327 if (gpio
->gpiob_out
& (1 << offset
)) {
329 gpio
->gpiob_val
|= (1 << offset
);
331 gpio
->gpiob_val
&= ~(1 << offset
);
333 mutex_lock(&vb
->lock
);
335 gbmsg
->cmd
= VPRBRD_GPIOB_CMD_SETVAL
;
336 gbmsg
->val
= cpu_to_be16(value
<< offset
);
337 gbmsg
->mask
= cpu_to_be16(0x0001 << offset
);
339 ret
= usb_control_msg(vb
->usb_dev
,
340 usb_sndctrlpipe(vb
->usb_dev
, 0),
341 VPRBRD_USB_REQUEST_GPIOB
, VPRBRD_USB_TYPE_OUT
,
342 0x0000, 0x0000, gbmsg
,
343 sizeof(struct vprbrd_gpiob_msg
), VPRBRD_USB_TIMEOUT_MS
);
345 mutex_unlock(&vb
->lock
);
347 if (ret
!= sizeof(struct vprbrd_gpiob_msg
))
348 dev_err(chip
->dev
, "usb error setting pin value\n");
352 static int vprbrd_gpiob_direction_input(struct gpio_chip
*chip
,
356 struct vprbrd_gpio
*gpio
=
357 container_of(chip
, struct vprbrd_gpio
, gpiob
);
358 struct vprbrd
*vb
= gpio
->vb
;
360 gpio
->gpiob_out
&= ~(1 << offset
);
362 mutex_lock(&vb
->lock
);
364 ret
= vprbrd_gpiob_setdir(vb
, offset
, 0);
366 mutex_unlock(&vb
->lock
);
369 dev_err(chip
->dev
, "usb error setting pin to input\n");
374 static int vprbrd_gpiob_direction_output(struct gpio_chip
*chip
,
375 unsigned offset
, int value
)
378 struct vprbrd_gpio
*gpio
=
379 container_of(chip
, struct vprbrd_gpio
, gpiob
);
380 struct vprbrd
*vb
= gpio
->vb
;
382 gpio
->gpiob_out
|= (1 << offset
);
384 mutex_lock(&vb
->lock
);
386 ret
= vprbrd_gpiob_setdir(vb
, offset
, 1);
388 dev_err(chip
->dev
, "usb error setting pin to output\n");
390 mutex_unlock(&vb
->lock
);
392 vprbrd_gpiob_set(chip
, offset
, value
);
397 /* ----- end of gpio b chip ---------------------------------------------- */
399 static int vprbrd_gpio_probe(struct platform_device
*pdev
)
401 struct vprbrd
*vb
= dev_get_drvdata(pdev
->dev
.parent
);
402 struct vprbrd_gpio
*vb_gpio
;
405 vb_gpio
= devm_kzalloc(&pdev
->dev
, sizeof(*vb_gpio
), GFP_KERNEL
);
410 /* registering gpio a */
411 vb_gpio
->gpioa
.label
= "viperboard gpio a";
412 vb_gpio
->gpioa
.dev
= &pdev
->dev
;
413 vb_gpio
->gpioa
.owner
= THIS_MODULE
;
414 vb_gpio
->gpioa
.base
= -1;
415 vb_gpio
->gpioa
.ngpio
= 16;
416 vb_gpio
->gpioa
.can_sleep
= 1;
417 vb_gpio
->gpioa
.set
= vprbrd_gpioa_set
;
418 vb_gpio
->gpioa
.get
= vprbrd_gpioa_get
;
419 vb_gpio
->gpioa
.direction_input
= vprbrd_gpioa_direction_input
;
420 vb_gpio
->gpioa
.direction_output
= vprbrd_gpioa_direction_output
;
421 ret
= gpiochip_add(&vb_gpio
->gpioa
);
423 dev_err(vb_gpio
->gpioa
.dev
, "could not add gpio a");
427 /* registering gpio b */
428 vb_gpio
->gpiob
.label
= "viperboard gpio b";
429 vb_gpio
->gpiob
.dev
= &pdev
->dev
;
430 vb_gpio
->gpiob
.owner
= THIS_MODULE
;
431 vb_gpio
->gpiob
.base
= -1;
432 vb_gpio
->gpiob
.ngpio
= 16;
433 vb_gpio
->gpiob
.can_sleep
= 1;
434 vb_gpio
->gpiob
.set
= vprbrd_gpiob_set
;
435 vb_gpio
->gpiob
.get
= vprbrd_gpiob_get
;
436 vb_gpio
->gpiob
.direction_input
= vprbrd_gpiob_direction_input
;
437 vb_gpio
->gpiob
.direction_output
= vprbrd_gpiob_direction_output
;
438 ret
= gpiochip_add(&vb_gpio
->gpiob
);
440 dev_err(vb_gpio
->gpiob
.dev
, "could not add gpio b");
444 platform_set_drvdata(pdev
, vb_gpio
);
449 ret
= gpiochip_remove(&vb_gpio
->gpioa
);
455 static int vprbrd_gpio_remove(struct platform_device
*pdev
)
457 struct vprbrd_gpio
*vb_gpio
= platform_get_drvdata(pdev
);
460 ret
= gpiochip_remove(&vb_gpio
->gpiob
);
462 ret
= gpiochip_remove(&vb_gpio
->gpioa
);
467 static struct platform_driver vprbrd_gpio_driver
= {
468 .driver
.name
= "viperboard-gpio",
469 .driver
.owner
= THIS_MODULE
,
470 .probe
= vprbrd_gpio_probe
,
471 .remove
= vprbrd_gpio_remove
,
474 static int __init
vprbrd_gpio_init(void)
476 switch (gpioa_freq
) {
478 gpioa_clk
= VPRBRD_GPIOA_CLK_1MHZ
;
481 gpioa_clk
= VPRBRD_GPIOA_CLK_100KHZ
;
484 gpioa_clk
= VPRBRD_GPIOA_CLK_10KHZ
;
487 gpioa_clk
= VPRBRD_GPIOA_CLK_1KHZ
;
490 gpioa_clk
= VPRBRD_GPIOA_CLK_100HZ
;
493 gpioa_clk
= VPRBRD_GPIOA_CLK_10HZ
;
496 pr_warn("invalid gpioa_freq (%d)\n", gpioa_freq
);
497 gpioa_clk
= VPRBRD_GPIOA_CLK_1KHZ
;
500 return platform_driver_register(&vprbrd_gpio_driver
);
502 subsys_initcall(vprbrd_gpio_init
);
504 static void __exit
vprbrd_gpio_exit(void)
506 platform_driver_unregister(&vprbrd_gpio_driver
);
508 module_exit(vprbrd_gpio_exit
);
510 MODULE_AUTHOR("Lars Poeschel <poeschel@lemonage.de>");
511 MODULE_DESCRIPTION("GPIO driver for Nano River Techs Viperboard");
512 MODULE_LICENSE("GPL");
513 MODULE_ALIAS("platform:viperboard-gpio");