[linux-2.6-block.git] / drivers / hid / hid-magicmouse.c

/*
 *   Apple "Magic" Wireless Mouse driver
 *
 *   Copyright (c) 2010 Michael Poole <mdpoole@troilus.org>
 *   Copyright (c) 2010 Chase Douglas <chase.douglas@canonical.com>
 */

/*
 * This program is free software; you can redistribute it and/or modify it
 * under the terms of the GNU General Public License as published by the Free
 * Software Foundation; either version 2 of the License, or (at your option)
 * any later version.
 */

#define pr_fmt(fmt) KBUILD_MODNAME ": " fmt

#include <linux/device.h>
#include <linux/hid.h>
#include <linux/module.h>
#include <linux/slab.h>
#include <linux/usb.h>

#include "hid-ids.h"

static bool emulate_3button = true;
module_param(emulate_3button, bool, 0644);
MODULE_PARM_DESC(emulate_3button, "Emulate a middle button");

static int middle_button_start = -350;
static int middle_button_stop = +350;

static bool emulate_scroll_wheel = true;
module_param(emulate_scroll_wheel, bool, 0644);
MODULE_PARM_DESC(emulate_scroll_wheel, "Emulate a scroll wheel");

static unsigned int scroll_speed = 32;
static int param_set_scroll_speed(const char *val, struct kernel_param *kp) {
	unsigned long speed;
	if (!val || strict_strtoul(val, 0, &speed) || speed > 63)
		return -EINVAL;
	scroll_speed = speed;
	return 0;
}
module_param_call(scroll_speed, param_set_scroll_speed, param_get_uint, &scroll_speed, 0644);
MODULE_PARM_DESC(scroll_speed, "Scroll speed, value from 0 (slow) to 63 (fast)");

static bool scroll_acceleration = false;
module_param(scroll_acceleration, bool, 0644);
MODULE_PARM_DESC(scroll_acceleration, "Accelerate sequential scroll events");

static bool report_touches = true;
module_param(report_touches, bool, 0644);
MODULE_PARM_DESC(report_touches, "Emit touch records (otherwise, only use them for emulation)");

static bool report_undeciphered;
module_param(report_undeciphered, bool, 0644);
MODULE_PARM_DESC(report_undeciphered, "Report undeciphered multi-touch state field using a MSC_RAW event");

#define TRACKPAD_REPORT_ID 0x28
#define MOUSE_REPORT_ID    0x29
#define DOUBLE_REPORT_ID   0xf7
/* These definitions are not precise, but they're close enough.  (Bits
 * 0x03 seem to indicate the aspect ratio of the touch, bits 0x70 seem
 * to be some kind of bit mask -- 0x20 may be a near-field reading,
 * and 0x40 is actual contact, and 0x10 may be a start/stop or change
 * indication.)
 */
#define TOUCH_STATE_MASK  0xf0
#define TOUCH_STATE_NONE  0x00
#define TOUCH_STATE_START 0x30
#define TOUCH_STATE_DRAG  0x40

#define SCROLL_ACCEL_DEFAULT 7

/* Single touch emulation should only begin when no touches are currently down.
 * This is true when single_touch_id is equal to NO_TOUCHES. If multiple touches
 * are down and the touch providing for single touch emulation is lifted,
 * single_touch_id is equal to SINGLE_TOUCH_UP. While single touch emulation is
 * occurring, single_touch_id corresponds with the tracking id of the touch used.
 */
#define NO_TOUCHES -1
#define SINGLE_TOUCH_UP -2

/**
 * struct magicmouse_sc - Tracks Magic Mouse-specific data.
 * @input: Input device through which we report events.
 * @quirks: Currently unused.
 * @ntouches: Number of touches in most recent touch report.
 * @scroll_accel: Number of consecutive scroll motions.
 * @scroll_jiffies: Time of last scroll motion.
 * @touches: Most recent data for a touch, indexed by tracking ID.
 * @tracking_ids: Mapping of current touch input data to @touches.
 */
struct magicmouse_sc {
	struct input_dev *input;
	unsigned long quirks;

	int ntouches;
	int scroll_accel;
	unsigned long scroll_jiffies;

	struct {
		short x;
		short y;
		short scroll_x;
		short scroll_y;
		u8 size;
	} touches[16];
	int tracking_ids[16];
	int single_touch_id;
};

static int magicmouse_firm_touch(struct magicmouse_sc *msc)
{
	int touch = -1;
	int ii;

	/* If there is only one "firm" touch, set touch to its
	 * tracking ID.
	 */
	for (ii = 0; ii < msc->ntouches; ii++) {
		int idx = msc->tracking_ids[ii];
		if (msc->touches[idx].size < 8) {
			/* Ignore this touch. */
		} else if (touch >= 0) {
			touch = -1;
			break;
		} else {
			touch = idx;
		}
	}

	return touch;
}

static void magicmouse_emit_buttons(struct magicmouse_sc *msc, int state)
{
	int last_state = test_bit(BTN_LEFT, msc->input->key) << 0 |
		test_bit(BTN_RIGHT, msc->input->key) << 1 |
		test_bit(BTN_MIDDLE, msc->input->key) << 2;

	if (emulate_3button) {
		int id;

		/* If some button was pressed before, keep it held
		 * down.  Otherwise, if there's exactly one firm
		 * touch, use that to override the mouse's guess.
		 */
		if (state == 0) {
			/* The button was released. */
		} else if (last_state != 0) {
			state = last_state;
		} else if ((id = magicmouse_firm_touch(msc)) >= 0) {
			int x = msc->touches[id].x;
			if (x < middle_button_start)
				state = 1;
			else if (x > middle_button_stop)
				state = 2;
			else
				state = 4;
		} /* else: we keep the mouse's guess */

		input_report_key(msc->input, BTN_MIDDLE, state & 4);
	}

	input_report_key(msc->input, BTN_LEFT, state & 1);
	input_report_key(msc->input, BTN_RIGHT, state & 2);

	if (state != last_state)
		msc->scroll_accel = SCROLL_ACCEL_DEFAULT;
}

static void magicmouse_emit_touch(struct magicmouse_sc *msc, int raw_id, u8 *tdata)
{
	struct input_dev *input = msc->input;
	int id, x, y, size, orientation, touch_major, touch_minor, state, down;

	if (input->id.product == USB_DEVICE_ID_APPLE_MAGICMOUSE) {
		id = (tdata[6] << 2 | tdata[5] >> 6) & 0xf;
		x = (tdata[1] << 28 | tdata[0] << 20) >> 20;
		y = -((tdata[2] << 24 | tdata[1] << 16) >> 20);
		size = tdata[5] & 0x3f;
		orientation = (tdata[6] >> 2) - 32;
		touch_major = tdata[3];
		touch_minor = tdata[4];
		state = tdata[7] & TOUCH_STATE_MASK;
		down = state != TOUCH_STATE_NONE;
	} else { /* USB_DEVICE_ID_APPLE_MAGICTRACKPAD */
		id = (tdata[7] << 2 | tdata[6] >> 6) & 0xf;
		x = (tdata[1] << 27 | tdata[0] << 19) >> 19;
		y = -((tdata[3] << 30 | tdata[2] << 22 | tdata[1] << 14) >> 19);
		size = tdata[6] & 0x3f;
		orientation = (tdata[7] >> 2) - 32;
		touch_major = tdata[4];
		touch_minor = tdata[5];
		state = tdata[8] & TOUCH_STATE_MASK;
		down = state != TOUCH_STATE_NONE;
	}

	/* Store tracking ID and other fields. */
	msc->tracking_ids[raw_id] = id;
	msc->touches[id].x = x;
	msc->touches[id].y = y;
	msc->touches[id].size = size;

	/* If requested, emulate a scroll wheel by detecting small
	 * vertical touch motions.
	 */
	if (emulate_scroll_wheel) {
		unsigned long now = jiffies;
		int step_x = msc->touches[id].scroll_x - x;
		int step_y = msc->touches[id].scroll_y - y;

		/* Calculate and apply the scroll motion. */
		switch (state) {
		case TOUCH_STATE_START:
			msc->touches[id].scroll_x = x;
			msc->touches[id].scroll_y = y;

			/* Reset acceleration after half a second. */
			if (scroll_acceleration && time_before(now,
						msc->scroll_jiffies + HZ / 2))
				msc->scroll_accel = max_t(int,
						msc->scroll_accel - 1, 1);
			else
				msc->scroll_accel = SCROLL_ACCEL_DEFAULT;

			break;
		case TOUCH_STATE_DRAG:
			step_x /= (64 - (int)scroll_speed) * msc->scroll_accel;
			if (step_x != 0) {
				msc->touches[id].scroll_x -= step_x *
					(64 - scroll_speed) * msc->scroll_accel;
				msc->scroll_jiffies = now;
				input_report_rel(input, REL_HWHEEL, -step_x);
			}

			step_y /= (64 - (int)scroll_speed) * msc->scroll_accel;
			if (step_y != 0) {
				msc->touches[id].scroll_y -= step_y *
					(64 - scroll_speed) * msc->scroll_accel;
				msc->scroll_jiffies = now;
				input_report_rel(input, REL_WHEEL, step_y);
			}
			break;
		}
	}

	if (down) {
		msc->ntouches++;
		if (msc->single_touch_id == NO_TOUCHES)
			msc->single_touch_id = id;
	} else if (msc->single_touch_id == id)
		msc->single_touch_id = SINGLE_TOUCH_UP;

	/* Generate the input events for this touch. */
	if (report_touches && down) {
		input_report_abs(input, ABS_MT_TRACKING_ID, id);
		input_report_abs(input, ABS_MT_TOUCH_MAJOR, touch_major << 2);
		input_report_abs(input, ABS_MT_TOUCH_MINOR, touch_minor << 2);
		input_report_abs(input, ABS_MT_ORIENTATION, -orientation);
		input_report_abs(input, ABS_MT_POSITION_X, x);
		input_report_abs(input, ABS_MT_POSITION_Y, y);

		if (report_undeciphered) {
			if (input->id.product == USB_DEVICE_ID_APPLE_MAGICMOUSE)
				input_event(input, EV_MSC, MSC_RAW, tdata[7]);
			else /* USB_DEVICE_ID_APPLE_MAGICTRACKPAD */
				input_event(input, EV_MSC, MSC_RAW, tdata[8]);
		}

		input_mt_sync(input);
	}
}

static int magicmouse_raw_event(struct hid_device *hdev,
		struct hid_report *report, u8 *data, int size)
{
	struct magicmouse_sc *msc = hid_get_drvdata(hdev);
	struct input_dev *input = msc->input;
	int x = 0, y = 0, ii, clicks = 0, npoints;

	switch (data[0]) {
	case TRACKPAD_REPORT_ID:
		/* Expect four bytes of prefix, and N*9 bytes of touch data. */
		if (size < 4 || ((size - 4) % 9) != 0)
			return 0;
		npoints = (size - 4) / 9;
		msc->ntouches = 0;
		for (ii = 0; ii < npoints; ii++)
			magicmouse_emit_touch(msc, ii, data + ii * 9 + 4);

		/* We don't need an MT sync here because trackpad emits a
		 * BTN_TOUCH event in a new frame when all touches are released.
		 */
		if (msc->ntouches == 0)
			msc->single_touch_id = NO_TOUCHES;

		clicks = data[1];

		/* The following bits provide a device specific timestamp. They
		 * are unused here.
		 *
		 * ts = data[1] >> 6 | data[2] << 2 | data[3] << 10;
		 */
		break;
	case MOUSE_REPORT_ID:
		/* Expect six bytes of prefix, and N*8 bytes of touch data. */
		if (size < 6 || ((size - 6) % 8) != 0)
			return 0;
		npoints = (size - 6) / 8;
		msc->ntouches = 0;
		for (ii = 0; ii < npoints; ii++)
			magicmouse_emit_touch(msc, ii, data + ii * 8 + 6);

		if (report_touches && msc->ntouches == 0)
			input_mt_sync(input);

		/* When emulating three-button mode, it is important
		 * to have the current touch information before
		 * generating a click event.
		 */
		x = (int)(((data[3] & 0x0c) << 28) | (data[1] << 22)) >> 22;
		y = (int)(((data[3] & 0x30) << 26) | (data[2] << 22)) >> 22;
		clicks = data[3];

		/* The following bits provide a device specific timestamp. They
		 * are unused here.
		 *
		 * ts = data[3] >> 6 | data[4] << 2 | data[5] << 10;
		 */
		break;
	case DOUBLE_REPORT_ID:
		/* Sometimes the trackpad sends two touch reports in one
		 * packet.
		 */
		magicmouse_raw_event(hdev, report, data + 2, data[1]);
		magicmouse_raw_event(hdev, report, data + 2 + data[1],
			size - 2 - data[1]);
		break;
	default:
		return 0;
	}

	if (input->id.product == USB_DEVICE_ID_APPLE_MAGICMOUSE) {
		magicmouse_emit_buttons(msc, clicks & 3);
		input_report_rel(input, REL_X, x);
		input_report_rel(input, REL_Y, y);
	} else { /* USB_DEVICE_ID_APPLE_MAGICTRACKPAD */
		input_report_key(input, BTN_MOUSE, clicks & 1);
		input_report_key(input, BTN_TOUCH, msc->ntouches > 0);
		input_report_key(input, BTN_TOOL_FINGER, msc->ntouches == 1);
		input_report_key(input, BTN_TOOL_DOUBLETAP, msc->ntouches == 2);
		input_report_key(input, BTN_TOOL_TRIPLETAP, msc->ntouches == 3);
		input_report_key(input, BTN_TOOL_QUADTAP, msc->ntouches == 4);
		if (msc->single_touch_id >= 0) {
			input_report_abs(input, ABS_X,
				msc->touches[msc->single_touch_id].x);
			input_report_abs(input, ABS_Y,
				msc->touches[msc->single_touch_id].y);
		}
	}

	input_sync(input);
	return 1;
}

static void magicmouse_setup_input(struct input_dev *input, struct hid_device *hdev)
{
	__set_bit(EV_KEY, input->evbit);

	if (input->id.product == USB_DEVICE_ID_APPLE_MAGICMOUSE) {
		__set_bit(BTN_LEFT, input->keybit);
		__set_bit(BTN_RIGHT, input->keybit);
		if (emulate_3button)
			__set_bit(BTN_MIDDLE, input->keybit);

		__set_bit(EV_REL, input->evbit);
		__set_bit(REL_X, input->relbit);
		__set_bit(REL_Y, input->relbit);
		if (emulate_scroll_wheel) {
			__set_bit(REL_WHEEL, input->relbit);
			__set_bit(REL_HWHEEL, input->relbit);
		}
	} else { /* USB_DEVICE_ID_APPLE_MAGICTRACKPAD */
		__set_bit(BTN_MOUSE, input->keybit);
		__set_bit(BTN_TOOL_FINGER, input->keybit);
		__set_bit(BTN_TOOL_DOUBLETAP, input->keybit);
		__set_bit(BTN_TOOL_TRIPLETAP, input->keybit);
		__set_bit(BTN_TOOL_QUADTAP, input->keybit);
		__set_bit(BTN_TOUCH, input->keybit);
	}

	if (report_touches) {
		__set_bit(EV_ABS, input->evbit);

		input_set_abs_params(input, ABS_MT_TRACKING_ID, 0, 15, 0, 0);
		input_set_abs_params(input, ABS_MT_TOUCH_MAJOR, 0, 255, 4, 0);
		input_set_abs_params(input, ABS_MT_TOUCH_MINOR, 0, 255, 4, 0);
		input_set_abs_params(input, ABS_MT_ORIENTATION, -31, 32, 1, 0);

		/* Note: Touch Y position from the device is inverted relative
		 * to how pointer motion is reported (and relative to how USB
		 * HID recommends the coordinates work).  This driver keeps
		 * the origin at the same position, and just uses the additive
		 * inverse of the reported Y.
		 */
		if (input->id.product == USB_DEVICE_ID_APPLE_MAGICMOUSE) {
			input_set_abs_params(input, ABS_MT_POSITION_X, -1100,
				1358, 4, 0);
			input_set_abs_params(input, ABS_MT_POSITION_Y, -1589,
				2047, 4, 0);
		} else { /* USB_DEVICE_ID_APPLE_MAGICTRACKPAD */
			input_set_abs_params(input, ABS_X, -2909, 3167, 4, 0);
			input_set_abs_params(input, ABS_Y, -2456, 2565, 4, 0);
			input_set_abs_params(input, ABS_MT_POSITION_X, -2909,
				3167, 4, 0);
			input_set_abs_params(input, ABS_MT_POSITION_Y, -2456,
				2565, 4, 0);
		}

		input_set_events_per_packet(input, 60);
	}

	if (report_undeciphered) {
		__set_bit(EV_MSC, input->evbit);
		__set_bit(MSC_RAW, input->mscbit);
	}
}

static int magicmouse_input_mapping(struct hid_device *hdev,
		struct hid_input *hi, struct hid_field *field,
		struct hid_usage *usage, unsigned long **bit, int *max)
{
	struct magicmouse_sc *msc = hid_get_drvdata(hdev);

	if (!msc->input)
		msc->input = hi->input;

	/* Magic Trackpad does not give relative data after switching to MT */
	if (hi->input->id.product == USB_DEVICE_ID_APPLE_MAGICTRACKPAD &&
	    field->flags & HID_MAIN_ITEM_RELATIVE)
		return -1;

	return 0;
}

static int magicmouse_probe(struct hid_device *hdev,
	const struct hid_device_id *id)
{
	__u8 feature[] = { 0xd7, 0x01 };
	struct magicmouse_sc *msc;
	struct hid_report *report;
	int ret;

	msc = kzalloc(sizeof(*msc), GFP_KERNEL);
	if (msc == NULL) {
		hid_err(hdev, "can't alloc magicmouse descriptor\n");
		return -ENOMEM;
	}

	msc->scroll_accel = SCROLL_ACCEL_DEFAULT;

	msc->quirks = id->driver_data;
	hid_set_drvdata(hdev, msc);

	msc->single_touch_id = NO_TOUCHES;

	ret = hid_parse(hdev);
	if (ret) {
		hid_err(hdev, "magicmouse hid parse failed\n");
		goto err_free;
	}

	ret = hid_hw_start(hdev, HID_CONNECT_DEFAULT);
	if (ret) {
		hid_err(hdev, "magicmouse hw start failed\n");
		goto err_free;
	}

	/* We do this after hid-input is done parsing reports so that
	 * hid-input uses the most natural button and axis IDs.
	 */
	if (msc->input)
		magicmouse_setup_input(msc->input, hdev);

	if (id->product == USB_DEVICE_ID_APPLE_MAGICMOUSE)
		report = hid_register_report(hdev, HID_INPUT_REPORT,
			MOUSE_REPORT_ID);
	else { /* USB_DEVICE_ID_APPLE_MAGICTRACKPAD */
		report = hid_register_report(hdev, HID_INPUT_REPORT,
			TRACKPAD_REPORT_ID);
		report = hid_register_report(hdev, HID_INPUT_REPORT,
			DOUBLE_REPORT_ID);
	}

	if (!report) {
		hid_err(hdev, "unable to register touch report\n");
		ret = -ENOMEM;
		goto err_stop_hw;
	}
	report->size = 6;

	/*
	 * The device reponds with 'invalid report id' when feature
	 * report switching it into multitouch mode is sent to it.
	 *
	 * This results in -EIO from the _raw low-level transport callback,
	 * but there seems to be no other way of switching the mode.
	 * Thus the super-ugly hacky success check below.
	 */
	ret = hdev->hid_output_raw_report(hdev, feature, sizeof(feature),
			HID_FEATURE_REPORT);
	if (ret != -EIO) {
		hid_err(hdev, "unable to request touch data (%d)\n", ret);
		goto err_stop_hw;
	}

	return 0;
err_stop_hw:
	hid_hw_stop(hdev);
err_free:
	kfree(msc);
	return ret;
}

static void magicmouse_remove(struct hid_device *hdev)
{
	struct magicmouse_sc *msc = hid_get_drvdata(hdev);

	hid_hw_stop(hdev);
	kfree(msc);
}

static const struct hid_device_id magic_mice[] = {
	{ HID_BLUETOOTH_DEVICE(USB_VENDOR_ID_APPLE,
		USB_DEVICE_ID_APPLE_MAGICMOUSE), .driver_data = 0 },
	{ HID_BLUETOOTH_DEVICE(USB_VENDOR_ID_APPLE,
		USB_DEVICE_ID_APPLE_MAGICTRACKPAD), .driver_data = 0 },
	{ }
};
MODULE_DEVICE_TABLE(hid, magic_mice);

static struct hid_driver magicmouse_driver = {
	.name = "magicmouse",
	.id_table = magic_mice,
	.probe = magicmouse_probe,
	.remove = magicmouse_remove,
	.raw_event = magicmouse_raw_event,
	.input_mapping = magicmouse_input_mapping,
};

static int __init magicmouse_init(void)
{
	int ret;

	ret = hid_register_driver(&magicmouse_driver);
	if (ret)
		pr_err("can't register magicmouse driver\n");

	return ret;
}

static void __exit magicmouse_exit(void)
{
	hid_unregister_driver(&magicmouse_driver);
}

module_init(magicmouse_init);
module_exit(magicmouse_exit);
MODULE_LICENSE("GPL");
Commit	Line	Data
128537ce MP	1	/*
	2	* Apple "Magic" Wireless Mouse driver
	3	*
	4	* Copyright (c) 2010 Michael Poole <mdpoole@troilus.org>
a462230e	5	* Copyright (c) 2010 Chase Douglas <chase.douglas@canonical.com>
128537ce MP	6	*/
	7
	8	/*
	9	* This program is free software; you can redistribute it and/or modify it
	10	* under the terms of the GNU General Public License as published by the Free
	11	* Software Foundation; either version 2 of the License, or (at your option)
	12	* any later version.
	13	*/
	14
4291ee30 JP	15	#define pr_fmt(fmt) KBUILD_MODNAME ": " fmt
4291ee30 JP	16
128537ce MP	17	#include <linux/device.h>
	18	#include <linux/hid.h>
	19	#include <linux/module.h>
5a0e3ad6	20	#include <linux/slab.h>
128537ce MP	21	#include <linux/usb.h>
	22
	23	#include "hid-ids.h"
	24
71b38bd4	25	static bool emulate_3button = true;
128537ce MP	26	module_param(emulate_3button, bool, 0644);
	27	MODULE_PARM_DESC(emulate_3button, "Emulate a middle button");
	28
	29	static int middle_button_start = -350;
	30	static int middle_button_stop = +350;
	31
71b38bd4	32	static bool emulate_scroll_wheel = true;
128537ce MP	33	module_param(emulate_scroll_wheel, bool, 0644);
	34	MODULE_PARM_DESC(emulate_scroll_wheel, "Emulate a scroll wheel");
	35
0b778e76 CD	36	static unsigned int scroll_speed = 32;
	37	static int param_set_scroll_speed(const char val, struct kernel_param kp) {
	38	unsigned long speed;
	39	if (!val \|\| strict_strtoul(val, 0, &speed) \|\| speed > 63)
	40	return -EINVAL;
	41	scroll_speed = speed;
	42	return 0;
	43	}
	44	module_param_call(scroll_speed, param_set_scroll_speed, param_get_uint, &scroll_speed, 0644);
	45	MODULE_PARM_DESC(scroll_speed, "Scroll speed, value from 0 (slow) to 63 (fast)");
	46
9846f350 CD	47	static bool scroll_acceleration = false;
	48	module_param(scroll_acceleration, bool, 0644);
	49	MODULE_PARM_DESC(scroll_acceleration, "Accelerate sequential scroll events");
	50
71b38bd4	51	static bool report_touches = true;
128537ce MP	52	module_param(report_touches, bool, 0644);
	53	MODULE_PARM_DESC(report_touches, "Emit touch records (otherwise, only use them for emulation)");
	54
71b38bd4	55	static bool report_undeciphered;
128537ce MP	56	module_param(report_undeciphered, bool, 0644);
	57	MODULE_PARM_DESC(report_undeciphered, "Report undeciphered multi-touch state field using a MSC_RAW event");
	58
a462230e CD	59	#define TRACKPAD_REPORT_ID 0x28
	60	#define MOUSE_REPORT_ID 0x29
	61	#define DOUBLE_REPORT_ID 0xf7
128537ce MP	62	/* These definitions are not precise, but they're close enough. (Bits
	63	* 0x03 seem to indicate the aspect ratio of the touch, bits 0x70 seem
	64	* to be some kind of bit mask -- 0x20 may be a near-field reading,
	65	* and 0x40 is actual contact, and 0x10 may be a start/stop or change
	66	* indication.)
	67	*/
	68	#define TOUCH_STATE_MASK 0xf0
	69	#define TOUCH_STATE_NONE 0x00
	70	#define TOUCH_STATE_START 0x30
	71	#define TOUCH_STATE_DRAG 0x40
	72
0b778e76 CD	73	#define SCROLL_ACCEL_DEFAULT 7
0b778e76 CD	74
a462230e CD	75	/* Single touch emulation should only begin when no touches are currently down.
	76	* This is true when single_touch_id is equal to NO_TOUCHES. If multiple touches
	77	* are down and the touch providing for single touch emulation is lifted,
	78	* single_touch_id is equal to SINGLE_TOUCH_UP. While single touch emulation is
25985edc	79	* occurring, single_touch_id corresponds with the tracking id of the touch used.
a462230e CD	80	*/
	81	#define NO_TOUCHES -1
	82	#define SINGLE_TOUCH_UP -2
	83
128537ce MP	84	/**
	85	* struct magicmouse_sc - Tracks Magic Mouse-specific data.
	86	* @input: Input device through which we report events.
	87	* @quirks: Currently unused.
128537ce MP	88	* @ntouches: Number of touches in most recent touch report.
	89	* @scroll_accel: Number of consecutive scroll motions.
	90	* @scroll_jiffies: Time of last scroll motion.
	91	* @touches: Most recent data for a touch, indexed by tracking ID.
	92	* @tracking_ids: Mapping of current touch input data to @touches.
	93	*/
	94	struct magicmouse_sc {
	95	struct input_dev *input;
	96	unsigned long quirks;
	97
128537ce MP	98	int ntouches;
	99	int scroll_accel;
	100	unsigned long scroll_jiffies;
	101
	102	struct {
	103	short x;
	104	short y;
c0426688	105	short scroll_x;
128537ce MP	106	short scroll_y;
	107	u8 size;
	108	} touches[16];
	109	int tracking_ids[16];
a462230e	110	int single_touch_id;
128537ce MP	111	};
	112
	113	static int magicmouse_firm_touch(struct magicmouse_sc *msc)
	114	{
	115	int touch = -1;
	116	int ii;
	117
	118	/* If there is only one "firm" touch, set touch to its
	119	* tracking ID.
	120	*/
	121	for (ii = 0; ii < msc->ntouches; ii++) {
	122	int idx = msc->tracking_ids[ii];
	123	if (msc->touches[idx].size < 8) {
	124	/* Ignore this touch. */
	125	} else if (touch >= 0) {
	126	touch = -1;
	127	break;
	128	} else {
	129	touch = idx;
	130	}
	131	}
	132
	133	return touch;
	134	}
	135
	136	static void magicmouse_emit_buttons(struct magicmouse_sc *msc, int state)
	137	{
71b38bd4 MP	138	int last_state = test_bit(BTN_LEFT, msc->input->key) << 0 \|
	139	test_bit(BTN_RIGHT, msc->input->key) << 1 \|
	140	test_bit(BTN_MIDDLE, msc->input->key) << 2;
128537ce MP	141
	142	if (emulate_3button) {
	143	int id;
	144
	145	/* If some button was pressed before, keep it held
	146	* down. Otherwise, if there's exactly one firm
	147	* touch, use that to override the mouse's guess.
	148	*/
	149	if (state == 0) {
	150	/* The button was released. */
	151	} else if (last_state != 0) {
	152	state = last_state;
	153	} else if ((id = magicmouse_firm_touch(msc)) >= 0) {
	154	int x = msc->touches[id].x;
	155	if (x < middle_button_start)
	156	state = 1;
	157	else if (x > middle_button_stop)
	158	state = 2;
	159	else
	160	state = 4;
	161	} /* else: we keep the mouse's guess */
	162
	163	input_report_key(msc->input, BTN_MIDDLE, state & 4);
	164	}
	165
	166	input_report_key(msc->input, BTN_LEFT, state & 1);
	167	input_report_key(msc->input, BTN_RIGHT, state & 2);
	168
	169	if (state != last_state)
0b778e76	170	msc->scroll_accel = SCROLL_ACCEL_DEFAULT;
128537ce MP	171	}
	172
	173	static void magicmouse_emit_touch(struct magicmouse_sc msc, int raw_id, u8 tdata)
	174	{
	175	struct input_dev *input = msc->input;
a462230e CD	176	int id, x, y, size, orientation, touch_major, touch_minor, state, down;
	177
	178	if (input->id.product == USB_DEVICE_ID_APPLE_MAGICMOUSE) {
	179	id = (tdata[6] << 2 \| tdata[5] >> 6) & 0xf;
	180	x = (tdata[1] << 28 \| tdata[0] << 20) >> 20;
	181	y = -((tdata[2] << 24 \| tdata[1] << 16) >> 20);
	182	size = tdata[5] & 0x3f;
	183	orientation = (tdata[6] >> 2) - 32;
	184	touch_major = tdata[3];
	185	touch_minor = tdata[4];
	186	state = tdata[7] & TOUCH_STATE_MASK;
	187	down = state != TOUCH_STATE_NONE;
	188	} else { /* USB_DEVICE_ID_APPLE_MAGICTRACKPAD */
	189	id = (tdata[7] << 2 \| tdata[6] >> 6) & 0xf;
	190	x = (tdata[1] << 27 \| tdata[0] << 19) >> 19;
	191	y = -((tdata[3] << 30 \| tdata[2] << 22 \| tdata[1] << 14) >> 19);
	192	size = tdata[6] & 0x3f;
	193	orientation = (tdata[7] >> 2) - 32;
	194	touch_major = tdata[4];
	195	touch_minor = tdata[5];
	196	state = tdata[8] & TOUCH_STATE_MASK;
	197	down = state != TOUCH_STATE_NONE;
	198	}
128537ce MP	199
	200	/* Store tracking ID and other fields. */
	201	msc->tracking_ids[raw_id] = id;
	202	msc->touches[id].x = x;
	203	msc->touches[id].y = y;
6de048bf	204	msc->touches[id].size = size;
128537ce MP	205
128537ce MP	206	/* If requested, emulate a scroll wheel by detecting small
ef566d30	207	* vertical touch motions.
128537ce	208	*/
ef566d30	209	if (emulate_scroll_wheel) {
128537ce	210	unsigned long now = jiffies;
c0426688 CD	211	int step_x = msc->touches[id].scroll_x - x;
c0426688 CD	212	int step_y = msc->touches[id].scroll_y - y;
128537ce	213
128537ce	214	/* Calculate and apply the scroll motion. */
6de048bf	215	switch (state) {
128537ce	216	case TOUCH_STATE_START:
c0426688	217	msc->touches[id].scroll_x = x;
128537ce	218	msc->touches[id].scroll_y = y;
0b778e76 CD	219
	220	/* Reset acceleration after half a second. */
	221	if (scroll_acceleration && time_before(now,
	222	msc->scroll_jiffies + HZ / 2))
	223	msc->scroll_accel = max_t(int,
	224	msc->scroll_accel - 1, 1);
	225	else
	226	msc->scroll_accel = SCROLL_ACCEL_DEFAULT;
	227
128537ce MP	228	break;
128537ce MP	229	case TOUCH_STATE_DRAG:
c0426688 CD	230	step_x /= (64 - (int)scroll_speed) * msc->scroll_accel;
	231	if (step_x != 0) {
	232	msc->touches[id].scroll_x -= step_x *
0b778e76	233	(64 - scroll_speed) * msc->scroll_accel;
128537ce	234	msc->scroll_jiffies = now;
c0426688 CD	235	input_report_rel(input, REL_HWHEEL, -step_x);
	236	}
	237
	238	step_y /= (64 - (int)scroll_speed) * msc->scroll_accel;
	239	if (step_y != 0) {
	240	msc->touches[id].scroll_y -= step_y *
	241	(64 - scroll_speed) * msc->scroll_accel;
	242	msc->scroll_jiffies = now;
	243	input_report_rel(input, REL_WHEEL, step_y);
128537ce MP	244	}
	245	break;
	246	}
	247	}
	248
a462230e CD	249	if (down) {
	250	msc->ntouches++;
	251	if (msc->single_touch_id == NO_TOUCHES)
	252	msc->single_touch_id = id;
	253	} else if (msc->single_touch_id == id)
	254	msc->single_touch_id = SINGLE_TOUCH_UP;
	255
128537ce	256	/* Generate the input events for this touch. */
e3612e86	257	if (report_touches && down) {
128537ce	258	input_report_abs(input, ABS_MT_TRACKING_ID, id);
921990b7 HR	259	input_report_abs(input, ABS_MT_TOUCH_MAJOR, touch_major << 2);
921990b7 HR	260	input_report_abs(input, ABS_MT_TOUCH_MINOR, touch_minor << 2);
2d9ca4e9	261	input_report_abs(input, ABS_MT_ORIENTATION, -orientation);
128537ce MP	262	input_report_abs(input, ABS_MT_POSITION_X, x);
	263	input_report_abs(input, ABS_MT_POSITION_Y, y);
	264
a462230e CD	265	if (report_undeciphered) {
	266	if (input->id.product == USB_DEVICE_ID_APPLE_MAGICMOUSE)
	267	input_event(input, EV_MSC, MSC_RAW, tdata[7]);
	268	else /* USB_DEVICE_ID_APPLE_MAGICTRACKPAD */
	269	input_event(input, EV_MSC, MSC_RAW, tdata[8]);
	270	}
128537ce MP	271
	272	input_mt_sync(input);
	273	}
	274	}
	275
	276	static int magicmouse_raw_event(struct hid_device *hdev,
	277	struct hid_report report, u8 data, int size)
	278	{
	279	struct magicmouse_sc *msc = hid_get_drvdata(hdev);
	280	struct input_dev *input = msc->input;
a462230e	281	int x = 0, y = 0, ii, clicks = 0, npoints;
128537ce MP	282
128537ce MP	283	switch (data[0]) {
a462230e CD	284	case TRACKPAD_REPORT_ID:
	285	/* Expect four bytes of prefix, and N9 bytes of touch data. /
	286	if (size < 4 \|\| ((size - 4) % 9) != 0)
	287	return 0;
	288	npoints = (size - 4) / 9;
	289	msc->ntouches = 0;
	290	for (ii = 0; ii < npoints; ii++)
	291	magicmouse_emit_touch(msc, ii, data + ii * 9 + 4);
	292
	293	/* We don't need an MT sync here because trackpad emits a
	294	* BTN_TOUCH event in a new frame when all touches are released.
	295	*/
	296	if (msc->ntouches == 0)
	297	msc->single_touch_id = NO_TOUCHES;
	298
	299	clicks = data[1];
	300
	301	/* The following bits provide a device specific timestamp. They
	302	* are unused here.
	303	*
	304	* ts = data[1] >> 6 \| data[2] << 2 \| data[3] << 10;
	305	*/
	306	break;
	307	case MOUSE_REPORT_ID:
128537ce MP	308	/* Expect six bytes of prefix, and N8 bytes of touch data. /
	309	if (size < 6 \|\| ((size - 6) % 8) != 0)
	310	return 0;
0228db70 CD	311	npoints = (size - 6) / 8;
	312	msc->ntouches = 0;
	313	for (ii = 0; ii < npoints; ii++)
128537ce	314	magicmouse_emit_touch(msc, ii, data + ii * 8 + 6);
e3612e86	315
0228db70 CD	316	if (report_touches && msc->ntouches == 0)
0228db70 CD	317	input_mt_sync(input);
e3612e86	318
128537ce MP	319	/* When emulating three-button mode, it is important
	320	* to have the current touch information before
	321	* generating a click event.
	322	*/
7d876c05 MP	323	x = (int)(((data[3] & 0x0c) << 28) \| (data[1] << 22)) >> 22;
7d876c05 MP	324	y = (int)(((data[3] & 0x30) << 26) \| (data[2] << 22)) >> 22;
128537ce	325	clicks = data[3];
c61b7cee CD	326
	327	/* The following bits provide a device specific timestamp. They
	328	* are unused here.
	329	*
	330	* ts = data[3] >> 6 \| data[4] << 2 \| data[5] << 10;
	331	*/
128537ce	332	break;
a462230e CD	333	case DOUBLE_REPORT_ID:
	334	/* Sometimes the trackpad sends two touch reports in one
	335	* packet.
	336	*/
	337	magicmouse_raw_event(hdev, report, data + 2, data[1]);
	338	magicmouse_raw_event(hdev, report, data + 2 + data[1],
	339	size - 2 - data[1]);
	340	break;
128537ce MP	341	default:
	342	return 0;
	343	}
	344
a462230e CD	345	if (input->id.product == USB_DEVICE_ID_APPLE_MAGICMOUSE) {
	346	magicmouse_emit_buttons(msc, clicks & 3);
	347	input_report_rel(input, REL_X, x);
	348	input_report_rel(input, REL_Y, y);
	349	} else { /* USB_DEVICE_ID_APPLE_MAGICTRACKPAD */
	350	input_report_key(input, BTN_MOUSE, clicks & 1);
	351	input_report_key(input, BTN_TOUCH, msc->ntouches > 0);
	352	input_report_key(input, BTN_TOOL_FINGER, msc->ntouches == 1);
	353	input_report_key(input, BTN_TOOL_DOUBLETAP, msc->ntouches == 2);
	354	input_report_key(input, BTN_TOOL_TRIPLETAP, msc->ntouches == 3);
	355	input_report_key(input, BTN_TOOL_QUADTAP, msc->ntouches == 4);
	356	if (msc->single_touch_id >= 0) {
	357	input_report_abs(input, ABS_X,
	358	msc->touches[msc->single_touch_id].x);
	359	input_report_abs(input, ABS_Y,
	360	msc->touches[msc->single_touch_id].y);
	361	}
	362	}
	363
128537ce MP	364	input_sync(input);
	365	return 1;
	366	}
	367
128537ce MP	368	static void magicmouse_setup_input(struct input_dev input, struct hid_device hdev)
128537ce MP	369	{
71b38bd4	370	__set_bit(EV_KEY, input->evbit);
a462230e CD	371
	372	if (input->id.product == USB_DEVICE_ID_APPLE_MAGICMOUSE) {
	373	__set_bit(BTN_LEFT, input->keybit);
	374	__set_bit(BTN_RIGHT, input->keybit);
	375	if (emulate_3button)
	376	__set_bit(BTN_MIDDLE, input->keybit);
	377
	378	__set_bit(EV_REL, input->evbit);
	379	__set_bit(REL_X, input->relbit);
	380	__set_bit(REL_Y, input->relbit);
	381	if (emulate_scroll_wheel) {
	382	__set_bit(REL_WHEEL, input->relbit);
	383	__set_bit(REL_HWHEEL, input->relbit);
	384	}
	385	} else { /* USB_DEVICE_ID_APPLE_MAGICTRACKPAD */
	386	__set_bit(BTN_MOUSE, input->keybit);
	387	__set_bit(BTN_TOOL_FINGER, input->keybit);
	388	__set_bit(BTN_TOOL_DOUBLETAP, input->keybit);
	389	__set_bit(BTN_TOOL_TRIPLETAP, input->keybit);
	390	__set_bit(BTN_TOOL_QUADTAP, input->keybit);
	391	__set_bit(BTN_TOUCH, input->keybit);
c0426688	392	}
128537ce MP	393
128537ce MP	394	if (report_touches) {
71b38bd4 MP	395	__set_bit(EV_ABS, input->evbit);
	396
	397	input_set_abs_params(input, ABS_MT_TRACKING_ID, 0, 15, 0, 0);
	398	input_set_abs_params(input, ABS_MT_TOUCH_MAJOR, 0, 255, 4, 0);
	399	input_set_abs_params(input, ABS_MT_TOUCH_MINOR, 0, 255, 4, 0);
2d9ca4e9	400	input_set_abs_params(input, ABS_MT_ORIENTATION, -31, 32, 1, 0);
a462230e	401
128537ce MP	402	/* Note: Touch Y position from the device is inverted relative
	403	* to how pointer motion is reported (and relative to how USB
	404	* HID recommends the coordinates work). This driver keeps
	405	* the origin at the same position, and just uses the additive
	406	* inverse of the reported Y.
	407	*/
a462230e CD	408	if (input->id.product == USB_DEVICE_ID_APPLE_MAGICMOUSE) {
	409	input_set_abs_params(input, ABS_MT_POSITION_X, -1100,
	410	1358, 4, 0);
	411	input_set_abs_params(input, ABS_MT_POSITION_Y, -1589,
	412	2047, 4, 0);
	413	} else { /* USB_DEVICE_ID_APPLE_MAGICTRACKPAD */
	414	input_set_abs_params(input, ABS_X, -2909, 3167, 4, 0);
	415	input_set_abs_params(input, ABS_Y, -2456, 2565, 4, 0);
	416	input_set_abs_params(input, ABS_MT_POSITION_X, -2909,
	417	3167, 4, 0);
	418	input_set_abs_params(input, ABS_MT_POSITION_Y, -2456,
	419	2565, 4, 0);
	420	}
cc5e0f08 CD	421
cc5e0f08 CD	422	input_set_events_per_packet(input, 60);
128537ce MP	423	}
	424
	425	if (report_undeciphered) {
71b38bd4 MP	426	__set_bit(EV_MSC, input->evbit);
71b38bd4 MP	427	__set_bit(MSC_RAW, input->mscbit);
128537ce MP	428	}
	429	}
	430
64eb105d MP	431	static int magicmouse_input_mapping(struct hid_device *hdev,
	432	struct hid_input hi, struct hid_field field,
	433	struct hid_usage usage, unsigned long bit, int max)
	434	{
	435	struct magicmouse_sc *msc = hid_get_drvdata(hdev);
	436
	437	if (!msc->input)
	438	msc->input = hi->input;
	439
6a66bbd6 CD	440	/* Magic Trackpad does not give relative data after switching to MT */
	441	if (hi->input->id.product == USB_DEVICE_ID_APPLE_MAGICTRACKPAD &&
	442	field->flags & HID_MAIN_ITEM_RELATIVE)
	443	return -1;
	444
64eb105d MP	445	return 0;
	446	}
	447
128537ce MP	448	static int magicmouse_probe(struct hid_device *hdev,
	449	const struct hid_device_id *id)
	450	{
0773590c	451	__u8 feature[] = { 0xd7, 0x01 };
128537ce MP	452	struct magicmouse_sc *msc;
	453	struct hid_report *report;
	454	int ret;
	455
	456	msc = kzalloc(sizeof(*msc), GFP_KERNEL);
	457	if (msc == NULL) {
4291ee30	458	hid_err(hdev, "can't alloc magicmouse descriptor\n");
128537ce MP	459	return -ENOMEM;
	460	}
	461
0b778e76 CD	462	msc->scroll_accel = SCROLL_ACCEL_DEFAULT;
0b778e76 CD	463
128537ce MP	464	msc->quirks = id->driver_data;
	465	hid_set_drvdata(hdev, msc);
	466
a462230e CD	467	msc->single_touch_id = NO_TOUCHES;
a462230e CD	468
128537ce MP	469	ret = hid_parse(hdev);
128537ce MP	470	if (ret) {
4291ee30	471	hid_err(hdev, "magicmouse hid parse failed\n");
128537ce MP	472	goto err_free;
	473	}
	474
23d02116	475	ret = hid_hw_start(hdev, HID_CONNECT_DEFAULT);
128537ce	476	if (ret) {
4291ee30	477	hid_err(hdev, "magicmouse hw start failed\n");
128537ce MP	478	goto err_free;
	479	}
	480
64eb105d MP	481	/* We do this after hid-input is done parsing reports so that
	482	* hid-input uses the most natural button and axis IDs.
	483	*/
	484	if (msc->input)
	485	magicmouse_setup_input(msc->input, hdev);
23d02116	486
a462230e CD	487	if (id->product == USB_DEVICE_ID_APPLE_MAGICMOUSE)
	488	report = hid_register_report(hdev, HID_INPUT_REPORT,
	489	MOUSE_REPORT_ID);
	490	else { /* USB_DEVICE_ID_APPLE_MAGICTRACKPAD */
	491	report = hid_register_report(hdev, HID_INPUT_REPORT,
	492	TRACKPAD_REPORT_ID);
	493	report = hid_register_report(hdev, HID_INPUT_REPORT,
	494	DOUBLE_REPORT_ID);
	495	}
	496
128537ce	497	if (!report) {
4291ee30	498	hid_err(hdev, "unable to register touch report\n");
128537ce	499	ret = -ENOMEM;
71b38bd4	500	goto err_stop_hw;
128537ce MP	501	}
	502	report->size = 6;
	503
23746a66 JK	504	/*
	505	* The device reponds with 'invalid report id' when feature
	506	* report switching it into multitouch mode is sent to it.
	507	*
	508	* This results in -EIO from the _raw low-level transport callback,
	509	* but there seems to be no other way of switching the mode.
	510	* Thus the super-ugly hacky success check below.
	511	*/
0773590c	512	ret = hdev->hid_output_raw_report(hdev, feature, sizeof(feature),
128537ce	513	HID_FEATURE_REPORT);
23746a66	514	if (ret != -EIO) {
4291ee30	515	hid_err(hdev, "unable to request touch data (%d)\n", ret);
71b38bd4	516	goto err_stop_hw;
128537ce MP	517	}
128537ce MP	518
128537ce	519	return 0;
71b38bd4 MP	520	err_stop_hw:
	521	hid_hw_stop(hdev);
	522	err_free:
128537ce MP	523	kfree(msc);
	524	return ret;
	525	}
	526
	527	static void magicmouse_remove(struct hid_device *hdev)
	528	{
28918c21 MP	529	struct magicmouse_sc *msc = hid_get_drvdata(hdev);
28918c21 MP	530
128537ce	531	hid_hw_stop(hdev);
28918c21	532	kfree(msc);
128537ce MP	533	}
	534
	535	static const struct hid_device_id magic_mice[] = {
a462230e CD	536	{ HID_BLUETOOTH_DEVICE(USB_VENDOR_ID_APPLE,
	537	USB_DEVICE_ID_APPLE_MAGICMOUSE), .driver_data = 0 },
	538	{ HID_BLUETOOTH_DEVICE(USB_VENDOR_ID_APPLE,
	539	USB_DEVICE_ID_APPLE_MAGICTRACKPAD), .driver_data = 0 },
128537ce MP	540	{ }
	541	};
	542	MODULE_DEVICE_TABLE(hid, magic_mice);
	543
	544	static struct hid_driver magicmouse_driver = {
	545	.name = "magicmouse",
	546	.id_table = magic_mice,
	547	.probe = magicmouse_probe,
	548	.remove = magicmouse_remove,
	549	.raw_event = magicmouse_raw_event,
64eb105d	550	.input_mapping = magicmouse_input_mapping,
128537ce MP	551	};
	552
	553	static int __init magicmouse_init(void)
	554	{
	555	int ret;
	556
	557	ret = hid_register_driver(&magicmouse_driver);
	558	if (ret)
4291ee30	559	pr_err("can't register magicmouse driver\n");
128537ce MP	560
	561	return ret;
	562	}
	563
	564	static void __exit magicmouse_exit(void)
	565	{
	566	hid_unregister_driver(&magicmouse_driver);
	567	}
	568
	569	module_init(magicmouse_init);
	570	module_exit(magicmouse_exit);
	571	MODULE_LICENSE("GPL");