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

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

嵌入式Linux

开发平台：

Unix_Linux

adbhid.c：源码内容
  1. /*
  2.  * drivers/input/adbhid.c
  3.  *
  4.  * ADB HID driver for Power Macintosh computers.
  5.  *
  6.  * Adapted from drivers/macintosh/mac_keyb.c by Franz Sirl
  7.  * (see that file for its authors and contributors).
  8.  *
  9.  * Copyright (C) 2000 Franz Sirl.
  10.  *
  11.  * Adapted to ADB changes and support for more devices by
  12.  * Benjamin Herrenschmidt. Adapted from code in MkLinux
  13.  * and reworked.
  14.  * 
  15.  * Supported devices:
  16.  *
  17.  * - Standard 1 button mouse
  18.  * - All standard Apple Extended protocol (handler ID 4)
  19.  * - mouseman and trackman mice & trackballs 
  20.  * - PowerBook Trackpad (default setup: enable tapping)
  21.  * - MicroSpeed mouse & trackball (needs testing)
  22.  * - CH Products Trackball Pro (needs testing)
  23.  * - Contour Design (Contour Mouse)
  24.  * - Hunter digital (NoHandsMouse)
  25.  * - Kensignton TurboMouse 5 (needs testing)
  26.  * - Mouse Systems A3 mice and trackballs <aidan@kublai.com>
  27.  * - MacAlly 2-buttons mouse (needs testing) <pochini@denise.shiny.it>
  28.  *
  29.  * To do:
  30.  *
  31.  * Improve Kensington support.
  32.  */
  34. #include <linux/config.h>
  35. #include <linux/module.h>
  36. #include <linux/slab.h>
  37. #include <linux/init.h>
  38. #include <linux/notifier.h>
  39. #include <linux/input.h>
  40. #include <linux/kbd_ll.h>
  42. #include <linux/adb.h>
  43. #include <linux/cuda.h>
  44. #include <linux/pmu.h>
  45. #ifdef CONFIG_PMAC_BACKLIGHT
  46. #include <asm/backlight.h>
  47. #endif
  49. MODULE_AUTHOR("Franz Sirl <Franz.Sirl-kernel@lauterbach.com>");
  51. #define KEYB_KEYREG 0 /* register # for key up/down data */
  52. #define KEYB_LEDREG 2 /* register # for leds on ADB keyboard */
  53. #define MOUSE_DATAREG 0 /* reg# for movement/button codes from mouse */
  55. static int adb_message_handler(struct notifier_block *, unsigned long, void *);
  56. static struct notifier_block adbhid_adb_notifier = {
  57. notifier_call: adb_message_handler,
  58. };
  60. unsigned char adb_to_linux_keycodes[128] = {
  61.  30, 31, 32, 33, 35, 34, 44, 45, 46, 47, 86, 48, 16, 17, 18, 19,
  62.  21, 20,  2,  3,  4,  5,  7,  6, 13, 10,  8, 12,  9, 11, 27, 24,
  63.  22, 26, 23, 25, 28, 38, 36, 40, 37, 39, 43, 51, 53, 49, 50, 52,
  64.  15, 57, 41, 14, 96,  1, 29,125, 42, 58, 56,105,106,108,103,  0,
  65.   0, 83,  0, 55,  0, 78,  0, 69,  0,  0,  0, 98, 96,  0, 74,  0,
  66.   0,117, 82, 79, 80, 81, 75, 76, 77, 71,  0, 72, 73,183,181,124,
  67.  63, 64, 65, 61, 66, 67,191, 87,190, 99,  0, 70,  0, 68,101, 88,
  68.   0,119,110,102,104,111, 62,107, 60,109, 59, 54,100, 97,116,116
  69. };
  71. struct adbhid {
  72. struct input_dev input;
  73. int id;
  74. int default_id;
  75. int original_handler_id;
  76. int current_handler_id;
  77. int mouse_kind;
  78. unsigned char *keycode;
  79. char name[64];
  80. };
  82. static struct adbhid *adbhid[16] = { 0 };
  84. static void adbhid_probe(void);
  86. static void adbhid_input_keycode(int, int, int);
  87. static void leds_done(struct adb_request *);
  89. static void init_trackpad(int id);
  90. static void init_trackball(int id);
  91. static void init_turbomouse(int id);
  92. static void init_microspeed(int id);
  93. static void init_ms_a3(int id);
  95. static struct adb_ids keyboard_ids;
  96. static struct adb_ids mouse_ids;
  97. static struct adb_ids buttons_ids;
  99. /* Kind of keyboard, see Apple technote 1152  */
  100. #define ADB_KEYBOARD_UNKNOWN 0
  101. #define ADB_KEYBOARD_ANSI 0x0100
  102. #define ADB_KEYBOARD_ISO 0x0200
  103. #define ADB_KEYBOARD_JIS 0x0300
  105. /* Kind of mouse  */
  106. #define ADBMOUSE_STANDARD_100 0 /* Standard 100cpi mouse (handler 1) */
  107. #define ADBMOUSE_STANDARD_200 1 /* Standard 200cpi mouse (handler 2) */
  108. #define ADBMOUSE_EXTENDED 2 /* Apple Extended mouse (handler 4) */
  109. #define ADBMOUSE_TRACKBALL 3 /* TrackBall (handler 4) */
  110. #define ADBMOUSE_TRACKPAD       4 /* Apple's PowerBook trackpad (handler 4) */
  111. #define ADBMOUSE_TURBOMOUSE5    5 /* Turbomouse 5 (previously req. mousehack) */
  112. #define ADBMOUSE_MICROSPEED 6 /* Microspeed mouse (&trackball ?), MacPoint */
  113. #define ADBMOUSE_TRACKBALLPRO 7 /* Trackball Pro (special buttons) */
  114. #define ADBMOUSE_MS_A3 8 /* Mouse systems A3 trackball (handler 3) */
  115. #define ADBMOUSE_MACALLY2 9 /* MacAlly 2-button mouse */
  117. static void
  118. adbhid_keyboard_input(unsigned char *data, int nb, struct pt_regs *regs, int apoll)
  119. {
  120. int id = (data[0] >> 4) & 0x0f;
  122. if (!adbhid[id]) {
  123. printk(KERN_ERR "ADB HID on ID %d not yet registered, packet %#02x, %#02x, %#02x, %#02xn",
  124.        id, data[0], data[1], data[2], data[3]);
  125. return;
  126. }
  128. /* first check this is from register 0 */
  129. if (nb != 3 || (data[0] & 3) != KEYB_KEYREG)
  130. return; /* ignore it */
  131. kbd_pt_regs = regs;
  132. adbhid_input_keycode(id, data[1], 0);
  133. if (!(data[2] == 0xff || (data[2] == 0x7f && data[1] == 0x7f)))
  134. adbhid_input_keycode(id, data[2], 0);
  135. }
  137. static void
  138. adbhid_input_keycode(int id, int keycode, int repeat)
  139. {
  140. int up_flag;
  142. up_flag = (keycode & 0x80);
  143. keycode &= 0x7f;
  145. switch (keycode) {
  146. case 0x39: /* Generate down/up events for CapsLock everytime. */
  147. input_report_key(&adbhid[id]->input, KEY_CAPSLOCK, 1);
  148. input_report_key(&adbhid[id]->input, KEY_CAPSLOCK, 0);
  149. return;
  150. case 0x3f: /* ignore Powerbook Fn key */
  151. return;
  152. }
  154. if (adbhid[id]->keycode[keycode])
  155. input_report_key(&adbhid[id]->input,
  156.  adbhid[id]->keycode[keycode], !up_flag);
  157. else
  158. printk(KERN_INFO "Unhandled ADB key (scancode %#02x) %s.n", keycode,
  159.        up_flag ? "released" : "pressed");
  160. }
  162. static void
  163. adbhid_mouse_input(unsigned char *data, int nb, struct pt_regs *regs, int autopoll)
  164. {
  165. int id = (data[0] >> 4) & 0x0f;
  167. if (!adbhid[id]) {
  168. printk(KERN_ERR "ADB HID on ID %d not yet registeredn", id);
  169. return;
  170. }
  172.   /*
  173.     Handler 1 -- 100cpi original Apple mouse protocol.
  174.     Handler 2 -- 200cpi original Apple mouse protocol.
  176.     For Apple's standard one-button mouse protocol the data array will
  177.     contain the following values:
  179.                 BITS    COMMENTS
  180.     data[0] = dddd 1100 ADB command: Talk, register 0, for device dddd.
  181.     data[1] = bxxx xxxx First button and x-axis motion.
  182.     data[2] = byyy yyyy Second button and y-axis motion.
  184.     Handler 4 -- Apple Extended mouse protocol.
  186.     For Apple's 3-button mouse protocol the data array will contain the
  187.     following values:
  189. BITS    COMMENTS
  190.     data[0] = dddd 1100 ADB command: Talk, register 0, for device dddd.
  191.     data[1] = bxxx xxxx Left button and x-axis motion.
  192.     data[2] = byyy yyyy Second button and y-axis motion.
  193.     data[3] = byyy bxxx Third button and fourth button.  Y is additional
  194.       high bits of y-axis motion.  XY is additional
  195.       high bits of x-axis motion.
  197.     MacAlly 2-button mouse protocol.
  199.     For MacAlly 2-button mouse protocol the data array will contain the
  200.     following values:
  202. BITS    COMMENTS
  203.     data[0] = dddd 1100 ADB command: Talk, register 0, for device dddd.
  204.     data[1] = bxxx xxxx Left button and x-axis motion.
  205.     data[2] = byyy yyyy Right button and y-axis motion.
  206.     data[3] = ???? ???? unknown
  207.     data[4] = ???? ???? unknown
  209.   */
  211. /* If it's a trackpad, we alias the second button to the first.
  212.    NOTE: Apple sends an ADB flush command to the trackpad when
  213.          the first (the real) button is released. We could do
  214.  this here using async flush requests.
  215. */
  216. switch (adbhid[id]->mouse_kind)
  217. {
  218.     case ADBMOUSE_TRACKPAD:
  219. data[1] = (data[1] & 0x7f) | ((data[1] & data[2]) & 0x80);
  220. data[2] = data[2] | 0x80;
  221. break;
  222.     case ADBMOUSE_MICROSPEED:
  223. data[1] = (data[1] & 0x7f) | ((data[3] & 0x01) << 7);
  224. data[2] = (data[2] & 0x7f) | ((data[3] & 0x02) << 6);
  225. data[3] = (data[3] & 0x77) | ((data[3] & 0x04) << 5)
  226. | (data[3] & 0x08);
  227. break;
  228.     case ADBMOUSE_TRACKBALLPRO:
  229. data[1] = (data[1] & 0x7f) | (((data[3] & 0x04) << 5)
  230. & ((data[3] & 0x08) << 4));
  231. data[2] = (data[2] & 0x7f) | ((data[3] & 0x01) << 7);
  232. data[3] = (data[3] & 0x77) | ((data[3] & 0x02) << 6);
  233. break;
  234.     case ADBMOUSE_MS_A3:
  235. data[1] = (data[1] & 0x7f) | ((data[3] & 0x01) << 7);
  236. data[2] = (data[2] & 0x7f) | ((data[3] & 0x02) << 6);
  237. data[3] = ((data[3] & 0x04) << 5);
  238. break;
  239.             case ADBMOUSE_MACALLY2:
  240. data[3] = (data[2] & 0x80) ? 0x80 : 0x00;
  241. data[2] |= 0x80;  /* Right button is mapped as button 3 */
  242. nb=4;
  243.                 break;
  244. }
  246. input_report_key(&adbhid[id]->input, BTN_LEFT,   !((data[1] >> 7) & 1));
  247. input_report_key(&adbhid[id]->input, BTN_MIDDLE, !((data[2] >> 7) & 1));
  249. if (nb >= 4)
  250. input_report_key(&adbhid[id]->input, BTN_RIGHT,  !((data[3] >> 7) & 1));
  252. input_report_rel(&adbhid[id]->input, REL_X,
  253.  ((data[2]&0x7f) < 64 ? (data[2]&0x7f) : (data[2]&0x7f)-128 ));
  254. input_report_rel(&adbhid[id]->input, REL_Y,
  255.  ((data[1]&0x7f) < 64 ? (data[1]&0x7f) : (data[1]&0x7f)-128 ));
  256. }
  258. static void
  259. adbhid_buttons_input(unsigned char *data, int nb, struct pt_regs *regs, int autopoll)
  260. {
  261. int id = (data[0] >> 4) & 0x0f;
  263. if (!adbhid[id]) {
  264. printk(KERN_ERR "ADB HID on ID %d not yet registeredn", id);
  265. return;
  266. }
  268. switch (adbhid[id]->original_handler_id) {
  269. default:
  270. case 0x02: /* Adjustable keyboard button device */
  271. printk(KERN_INFO "Unhandled ADB_MISC event %02x, %02x, %02x, %02xn",
  272.        data[0], data[1], data[2], data[3]);
  273. break;
  274. case 0x1f: /* Powerbook button device */
  275.   {
  276.    int down = (data[1] == (data[1] & 0xf));
  277. #ifdef CONFIG_PMAC_BACKLIGHT
  278. int backlight = get_backlight_level();
  279. #endif
  280. /*
  281.  * XXX: Where is the contrast control for the passive?
  282.  *  -- Cort
  283.  */
  285. switch (data[1] & 0x0f) {
  286. case 0x8: /* mute */
  287. input_report_key(&adbhid[id]->input, KEY_MUTE,
  288. data[1] == (data[1] & 0xf));
  289. break;
  291. case 0x7: /* volume decrease */
  292. input_report_key(&adbhid[id]->input, KEY_VOLUMEDOWN,
  293. data[1] == (data[1] & 0xf));
  294. break;
  296. case 0x6: /* volume increase */
  297. input_report_key(&adbhid[id]->input, KEY_VOLUMEUP,
  298. data[1] == (data[1] & 0xf));
  299.   break;
  301. case 0xb: /* eject */
  302. input_report_key(&adbhid[id]->input, KEY_EJECTCD,
  303. data[1] == (data[1] & 0xf));
  304. break;
  306. #ifdef CONFIG_PMAC_BACKLIGHT
  307. case 0xa: /* brightness decrease */
  308. if (!down || backlight < 0)
  309. break;
  310. if (backlight > BACKLIGHT_OFF)
  311. set_backlight_level(backlight-1);
  312. else
  313. set_backlight_level(BACKLIGHT_OFF);
  314. break;
  316. case 0x9: /* brightness increase */
  317. if (!down || backlight < 0)
  318. break;
  319. if (backlight < BACKLIGHT_MAX)
  320. set_backlight_level(backlight+1);
  321. else 
  322. set_backlight_level(BACKLIGHT_MAX);
  323. break;
  324. #endif /* CONFIG_PMAC_BACKLIGHT */
  325. }
  326.   }
  327.   break;
  328. }
  329. }
  331. static struct adb_request led_request;
  332. static int leds_pending[16];
  333. static int pending_devs[16];
  334. static int pending_led_start=0;
  335. static int pending_led_end=0;
  337. static void real_leds(unsigned char leds, int device)
  338. {
  339.     if (led_request.complete) {
  340. adb_request(&led_request, leds_done, 0, 3,
  341.     ADB_WRITEREG(device, KEYB_LEDREG), 0xff,
  342.     ~leds);
  343.     } else {
  344. if (!(leds_pending[device] & 0x100)) {
  345.     pending_devs[pending_led_end] = device;
  346.     pending_led_end++;
  347.     pending_led_end = (pending_led_end < 16) ? pending_led_end : 0;
  348. }
  349. leds_pending[device] = leds | 0x100;
  350.     }
  351. }
  353. /*
  354.  * Event callback from the input module. Events that change the state of
  355.  * the hardware are processed here.
  356.  */
  357. static int adbhid_kbd_event(struct input_dev *dev, unsigned int type, unsigned int code, int value)
  358. {
  359. struct adbhid *adbhid = dev->private;
  360. unsigned char leds;
  362. switch (type) {
  363. case EV_LED:
  364.   leds = (test_bit(LED_SCROLLL, dev->led) ? 4 : 0)
  365.        | (test_bit(LED_NUML,    dev->led) ? 1 : 0)
  366.        | (test_bit(LED_CAPSL,   dev->led) ? 2 : 0);
  367.   real_leds(leds, adbhid->id);
  368.   return 0;
  369. }
  371. return -1;
  372. }
  374. static void leds_done(struct adb_request *req)
  375. {
  376.     int leds,device;
  378.     if (pending_led_start != pending_led_end) {
  379. device = pending_devs[pending_led_start];
  380. leds = leds_pending[device] & 0xff;
  381. leds_pending[device] = 0;
  382. pending_led_start++;
  383. pending_led_start = (pending_led_start < 16) ? pending_led_start : 0;
  384. real_leds(leds,device);
  385.     }
  387. }
  389. static int
  390. adb_message_handler(struct notifier_block *this, unsigned long code, void *x)
  391. {
  392. unsigned long flags;
  394. switch (code) {
  395. case ADB_MSG_PRE_RESET:
  396. case ADB_MSG_POWERDOWN:
  397.      /* Stop the repeat timer. Autopoll is already off at this point */
  398. save_flags(flags);
  399. cli();
  400. {
  401. int i;
  402. for (i = 1; i < 16; i++) {
  403. if (adbhid[i])
  404. del_timer(&adbhid[i]->input.timer);
  405. }
  406. }
  407. restore_flags(flags);
  409. /* Stop pending led requests */
  410. while(!led_request.complete)
  411. adb_poll();
  412. break;
  414. case ADB_MSG_POST_RESET:
  415. adbhid_probe();
  416. break;
  417. }
  418. return NOTIFY_DONE;
  419. }
  421. static void
  422. adbhid_input_register(int id, int default_id, int original_handler_id,
  423.       int current_handler_id, int mouse_kind)
  424. {
  425. int i;
  427. if (adbhid[id]) {
  428. printk(KERN_ERR "Trying to reregister ADB HID on ID %dn", id);
  429. return;
  430. }
  432. if (!(adbhid[id] = kmalloc(sizeof(struct adbhid), GFP_KERNEL)))
  433. return;
  435. memset(adbhid[id], 0, sizeof(struct adbhid));
  437. adbhid[id]->id = default_id;
  438. adbhid[id]->original_handler_id = original_handler_id;
  439. adbhid[id]->current_handler_id = current_handler_id;
  440. adbhid[id]->mouse_kind = mouse_kind;
  441. adbhid[id]->input.private = adbhid[id];
  442. adbhid[id]->input.name = adbhid[id]->name;
  443. adbhid[id]->input.idbus = BUS_ADB;
  444. adbhid[id]->input.idvendor = 0x0001;
  445. adbhid[id]->input.idproduct = (id << 12) | (default_id << 8) | original_handler_id;
  446. adbhid[id]->input.idversion = 0x0100;
  448. switch (default_id) {
  449. case ADB_KEYBOARD:
  450. if (!(adbhid[id]->keycode = kmalloc(sizeof(adb_to_linux_keycodes), GFP_KERNEL))) {
  451. kfree(adbhid[id]);
  452. return;
  453. }
  455. sprintf(adbhid[id]->name, "ADB keyboard on ID %d:%d.%02x",
  456. id, default_id, original_handler_id);
  458. memcpy(adbhid[id]->keycode, adb_to_linux_keycodes, sizeof(adb_to_linux_keycodes));
  460. printk(KERN_INFO "Detected ADB keyboard, type ");
  461. switch (original_handler_id) {
  462. default:
  463. printk("<unknown>.n");
  464. adbhid[id]->input.idversion = ADB_KEYBOARD_UNKNOWN;
  465. break;
  467. case 0x01: case 0x02: case 0x03: case 0x06: case 0x08:
  468. case 0x0C: case 0x10: case 0x18: case 0x1B: case 0x1C:
  469. case 0xC0: case 0xC3: case 0xC6:
  470. printk("ANSI.n");
  471. adbhid[id]->input.idversion = ADB_KEYBOARD_ANSI;
  472. break;
  474. case 0x04: case 0x05: case 0x07: case 0x09: case 0x0D:
  475. case 0x11: case 0x14: case 0x19: case 0x1D: case 0xC1:
  476. case 0xC4: case 0xC7:
  477. printk("ISO, swapping keys.n");
  478. adbhid[id]->input.idversion = ADB_KEYBOARD_ISO;
  479. i = adbhid[id]->keycode[10];
  480. adbhid[id]->keycode[10] = adbhid[id]->keycode[50];
  481. adbhid[id]->keycode[50] = i;
  482. break;
  484. case 0x12: case 0x15: case 0x16: case 0x17: case 0x1A:
  485. case 0x1E: case 0xC2: case 0xC5: case 0xC8: case 0xC9:
  486. printk("JIS.n");
  487. adbhid[id]->input.idversion = ADB_KEYBOARD_JIS;
  488. break;
  489. }
  491. for (i = 0; i < 128; i++)
  492. if (adbhid[id]->keycode[i])
  493. set_bit(adbhid[id]->keycode[i], adbhid[id]->input.keybit);
  495. adbhid[id]->input.evbit[0] = BIT(EV_KEY) | BIT(EV_LED) | BIT(EV_REP);
  496. adbhid[id]->input.ledbit[0] = BIT(LED_SCROLLL) | BIT(LED_CAPSL) | BIT(LED_NUML);
  497. adbhid[id]->input.event = adbhid_kbd_event;
  498. adbhid[id]->input.keycodemax = 127;
  499. adbhid[id]->input.keycodesize = 1;
  500. break;
  502. case ADB_MOUSE:
  503. sprintf(adbhid[id]->name, "ADB mouse on ID %d:%d.%02x",
  504. id, default_id, original_handler_id);
  506. adbhid[id]->input.evbit[0] = BIT(EV_KEY) | BIT(EV_REL);
  507. adbhid[id]->input.keybit[LONG(BTN_MOUSE)] = BIT(BTN_LEFT) | BIT(BTN_MIDDLE) | BIT(BTN_RIGHT);
  508. adbhid[id]->input.relbit[0] = BIT(REL_X) | BIT(REL_Y);
  509. break;
  511. case ADB_MISC:
  512. switch (original_handler_id) {
  513. case 0x02: /* Adjustable keyboard button device */
  514. sprintf(adbhid[id]->name, "ADB adjustable keyboard buttons on ID %d:%d.%02x",
  515. id, default_id, original_handler_id);
  516. break;
  517. case 0x1f: /* Powerbook button device */
  518. sprintf(adbhid[id]->name, "ADB Powerbook buttons on ID %d:%d.%02x",
  519. id, default_id, original_handler_id);
  520. adbhid[id]->input.evbit[0] = BIT(EV_KEY) | BIT(EV_REP);
  521. set_bit(KEY_MUTE, adbhid[id]->input.keybit);
  522. set_bit(KEY_VOLUMEUP, adbhid[id]->input.keybit);
  523. set_bit(KEY_VOLUMEDOWN, adbhid[id]->input.keybit);
  524. set_bit(KEY_EJECTCD, adbhid[id]->input.keybit);
  525. break;
  526. }
  527. if (adbhid[id]->name[0])
  528. break;
  529. /* else fall through */
  531. default:
  532. printk(KERN_INFO "Trying to register unknown ADB device to input layer.n");
  533. kfree(adbhid[id]);
  534. return;
  535. }
  537. adbhid[id]->input.keycode = adbhid[id]->keycode;
  539. input_register_device(&adbhid[id]->input);
  541. printk(KERN_INFO "input%d: ADB HID on ID %d:%d.%02xn",
  542.        adbhid[id]->input.number, id, default_id, original_handler_id);
  544. if (default_id == ADB_KEYBOARD) {
  545. /* HACK WARNING!! This should go away as soon there is an utility
  546.  * to control that for event devices.
  547.  */
  548. adbhid[id]->input.rep[REP_DELAY] = HZ/2;   /* input layer default: HZ/4 */
  549. adbhid[id]->input.rep[REP_PERIOD] = HZ/15; /* input layer default: HZ/33 */
  550. }
  551. }
  553. static void adbhid_input_unregister(int id)
  554. {
  555. input_unregister_device(&adbhid[id]->input);
  556. if (adbhid[id]->keycode)
  557. kfree(adbhid[id]->keycode);
  558. kfree(adbhid[id]);
  559. adbhid[id] = 0;
  560. }
  563. static u16
  564. adbhid_input_reregister(int id, int default_id, int org_handler_id,
  565. int cur_handler_id, int mk)
  566. {
  567. if (adbhid[id]) {
  568. if (adbhid[id]->input.idproduct !=
  569.     ((id << 12)|(default_id << 8)|org_handler_id)) {
  570. adbhid_input_unregister(id);
  571. adbhid_input_register(id, default_id, org_handler_id,
  572. cur_handler_id, mk);
  573. }
  574. } else
  575. adbhid_input_register(id, default_id, org_handler_id,
  576. cur_handler_id, mk);
  577. return 1<<id;
  578. }
  580. static void
  581. adbhid_input_devcleanup(u16 exist)
  582. {
  583. int i;
  584. for(i=1; i<16; i++)
  585.     if (adbhid[i] && !(exist&(1<<i)))
  586. adbhid_input_unregister(i);
  587. }
  588.  
  589. static void
  590. adbhid_probe(void)
  591. {
  592. struct adb_request req;
  593. int i, default_id, org_handler_id, cur_handler_id;
  594. u16 reg = 0;
  596. adb_register(ADB_MOUSE, 0, &mouse_ids, adbhid_mouse_input);
  597. adb_register(ADB_KEYBOARD, 0, &keyboard_ids, adbhid_keyboard_input);
  598. adb_register(ADB_MISC, 0, &buttons_ids, adbhid_buttons_input);
  600. for (i = 0; i < keyboard_ids.nids; i++) {
  601. int id = keyboard_ids.id[i];
  603. adb_get_infos(id, &default_id, &org_handler_id);
  605. /* turn off all leds */
  606. adb_request(&req, NULL, ADBREQ_SYNC, 3,
  607.     ADB_WRITEREG(id, KEYB_LEDREG), 0xff, 0xff);
  609. /* Enable full feature set of the keyboard
  610.    ->get it to send separate codes for left and right shift,
  611.    control, option keys */
  612. #if 0 /* handler 5 doesn't send separate codes for R modifiers */
  613. if (adb_try_handler_change(id, 5))
  614. printk("ADB keyboard at %d, handler set to 5n", id);
  615. else
  616. #endif
  617. if (adb_try_handler_change(id, 3))
  618. printk("ADB keyboard at %d, handler set to 3n", id);
  619. else
  620. printk("ADB keyboard at %d, handler 1n", id);
  622. adb_get_infos(id, &default_id, &cur_handler_id);
  623. reg |= adbhid_input_reregister(id, default_id, org_handler_id, cur_handler_id, 0);
  624. }
  626. for (i = 0; i < buttons_ids.nids; i++) {
  627. int id = buttons_ids.id[i];
  629. adb_get_infos(id, &default_id, &org_handler_id);
  630. reg |= adbhid_input_reregister(id, default_id, org_handler_id, org_handler_id, 0);
  631. }
  633. /* Try to switch all mice to handler 4, or 2 for three-button
  634.    mode and full resolution. */
  635. for (i = 0; i < mouse_ids.nids; i++) {
  636. int id = mouse_ids.id[i];
  637. int mouse_kind;
  639. adb_get_infos(id, &default_id, &org_handler_id);
  641. if (adb_try_handler_change(id, 4)) {
  642. printk("ADB mouse at %d, handler set to 4", id);
  643. mouse_kind = ADBMOUSE_EXTENDED;
  644. }
  645. else if (adb_try_handler_change(id, 0x2F)) {
  646. printk("ADB mouse at %d, handler set to 0x2F", id);
  647. mouse_kind = ADBMOUSE_MICROSPEED;
  648. }
  649. else if (adb_try_handler_change(id, 0x42)) {
  650. printk("ADB mouse at %d, handler set to 0x42", id);
  651. mouse_kind = ADBMOUSE_TRACKBALLPRO;
  652. }
  653. else if (adb_try_handler_change(id, 0x66)) {
  654. printk("ADB mouse at %d, handler set to 0x66", id);
  655. mouse_kind = ADBMOUSE_MICROSPEED;
  656. }
  657. else if (adb_try_handler_change(id, 0x5F)) {
  658. printk("ADB mouse at %d, handler set to 0x5F", id);
  659. mouse_kind = ADBMOUSE_MICROSPEED;
  660. }
  661. else if (adb_try_handler_change(id, 3)) {
  662. printk("ADB mouse at %d, handler set to 3", id);
  663. mouse_kind = ADBMOUSE_MS_A3;
  664. }
  665. else if (adb_try_handler_change(id, 2)) {
  666. printk("ADB mouse at %d, handler set to 2", id);
  667. mouse_kind = ADBMOUSE_STANDARD_200;
  668. }
  669. else {
  670. printk("ADB mouse at %d, handler 1", id);
  671. mouse_kind = ADBMOUSE_STANDARD_100;
  672. }
  674. if ((mouse_kind == ADBMOUSE_TRACKBALLPRO)
  675.     || (mouse_kind == ADBMOUSE_MICROSPEED)) {
  676. init_microspeed(id);
  677. } else if (mouse_kind == ADBMOUSE_MS_A3) {
  678. init_ms_a3(id);
  679. } else if (mouse_kind ==  ADBMOUSE_EXTENDED) {
  680. /*
  681.  * Register 1 is usually used for device
  682.  * identification.  Here, we try to identify
  683.  * a known device and call the appropriate
  684.  * init function.
  685.  */
  686. adb_request(&req, NULL, ADBREQ_SYNC | ADBREQ_REPLY, 1,
  687.     ADB_READREG(id, 1));
  689. if ((req.reply_len) &&
  690.     (req.reply[1] == 0x9a) && ((req.reply[2] == 0x21)
  691.      || (req.reply[2] == 0x20))) {
  692. mouse_kind = ADBMOUSE_TRACKBALL;
  693. init_trackball(id);
  694. }
  695. else if ((req.reply_len >= 4) &&
  696.     (req.reply[1] == 0x74) && (req.reply[2] == 0x70) &&
  697.     (req.reply[3] == 0x61) && (req.reply[4] == 0x64)) {
  698. mouse_kind = ADBMOUSE_TRACKPAD;
  699. init_trackpad(id);
  700. }
  701. else if ((req.reply_len >= 4) &&
  702.     (req.reply[1] == 0x4b) && (req.reply[2] == 0x4d) &&
  703.     (req.reply[3] == 0x4c) && (req.reply[4] == 0x31)) {
  704. mouse_kind = ADBMOUSE_TURBOMOUSE5;
  705. init_turbomouse(id);
  706. }
  707. else if ((req.reply_len == 9) &&
  708.     (req.reply[1] == 0x4b) && (req.reply[2] == 0x4f) &&
  709.     (req.reply[3] == 0x49) && (req.reply[4] == 0x54)) {
  710. if (adb_try_handler_change(id, 0x42)) {
  711. printk("nADB MacAlly 2-button mouse at %d, handler set to 0x42", id);
  712. mouse_kind = ADBMOUSE_MACALLY2;
  713. }
  714. }
  715. }
  716. printk("n");
  718. adb_get_infos(id, &default_id, &cur_handler_id);
  719. reg |= adbhid_input_reregister(id, default_id, org_handler_id,
  720.       cur_handler_id, mouse_kind);
  721.         }
  722. adbhid_input_devcleanup(reg);
  723. }
  725. static void 
  726. init_trackpad(int id)
  727. {
  728. struct adb_request req;
  729. unsigned char r1_buffer[8];
  731. printk(" (trackpad)");
  733. adb_request(&req, NULL, ADBREQ_SYNC | ADBREQ_REPLY, 1,
  734. ADB_READREG(id,1));
  735. if (req.reply_len < 8)
  736.     printk("bad length for reg. 1n");
  737. else
  738. {
  739.     memcpy(r1_buffer, &req.reply[1], 8);
  741.     adb_request(&req, NULL, ADBREQ_SYNC, 9,
  742.         ADB_WRITEREG(id,1),
  743.             r1_buffer[0],
  744.             r1_buffer[1],
  745.             r1_buffer[2],
  746.             r1_buffer[3],
  747.             r1_buffer[4],
  748.             r1_buffer[5],
  749.             0x0d,
  750.             r1_buffer[7]);
  752.             adb_request(&req, NULL, ADBREQ_SYNC, 9,
  753.         ADB_WRITEREG(id,2),
  754.          0x99,
  755.          0x94,
  756.          0x19,
  757.          0xff,
  758.          0xb2,
  759.          0x8a,
  760.          0x1b,
  761.          0x50);
  763.     adb_request(&req, NULL, ADBREQ_SYNC, 9,
  764.         ADB_WRITEREG(id,1),
  765.             r1_buffer[0],
  766.             r1_buffer[1],
  767.             r1_buffer[2],
  768.             r1_buffer[3],
  769.             r1_buffer[4],
  770.             r1_buffer[5],
  771.             0x03, /*r1_buffer[6],*/
  772.             r1_buffer[7]);
  774.     /* Without this flush, the trackpad may be locked up */     
  775.     adb_request(&req, NULL, ADBREQ_SYNC, 1, ADB_FLUSH(id));
  776.         }
  777. }
  779. static void 
  780. init_trackball(int id)
  781. {
  782. struct adb_request req;
  784. printk(" (trackman/mouseman)");
  786. adb_request(&req, NULL, ADBREQ_SYNC, 3,
  787. ADB_WRITEREG(id,1), 00,0x81);
  789. adb_request(&req, NULL, ADBREQ_SYNC, 3,
  790. ADB_WRITEREG(id,1), 01,0x81);
  792. adb_request(&req, NULL, ADBREQ_SYNC, 3,
  793. ADB_WRITEREG(id,1), 02,0x81);
  795. adb_request(&req, NULL, ADBREQ_SYNC, 3,
  796. ADB_WRITEREG(id,1), 03,0x38);
  798. adb_request(&req, NULL, ADBREQ_SYNC, 3,
  799. ADB_WRITEREG(id,1), 00,0x81);
  801. adb_request(&req, NULL, ADBREQ_SYNC, 3,
  802. ADB_WRITEREG(id,1), 01,0x81);
  804. adb_request(&req, NULL, ADBREQ_SYNC, 3,
  805. ADB_WRITEREG(id,1), 02,0x81);
  807. adb_request(&req, NULL, ADBREQ_SYNC, 3,
  808. ADB_WRITEREG(id,1), 03,0x38);
  809. }
  811. static void
  812. init_turbomouse(int id)
  813. {
  814. struct adb_request req;
  816.         printk(" (TurboMouse 5)");
  818. adb_request(&req, NULL, ADBREQ_SYNC, 1, ADB_FLUSH(id));
  820. adb_request(&req, NULL, ADBREQ_SYNC, 1, ADB_FLUSH(3));
  822. adb_request(&req, NULL, ADBREQ_SYNC, 9,
  823. ADB_WRITEREG(3,2),
  824.     0xe7,
  825.     0x8c,
  826.     0,
  827.     0,
  828.     0,
  829.     0xff,
  830.     0xff,
  831.     0x94);
  833. adb_request(&req, NULL, ADBREQ_SYNC, 1, ADB_FLUSH(3));
  835. adb_request(&req, NULL, ADBREQ_SYNC, 9,
  836. ADB_WRITEREG(3,2),
  837.     0xa5,
  838.     0x14,
  839.     0,
  840.     0,
  841.     0x69,
  842.     0xff,
  843.     0xff,
  844.     0x27);
  845. }
  847. static void
  848. init_microspeed(int id)
  849. {
  850. struct adb_request req;
  852.         printk(" (Microspeed/MacPoint or compatible)");
  854. adb_request(&req, NULL, ADBREQ_SYNC, 1, ADB_FLUSH(id));
  856. /* This will initialize mice using the Microspeed, MacPoint and
  857.    other compatible firmware. Bit 12 enables extended protocol.
  858.    
  859.    Register 1 Listen (4 Bytes)
  860.             0 -  3     Button is mouse (set also for double clicking!!!)
  861.             4 -  7     Button is locking (affects change speed also)
  862.             8 - 11     Button changes speed
  863.            12          1 = Extended mouse mode, 0 = normal mouse mode
  864.            13 - 15     unused 0
  865.            16 - 23     normal speed
  866.            24 - 31     changed speed
  868.        Register 1 talk holds version and product identification information.
  869.        Register 1 Talk (4 Bytes):
  870.             0 -  7     Product code
  871.             8 - 23     undefined, reserved
  872.            24 - 31     Version number
  873.         
  874.        Speed 0 is max. 1 to 255 set speed in increments of 1/256 of max.
  875.  */
  876. adb_request(&req, NULL, ADBREQ_SYNC, 5,
  877. ADB_WRITEREG(id,1),
  878.     0x20, /* alt speed = 0x20 (rather slow) */
  879.     0x00, /* norm speed = 0x00 (fastest) */
  880.     0x10, /* extended protocol, no speed change */
  881.     0x07); /* all buttons enabled as mouse buttons, no locking */
  884. adb_request(&req, NULL, ADBREQ_SYNC, 1, ADB_FLUSH(id));
  885. }
  887. static void
  888. init_ms_a3(int id)
  889. {
  890. struct adb_request req;
  892. printk(" (Mouse Systems A3 Mouse, or compatible)");
  893. adb_request(&req, NULL, ADBREQ_SYNC, 3,
  894. ADB_WRITEREG(id, 0x2),
  895.     0x00,
  896.     0x07);
  897.  
  898.   adb_request(&req, NULL, ADBREQ_SYNC, 1, ADB_FLUSH(id));
  899. }
  901. static int __init adbhid_init(void)
  902. {
  903. if ( (_machine != _MACH_chrp) && (_machine != _MACH_Pmac) )
  904.     return 0;
  906. led_request.complete = 1;
  908. adbhid_probe();
  910. notifier_chain_register(&adb_client_list, &adbhid_adb_notifier);
  912. return 0;
  913. }
  915. static void __exit adbhid_exit(void)
  916. {
  917. }
  918.  
  919. module_init(adbhid_init);
  920. module_exit(adbhid_exit);