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

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

嵌入式Linux

开发平台：

Unix_Linux

db9.c：源码内容
  1. /*
  2.  * $Id: db9.c,v 1.6 2000/06/25 10:57:50 vojtech Exp $
  3.  *
  4.  *  Copyright (c) 1999 Vojtech Pavlik
  5.  *
  6.  *  Based on the work of:
  7.  * Andree Borrmann Mats Sj鰒all
  8.  *
  9.  *  Sponsored by SuSE
  10.  */
  12. /*
  13.  * Atari, Amstrad, Commodore, Amiga, Sega, etc. joystick driver for Linux
  14.  */
  16. /*
  17.  * This program is free software; you can redistribute it and/or modify
  18.  * it under the terms of the GNU General Public License as published by
  19.  * the Free Software Foundation; either version 2 of the License, or 
  20.  * (at your option) any later version.
  21.  * 
  22.  * This program is distributed in the hope that it will be useful,
  23.  * but WITHOUT ANY WARRANTY; without even the implied warranty of
  24.  * MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE.  See the
  25.  * GNU General Public License for more details.
  26.  * 
  27.  * You should have received a copy of the GNU General Public License
  28.  * along with this program; if not, write to the Free Software
  29.  * Foundation, Inc., 59 Temple Place, Suite 330, Boston, MA 02111-1307 USA
  30.  *
  31.  * Should you need to contact me, the author, you can do so either by
  32.  * e-mail - mail your message to <vojtech@suse.cz>, or by paper mail:
  33.  * Vojtech Pavlik, Ucitelska 1576, Prague 8, 182 00 Czech Republic
  34.  */
  36. #include <linux/kernel.h>
  37. #include <linux/module.h>
  38. #include <linux/delay.h>
  39. #include <linux/init.h>
  40. #include <linux/parport.h>
  41. #include <linux/input.h>
  43. MODULE_AUTHOR("Vojtech Pavlik <vojtech@suse.cz>");
  44. MODULE_LICENSE("GPL");
  45. MODULE_PARM(db9, "2i");
  46. MODULE_PARM(db9_2, "2i");
  47. MODULE_PARM(db9_3, "2i");
  49. #define DB9_MULTI_STICK 0x01
  50. #define DB9_MULTI2_STICK 0x02
  51. #define DB9_GENESIS_PAD 0x03
  52. #define DB9_GENESIS5_PAD 0x05
  53. #define DB9_GENESIS6_PAD 0x06
  54. #define DB9_SATURN_PAD 0x07
  55. #define DB9_MULTI_0802 0x08
  56. #define DB9_MULTI_0802_2 0x09
  57. #define DB9_CD32_PAD 0x0A
  58. #define DB9_MAX_PAD 0x0B
  60. #define DB9_UP 0x01
  61. #define DB9_DOWN 0x02
  62. #define DB9_LEFT 0x04
  63. #define DB9_RIGHT 0x08
  64. #define DB9_FIRE1 0x10
  65. #define DB9_FIRE2 0x20
  66. #define DB9_FIRE3 0x40
  67. #define DB9_FIRE4 0x80
  69. #define DB9_NORMAL 0x0a
  70. #define DB9_NOSELECT 0x08
  72. #define DB9_SATURN0 0x00
  73. #define DB9_SATURN1 0x02
  74. #define DB9_SATURN2 0x04
  75. #define DB9_SATURN3 0x06
  77. #define DB9_GENESIS6_DELAY 14
  78. #define DB9_REFRESH_TIME HZ/100
  80. static int db9[] __initdata = { -1, 0 };
  81. static int db9_2[] __initdata = { -1, 0 };
  82. static int db9_3[] __initdata = { -1, 0 };
  84. struct db9 {
  85. struct input_dev dev[2];
  86. struct timer_list timer;
  87. struct pardevice *pd;
  88. int mode;
  89. int used;
  90. };
  92. static struct db9 *db9_base[3];
  94. static short db9_multi_btn[] = { BTN_TRIGGER, BTN_THUMB };
  95. static short db9_genesis_btn[] = { BTN_START, BTN_A, BTN_B, BTN_C, BTN_X, BTN_Y, BTN_Z, BTN_MODE };
  96. static short db9_cd32_btn[] = { BTN_A, BTN_B, BTN_C, BTN_X, BTN_Y, BTN_Z, BTN_TL, BTN_TR, BTN_START };
  98. static char db9_buttons[DB9_MAX_PAD] = { 0, 1, 2, 4, 0, 6, 8, 8, 1, 1, 7 };
  99. static short *db9_btn[DB9_MAX_PAD] = { NULL, db9_multi_btn, db9_multi_btn, db9_genesis_btn, NULL, db9_genesis_btn,
  100. db9_genesis_btn, db9_cd32_btn, db9_multi_btn, db9_multi_btn, db9_cd32_btn };
  101. static char *db9_name[DB9_MAX_PAD] = { NULL, "Multisystem joystick", "Multisystem joystick (2 fire)", "Genesis pad",
  102.       NULL, "Genesis 5 pad", "Genesis 6 pad", "Saturn pad", "Multisystem (0.8.0.2) joystick",
  103.      "Multisystem (0.8.0.2-dual) joystick", "Amiga CD-32 pad" };
  105. static void db9_timer(unsigned long private)
  106. {
  107. struct db9 *db9 = (void *) private;
  108. struct parport *port = db9->pd->port;
  109. struct input_dev *dev = db9->dev;
  110. int data, i;
  112. switch(db9->mode) {
  113. case DB9_MULTI_0802_2:
  115. data = parport_read_data(port) >> 3;
  117. input_report_abs(dev + 1, ABS_X, (data & DB9_RIGHT ? 0 : 1) - (data & DB9_LEFT ? 0 : 1));
  118. input_report_abs(dev + 1, ABS_Y, (data & DB9_DOWN  ? 0 : 1) - (data & DB9_UP   ? 0 : 1));
  119. input_report_key(dev + 1, BTN_TRIGGER, ~data & DB9_FIRE1);
  121. case DB9_MULTI_0802:
  123. data = parport_read_status(port) >> 3;
  125. input_report_abs(dev, ABS_X, (data & DB9_RIGHT ? 0 : 1) - (data & DB9_LEFT ? 0 : 1));
  126. input_report_abs(dev, ABS_Y, (data & DB9_DOWN  ? 0 : 1) - (data & DB9_UP   ? 0 : 1));
  127. input_report_key(dev, BTN_TRIGGER, data & DB9_FIRE1);
  128. break;
  130. case DB9_MULTI_STICK:
  132. data = parport_read_data(port);
  134. input_report_abs(dev, ABS_X, (data & DB9_RIGHT ? 0 : 1) - (data & DB9_LEFT ? 0 : 1));
  135. input_report_abs(dev, ABS_Y, (data & DB9_DOWN  ? 0 : 1) - (data & DB9_UP   ? 0 : 1));
  136. input_report_key(dev, BTN_TRIGGER, ~data & DB9_FIRE1);
  137. break;
  139. case DB9_MULTI2_STICK:
  141. data = parport_read_data(port);
  143. input_report_abs(dev, ABS_X, (data & DB9_RIGHT ? 0 : 1) - (data & DB9_LEFT ? 0 : 1));
  144. input_report_abs(dev, ABS_Y, (data & DB9_DOWN  ? 0 : 1) - (data & DB9_UP   ? 0 : 1));
  145. input_report_key(dev, BTN_TRIGGER, ~data & DB9_FIRE1);
  146. input_report_key(dev, BTN_THUMB,   ~data & DB9_FIRE2);
  147. break;
  149. case DB9_GENESIS_PAD:
  151. parport_write_control(port, DB9_NOSELECT);
  152. data = parport_read_data(port);
  154. input_report_abs(dev, ABS_X, (data & DB9_RIGHT ? 0 : 1) - (data & DB9_LEFT ? 0 : 1));
  155. input_report_abs(dev, ABS_Y, (data & DB9_DOWN  ? 0 : 1) - (data & DB9_UP   ? 0 : 1));
  156. input_report_key(dev, BTN_B, ~data & DB9_FIRE1);
  157. input_report_key(dev, BTN_C, ~data & DB9_FIRE2);
  159. parport_write_control(port, DB9_NORMAL);
  160. data=parport_read_data(port);
  162. input_report_key(dev, BTN_A,     ~data & DB9_FIRE1);
  163. input_report_key(dev, BTN_START, ~data & DB9_FIRE2);
  164. break;
  166. case DB9_GENESIS5_PAD:
  168. parport_write_control(port, DB9_NOSELECT);
  169. data=parport_read_data(port);
  171. input_report_abs(dev, ABS_X, (data & DB9_RIGHT ? 0 : 1) - (data & DB9_LEFT ? 0 : 1));
  172. input_report_abs(dev, ABS_Y, (data & DB9_DOWN  ? 0 : 1) - (data & DB9_UP   ? 0 : 1));
  173. input_report_key(dev, BTN_B, ~data & DB9_FIRE1);
  174. input_report_key(dev, BTN_C, ~data & DB9_FIRE2);
  176. parport_write_control(port, DB9_NORMAL);
  177. data=parport_read_data(port);
  179. input_report_key(dev, BTN_A,     ~data & DB9_FIRE1);
  180. input_report_key(dev, BTN_X,     ~data & DB9_FIRE2);
  181. input_report_key(dev, BTN_Y,     ~data & DB9_LEFT);
  182. input_report_key(dev, BTN_START, ~data & DB9_RIGHT);
  183. break;
  185. case DB9_GENESIS6_PAD:
  187. parport_write_control(port, DB9_NOSELECT); /* 1 */
  188. udelay(DB9_GENESIS6_DELAY);
  189. data=parport_read_data(port);
  191. input_report_abs(dev, ABS_X, (data & DB9_RIGHT ? 0 : 1) - (data & DB9_LEFT ? 0 : 1));
  192. input_report_abs(dev, ABS_Y, (data & DB9_DOWN  ? 0 : 1) - (data & DB9_UP   ? 0 : 1));
  193. input_report_key(dev, BTN_B, ~data & DB9_FIRE1);
  194. input_report_key(dev, BTN_C, ~data & DB9_FIRE2);
  196. parport_write_control(port, DB9_NORMAL);
  197. udelay(DB9_GENESIS6_DELAY);
  198. data=parport_read_data(port);
  200. input_report_key(dev, BTN_A, ~data & DB9_FIRE1);
  201. input_report_key(dev, BTN_X, ~data & DB9_FIRE2);
  203. parport_write_control(port, DB9_NOSELECT); /* 2 */
  204. udelay(DB9_GENESIS6_DELAY);
  205. parport_write_control(port, DB9_NORMAL);
  206. udelay(DB9_GENESIS6_DELAY);
  207. parport_write_control(port, DB9_NOSELECT); /* 3 */
  208. udelay(DB9_GENESIS6_DELAY);
  209. data=parport_read_data(port);
  211. input_report_key(dev, BTN_Y,     ~data & DB9_LEFT);
  212. input_report_key(dev, BTN_Z,     ~data & DB9_DOWN);
  213. input_report_key(dev, BTN_MODE,  ~data & DB9_UP);
  214. input_report_key(dev, BTN_START, ~data & DB9_RIGHT);
  216. parport_write_control(port, DB9_NORMAL);
  217. udelay(DB9_GENESIS6_DELAY);
  218. parport_write_control(port, DB9_NOSELECT); /* 4 */
  219. udelay(DB9_GENESIS6_DELAY);
  220. parport_write_control(port, DB9_NORMAL);
  221. break;
  223. case DB9_SATURN_PAD:
  225. parport_write_control(port, DB9_SATURN0);
  226. data = parport_read_data(port);
  228. input_report_key(dev, BTN_Y,  ~data & DB9_LEFT);
  229. input_report_key(dev, BTN_Z,  ~data & DB9_DOWN);
  230. input_report_key(dev, BTN_TL, ~data & DB9_UP);
  231. input_report_key(dev, BTN_TR, ~data & DB9_RIGHT);
  233. parport_write_control(port, DB9_SATURN2);
  234. data = parport_read_data(port);
  236. input_report_abs(dev, ABS_X, (data & DB9_RIGHT ? 0 : 1) - (data & DB9_LEFT ? 0 : 1));
  237. input_report_abs(dev, ABS_Y, (data & DB9_DOWN  ? 0 : 1) - (data & DB9_UP   ? 0 : 1));
  239. parport_write_control(port, DB9_NORMAL);
  240. data = parport_read_data(port);
  242. input_report_key(dev, BTN_A, ~data & DB9_LEFT);
  243. input_report_key(dev, BTN_B, ~data & DB9_UP);
  244. input_report_key(dev, BTN_C, ~data & DB9_DOWN);
  245. input_report_key(dev, BTN_X, ~data & DB9_RIGHT);
  246. break;
  248. case DB9_CD32_PAD:
  250. data=parport_read_data(port);
  252. input_report_abs(dev, ABS_X, (data & DB9_RIGHT ? 0 : 1) - (data & DB9_LEFT ? 0 : 1));
  253. input_report_abs(dev, ABS_Y, (data & DB9_DOWN  ? 0 : 1) - (data & DB9_UP   ? 0 : 1));
  255. parport_write_control(port, 0x0a); 
  257. for (i = 0; i < 7; i++) { 
  258. data = parport_read_data(port);
  259. parport_write_control(port, 0x02); 
  260. parport_write_control(port, 0x0a); 
  261. input_report_key(dev, db9_cd32_btn[i], ~data & DB9_FIRE2);
  262. }
  264. parport_write_control(port, 0x00); 
  265. break;
  266. }
  268. mod_timer(&db9->timer, jiffies + DB9_REFRESH_TIME);
  269. }
  271. static int db9_open(struct input_dev *dev)
  272. {
  273. struct db9 *db9 = dev->private;
  274. struct parport *port = db9->pd->port;
  276. if (!db9->used++) {
  277. parport_claim(db9->pd);
  278. parport_write_data(port, 0xff);
  279. parport_data_reverse(port);
  280. parport_write_control(port, DB9_NORMAL);
  281. mod_timer(&db9->timer, jiffies + DB9_REFRESH_TIME);
  282. }
  284. return 0;
  285. }
  287. static void db9_close(struct input_dev *dev)
  288. {
  289. struct db9 *db9 = dev->private;
  290. struct parport *port = db9->pd->port;
  292. if (!--db9->used) {
  293. del_timer(&db9->timer);
  294. parport_write_control(port, 0x00);
  295. parport_data_forward(port);
  296. parport_release(db9->pd);
  297. }
  298. }
  300. static struct db9 __init *db9_probe(int *config)
  301. {
  302. struct db9 *db9;
  303. struct parport *pp;
  304. int i, j;
  306. if (config[0] < 0)
  307. return NULL;
  308. if (config[1] < 1 || config[1] >= DB9_MAX_PAD || !db9_buttons[config[1]]) {
  309. printk(KERN_ERR "db9.c: bad confign");
  310. return NULL;
  311. }
  313. for (pp = parport_enumerate(); pp && (config[0] > 0); pp = pp->next)
  314. config[0]--;
  316. if (!pp) {
  317. printk(KERN_ERR "db9.c: no such parportn");
  318. return NULL;
  319. }
  321. if (!(pp->modes & PARPORT_MODE_TRISTATE) && config[1] != DB9_MULTI_0802) {
  322. printk(KERN_ERR "db9.c: specified parport is not bidirectionaln");
  323. return NULL;
  324. }
  326. if (!(db9 = kmalloc(sizeof(struct db9), GFP_KERNEL)))
  327. return NULL;
  328. memset(db9, 0, sizeof(struct db9));
  330. db9->mode = config[1];
  331. init_timer(&db9->timer);
  332. db9->timer.data = (long) db9;
  333. db9->timer.function = db9_timer;
  335. db9->pd = parport_register_device(pp, "db9", NULL, NULL, NULL, PARPORT_DEV_EXCL, NULL);
  337. if (!db9->pd) {
  338. printk(KERN_ERR "db9.c: parport busy already - lp.o loaded?n");
  339. kfree(db9);
  340. return NULL;
  341. }
  343. for (i = 0; i < 1 + (db9->mode == DB9_MULTI_0802_2); i++) {
  345. db9->dev[i].private = db9;
  346. db9->dev[i].open = db9_open;
  347. db9->dev[i].close = db9_close;
  349. db9->dev[i].name = db9_name[db9->mode];
  350. db9->dev[i].idbus = BUS_PARPORT;
  351. db9->dev[i].idvendor = 0x0002;
  352. db9->dev[i].idproduct = config[1];
  353. db9->dev[i].idversion = 0x0100;
  355. db9->dev[i].evbit[0] = BIT(EV_KEY) | BIT(EV_ABS);
  356. db9->dev[i].absbit[0] = BIT(ABS_X) | BIT(ABS_Y);
  358. for (j = 0; j < db9_buttons[db9->mode]; j++)
  359. set_bit(db9_btn[db9->mode][j], db9->dev[i].keybit); 
  361. db9->dev[i].absmin[ABS_X] = -1; db9->dev[i].absmax[ABS_X] = 1;
  362. db9->dev[i].absmin[ABS_Y] = -1; db9->dev[i].absmax[ABS_Y] = 1;
  364. input_register_device(db9->dev + i);
  365. printk(KERN_INFO "input%d: %s on %sn",
  366. db9->dev[i].number, db9_name[db9->mode], db9->pd->port->name);
  367. }
  369. return db9;
  370. }
  372. #ifndef MODULE
  373. int __init db9_setup(char *str)
  374. {
  375. int i, ints[3];
  376. get_options(str, ARRAY_SIZE(ints), ints);
  377. for (i = 0; i <= ints[0] && i < 2; i++) db9[i] = ints[i + 1];
  378. return 1;
  379. }
  380. int __init db9_setup_2(char *str)
  381. {
  382. int i, ints[3];
  383. get_options(str, ARRAY_SIZE(ints), ints);
  384. for (i = 0; i <= ints[0] && i < 2; i++) db9_2[i] = ints[i + 1];
  385. return 1;
  386. }
  387. int __init db9_setup_3(char *str)
  388. {
  389. int i, ints[3];
  390. get_options(str, ARRAY_SIZE(ints), ints);
  391. for (i = 0; i <= ints[0] && i < 2; i++) db9_3[i] = ints[i + 1];
  392. return 1;
  393. }
  394. __setup("db9=", db9_setup);
  395. __setup("db9_2=", db9_setup_2);
  396. __setup("db9_3=", db9_setup_3);
  397. #endif
  399. int __init db9_init(void)
  400. {
  401. db9_base[0] = db9_probe(db9);
  402. db9_base[1] = db9_probe(db9_2);
  403. db9_base[2] = db9_probe(db9_3);
  405. if (db9_base[0] || db9_base[1] || db9_base[2])
  406. return 0;
  408. return -ENODEV;
  409. }
  411. void __exit db9_exit(void)
  412. {
  413. int i, j;
  415. for (i = 0; i < 3; i++) 
  416. if (db9_base[i]) {
  417. for (j = 0; j < 1 + (db9_base[i]->mode == DB9_MULTI_0802_2); j++)
  418. input_unregister_device(db9_base[i]->dev + j);
  419. parport_unregister_device(db9_base[i]->pd);
  420. }
  421. }
  423. module_init(db9_init);
  424. module_exit(db9_exit);