提交 6ea8115b 编写于 作者: F Florian Fainelli 提交者: Wim Van Sebroeck

[WATCHDOG] Convert mtx1 wdt to be a platform device and use generic GPIO API

This patch converts the MTX-1 to be a platform device, use the available
generic GPIO API for the MTX-1 board and register the miscdev alias.
Signed-off-by: NFlorian Fainelli <florian.fainelli@telecomint.eu>
Signed-off-by: NWim Van Sebroeck <wim@iguana.be>
上级 75c752e6
...@@ -45,10 +45,13 @@ ...@@ -45,10 +45,13 @@
#include <linux/completion.h> #include <linux/completion.h>
#include <linux/jiffies.h> #include <linux/jiffies.h>
#include <linux/watchdog.h> #include <linux/watchdog.h>
#include <linux/platform_device.h>
#include <asm/io.h> #include <asm/io.h>
#include <asm/uaccess.h> #include <asm/uaccess.h>
#include <asm/mach-au1x00/au1000.h> #include <asm/mach-au1x00/au1000.h>
#include <asm/gpio.h>
#define MTX1_WDT_INTERVAL (5 * HZ) #define MTX1_WDT_INTERVAL (5 * HZ)
...@@ -61,6 +64,7 @@ static struct { ...@@ -61,6 +64,7 @@ static struct {
volatile int queue; volatile int queue;
int default_ticks; int default_ticks;
unsigned long inuse; unsigned long inuse;
unsigned gpio;
} mtx1_wdt_device; } mtx1_wdt_device;
static void mtx1_wdt_trigger(unsigned long unused) static void mtx1_wdt_trigger(unsigned long unused)
...@@ -73,7 +77,8 @@ static void mtx1_wdt_trigger(unsigned long unused) ...@@ -73,7 +77,8 @@ static void mtx1_wdt_trigger(unsigned long unused)
* toggle GPIO2_15 * toggle GPIO2_15
*/ */
tmp = au_readl(GPIO2_DIR); tmp = au_readl(GPIO2_DIR);
tmp = (tmp & ~(1<<15)) | ((~tmp) & (1<<15)); tmp = (tmp & ~(1 << mtx1_wdt_device.gpio)) |
((~tmp) & (1 << mtx1_wdt_device.gpio));
au_writel (tmp, GPIO2_DIR); au_writel (tmp, GPIO2_DIR);
if (mtx1_wdt_device.queue && ticks) if (mtx1_wdt_device.queue && ticks)
...@@ -93,7 +98,7 @@ static void mtx1_wdt_start(void) ...@@ -93,7 +98,7 @@ static void mtx1_wdt_start(void)
{ {
if (!mtx1_wdt_device.queue) { if (!mtx1_wdt_device.queue) {
mtx1_wdt_device.queue = 1; mtx1_wdt_device.queue = 1;
au_writel (au_readl(GPIO2_DIR) | (u32)(1<<15), GPIO2_DIR); gpio_set_value(mtx1_wdt_device.gpio, 1);
mod_timer(&mtx1_wdt_device.timer, jiffies + MTX1_WDT_INTERVAL); mod_timer(&mtx1_wdt_device.timer, jiffies + MTX1_WDT_INTERVAL);
} }
mtx1_wdt_device.running++; mtx1_wdt_device.running++;
...@@ -103,7 +108,7 @@ static int mtx1_wdt_stop(void) ...@@ -103,7 +108,7 @@ static int mtx1_wdt_stop(void)
{ {
if (mtx1_wdt_device.queue) { if (mtx1_wdt_device.queue) {
mtx1_wdt_device.queue = 0; mtx1_wdt_device.queue = 0;
au_writel (au_readl(GPIO2_DIR) & ~((u32)(1<<15)), GPIO2_DIR); gpio_set_value(mtx1_wdt_device.gpio, 0);
} }
ticks = mtx1_wdt_device.default_ticks; ticks = mtx1_wdt_device.default_ticks;
...@@ -197,10 +202,12 @@ static struct miscdevice mtx1_wdt_misc = { ...@@ -197,10 +202,12 @@ static struct miscdevice mtx1_wdt_misc = {
}; };
static int __init mtx1_wdt_init(void) static int mtx1_wdt_probe(struct platform_device *pdev)
{ {
int ret; int ret;
mtx1_wdt_device.gpio = pdev->resource[0].start;
if ((ret = misc_register(&mtx1_wdt_misc)) < 0) { if ((ret = misc_register(&mtx1_wdt_misc)) < 0) {
printk(KERN_ERR " mtx-1_wdt : failed to register\n"); printk(KERN_ERR " mtx-1_wdt : failed to register\n");
return ret; return ret;
...@@ -222,13 +229,30 @@ static int __init mtx1_wdt_init(void) ...@@ -222,13 +229,30 @@ static int __init mtx1_wdt_init(void)
return 0; return 0;
} }
static void __exit mtx1_wdt_exit(void) static int mtx1_wdt_remove(struct platform_device *pdev)
{ {
if (mtx1_wdt_device.queue) { if (mtx1_wdt_device.queue) {
mtx1_wdt_device.queue = 0; mtx1_wdt_device.queue = 0;
wait_for_completion(&mtx1_wdt_device.stop); wait_for_completion(&mtx1_wdt_device.stop);
} }
misc_deregister(&mtx1_wdt_misc); misc_deregister(&mtx1_wdt_misc);
return 0;
}
static struct platform_driver mtx1_wdt = {
.probe = mtx1_wdt_probe,
.remove = mtx1_wdt_remove,
.driver.name = "mtx1-wdt",
};
static int __init mtx1_wdt_init(void)
{
return platform_driver_register(&mtx1_wdt);
}
static void __exit mtx1_wdt_exit(void)
{
platform_driver_unregister(&mtx1_wdt);
} }
module_init(mtx1_wdt_init); module_init(mtx1_wdt_init);
...@@ -237,3 +261,4 @@ module_exit(mtx1_wdt_exit); ...@@ -237,3 +261,4 @@ module_exit(mtx1_wdt_exit);
MODULE_AUTHOR("Michael Stickel, Florian Fainelli"); MODULE_AUTHOR("Michael Stickel, Florian Fainelli");
MODULE_DESCRIPTION("Driver for the MTX-1 watchdog"); MODULE_DESCRIPTION("Driver for the MTX-1 watchdog");
MODULE_LICENSE("GPL"); MODULE_LICENSE("GPL");
MODULE_ALIAS_MISCDEV(WATCHDOG_MINOR);
Markdown is supported
0% .
You are about to add 0 people to the discussion. Proceed with caution.
先完成此消息的编辑!
想要评论请 注册