开通博客赚积分
发布资源赚积分
分类

源码开发语言/平台
当前位置：首页 > 源码/资料 > 嵌入式/单片机编程 > 嵌入式Linux > 查看源码
toshiba.c
资源名称：SBC-2410X_kernel.tar.gz　[点击查看]
上传用户：lgb322
上传日期：2013-02-24
资源大小：30529k
文件大小：12k
源码类别：

嵌入式Linux

开发平台：

Unix_Linux

toshiba.c：源码内容
  1. /* toshiba.c -- Linux driver for accessing the SMM on Toshiba laptops
  2.  *
  3.  * Copyright (c) 1996-2001  Jonathan A. Buzzard (jonathan@buzzard.org.uk)
  4.  *
  5.  * Valuable assistance and patches from:
  6.  *     Tom May <tom@you-bastards.com>
  7.  *     Rob Napier <rnapier@employees.org>
  8.  *
  9.  * Fn status port numbers for machine ID's courtesy of
  10.  *     0xfc02: Scott Eisert <scott.e@sky-eye.com>
  11.  *     0xfc04: Steve VanDevender <stevev@efn.org>
  12.  *     0xfc08: Garth Berry <garth@itsbruce.net>
  13.  *     0xfc0a: Egbert Eich <eich@xfree86.org>
  14.  *     0xfc10: Andrew Lofthouse <Andrew.Lofthouse@robins.af.mil>
  15.  *     0xfc11: Spencer Olson <solson@novell.com>
  16.  *     0xfc13: Claudius Frankewitz <kryp@gmx.de>
  17.  *     0xfc15: Tom May <tom@you-bastards.com>
  18.  *     0xfc17: Dave Konrad <konrad@xenia.it>
  19.  *     0xfc1a: George Betzos <betzos@engr.colostate.edu>
  20.  *     0xfc1b: Munemasa Wada <munemasa@jnovel.co.jp>
  21.  *     0xfc1d: Arthur Liu <armie@slap.mine.nu>
  22.  *     0xfc5a: Jacques L'helgoualc'h <lhh@free.fr>
  23.  *     0xfcd1: Mr. Dave Konrad <konrad@xenia.it>
  24.  *
  25.  * WARNING WARNING WARNING WARNING WARNING WARNING WARNING WARNING WARNING
  26.  *
  27.  *   This code is covered by the GNU GPL and you are free to make any
  28.  *   changes you wish to it under the terms of the license. However the
  29.  *   code has the potential to render your computer and/or someone else's
  30.  *   unusable. Please proceed with care when modifying the code.
  31.  *
  32.  * Note: Unfortunately the laptop hardware can close the System Configuration
  33.  *       Interface on it's own accord. It is therefore necessary for *all*
  34.  *       programs using this driver to be aware that *any* SCI call can fail at
  35.  *       *any* time. It is up to any program to be aware of this eventuality
  36.  *       and take appropriate steps.
  37.  *
  38.  * This program is free software; you can redistribute it and/or modify it
  39.  * under the terms of the GNU General Public License as published by the
  40.  * Free Software Foundation; either version 2, or (at your option) any
  41.  * later version.
  42.  *
  43.  * This program is distributed in the hope that it will be useful, but
  44.  * WITHOUT ANY WARRANTY; without even the implied warranty of
  45.  * MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE.  See the GNU
  46.  * General Public License for more details.
  47.  *
  48.  * The information used to write this driver has been obtained by reverse
  49.  * engineering the software supplied by Toshiba for their portable computers in
  50.  * strict accordance with the European Council Directive 92/250/EEC on the legal
  51.  * protection of computer programs, and it's implementation into English Law by
  52.  * the Copyright (Computer Programs) Regulations 1992 (S.I. 1992 No.3233).
  53.  *
  54.  */
  56. #define TOSH_VERSION "1.11 26/9/2001"
  57. #define TOSH_DEBUG 0
  59. #include <linux/module.h>
  60. #include <linux/version.h>
  61. #include <linux/kernel.h>
  62. #include <linux/sched.h>
  63. #include <linux/types.h>
  64. #include <linux/fcntl.h>
  65. #include <linux/miscdevice.h>
  66. #include <linux/ioport.h>
  67. #include <asm/io.h>
  68. #include <asm/uaccess.h>
  69. #include <linux/init.h>
  70. #include <linux/stat.h>
  71. #include <linux/proc_fs.h>
  73. #include <linux/toshiba.h>
  75. #define TOSH_MINOR_DEV 181
  77. static int tosh_id = 0x0000;
  78. static int tosh_bios = 0x0000;
  79. static int tosh_date = 0x0000;
  80. static int tosh_sci = 0x0000;
  81. static int tosh_fan = 0;
  83. static int tosh_fn = 0;
  85. MODULE_PARM(tosh_fn, "i");
  87. MODULE_LICENSE("GPL");
  90. static int tosh_get_info(char *, char **, off_t, int);
  91. static int tosh_ioctl(struct inode *, struct file *, unsigned int,
  92. unsigned long);
  95. static struct file_operations tosh_fops = {
  96. owner: THIS_MODULE,
  97. ioctl: tosh_ioctl,
  98. };
  100. static struct miscdevice tosh_device = {
  101. TOSH_MINOR_DEV,
  102. "toshiba",
  103. &tosh_fops
  104. };
  106. /*
  107.  * Read the Fn key status
  108.  */
  109. static int tosh_fn_status(void)
  110. {
  111.         unsigned char scan;
  112. unsigned long flags;
  114. if (tosh_fn!=0) {
  115. scan = inb(tosh_fn);
  116. } else {
  117. save_flags(flags);
  118. cli();
  119. outb(0x8e, 0xe4);
  120. scan = inb(0xe5);
  121. restore_flags(flags);
  122. }
  124.         return (int) scan;
  125. }
  128. /*
  129.  * For the Portage 610CT and the Tecra 700CS/700CDT emulate the HCI fan function
  130.  */
  131. static int tosh_emulate_fan(SMMRegisters *regs)
  132. {
  133. unsigned long eax,ecx,flags;
  134. unsigned char al;
  136. eax = regs->eax & 0xff00;
  137. ecx = regs->ecx & 0xffff;
  139. /* Portage 610CT */
  141. if (tosh_id==0xfccb) {
  142. if (eax==0xfe00) {
  143. /* fan status */
  144. save_flags(flags);
  145. cli();
  146. outb(0xbe, 0xe4);
  147. al = inb(0xe5);
  148. restore_flags(flags);
  149. regs->eax = 0x00;
  150. regs->ecx = (unsigned int) (al & 0x01);
  151. }
  152. if ((eax==0xff00) && (ecx==0x0000)) {
  153. /* fan off */
  154. save_flags(flags);
  155. cli();
  156. outb(0xbe, 0xe4);
  157. al = inb(0xe5);
  158. outb(0xbe, 0xe4);
  159. outb (al | 0x01, 0xe5);
  160. restore_flags(flags);
  161. regs->eax = 0x00;
  162. regs->ecx = 0x00;
  163. }
  164. if ((eax==0xff00) && (ecx==0x0001)) {
  165. /* fan on */
  166. save_flags(flags);
  167. cli();
  168. outb(0xbe, 0xe4);
  169. al = inb(0xe5);
  170. outb(0xbe, 0xe4);
  171. outb(al & 0xfe, 0xe5);
  172. restore_flags(flags);
  173. regs->eax = 0x00;
  174. regs->ecx = 0x01;
  175. }
  176. }
  178. /* Tecra 700CS/CDT */
  180. if (tosh_id==0xfccc) {
  181. if (eax==0xfe00) {
  182. /* fan status */
  183. save_flags(flags);
  184. cli();
  185. outb(0xe0, 0xe4);
  186. al = inb(0xe5);
  187. restore_flags(flags);
  188. regs->eax = 0x00;
  189. regs->ecx = al & 0x01;
  190. }
  191. if ((eax==0xff00) && (ecx==0x0000)) {
  192. /* fan off */
  193. save_flags(flags);
  194. cli();
  195. outb(0xe0, 0xe4);
  196. al = inb(0xe5);
  197. outw(0xe0 | ((al & 0xfe) << 8), 0xe4);
  198. restore_flags(flags);
  199. regs->eax = 0x00;
  200. regs->ecx = 0x00;
  201. }
  202. if ((eax==0xff00) && (ecx==0x0001)) {
  203. /* fan on */
  204. save_flags(flags);
  205. cli();
  206. outb(0xe0, 0xe4);
  207. al = inb(0xe5);
  208. outw(0xe0 | ((al | 0x01) << 8), 0xe4);
  209. restore_flags(flags);
  210. regs->eax = 0x00;
  211. regs->ecx = 0x01;
  212. }
  213. }
  215. return 0;
  216. }
  219. /*
  220.  * Put the laptop into System Management Mode
  221.  */
  222. static int tosh_smm(SMMRegisters *regs)
  223. {
  224. int eax;
  226. asm ("# load the values into the registersnt" 
  227. "pushl %%eaxnt" 
  228. "movl 0(%%eax),%%edxnt" 
  229. "push %%edxnt" 
  230. "movl 4(%%eax),%%ebxnt" 
  231. "movl 8(%%eax),%%ecxnt" 
  232. "movl 12(%%eax),%%edxnt" 
  233. "movl 16(%%eax),%%esint" 
  234. "movl 20(%%eax),%%edint" 
  235. "popl %%eaxnt" 
  236. "# call the System Management modent" 
  237. "inb $0xb2,%%alnt"
  238. "# fill out the memory with the values in the registersnt" 
  239. "xchgl %%eax,(%%esp)nt"
  240. "movl %%ebx,4(%%eax)nt" 
  241. "movl %%ecx,8(%%eax)nt" 
  242. "movl %%edx,12(%%eax)nt" 
  243. "movl %%esi,16(%%eax)nt" 
  244. "movl %%edi,20(%%eax)nt" 
  245. "popl %%edxnt" 
  246. "movl %%edx,0(%%eax)nt" 
  247. "# setup the return value to the carry flagnt" 
  248. "lahfnt" 
  249. "shrl $8,%%eaxnt" 
  250. "andl $1,%%eaxn" 
  251. : "=a" (eax)
  252. : "a" (regs)
  253. : "%ebx", "%ecx", "%edx", "%esi", "%edi", "memory");
  255. return eax;
  256. }
  259. static int tosh_ioctl(struct inode *ip, struct file *fp, unsigned int cmd,
  260. unsigned long arg)
  261. {
  262. SMMRegisters regs;
  263. unsigned short ax,bx;
  264. int err;
  266. if (!arg)
  267. return -EINVAL;
  269. if (copy_from_user(&regs, (SMMRegisters *) arg, sizeof(SMMRegisters)))
  270. return -EFAULT;
  272. switch (cmd) {
  273. case TOSH_SMM:
  274. ax = regs.eax & 0xff00;
  275. bx = regs.ebx & 0xffff;
  276. /* block HCI calls to read/write memory & PCI devices */
  277. if (((ax==0xff00) || (ax==0xfe00)) && (bx>0x0069))
  278. return -EINVAL;
  280. /* do we need to emulate the fan ? */
  281. if (tosh_fan==1) {
  282. if (((ax==0xf300) || (ax==0xf400)) && (bx==0x0004)) {
  283. err = tosh_emulate_fan(&regs);
  284. break;
  285. }
  286. }
  287. err = tosh_smm(&regs);
  288. break;
  289. default:
  290. return -EINVAL;
  291. }
  293.         if (copy_to_user((SMMRegisters *) arg, &regs, sizeof(SMMRegisters)))
  294.          return -EFAULT;
  296. return (err==0) ? 0:-EINVAL;
  297. }
  300. /*
  301.  * Print the information for /proc/toshiba
  302.  */
  303. int tosh_get_info(char *buffer, char **start, off_t fpos, int length)
  304. {
  305. char *temp;
  306. int key;
  308. temp = buffer;
  309. key = tosh_fn_status();
  311. /* Arguments
  312.      0) Linux driver version (this will change if format changes)
  313.      1) Machine ID
  314.      2) SCI version
  315.      3) BIOS version (major, minor)
  316.      4) BIOS date (in SCI date format)
  317.      5) Fn Key status
  318. */
  320. temp += sprintf(temp, "1.1 0x%04x %d.%d %d.%d 0x%04x 0x%02xn",
  321. tosh_id,
  322. (tosh_sci & 0xff00)>>8,
  323. tosh_sci & 0xff,
  324. (tosh_bios & 0xff00)>>8,
  325. tosh_bios & 0xff,
  326. tosh_date,
  327. key);
  329. return temp-buffer;
  330. }
  333. /*
  334.  * Determine which port to use for the Fn key status
  335.  */
  336. static void tosh_set_fn_port(void)
  337. {
  338. switch (tosh_id) {
  339. case 0xfc02: case 0xfc04: case 0xfc09: case 0xfc0a: case 0xfc10:
  340. case 0xfc11: case 0xfc13: case 0xfc15: case 0xfc1a: case 0xfc1b:
  341. case 0xfc5a:
  342. tosh_fn = 0x62;
  343. break;
  344. case 0xfc08: case 0xfc17: case 0xfc1d: case 0xfcd1: case 0xfce0:
  345. case 0xfce2:
  346. tosh_fn = 0x68;
  347. break;
  348. default:
  349. tosh_fn = 0x00;
  350. break;
  351. }
  353. return;
  354. }
  357. /*
  358.  * Get the machine identification number of the current model
  359.  */
  360. static int tosh_get_machine_id(void)
  361. {
  362. int id;
  363. SMMRegisters regs;
  364. unsigned short bx,cx;
  365. unsigned long address;
  367. id = (0x100*(int) isa_readb(0xffffe))+((int) isa_readb(0xffffa));
  369. /* do we have a SCTTable machine identication number on our hands */
  371. if (id==0xfc2f) {
  373. /* start by getting a pointer into the BIOS */
  375. regs.eax = 0xc000;
  376. regs.ebx = 0x0000;
  377. regs.ecx = 0x0000;
  378. tosh_smm(&regs);
  379. bx = (unsigned short) (regs.ebx & 0xffff);
  381. /* At this point in the Toshiba routines under MS Windows
  382.    the bx register holds 0xe6f5. However my code is producing
  383.    a different value! For the time being I will just fudge the
  384.    value. This has been verified on a Satellite Pro 430CDT,
  385.    Tecra 750CDT, Tecra 780DVD and Satellite 310CDT. */
  386. #if TOSH_DEBUG
  387. printk("toshiba: debugging ID ebx=0x%04xn", regs.ebx);
  388. #endif
  389. bx = 0xe6f5;
  391. /* now twiddle with our pointer a bit */
  393. address = 0x000f0000+bx;
  394. cx = isa_readw(address);
  395. address = 0x000f0009+bx+cx;
  396. cx = isa_readw(address);
  397. address = 0x000f000a+cx;
  398. cx = isa_readw(address);
  400. /* now construct our machine identification number */
  402. id = ((cx & 0xff)<<8)+((cx & 0xff00)>>8);
  403. }
  405. return id;
  406. }
  409. /*
  410.  * Probe for the presence of a Toshiba laptop
  411.  *
  412.  *   returns and non-zero if unable to detect the presence of a Toshiba
  413.  *   laptop, otherwise zero and determines the Machine ID, BIOS version and
  414.  *   date, and SCI version.
  415.  */
  416. int tosh_probe(void)
  417. {
  418. int i,major,minor,day,year,month,flag;
  419. unsigned char signature[7] = { 0x54,0x4f,0x53,0x48,0x49,0x42,0x41 };
  420. SMMRegisters regs;
  422. /* extra sanity check for the string "TOSHIBA" in the BIOS because
  423.    some machines that are not Toshiba's pass the next test */
  425. for (i=0;i<7;i++) {
  426. if (isa_readb(0xfe010+i)!=signature[i]) {
  427. printk("toshiba: not a supported Toshiba laptopn");
  428. return -ENODEV;
  429. }
  430. }
  432. /* call the Toshiba SCI support check routine */
  434. regs.eax = 0xf0f0;
  435. regs.ebx = 0x0000;
  436. regs.ecx = 0x0000;
  437. flag = tosh_smm(&regs);
  439. /* if this is not a Toshiba laptop carry flag is set and ah=0x86 */
  441. if ((flag==1) || ((regs.eax & 0xff00)==0x8600)) {
  442. printk("toshiba: not a supported Toshiba laptopn");
  443. return -ENODEV;
  444. }
  446. /* if we get this far then we are running on a Toshiba (probably)! */
  448. tosh_sci = regs.edx & 0xffff;
  450. /* next get the machine ID of the current laptop */
  452. tosh_id = tosh_get_machine_id();
  454. /* get the BIOS version */
  456. major = isa_readb(0xfe009)-'0';
  457. minor = ((isa_readb(0xfe00b)-'0')*10)+(isa_readb(0xfe00c)-'0');
  458. tosh_bios = (major*0x100)+minor;
  460. /* get the BIOS date */
  462. day = ((isa_readb(0xffff5)-'0')*10)+(isa_readb(0xffff6)-'0');
  463. month = ((isa_readb(0xffff8)-'0')*10)+(isa_readb(0xffff9)-'0');
  464. year = ((isa_readb(0xffffb)-'0')*10)+(isa_readb(0xffffc)-'0');
  465. tosh_date = (((year-90) & 0x1f)<<10) | ((month & 0xf)<<6)
  466. | ((day & 0x1f)<<1);
  469. /* in theory we should check the ports we are going to use for the
  470.    fn key detection (and the fan on the Portage 610/Tecra700), and
  471.    then request them to stop other drivers using them. However as
  472.    the keyboard driver grabs 0x60-0x6f and the pic driver grabs
  473.    0xa0-0xbf we can't. We just have to live dangerously and use the
  474.    ports anyway, oh boy! */
  476. /* do we need to emulate the fan? */
  478. if ((tosh_id==0xfccb) || (tosh_id==0xfccc))
  479. tosh_fan = 1;
  481. return 0;
  482. }
  484. int __init tosh_init(void)
  485. {
  486. /* are we running on a Toshiba laptop */
  488. if (tosh_probe()!=0)
  489. return -EIO;
  491. printk(KERN_INFO "Toshiba System Managment Mode driver v"
  492. TOSH_VERSION"n");
  494. /* set the port to use for Fn status if not specified as a parameter */
  496. if (tosh_fn==0x00)
  497. tosh_set_fn_port();
  499. /* register the device file */
  501. misc_register(&tosh_device);
  503. /* register the proc entry */
  505. create_proc_info_entry("toshiba", 0, NULL, tosh_get_info);
  507. return 0;
  508. }
  510. #ifdef MODULE
  511. int init_module(void)
  512. {
  513. return tosh_init();
  514. }
  516. void cleanup_module(void)
  517. {
  518. /* remove the proc entry */
  520. remove_proc_entry("toshiba", NULL);
  522. /* unregister the device file */
  524. misc_deregister(&tosh_device);
  525. }
  526. #endif