Commit 55e2d1ee authored by Bartosz Golaszewski's avatar Bartosz Golaszewski
Browse files

gpio: viperboard: use new GPIO line value setter callbacks

struct gpio_chip now has callbacks for setting line values that return
an integer, allowing to indicate failures. Convert the driver to using
them.

Link: https://lore.kernel.org/r/20250707-gpiochip-set-rv-gpio-round4-v1-11-35668aaaf6d2@linaro.org


Signed-off-by: default avatarBartosz Golaszewski <bartosz.golaszewski@linaro.org>
parent 42fbbe31
Loading
Loading
Loading
Loading
+68 −58
Original line number Diff line number Diff line
@@ -128,15 +128,17 @@ static int vprbrd_gpioa_get(struct gpio_chip *chip,
	return answer;
}

static void vprbrd_gpioa_set(struct gpio_chip *chip,
		unsigned int offset, int value)
static int vprbrd_gpioa_set(struct gpio_chip *chip, unsigned int offset,
			    int value)
{
	int ret;
	int ret = 0;
	struct vprbrd_gpio *gpio = gpiochip_get_data(chip);
	struct vprbrd *vb = gpio->vb;
	struct vprbrd_gpioa_msg *gamsg = (struct vprbrd_gpioa_msg *)vb->buf;

	if (gpio->gpioa_out & (1 << offset)) {
	if (!(gpio->gpioa_out & (1 << offset)))
		return 0;

	if (value)
		gpio->gpioa_val |= (1 << offset);
	else
@@ -156,17 +158,20 @@ static void vprbrd_gpioa_set(struct gpio_chip *chip,
	gamsg->answer = 0x00;
	gamsg->__fill = 0x00;

		ret = usb_control_msg(vb->usb_dev,
			usb_sndctrlpipe(vb->usb_dev, 0),
	ret = usb_control_msg(vb->usb_dev, usb_sndctrlpipe(vb->usb_dev, 0),
			      VPRBRD_USB_REQUEST_GPIOA, VPRBRD_USB_TYPE_OUT,
			      0x0000, 0x0000, gamsg,
			sizeof(struct vprbrd_gpioa_msg), VPRBRD_USB_TIMEOUT_MS);
			      sizeof(struct vprbrd_gpioa_msg),
			      VPRBRD_USB_TIMEOUT_MS);

	mutex_unlock(&vb->lock);

		if (ret != sizeof(struct vprbrd_gpioa_msg))
	if (ret != sizeof(struct vprbrd_gpioa_msg)) {
		dev_err(chip->parent, "usb error setting pin value\n");
		return -EREMOTEIO;
	}

	return 0;
}

static int vprbrd_gpioa_direction_input(struct gpio_chip *chip,
@@ -304,15 +309,17 @@ static int vprbrd_gpiob_get(struct gpio_chip *chip,
	return (gpio->gpiob_val >> offset) & 0x1;
}

static void vprbrd_gpiob_set(struct gpio_chip *chip,
		unsigned int offset, int value)
static int vprbrd_gpiob_set(struct gpio_chip *chip, unsigned int offset,
			    int value)
{
	int ret;
	struct vprbrd_gpio *gpio = gpiochip_get_data(chip);
	struct vprbrd *vb = gpio->vb;
	struct vprbrd_gpiob_msg *gbmsg = (struct vprbrd_gpiob_msg *)vb->buf;

	if (gpio->gpiob_out & (1 << offset)) {
	if (!(gpio->gpiob_out & (1 << offset)))
		return 0;

	if (value)
		gpio->gpiob_val |= (1 << offset);
	else
@@ -324,17 +331,20 @@ static void vprbrd_gpiob_set(struct gpio_chip *chip,
	gbmsg->val = cpu_to_be16(value << offset);
	gbmsg->mask = cpu_to_be16(0x0001 << offset);

		ret = usb_control_msg(vb->usb_dev,
			usb_sndctrlpipe(vb->usb_dev, 0),
	ret = usb_control_msg(vb->usb_dev, usb_sndctrlpipe(vb->usb_dev, 0),
			      VPRBRD_USB_REQUEST_GPIOB, VPRBRD_USB_TYPE_OUT,
			      0x0000, 0x0000, gbmsg,
			sizeof(struct vprbrd_gpiob_msg), VPRBRD_USB_TIMEOUT_MS);
			      sizeof(struct vprbrd_gpiob_msg),
			      VPRBRD_USB_TIMEOUT_MS);

	mutex_unlock(&vb->lock);

		if (ret != sizeof(struct vprbrd_gpiob_msg))
	if (ret != sizeof(struct vprbrd_gpiob_msg)) {
		dev_err(chip->parent, "usb error setting pin value\n");
		return -EREMOTEIO;
	}

	return 0;
}

static int vprbrd_gpiob_direction_input(struct gpio_chip *chip,
@@ -370,14 +380,14 @@ static int vprbrd_gpiob_direction_output(struct gpio_chip *chip,
	mutex_lock(&vb->lock);

	ret = vprbrd_gpiob_setdir(vb, offset, 1);
	if (ret)
	if (ret) {
		dev_err(chip->parent, "usb error setting pin to output\n");
		return ret;
	}

	mutex_unlock(&vb->lock);

	vprbrd_gpiob_set(chip, offset, value);

	return ret;
	return vprbrd_gpiob_set(chip, offset, value);
}

/* ----- end of gpio b chip ---------------------------------------------- */
@@ -400,7 +410,7 @@ static int vprbrd_gpio_probe(struct platform_device *pdev)
	vb_gpio->gpioa.base = -1;
	vb_gpio->gpioa.ngpio = 16;
	vb_gpio->gpioa.can_sleep = true;
	vb_gpio->gpioa.set = vprbrd_gpioa_set;
	vb_gpio->gpioa.set_rv = vprbrd_gpioa_set;
	vb_gpio->gpioa.get = vprbrd_gpioa_get;
	vb_gpio->gpioa.direction_input = vprbrd_gpioa_direction_input;
	vb_gpio->gpioa.direction_output = vprbrd_gpioa_direction_output;
@@ -416,7 +426,7 @@ static int vprbrd_gpio_probe(struct platform_device *pdev)
	vb_gpio->gpiob.base = -1;
	vb_gpio->gpiob.ngpio = 16;
	vb_gpio->gpiob.can_sleep = true;
	vb_gpio->gpiob.set = vprbrd_gpiob_set;
	vb_gpio->gpiob.set_rv = vprbrd_gpiob_set;
	vb_gpio->gpiob.get = vprbrd_gpiob_get;
	vb_gpio->gpiob.direction_input = vprbrd_gpiob_direction_input;
	vb_gpio->gpiob.direction_output = vprbrd_gpiob_direction_output;