^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1) // SPDX-License-Identifier: GPL-2.0+
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 2) /*
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 3) * Nano River Technologies viperboard GPIO lib driver
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 4) *
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 5) * (C) 2012 by Lemonage GmbH
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 6) * Author: Lars Poeschel <poeschel@lemonage.de>
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 7) * All rights reserved.
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 8) */
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 9)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 10) #include <linux/kernel.h>
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 11) #include <linux/errno.h>
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 12) #include <linux/module.h>
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 13) #include <linux/slab.h>
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 14) #include <linux/types.h>
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 15) #include <linux/mutex.h>
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 16) #include <linux/platform_device.h>
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 17) #include <linux/usb.h>
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 18) #include <linux/gpio/driver.h>
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 19)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 20) #include <linux/mfd/viperboard.h>
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 21)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 22) #define VPRBRD_GPIOA_CLK_1MHZ 0
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 23) #define VPRBRD_GPIOA_CLK_100KHZ 1
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 24) #define VPRBRD_GPIOA_CLK_10KHZ 2
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 25) #define VPRBRD_GPIOA_CLK_1KHZ 3
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 26) #define VPRBRD_GPIOA_CLK_100HZ 4
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 27) #define VPRBRD_GPIOA_CLK_10HZ 5
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 28)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 29) #define VPRBRD_GPIOA_FREQ_DEFAULT 1000
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 30)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 31) #define VPRBRD_GPIOA_CMD_CONT 0x00
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 32) #define VPRBRD_GPIOA_CMD_PULSE 0x01
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 33) #define VPRBRD_GPIOA_CMD_PWM 0x02
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 34) #define VPRBRD_GPIOA_CMD_SETOUT 0x03
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 35) #define VPRBRD_GPIOA_CMD_SETIN 0x04
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 36) #define VPRBRD_GPIOA_CMD_SETINT 0x05
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 37) #define VPRBRD_GPIOA_CMD_GETIN 0x06
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 38)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 39) #define VPRBRD_GPIOB_CMD_SETDIR 0x00
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 40) #define VPRBRD_GPIOB_CMD_SETVAL 0x01
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 41)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 42) struct vprbrd_gpioa_msg {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 43) u8 cmd;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 44) u8 clk;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 45) u8 offset;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 46) u8 t1;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 47) u8 t2;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 48) u8 invert;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 49) u8 pwmlevel;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 50) u8 outval;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 51) u8 risefall;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 52) u8 answer;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 53) u8 __fill;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 54) } __packed;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 55)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 56) struct vprbrd_gpiob_msg {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 57) u8 cmd;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 58) u16 val;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 59) u16 mask;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 60) } __packed;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 61)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 62) struct vprbrd_gpio {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 63) struct gpio_chip gpioa; /* gpio a related things */
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 64) u32 gpioa_out;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 65) u32 gpioa_val;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 66) struct gpio_chip gpiob; /* gpio b related things */
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 67) u32 gpiob_out;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 68) u32 gpiob_val;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 69) struct vprbrd *vb;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 70) };
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 71)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 72) /* gpioa sampling clock module parameter */
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 73) static unsigned char gpioa_clk;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 74) static unsigned int gpioa_freq = VPRBRD_GPIOA_FREQ_DEFAULT;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 75) module_param(gpioa_freq, uint, 0);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 76) MODULE_PARM_DESC(gpioa_freq,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 77) "gpio-a sampling freq in Hz (default is 1000Hz) valid values: 10, 100, 1000, 10000, 100000, 1000000");
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 78)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 79) /* ----- begin of gipo a chip -------------------------------------------- */
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 80)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 81) static int vprbrd_gpioa_get(struct gpio_chip *chip,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 82) unsigned int offset)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 83) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 84) int ret, answer, error = 0;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 85) struct vprbrd_gpio *gpio = gpiochip_get_data(chip);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 86) struct vprbrd *vb = gpio->vb;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 87) struct vprbrd_gpioa_msg *gamsg = (struct vprbrd_gpioa_msg *)vb->buf;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 88)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 89) /* if io is set to output, just return the saved value */
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 90) if (gpio->gpioa_out & (1 << offset))
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 91) return !!(gpio->gpioa_val & (1 << offset));
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 92)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 93) mutex_lock(&vb->lock);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 94)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 95) gamsg->cmd = VPRBRD_GPIOA_CMD_GETIN;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 96) gamsg->clk = 0x00;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 97) gamsg->offset = offset;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 98) gamsg->t1 = 0x00;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 99) gamsg->t2 = 0x00;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 100) gamsg->invert = 0x00;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 101) gamsg->pwmlevel = 0x00;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 102) gamsg->outval = 0x00;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 103) gamsg->risefall = 0x00;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 104) gamsg->answer = 0x00;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 105) gamsg->__fill = 0x00;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 106)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 107) ret = usb_control_msg(vb->usb_dev, usb_sndctrlpipe(vb->usb_dev, 0),
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 108) VPRBRD_USB_REQUEST_GPIOA, VPRBRD_USB_TYPE_OUT, 0x0000,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 109) 0x0000, gamsg, sizeof(struct vprbrd_gpioa_msg),
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 110) VPRBRD_USB_TIMEOUT_MS);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 111) if (ret != sizeof(struct vprbrd_gpioa_msg))
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 112) error = -EREMOTEIO;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 113)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 114) ret = usb_control_msg(vb->usb_dev, usb_rcvctrlpipe(vb->usb_dev, 0),
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 115) VPRBRD_USB_REQUEST_GPIOA, VPRBRD_USB_TYPE_IN, 0x0000,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 116) 0x0000, gamsg, sizeof(struct vprbrd_gpioa_msg),
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 117) VPRBRD_USB_TIMEOUT_MS);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 118) answer = gamsg->answer & 0x01;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 119)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 120) mutex_unlock(&vb->lock);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 121)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 122) if (ret != sizeof(struct vprbrd_gpioa_msg))
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 123) error = -EREMOTEIO;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 124)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 125) if (error)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 126) return error;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 127)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 128) return answer;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 129) }
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 130)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 131) static void vprbrd_gpioa_set(struct gpio_chip *chip,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 132) unsigned int offset, int value)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 133) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 134) int ret;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 135) struct vprbrd_gpio *gpio = gpiochip_get_data(chip);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 136) struct vprbrd *vb = gpio->vb;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 137) struct vprbrd_gpioa_msg *gamsg = (struct vprbrd_gpioa_msg *)vb->buf;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 138)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 139) if (gpio->gpioa_out & (1 << offset)) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 140) if (value)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 141) gpio->gpioa_val |= (1 << offset);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 142) else
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 143) gpio->gpioa_val &= ~(1 << offset);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 144)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 145) mutex_lock(&vb->lock);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 146)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 147) gamsg->cmd = VPRBRD_GPIOA_CMD_SETOUT;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 148) gamsg->clk = 0x00;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 149) gamsg->offset = offset;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 150) gamsg->t1 = 0x00;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 151) gamsg->t2 = 0x00;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 152) gamsg->invert = 0x00;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 153) gamsg->pwmlevel = 0x00;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 154) gamsg->outval = value;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 155) gamsg->risefall = 0x00;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 156) gamsg->answer = 0x00;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 157) gamsg->__fill = 0x00;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 158)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 159) ret = usb_control_msg(vb->usb_dev,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 160) usb_sndctrlpipe(vb->usb_dev, 0),
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 161) VPRBRD_USB_REQUEST_GPIOA, VPRBRD_USB_TYPE_OUT,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 162) 0x0000, 0x0000, gamsg,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 163) sizeof(struct vprbrd_gpioa_msg), VPRBRD_USB_TIMEOUT_MS);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 164)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 165) mutex_unlock(&vb->lock);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 166)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 167) if (ret != sizeof(struct vprbrd_gpioa_msg))
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 168) dev_err(chip->parent, "usb error setting pin value\n");
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 169) }
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 170) }
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 171)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 172) static int vprbrd_gpioa_direction_input(struct gpio_chip *chip,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 173) unsigned int offset)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 174) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 175) int ret;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 176) struct vprbrd_gpio *gpio = gpiochip_get_data(chip);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 177) struct vprbrd *vb = gpio->vb;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 178) struct vprbrd_gpioa_msg *gamsg = (struct vprbrd_gpioa_msg *)vb->buf;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 179)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 180) gpio->gpioa_out &= ~(1 << offset);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 181)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 182) mutex_lock(&vb->lock);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 183)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 184) gamsg->cmd = VPRBRD_GPIOA_CMD_SETIN;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 185) gamsg->clk = gpioa_clk;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 186) gamsg->offset = offset;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 187) gamsg->t1 = 0x00;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 188) gamsg->t2 = 0x00;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 189) gamsg->invert = 0x00;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 190) gamsg->pwmlevel = 0x00;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 191) gamsg->outval = 0x00;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 192) gamsg->risefall = 0x00;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 193) gamsg->answer = 0x00;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 194) gamsg->__fill = 0x00;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 195)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 196) ret = usb_control_msg(vb->usb_dev, usb_sndctrlpipe(vb->usb_dev, 0),
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 197) VPRBRD_USB_REQUEST_GPIOA, VPRBRD_USB_TYPE_OUT, 0x0000,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 198) 0x0000, gamsg, sizeof(struct vprbrd_gpioa_msg),
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 199) VPRBRD_USB_TIMEOUT_MS);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 200)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 201) mutex_unlock(&vb->lock);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 202)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 203) if (ret != sizeof(struct vprbrd_gpioa_msg))
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 204) return -EREMOTEIO;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 205)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 206) return 0;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 207) }
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 208)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 209) static int vprbrd_gpioa_direction_output(struct gpio_chip *chip,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 210) unsigned int offset, int value)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 211) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 212) int ret;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 213) struct vprbrd_gpio *gpio = gpiochip_get_data(chip);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 214) struct vprbrd *vb = gpio->vb;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 215) struct vprbrd_gpioa_msg *gamsg = (struct vprbrd_gpioa_msg *)vb->buf;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 216)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 217) gpio->gpioa_out |= (1 << offset);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 218) if (value)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 219) gpio->gpioa_val |= (1 << offset);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 220) else
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 221) gpio->gpioa_val &= ~(1 << offset);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 222)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 223) mutex_lock(&vb->lock);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 224)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 225) gamsg->cmd = VPRBRD_GPIOA_CMD_SETOUT;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 226) gamsg->clk = 0x00;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 227) gamsg->offset = offset;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 228) gamsg->t1 = 0x00;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 229) gamsg->t2 = 0x00;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 230) gamsg->invert = 0x00;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 231) gamsg->pwmlevel = 0x00;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 232) gamsg->outval = value;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 233) gamsg->risefall = 0x00;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 234) gamsg->answer = 0x00;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 235) gamsg->__fill = 0x00;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 236)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 237) ret = usb_control_msg(vb->usb_dev, usb_sndctrlpipe(vb->usb_dev, 0),
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 238) VPRBRD_USB_REQUEST_GPIOA, VPRBRD_USB_TYPE_OUT, 0x0000,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 239) 0x0000, gamsg, sizeof(struct vprbrd_gpioa_msg),
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 240) VPRBRD_USB_TIMEOUT_MS);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 241)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 242) mutex_unlock(&vb->lock);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 243)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 244) if (ret != sizeof(struct vprbrd_gpioa_msg))
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 245) return -EREMOTEIO;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 246)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 247) return 0;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 248) }
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 249)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 250) /* ----- end of gpio a chip ---------------------------------------------- */
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 251)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 252) /* ----- begin of gipo b chip -------------------------------------------- */
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 253)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 254) static int vprbrd_gpiob_setdir(struct vprbrd *vb, unsigned int offset,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 255) unsigned int dir)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 256) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 257) struct vprbrd_gpiob_msg *gbmsg = (struct vprbrd_gpiob_msg *)vb->buf;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 258) int ret;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 259)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 260) gbmsg->cmd = VPRBRD_GPIOB_CMD_SETDIR;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 261) gbmsg->val = cpu_to_be16(dir << offset);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 262) gbmsg->mask = cpu_to_be16(0x0001 << offset);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 263)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 264) ret = usb_control_msg(vb->usb_dev, usb_sndctrlpipe(vb->usb_dev, 0),
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 265) VPRBRD_USB_REQUEST_GPIOB, VPRBRD_USB_TYPE_OUT, 0x0000,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 266) 0x0000, gbmsg, sizeof(struct vprbrd_gpiob_msg),
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 267) VPRBRD_USB_TIMEOUT_MS);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 268)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 269) if (ret != sizeof(struct vprbrd_gpiob_msg))
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 270) return -EREMOTEIO;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 271)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 272) return 0;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 273) }
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 274)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 275) static int vprbrd_gpiob_get(struct gpio_chip *chip,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 276) unsigned int offset)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 277) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 278) int ret;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 279) u16 val;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 280) struct vprbrd_gpio *gpio = gpiochip_get_data(chip);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 281) struct vprbrd *vb = gpio->vb;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 282) struct vprbrd_gpiob_msg *gbmsg = (struct vprbrd_gpiob_msg *)vb->buf;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 283)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 284) /* if io is set to output, just return the saved value */
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 285) if (gpio->gpiob_out & (1 << offset))
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 286) return gpio->gpiob_val & (1 << offset);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 287)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 288) mutex_lock(&vb->lock);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 289)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 290) ret = usb_control_msg(vb->usb_dev, usb_rcvctrlpipe(vb->usb_dev, 0),
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 291) VPRBRD_USB_REQUEST_GPIOB, VPRBRD_USB_TYPE_IN, 0x0000,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 292) 0x0000, gbmsg, sizeof(struct vprbrd_gpiob_msg),
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 293) VPRBRD_USB_TIMEOUT_MS);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 294) val = gbmsg->val;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 295)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 296) mutex_unlock(&vb->lock);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 297)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 298) if (ret != sizeof(struct vprbrd_gpiob_msg))
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 299) return ret;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 300)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 301) /* cache the read values */
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 302) gpio->gpiob_val = be16_to_cpu(val);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 303)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 304) return (gpio->gpiob_val >> offset) & 0x1;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 305) }
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 306)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 307) static void vprbrd_gpiob_set(struct gpio_chip *chip,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 308) unsigned int offset, int value)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 309) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 310) int ret;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 311) struct vprbrd_gpio *gpio = gpiochip_get_data(chip);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 312) struct vprbrd *vb = gpio->vb;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 313) struct vprbrd_gpiob_msg *gbmsg = (struct vprbrd_gpiob_msg *)vb->buf;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 314)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 315) if (gpio->gpiob_out & (1 << offset)) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 316) if (value)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 317) gpio->gpiob_val |= (1 << offset);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 318) else
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 319) gpio->gpiob_val &= ~(1 << offset);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 320)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 321) mutex_lock(&vb->lock);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 322)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 323) gbmsg->cmd = VPRBRD_GPIOB_CMD_SETVAL;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 324) gbmsg->val = cpu_to_be16(value << offset);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 325) gbmsg->mask = cpu_to_be16(0x0001 << offset);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 326)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 327) ret = usb_control_msg(vb->usb_dev,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 328) usb_sndctrlpipe(vb->usb_dev, 0),
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 329) VPRBRD_USB_REQUEST_GPIOB, VPRBRD_USB_TYPE_OUT,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 330) 0x0000, 0x0000, gbmsg,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 331) sizeof(struct vprbrd_gpiob_msg), VPRBRD_USB_TIMEOUT_MS);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 332)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 333) mutex_unlock(&vb->lock);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 334)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 335) if (ret != sizeof(struct vprbrd_gpiob_msg))
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 336) dev_err(chip->parent, "usb error setting pin value\n");
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 337) }
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 338) }
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 339)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 340) static int vprbrd_gpiob_direction_input(struct gpio_chip *chip,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 341) unsigned int offset)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 342) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 343) int ret;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 344) struct vprbrd_gpio *gpio = gpiochip_get_data(chip);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 345) struct vprbrd *vb = gpio->vb;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 346)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 347) gpio->gpiob_out &= ~(1 << offset);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 348)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 349) mutex_lock(&vb->lock);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 350)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 351) ret = vprbrd_gpiob_setdir(vb, offset, 0);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 352)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 353) mutex_unlock(&vb->lock);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 354)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 355) if (ret)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 356) dev_err(chip->parent, "usb error setting pin to input\n");
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 357)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 358) return ret;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 359) }
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 360)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 361) static int vprbrd_gpiob_direction_output(struct gpio_chip *chip,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 362) unsigned int offset, int value)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 363) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 364) int ret;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 365) struct vprbrd_gpio *gpio = gpiochip_get_data(chip);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 366) struct vprbrd *vb = gpio->vb;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 367)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 368) gpio->gpiob_out |= (1 << offset);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 369)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 370) mutex_lock(&vb->lock);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 371)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 372) ret = vprbrd_gpiob_setdir(vb, offset, 1);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 373) if (ret)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 374) dev_err(chip->parent, "usb error setting pin to output\n");
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 375)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 376) mutex_unlock(&vb->lock);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 377)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 378) vprbrd_gpiob_set(chip, offset, value);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 379)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 380) return ret;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 381) }
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 382)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 383) /* ----- end of gpio b chip ---------------------------------------------- */
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 384)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 385) static int vprbrd_gpio_probe(struct platform_device *pdev)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 386) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 387) struct vprbrd *vb = dev_get_drvdata(pdev->dev.parent);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 388) struct vprbrd_gpio *vb_gpio;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 389) int ret;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 390)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 391) vb_gpio = devm_kzalloc(&pdev->dev, sizeof(*vb_gpio), GFP_KERNEL);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 392) if (vb_gpio == NULL)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 393) return -ENOMEM;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 394)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 395) vb_gpio->vb = vb;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 396) /* registering gpio a */
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 397) vb_gpio->gpioa.label = "viperboard gpio a";
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 398) vb_gpio->gpioa.parent = &pdev->dev;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 399) vb_gpio->gpioa.owner = THIS_MODULE;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 400) vb_gpio->gpioa.base = -1;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 401) vb_gpio->gpioa.ngpio = 16;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 402) vb_gpio->gpioa.can_sleep = true;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 403) vb_gpio->gpioa.set = vprbrd_gpioa_set;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 404) vb_gpio->gpioa.get = vprbrd_gpioa_get;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 405) vb_gpio->gpioa.direction_input = vprbrd_gpioa_direction_input;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 406) vb_gpio->gpioa.direction_output = vprbrd_gpioa_direction_output;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 407) ret = devm_gpiochip_add_data(&pdev->dev, &vb_gpio->gpioa, vb_gpio);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 408) if (ret < 0) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 409) dev_err(vb_gpio->gpioa.parent, "could not add gpio a");
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 410) return ret;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 411) }
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 412)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 413) /* registering gpio b */
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 414) vb_gpio->gpiob.label = "viperboard gpio b";
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 415) vb_gpio->gpiob.parent = &pdev->dev;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 416) vb_gpio->gpiob.owner = THIS_MODULE;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 417) vb_gpio->gpiob.base = -1;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 418) vb_gpio->gpiob.ngpio = 16;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 419) vb_gpio->gpiob.can_sleep = true;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 420) vb_gpio->gpiob.set = vprbrd_gpiob_set;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 421) vb_gpio->gpiob.get = vprbrd_gpiob_get;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 422) vb_gpio->gpiob.direction_input = vprbrd_gpiob_direction_input;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 423) vb_gpio->gpiob.direction_output = vprbrd_gpiob_direction_output;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 424) ret = devm_gpiochip_add_data(&pdev->dev, &vb_gpio->gpiob, vb_gpio);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 425) if (ret < 0) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 426) dev_err(vb_gpio->gpiob.parent, "could not add gpio b");
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 427) return ret;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 428) }
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 429)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 430) platform_set_drvdata(pdev, vb_gpio);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 431)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 432) return ret;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 433) }
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 434)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 435) static struct platform_driver vprbrd_gpio_driver = {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 436) .driver.name = "viperboard-gpio",
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 437) .probe = vprbrd_gpio_probe,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 438) };
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 439)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 440) static int __init vprbrd_gpio_init(void)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 441) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 442) switch (gpioa_freq) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 443) case 1000000:
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 444) gpioa_clk = VPRBRD_GPIOA_CLK_1MHZ;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 445) break;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 446) case 100000:
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 447) gpioa_clk = VPRBRD_GPIOA_CLK_100KHZ;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 448) break;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 449) case 10000:
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 450) gpioa_clk = VPRBRD_GPIOA_CLK_10KHZ;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 451) break;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 452) case 1000:
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 453) gpioa_clk = VPRBRD_GPIOA_CLK_1KHZ;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 454) break;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 455) case 100:
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 456) gpioa_clk = VPRBRD_GPIOA_CLK_100HZ;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 457) break;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 458) case 10:
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 459) gpioa_clk = VPRBRD_GPIOA_CLK_10HZ;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 460) break;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 461) default:
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 462) pr_warn("invalid gpioa_freq (%d)\n", gpioa_freq);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 463) gpioa_clk = VPRBRD_GPIOA_CLK_1KHZ;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 464) }
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 465)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 466) return platform_driver_register(&vprbrd_gpio_driver);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 467) }
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 468) subsys_initcall(vprbrd_gpio_init);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 469)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 470) static void __exit vprbrd_gpio_exit(void)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 471) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 472) platform_driver_unregister(&vprbrd_gpio_driver);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 473) }
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 474) module_exit(vprbrd_gpio_exit);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 475)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 476) MODULE_AUTHOR("Lars Poeschel <poeschel@lemonage.de>");
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 477) MODULE_DESCRIPTION("GPIO driver for Nano River Techs Viperboard");
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 478) MODULE_LICENSE("GPL");
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 479) MODULE_ALIAS("platform:viperboard-gpio");
Orange Pi5 kernel
Deprecated Linux kernel 5.10.110 for OrangePi 5/5B/5+ boards
3 Commits
0 Branches
0 Tags