1751107efSLinus Walleij // SPDX-License-Identifier: GPL-2.0+
29d5b72deSLars Poeschel /*
39d5b72deSLars Poeschel * Nano River Technologies viperboard GPIO lib driver
49d5b72deSLars Poeschel *
59d5b72deSLars Poeschel * (C) 2012 by Lemonage GmbH
69d5b72deSLars Poeschel * Author: Lars Poeschel <poeschel@lemonage.de>
79d5b72deSLars Poeschel * All rights reserved.
89d5b72deSLars Poeschel */
99d5b72deSLars Poeschel
109d5b72deSLars Poeschel #include <linux/kernel.h>
119d5b72deSLars Poeschel #include <linux/errno.h>
129d5b72deSLars Poeschel #include <linux/module.h>
139d5b72deSLars Poeschel #include <linux/slab.h>
149d5b72deSLars Poeschel #include <linux/types.h>
159d5b72deSLars Poeschel #include <linux/mutex.h>
169d5b72deSLars Poeschel #include <linux/platform_device.h>
179d5b72deSLars Poeschel #include <linux/usb.h>
18d3007ecbSLinus Walleij #include <linux/gpio/driver.h>
199d5b72deSLars Poeschel
209d5b72deSLars Poeschel #include <linux/mfd/viperboard.h>
219d5b72deSLars Poeschel
229d5b72deSLars Poeschel #define VPRBRD_GPIOA_CLK_1MHZ 0
239d5b72deSLars Poeschel #define VPRBRD_GPIOA_CLK_100KHZ 1
249d5b72deSLars Poeschel #define VPRBRD_GPIOA_CLK_10KHZ 2
259d5b72deSLars Poeschel #define VPRBRD_GPIOA_CLK_1KHZ 3
269d5b72deSLars Poeschel #define VPRBRD_GPIOA_CLK_100HZ 4
279d5b72deSLars Poeschel #define VPRBRD_GPIOA_CLK_10HZ 5
289d5b72deSLars Poeschel
299d5b72deSLars Poeschel #define VPRBRD_GPIOA_FREQ_DEFAULT 1000
309d5b72deSLars Poeschel
319d5b72deSLars Poeschel #define VPRBRD_GPIOA_CMD_CONT 0x00
329d5b72deSLars Poeschel #define VPRBRD_GPIOA_CMD_PULSE 0x01
339d5b72deSLars Poeschel #define VPRBRD_GPIOA_CMD_PWM 0x02
349d5b72deSLars Poeschel #define VPRBRD_GPIOA_CMD_SETOUT 0x03
359d5b72deSLars Poeschel #define VPRBRD_GPIOA_CMD_SETIN 0x04
369d5b72deSLars Poeschel #define VPRBRD_GPIOA_CMD_SETINT 0x05
379d5b72deSLars Poeschel #define VPRBRD_GPIOA_CMD_GETIN 0x06
389d5b72deSLars Poeschel
399d5b72deSLars Poeschel #define VPRBRD_GPIOB_CMD_SETDIR 0x00
409d5b72deSLars Poeschel #define VPRBRD_GPIOB_CMD_SETVAL 0x01
419d5b72deSLars Poeschel
429d5b72deSLars Poeschel struct vprbrd_gpioa_msg {
439d5b72deSLars Poeschel u8 cmd;
449d5b72deSLars Poeschel u8 clk;
459d5b72deSLars Poeschel u8 offset;
469d5b72deSLars Poeschel u8 t1;
479d5b72deSLars Poeschel u8 t2;
489d5b72deSLars Poeschel u8 invert;
499d5b72deSLars Poeschel u8 pwmlevel;
509d5b72deSLars Poeschel u8 outval;
519d5b72deSLars Poeschel u8 risefall;
529d5b72deSLars Poeschel u8 answer;
539d5b72deSLars Poeschel u8 __fill;
549d5b72deSLars Poeschel } __packed;
559d5b72deSLars Poeschel
569d5b72deSLars Poeschel struct vprbrd_gpiob_msg {
579d5b72deSLars Poeschel u8 cmd;
589d5b72deSLars Poeschel u16 val;
599d5b72deSLars Poeschel u16 mask;
609d5b72deSLars Poeschel } __packed;
619d5b72deSLars Poeschel
629d5b72deSLars Poeschel struct vprbrd_gpio {
639d5b72deSLars Poeschel struct gpio_chip gpioa; /* gpio a related things */
649d5b72deSLars Poeschel u32 gpioa_out;
659d5b72deSLars Poeschel u32 gpioa_val;
669d5b72deSLars Poeschel struct gpio_chip gpiob; /* gpio b related things */
679d5b72deSLars Poeschel u32 gpiob_out;
689d5b72deSLars Poeschel u32 gpiob_val;
699d5b72deSLars Poeschel struct vprbrd *vb;
709d5b72deSLars Poeschel };
719d5b72deSLars Poeschel
729d5b72deSLars Poeschel /* gpioa sampling clock module parameter */
739d5b72deSLars Poeschel static unsigned char gpioa_clk;
749d5b72deSLars Poeschel static unsigned int gpioa_freq = VPRBRD_GPIOA_FREQ_DEFAULT;
759d5b72deSLars Poeschel module_param(gpioa_freq, uint, 0);
769d5b72deSLars Poeschel MODULE_PARM_DESC(gpioa_freq,
779d5b72deSLars Poeschel "gpio-a sampling freq in Hz (default is 1000Hz) valid values: 10, 100, 1000, 10000, 100000, 1000000");
789d5b72deSLars Poeschel
799d5b72deSLars Poeschel /* ----- begin of gipo a chip -------------------------------------------- */
809d5b72deSLars Poeschel
vprbrd_gpioa_get(struct gpio_chip * chip,unsigned int offset)819d5b72deSLars Poeschel static int vprbrd_gpioa_get(struct gpio_chip *chip,
82d111e7a3SHennie Muller unsigned int offset)
839d5b72deSLars Poeschel {
849d5b72deSLars Poeschel int ret, answer, error = 0;
852a873c8dSLinus Walleij struct vprbrd_gpio *gpio = gpiochip_get_data(chip);
869d5b72deSLars Poeschel struct vprbrd *vb = gpio->vb;
879d5b72deSLars Poeschel struct vprbrd_gpioa_msg *gamsg = (struct vprbrd_gpioa_msg *)vb->buf;
889d5b72deSLars Poeschel
899d5b72deSLars Poeschel /* if io is set to output, just return the saved value */
909d5b72deSLars Poeschel if (gpio->gpioa_out & (1 << offset))
9180776df4SLinus Walleij return !!(gpio->gpioa_val & (1 << offset));
929d5b72deSLars Poeschel
939d5b72deSLars Poeschel mutex_lock(&vb->lock);
949d5b72deSLars Poeschel
959d5b72deSLars Poeschel gamsg->cmd = VPRBRD_GPIOA_CMD_GETIN;
969d5b72deSLars Poeschel gamsg->clk = 0x00;
979d5b72deSLars Poeschel gamsg->offset = offset;
989d5b72deSLars Poeschel gamsg->t1 = 0x00;
999d5b72deSLars Poeschel gamsg->t2 = 0x00;
1009d5b72deSLars Poeschel gamsg->invert = 0x00;
1019d5b72deSLars Poeschel gamsg->pwmlevel = 0x00;
1029d5b72deSLars Poeschel gamsg->outval = 0x00;
1039d5b72deSLars Poeschel gamsg->risefall = 0x00;
1049d5b72deSLars Poeschel gamsg->answer = 0x00;
1059d5b72deSLars Poeschel gamsg->__fill = 0x00;
1069d5b72deSLars Poeschel
1079d5b72deSLars Poeschel ret = usb_control_msg(vb->usb_dev, usb_sndctrlpipe(vb->usb_dev, 0),
1089d5b72deSLars Poeschel VPRBRD_USB_REQUEST_GPIOA, VPRBRD_USB_TYPE_OUT, 0x0000,
1099d5b72deSLars Poeschel 0x0000, gamsg, sizeof(struct vprbrd_gpioa_msg),
1109d5b72deSLars Poeschel VPRBRD_USB_TIMEOUT_MS);
1119d5b72deSLars Poeschel if (ret != sizeof(struct vprbrd_gpioa_msg))
1129d5b72deSLars Poeschel error = -EREMOTEIO;
1139d5b72deSLars Poeschel
1149d5b72deSLars Poeschel ret = usb_control_msg(vb->usb_dev, usb_rcvctrlpipe(vb->usb_dev, 0),
1159d5b72deSLars Poeschel VPRBRD_USB_REQUEST_GPIOA, VPRBRD_USB_TYPE_IN, 0x0000,
1169d5b72deSLars Poeschel 0x0000, gamsg, sizeof(struct vprbrd_gpioa_msg),
1179d5b72deSLars Poeschel VPRBRD_USB_TIMEOUT_MS);
1189d5b72deSLars Poeschel answer = gamsg->answer & 0x01;
1199d5b72deSLars Poeschel
1209d5b72deSLars Poeschel mutex_unlock(&vb->lock);
1219d5b72deSLars Poeschel
1229d5b72deSLars Poeschel if (ret != sizeof(struct vprbrd_gpioa_msg))
1239d5b72deSLars Poeschel error = -EREMOTEIO;
1249d5b72deSLars Poeschel
1259d5b72deSLars Poeschel if (error)
1269d5b72deSLars Poeschel return error;
1279d5b72deSLars Poeschel
1289d5b72deSLars Poeschel return answer;
1299d5b72deSLars Poeschel }
1309d5b72deSLars Poeschel
vprbrd_gpioa_set(struct gpio_chip * chip,unsigned int offset,int value)1319d5b72deSLars Poeschel static void vprbrd_gpioa_set(struct gpio_chip *chip,
132d111e7a3SHennie Muller unsigned int offset, int value)
1339d5b72deSLars Poeschel {
1349d5b72deSLars Poeschel int ret;
1352a873c8dSLinus Walleij struct vprbrd_gpio *gpio = gpiochip_get_data(chip);
1369d5b72deSLars Poeschel struct vprbrd *vb = gpio->vb;
1379d5b72deSLars Poeschel struct vprbrd_gpioa_msg *gamsg = (struct vprbrd_gpioa_msg *)vb->buf;
1389d5b72deSLars Poeschel
1399d5b72deSLars Poeschel if (gpio->gpioa_out & (1 << offset)) {
1409d5b72deSLars Poeschel if (value)
1419d5b72deSLars Poeschel gpio->gpioa_val |= (1 << offset);
1429d5b72deSLars Poeschel else
1439d5b72deSLars Poeschel gpio->gpioa_val &= ~(1 << offset);
1449d5b72deSLars Poeschel
1459d5b72deSLars Poeschel mutex_lock(&vb->lock);
1469d5b72deSLars Poeschel
1479d5b72deSLars Poeschel gamsg->cmd = VPRBRD_GPIOA_CMD_SETOUT;
1489d5b72deSLars Poeschel gamsg->clk = 0x00;
1499d5b72deSLars Poeschel gamsg->offset = offset;
1509d5b72deSLars Poeschel gamsg->t1 = 0x00;
1519d5b72deSLars Poeschel gamsg->t2 = 0x00;
1529d5b72deSLars Poeschel gamsg->invert = 0x00;
1539d5b72deSLars Poeschel gamsg->pwmlevel = 0x00;
1549d5b72deSLars Poeschel gamsg->outval = value;
1559d5b72deSLars Poeschel gamsg->risefall = 0x00;
1569d5b72deSLars Poeschel gamsg->answer = 0x00;
1579d5b72deSLars Poeschel gamsg->__fill = 0x00;
1589d5b72deSLars Poeschel
1599d5b72deSLars Poeschel ret = usb_control_msg(vb->usb_dev,
1609d5b72deSLars Poeschel usb_sndctrlpipe(vb->usb_dev, 0),
1619d5b72deSLars Poeschel VPRBRD_USB_REQUEST_GPIOA, VPRBRD_USB_TYPE_OUT,
1629d5b72deSLars Poeschel 0x0000, 0x0000, gamsg,
1639d5b72deSLars Poeschel sizeof(struct vprbrd_gpioa_msg), VPRBRD_USB_TIMEOUT_MS);
1649d5b72deSLars Poeschel
1659d5b72deSLars Poeschel mutex_unlock(&vb->lock);
1669d5b72deSLars Poeschel
1679d5b72deSLars Poeschel if (ret != sizeof(struct vprbrd_gpioa_msg))
16858383c78SLinus Walleij dev_err(chip->parent, "usb error setting pin value\n");
1699d5b72deSLars Poeschel }
1709d5b72deSLars Poeschel }
1719d5b72deSLars Poeschel
vprbrd_gpioa_direction_input(struct gpio_chip * chip,unsigned int offset)1729d5b72deSLars Poeschel static int vprbrd_gpioa_direction_input(struct gpio_chip *chip,
173d111e7a3SHennie Muller unsigned int offset)
1749d5b72deSLars Poeschel {
1759d5b72deSLars Poeschel int ret;
1762a873c8dSLinus Walleij struct vprbrd_gpio *gpio = gpiochip_get_data(chip);
1779d5b72deSLars Poeschel struct vprbrd *vb = gpio->vb;
1789d5b72deSLars Poeschel struct vprbrd_gpioa_msg *gamsg = (struct vprbrd_gpioa_msg *)vb->buf;
1799d5b72deSLars Poeschel
1809d5b72deSLars Poeschel gpio->gpioa_out &= ~(1 << offset);
1819d5b72deSLars Poeschel
1829d5b72deSLars Poeschel mutex_lock(&vb->lock);
1839d5b72deSLars Poeschel
1849d5b72deSLars Poeschel gamsg->cmd = VPRBRD_GPIOA_CMD_SETIN;
1859d5b72deSLars Poeschel gamsg->clk = gpioa_clk;
1869d5b72deSLars Poeschel gamsg->offset = offset;
1879d5b72deSLars Poeschel gamsg->t1 = 0x00;
1889d5b72deSLars Poeschel gamsg->t2 = 0x00;
1899d5b72deSLars Poeschel gamsg->invert = 0x00;
1909d5b72deSLars Poeschel gamsg->pwmlevel = 0x00;
1919d5b72deSLars Poeschel gamsg->outval = 0x00;
1929d5b72deSLars Poeschel gamsg->risefall = 0x00;
1939d5b72deSLars Poeschel gamsg->answer = 0x00;
1949d5b72deSLars Poeschel gamsg->__fill = 0x00;
1959d5b72deSLars Poeschel
1969d5b72deSLars Poeschel ret = usb_control_msg(vb->usb_dev, usb_sndctrlpipe(vb->usb_dev, 0),
1979d5b72deSLars Poeschel VPRBRD_USB_REQUEST_GPIOA, VPRBRD_USB_TYPE_OUT, 0x0000,
1989d5b72deSLars Poeschel 0x0000, gamsg, sizeof(struct vprbrd_gpioa_msg),
1999d5b72deSLars Poeschel VPRBRD_USB_TIMEOUT_MS);
2009d5b72deSLars Poeschel
2019d5b72deSLars Poeschel mutex_unlock(&vb->lock);
2029d5b72deSLars Poeschel
2039d5b72deSLars Poeschel if (ret != sizeof(struct vprbrd_gpioa_msg))
2049d5b72deSLars Poeschel return -EREMOTEIO;
2059d5b72deSLars Poeschel
2069d5b72deSLars Poeschel return 0;
2079d5b72deSLars Poeschel }
2089d5b72deSLars Poeschel
vprbrd_gpioa_direction_output(struct gpio_chip * chip,unsigned int offset,int value)2099d5b72deSLars Poeschel static int vprbrd_gpioa_direction_output(struct gpio_chip *chip,
210d111e7a3SHennie Muller unsigned int offset, int value)
2119d5b72deSLars Poeschel {
2129d5b72deSLars Poeschel int ret;
2132a873c8dSLinus Walleij struct vprbrd_gpio *gpio = gpiochip_get_data(chip);
2149d5b72deSLars Poeschel struct vprbrd *vb = gpio->vb;
2159d5b72deSLars Poeschel struct vprbrd_gpioa_msg *gamsg = (struct vprbrd_gpioa_msg *)vb->buf;
2169d5b72deSLars Poeschel
2179d5b72deSLars Poeschel gpio->gpioa_out |= (1 << offset);
2189d5b72deSLars Poeschel if (value)
2199d5b72deSLars Poeschel gpio->gpioa_val |= (1 << offset);
2209d5b72deSLars Poeschel else
2219d5b72deSLars Poeschel gpio->gpioa_val &= ~(1 << offset);
2229d5b72deSLars Poeschel
2239d5b72deSLars Poeschel mutex_lock(&vb->lock);
2249d5b72deSLars Poeschel
2259d5b72deSLars Poeschel gamsg->cmd = VPRBRD_GPIOA_CMD_SETOUT;
2269d5b72deSLars Poeschel gamsg->clk = 0x00;
2279d5b72deSLars Poeschel gamsg->offset = offset;
2289d5b72deSLars Poeschel gamsg->t1 = 0x00;
2299d5b72deSLars Poeschel gamsg->t2 = 0x00;
2309d5b72deSLars Poeschel gamsg->invert = 0x00;
2319d5b72deSLars Poeschel gamsg->pwmlevel = 0x00;
2329d5b72deSLars Poeschel gamsg->outval = value;
2339d5b72deSLars Poeschel gamsg->risefall = 0x00;
2349d5b72deSLars Poeschel gamsg->answer = 0x00;
2359d5b72deSLars Poeschel gamsg->__fill = 0x00;
2369d5b72deSLars Poeschel
2379d5b72deSLars Poeschel ret = usb_control_msg(vb->usb_dev, usb_sndctrlpipe(vb->usb_dev, 0),
2389d5b72deSLars Poeschel VPRBRD_USB_REQUEST_GPIOA, VPRBRD_USB_TYPE_OUT, 0x0000,
2399d5b72deSLars Poeschel 0x0000, gamsg, sizeof(struct vprbrd_gpioa_msg),
2409d5b72deSLars Poeschel VPRBRD_USB_TIMEOUT_MS);
2419d5b72deSLars Poeschel
2429d5b72deSLars Poeschel mutex_unlock(&vb->lock);
2439d5b72deSLars Poeschel
2449d5b72deSLars Poeschel if (ret != sizeof(struct vprbrd_gpioa_msg))
2459d5b72deSLars Poeschel return -EREMOTEIO;
2469d5b72deSLars Poeschel
2479d5b72deSLars Poeschel return 0;
2489d5b72deSLars Poeschel }
2499d5b72deSLars Poeschel
2509d5b72deSLars Poeschel /* ----- end of gpio a chip ---------------------------------------------- */
2519d5b72deSLars Poeschel
2529d5b72deSLars Poeschel /* ----- begin of gipo b chip -------------------------------------------- */
2539d5b72deSLars Poeschel
vprbrd_gpiob_setdir(struct vprbrd * vb,unsigned int offset,unsigned int dir)254d111e7a3SHennie Muller static int vprbrd_gpiob_setdir(struct vprbrd *vb, unsigned int offset,
255d111e7a3SHennie Muller unsigned int dir)
2569d5b72deSLars Poeschel {
2579d5b72deSLars Poeschel struct vprbrd_gpiob_msg *gbmsg = (struct vprbrd_gpiob_msg *)vb->buf;
2589d5b72deSLars Poeschel int ret;
2599d5b72deSLars Poeschel
2609d5b72deSLars Poeschel gbmsg->cmd = VPRBRD_GPIOB_CMD_SETDIR;
2619d5b72deSLars Poeschel gbmsg->val = cpu_to_be16(dir << offset);
2629d5b72deSLars Poeschel gbmsg->mask = cpu_to_be16(0x0001 << offset);
2639d5b72deSLars Poeschel
2649d5b72deSLars Poeschel ret = usb_control_msg(vb->usb_dev, usb_sndctrlpipe(vb->usb_dev, 0),
2659d5b72deSLars Poeschel VPRBRD_USB_REQUEST_GPIOB, VPRBRD_USB_TYPE_OUT, 0x0000,
2669d5b72deSLars Poeschel 0x0000, gbmsg, sizeof(struct vprbrd_gpiob_msg),
2679d5b72deSLars Poeschel VPRBRD_USB_TIMEOUT_MS);
2689d5b72deSLars Poeschel
2699d5b72deSLars Poeschel if (ret != sizeof(struct vprbrd_gpiob_msg))
2709d5b72deSLars Poeschel return -EREMOTEIO;
2719d5b72deSLars Poeschel
2729d5b72deSLars Poeschel return 0;
2739d5b72deSLars Poeschel }
2749d5b72deSLars Poeschel
vprbrd_gpiob_get(struct gpio_chip * chip,unsigned int offset)2759d5b72deSLars Poeschel static int vprbrd_gpiob_get(struct gpio_chip *chip,
276d111e7a3SHennie Muller unsigned int offset)
2779d5b72deSLars Poeschel {
2789d5b72deSLars Poeschel int ret;
2799d5b72deSLars Poeschel u16 val;
2802a873c8dSLinus Walleij struct vprbrd_gpio *gpio = gpiochip_get_data(chip);
2819d5b72deSLars Poeschel struct vprbrd *vb = gpio->vb;
2829d5b72deSLars Poeschel struct vprbrd_gpiob_msg *gbmsg = (struct vprbrd_gpiob_msg *)vb->buf;
2839d5b72deSLars Poeschel
2849d5b72deSLars Poeschel /* if io is set to output, just return the saved value */
2859d5b72deSLars Poeschel if (gpio->gpiob_out & (1 << offset))
2869d5b72deSLars Poeschel return gpio->gpiob_val & (1 << offset);
2879d5b72deSLars Poeschel
2889d5b72deSLars Poeschel mutex_lock(&vb->lock);
2899d5b72deSLars Poeschel
2909d5b72deSLars Poeschel ret = usb_control_msg(vb->usb_dev, usb_rcvctrlpipe(vb->usb_dev, 0),
2919d5b72deSLars Poeschel VPRBRD_USB_REQUEST_GPIOB, VPRBRD_USB_TYPE_IN, 0x0000,
2929d5b72deSLars Poeschel 0x0000, gbmsg, sizeof(struct vprbrd_gpiob_msg),
2939d5b72deSLars Poeschel VPRBRD_USB_TIMEOUT_MS);
2949d5b72deSLars Poeschel val = gbmsg->val;
2959d5b72deSLars Poeschel
2969d5b72deSLars Poeschel mutex_unlock(&vb->lock);
2979d5b72deSLars Poeschel
2989d5b72deSLars Poeschel if (ret != sizeof(struct vprbrd_gpiob_msg))
2999d5b72deSLars Poeschel return ret;
3009d5b72deSLars Poeschel
3019d5b72deSLars Poeschel /* cache the read values */
3029d5b72deSLars Poeschel gpio->gpiob_val = be16_to_cpu(val);
3039d5b72deSLars Poeschel
3049d5b72deSLars Poeschel return (gpio->gpiob_val >> offset) & 0x1;
3059d5b72deSLars Poeschel }
3069d5b72deSLars Poeschel
vprbrd_gpiob_set(struct gpio_chip * chip,unsigned int offset,int value)3079d5b72deSLars Poeschel static void vprbrd_gpiob_set(struct gpio_chip *chip,
308d111e7a3SHennie Muller unsigned int offset, int value)
3099d5b72deSLars Poeschel {
3109d5b72deSLars Poeschel int ret;
3112a873c8dSLinus Walleij struct vprbrd_gpio *gpio = gpiochip_get_data(chip);
3129d5b72deSLars Poeschel struct vprbrd *vb = gpio->vb;
3139d5b72deSLars Poeschel struct vprbrd_gpiob_msg *gbmsg = (struct vprbrd_gpiob_msg *)vb->buf;
3149d5b72deSLars Poeschel
3159d5b72deSLars Poeschel if (gpio->gpiob_out & (1 << offset)) {
3169d5b72deSLars Poeschel if (value)
3179d5b72deSLars Poeschel gpio->gpiob_val |= (1 << offset);
3189d5b72deSLars Poeschel else
3199d5b72deSLars Poeschel gpio->gpiob_val &= ~(1 << offset);
3209d5b72deSLars Poeschel
3219d5b72deSLars Poeschel mutex_lock(&vb->lock);
3229d5b72deSLars Poeschel
3239d5b72deSLars Poeschel gbmsg->cmd = VPRBRD_GPIOB_CMD_SETVAL;
3249d5b72deSLars Poeschel gbmsg->val = cpu_to_be16(value << offset);
3259d5b72deSLars Poeschel gbmsg->mask = cpu_to_be16(0x0001 << offset);
3269d5b72deSLars Poeschel
3279d5b72deSLars Poeschel ret = usb_control_msg(vb->usb_dev,
3289d5b72deSLars Poeschel usb_sndctrlpipe(vb->usb_dev, 0),
3299d5b72deSLars Poeschel VPRBRD_USB_REQUEST_GPIOB, VPRBRD_USB_TYPE_OUT,
3309d5b72deSLars Poeschel 0x0000, 0x0000, gbmsg,
3319d5b72deSLars Poeschel sizeof(struct vprbrd_gpiob_msg), VPRBRD_USB_TIMEOUT_MS);
3329d5b72deSLars Poeschel
3339d5b72deSLars Poeschel mutex_unlock(&vb->lock);
3349d5b72deSLars Poeschel
3359d5b72deSLars Poeschel if (ret != sizeof(struct vprbrd_gpiob_msg))
33658383c78SLinus Walleij dev_err(chip->parent, "usb error setting pin value\n");
3379d5b72deSLars Poeschel }
3389d5b72deSLars Poeschel }
3399d5b72deSLars Poeschel
vprbrd_gpiob_direction_input(struct gpio_chip * chip,unsigned int offset)3409d5b72deSLars Poeschel static int vprbrd_gpiob_direction_input(struct gpio_chip *chip,
341d111e7a3SHennie Muller unsigned int offset)
3429d5b72deSLars Poeschel {
3439d5b72deSLars Poeschel int ret;
3442a873c8dSLinus Walleij struct vprbrd_gpio *gpio = gpiochip_get_data(chip);
3459d5b72deSLars Poeschel struct vprbrd *vb = gpio->vb;
3469d5b72deSLars Poeschel
3479d5b72deSLars Poeschel gpio->gpiob_out &= ~(1 << offset);
3489d5b72deSLars Poeschel
3499d5b72deSLars Poeschel mutex_lock(&vb->lock);
3509d5b72deSLars Poeschel
3519d5b72deSLars Poeschel ret = vprbrd_gpiob_setdir(vb, offset, 0);
3529d5b72deSLars Poeschel
3539d5b72deSLars Poeschel mutex_unlock(&vb->lock);
3549d5b72deSLars Poeschel
3559d5b72deSLars Poeschel if (ret)
35658383c78SLinus Walleij dev_err(chip->parent, "usb error setting pin to input\n");
3579d5b72deSLars Poeschel
3589d5b72deSLars Poeschel return ret;
3599d5b72deSLars Poeschel }
3609d5b72deSLars Poeschel
vprbrd_gpiob_direction_output(struct gpio_chip * chip,unsigned int offset,int value)3619d5b72deSLars Poeschel static int vprbrd_gpiob_direction_output(struct gpio_chip *chip,
362d111e7a3SHennie Muller unsigned int offset, int value)
3639d5b72deSLars Poeschel {
3649d5b72deSLars Poeschel int ret;
3652a873c8dSLinus Walleij struct vprbrd_gpio *gpio = gpiochip_get_data(chip);
3669d5b72deSLars Poeschel struct vprbrd *vb = gpio->vb;
3679d5b72deSLars Poeschel
3689d5b72deSLars Poeschel gpio->gpiob_out |= (1 << offset);
3699d5b72deSLars Poeschel
3709d5b72deSLars Poeschel mutex_lock(&vb->lock);
3719d5b72deSLars Poeschel
3729d5b72deSLars Poeschel ret = vprbrd_gpiob_setdir(vb, offset, 1);
3739d5b72deSLars Poeschel if (ret)
37458383c78SLinus Walleij dev_err(chip->parent, "usb error setting pin to output\n");
3759d5b72deSLars Poeschel
3769d5b72deSLars Poeschel mutex_unlock(&vb->lock);
3779d5b72deSLars Poeschel
3789d5b72deSLars Poeschel vprbrd_gpiob_set(chip, offset, value);
3799d5b72deSLars Poeschel
3809d5b72deSLars Poeschel return ret;
3819d5b72deSLars Poeschel }
3829d5b72deSLars Poeschel
3839d5b72deSLars Poeschel /* ----- end of gpio b chip ---------------------------------------------- */
3849d5b72deSLars Poeschel
vprbrd_gpio_probe(struct platform_device * pdev)3850fe763c5SGreg Kroah-Hartman static int vprbrd_gpio_probe(struct platform_device *pdev)
3869d5b72deSLars Poeschel {
3879d5b72deSLars Poeschel struct vprbrd *vb = dev_get_drvdata(pdev->dev.parent);
3889d5b72deSLars Poeschel struct vprbrd_gpio *vb_gpio;
3899d5b72deSLars Poeschel int ret;
3909d5b72deSLars Poeschel
3919d5b72deSLars Poeschel vb_gpio = devm_kzalloc(&pdev->dev, sizeof(*vb_gpio), GFP_KERNEL);
3929d5b72deSLars Poeschel if (vb_gpio == NULL)
3939d5b72deSLars Poeschel return -ENOMEM;
3949d5b72deSLars Poeschel
3959d5b72deSLars Poeschel vb_gpio->vb = vb;
3969d5b72deSLars Poeschel /* registering gpio a */
3979d5b72deSLars Poeschel vb_gpio->gpioa.label = "viperboard gpio a";
39858383c78SLinus Walleij vb_gpio->gpioa.parent = &pdev->dev;
3999d5b72deSLars Poeschel vb_gpio->gpioa.owner = THIS_MODULE;
4009d5b72deSLars Poeschel vb_gpio->gpioa.base = -1;
4019d5b72deSLars Poeschel vb_gpio->gpioa.ngpio = 16;
4029fb1f39eSLinus Walleij vb_gpio->gpioa.can_sleep = true;
4039d5b72deSLars Poeschel vb_gpio->gpioa.set = vprbrd_gpioa_set;
4049d5b72deSLars Poeschel vb_gpio->gpioa.get = vprbrd_gpioa_get;
4059d5b72deSLars Poeschel vb_gpio->gpioa.direction_input = vprbrd_gpioa_direction_input;
4069d5b72deSLars Poeschel vb_gpio->gpioa.direction_output = vprbrd_gpioa_direction_output;
407*6b4a2a42SAlexandru Ardelean
40845338c3aSLaxman Dewangan ret = devm_gpiochip_add_data(&pdev->dev, &vb_gpio->gpioa, vb_gpio);
409*6b4a2a42SAlexandru Ardelean if (ret < 0)
41045338c3aSLaxman Dewangan return ret;
4119d5b72deSLars Poeschel
4129d5b72deSLars Poeschel /* registering gpio b */
4139d5b72deSLars Poeschel vb_gpio->gpiob.label = "viperboard gpio b";
41458383c78SLinus Walleij vb_gpio->gpiob.parent = &pdev->dev;
4159d5b72deSLars Poeschel vb_gpio->gpiob.owner = THIS_MODULE;
4169d5b72deSLars Poeschel vb_gpio->gpiob.base = -1;
4179d5b72deSLars Poeschel vb_gpio->gpiob.ngpio = 16;
4189fb1f39eSLinus Walleij vb_gpio->gpiob.can_sleep = true;
4199d5b72deSLars Poeschel vb_gpio->gpiob.set = vprbrd_gpiob_set;
4209d5b72deSLars Poeschel vb_gpio->gpiob.get = vprbrd_gpiob_get;
4219d5b72deSLars Poeschel vb_gpio->gpiob.direction_input = vprbrd_gpiob_direction_input;
4229d5b72deSLars Poeschel vb_gpio->gpiob.direction_output = vprbrd_gpiob_direction_output;
4239d5b72deSLars Poeschel
424*6b4a2a42SAlexandru Ardelean return devm_gpiochip_add_data(&pdev->dev, &vb_gpio->gpiob, vb_gpio);
4259d5b72deSLars Poeschel }
4269d5b72deSLars Poeschel
4279d5b72deSLars Poeschel static struct platform_driver vprbrd_gpio_driver = {
4289d5b72deSLars Poeschel .driver.name = "viperboard-gpio",
4299d5b72deSLars Poeschel .probe = vprbrd_gpio_probe,
4309d5b72deSLars Poeschel };
4319d5b72deSLars Poeschel
vprbrd_gpio_init(void)4329d5b72deSLars Poeschel static int __init vprbrd_gpio_init(void)
4339d5b72deSLars Poeschel {
4349d5b72deSLars Poeschel switch (gpioa_freq) {
4359d5b72deSLars Poeschel case 1000000:
4369d5b72deSLars Poeschel gpioa_clk = VPRBRD_GPIOA_CLK_1MHZ;
4379d5b72deSLars Poeschel break;
4389d5b72deSLars Poeschel case 100000:
4399d5b72deSLars Poeschel gpioa_clk = VPRBRD_GPIOA_CLK_100KHZ;
4409d5b72deSLars Poeschel break;
4419d5b72deSLars Poeschel case 10000:
4429d5b72deSLars Poeschel gpioa_clk = VPRBRD_GPIOA_CLK_10KHZ;
4439d5b72deSLars Poeschel break;
4449d5b72deSLars Poeschel case 1000:
4459d5b72deSLars Poeschel gpioa_clk = VPRBRD_GPIOA_CLK_1KHZ;
4469d5b72deSLars Poeschel break;
4479d5b72deSLars Poeschel case 100:
4489d5b72deSLars Poeschel gpioa_clk = VPRBRD_GPIOA_CLK_100HZ;
4499d5b72deSLars Poeschel break;
4509d5b72deSLars Poeschel case 10:
4519d5b72deSLars Poeschel gpioa_clk = VPRBRD_GPIOA_CLK_10HZ;
4529d5b72deSLars Poeschel break;
4539d5b72deSLars Poeschel default:
4549d5b72deSLars Poeschel pr_warn("invalid gpioa_freq (%d)\n", gpioa_freq);
4559d5b72deSLars Poeschel gpioa_clk = VPRBRD_GPIOA_CLK_1KHZ;
4569d5b72deSLars Poeschel }
4579d5b72deSLars Poeschel
4589d5b72deSLars Poeschel return platform_driver_register(&vprbrd_gpio_driver);
4599d5b72deSLars Poeschel }
4609d5b72deSLars Poeschel subsys_initcall(vprbrd_gpio_init);
4619d5b72deSLars Poeschel
vprbrd_gpio_exit(void)4629d5b72deSLars Poeschel static void __exit vprbrd_gpio_exit(void)
4639d5b72deSLars Poeschel {
4649d5b72deSLars Poeschel platform_driver_unregister(&vprbrd_gpio_driver);
4659d5b72deSLars Poeschel }
4669d5b72deSLars Poeschel module_exit(vprbrd_gpio_exit);
4679d5b72deSLars Poeschel
4689d5b72deSLars Poeschel MODULE_AUTHOR("Lars Poeschel <poeschel@lemonage.de>");
4699d5b72deSLars Poeschel MODULE_DESCRIPTION("GPIO driver for Nano River Techs Viperboard");
4709d5b72deSLars Poeschel MODULE_LICENSE("GPL");
4719d5b72deSLars Poeschel MODULE_ALIAS("platform:viperboard-gpio");
472