253 lines · c
1// SPDX-License-Identifier: GPL-2.0-only2/* leds-sunfire.c: SUNW,Ultra-Enterprise LED driver.3 *4 * Copyright (C) 2008 David S. Miller <davem@davemloft.net>5 */6 7#define pr_fmt(fmt) KBUILD_MODNAME ": " fmt8 9#include <linux/kernel.h>10#include <linux/module.h>11#include <linux/init.h>12#include <linux/leds.h>13#include <linux/io.h>14#include <linux/platform_device.h>15#include <linux/slab.h>16 17#include <asm/fhc.h>18#include <asm/upa.h>19 20MODULE_AUTHOR("David S. Miller <davem@davemloft.net>");21MODULE_DESCRIPTION("Sun Fire LED driver");22MODULE_LICENSE("GPL");23 24struct sunfire_led {25 struct led_classdev led_cdev;26 void __iomem *reg;27};28#define to_sunfire_led(d) container_of(d, struct sunfire_led, led_cdev)29 30static void __clockboard_set(struct led_classdev *led_cdev,31 enum led_brightness led_val, u8 bit)32{33 struct sunfire_led *p = to_sunfire_led(led_cdev);34 u8 reg = upa_readb(p->reg);35 36 switch (bit) {37 case CLOCK_CTRL_LLED:38 if (led_val)39 reg &= ~bit;40 else41 reg |= bit;42 break;43 44 default:45 if (led_val)46 reg |= bit;47 else48 reg &= ~bit;49 break;50 }51 upa_writeb(reg, p->reg);52}53 54static void clockboard_left_set(struct led_classdev *led_cdev,55 enum led_brightness led_val)56{57 __clockboard_set(led_cdev, led_val, CLOCK_CTRL_LLED);58}59 60static void clockboard_middle_set(struct led_classdev *led_cdev,61 enum led_brightness led_val)62{63 __clockboard_set(led_cdev, led_val, CLOCK_CTRL_MLED);64}65 66static void clockboard_right_set(struct led_classdev *led_cdev,67 enum led_brightness led_val)68{69 __clockboard_set(led_cdev, led_val, CLOCK_CTRL_RLED);70}71 72static void __fhc_set(struct led_classdev *led_cdev,73 enum led_brightness led_val, u32 bit)74{75 struct sunfire_led *p = to_sunfire_led(led_cdev);76 u32 reg = upa_readl(p->reg);77 78 switch (bit) {79 case FHC_CONTROL_LLED:80 if (led_val)81 reg &= ~bit;82 else83 reg |= bit;84 break;85 86 default:87 if (led_val)88 reg |= bit;89 else90 reg &= ~bit;91 break;92 }93 upa_writel(reg, p->reg);94}95 96static void fhc_left_set(struct led_classdev *led_cdev,97 enum led_brightness led_val)98{99 __fhc_set(led_cdev, led_val, FHC_CONTROL_LLED);100}101 102static void fhc_middle_set(struct led_classdev *led_cdev,103 enum led_brightness led_val)104{105 __fhc_set(led_cdev, led_val, FHC_CONTROL_MLED);106}107 108static void fhc_right_set(struct led_classdev *led_cdev,109 enum led_brightness led_val)110{111 __fhc_set(led_cdev, led_val, FHC_CONTROL_RLED);112}113 114typedef void (*set_handler)(struct led_classdev *, enum led_brightness);115struct led_type {116 const char *name;117 set_handler handler;118 const char *default_trigger;119};120 121#define NUM_LEDS_PER_BOARD 3122struct sunfire_drvdata {123 struct sunfire_led leds[NUM_LEDS_PER_BOARD];124};125 126static int sunfire_led_generic_probe(struct platform_device *pdev,127 struct led_type *types)128{129 struct sunfire_drvdata *p;130 int i, err;131 132 if (pdev->num_resources != 1) {133 dev_err(&pdev->dev, "Wrong number of resources %d, should be 1\n",134 pdev->num_resources);135 return -EINVAL;136 }137 138 p = devm_kzalloc(&pdev->dev, sizeof(*p), GFP_KERNEL);139 if (!p)140 return -ENOMEM;141 142 for (i = 0; i < NUM_LEDS_PER_BOARD; i++) {143 struct led_classdev *lp = &p->leds[i].led_cdev;144 145 p->leds[i].reg = (void __iomem *) pdev->resource[0].start;146 lp->name = types[i].name;147 lp->brightness = LED_FULL;148 lp->brightness_set = types[i].handler;149 lp->default_trigger = types[i].default_trigger;150 151 err = led_classdev_register(&pdev->dev, lp);152 if (err) {153 dev_err(&pdev->dev, "Could not register %s LED\n",154 lp->name);155 for (i--; i >= 0; i--)156 led_classdev_unregister(&p->leds[i].led_cdev);157 return err;158 }159 }160 161 platform_set_drvdata(pdev, p);162 163 return 0;164}165 166static void sunfire_led_generic_remove(struct platform_device *pdev)167{168 struct sunfire_drvdata *p = platform_get_drvdata(pdev);169 int i;170 171 for (i = 0; i < NUM_LEDS_PER_BOARD; i++)172 led_classdev_unregister(&p->leds[i].led_cdev);173}174 175static struct led_type clockboard_led_types[NUM_LEDS_PER_BOARD] = {176 {177 .name = "clockboard-left",178 .handler = clockboard_left_set,179 },180 {181 .name = "clockboard-middle",182 .handler = clockboard_middle_set,183 },184 {185 .name = "clockboard-right",186 .handler = clockboard_right_set,187 .default_trigger = "heartbeat",188 },189};190 191static int sunfire_clockboard_led_probe(struct platform_device *pdev)192{193 return sunfire_led_generic_probe(pdev, clockboard_led_types);194}195 196static struct led_type fhc_led_types[NUM_LEDS_PER_BOARD] = {197 {198 .name = "fhc-left",199 .handler = fhc_left_set,200 },201 {202 .name = "fhc-middle",203 .handler = fhc_middle_set,204 },205 {206 .name = "fhc-right",207 .handler = fhc_right_set,208 .default_trigger = "heartbeat",209 },210};211 212static int sunfire_fhc_led_probe(struct platform_device *pdev)213{214 return sunfire_led_generic_probe(pdev, fhc_led_types);215}216 217MODULE_ALIAS("platform:sunfire-clockboard-leds");218MODULE_ALIAS("platform:sunfire-fhc-leds");219 220static struct platform_driver sunfire_clockboard_led_driver = {221 .probe = sunfire_clockboard_led_probe,222 .remove_new = sunfire_led_generic_remove,223 .driver = {224 .name = "sunfire-clockboard-leds",225 },226};227 228static struct platform_driver sunfire_fhc_led_driver = {229 .probe = sunfire_fhc_led_probe,230 .remove_new = sunfire_led_generic_remove,231 .driver = {232 .name = "sunfire-fhc-leds",233 },234};235 236static struct platform_driver * const drivers[] = {237 &sunfire_clockboard_led_driver,238 &sunfire_fhc_led_driver,239};240 241static int __init sunfire_leds_init(void)242{243 return platform_register_drivers(drivers, ARRAY_SIZE(drivers));244}245 246static void __exit sunfire_leds_exit(void)247{248 platform_unregister_drivers(drivers, ARRAY_SIZE(drivers));249}250 251module_init(sunfire_leds_init);252module_exit(sunfire_leds_exit);253