1
2
3
4
5
6
7
8
9
10
11
12
13
14#include <linux/module.h>
15#include <linux/moduleparam.h>
16#include <linux/types.h>
17#include <linux/kernel.h>
18#include <linux/fs.h>
19#include <linux/miscdevice.h>
20#include <linux/watchdog.h>
21#include <linux/init.h>
22#include <linux/bitops.h>
23#include <linux/platform_device.h>
24#include <linux/spinlock.h>
25#include <linux/uaccess.h>
26#include <linux/io.h>
27#include <linux/device.h>
28
29#define MODULE_NAME "DAVINCI-WDT: "
30
31#define DEFAULT_HEARTBEAT 60
32#define MAX_HEARTBEAT 600
33
34
35#define PID12 (0x0)
36#define EMUMGT (0x4)
37#define TIM12 (0x10)
38#define TIM34 (0x14)
39#define PRD12 (0x18)
40#define PRD34 (0x1C)
41#define TCR (0x20)
42#define TGCR (0x24)
43#define WDTCR (0x28)
44
45
46#define ENAMODE12_DISABLED (0 << 6)
47#define ENAMODE12_ONESHOT (1 << 6)
48#define ENAMODE12_PERIODIC (2 << 6)
49
50
51#define TIM12RS_UNRESET (1 << 0)
52#define TIM34RS_UNRESET (1 << 1)
53#define TIMMODE_64BIT_WDOG (2 << 2)
54
55
56#define WDEN (1 << 14)
57#define WDFLAG (1 << 15)
58#define WDKEY_SEQ0 (0xa5c6 << 16)
59#define WDKEY_SEQ1 (0xda7e << 16)
60
61static int heartbeat = DEFAULT_HEARTBEAT;
62
63static DEFINE_SPINLOCK(io_lock);
64static unsigned long wdt_status;
65#define WDT_IN_USE 0
66#define WDT_OK_TO_CLOSE 1
67#define WDT_REGION_INITED 2
68#define WDT_DEVICE_INITED 3
69
70static struct resource *wdt_mem;
71static void __iomem *wdt_base;
72
73static void wdt_service(void)
74{
75 spin_lock(&io_lock);
76
77
78 iowrite32(WDKEY_SEQ0, wdt_base + WDTCR);
79
80 iowrite32(WDKEY_SEQ1, wdt_base + WDTCR);
81
82 spin_unlock(&io_lock);
83}
84
85static void wdt_enable(void)
86{
87 u32 tgcr;
88 u32 timer_margin;
89
90 spin_lock(&io_lock);
91
92
93 iowrite32(0, wdt_base + TCR);
94
95 iowrite32(0, wdt_base + TGCR);
96 tgcr = TIMMODE_64BIT_WDOG | TIM12RS_UNRESET | TIM34RS_UNRESET;
97 iowrite32(tgcr, wdt_base + TGCR);
98
99 iowrite32(0, wdt_base + TIM12);
100 iowrite32(0, wdt_base + TIM34);
101
102 timer_margin = (((u64)heartbeat * CLOCK_TICK_RATE) & 0xffffffff);
103 iowrite32(timer_margin, wdt_base + PRD12);
104 timer_margin = (((u64)heartbeat * CLOCK_TICK_RATE) >> 32);
105 iowrite32(timer_margin, wdt_base + PRD34);
106
107 iowrite32(ENAMODE12_PERIODIC, wdt_base + TCR);
108
109
110
111
112
113 iowrite32(WDKEY_SEQ0 | WDEN, wdt_base + WDTCR);
114
115 iowrite32(WDKEY_SEQ1 | WDEN, wdt_base + WDTCR);
116
117 spin_unlock(&io_lock);
118}
119
120static int davinci_wdt_open(struct inode *inode, struct file *file)
121{
122 if (test_and_set_bit(WDT_IN_USE, &wdt_status))
123 return -EBUSY;
124
125 wdt_enable();
126
127 return nonseekable_open(inode, file);
128}
129
130static ssize_t
131davinci_wdt_write(struct file *file, const char *data, size_t len,
132 loff_t *ppos)
133{
134 if (len)
135 wdt_service();
136
137 return len;
138}
139
140static struct watchdog_info ident = {
141 .options = WDIOF_KEEPALIVEPING,
142 .identity = "DaVinci Watchdog",
143};
144
145static long davinci_wdt_ioctl(struct file *file,
146 unsigned int cmd, unsigned long arg)
147{
148 int ret = -ENOTTY;
149
150 switch (cmd) {
151 case WDIOC_GETSUPPORT:
152 ret = copy_to_user((struct watchdog_info *)arg, &ident,
153 sizeof(ident)) ? -EFAULT : 0;
154 break;
155
156 case WDIOC_GETSTATUS:
157 case WDIOC_GETBOOTSTATUS:
158 ret = put_user(0, (int *)arg);
159 break;
160
161 case WDIOC_KEEPALIVE:
162 wdt_service();
163 ret = 0;
164 break;
165
166 case WDIOC_GETTIMEOUT:
167 ret = put_user(heartbeat, (int *)arg);
168 break;
169 }
170 return ret;
171}
172
173static int davinci_wdt_release(struct inode *inode, struct file *file)
174{
175 wdt_service();
176 clear_bit(WDT_IN_USE, &wdt_status);
177
178 return 0;
179}
180
181static const struct file_operations davinci_wdt_fops = {
182 .owner = THIS_MODULE,
183 .llseek = no_llseek,
184 .write = davinci_wdt_write,
185 .unlocked_ioctl = davinci_wdt_ioctl,
186 .open = davinci_wdt_open,
187 .release = davinci_wdt_release,
188};
189
190static struct miscdevice davinci_wdt_miscdev = {
191 .minor = WATCHDOG_MINOR,
192 .name = "watchdog",
193 .fops = &davinci_wdt_fops,
194};
195
196static int davinci_wdt_probe(struct platform_device *pdev)
197{
198 int ret = 0, size;
199 struct resource *res;
200 struct device *dev = &pdev->dev;
201
202 if (heartbeat < 1 || heartbeat > MAX_HEARTBEAT)
203 heartbeat = DEFAULT_HEARTBEAT;
204
205 dev_info(dev, "heartbeat %d sec\n", heartbeat);
206
207 res = platform_get_resource(pdev, IORESOURCE_MEM, 0);
208 if (res == NULL) {
209 dev_err(dev, "failed to get memory region resource\n");
210 return -ENOENT;
211 }
212
213 size = res->end - res->start + 1;
214 wdt_mem = request_mem_region(res->start, size, pdev->name);
215
216 if (wdt_mem == NULL) {
217 dev_err(dev, "failed to get memory region\n");
218 return -ENOENT;
219 }
220
221 wdt_base = ioremap(res->start, size);
222 if (!wdt_base) {
223 dev_err(dev, "failed to map memory region\n");
224 return -ENOMEM;
225 }
226
227 ret = misc_register(&davinci_wdt_miscdev);
228 if (ret < 0) {
229 dev_err(dev, "cannot register misc device\n");
230 release_resource(wdt_mem);
231 kfree(wdt_mem);
232 } else {
233 set_bit(WDT_DEVICE_INITED, &wdt_status);
234 }
235
236 iounmap(wdt_base);
237 return ret;
238}
239
240static int davinci_wdt_remove(struct platform_device *pdev)
241{
242 misc_deregister(&davinci_wdt_miscdev);
243 if (wdt_mem) {
244 release_resource(wdt_mem);
245 kfree(wdt_mem);
246 wdt_mem = NULL;
247 }
248 return 0;
249}
250
251static struct platform_driver platform_wdt_driver = {
252 .driver = {
253 .name = "watchdog",
254 .owner = THIS_MODULE,
255 },
256 .probe = davinci_wdt_probe,
257 .remove = davinci_wdt_remove,
258};
259
260static int __init davinci_wdt_init(void)
261{
262 return platform_driver_register(&platform_wdt_driver);
263}
264
265static void __exit davinci_wdt_exit(void)
266{
267 platform_driver_unregister(&platform_wdt_driver);
268}
269
270module_init(davinci_wdt_init);
271module_exit(davinci_wdt_exit);
272
273MODULE_AUTHOR("Texas Instruments");
274MODULE_DESCRIPTION("DaVinci Watchdog Driver");
275
276module_param(heartbeat, int, 0);
277MODULE_PARM_DESC(heartbeat,
278 "Watchdog heartbeat period in seconds from 1 to "
279 __MODULE_STRING(MAX_HEARTBEAT) ", default "
280 __MODULE_STRING(DEFAULT_HEARTBEAT));
281
282MODULE_LICENSE("GPL");
283MODULE_ALIAS_MISCDEV(WATCHDOG_MINOR);
284MODULE_ALIAS("platform:watchdog");
285
