Linux Audio

Check our new training course

Loading...
v3.1
  1/*
  2 *	sp5100_tco :	TCO timer driver for sp5100 chipsets
  3 *
  4 *	(c) Copyright 2009 Google Inc., All Rights Reserved.
  5 *
  6 *	Based on i8xx_tco.c:
  7 *	(c) Copyright 2000 kernel concepts <nils@kernelconcepts.de>, All Rights
  8 *	Reserved.
  9 *				http://www.kernelconcepts.de
 10 *
 11 *	This program is free software; you can redistribute it and/or
 12 *	modify it under the terms of the GNU General Public License
 13 *	as published by the Free Software Foundation; either version
 14 *	2 of the License, or (at your option) any later version.
 15 *
 16 *	See AMD Publication 43009 "AMD SB700/710/750 Register Reference Guide"
 
 
 
 
 
 
 
 17 */
 18
 19/*
 20 *	Includes, defines, variables, module parameters, ...
 21 */
 22
 
 
 
 
 
 23#include <linux/module.h>
 24#include <linux/moduleparam.h>
 25#include <linux/types.h>
 26#include <linux/miscdevice.h>
 27#include <linux/watchdog.h>
 28#include <linux/init.h>
 29#include <linux/fs.h>
 30#include <linux/pci.h>
 31#include <linux/ioport.h>
 32#include <linux/platform_device.h>
 33#include <linux/uaccess.h>
 34#include <linux/io.h>
 35
 36#include "sp5100_tco.h"
 37
 38/* Module and version information */
 39#define TCO_VERSION "0.01"
 40#define TCO_MODULE_NAME "SP5100 TCO timer"
 41#define TCO_DRIVER_NAME   TCO_MODULE_NAME ", v" TCO_VERSION
 42#define PFX TCO_MODULE_NAME ": "
 43
 44/* internal variables */
 45static u32 tcobase_phys;
 46static void __iomem *tcobase;
 47static unsigned int pm_iobase;
 48static DEFINE_SPINLOCK(tco_lock);	/* Guards the hardware */
 49static unsigned long timer_alive;
 50static char tco_expect_close;
 51static struct pci_dev *sp5100_tco_pci;
 
 
 
 52
 53/* the watchdog platform device */
 54static struct platform_device *sp5100_tco_platform_device;
 
 
 55
 56/* module parameters */
 57
 58#define WATCHDOG_HEARTBEAT 60	/* 60 sec default heartbeat. */
 59static int heartbeat = WATCHDOG_HEARTBEAT;  /* in seconds */
 60module_param(heartbeat, int, 0);
 61MODULE_PARM_DESC(heartbeat, "Watchdog heartbeat in seconds. (default="
 62		 __MODULE_STRING(WATCHDOG_HEARTBEAT) ")");
 63
 64static int nowayout = WATCHDOG_NOWAYOUT;
 65module_param(nowayout, int, 0);
 66MODULE_PARM_DESC(nowayout, "Watchdog cannot be stopped once started"
 67		" (default=" __MODULE_STRING(WATCHDOG_NOWAYOUT) ")");
 68
 69/*
 70 * Some TCO specific functions
 71 */
 72static void tco_timer_start(void)
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 73{
 
 74	u32 val;
 75	unsigned long flags;
 76
 77	spin_lock_irqsave(&tco_lock, flags);
 78	val = readl(SP5100_WDT_CONTROL(tcobase));
 79	val |= SP5100_WDT_START_STOP_BIT;
 80	writel(val, SP5100_WDT_CONTROL(tcobase));
 81	spin_unlock_irqrestore(&tco_lock, flags);
 
 82}
 83
 84static void tco_timer_stop(void)
 85{
 
 86	u32 val;
 87	unsigned long flags;
 88
 89	spin_lock_irqsave(&tco_lock, flags);
 90	val = readl(SP5100_WDT_CONTROL(tcobase));
 91	val &= ~SP5100_WDT_START_STOP_BIT;
 92	writel(val, SP5100_WDT_CONTROL(tcobase));
 93	spin_unlock_irqrestore(&tco_lock, flags);
 
 94}
 95
 96static void tco_timer_keepalive(void)
 97{
 
 98	u32 val;
 99	unsigned long flags;
100
101	spin_lock_irqsave(&tco_lock, flags);
102	val = readl(SP5100_WDT_CONTROL(tcobase));
103	val |= SP5100_WDT_TRIGGER_BIT;
104	writel(val, SP5100_WDT_CONTROL(tcobase));
105	spin_unlock_irqrestore(&tco_lock, flags);
 
106}
107
108static int tco_timer_set_heartbeat(int t)
 
109{
110	unsigned long flags;
111
112	if (t < 0 || t > 0xffff)
113		return -EINVAL;
114
115	/* Write new heartbeat to watchdog */
116	spin_lock_irqsave(&tco_lock, flags);
117	writel(t, SP5100_WDT_COUNT(tcobase));
118	spin_unlock_irqrestore(&tco_lock, flags);
119
120	heartbeat = t;
121	return 0;
122}
123
124/*
125 *	/dev/watchdog handling
126 */
127
128static int sp5100_tco_open(struct inode *inode, struct file *file)
129{
130	/* /dev/watchdog can only be opened once */
131	if (test_and_set_bit(0, &timer_alive))
132		return -EBUSY;
133
134	/* Reload and activate timer */
135	tco_timer_start();
136	tco_timer_keepalive();
137	return nonseekable_open(inode, file);
138}
139
140static int sp5100_tco_release(struct inode *inode, struct file *file)
141{
142	/* Shut off the timer. */
143	if (tco_expect_close == 42) {
144		tco_timer_stop();
145	} else {
146		printk(KERN_CRIT PFX
147			"Unexpected close, not stopping watchdog!\n");
148		tco_timer_keepalive();
149	}
150	clear_bit(0, &timer_alive);
151	tco_expect_close = 0;
152	return 0;
153}
154
155static ssize_t sp5100_tco_write(struct file *file, const char __user *data,
156				size_t len, loff_t *ppos)
157{
158	/* See if we got the magic character 'V' and reload the timer */
159	if (len) {
160		if (!nowayout) {
161			size_t i;
162
163			/* note: just in case someone wrote the magic character
164			 * five months ago... */
165			tco_expect_close = 0;
166
167			/* scan to see whether or not we got the magic character
168			 */
169			for (i = 0; i != len; i++) {
170				char c;
171				if (get_user(c, data + i))
172					return -EFAULT;
173				if (c == 'V')
174					tco_expect_close = 42;
175			}
176		}
177
178		/* someone wrote to us, we should reload the timer */
179		tco_timer_keepalive();
180	}
181	return len;
 
182}
183
184static long sp5100_tco_ioctl(struct file *file, unsigned int cmd,
185			     unsigned long arg)
186{
187	int new_options, retval = -EINVAL;
188	int new_heartbeat;
189	void __user *argp = (void __user *)arg;
190	int __user *p = argp;
191	static const struct watchdog_info ident = {
192		.options =		WDIOF_SETTIMEOUT |
193					WDIOF_KEEPALIVEPING |
194					WDIOF_MAGICCLOSE,
195		.firmware_version =	0,
196		.identity =		TCO_MODULE_NAME,
197	};
198
199	switch (cmd) {
200	case WDIOC_GETSUPPORT:
201		return copy_to_user(argp, &ident,
202			sizeof(ident)) ? -EFAULT : 0;
203	case WDIOC_GETSTATUS:
204	case WDIOC_GETBOOTSTATUS:
205		return put_user(0, p);
206	case WDIOC_SETOPTIONS:
207		if (get_user(new_options, p))
208			return -EFAULT;
209		if (new_options & WDIOS_DISABLECARD) {
210			tco_timer_stop();
211			retval = 0;
212		}
213		if (new_options & WDIOS_ENABLECARD) {
214			tco_timer_start();
215			tco_timer_keepalive();
216			retval = 0;
217		}
218		return retval;
219	case WDIOC_KEEPALIVE:
220		tco_timer_keepalive();
221		return 0;
222	case WDIOC_SETTIMEOUT:
223		if (get_user(new_heartbeat, p))
224			return -EFAULT;
225		if (tco_timer_set_heartbeat(new_heartbeat))
226			return -EINVAL;
227		tco_timer_keepalive();
228		/* Fall through */
229	case WDIOC_GETTIMEOUT:
230		return put_user(heartbeat, p);
231	default:
232		return -ENOTTY;
233	}
234}
235
236/*
237 * Kernel Interfaces
238 */
239
240static const struct file_operations sp5100_tco_fops = {
241	.owner =		THIS_MODULE,
242	.llseek =		no_llseek,
243	.write =		sp5100_tco_write,
244	.unlocked_ioctl =	sp5100_tco_ioctl,
245	.open =			sp5100_tco_open,
246	.release =		sp5100_tco_release,
247};
248
249static struct miscdevice sp5100_tco_miscdev = {
250	.minor =	WATCHDOG_MINOR,
251	.name =		"watchdog",
252	.fops =		&sp5100_tco_fops,
253};
254
255/*
256 * Data for PCI driver interface
257 *
258 * This data only exists for exporting the supported
259 * PCI ids via MODULE_DEVICE_TABLE.  We do not actually
260 * register a pci_driver, because someone else might
261 * want to register another driver on the same PCI id.
262 */
263static DEFINE_PCI_DEVICE_TABLE(sp5100_tco_pci_tbl) = {
264	{ PCI_VENDOR_ID_ATI, PCI_DEVICE_ID_ATI_SBX00_SMBUS, PCI_ANY_ID,
265	  PCI_ANY_ID, },
266	{ 0, },			/* End of list */
267};
268MODULE_DEVICE_TABLE(pci, sp5100_tco_pci_tbl);
269
270/*
271 * Init & exit routines
272 */
273
274static unsigned char __devinit sp5100_tco_setupdevice(void)
 
275{
276	struct pci_dev *dev = NULL;
277	u32 val;
 
 
278
279	/* Match the PCI device */
280	for_each_pci_dev(dev) {
281		if (pci_match_id(sp5100_tco_pci_tbl, dev) != NULL) {
282			sp5100_tco_pci = dev;
283			break;
284		}
285	}
286
287	if (!sp5100_tco_pci)
288		return 0;
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
289
290	/* Request the IO ports used by this driver */
291	pm_iobase = SP5100_IO_PM_INDEX_REG;
292	if (!request_region(pm_iobase, SP5100_PM_IOPORTS_SIZE, "SP5100 TCO")) {
293		printk(KERN_ERR PFX "I/O address 0x%04x already in use\n",
294			pm_iobase);
295		goto exit;
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
296	}
297
298	/* Find the watchdog base address. */
299	outb(SP5100_PM_WATCHDOG_BASE3, SP5100_IO_PM_INDEX_REG);
300	val = inb(SP5100_IO_PM_DATA_REG);
301	outb(SP5100_PM_WATCHDOG_BASE2, SP5100_IO_PM_INDEX_REG);
302	val = val << 8 | inb(SP5100_IO_PM_DATA_REG);
303	outb(SP5100_PM_WATCHDOG_BASE1, SP5100_IO_PM_INDEX_REG);
304	val = val << 8 | inb(SP5100_IO_PM_DATA_REG);
305	outb(SP5100_PM_WATCHDOG_BASE0, SP5100_IO_PM_INDEX_REG);
306	/* Low three bits of BASE0 are reserved. */
307	val = val << 8 | (inb(SP5100_IO_PM_DATA_REG) & 0xf8);
308
309	if (!request_mem_region_exclusive(val, SP5100_WDT_MEM_MAP_SIZE,
310								"SP5100 TCO")) {
311		printk(KERN_ERR PFX "mmio address 0x%04x already in use\n",
312			val);
313		goto unreg_region;
314	}
315	tcobase_phys = val;
316
317	tcobase = ioremap(val, SP5100_WDT_MEM_MAP_SIZE);
318	if (tcobase == 0) {
319		printk(KERN_ERR PFX "failed to get tcobase address\n");
320		goto unreg_mem_region;
321	}
322
323	/* Enable watchdog decode bit */
324	pci_read_config_dword(sp5100_tco_pci,
325			      SP5100_PCI_WATCHDOG_MISC_REG,
326			      &val);
327
328	val |= SP5100_PCI_WATCHDOG_DECODE_EN;
329
330	pci_write_config_dword(sp5100_tco_pci,
331			       SP5100_PCI_WATCHDOG_MISC_REG,
332			       val);
333
334	/* Enable Watchdog timer and set the resolution to 1 sec. */
335	outb(SP5100_PM_WATCHDOG_CONTROL, SP5100_IO_PM_INDEX_REG);
336	val = inb(SP5100_IO_PM_DATA_REG);
337	val |= SP5100_PM_WATCHDOG_SECOND_RES;
338	val &= ~SP5100_PM_WATCHDOG_DISABLE;
339	outb(val, SP5100_IO_PM_DATA_REG);
340
341	/* Check that the watchdog action is set to reset the system. */
342	val = readl(SP5100_WDT_CONTROL(tcobase));
343	val &= ~SP5100_PM_WATCHDOG_ACTION_RESET;
344	writel(val, SP5100_WDT_CONTROL(tcobase));
 
 
 
 
 
345
346	/* Set a reasonable heartbeat before we stop the timer */
347	tco_timer_set_heartbeat(heartbeat);
348
349	/*
350	 * Stop the TCO before we change anything so we don't race with
351	 * a zeroed timer.
352	 */
353	tco_timer_stop();
354
355	/* Done */
356	return 1;
357
358unreg_mem_region:
359	release_mem_region(tcobase_phys, SP5100_WDT_MEM_MAP_SIZE);
360unreg_region:
361	release_region(pm_iobase, SP5100_PM_IOPORTS_SIZE);
362exit:
363	return 0;
364}
365
366static int __devinit sp5100_tco_init(struct platform_device *dev)
367{
368	int ret;
369	u32 val;
370
371	/* Check whether or not the hardware watchdog is there. If found, then
372	 * set it up.
373	 */
374	if (!sp5100_tco_setupdevice())
375		return -ENODEV;
376
377	/* Check to see if last reboot was due to watchdog timeout */
378	printk(KERN_INFO PFX "Watchdog reboot %sdetected.\n",
379	       readl(SP5100_WDT_CONTROL(tcobase)) & SP5100_PM_WATCHDOG_FIRED ?
380		      "" : "not ");
381
382	/* Clear out the old status */
383	val = readl(SP5100_WDT_CONTROL(tcobase));
384	val &= ~SP5100_PM_WATCHDOG_FIRED;
385	writel(val, SP5100_WDT_CONTROL(tcobase));
386
387	/*
388	 * Check that the heartbeat value is within it's range.
389	 * If not, reset to the default.
390	 */
391	if (tco_timer_set_heartbeat(heartbeat)) {
392		heartbeat = WATCHDOG_HEARTBEAT;
393		tco_timer_set_heartbeat(heartbeat);
394	}
395
396	ret = misc_register(&sp5100_tco_miscdev);
397	if (ret != 0) {
398		printk(KERN_ERR PFX "cannot register miscdev on minor="
399		       "%d (err=%d)\n",
400		       WATCHDOG_MINOR, ret);
401		goto exit;
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
402	}
403
404	clear_bit(0, &timer_alive);
 
 
405
406	printk(KERN_INFO PFX "initialized (0x%p). heartbeat=%d sec"
407		" (nowayout=%d)\n",
408		tcobase, heartbeat, nowayout);
409
410	return 0;
411
412exit:
413	iounmap(tcobase);
414	release_mem_region(tcobase_phys, SP5100_WDT_MEM_MAP_SIZE);
415	release_region(pm_iobase, SP5100_PM_IOPORTS_SIZE);
416	return ret;
417}
418
419static void __devexit sp5100_tco_cleanup(void)
420{
421	/* Stop the timer before we leave */
422	if (!nowayout)
423		tco_timer_stop();
424
425	/* Deregister */
426	misc_deregister(&sp5100_tco_miscdev);
427	iounmap(tcobase);
428	release_mem_region(tcobase_phys, SP5100_WDT_MEM_MAP_SIZE);
429	release_region(pm_iobase, SP5100_PM_IOPORTS_SIZE);
430}
431
432static int __devexit sp5100_tco_remove(struct platform_device *dev)
433{
434	if (tcobase)
435		sp5100_tco_cleanup();
436	return 0;
437}
438
439static void sp5100_tco_shutdown(struct platform_device *dev)
440{
441	tco_timer_stop();
442}
443
444static struct platform_driver sp5100_tco_driver = {
445	.probe		= sp5100_tco_init,
446	.remove		= __devexit_p(sp5100_tco_remove),
447	.shutdown	= sp5100_tco_shutdown,
448	.driver		= {
449		.owner	= THIS_MODULE,
450		.name	= TCO_MODULE_NAME,
451	},
452};
453
454static int __init sp5100_tco_init_module(void)
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
455{
 
456	int err;
457
458	printk(KERN_INFO PFX "SP5100 TCO WatchDog Timer Driver v%s\n",
459	       TCO_VERSION);
 
 
 
 
 
 
 
 
 
 
460
461	err = platform_driver_register(&sp5100_tco_driver);
462	if (err)
463		return err;
464
465	sp5100_tco_platform_device = platform_device_register_simple(
466					TCO_MODULE_NAME, -1, NULL, 0);
467	if (IS_ERR(sp5100_tco_platform_device)) {
468		err = PTR_ERR(sp5100_tco_platform_device);
469		goto unreg_platform_driver;
470	}
471
472	return 0;
473
474unreg_platform_driver:
475	platform_driver_unregister(&sp5100_tco_driver);
476	return err;
477}
478
479static void __exit sp5100_tco_cleanup_module(void)
480{
481	platform_device_unregister(sp5100_tco_platform_device);
482	platform_driver_unregister(&sp5100_tco_driver);
483	printk(KERN_INFO PFX "SP5100 TCO Watchdog Module Unloaded.\n");
484}
485
486module_init(sp5100_tco_init_module);
487module_exit(sp5100_tco_cleanup_module);
488
489MODULE_AUTHOR("Priyanka Gupta");
490MODULE_DESCRIPTION("TCO timer driver for SP5100 chipset");
491MODULE_LICENSE("GPL");
492MODULE_ALIAS_MISCDEV(WATCHDOG_MINOR);
v4.17
  1/*
  2 *	sp5100_tco :	TCO timer driver for sp5100 chipsets
  3 *
  4 *	(c) Copyright 2009 Google Inc., All Rights Reserved.
  5 *
  6 *	Based on i8xx_tco.c:
  7 *	(c) Copyright 2000 kernel concepts <nils@kernelconcepts.de>, All Rights
  8 *	Reserved.
  9 *				http://www.kernelconcepts.de
 10 *
 11 *	This program is free software; you can redistribute it and/or
 12 *	modify it under the terms of the GNU General Public License
 13 *	as published by the Free Software Foundation; either version
 14 *	2 of the License, or (at your option) any later version.
 15 *
 16 *	See AMD Publication 43009 "AMD SB700/710/750 Register Reference Guide",
 17 *	    AMD Publication 45482 "AMD SB800-Series Southbridges Register
 18 *	                                                      Reference Guide"
 19 *	    AMD Publication 48751 "BIOS and Kernel Developer’s Guide (BKDG)
 20 *				for AMD Family 16h Models 00h-0Fh Processors"
 21 *	    AMD Publication 51192 "AMD Bolton FCH Register Reference Guide"
 22 *	    AMD Publication 52740 "BIOS and Kernel Developer’s Guide (BKDG)
 23 *				for AMD Family 16h Models 30h-3Fh Processors"
 24 */
 25
 26/*
 27 *	Includes, defines, variables, module parameters, ...
 28 */
 29
 30#define pr_fmt(fmt) KBUILD_MODNAME ": " fmt
 31
 32#include <linux/init.h>
 33#include <linux/io.h>
 34#include <linux/ioport.h>
 35#include <linux/module.h>
 36#include <linux/moduleparam.h>
 
 
 
 
 
 37#include <linux/pci.h>
 
 38#include <linux/platform_device.h>
 39#include <linux/types.h>
 40#include <linux/watchdog.h>
 41
 42#include "sp5100_tco.h"
 43
 44#define TCO_DRIVER_NAME	"sp5100-tco"
 
 
 
 
 45
 46/* internal variables */
 47
 48enum tco_reg_layout {
 49	sp5100, sb800, efch
 50};
 51
 52struct sp5100_tco {
 53	struct watchdog_device wdd;
 54	void __iomem *tcobase;
 55	enum tco_reg_layout tco_reg_layout;
 56};
 57
 58/* the watchdog platform device */
 59static struct platform_device *sp5100_tco_platform_device;
 60/* the associated PCI device */
 61static struct pci_dev *sp5100_tco_pci;
 62
 63/* module parameters */
 64
 65#define WATCHDOG_HEARTBEAT 60	/* 60 sec default heartbeat. */
 66static int heartbeat = WATCHDOG_HEARTBEAT;  /* in seconds */
 67module_param(heartbeat, int, 0);
 68MODULE_PARM_DESC(heartbeat, "Watchdog heartbeat in seconds. (default="
 69		 __MODULE_STRING(WATCHDOG_HEARTBEAT) ")");
 70
 71static bool nowayout = WATCHDOG_NOWAYOUT;
 72module_param(nowayout, bool, 0);
 73MODULE_PARM_DESC(nowayout, "Watchdog cannot be stopped once started."
 74		" (default=" __MODULE_STRING(WATCHDOG_NOWAYOUT) ")");
 75
 76/*
 77 * Some TCO specific functions
 78 */
 79
 80static enum tco_reg_layout tco_reg_layout(struct pci_dev *dev)
 81{
 82	if (dev->vendor == PCI_VENDOR_ID_ATI &&
 83	    dev->device == PCI_DEVICE_ID_ATI_SBX00_SMBUS &&
 84	    dev->revision < 0x40) {
 85		return sp5100;
 86	} else if (dev->vendor == PCI_VENDOR_ID_AMD &&
 87	    ((dev->device == PCI_DEVICE_ID_AMD_HUDSON2_SMBUS &&
 88	     dev->revision >= 0x41) ||
 89	    (dev->device == PCI_DEVICE_ID_AMD_KERNCZ_SMBUS &&
 90	     dev->revision >= 0x49))) {
 91		return efch;
 92	}
 93	return sb800;
 94}
 95
 96static int tco_timer_start(struct watchdog_device *wdd)
 97{
 98	struct sp5100_tco *tco = watchdog_get_drvdata(wdd);
 99	u32 val;
 
100
101	val = readl(SP5100_WDT_CONTROL(tco->tcobase));
 
102	val |= SP5100_WDT_START_STOP_BIT;
103	writel(val, SP5100_WDT_CONTROL(tco->tcobase));
104
105	return 0;
106}
107
108static int tco_timer_stop(struct watchdog_device *wdd)
109{
110	struct sp5100_tco *tco = watchdog_get_drvdata(wdd);
111	u32 val;
 
112
113	val = readl(SP5100_WDT_CONTROL(tco->tcobase));
 
114	val &= ~SP5100_WDT_START_STOP_BIT;
115	writel(val, SP5100_WDT_CONTROL(tco->tcobase));
116
117	return 0;
118}
119
120static int tco_timer_ping(struct watchdog_device *wdd)
121{
122	struct sp5100_tco *tco = watchdog_get_drvdata(wdd);
123	u32 val;
 
124
125	val = readl(SP5100_WDT_CONTROL(tco->tcobase));
 
126	val |= SP5100_WDT_TRIGGER_BIT;
127	writel(val, SP5100_WDT_CONTROL(tco->tcobase));
128
129	return 0;
130}
131
132static int tco_timer_set_timeout(struct watchdog_device *wdd,
133				 unsigned int t)
134{
135	struct sp5100_tco *tco = watchdog_get_drvdata(wdd);
 
 
 
136
137	/* Write new heartbeat to watchdog */
138	writel(t, SP5100_WDT_COUNT(tco->tcobase));
139
140	wdd->timeout = t;
141
 
142	return 0;
143}
144
145static u8 sp5100_tco_read_pm_reg8(u8 index)
 
 
 
 
146{
147	outb(index, SP5100_IO_PM_INDEX_REG);
148	return inb(SP5100_IO_PM_DATA_REG);
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
149}
150
151static void sp5100_tco_update_pm_reg8(u8 index, u8 reset, u8 set)
 
152{
153	u8 val;
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
154
155	outb(index, SP5100_IO_PM_INDEX_REG);
156	val = inb(SP5100_IO_PM_DATA_REG);
157	val &= reset;
158	val |= set;
159	outb(val, SP5100_IO_PM_DATA_REG);
160}
161
162static void tco_timer_enable(struct sp5100_tco *tco)
 
163{
164	u32 val;
165
166	switch (tco->tco_reg_layout) {
167	case sb800:
168		/* For SB800 or later */
169		/* Set the Watchdog timer resolution to 1 sec */
170		sp5100_tco_update_pm_reg8(SB800_PM_WATCHDOG_CONFIG,
171					  0xff, SB800_PM_WATCHDOG_SECOND_RES);
172
173		/* Enable watchdog decode bit and watchdog timer */
174		sp5100_tco_update_pm_reg8(SB800_PM_WATCHDOG_CONTROL,
175					  ~SB800_PM_WATCHDOG_DISABLE,
176					  SB800_PCI_WATCHDOG_DECODE_EN);
177		break;
178	case sp5100:
179		/* For SP5100 or SB7x0 */
180		/* Enable watchdog decode bit */
181		pci_read_config_dword(sp5100_tco_pci,
182				      SP5100_PCI_WATCHDOG_MISC_REG,
183				      &val);
184
185		val |= SP5100_PCI_WATCHDOG_DECODE_EN;
186
187		pci_write_config_dword(sp5100_tco_pci,
188				       SP5100_PCI_WATCHDOG_MISC_REG,
189				       val);
190
191		/* Enable Watchdog timer and set the resolution to 1 sec */
192		sp5100_tco_update_pm_reg8(SP5100_PM_WATCHDOG_CONTROL,
193					  ~SP5100_PM_WATCHDOG_DISABLE,
194					  SP5100_PM_WATCHDOG_SECOND_RES);
195		break;
196	case efch:
197		/* Set the Watchdog timer resolution to 1 sec and enable */
198		sp5100_tco_update_pm_reg8(EFCH_PM_DECODEEN3,
199					  ~EFCH_PM_WATCHDOG_DISABLE,
200					  EFCH_PM_DECODEEN_SECOND_RES);
201		break;
 
 
 
 
 
 
 
 
202	}
203}
204
205static u32 sp5100_tco_read_pm_reg32(u8 index)
206{
207	u32 val = 0;
208	int i;
 
 
 
 
 
 
 
 
 
 
 
 
 
 
209
210	for (i = 3; i >= 0; i--)
211		val = (val << 8) + sp5100_tco_read_pm_reg8(index + i);
 
 
 
 
 
 
 
 
 
 
 
 
212
213	return val;
214}
 
215
216static int sp5100_tco_setupdevice(struct device *dev,
217				  struct watchdog_device *wdd)
218{
219	struct sp5100_tco *tco = watchdog_get_drvdata(wdd);
220	const char *dev_name;
221	u32 mmio_addr = 0, val;
222	int ret;
223
224	/* Request the IO ports used by this driver */
225	if (!request_muxed_region(SP5100_IO_PM_INDEX_REG,
226				  SP5100_PM_IOPORTS_SIZE, "sp5100_tco")) {
227		dev_err(dev, "I/O address 0x%04x already in use\n",
228			SP5100_IO_PM_INDEX_REG);
229		return -EBUSY;
230	}
231
232	/*
233	 * Determine type of southbridge chipset.
234	 */
235	switch (tco->tco_reg_layout) {
236	case sp5100:
237		dev_name = SP5100_DEVNAME;
238		mmio_addr = sp5100_tco_read_pm_reg32(SP5100_PM_WATCHDOG_BASE) &
239								0xfffffff8;
240		break;
241	case sb800:
242		dev_name = SB800_DEVNAME;
243		mmio_addr = sp5100_tco_read_pm_reg32(SB800_PM_WATCHDOG_BASE) &
244								0xfffffff8;
245		break;
246	case efch:
247		dev_name = SB800_DEVNAME;
248		val = sp5100_tco_read_pm_reg8(EFCH_PM_DECODEEN);
249		if (val & EFCH_PM_DECODEEN_WDT_TMREN)
250			mmio_addr = EFCH_PM_WDT_ADDR;
251		break;
252	default:
253		return -ENODEV;
254	}
255
256	/* Check MMIO address conflict */
257	if (!mmio_addr ||
258	    !devm_request_mem_region(dev, mmio_addr, SP5100_WDT_MEM_MAP_SIZE,
259				     dev_name)) {
260		if (mmio_addr)
261			dev_dbg(dev, "MMIO address 0x%08x already in use\n",
262				mmio_addr);
263		switch (tco->tco_reg_layout) {
264		case sp5100:
265			/*
266			 * Secondly, Find the watchdog timer MMIO address
267			 * from SBResource_MMIO register.
268			 */
269			/* Read SBResource_MMIO from PCI config(PCI_Reg: 9Ch) */
270			pci_read_config_dword(sp5100_tco_pci,
271					      SP5100_SB_RESOURCE_MMIO_BASE,
272					      &mmio_addr);
273			if ((mmio_addr & (SB800_ACPI_MMIO_DECODE_EN |
274					  SB800_ACPI_MMIO_SEL)) !=
275						  SB800_ACPI_MMIO_DECODE_EN) {
276				ret = -ENODEV;
277				goto unreg_region;
278			}
279			mmio_addr &= ~0xFFF;
280			mmio_addr += SB800_PM_WDT_MMIO_OFFSET;
281			break;
282		case sb800:
283			/* Read SBResource_MMIO from AcpiMmioEn(PM_Reg: 24h) */
284			mmio_addr =
285				sp5100_tco_read_pm_reg32(SB800_PM_ACPI_MMIO_EN);
286			if ((mmio_addr & (SB800_ACPI_MMIO_DECODE_EN |
287					  SB800_ACPI_MMIO_SEL)) !=
288						  SB800_ACPI_MMIO_DECODE_EN) {
289				ret = -ENODEV;
290				goto unreg_region;
291			}
292			mmio_addr &= ~0xFFF;
293			mmio_addr += SB800_PM_WDT_MMIO_OFFSET;
294			break;
295		case efch:
296			val = sp5100_tco_read_pm_reg8(EFCH_PM_ISACONTROL);
297			if (!(val & EFCH_PM_ISACONTROL_MMIOEN)) {
298				ret = -ENODEV;
299				goto unreg_region;
300			}
301			mmio_addr = EFCH_PM_ACPI_MMIO_ADDR +
302				    EFCH_PM_ACPI_MMIO_WDT_OFFSET;
303			break;
304		}
305		dev_dbg(dev, "Got 0x%08x from SBResource_MMIO register\n",
306			mmio_addr);
307		if (!devm_request_mem_region(dev, mmio_addr,
308					     SP5100_WDT_MEM_MAP_SIZE,
309					     dev_name)) {
310			dev_dbg(dev, "MMIO address 0x%08x already in use\n",
311				mmio_addr);
312			ret = -EBUSY;
313			goto unreg_region;
314		}
315	}
316
317	tco->tcobase = devm_ioremap(dev, mmio_addr, SP5100_WDT_MEM_MAP_SIZE);
318	if (!tco->tcobase) {
319		dev_err(dev, "failed to get tcobase address\n");
320		ret = -ENOMEM;
 
 
 
 
 
 
 
 
 
 
 
321		goto unreg_region;
322	}
 
323
324	dev_info(dev, "Using 0x%08x for watchdog MMIO address\n", mmio_addr);
 
 
 
 
325
326	/* Setup the watchdog timer */
327	tco_timer_enable(tco);
 
 
 
 
 
 
 
 
328
329	val = readl(SP5100_WDT_CONTROL(tco->tcobase));
330	if (val & SP5100_WDT_DISABLED) {
331		dev_err(dev, "Watchdog hardware is disabled\n");
332		ret = -ENODEV;
333		goto unreg_region;
334	}
335
336	/*
337	 * Save WatchDogFired status, because WatchDogFired flag is
338	 * cleared here.
339	 */
340	if (val & SP5100_WDT_FIRED)
341		wdd->bootstatus = WDIOF_CARDRESET;
342	/* Set watchdog action to reset the system */
343	val &= ~SP5100_WDT_ACTION_RESET;
344	writel(val, SP5100_WDT_CONTROL(tco->tcobase));
345
346	/* Set a reasonable heartbeat before we stop the timer */
347	tco_timer_set_timeout(wdd, wdd->timeout);
348
349	/*
350	 * Stop the TCO before we change anything so we don't race with
351	 * a zeroed timer.
352	 */
353	tco_timer_stop(wdd);
354
355	release_region(SP5100_IO_PM_INDEX_REG, SP5100_PM_IOPORTS_SIZE);
 
356
 
 
 
 
 
357	return 0;
 
358
359unreg_region:
360	release_region(SP5100_IO_PM_INDEX_REG, SP5100_PM_IOPORTS_SIZE);
361	return ret;
362}
363
364static struct watchdog_info sp5100_tco_wdt_info = {
365	.identity = "SP5100 TCO timer",
366	.options = WDIOF_SETTIMEOUT | WDIOF_KEEPALIVEPING | WDIOF_MAGICCLOSE,
367};
 
368
369static const struct watchdog_ops sp5100_tco_wdt_ops = {
370	.owner = THIS_MODULE,
371	.start = tco_timer_start,
372	.stop = tco_timer_stop,
373	.ping = tco_timer_ping,
374	.set_timeout = tco_timer_set_timeout,
375};
 
 
376
377static int sp5100_tco_probe(struct platform_device *pdev)
378{
379	struct device *dev = &pdev->dev;
380	struct watchdog_device *wdd;
381	struct sp5100_tco *tco;
382	int ret;
 
 
383
384	tco = devm_kzalloc(dev, sizeof(*tco), GFP_KERNEL);
385	if (!tco)
386		return -ENOMEM;
387
388	tco->tco_reg_layout = tco_reg_layout(sp5100_tco_pci);
389
390	wdd = &tco->wdd;
391	wdd->parent = dev;
392	wdd->info = &sp5100_tco_wdt_info;
393	wdd->ops = &sp5100_tco_wdt_ops;
394	wdd->timeout = WATCHDOG_HEARTBEAT;
395	wdd->min_timeout = 1;
396	wdd->max_timeout = 0xffff;
397
398	if (watchdog_init_timeout(wdd, heartbeat, NULL))
399		dev_info(dev, "timeout value invalid, using %d\n",
400			 wdd->timeout);
401	watchdog_set_nowayout(wdd, nowayout);
402	watchdog_stop_on_reboot(wdd);
403	watchdog_stop_on_unregister(wdd);
404	watchdog_set_drvdata(wdd, tco);
405
406	ret = sp5100_tco_setupdevice(dev, wdd);
407	if (ret)
408		return ret;
409
410	ret = devm_watchdog_register_device(dev, wdd);
411	if (ret) {
412		dev_err(dev, "cannot register watchdog device (err=%d)\n", ret);
413		return ret;
414	}
415
416	/* Show module parameters */
417	dev_info(dev, "initialized. heartbeat=%d sec (nowayout=%d)\n",
418		 wdd->timeout, nowayout);
419
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
420	return 0;
421}
422
 
 
 
 
 
423static struct platform_driver sp5100_tco_driver = {
424	.probe		= sp5100_tco_probe,
 
 
425	.driver		= {
426		.name	= TCO_DRIVER_NAME,
 
427	},
428};
429
430/*
431 * Data for PCI driver interface
432 *
433 * This data only exists for exporting the supported
434 * PCI ids via MODULE_DEVICE_TABLE.  We do not actually
435 * register a pci_driver, because someone else might
436 * want to register another driver on the same PCI id.
437 */
438static const struct pci_device_id sp5100_tco_pci_tbl[] = {
439	{ PCI_VENDOR_ID_ATI, PCI_DEVICE_ID_ATI_SBX00_SMBUS, PCI_ANY_ID,
440	  PCI_ANY_ID, },
441	{ PCI_VENDOR_ID_AMD, PCI_DEVICE_ID_AMD_HUDSON2_SMBUS, PCI_ANY_ID,
442	  PCI_ANY_ID, },
443	{ PCI_VENDOR_ID_AMD, PCI_DEVICE_ID_AMD_KERNCZ_SMBUS, PCI_ANY_ID,
444	  PCI_ANY_ID, },
445	{ 0, },			/* End of list */
446};
447MODULE_DEVICE_TABLE(pci, sp5100_tco_pci_tbl);
448
449static int __init sp5100_tco_init(void)
450{
451	struct pci_dev *dev = NULL;
452	int err;
453
454	/* Match the PCI device */
455	for_each_pci_dev(dev) {
456		if (pci_match_id(sp5100_tco_pci_tbl, dev) != NULL) {
457			sp5100_tco_pci = dev;
458			break;
459		}
460	}
461
462	if (!sp5100_tco_pci)
463		return -ENODEV;
464
465	pr_info("SP5100/SB800 TCO WatchDog Timer Driver\n");
466
467	err = platform_driver_register(&sp5100_tco_driver);
468	if (err)
469		return err;
470
471	sp5100_tco_platform_device =
472		platform_device_register_simple(TCO_DRIVER_NAME, -1, NULL, 0);
473	if (IS_ERR(sp5100_tco_platform_device)) {
474		err = PTR_ERR(sp5100_tco_platform_device);
475		goto unreg_platform_driver;
476	}
477
478	return 0;
479
480unreg_platform_driver:
481	platform_driver_unregister(&sp5100_tco_driver);
482	return err;
483}
484
485static void __exit sp5100_tco_exit(void)
486{
487	platform_device_unregister(sp5100_tco_platform_device);
488	platform_driver_unregister(&sp5100_tco_driver);
 
489}
490
491module_init(sp5100_tco_init);
492module_exit(sp5100_tco_exit);
493
494MODULE_AUTHOR("Priyanka Gupta");
495MODULE_DESCRIPTION("TCO timer driver for SP5100/SB800 chipset");
496MODULE_LICENSE("GPL");