^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1) // SPDX-License-Identifier: GPL-2.0-only
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 2) /*
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 3) * LEDs driver for Freescale MC13783/MC13892/MC34708
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 4) *
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 5) * Copyright (C) 2010 Philippe Rétornaz
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 6) *
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 7) * Based on leds-da903x:
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 8) * Copyright (C) 2008 Compulab, Ltd.
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 9) * Mike Rapoport <mike@compulab.co.il>
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 10) *
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 11) * Copyright (C) 2006-2008 Marvell International Ltd.
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 12) * Eric Miao <eric.miao@marvell.com>
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 13) */
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 14)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 15) #include <linux/module.h>
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 16) #include <linux/kernel.h>
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 17) #include <linux/platform_device.h>
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 18) #include <linux/leds.h>
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 19) #include <linux/of.h>
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 20) #include <linux/mfd/mc13xxx.h>
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 21)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 22) struct mc13xxx_led_devtype {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 23) int led_min;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 24) int led_max;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 25) int num_regs;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 26) u32 ledctrl_base;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 27) };
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 28)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 29) struct mc13xxx_led {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 30) struct led_classdev cdev;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 31) int id;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 32) struct mc13xxx_leds *leds;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 33) };
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 34)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 35) struct mc13xxx_leds {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 36) struct mc13xxx *master;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 37) struct mc13xxx_led_devtype *devtype;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 38) int num_leds;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 39) struct mc13xxx_led *led;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 40) };
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 41)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 42) static unsigned int mc13xxx_max_brightness(int id)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 43) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 44) if (id >= MC13783_LED_MD && id <= MC13783_LED_KP)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 45) return 0x0f;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 46) else if (id >= MC13783_LED_R1 && id <= MC13783_LED_B3)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 47) return 0x1f;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 48)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 49) return 0x3f;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 50) }
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 51)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 52) static int mc13xxx_led_set(struct led_classdev *led_cdev,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 53) enum led_brightness value)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 54) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 55) struct mc13xxx_led *led =
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 56) container_of(led_cdev, struct mc13xxx_led, cdev);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 57) struct mc13xxx_leds *leds = led->leds;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 58) unsigned int reg, bank, off, shift;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 59)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 60) switch (led->id) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 61) case MC13783_LED_MD:
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 62) case MC13783_LED_AD:
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 63) case MC13783_LED_KP:
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 64) reg = 2;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 65) shift = 9 + (led->id - MC13783_LED_MD) * 4;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 66) break;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 67) case MC13783_LED_R1:
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 68) case MC13783_LED_G1:
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 69) case MC13783_LED_B1:
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 70) case MC13783_LED_R2:
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 71) case MC13783_LED_G2:
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 72) case MC13783_LED_B2:
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 73) case MC13783_LED_R3:
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 74) case MC13783_LED_G3:
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 75) case MC13783_LED_B3:
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 76) off = led->id - MC13783_LED_R1;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 77) bank = off / 3;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 78) reg = 3 + bank;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 79) shift = (off - bank * 3) * 5 + 6;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 80) break;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 81) case MC13892_LED_MD:
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 82) case MC13892_LED_AD:
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 83) case MC13892_LED_KP:
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 84) off = led->id - MC13892_LED_MD;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 85) reg = off / 2;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 86) shift = 3 + (off - reg * 2) * 12;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 87) break;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 88) case MC13892_LED_R:
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 89) case MC13892_LED_G:
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 90) case MC13892_LED_B:
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 91) off = led->id - MC13892_LED_R;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 92) bank = off / 2;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 93) reg = 2 + bank;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 94) shift = (off - bank * 2) * 12 + 3;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 95) break;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 96) case MC34708_LED_R:
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 97) case MC34708_LED_G:
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 98) reg = 0;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 99) shift = 3 + (led->id - MC34708_LED_R) * 12;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 100) break;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 101) default:
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 102) BUG();
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 103) }
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 104)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 105) return mc13xxx_reg_rmw(leds->master, leds->devtype->ledctrl_base + reg,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 106) mc13xxx_max_brightness(led->id) << shift,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 107) value << shift);
^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) #ifdef CONFIG_OF
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 111) static struct mc13xxx_leds_platform_data __init *mc13xxx_led_probe_dt(
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 112) struct platform_device *pdev)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 113) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 114) struct mc13xxx_leds *leds = platform_get_drvdata(pdev);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 115) struct mc13xxx_leds_platform_data *pdata;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 116) struct device_node *parent, *child;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 117) struct device *dev = &pdev->dev;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 118) int i = 0, ret = -ENODATA;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 119)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 120) pdata = devm_kzalloc(dev, sizeof(*pdata), GFP_KERNEL);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 121) if (!pdata)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 122) return ERR_PTR(-ENOMEM);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 123)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 124) parent = of_get_child_by_name(dev_of_node(dev->parent), "leds");
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 125) if (!parent)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 126) goto out_node_put;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 127)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 128) ret = of_property_read_u32_array(parent, "led-control",
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 129) pdata->led_control,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 130) leds->devtype->num_regs);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 131) if (ret)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 132) goto out_node_put;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 133)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 134) pdata->num_leds = of_get_available_child_count(parent);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 135)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 136) pdata->led = devm_kcalloc(dev, pdata->num_leds, sizeof(*pdata->led),
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 137) GFP_KERNEL);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 138) if (!pdata->led) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 139) ret = -ENOMEM;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 140) goto out_node_put;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 141) }
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 142)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 143) for_each_available_child_of_node(parent, child) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 144) const char *str;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 145) u32 tmp;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 146)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 147) if (of_property_read_u32(child, "reg", &tmp))
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 148) continue;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 149) pdata->led[i].id = leds->devtype->led_min + tmp;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 150)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 151) if (!of_property_read_string(child, "label", &str))
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 152) pdata->led[i].name = str;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 153) if (!of_property_read_string(child, "linux,default-trigger",
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 154) &str))
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 155) pdata->led[i].default_trigger = str;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 156)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 157) i++;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 158) }
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 159)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 160) pdata->num_leds = i;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 161) ret = i > 0 ? 0 : -ENODATA;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 162)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 163) out_node_put:
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 164) of_node_put(parent);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 165)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 166) return ret ? ERR_PTR(ret) : pdata;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 167) }
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 168) #else
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 169) static inline struct mc13xxx_leds_platform_data __init *mc13xxx_led_probe_dt(
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 170) struct platform_device *pdev)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 171) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 172) return ERR_PTR(-ENOSYS);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 173) }
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 174) #endif
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 175)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 176) static int __init mc13xxx_led_probe(struct platform_device *pdev)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 177) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 178) struct device *dev = &pdev->dev;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 179) struct mc13xxx_leds_platform_data *pdata = dev_get_platdata(dev);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 180) struct mc13xxx *mcdev = dev_get_drvdata(dev->parent);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 181) struct mc13xxx_led_devtype *devtype =
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 182) (struct mc13xxx_led_devtype *)pdev->id_entry->driver_data;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 183) struct mc13xxx_leds *leds;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 184) int i, id, ret = -ENODATA;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 185) u32 init_led = 0;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 186)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 187) leds = devm_kzalloc(dev, sizeof(*leds), GFP_KERNEL);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 188) if (!leds)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 189) return -ENOMEM;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 190)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 191) leds->devtype = devtype;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 192) leds->master = mcdev;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 193) platform_set_drvdata(pdev, leds);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 194)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 195) if (dev_of_node(dev->parent)) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 196) pdata = mc13xxx_led_probe_dt(pdev);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 197) if (IS_ERR(pdata))
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 198) return PTR_ERR(pdata);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 199) } else if (!pdata)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 200) return -ENODATA;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 201)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 202) leds->num_leds = pdata->num_leds;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 203)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 204) if ((leds->num_leds < 1) ||
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 205) (leds->num_leds > (devtype->led_max - devtype->led_min + 1))) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 206) dev_err(dev, "Invalid LED count %d\n", leds->num_leds);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 207) return -EINVAL;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 208) }
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 209)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 210) leds->led = devm_kcalloc(dev, leds->num_leds, sizeof(*leds->led),
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 211) GFP_KERNEL);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 212) if (!leds->led)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 213) return -ENOMEM;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 214)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 215) for (i = 0; i < devtype->num_regs; i++) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 216) ret = mc13xxx_reg_write(mcdev, leds->devtype->ledctrl_base + i,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 217) pdata->led_control[i]);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 218) if (ret)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 219) return ret;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 220) }
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 221)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 222) for (i = 0; i < leds->num_leds; i++) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 223) const char *name, *trig;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 224)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 225) ret = -EINVAL;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 226)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 227) id = pdata->led[i].id;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 228) name = pdata->led[i].name;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 229) trig = pdata->led[i].default_trigger;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 230)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 231) if ((id > devtype->led_max) || (id < devtype->led_min)) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 232) dev_err(dev, "Invalid ID %i\n", id);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 233) break;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 234) }
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 235)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 236) if (init_led & (1 << id)) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 237) dev_warn(dev, "LED %i already initialized\n", id);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 238) break;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 239) }
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 240)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 241) init_led |= 1 << id;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 242) leds->led[i].id = id;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 243) leds->led[i].leds = leds;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 244) leds->led[i].cdev.name = name;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 245) leds->led[i].cdev.default_trigger = trig;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 246) leds->led[i].cdev.flags = LED_CORE_SUSPENDRESUME;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 247) leds->led[i].cdev.brightness_set_blocking = mc13xxx_led_set;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 248) leds->led[i].cdev.max_brightness = mc13xxx_max_brightness(id);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 249)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 250) ret = led_classdev_register(dev->parent, &leds->led[i].cdev);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 251) if (ret) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 252) dev_err(dev, "Failed to register LED %i\n", id);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 253) break;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 254) }
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 255) }
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 256)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 257) if (ret)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 258) while (--i >= 0)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 259) led_classdev_unregister(&leds->led[i].cdev);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 260)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 261) return ret;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 262) }
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 263)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 264) static int mc13xxx_led_remove(struct platform_device *pdev)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 265) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 266) struct mc13xxx_leds *leds = platform_get_drvdata(pdev);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 267) int i;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 268)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 269) for (i = 0; i < leds->num_leds; i++)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 270) led_classdev_unregister(&leds->led[i].cdev);
^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 const struct mc13xxx_led_devtype mc13783_led_devtype = {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 276) .led_min = MC13783_LED_MD,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 277) .led_max = MC13783_LED_B3,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 278) .num_regs = 6,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 279) .ledctrl_base = 51,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 280) };
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 281)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 282) static const struct mc13xxx_led_devtype mc13892_led_devtype = {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 283) .led_min = MC13892_LED_MD,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 284) .led_max = MC13892_LED_B,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 285) .num_regs = 4,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 286) .ledctrl_base = 51,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 287) };
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 288)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 289) static const struct mc13xxx_led_devtype mc34708_led_devtype = {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 290) .led_min = MC34708_LED_R,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 291) .led_max = MC34708_LED_G,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 292) .num_regs = 1,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 293) .ledctrl_base = 54,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 294) };
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 295)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 296) static const struct platform_device_id mc13xxx_led_id_table[] = {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 297) { "mc13783-led", (kernel_ulong_t)&mc13783_led_devtype, },
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 298) { "mc13892-led", (kernel_ulong_t)&mc13892_led_devtype, },
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 299) { "mc34708-led", (kernel_ulong_t)&mc34708_led_devtype, },
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 300) { }
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 301) };
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 302) MODULE_DEVICE_TABLE(platform, mc13xxx_led_id_table);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 303)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 304) static struct platform_driver mc13xxx_led_driver = {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 305) .driver = {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 306) .name = "mc13xxx-led",
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 307) },
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 308) .remove = mc13xxx_led_remove,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 309) .id_table = mc13xxx_led_id_table,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 310) };
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 311) module_platform_driver_probe(mc13xxx_led_driver, mc13xxx_led_probe);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 312)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 313) MODULE_DESCRIPTION("LEDs driver for Freescale MC13XXX PMIC");
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 314) MODULE_AUTHOR("Philippe Retornaz <philippe.retornaz@epfl.ch>");
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 315) MODULE_LICENSE("GPL");
Orange Pi5 kernel
Deprecated Linux kernel 5.10.110 for OrangePi 5/5B/5+ boards
3 Commits
0 Branches
0 Tags