/* * 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 <asm/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");