Source of adbhid.c - linux-imx - PHYTEC BitBucket (Stash)

Ignore whitespace
Show whitespace characters
Hide e-diff
Unified diff
Side-by-side diff
Source viewDiff to previous
​x
 
}
​
static int
adbhid_input_register(int id, int default_id, int original_handler_id,
              int current_handler_id, int mouse_kind)
{
    struct adbhid *hid;
    struct input_dev *input_dev;
    int err;
    int i;
    char *keyboard_type;
​
    if (adbhid[id]) {
        pr_err("Trying to reregister ADB HID on ID %d\n", id);
        return -EEXIST;
    }
​
    adbhid[id] = hid = kzalloc(sizeof(struct adbhid), GFP_KERNEL);
    input_dev = input_allocate_device();
    if (!hid || !input_dev) {
        err = -ENOMEM;
        hid->keycode = kmalloc(sizeof(adb_to_linux_keycodes), GFP_KERNEL);
        if (!hid->keycode) {
            err = -ENOMEM;
            goto fail;
        }
​
        sprintf(hid->name, "ADB keyboard");
​
        memcpy(hid->keycode, adb_to_linux_keycodes, sizeof(adb_to_linux_keycodes));
​
        pr_info("Detected ADB keyboard, type ");
        switch (original_handler_id) {
        default:
            pr_cont("<unknown>.\n");
            keyboard_type = "<unknown>";
            input_dev->id.version = ADB_KEYBOARD_UNKNOWN;
            break;
​
        case 0x01: case 0x02: case 0x03: case 0x06: case 0x08:
        case 0x0C: case 0x10: case 0x18: case 0x1B: case 0x1C:
        case 0xC0: case 0xC3: case 0xC6:
            pr_cont("ANSI.\n");
            keyboard_type = "ANSI";
            input_dev->id.version = ADB_KEYBOARD_ANSI;
            break;
​
        case 0x04: case 0x05: case 0x07: case 0x09: case 0x0D:
        case 0x11: case 0x14: case 0x19: case 0x1D: case 0xC1:
        case 0xC4: case 0xC7:
            pr_cont("ISO, swapping keys.\n");
            keyboard_type = "ISO, swapping keys";
            input_dev->id.version = ADB_KEYBOARD_ISO;
            i = hid->keycode[10];
            hid->keycode[10] = hid->keycode[50];
            hid->keycode[50] = i;
            break;
​
        case 0x12: case 0x15: case 0x16: case 0x17: case 0x1A:
        case 0x1E: case 0xC2: case 0xC5: case 0xC8: case 0xC9:
            pr_cont("JIS.\n");
            keyboard_type = "JIS";
            input_dev->id.version = ADB_KEYBOARD_JIS;
            break;
        }
        pr_info("Detected ADB keyboard, type %s.\n", keyboard_type);
​
        for (i = 0; i < 128; i++)
            if (hid->keycode[i])
                set_bit(hid->keycode[i], input_dev->keybit);
​
        input_dev->evbit[0] = BIT_MASK(EV_KEY) | BIT_MASK(EV_LED) |
            BIT_MASK(EV_REP);
        input_dev->ledbit[0] = BIT_MASK(LED_SCROLLL) |
            BIT_MASK(LED_CAPSL) | BIT_MASK(LED_NUML);
        input_dev->event = adbhid_kbd_event;
        adb_get_infos(id, &default_id, &org_handler_id);
​
        /* turn off all leds */
        adb_request(&req, NULL, ADBREQ_SYNC, 3,
                ADB_WRITEREG(id, KEYB_LEDREG), 0xff, 0xff);
​
        /* Enable full feature set of the keyboard
           ->get it to send separate codes for left and right shift,
           control, option keys */
#if 0       /* handler 5 doesn't send separate codes for R modifiers */
        if (adb_try_handler_change(id, 5))
            printk("ADB keyboard at %d, handler set to 5\n", id);
        else
        if (!adb_try_handler_change(id, 5))
#endif
        if (adb_try_handler_change(id, 3))
            printk("ADB keyboard at %d, handler set to 3\n", id);
        else
            printk("ADB keyboard at %d, handler 1\n", id);
        adb_try_handler_change(id, 3);
​
        adb_get_infos(id, &default_id, &cur_handler_id);
        printk(KERN_DEBUG "ADB keyboard at %d has handler 0x%X\n",
               id, cur_handler_id);
        reg |= adbhid_input_reregister(id, default_id, org_handler_id,
                           cur_handler_id, 0);
    }
​
    for (i = 0; i < buttons_ids.nids; i++) {
        int id = buttons_ids.id[i];
​
        adb_get_infos(id, &default_id, &org_handler_id);
        reg |= adbhid_input_reregister(id, default_id, org_handler_id,
                           org_handler_id, 0);
    }
​
    /* Try to switch all mice to handler 4, or 2 for three-button
       mode and full resolution. */
    for (i = 0; i < mouse_ids.nids; i++) {
        int id = mouse_ids.id[i];
        int mouse_kind;
        char *desc = "standard";
​
        adb_get_infos(id, &default_id, &org_handler_id);
​
        if (adb_try_handler_change(id, 4)) {
            printk("ADB mouse at %d, handler set to 4", id);
            mouse_kind = ADBMOUSE_EXTENDED;
        }
        else if (adb_try_handler_change(id, 0x2F)) {
            printk("ADB mouse at %d, handler set to 0x2F", id);
            mouse_kind = ADBMOUSE_MICROSPEED;
        }
        else if (adb_try_handler_change(id, 0x42)) {
            printk("ADB mouse at %d, handler set to 0x42", id);
            mouse_kind = ADBMOUSE_TRACKBALLPRO;
        }
        else if (adb_try_handler_change(id, 0x66)) {
            printk("ADB mouse at %d, handler set to 0x66", id);
            mouse_kind = ADBMOUSE_MICROSPEED;
        }
        else if (adb_try_handler_change(id, 0x5F)) {
            printk("ADB mouse at %d, handler set to 0x5F", id);
            mouse_kind = ADBMOUSE_MICROSPEED;
        }
        else if (adb_try_handler_change(id, 3)) {
            printk("ADB mouse at %d, handler set to 3", id);
            mouse_kind = ADBMOUSE_MS_A3;
        }
        else if (adb_try_handler_change(id, 2)) {
            printk("ADB mouse at %d, handler set to 2", id);
            mouse_kind = ADBMOUSE_STANDARD_200;
        }
        else {
            printk("ADB mouse at %d, handler 1", id);
            mouse_kind = ADBMOUSE_STANDARD_100;
        }
​
        if ((mouse_kind == ADBMOUSE_TRACKBALLPRO)
            || (mouse_kind == ADBMOUSE_MICROSPEED)) {
            desc = "Microspeed/MacPoint or compatible";
            init_microspeed(id);
        } else if (mouse_kind == ADBMOUSE_MS_A3) {
            desc = "Mouse Systems A3 Mouse or compatible";
            init_ms_a3(id);
        } else if (mouse_kind ==  ADBMOUSE_EXTENDED) {
            desc = "extended";
            /*
             * Register 1 is usually used for device
             * identification.  Here, we try to identify
             * a known device and call the appropriate
             * init function.
             */
            adb_request(&req, NULL, ADBREQ_SYNC | ADBREQ_REPLY, 1,
                    ADB_READREG(id, 1));
​
            if ((req.reply_len) &&
                (req.reply[1] == 0x9a) && ((req.reply[2] == 0x21)
                    || (req.reply[2] == 0x20))) {
                mouse_kind = ADBMOUSE_TRACKBALL;
                desc = "trackman/mouseman";
                init_trackball(id);
            }
            else if ((req.reply_len >= 4) &&
                (req.reply[1] == 0x74) && (req.reply[2] == 0x70) &&
                (req.reply[3] == 0x61) && (req.reply[4] == 0x64)) {
                mouse_kind = ADBMOUSE_TRACKPAD;
                desc = "trackpad";
                init_trackpad(id);
            }
            else if ((req.reply_len >= 4) &&
                (req.reply[1] == 0x4b) && (req.reply[2] == 0x4d) &&
                (req.reply[3] == 0x4c) && (req.reply[4] == 0x31)) {
                mouse_kind = ADBMOUSE_TURBOMOUSE5;
                desc = "TurboMouse 5";
                init_turbomouse(id);
            }
            else if ((req.reply_len == 9) &&
                (req.reply[1] == 0x4b) && (req.reply[2] == 0x4f) &&
                (req.reply[3] == 0x49) && (req.reply[4] == 0x54)) {
                if (adb_try_handler_change(id, 0x42)) {
                    pr_cont("\nADB MacAlly 2-button mouse at %d, handler set to 0x42", id);
                    mouse_kind = ADBMOUSE_MACALLY2;
                    desc = "MacAlly 2-button";
                }
            }
        }
        pr_cont("\n");
​
        adb_get_infos(id, &default_id, &cur_handler_id);
        printk(KERN_DEBUG "ADB mouse (%s) at %d has handler 0x%X\n",
               desc, id, cur_handler_id);
        reg |= adbhid_input_reregister(id, default_id, org_handler_id,
                           cur_handler_id, mouse_kind);
    }
    adbhid_input_devcleanup(reg);
}
​
static void 
init_trackpad(int id)
{
    struct adb_request req;
    unsigned char r1_buffer[8];
​
    pr_cont(" (trackpad)");
​
    adb_request(&req, NULL, ADBREQ_SYNC | ADBREQ_REPLY, 1,
            ADB_READREG(id,1));
    if (req.reply_len < 8)
        pr_cont("bad length for reg. 1\n");
        pr_err("%s: bad length for reg. 1\n", __func__);
    else
    {
        memcpy(r1_buffer, &req.reply[1], 8);
​
        adb_request(&req, NULL, ADBREQ_SYNC, 9,
            ADB_WRITEREG(id,1),
                r1_buffer[0],
                r1_buffer[1],
                r1_buffer[2],
                r1_buffer[3],
        /* Without this flush, the trackpad may be locked up */
        adb_request(&req, NULL, ADBREQ_SYNC, 1, ADB_FLUSH(id));
        }
}
​
static void 
init_trackball(int id)
{
    struct adb_request req;
​
    pr_cont(" (trackman/mouseman)");
​
    adb_request(&req, NULL, ADBREQ_SYNC, 3,
    ADB_WRITEREG(id,1), 00,0x81);
​
    adb_request(&req, NULL, ADBREQ_SYNC, 3,
    ADB_WRITEREG(id,1), 01,0x81);
​
    adb_request(&req, NULL, ADBREQ_SYNC, 3,
    ADB_WRITEREG(id,1), 02,0x81);
​
    adb_request(&req, NULL, ADBREQ_SYNC, 3,
​
    adb_request(&req, NULL, ADBREQ_SYNC, 3,
    ADB_WRITEREG(id,1), 03,0x38);
}
​
static void
init_turbomouse(int id)
{
    struct adb_request req;
​
    pr_cont(" (TurboMouse 5)");
​
    adb_request(&req, NULL, ADBREQ_SYNC, 1, ADB_FLUSH(id));
​
    adb_request(&req, NULL, ADBREQ_SYNC, 1, ADB_FLUSH(3));
​
    adb_request(&req, NULL, ADBREQ_SYNC, 9,
    ADB_WRITEREG(3,2),
        0xe7,
        0x8c,
        0,
        0,
        0xff,
        0xff,
        0x27);
}
​
static void
init_microspeed(int id)
{
    struct adb_request req;
​
    pr_cont(" (Microspeed/MacPoint or compatible)");
​
    adb_request(&req, NULL, ADBREQ_SYNC, 1, ADB_FLUSH(id));
​
    /* This will initialize mice using the Microspeed, MacPoint and
       other compatible firmware. Bit 12 enables extended protocol.
       
       Register 1 Listen (4 Bytes)
            0 -  3     Button is mouse (set also for double clicking!!!)
            4 -  7     Button is locking (affects change speed also)
            8 - 11     Button changes speed
           12          1 = Extended mouse mode, 0 = normal mouse mode
​
​
    adb_request(&req, NULL, ADBREQ_SYNC, 1, ADB_FLUSH(id));
}
​
static void
init_ms_a3(int id)
{
    struct adb_request req;
​
    pr_cont(" (Mouse Systems A3 Mouse, or compatible)");
    adb_request(&req, NULL, ADBREQ_SYNC, 3,
    ADB_WRITEREG(id, 0x2),
        0x00,
        0x07);
 
    adb_request(&req, NULL, ADBREQ_SYNC, 1, ADB_FLUSH(id));
}
​
static int __init adbhid_init(void)
{