V4L/DVB (9461): Initialize SYSREG register
[linux-2.6] / drivers / leds / leds-net48xx.c
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>
18 #include <asm/io.h>
19 #include <linux/nsc_gpio.h>
20 #include <linux/scx200_gpio.h>
21
22 #define DRVNAME "net48xx-led"
23 #define NET48XX_ERROR_LED_GPIO  20
24
25 static struct platform_device *pdev;
26
27 static void net48xx_error_led_set(struct led_classdev *led_cdev,
28                 enum led_brightness value)
29 {
30         scx200_gpio_ops.gpio_set(NET48XX_ERROR_LED_GPIO, value ? 1 : 0);
31 }
32
33 static struct led_classdev net48xx_error_led = {
34         .name           = "net48xx::error",
35         .brightness_set = net48xx_error_led_set,
36 };
37
38 #ifdef CONFIG_PM
39 static int net48xx_led_suspend(struct platform_device *dev,
40                 pm_message_t state)
41 {
42         led_classdev_suspend(&net48xx_error_led);
43         return 0;
44 }
45
46 static int net48xx_led_resume(struct platform_device *dev)
47 {
48         led_classdev_resume(&net48xx_error_led);
49         return 0;
50 }
51 #else
52 #define net48xx_led_suspend NULL
53 #define net48xx_led_resume NULL
54 #endif
55
56 static int net48xx_led_probe(struct platform_device *pdev)
57 {
58         return led_classdev_register(&pdev->dev, &net48xx_error_led);
59 }
60
61 static int net48xx_led_remove(struct platform_device *pdev)
62 {
63         led_classdev_unregister(&net48xx_error_led);
64         return 0;
65 }
66
67 static struct platform_driver net48xx_led_driver = {
68         .probe          = net48xx_led_probe,
69         .remove         = net48xx_led_remove,
70         .suspend        = net48xx_led_suspend,
71         .resume         = net48xx_led_resume,
72         .driver         = {
73                 .name           = DRVNAME,
74                 .owner          = THIS_MODULE,
75         },
76 };
77
78 static int __init net48xx_led_init(void)
79 {
80         int ret;
81
82         /* small hack, but scx200_gpio doesn't set .dev if the probe fails */
83         if (!scx200_gpio_ops.dev) {
84                 ret = -ENODEV;
85                 goto out;
86         }
87
88         ret = platform_driver_register(&net48xx_led_driver);
89         if (ret < 0)
90                 goto out;
91
92         pdev = platform_device_register_simple(DRVNAME, -1, NULL, 0);
93         if (IS_ERR(pdev)) {
94                 ret = PTR_ERR(pdev);
95                 platform_driver_unregister(&net48xx_led_driver);
96                 goto out;
97         }
98
99 out:
100         return ret;
101 }
102
103 static void __exit net48xx_led_exit(void)
104 {
105         platform_device_unregister(pdev);
106         platform_driver_unregister(&net48xx_led_driver);
107 }
108
109 module_init(net48xx_led_init);
110 module_exit(net48xx_led_exit);
111
112 MODULE_AUTHOR("Chris Boot <bootc@bootc.net>");
113 MODULE_DESCRIPTION("Soekris net48xx LED driver");
114 MODULE_LICENSE("GPL");
115