Contributors: 1
Author Tokens Token Proportion Commits Commit Proportion
Heiko Stübner 1792 100.00% 3 100.00%
Total 1792 3 


// SPDX-License-Identifier: GPL-2.0-only
/*
 * Driver for LEDs found on QNAP MCU devices
 *
 * Copyright (C) 2024 Heiko Stuebner <heiko@sntech.de>
 */

#include <linux/leds.h>
#include <linux/mfd/qnap-mcu.h>
#include <linux/module.h>
#include <linux/platform_device.h>
#include <linux/slab.h>
#include <uapi/linux/uleds.h>

enum qnap_mcu_err_led_mode {
	QNAP_MCU_ERR_LED_ON = 0,
	QNAP_MCU_ERR_LED_OFF = 1,
	QNAP_MCU_ERR_LED_BLINK_FAST = 2,
	QNAP_MCU_ERR_LED_BLINK_SLOW = 3,
};

struct qnap_mcu_err_led {
	struct qnap_mcu *mcu;
	struct led_classdev cdev;
	char name[LED_MAX_NAME_SIZE];
	u8 num;
	u8 mode;
};

static inline struct qnap_mcu_err_led *
		cdev_to_qnap_mcu_err_led(struct led_classdev *led_cdev)
{
	return container_of(led_cdev, struct qnap_mcu_err_led, cdev);
}

static int qnap_mcu_err_led_set(struct led_classdev *led_cdev,
				enum led_brightness brightness)
{
	struct qnap_mcu_err_led *err_led = cdev_to_qnap_mcu_err_led(led_cdev);
	u8 cmd[] = { '@', 'R', '0' + err_led->num, '0' };

	/* Don't disturb a possible set blink-mode if LED stays on */
	if (brightness != 0 && err_led->mode >= QNAP_MCU_ERR_LED_BLINK_FAST)
		return 0;

	err_led->mode = brightness ? QNAP_MCU_ERR_LED_ON : QNAP_MCU_ERR_LED_OFF;
	cmd[3] = '0' + err_led->mode;

	return qnap_mcu_exec_with_ack(err_led->mcu, cmd, sizeof(cmd));
}

static int qnap_mcu_err_led_blink_set(struct led_classdev *led_cdev,
				      unsigned long *delay_on,
				      unsigned long *delay_off)
{
	struct qnap_mcu_err_led *err_led = cdev_to_qnap_mcu_err_led(led_cdev);
	u8 cmd[] = { '@', 'R', '0' + err_led->num, '0' };

	/* LED is off, nothing to do */
	if (err_led->mode == QNAP_MCU_ERR_LED_OFF)
		return 0;

	if (*delay_on < 500) {
		*delay_on = 100;
		*delay_off = 100;
		err_led->mode = QNAP_MCU_ERR_LED_BLINK_FAST;
	} else {
		*delay_on = 500;
		*delay_off = 500;
		err_led->mode = QNAP_MCU_ERR_LED_BLINK_SLOW;
	}

	cmd[3] = '0' + err_led->mode;

	return qnap_mcu_exec_with_ack(err_led->mcu, cmd, sizeof(cmd));
}

static int qnap_mcu_register_err_led(struct device *dev, struct qnap_mcu *mcu, int num_err_led)
{
	struct qnap_mcu_err_led *err_led;
	int ret;

	err_led = devm_kzalloc(dev, sizeof(*err_led), GFP_KERNEL);
	if (!err_led)
		return -ENOMEM;

	err_led->mcu = mcu;
	err_led->num = num_err_led;
	err_led->mode = QNAP_MCU_ERR_LED_OFF;

	scnprintf(err_led->name, LED_MAX_NAME_SIZE, "hdd%d:red:status", num_err_led + 1);
	err_led->cdev.name = err_led->name;

	err_led->cdev.brightness_set_blocking = qnap_mcu_err_led_set;
	err_led->cdev.blink_set = qnap_mcu_err_led_blink_set;
	err_led->cdev.brightness = 0;
	err_led->cdev.max_brightness = 1;

	ret = devm_led_classdev_register(dev, &err_led->cdev);
	if (ret)
		return ret;

	return qnap_mcu_err_led_set(&err_led->cdev, 0);
}

enum qnap_mcu_usb_led_mode {
	QNAP_MCU_USB_LED_ON = 0,
	QNAP_MCU_USB_LED_OFF = 2,
	QNAP_MCU_USB_LED_BLINK = 1,
};

struct qnap_mcu_usb_led {
	struct qnap_mcu *mcu;
	struct led_classdev cdev;
	u8 mode;
};

static inline struct qnap_mcu_usb_led *
		cdev_to_qnap_mcu_usb_led(struct led_classdev *led_cdev)
{
	return container_of(led_cdev, struct qnap_mcu_usb_led, cdev);
}

static int qnap_mcu_usb_led_set(struct led_classdev *led_cdev,
				enum led_brightness brightness)
{
	struct qnap_mcu_usb_led *usb_led = cdev_to_qnap_mcu_usb_led(led_cdev);
	u8 cmd[] = { '@', 'C', 0 };

	/* Don't disturb a possible set blink-mode if LED stays on */
	if (brightness != 0 && usb_led->mode == QNAP_MCU_USB_LED_BLINK)
		return 0;

	usb_led->mode = brightness ? QNAP_MCU_USB_LED_ON : QNAP_MCU_USB_LED_OFF;

	/*
	 * Byte 3 is shared between the usb led target on/off/blink
	 * and also the buzzer control (in the input driver)
	 */
	cmd[2] = 'E' + usb_led->mode;

	return qnap_mcu_exec_with_ack(usb_led->mcu, cmd, sizeof(cmd));
}

static int qnap_mcu_usb_led_blink_set(struct led_classdev *led_cdev,
				      unsigned long *delay_on,
				      unsigned long *delay_off)
{
	struct qnap_mcu_usb_led *usb_led = cdev_to_qnap_mcu_usb_led(led_cdev);
	u8 cmd[] = { '@', 'C', 0 };

	/* LED is off, nothing to do */
	if (usb_led->mode == QNAP_MCU_USB_LED_OFF)
		return 0;

	*delay_on = 250;
	*delay_off = 250;
	usb_led->mode = QNAP_MCU_USB_LED_BLINK;

	/*
	 * Byte 3 is shared between the USB LED target on/off/blink
	 * and also the buzzer control (in the input driver)
	 */
	cmd[2] = 'E' + usb_led->mode;

	return qnap_mcu_exec_with_ack(usb_led->mcu, cmd, sizeof(cmd));
}

static int qnap_mcu_register_usb_led(struct device *dev, struct qnap_mcu *mcu)
{
	struct qnap_mcu_usb_led *usb_led;
	int ret;

	usb_led = devm_kzalloc(dev, sizeof(*usb_led), GFP_KERNEL);
	if (!usb_led)
		return -ENOMEM;

	usb_led->mcu = mcu;
	usb_led->mode = QNAP_MCU_USB_LED_OFF;
	usb_led->cdev.name = "usb:blue:disk";
	usb_led->cdev.brightness_set_blocking = qnap_mcu_usb_led_set;
	usb_led->cdev.blink_set = qnap_mcu_usb_led_blink_set;
	usb_led->cdev.brightness = 0;
	usb_led->cdev.max_brightness = 1;

	ret = devm_led_classdev_register(dev, &usb_led->cdev);
	if (ret)
		return ret;

	return qnap_mcu_usb_led_set(&usb_led->cdev, 0);
}

enum qnap_mcu_status_led_mode {
	QNAP_MCU_STATUS_LED_OFF = 0,
	QNAP_MCU_STATUS_LED_ON = 1,
	QNAP_MCU_STATUS_LED_BLINK_FAST = 2, /* 500ms / 500ms */
	QNAP_MCU_STATUS_LED_BLINK_SLOW = 3, /* 1s / 1s */
};

struct qnap_mcu_status_led {
	struct led_classdev cdev;
	struct qnap_mcu_status_led *red;
	u8 mode;
};

struct qnap_mcu_status {
	struct qnap_mcu *mcu;
	struct qnap_mcu_status_led red;
	struct qnap_mcu_status_led green;
};

static inline struct qnap_mcu_status_led *cdev_to_qnap_mcu_status_led(struct led_classdev *led_cdev)
{
	return container_of(led_cdev, struct qnap_mcu_status_led, cdev);
}

static inline struct qnap_mcu_status *statusled_to_qnap_mcu_status(struct qnap_mcu_status_led *led)
{
	return container_of(led->red, struct qnap_mcu_status, red);
}

static u8 qnap_mcu_status_led_encode(struct qnap_mcu_status *status)
{
	if (status->red.mode == QNAP_MCU_STATUS_LED_OFF) {
		switch (status->green.mode) {
		case QNAP_MCU_STATUS_LED_OFF:
			return '9';
		case QNAP_MCU_STATUS_LED_ON:
			return '6';
		case QNAP_MCU_STATUS_LED_BLINK_FAST:
			return '5';
		case QNAP_MCU_STATUS_LED_BLINK_SLOW:
			return 'A';
		}
	} else if (status->green.mode == QNAP_MCU_STATUS_LED_OFF) {
		switch (status->red.mode) {
		case QNAP_MCU_STATUS_LED_OFF:
			return '9';
		case QNAP_MCU_STATUS_LED_ON:
			return '7';
		case QNAP_MCU_STATUS_LED_BLINK_FAST:
			return '4';
		case QNAP_MCU_STATUS_LED_BLINK_SLOW:
			return 'B';
		}
	} else if (status->green.mode == QNAP_MCU_STATUS_LED_ON &&
		   status->red.mode == QNAP_MCU_STATUS_LED_ON) {
		return 'D';
	} else if (status->green.mode == QNAP_MCU_STATUS_LED_BLINK_SLOW &&
		   status->red.mode == QNAP_MCU_STATUS_LED_BLINK_SLOW) {
		return 'C';
	}

	/*
	 * Here both LEDs are on in some fashion, either both blinking fast,
	 * or in different speeds, so default to fast blinking for both.
	 */
	return '8';
}

static int qnap_mcu_status_led_update(struct qnap_mcu *mcu,
				      struct qnap_mcu_status *status)
{
	u8 cmd[] = { '@', 'C', 0 };

	cmd[2] = qnap_mcu_status_led_encode(status);

	return qnap_mcu_exec_with_ack(mcu, cmd, sizeof(cmd));
}

static int qnap_mcu_status_led_set(struct led_classdev *led_cdev,
				   enum led_brightness brightness)
{
	struct qnap_mcu_status_led *status_led = cdev_to_qnap_mcu_status_led(led_cdev);
	struct qnap_mcu_status *base = statusled_to_qnap_mcu_status(status_led);

	/* Don't disturb a possible set blink-mode if LED stays on */
	if (brightness != 0 && status_led->mode >= QNAP_MCU_STATUS_LED_BLINK_FAST)
		return 0;

	status_led->mode = brightness ? QNAP_MCU_STATUS_LED_ON :
					QNAP_MCU_STATUS_LED_OFF;

	return qnap_mcu_status_led_update(base->mcu, base);
}

static int qnap_mcu_status_led_blink_set(struct led_classdev *led_cdev,
					 unsigned long *delay_on,
					 unsigned long *delay_off)
{
	struct qnap_mcu_status_led *status_led = cdev_to_qnap_mcu_status_led(led_cdev);
	struct qnap_mcu_status *base = statusled_to_qnap_mcu_status(status_led);

	if (status_led->mode == QNAP_MCU_STATUS_LED_OFF)
		return 0;

	if (*delay_on <= 500) {
		*delay_on = 500;
		*delay_off = 500;
		status_led->mode = QNAP_MCU_STATUS_LED_BLINK_FAST;
	} else {
		*delay_on = 1000;
		*delay_off = 1000;
		status_led->mode = QNAP_MCU_STATUS_LED_BLINK_SLOW;
	}

	return qnap_mcu_status_led_update(base->mcu, base);
}

static int qnap_mcu_register_status_leds(struct device *dev, struct qnap_mcu *mcu)
{
	struct qnap_mcu_status *status;
	int ret;

	status = devm_kzalloc(dev, sizeof(*status), GFP_KERNEL);
	if (!status)
		return -ENOMEM;

	status->mcu = mcu;

	/*
	 * point to the red led, so that statusled_to_qnap_mcu_status
	 * can resolve the main status struct containing both leds
	 */
	status->red.red = &status->red;
	status->green.red = &status->red;

	status->red.mode = QNAP_MCU_STATUS_LED_OFF;
	status->red.cdev.name = "red:status";
	status->red.cdev.brightness_set_blocking = qnap_mcu_status_led_set;
	status->red.cdev.blink_set = qnap_mcu_status_led_blink_set;
	status->red.cdev.brightness = 0;
	status->red.cdev.max_brightness = 1;

	status->green.mode = QNAP_MCU_STATUS_LED_OFF;
	status->green.cdev.name = "green:status";
	status->green.cdev.brightness_set_blocking = qnap_mcu_status_led_set;
	status->green.cdev.blink_set = qnap_mcu_status_led_blink_set;
	status->green.cdev.brightness = 0;
	status->green.cdev.max_brightness = 1;

	ret = devm_led_classdev_register(dev, &status->red.cdev);
	if (ret)
		return ret;

	ret = devm_led_classdev_register(dev, &status->green.cdev);
	if (ret)
		return ret;

	return qnap_mcu_status_led_update(status->mcu, status);
}

static int qnap_mcu_leds_probe(struct platform_device *pdev)
{
	struct qnap_mcu *mcu = dev_get_drvdata(pdev->dev.parent);
	const struct qnap_mcu_variant *variant = pdev->dev.platform_data;
	int ret;

	for (int i = 0; i < variant->num_drives; i++) {
		ret = qnap_mcu_register_err_led(&pdev->dev, mcu, i);
		if (ret)
			return dev_err_probe(&pdev->dev, ret,
					"failed to register error LED %d\n", i);
	}

	if (variant->usb_led) {
		ret = qnap_mcu_register_usb_led(&pdev->dev, mcu);
		if (ret)
			return dev_err_probe(&pdev->dev, ret,
					"failed to register USB LED\n");
	}

	ret = qnap_mcu_register_status_leds(&pdev->dev, mcu);
	if (ret)
		return dev_err_probe(&pdev->dev, ret,
				     "failed to register status LEDs\n");

	return 0;
}

static struct platform_driver qnap_mcu_leds_driver = {
	.probe = qnap_mcu_leds_probe,
	.driver = {
		.name = "qnap-mcu-leds",
	},
};
module_platform_driver(qnap_mcu_leds_driver);

MODULE_ALIAS("platform:qnap-mcu-leds");
MODULE_AUTHOR("Heiko Stuebner <heiko@sntech.de>");
MODULE_DESCRIPTION("QNAP MCU LEDs driver");
MODULE_LICENSE("GPL");