106 lines · c
1// SPDX-License-Identifier: GPL-2.0-or-later2/*3 * LEDs driver for the Cobalt Raq series.4 *5 * Copyright (C) 2007 Yoichi Yuasa <yuasa@linux-mips.org>6 */7#include <linux/init.h>8#include <linux/io.h>9#include <linux/ioport.h>10#include <linux/leds.h>11#include <linux/platform_device.h>12#include <linux/spinlock.h>13#include <linux/types.h>14#include <linux/export.h>15 16#define LED_WEB 0x0417#define LED_POWER_OFF 0x0818 19static void __iomem *led_port;20static u8 led_value;21static DEFINE_SPINLOCK(led_value_lock);22 23static void raq_web_led_set(struct led_classdev *led_cdev,24 enum led_brightness brightness)25{26 unsigned long flags;27 28 spin_lock_irqsave(&led_value_lock, flags);29 30 if (brightness)31 led_value |= LED_WEB;32 else33 led_value &= ~LED_WEB;34 writeb(led_value, led_port);35 36 spin_unlock_irqrestore(&led_value_lock, flags);37}38 39static struct led_classdev raq_web_led = {40 .name = "raq::web",41 .brightness_set = raq_web_led_set,42};43 44static void raq_power_off_led_set(struct led_classdev *led_cdev,45 enum led_brightness brightness)46{47 unsigned long flags;48 49 spin_lock_irqsave(&led_value_lock, flags);50 51 if (brightness)52 led_value |= LED_POWER_OFF;53 else54 led_value &= ~LED_POWER_OFF;55 writeb(led_value, led_port);56 57 spin_unlock_irqrestore(&led_value_lock, flags);58}59 60static struct led_classdev raq_power_off_led = {61 .name = "raq::power-off",62 .brightness_set = raq_power_off_led_set,63 .default_trigger = "power-off",64};65 66static int cobalt_raq_led_probe(struct platform_device *pdev)67{68 struct resource *res;69 int retval;70 71 res = platform_get_resource(pdev, IORESOURCE_MEM, 0);72 if (!res)73 return -EBUSY;74 75 led_port = devm_ioremap(&pdev->dev, res->start, resource_size(res));76 if (!led_port)77 return -ENOMEM;78 79 retval = led_classdev_register(&pdev->dev, &raq_power_off_led);80 if (retval)81 goto err_null;82 83 retval = led_classdev_register(&pdev->dev, &raq_web_led);84 if (retval)85 goto err_unregister;86 87 return 0;88 89err_unregister:90 led_classdev_unregister(&raq_power_off_led);91 92err_null:93 led_port = NULL;94 95 return retval;96}97 98static struct platform_driver cobalt_raq_led_driver = {99 .probe = cobalt_raq_led_probe,100 .driver = {101 .name = "cobalt-raq-leds",102 },103};104 105builtin_platform_driver(cobalt_raq_led_driver);106