[WATCHDOG] davinci: convert to ioremap() + io[read|write]
Remove davinci platform-specific IO accessor macros in favor of standard ioremap + io[read|write]* functions. Also, convert printk(KERN_ERR ....) into dev_err(...) Signed-off-by: Kevin Hilman <khilman@deeprootsystems.com> Signed-off-by: Wim Van Sebroeck <wim@iguana.be>
This commit is contained in:
parent
63bad1452e
commit
371d3525e3
|
@ -24,7 +24,7 @@
|
||||||
#include <linux/spinlock.h>
|
#include <linux/spinlock.h>
|
||||||
#include <linux/uaccess.h>
|
#include <linux/uaccess.h>
|
||||||
#include <linux/io.h>
|
#include <linux/io.h>
|
||||||
#include <mach/hardware.h>
|
#include <linux/device.h>
|
||||||
|
|
||||||
#define MODULE_NAME "DAVINCI-WDT: "
|
#define MODULE_NAME "DAVINCI-WDT: "
|
||||||
|
|
||||||
|
@ -75,9 +75,9 @@ static void wdt_service(void)
|
||||||
spin_lock(&io_lock);
|
spin_lock(&io_lock);
|
||||||
|
|
||||||
/* put watchdog in service state */
|
/* put watchdog in service state */
|
||||||
davinci_writel(WDKEY_SEQ0, wdt_base + WDTCR);
|
iowrite32(WDKEY_SEQ0, wdt_base + WDTCR);
|
||||||
/* put watchdog in active state */
|
/* put watchdog in active state */
|
||||||
davinci_writel(WDKEY_SEQ1, wdt_base + WDTCR);
|
iowrite32(WDKEY_SEQ1, wdt_base + WDTCR);
|
||||||
|
|
||||||
spin_unlock(&io_lock);
|
spin_unlock(&io_lock);
|
||||||
}
|
}
|
||||||
|
@ -90,29 +90,29 @@ static void wdt_enable(void)
|
||||||
spin_lock(&io_lock);
|
spin_lock(&io_lock);
|
||||||
|
|
||||||
/* disable, internal clock source */
|
/* disable, internal clock source */
|
||||||
davinci_writel(0, wdt_base + TCR);
|
iowrite32(0, wdt_base + TCR);
|
||||||
/* reset timer, set mode to 64-bit watchdog, and unreset */
|
/* reset timer, set mode to 64-bit watchdog, and unreset */
|
||||||
davinci_writel(0, wdt_base + TGCR);
|
iowrite32(0, wdt_base + TGCR);
|
||||||
tgcr = TIMMODE_64BIT_WDOG | TIM12RS_UNRESET | TIM34RS_UNRESET;
|
tgcr = TIMMODE_64BIT_WDOG | TIM12RS_UNRESET | TIM34RS_UNRESET;
|
||||||
davinci_writel(tgcr, wdt_base + TGCR);
|
iowrite32(tgcr, wdt_base + TGCR);
|
||||||
/* clear counter regs */
|
/* clear counter regs */
|
||||||
davinci_writel(0, wdt_base + TIM12);
|
iowrite32(0, wdt_base + TIM12);
|
||||||
davinci_writel(0, wdt_base + TIM34);
|
iowrite32(0, wdt_base + TIM34);
|
||||||
/* set timeout period */
|
/* set timeout period */
|
||||||
timer_margin = (((u64)heartbeat * CLOCK_TICK_RATE) & 0xffffffff);
|
timer_margin = (((u64)heartbeat * CLOCK_TICK_RATE) & 0xffffffff);
|
||||||
davinci_writel(timer_margin, wdt_base + PRD12);
|
iowrite32(timer_margin, wdt_base + PRD12);
|
||||||
timer_margin = (((u64)heartbeat * CLOCK_TICK_RATE) >> 32);
|
timer_margin = (((u64)heartbeat * CLOCK_TICK_RATE) >> 32);
|
||||||
davinci_writel(timer_margin, wdt_base + PRD34);
|
iowrite32(timer_margin, wdt_base + PRD34);
|
||||||
/* enable run continuously */
|
/* enable run continuously */
|
||||||
davinci_writel(ENAMODE12_PERIODIC, wdt_base + TCR);
|
iowrite32(ENAMODE12_PERIODIC, wdt_base + TCR);
|
||||||
/* Once the WDT is in pre-active state write to
|
/* Once the WDT is in pre-active state write to
|
||||||
* TIM12, TIM34, PRD12, PRD34, TCR, TGCR, WDTCR are
|
* TIM12, TIM34, PRD12, PRD34, TCR, TGCR, WDTCR are
|
||||||
* write protected (except for the WDKEY field)
|
* write protected (except for the WDKEY field)
|
||||||
*/
|
*/
|
||||||
/* put watchdog in pre-active state */
|
/* put watchdog in pre-active state */
|
||||||
davinci_writel(WDKEY_SEQ0 | WDEN, wdt_base + WDTCR);
|
iowrite32(WDKEY_SEQ0 | WDEN, wdt_base + WDTCR);
|
||||||
/* put watchdog in active state */
|
/* put watchdog in active state */
|
||||||
davinci_writel(WDKEY_SEQ1 | WDEN, wdt_base + WDTCR);
|
iowrite32(WDKEY_SEQ1 | WDEN, wdt_base + WDTCR);
|
||||||
|
|
||||||
spin_unlock(&io_lock);
|
spin_unlock(&io_lock);
|
||||||
}
|
}
|
||||||
|
@ -197,17 +197,16 @@ static int davinci_wdt_probe(struct platform_device *pdev)
|
||||||
{
|
{
|
||||||
int ret = 0, size;
|
int ret = 0, size;
|
||||||
struct resource *res;
|
struct resource *res;
|
||||||
|
struct device *dev = &pdev->dev;
|
||||||
|
|
||||||
if (heartbeat < 1 || heartbeat > MAX_HEARTBEAT)
|
if (heartbeat < 1 || heartbeat > MAX_HEARTBEAT)
|
||||||
heartbeat = DEFAULT_HEARTBEAT;
|
heartbeat = DEFAULT_HEARTBEAT;
|
||||||
|
|
||||||
printk(KERN_INFO MODULE_NAME
|
dev_info(dev, "heartbeat %d sec\n", heartbeat);
|
||||||
"DaVinci Watchdog Timer: heartbeat %d sec\n", heartbeat);
|
|
||||||
|
|
||||||
res = platform_get_resource(pdev, IORESOURCE_MEM, 0);
|
res = platform_get_resource(pdev, IORESOURCE_MEM, 0);
|
||||||
if (res == NULL) {
|
if (res == NULL) {
|
||||||
printk(KERN_INFO MODULE_NAME
|
dev_err(dev, "failed to get memory region resource\n");
|
||||||
"failed to get memory region resource\n");
|
|
||||||
return -ENOENT;
|
return -ENOENT;
|
||||||
}
|
}
|
||||||
|
|
||||||
|
@ -215,20 +214,26 @@ static int davinci_wdt_probe(struct platform_device *pdev)
|
||||||
wdt_mem = request_mem_region(res->start, size, pdev->name);
|
wdt_mem = request_mem_region(res->start, size, pdev->name);
|
||||||
|
|
||||||
if (wdt_mem == NULL) {
|
if (wdt_mem == NULL) {
|
||||||
printk(KERN_INFO MODULE_NAME "failed to get memory region\n");
|
dev_err(dev, "failed to get memory region\n");
|
||||||
return -ENOENT;
|
return -ENOENT;
|
||||||
}
|
}
|
||||||
wdt_base = (void __iomem *)(res->start);
|
|
||||||
|
wdt_base = ioremap(res->start, size);
|
||||||
|
if (!wdt_base) {
|
||||||
|
dev_err(dev, "failed to map memory region\n");
|
||||||
|
return -ENOMEM;
|
||||||
|
}
|
||||||
|
|
||||||
ret = misc_register(&davinci_wdt_miscdev);
|
ret = misc_register(&davinci_wdt_miscdev);
|
||||||
if (ret < 0) {
|
if (ret < 0) {
|
||||||
printk(KERN_ERR MODULE_NAME "cannot register misc device\n");
|
dev_err(dev, "cannot register misc device\n");
|
||||||
release_resource(wdt_mem);
|
release_resource(wdt_mem);
|
||||||
kfree(wdt_mem);
|
kfree(wdt_mem);
|
||||||
} else {
|
} else {
|
||||||
set_bit(WDT_DEVICE_INITED, &wdt_status);
|
set_bit(WDT_DEVICE_INITED, &wdt_status);
|
||||||
}
|
}
|
||||||
|
|
||||||
|
iounmap(wdt_base);
|
||||||
return ret;
|
return ret;
|
||||||
}
|
}
|
||||||
|
|
||||||
|
|
Loading…
Reference in New Issue