^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) /* Copyright (c) 2010, 2011, 2016 The Linux Foundation. All rights reserved.
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 3) */
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 4) #include <linux/leds.h>
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 5) #include <linux/module.h>
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 6) #include <linux/of.h>
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 7) #include <linux/of_device.h>
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 8) #include <linux/platform_device.h>
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 9) #include <linux/pm.h>
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 10) #include <linux/regmap.h>
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 11)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 12) #define PM8058_LED_TYPE_COMMON 0x00
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 13) #define PM8058_LED_TYPE_KEYPAD 0x01
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 14) #define PM8058_LED_TYPE_FLASH 0x02
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 15)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 16) #define PM8058_LED_TYPE_COMMON_MASK 0xf8
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 17) #define PM8058_LED_TYPE_KEYPAD_MASK 0xf0
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 18) #define PM8058_LED_TYPE_COMMON_SHIFT 3
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 19) #define PM8058_LED_TYPE_KEYPAD_SHIFT 4
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 20)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 21) struct pm8058_led {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 22) struct regmap *map;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 23) u32 reg;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 24) u32 ledtype;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 25) struct led_classdev cdev;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 26) };
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 27)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 28) static void pm8058_led_set(struct led_classdev *cled,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 29) enum led_brightness value)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 30) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 31) struct pm8058_led *led;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 32) int ret = 0;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 33) unsigned int mask = 0;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 34) unsigned int val = 0;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 35)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 36) led = container_of(cled, struct pm8058_led, cdev);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 37) switch (led->ledtype) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 38) case PM8058_LED_TYPE_COMMON:
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 39) mask = PM8058_LED_TYPE_COMMON_MASK;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 40) val = value << PM8058_LED_TYPE_COMMON_SHIFT;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 41) break;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 42) case PM8058_LED_TYPE_KEYPAD:
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 43) case PM8058_LED_TYPE_FLASH:
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 44) mask = PM8058_LED_TYPE_KEYPAD_MASK;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 45) val = value << PM8058_LED_TYPE_KEYPAD_SHIFT;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 46) break;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 47) default:
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 48) break;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 49) }
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 50)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 51) ret = regmap_update_bits(led->map, led->reg, mask, val);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 52) if (ret)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 53) pr_err("Failed to set LED brightness\n");
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 54) }
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 55)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 56) static enum led_brightness pm8058_led_get(struct led_classdev *cled)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 57) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 58) struct pm8058_led *led;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 59) int ret;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 60) unsigned int val;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 61)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 62) led = container_of(cled, struct pm8058_led, cdev);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 63)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 64) ret = regmap_read(led->map, led->reg, &val);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 65) if (ret) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 66) pr_err("Failed to get LED brightness\n");
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 67) return LED_OFF;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 68) }
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 69)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 70) switch (led->ledtype) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 71) case PM8058_LED_TYPE_COMMON:
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 72) val &= PM8058_LED_TYPE_COMMON_MASK;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 73) val >>= PM8058_LED_TYPE_COMMON_SHIFT;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 74) break;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 75) case PM8058_LED_TYPE_KEYPAD:
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 76) case PM8058_LED_TYPE_FLASH:
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 77) val &= PM8058_LED_TYPE_KEYPAD_MASK;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 78) val >>= PM8058_LED_TYPE_KEYPAD_SHIFT;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 79) break;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 80) default:
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 81) val = LED_OFF;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 82) break;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 83) }
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 84)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 85) return val;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 86) }
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 87)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 88) static int pm8058_led_probe(struct platform_device *pdev)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 89) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 90) struct led_init_data init_data = {};
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 91) struct device *dev = &pdev->dev;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 92) struct pm8058_led *led;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 93) struct device_node *np;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 94) int ret;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 95) struct regmap *map;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 96) const char *state;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 97) enum led_brightness maxbright;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 98)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 99) led = devm_kzalloc(dev, sizeof(*led), GFP_KERNEL);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 100) if (!led)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 101) return -ENOMEM;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 102)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 103) led->ledtype = (u32)(unsigned long)of_device_get_match_data(dev);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 104)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 105) map = dev_get_regmap(dev->parent, NULL);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 106) if (!map) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 107) dev_err(dev, "Parent regmap unavailable.\n");
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 108) return -ENXIO;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 109) }
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 110) led->map = map;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 111)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 112) np = dev_of_node(dev);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 113)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 114) ret = of_property_read_u32(np, "reg", &led->reg);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 115) if (ret) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 116) dev_err(dev, "no register offset specified\n");
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 117) return -EINVAL;
^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) led->cdev.brightness_set = pm8058_led_set;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 121) led->cdev.brightness_get = pm8058_led_get;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 122) if (led->ledtype == PM8058_LED_TYPE_COMMON)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 123) maxbright = 31; /* 5 bits */
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 124) else
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 125) maxbright = 15; /* 4 bits */
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 126) led->cdev.max_brightness = maxbright;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 127)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 128) state = of_get_property(np, "default-state", NULL);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 129) if (state) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 130) if (!strcmp(state, "keep")) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 131) led->cdev.brightness = pm8058_led_get(&led->cdev);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 132) } else if (!strcmp(state, "on")) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 133) led->cdev.brightness = maxbright;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 134) pm8058_led_set(&led->cdev, maxbright);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 135) } else {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 136) led->cdev.brightness = LED_OFF;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 137) pm8058_led_set(&led->cdev, LED_OFF);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 138) }
^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 (led->ledtype == PM8058_LED_TYPE_KEYPAD ||
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 142) led->ledtype == PM8058_LED_TYPE_FLASH)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 143) led->cdev.flags = LED_CORE_SUSPENDRESUME;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 144)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 145) init_data.fwnode = of_fwnode_handle(np);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 146)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 147) ret = devm_led_classdev_register_ext(dev, &led->cdev, &init_data);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 148) if (ret)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 149) dev_err(dev, "Failed to register LED for %pOF\n", np);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 150)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 151) return ret;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 152) }
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 153)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 154) static const struct of_device_id pm8058_leds_id_table[] = {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 155) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 156) .compatible = "qcom,pm8058-led",
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 157) .data = (void *)PM8058_LED_TYPE_COMMON
^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) .compatible = "qcom,pm8058-keypad-led",
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 161) .data = (void *)PM8058_LED_TYPE_KEYPAD
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 162) },
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 163) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 164) .compatible = "qcom,pm8058-flash-led",
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 165) .data = (void *)PM8058_LED_TYPE_FLASH
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 166) },
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 167) { },
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 168) };
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 169) MODULE_DEVICE_TABLE(of, pm8058_leds_id_table);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 170)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 171) static struct platform_driver pm8058_led_driver = {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 172) .probe = pm8058_led_probe,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 173) .driver = {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 174) .name = "pm8058-leds",
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 175) .of_match_table = pm8058_leds_id_table,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 176) },
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 177) };
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 178) module_platform_driver(pm8058_led_driver);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 179)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 180) MODULE_DESCRIPTION("PM8058 LEDs driver");
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 181) MODULE_LICENSE("GPL v2");
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 182) MODULE_ALIAS("platform:pm8058-leds");
Orange Pi5 kernel
Deprecated Linux kernel 5.10.110 for OrangePi 5/5B/5+ boards
3 Commits
0 Branches
0 Tags