1// SPDX-License-Identifier: GPL-2.0-or-later
  2/*
  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		0x04
 17#define LED_POWER_OFF	0x08
 18
 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	else
 33		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	else
 54		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);