[GitHub/mt8127/android_kernel_alcatel_ttab.git] / drivers / leds / leds-net48xx.c

/*
 * LEDs driver for Soekris net48xx
 *
 * Copyright (C) 2006 Chris Boot <bootc@bootc.net>
 *
 * Based on leds-ams-delta.c
 *
 * This program is free software; you can redistribute it and/or modify
 * it under the terms of the GNU General Public License version 2 as
 * published by the Free Software Foundation.
 */

#include <linux/kernel.h>
#include <linux/init.h>
#include <linux/platform_device.h>
#include <linux/leds.h>
#include <linux/err.h>
#include <linux/io.h>
#include <linux/nsc_gpio.h>
#include <linux/scx200_gpio.h>
#include <linux/module.h>

#define DRVNAME "net48xx-led"
#define NET48XX_ERROR_LED_GPIO	20

static struct platform_device *pdev;

static void net48xx_error_led_set(struct led_classdev *led_cdev,
		enum led_brightness value)
{
	scx200_gpio_ops.gpio_set(NET48XX_ERROR_LED_GPIO, value ? 1 : 0);
}

static struct led_classdev net48xx_error_led = {
	.name		= "net48xx::error",
	.brightness_set	= net48xx_error_led_set,
	.flags		= LED_CORE_SUSPENDRESUME,
};

static int net48xx_led_probe(struct platform_device *pdev)
{
	return led_classdev_register(&pdev->dev, &net48xx_error_led);
}

static int net48xx_led_remove(struct platform_device *pdev)
{
	led_classdev_unregister(&net48xx_error_led);
	return 0;
}

static struct platform_driver net48xx_led_driver = {
	.probe		= net48xx_led_probe,
	.remove		= net48xx_led_remove,
	.driver		= {
		.name		= DRVNAME,
		.owner		= THIS_MODULE,
	},
};

static int __init net48xx_led_init(void)
{
	int ret;

	/* small hack, but scx200_gpio doesn't set .dev if the probe fails */
	if (!scx200_gpio_ops.dev) {
		ret = -ENODEV;
		goto out;
	}

	ret = platform_driver_register(&net48xx_led_driver);
	if (ret < 0)
		goto out;

	pdev = platform_device_register_simple(DRVNAME, -1, NULL, 0);
	if (IS_ERR(pdev)) {
		ret = PTR_ERR(pdev);
		platform_driver_unregister(&net48xx_led_driver);
		goto out;
	}

out:
	return ret;
}

static void __exit net48xx_led_exit(void)
{
	platform_device_unregister(pdev);
	platform_driver_unregister(&net48xx_led_driver);
}

module_init(net48xx_led_init);
module_exit(net48xx_led_exit);

MODULE_AUTHOR("Chris Boot <bootc@bootc.net>");
MODULE_DESCRIPTION("Soekris net48xx LED driver");
MODULE_LICENSE("GPL");
Commit	Line	Data
1a87d942 CB	1	/*
	2	* LEDs driver for Soekris net48xx
	3	*
	4	* Copyright (C) 2006 Chris Boot <bootc@bootc.net>
	5	*
	6	* Based on leds-ams-delta.c
	7	*
	8	* This program is free software; you can redistribute it and/or modify
	9	* it under the terms of the GNU General Public License version 2 as
	10	* published by the Free Software Foundation.
	11	*/
	12
	13	#include <linux/kernel.h>
	14	#include <linux/init.h>
	15	#include <linux/platform_device.h>
	16	#include <linux/leds.h>
	17	#include <linux/err.h>
6023ff73	18	#include <linux/io.h>
cfedc920	19	#include <linux/nsc_gpio.h>
1a87d942	20	#include <linux/scx200_gpio.h>
54f4dedb	21	#include <linux/module.h>
1a87d942	22
bca3bffe	23	#define DRVNAME "net48xx-led"
1a87d942 CB	24	#define NET48XX_ERROR_LED_GPIO 20
	25
	26	static struct platform_device *pdev;
	27
	28	static void net48xx_error_led_set(struct led_classdev *led_cdev,
	29	enum led_brightness value)
	30	{
cfedc920	31	scx200_gpio_ops.gpio_set(NET48XX_ERROR_LED_GPIO, value ? 1 : 0);
1a87d942 CB	32	}
	33
	34	static struct led_classdev net48xx_error_led = {
6c152bee	35	.name = "net48xx::error",
1a87d942	36	.brightness_set = net48xx_error_led_set,
859cb7f2	37	.flags = LED_CORE_SUSPENDRESUME,
1a87d942 CB	38	};
1a87d942 CB	39
1a87d942 CB	40	static int net48xx_led_probe(struct platform_device *pdev)
	41	{
	42	return led_classdev_register(&pdev->dev, &net48xx_error_led);
	43	}
	44
	45	static int net48xx_led_remove(struct platform_device *pdev)
	46	{
	47	led_classdev_unregister(&net48xx_error_led);
	48	return 0;
	49	}
	50
	51	static struct platform_driver net48xx_led_driver = {
1a87d942 CB	52	.probe = net48xx_led_probe,
1a87d942 CB	53	.remove = net48xx_led_remove,
1a87d942	54	.driver = {
bca3bffe CB	55	.name = DRVNAME,
bca3bffe CB	56	.owner = THIS_MODULE,
1a87d942 CB	57	},
	58	};
	59
	60	static int __init net48xx_led_init(void)
	61	{
	62	int ret;
	63
cfedc920 CB	64	/* small hack, but scx200_gpio doesn't set .dev if the probe fails */
cfedc920 CB	65	if (!scx200_gpio_ops.dev) {
1a87d942 CB	66	ret = -ENODEV;
	67	goto out;
	68	}
	69
	70	ret = platform_driver_register(&net48xx_led_driver);
	71	if (ret < 0)
	72	goto out;
	73
bca3bffe	74	pdev = platform_device_register_simple(DRVNAME, -1, NULL, 0);
1a87d942 CB	75	if (IS_ERR(pdev)) {
	76	ret = PTR_ERR(pdev);
	77	platform_driver_unregister(&net48xx_led_driver);
	78	goto out;
	79	}
	80
	81	out:
	82	return ret;
	83	}
	84
	85	static void __exit net48xx_led_exit(void)
	86	{
	87	platform_device_unregister(pdev);
	88	platform_driver_unregister(&net48xx_led_driver);
	89	}
	90
	91	module_init(net48xx_led_init);
	92	module_exit(net48xx_led_exit);
	93
	94	MODULE_AUTHOR("Chris Boot <bootc@bootc.net>");
	95	MODULE_DESCRIPTION("Soekris net48xx LED driver");
	96	MODULE_LICENSE("GPL");
	97