pcwd.c
上传用户:lgb322
上传日期:2013-02-24
资源大小:30529k
文件大小:15k
源码类别:

嵌入式Linux

开发平台:

Unix_Linux

  1. /*
  2.  * PC Watchdog Driver
  3.  * by Ken Hollis (khollis@bitgate.com)
  4.  *
  5.  * Permission granted from Simon Machell (73244.1270@compuserve.com)
  6.  * Written for the Linux Kernel, and GPLed by Ken Hollis
  7.  *
  8.  * 960107 Added request_region routines, modulized the whole thing.
  9.  * 960108 Fixed end-of-file pointer (Thanks to Dan Hollis), added
  10.  * WD_TIMEOUT define.
  11.  * 960216 Added eof marker on the file, and changed verbose messages.
  12.  * 960716 Made functional and cosmetic changes to the source for
  13.  * inclusion in Linux 2.0.x kernels, thanks to Alan Cox.
  14.  * 960717 Removed read/seek routines, replaced with ioctl.  Also, added
  15.  * check_region command due to Alan's suggestion.
  16.  * 960821 Made changes to compile in newer 2.0.x kernels.  Added
  17.  * "cold reboot sense" entry.
  18.  * 960825 Made a few changes to code, deleted some defines and made
  19.  * typedefs to replace them.  Made heartbeat reset only available
  20.  * via ioctl, and removed the write routine.
  21.  * 960828 Added new items for PC Watchdog Rev.C card.
  22.  * 960829 Changed around all of the IOCTLs, added new features,
  23.  * added watchdog disable/re-enable routines.  Added firmware
  24.  * version reporting.  Added read routine for temperature.
  25.  * Removed some extra defines, added an autodetect Revision
  26.  * routine.
  27.  * 961006       Revised some documentation, fixed some cosmetic bugs.  Made
  28.  *              drivers to panic the system if it's overheating at bootup.
  29.  * 961118 Changed some verbiage on some of the output, tidied up
  30.  * code bits, and added compatibility to 2.1.x.
  31.  * 970912       Enabled board on open and disable on close.
  32.  * 971107 Took account of recent VFS changes (broke read).
  33.  * 971210       Disable board on initialisation in case board already ticking.
  34.  * 971222       Changed open/close for temperature handling
  35.  *              Michael Meskes <meskes@debian.org>.
  36.  * 980112       Used minor numbers from include/linux/miscdevice.h
  37.  * 990403       Clear reset status after reading control status register in 
  38.  *              pcwd_showprevstate(). [Marc Boucher <marc@mbsi.ca>]
  39.  * 990605 Made changes to code to support Firmware 1.22a, added
  40.  * fairly useless proc entry.
  41.  * 990610 removed said useless proc code for the merge <alan>
  42.  * 000403 Removed last traces of proc code. <davej>
  43.  */
  44. #include <linux/module.h>
  45. #include <linux/types.h>
  46. #include <linux/errno.h>
  47. #include <linux/sched.h>
  48. #include <linux/tty.h>
  49. #include <linux/timer.h>
  50. #include <linux/config.h>
  51. #include <linux/kernel.h>
  52. #include <linux/wait.h>
  53. #include <linux/string.h>
  54. #include <linux/slab.h>
  55. #include <linux/ioport.h>
  56. #include <linux/delay.h>
  57. #include <linux/miscdevice.h>
  58. #include <linux/fs.h>
  59. #include <linux/mm.h>
  60. #include <linux/watchdog.h>
  61. #include <linux/init.h>
  62. #include <linux/proc_fs.h>
  63. #include <linux/spinlock.h>
  64. #include <linux/smp_lock.h>
  65. #include <asm/uaccess.h>
  66. #include <asm/io.h>
  67. /*
  68.  * These are the auto-probe addresses available.
  69.  *
  70.  * Revision A only uses ports 0x270 and 0x370.  Revision C introduced 0x350.
  71.  * Revision A has an address range of 2 addresses, while Revision C has 3.
  72.  */
  73. static int pcwd_ioports[] = { 0x270, 0x350, 0x370, 0x000 };
  74. #define WD_VER                  "1.10 (06/05/99)"
  75. /*
  76.  * It should be noted that PCWD_REVISION_B was removed because A and B
  77.  * are essentially the same types of card, with the exception that B
  78.  * has temperature reporting.  Since I didn't receive a Rev.B card,
  79.  * the Rev.B card is not supported.  (It's a good thing too, as they
  80.  * are no longer in production.)
  81.  */
  82. #define PCWD_REVISION_A 1
  83. #define PCWD_REVISION_C 2
  84. #define WD_TIMEOUT 3 /* 1 1/2 seconds for a timeout */
  85. /*
  86.  * These are the defines for the PC Watchdog card, revision A.
  87.  */
  88. #define WD_WDRST                0x01 /* Previously reset state */
  89. #define WD_T110                 0x02 /* Temperature overheat sense */
  90. #define WD_HRTBT                0x04 /* Heartbeat sense */
  91. #define WD_RLY2                 0x08 /* External relay triggered */
  92. #define WD_SRLY2                0x80 /* Software external relay triggered */
  93. static int current_readport, revision, temp_panic;
  94. static int is_open, initial_status, supports_temp, mode_debug;
  95. static spinlock_t io_lock;
  96. /*
  97.  * PCWD_CHECKCARD
  98.  *
  99.  * This routine checks the "current_readport" to see if the card lies there.
  100.  * If it does, it returns accordingly.
  101.  */
  102. static int __init pcwd_checkcard(void)
  103. {
  104. int card_dat, prev_card_dat, found = 0, count = 0, done = 0;
  105. /* As suggested by Alan Cox - this is a safety measure. */
  106. if (check_region(current_readport, 4)) {
  107. printk("pcwd: Port 0x%x unavailable.n", current_readport);
  108. return 0;
  109. }
  110. card_dat = 0x00;
  111. prev_card_dat = 0x00;
  112. prev_card_dat = inb(current_readport);
  113. if (prev_card_dat == 0xFF)
  114. return 0;
  115. while(count < WD_TIMEOUT) {
  116. /* Read the raw card data from the port, and strip off the
  117.    first 4 bits */
  118. card_dat = inb_p(current_readport);
  119. card_dat &= 0x000F;
  120. /* Sleep 1/2 second (or 500000 microseconds :) */
  121. mdelay(500);
  122. done = 0;
  123. /* If there's a heart beat in both instances, then this means we
  124.    found our card.  This also means that either the card was
  125.    previously reset, or the computer was power-cycled. */
  126. if ((card_dat & WD_HRTBT) && (prev_card_dat & WD_HRTBT) &&
  127. (!done)) {
  128. found = 1;
  129. done = 1;
  130. break;
  131. }
  132. /* If the card data is exactly the same as the previous card data,
  133.    it's safe to assume that we should check again.  The manual says
  134.    that the heart beat will change every second (or the bit will
  135.    toggle), and this can be used to see if the card is there.  If
  136.    the card was powered up with a cold boot, then the card will
  137.    not start blinking until 2.5 minutes after a reboot, so this
  138.    bit will stay at 1. */
  139. if ((card_dat == prev_card_dat) && (!done)) {
  140. count++;
  141. done = 1;
  142. }
  143. /* If the card data is toggling any bits, this means that the heart
  144.    beat was detected, or something else about the card is set. */
  145. if ((card_dat != prev_card_dat) && (!done)) {
  146. done = 1;
  147. found = 1;
  148. break;
  149. }
  150. /* Otherwise something else strange happened. */
  151. if (!done)
  152. count++;
  153. }
  154. return((found) ? 1 : 0);
  155. }
  156. void pcwd_showprevstate(void)
  157. {
  158. int card_status = 0x0000;
  159. if (revision == PCWD_REVISION_A)
  160. initial_status = card_status = inb(current_readport);
  161. else {
  162. initial_status = card_status = inb(current_readport + 1);
  163. outb_p(0x00, current_readport + 1); /* clear reset status */
  164. }
  165. if (revision == PCWD_REVISION_A) {
  166. if (card_status & WD_WDRST)
  167. printk("pcwd: Previous reboot was caused by the card.n");
  168. if (card_status & WD_T110) {
  169. printk("pcwd: Card senses a CPU Overheat.  Panicking!n");
  170. panic("pcwd: CPU Overheat.n");
  171. }
  172. if ((!(card_status & WD_WDRST)) &&
  173.     (!(card_status & WD_T110)))
  174. printk("pcwd: Cold boot sense.n");
  175. } else {
  176. if (card_status & 0x01)
  177. printk("pcwd: Previous reboot was caused by the card.n");
  178. if (card_status & 0x04) {
  179. printk("pcwd: Card senses a CPU Overheat.  Panicking!n");
  180. panic("pcwd: CPU Overheat.n");
  181. }
  182. if ((!(card_status & 0x01)) &&
  183.     (!(card_status & 0x04)))
  184. printk("pcwd: Cold boot sense.n");
  185. }
  186. }
  187. static void pcwd_send_heartbeat(void)
  188. {
  189. int wdrst_stat;
  190. wdrst_stat = inb_p(current_readport);
  191. wdrst_stat &= 0x0F;
  192. wdrst_stat |= WD_WDRST;
  193. if (revision == PCWD_REVISION_A)
  194. outb_p(wdrst_stat, current_readport + 1);
  195. else
  196. outb_p(wdrst_stat, current_readport);
  197. }
  198. static int pcwd_ioctl(struct inode *inode, struct file *file,
  199.       unsigned int cmd, unsigned long arg)
  200. {
  201. int i, cdat, rv;
  202. static struct watchdog_info ident=
  203. {
  204. WDIOF_OVERHEAT|WDIOF_CARDRESET,
  205. 1,
  206. "PCWD"
  207. };
  208. switch(cmd) {
  209. default:
  210. return -ENOTTY;
  211. case WDIOC_GETSUPPORT:
  212. i = copy_to_user((void*)arg, &ident, sizeof(ident));
  213. return i ? -EFAULT : 0;
  214. case WDIOC_GETSTATUS:
  215. spin_lock(&io_lock);
  216. if (revision == PCWD_REVISION_A) 
  217. cdat = inb(current_readport);
  218. else
  219. cdat = inb(current_readport + 1 );
  220. spin_unlock(&io_lock);
  221. rv = 0;
  222. if (revision == PCWD_REVISION_A) 
  223. {
  224. if (cdat & WD_WDRST)
  225. rv |= WDIOF_CARDRESET;
  226. if (cdat & WD_T110) 
  227. {
  228. rv |= WDIOF_OVERHEAT;
  229. if (temp_panic)
  230. panic("pcwd: Temperature overheat trip!n");
  231. }
  232. }
  233. else 
  234. {
  235. if (cdat & 0x01)
  236. rv |= WDIOF_CARDRESET;
  237. if (cdat & 0x04) 
  238. {
  239. rv |= WDIOF_OVERHEAT;
  240. if (temp_panic)
  241. panic("pcwd: Temperature overheat trip!n");
  242. }
  243. }
  244. if(put_user(rv, (int *) arg))
  245. return -EFAULT;
  246. return 0;
  247. case WDIOC_GETBOOTSTATUS:
  248. rv = 0;
  249. if (revision == PCWD_REVISION_A) 
  250. {
  251. if (initial_status & WD_WDRST)
  252. rv |= WDIOF_CARDRESET;
  253. if (initial_status & WD_T110)
  254. rv |= WDIOF_OVERHEAT;
  255. }
  256. else
  257. {
  258. if (initial_status & 0x01)
  259. rv |= WDIOF_CARDRESET;
  260. if (initial_status & 0x04)
  261. rv |= WDIOF_OVERHEAT;
  262. }
  263. if(put_user(rv, (int *) arg))
  264. return -EFAULT;
  265. return 0;
  266. case WDIOC_GETTEMP:
  267. rv = 0;
  268. if ((supports_temp) && (mode_debug == 0)) 
  269. {
  270. spin_lock(&io_lock);
  271. rv = inb(current_readport);
  272. spin_unlock(&io_lock);
  273. if(put_user(rv, (int*) arg))
  274. return -EFAULT;
  275. } else if(put_user(rv, (int*) arg))
  276. return -EFAULT;
  277. return 0;
  278. case WDIOC_SETOPTIONS:
  279. if (revision == PCWD_REVISION_C) 
  280. {
  281. if(copy_from_user(&rv, (int*) arg, sizeof(int)))
  282. return -EFAULT;
  283. if (rv & WDIOS_DISABLECARD) 
  284. {
  285. spin_lock(&io_lock);
  286. outb_p(0xA5, current_readport + 3);
  287. outb_p(0xA5, current_readport + 3);
  288. cdat = inb_p(current_readport + 2);
  289. spin_unlock(&io_lock);
  290. if ((cdat & 0x10) == 0) 
  291. {
  292. printk("pcwd: Could not disable card.n");
  293. return -EIO;
  294. }
  295. return 0;
  296. }
  297. if (rv & WDIOS_ENABLECARD) 
  298. {
  299. spin_lock(&io_lock);
  300. outb_p(0x00, current_readport + 3);
  301. cdat = inb_p(current_readport + 2);
  302. spin_unlock(&io_lock);
  303. if (cdat & 0x10) 
  304. {
  305. printk("pcwd: Could not enable card.n");
  306. return -EIO;
  307. }
  308. return 0;
  309. }
  310. if (rv & WDIOS_TEMPPANIC) 
  311. {
  312. temp_panic = 1;
  313. }
  314. }
  315. return -EINVAL;
  316. case WDIOC_KEEPALIVE:
  317. pcwd_send_heartbeat();
  318. return 0;
  319. }
  320. return 0;
  321. }
  322. static ssize_t pcwd_write(struct file *file, const char *buf, size_t len,
  323.   loff_t *ppos)
  324. {
  325. /*  Can't seek (pwrite) on this device  */
  326. if (ppos != &file->f_pos)
  327. return -ESPIPE;
  328. if (len)
  329. {
  330. pcwd_send_heartbeat();
  331. return 1;
  332. }
  333. return 0;
  334. }
  335. static int pcwd_open(struct inode *ino, struct file *filep)
  336. {
  337.         switch (MINOR(ino->i_rdev))
  338.         {
  339.                 case WATCHDOG_MINOR:
  340.                     if (is_open)
  341.                         return -EBUSY;
  342.                     MOD_INC_USE_COUNT;
  343.                     /*  Enable the port  */
  344.                     if (revision == PCWD_REVISION_C)
  345.                     {
  346.                      spin_lock(&io_lock);
  347.                      outb_p(0x00, current_readport + 3);
  348.                      spin_unlock(&io_lock);
  349.                     }
  350.                     is_open = 1;
  351.                     return(0);
  352.                 case TEMP_MINOR:
  353.                     return(0);
  354.                 default:
  355.                     return (-ENODEV);
  356.         }
  357. }
  358. static ssize_t pcwd_read(struct file *file, char *buf, size_t count,
  359.  loff_t *ppos)
  360. {
  361. unsigned short c;
  362. unsigned char cp;
  363. /*  Can't seek (pread) on this device  */
  364. if (ppos != &file->f_pos)
  365. return -ESPIPE;
  366. switch(MINOR(file->f_dentry->d_inode->i_rdev)) 
  367. {
  368. case TEMP_MINOR:
  369. /*
  370.  * Convert metric to Fahrenheit, since this was
  371.  * the decided 'standard' for this return value.
  372.  */
  373. c = inb(current_readport);
  374. cp = (c * 9 / 5) + 32;
  375. if(copy_to_user(buf, &cp, 1))
  376. return -EFAULT;
  377. return 1;
  378. default:
  379. return -EINVAL;
  380. }
  381. }
  382. static int pcwd_close(struct inode *ino, struct file *filep)
  383. {
  384. if (MINOR(ino->i_rdev)==WATCHDOG_MINOR)
  385. {
  386. lock_kernel();
  387.         is_open = 0;
  388. #ifndef CONFIG_WATCHDOG_NOWAYOUT
  389. /*  Disable the board  */
  390. if (revision == PCWD_REVISION_C) {
  391. spin_lock(&io_lock);
  392. outb_p(0xA5, current_readport + 3);
  393. outb_p(0xA5, current_readport + 3);
  394. spin_unlock(&io_lock);
  395. }
  396. #endif
  397. unlock_kernel();
  398. }
  399. return 0;
  400. }
  401. static inline void get_support(void)
  402. {
  403. if (inb(current_readport) != 0xF0)
  404. supports_temp = 1;
  405. }
  406. static inline int get_revision(void)
  407. {
  408. int r = PCWD_REVISION_C;
  409. spin_lock(&io_lock);
  410. if ((inb(current_readport + 2) == 0xFF) ||
  411.     (inb(current_readport + 3) == 0xFF))
  412. r=PCWD_REVISION_A;
  413. spin_unlock(&io_lock);
  414. return r;
  415. }
  416. static int __init send_command(int cmd)
  417. {
  418. int i;
  419. outb_p(cmd, current_readport + 2);
  420. mdelay(1);
  421. i = inb(current_readport);
  422. i = inb(current_readport);
  423. return(i);
  424. }
  425. static inline char *get_firmware(void)
  426. {
  427. int i, found = 0, count = 0, one, ten, hund, minor;
  428. char *ret;
  429. ret = kmalloc(6, GFP_KERNEL);
  430. if(ret == NULL)
  431. return NULL;
  432. while((count < 3) && (!found)) {
  433. outb_p(0x80, current_readport + 2);
  434. i = inb(current_readport);
  435. if (i == 0x00)
  436. found = 1;
  437. else if (i == 0xF3)
  438. outb_p(0x00, current_readport + 2);
  439. udelay(400L);
  440. count++;
  441. }
  442. if (found) {
  443. mode_debug = 1;
  444. one = send_command(0x81);
  445. ten = send_command(0x82);
  446. hund = send_command(0x83);
  447. minor = send_command(0x84);
  448. sprintf(ret, "%c.%c%c%c", one, ten, hund, minor);
  449. }
  450. else
  451. sprintf(ret, "ERROR");
  452. return(ret);
  453. }
  454. static void debug_off(void)
  455. {
  456. outb_p(0x00, current_readport + 2);
  457. mode_debug = 0;
  458. }
  459. static struct file_operations pcwd_fops = {
  460. owner: THIS_MODULE,
  461. read: pcwd_read,
  462. write: pcwd_write,
  463. ioctl: pcwd_ioctl,
  464. open: pcwd_open,
  465. release: pcwd_close,
  466. };
  467. static struct miscdevice pcwd_miscdev = {
  468. WATCHDOG_MINOR,
  469. "watchdog",
  470. &pcwd_fops
  471. };
  472. static struct miscdevice temp_miscdev = {
  473. TEMP_MINOR,
  474. "temperature",
  475. &pcwd_fops
  476. };
  477.  
  478. static int __init pcwatchdog_init(void)
  479. {
  480. int i, found = 0;
  481. spin_lock_init(&io_lock);
  482. revision = PCWD_REVISION_A;
  483. printk("pcwd: v%s Ken Hollis (kenji@bitgate.com)n", WD_VER);
  484. /* Initial variables */
  485. is_open = 0;
  486. supports_temp = 0;
  487. mode_debug = 0;
  488. temp_panic = 0;
  489. initial_status = 0x0000;
  490. #ifndef PCWD_BLIND
  491. for (i = 0; pcwd_ioports[i] != 0; i++) {
  492. current_readport = pcwd_ioports[i];
  493. if (pcwd_checkcard()) {
  494. found = 1;
  495. break;
  496. }
  497. }
  498. if (!found) {
  499. printk("pcwd: No card detected, or port not available.n");
  500. return(-EIO);
  501. }
  502. #endif
  503. #ifdef PCWD_BLIND
  504. current_readport = PCWD_BLIND;
  505. #endif
  506. get_support();
  507. revision = get_revision();
  508. if (revision == PCWD_REVISION_A)
  509. printk("pcwd: PC Watchdog (REV.A) detected at port 0x%03xn", current_readport);
  510. else if (revision == PCWD_REVISION_C)
  511. printk("pcwd: PC Watchdog (REV.C) detected at port 0x%03x (Firmware version: %s)n",
  512. current_readport, get_firmware());
  513. else {
  514. /* Should NEVER happen, unless get_revision() fails. */
  515. printk("pcwd: Unable to get revision.n");
  516. return -1;
  517. }
  518. if (supports_temp)
  519. printk("pcwd: Temperature Option Detected.n");
  520. debug_off();
  521. pcwd_showprevstate();
  522. /*  Disable the board  */
  523. if (revision == PCWD_REVISION_C) {
  524. outb_p(0xA5, current_readport + 3);
  525. outb_p(0xA5, current_readport + 3);
  526. }
  527. if (revision == PCWD_REVISION_A)
  528. request_region(current_readport, 2, "PCWD Rev.A (Berkshire)");
  529. else
  530. request_region(current_readport, 4, "PCWD Rev.C (Berkshire)");
  531. misc_register(&pcwd_miscdev);
  532. if (supports_temp)
  533. misc_register(&temp_miscdev);
  534. return 0;
  535. }
  536. static void __exit pcwatchdog_exit(void)
  537. {
  538. misc_deregister(&pcwd_miscdev);
  539. /*  Disable the board  */
  540. if (revision == PCWD_REVISION_C) {
  541. outb_p(0xA5, current_readport + 3);
  542. outb_p(0xA5, current_readport + 3);
  543. }
  544. if (supports_temp)
  545. misc_deregister(&temp_miscdev);
  546. release_region(current_readport, (revision == PCWD_REVISION_A) ? 2 : 4);
  547. }
  548. module_init(pcwatchdog_init);
  549. module_exit(pcwatchdog_exit);
  550. MODULE_LICENSE("GPL");
  551. EXPORT_NO_SYMBOLS;