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