[linux-2.6-block.git] / drivers / leds / leds-nic78bx.c

// SPDX-License-Identifier: GPL-2.0-or-later
/*
 * Copyright (C) 2016 National Instruments Corp.
 */

#include <linux/acpi.h>
#include <linux/leds.h>
#include <linux/module.h>
#include <linux/platform_device.h>
#include <linux/spinlock.h>

#define NIC78BX_USER1_LED_MASK		0x3
#define NIC78BX_USER1_GREEN_LED		BIT(0)
#define NIC78BX_USER1_YELLOW_LED	BIT(1)

#define NIC78BX_USER2_LED_MASK		0xC
#define NIC78BX_USER2_GREEN_LED		BIT(2)
#define NIC78BX_USER2_YELLOW_LED	BIT(3)

#define NIC78BX_LOCK_REG_OFFSET		1
#define NIC78BX_LOCK_VALUE		0xA5
#define NIC78BX_UNLOCK_VALUE		0x5A

#define NIC78BX_USER_LED_IO_SIZE	2

struct nic78bx_led_data {
	u16 io_base;
	spinlock_t lock;
	struct platform_device *pdev;
};

struct nic78bx_led {
	u8 bit;
	u8 mask;
	struct nic78bx_led_data *data;
	struct led_classdev cdev;
};

static inline struct nic78bx_led *to_nic78bx_led(struct led_classdev *cdev)
{
	return container_of(cdev, struct nic78bx_led, cdev);
}

static void nic78bx_brightness_set(struct led_classdev *cdev,
				  enum led_brightness brightness)
{
	struct nic78bx_led *nled = to_nic78bx_led(cdev);
	unsigned long flags;
	u8 value;

	spin_lock_irqsave(&nled->data->lock, flags);
	value = inb(nled->data->io_base);

	if (brightness) {
		value &= ~nled->mask;
		value |= nled->bit;
	} else {
		value &= ~nled->bit;
	}

	outb(value, nled->data->io_base);
	spin_unlock_irqrestore(&nled->data->lock, flags);
}

static enum led_brightness nic78bx_brightness_get(struct led_classdev *cdev)
{
	struct nic78bx_led *nled = to_nic78bx_led(cdev);
	unsigned long flags;
	u8 value;

	spin_lock_irqsave(&nled->data->lock, flags);
	value = inb(nled->data->io_base);
	spin_unlock_irqrestore(&nled->data->lock, flags);

	return (value & nled->bit) ? 1 : LED_OFF;
}

static struct nic78bx_led nic78bx_leds[] = {
	{
		.bit = NIC78BX_USER1_GREEN_LED,
		.mask = NIC78BX_USER1_LED_MASK,
		.cdev = {
			.name = "nilrt:green:user1",
			.max_brightness = 1,
			.brightness_set = nic78bx_brightness_set,
			.brightness_get = nic78bx_brightness_get,
		}
	},
	{
		.bit = NIC78BX_USER1_YELLOW_LED,
		.mask = NIC78BX_USER1_LED_MASK,
		.cdev = {
			.name = "nilrt:yellow:user1",
			.max_brightness = 1,
			.brightness_set = nic78bx_brightness_set,
			.brightness_get = nic78bx_brightness_get,
		}
	},
	{
		.bit = NIC78BX_USER2_GREEN_LED,
		.mask = NIC78BX_USER2_LED_MASK,
		.cdev = {
			.name = "nilrt:green:user2",
			.max_brightness = 1,
			.brightness_set = nic78bx_brightness_set,
			.brightness_get = nic78bx_brightness_get,
		}
	},
	{
		.bit = NIC78BX_USER2_YELLOW_LED,
		.mask = NIC78BX_USER2_LED_MASK,
		.cdev = {
			.name = "nilrt:yellow:user2",
			.max_brightness = 1,
			.brightness_set = nic78bx_brightness_set,
			.brightness_get = nic78bx_brightness_get,
		}
	}
};

static void lock_led_reg_action(void *data)
{
	struct nic78bx_led_data *led_data = data;

	/* Lock LED register */
	outb(NIC78BX_LOCK_VALUE,
	     led_data->io_base + NIC78BX_LOCK_REG_OFFSET);
}

static int nic78bx_probe(struct platform_device *pdev)
{
	struct device *dev = &pdev->dev;
	struct nic78bx_led_data *led_data;
	struct resource *io_rc;
	int ret, i;

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

	led_data->pdev = pdev;
	platform_set_drvdata(pdev, led_data);

	io_rc = platform_get_resource(pdev, IORESOURCE_IO, 0);
	if (!io_rc) {
		dev_err(dev, "missing IO resources\n");
		return -EINVAL;
	}

	if (resource_size(io_rc) < NIC78BX_USER_LED_IO_SIZE) {
		dev_err(dev, "IO region too small\n");
		return -EINVAL;
	}

	if (!devm_request_region(dev, io_rc->start, resource_size(io_rc),
				 KBUILD_MODNAME)) {
		dev_err(dev, "failed to get IO region\n");
		return -EBUSY;
	}

	led_data->io_base = io_rc->start;
	spin_lock_init(&led_data->lock);

	ret = devm_add_action(dev, lock_led_reg_action, led_data);
	if (ret)
		return ret;

	for (i = 0; i < ARRAY_SIZE(nic78bx_leds); i++) {
		nic78bx_leds[i].data = led_data;

		ret = devm_led_classdev_register(dev, &nic78bx_leds[i].cdev);
		if (ret)
			return ret;
	}

	/* Unlock LED register */
	outb(NIC78BX_UNLOCK_VALUE,
	     led_data->io_base + NIC78BX_LOCK_REG_OFFSET);

	return ret;
}

static const struct acpi_device_id led_device_ids[] = {
	{"NIC78B3", 0},
	{"", 0},
};
MODULE_DEVICE_TABLE(acpi, led_device_ids);

static struct platform_driver led_driver = {
	.probe = nic78bx_probe,
	.driver = {
		.name = KBUILD_MODNAME,
		.acpi_match_table = ACPI_PTR(led_device_ids),
	},
};

module_platform_driver(led_driver);

MODULE_DESCRIPTION("National Instruments PXI User LEDs driver");
MODULE_AUTHOR("Hui Chun Ong <hui.chun.ong@ni.com>");
MODULE_LICENSE("GPL");
Commit	Line	Data
c942fddf	1	// SPDX-License-Identifier: GPL-2.0-or-later
8338eab5 HCO	2	/*
8338eab5 HCO	3	* Copyright (C) 2016 National Instruments Corp.
8338eab5 HCO	4	*/
	5
	6	#include <linux/acpi.h>
	7	#include <linux/leds.h>
	8	#include <linux/module.h>
	9	#include <linux/platform_device.h>
	10	#include <linux/spinlock.h>
	11
	12	#define NIC78BX_USER1_LED_MASK 0x3
	13	#define NIC78BX_USER1_GREEN_LED BIT(0)
	14	#define NIC78BX_USER1_YELLOW_LED BIT(1)
	15
	16	#define NIC78BX_USER2_LED_MASK 0xC
	17	#define NIC78BX_USER2_GREEN_LED BIT(2)
	18	#define NIC78BX_USER2_YELLOW_LED BIT(3)
	19
	20	#define NIC78BX_LOCK_REG_OFFSET 1
	21	#define NIC78BX_LOCK_VALUE 0xA5
	22	#define NIC78BX_UNLOCK_VALUE 0x5A
	23
	24	#define NIC78BX_USER_LED_IO_SIZE 2
	25
	26	struct nic78bx_led_data {
	27	u16 io_base;
	28	spinlock_t lock;
	29	struct platform_device *pdev;
	30	};
	31
	32	struct nic78bx_led {
	33	u8 bit;
	34	u8 mask;
	35	struct nic78bx_led_data *data;
	36	struct led_classdev cdev;
	37	};
	38
	39	static inline struct nic78bx_led to_nic78bx_led(struct led_classdev cdev)
	40	{
	41	return container_of(cdev, struct nic78bx_led, cdev);
	42	}
	43
	44	static void nic78bx_brightness_set(struct led_classdev *cdev,
	45	enum led_brightness brightness)
	46	{
	47	struct nic78bx_led *nled = to_nic78bx_led(cdev);
	48	unsigned long flags;
	49	u8 value;
	50
	51	spin_lock_irqsave(&nled->data->lock, flags);
	52	value = inb(nled->data->io_base);
	53
	54	if (brightness) {
	55	value &= ~nled->mask;
	56	value \|= nled->bit;
	57	} else {
	58	value &= ~nled->bit;
	59	}
	60
	61	outb(value, nled->data->io_base);
	62	spin_unlock_irqrestore(&nled->data->lock, flags);
	63	}
	64
	65	static enum led_brightness nic78bx_brightness_get(struct led_classdev *cdev)
	66	{
	67	struct nic78bx_led *nled = to_nic78bx_led(cdev);
68	unsigned long flags;
69	u8 value;
70
71	spin_lock_irqsave(&nled->data->lock, flags);
72	value = inb(nled->data->io_base);
73	spin_unlock_irqrestore(&nled->data->lock, flags);
74
75	return (value & nled->bit) ? 1 : LED_OFF;
76	}
77
78	static struct nic78bx_led nic78bx_leds[] = {
79	{
80	.bit = NIC78BX_USER1_GREEN_LED,
81	.mask = NIC78BX_USER1_LED_MASK,
82	.cdev = {
83	.name = "nilrt:green:user1",
84	.max_brightness = 1,
85	.brightness_set = nic78bx_brightness_set,
86	.brightness_get = nic78bx_brightness_get,
87	}
88	},
89	{
90	.bit = NIC78BX_USER1_YELLOW_LED,
91	.mask = NIC78BX_USER1_LED_MASK,
92	.cdev = {
93	.name = "nilrt:yellow:user1",
94	.max_brightness = 1,
95	.brightness_set = nic78bx_brightness_set,
96	.brightness_get = nic78bx_brightness_get,
97	}
98	},
99	{
100	.bit = NIC78BX_USER2_GREEN_LED,
101	.mask = NIC78BX_USER2_LED_MASK,
102	.cdev = {
103	.name = "nilrt:green:user2",
104	.max_brightness = 1,
105	.brightness_set = nic78bx_brightness_set,
106	.brightness_get = nic78bx_brightness_get,
107	}
108	},
109	{
110	.bit = NIC78BX_USER2_YELLOW_LED,
111	.mask = NIC78BX_USER2_LED_MASK,
112	.cdev = {
113	.name = "nilrt:yellow:user2",
114	.max_brightness = 1,
115	.brightness_set = nic78bx_brightness_set,
116	.brightness_get = nic78bx_brightness_get,
117	}
118	}
119	};
120
310d2652 GS	121	static void lock_led_reg_action(void *data)
	122	{
	123	struct nic78bx_led_data *led_data = data;
	124
	125	/* Lock LED register */
	126	outb(NIC78BX_LOCK_VALUE,
	127	led_data->io_base + NIC78BX_LOCK_REG_OFFSET);
	128	}
	129
8338eab5 HCO	130	static int nic78bx_probe(struct platform_device *pdev)
	131	{
	132	struct device *dev = &pdev->dev;
	133	struct nic78bx_led_data *led_data;
	134	struct resource *io_rc;
	135	int ret, i;
	136
	137	led_data = devm_kzalloc(dev, sizeof(*led_data), GFP_KERNEL);
	138	if (!led_data)
	139	return -ENOMEM;
	140
	141	led_data->pdev = pdev;
	142	platform_set_drvdata(pdev, led_data);
	143
	144	io_rc = platform_get_resource(pdev, IORESOURCE_IO, 0);
	145	if (!io_rc) {
	146	dev_err(dev, "missing IO resources\n");
	147	return -EINVAL;
	148	}
	149
	150	if (resource_size(io_rc) < NIC78BX_USER_LED_IO_SIZE) {
	151	dev_err(dev, "IO region too small\n");
	152	return -EINVAL;
	153	}
	154
	155	if (!devm_request_region(dev, io_rc->start, resource_size(io_rc),
	156	KBUILD_MODNAME)) {
	157	dev_err(dev, "failed to get IO region\n");
	158	return -EBUSY;
	159	}
	160
	161	led_data->io_base = io_rc->start;
	162	spin_lock_init(&led_data->lock);
	163
310d2652 GS	164	ret = devm_add_action(dev, lock_led_reg_action, led_data);
	165	if (ret)
	166	return ret;
	167
8338eab5 HCO	168	for (i = 0; i < ARRAY_SIZE(nic78bx_leds); i++) {
	169	nic78bx_leds[i].data = led_data;
	170
	171	ret = devm_led_classdev_register(dev, &nic78bx_leds[i].cdev);
	172	if (ret)
	173	return ret;
	174	}
	175
	176	/* Unlock LED register */
	177	outb(NIC78BX_UNLOCK_VALUE,
	178	led_data->io_base + NIC78BX_LOCK_REG_OFFSET);
	179
	180	return ret;
	181	}
	182
8338eab5 HCO	183	static const struct acpi_device_id led_device_ids[] = {
	184	{"NIC78B3", 0},
	185	{"", 0},
	186	};
	187	MODULE_DEVICE_TABLE(acpi, led_device_ids);
	188
	189	static struct platform_driver led_driver = {
	190	.probe = nic78bx_probe,
8338eab5 HCO	191	.driver = {
	192	.name = KBUILD_MODNAME,
	193	.acpi_match_table = ACPI_PTR(led_device_ids),
	194	},
	195	};
	196
	197	module_platform_driver(led_driver);
	198
	199	MODULE_DESCRIPTION("National Instruments PXI User LEDs driver");
	200	MODULE_AUTHOR("Hui Chun Ong <hui.chun.ong@ni.com>");
	201	MODULE_LICENSE("GPL");