mirror of
https://github.com/torvalds/linux.git
synced 2024-11-29 15:41:36 +00:00
297d716f62
Change the ownership of power_supply structure from each driver implementing the class to the power supply core. The patch changes power_supply_register() function thus all drivers implementing power supply class are adjusted. Each driver provides the implementation of power supply. However it should not be the owner of power supply class instance because it is exposed by core to other subsystems with power_supply_get_by_name(). These other subsystems have no knowledge when the driver will unregister the power supply. This leads to several issues when driver is unbound - mostly because user of power supply accesses freed memory. Instead let the core own the instance of struct 'power_supply'. Other users of this power supply will still access valid memory because it will be freed when device reference count reaches 0. Currently this means "it will leak" but power_supply_put() call in next patches will solve it. This solves invalid memory references in following race condition scenario: Thread 1: charger manager Thread 2: power supply driver, used by charger manager THREAD 1 (charger manager) THREAD 2 (power supply driver) ========================== ============================== psy = power_supply_get_by_name() Driver unbind, .remove power_supply_unregister() Device fully removed psy->get_property() The 'get_property' call is executed in invalid context because the driver was unbound and struct 'power_supply' memory was freed. This could be observed easily with charger manager driver (here compiled with max17040 fuel gauge): $ cat /sys/devices/virtual/power_supply/cm-battery/capacity & $ echo "1-0036" > /sys/bus/i2c/drivers/max17040/unbind [ 55.725123] Unable to handle kernel NULL pointer dereference at virtual address 00000000 [ 55.732584] pgd = d98d4000 [ 55.734060] [00000000] *pgd=5afa2831, *pte=00000000, *ppte=00000000 [ 55.740318] Internal error: Oops: 80000007 [#1] PREEMPT SMP ARM [ 55.746210] Modules linked in: [ 55.749259] CPU: 1 PID: 2936 Comm: cat Tainted: G W 3.19.0-rc1-next-20141226-00048-gf79f475f3c44-dirty #1496 [ 55.760190] Hardware name: SAMSUNG EXYNOS (Flattened Device Tree) [ 55.766270] task: d9b76f00 ti: daf54000 task.ti: daf54000 [ 55.771647] PC is at 0x0 [ 55.774182] LR is at charger_get_property+0x2f4/0x36c [ 55.779201] pc : [<00000000>] lr : [<c034b0b4>] psr: 60000013 [ 55.779201] sp : daf55e90 ip : 00000003 fp : 00000000 [ 55.790657] r10: 00000000 r9 : c06e2878 r8 : d9b26c68 [ 55.795865] r7 : dad81610 r6 : daec7410 r5 : daf55ebc r4 : 00000000 [ 55.802367] r3 : 00000000 r2 : daf55ebc r1 : 0000002a r0 : d9b26c68 [ 55.808879] Flags: nZCv IRQs on FIQs on Mode SVC_32 ISA ARM Segment user [ 55.815994] Control: 10c5387d Table: 598d406a DAC: 00000015 [ 55.821723] Process cat (pid: 2936, stack limit = 0xdaf54210) [ 55.827451] Stack: (0xdaf55e90 to 0xdaf56000) [ 55.831795] 5e80: 60000013 c01459c4 0000002a c06f8ef8 [ 55.839956] 5ea0: db651000 c06f8ef8 daebac00 c04cb668 daebac08 c0346864 00000000 c01459c4 [ 55.848115] 5ec0: d99eaa80 c06f8ef8 00000fff 00001000 db651000 c027f25c c027f240 d99eaa80 [ 55.856274] 5ee0: d9a06c00 c0146218 daf55f18 00001000 d99eaa80 db4c18c0 00000001 00000001 [ 55.864468] 5f00: daf55f80 c0144c78 c0144c54 c0107f90 00015000 d99eaab0 00000000 00000000 [ 55.872603] 5f20: 000051c7 00000000 db4c18c0 c04a9370 00015000 00001000 daf55f80 00001000 [ 55.880763] 5f40: daf54000 00015000 00000000 c00e53dc db4c18c0 c00e548c 0000000d 00008124 [ 55.888937] 5f60: 00000001 00000000 00000000 db4c18c0 db4c18c0 00001000 00015000 c00e5550 [ 55.897099] 5f80: 00000000 00000000 00001000 00001000 00015000 00000003 00000003 c000f364 [ 55.905239] 5fa0: 00000000 c000f1a0 00001000 00015000 00000003 00015000 00001000 0001333c [ 55.913399] 5fc0: 00001000 00015000 00000003 00000003 00000002 00000000 00000000 00000000 [ 55.921560] 5fe0: 7fffe000 be999850 0000a225 b6f3c19c 60000010 00000003 00000000 00000000 [ 55.929744] [<c034b0b4>] (charger_get_property) from [<c0346864>] (power_supply_show_property+0x48/0x20c) [ 55.939286] [<c0346864>] (power_supply_show_property) from [<c027f25c>] (dev_attr_show+0x1c/0x48) [ 55.948130] [<c027f25c>] (dev_attr_show) from [<c0146218>] (sysfs_kf_seq_show+0x84/0x104) [ 55.956298] [<c0146218>] (sysfs_kf_seq_show) from [<c0144c78>] (kernfs_seq_show+0x24/0x28) [ 55.964536] [<c0144c78>] (kernfs_seq_show) from [<c0107f90>] (seq_read+0x1b0/0x484) [ 55.972172] [<c0107f90>] (seq_read) from [<c00e53dc>] (__vfs_read+0x18/0x4c) [ 55.979188] [<c00e53dc>] (__vfs_read) from [<c00e548c>] (vfs_read+0x7c/0x100) [ 55.986304] [<c00e548c>] (vfs_read) from [<c00e5550>] (SyS_read+0x40/0x8c) [ 55.993164] [<c00e5550>] (SyS_read) from [<c000f1a0>] (ret_fast_syscall+0x0/0x48) [ 56.000626] Code: bad PC value [ 56.011652] ---[ end trace 7b64343fbdae8ef1 ]--- Signed-off-by: Krzysztof Kozlowski <k.kozlowski@samsung.com> Reviewed-by: Bartlomiej Zolnierkiewicz <b.zolnierkie@samsung.com> [for the nvec part] Reviewed-by: Marc Dietrich <marvin24@gmx.de> [for compal-laptop.c] Acked-by: Darren Hart <dvhart@linux.intel.com> [for the mfd part] Acked-by: Lee Jones <lee.jones@linaro.org> [for the hid part] Acked-by: Jiri Kosina <jkosina@suse.cz> [for the acpi part] Acked-by: Rafael J. Wysocki <rafael.j.wysocki@intel.com> Signed-off-by: Sebastian Reichel <sre@kernel.org>
1605 lines
41 KiB
C
1605 lines
41 KiB
C
/*
|
|
* drivers/input/tablet/wacom_sys.c
|
|
*
|
|
* USB Wacom tablet support - system specific code
|
|
*/
|
|
|
|
/*
|
|
* 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.
|
|
*/
|
|
|
|
#include "wacom_wac.h"
|
|
#include "wacom.h"
|
|
#include <linux/input/mt.h>
|
|
|
|
#define WAC_MSG_RETRIES 5
|
|
|
|
#define WAC_CMD_WL_LED_CONTROL 0x03
|
|
#define WAC_CMD_LED_CONTROL 0x20
|
|
#define WAC_CMD_ICON_START 0x21
|
|
#define WAC_CMD_ICON_XFER 0x23
|
|
#define WAC_CMD_ICON_BT_XFER 0x26
|
|
#define WAC_CMD_RETRIES 10
|
|
|
|
#define DEV_ATTR_RW_PERM (S_IRUGO | S_IWUSR | S_IWGRP)
|
|
#define DEV_ATTR_WO_PERM (S_IWUSR | S_IWGRP)
|
|
|
|
static int wacom_get_report(struct hid_device *hdev, u8 type, u8 *buf,
|
|
size_t size, unsigned int retries)
|
|
{
|
|
int retval;
|
|
|
|
do {
|
|
retval = hid_hw_raw_request(hdev, buf[0], buf, size, type,
|
|
HID_REQ_GET_REPORT);
|
|
} while ((retval == -ETIMEDOUT || retval == -EPIPE) && --retries);
|
|
|
|
return retval;
|
|
}
|
|
|
|
static int wacom_set_report(struct hid_device *hdev, u8 type, u8 *buf,
|
|
size_t size, unsigned int retries)
|
|
{
|
|
int retval;
|
|
|
|
do {
|
|
retval = hid_hw_raw_request(hdev, buf[0], buf, size, type,
|
|
HID_REQ_SET_REPORT);
|
|
} while ((retval == -ETIMEDOUT || retval == -EPIPE) && --retries);
|
|
|
|
return retval;
|
|
}
|
|
|
|
static int wacom_raw_event(struct hid_device *hdev, struct hid_report *report,
|
|
u8 *raw_data, int size)
|
|
{
|
|
struct wacom *wacom = hid_get_drvdata(hdev);
|
|
|
|
if (size > WACOM_PKGLEN_MAX)
|
|
return 1;
|
|
|
|
memcpy(wacom->wacom_wac.data, raw_data, size);
|
|
|
|
wacom_wac_irq(&wacom->wacom_wac, size);
|
|
|
|
return 0;
|
|
}
|
|
|
|
static int wacom_open(struct input_dev *dev)
|
|
{
|
|
struct wacom *wacom = input_get_drvdata(dev);
|
|
|
|
return hid_hw_open(wacom->hdev);
|
|
}
|
|
|
|
static void wacom_close(struct input_dev *dev)
|
|
{
|
|
struct wacom *wacom = input_get_drvdata(dev);
|
|
|
|
hid_hw_close(wacom->hdev);
|
|
}
|
|
|
|
/*
|
|
* Calculate the resolution of the X or Y axis using hidinput_calc_abs_res.
|
|
*/
|
|
static int wacom_calc_hid_res(int logical_extents, int physical_extents,
|
|
unsigned unit, int exponent)
|
|
{
|
|
struct hid_field field = {
|
|
.logical_maximum = logical_extents,
|
|
.physical_maximum = physical_extents,
|
|
.unit = unit,
|
|
.unit_exponent = exponent,
|
|
};
|
|
|
|
return hidinput_calc_abs_res(&field, ABS_X);
|
|
}
|
|
|
|
static void wacom_feature_mapping(struct hid_device *hdev,
|
|
struct hid_field *field, struct hid_usage *usage)
|
|
{
|
|
struct wacom *wacom = hid_get_drvdata(hdev);
|
|
struct wacom_features *features = &wacom->wacom_wac.features;
|
|
struct hid_data *hid_data = &wacom->wacom_wac.hid_data;
|
|
u8 *data;
|
|
int ret;
|
|
|
|
switch (usage->hid) {
|
|
case HID_DG_CONTACTMAX:
|
|
/* leave touch_max as is if predefined */
|
|
if (!features->touch_max) {
|
|
/* read manually */
|
|
data = kzalloc(2, GFP_KERNEL);
|
|
if (!data)
|
|
break;
|
|
data[0] = field->report->id;
|
|
ret = wacom_get_report(hdev, HID_FEATURE_REPORT,
|
|
data, 2, 0);
|
|
if (ret == 2)
|
|
features->touch_max = data[1];
|
|
kfree(data);
|
|
}
|
|
break;
|
|
case HID_DG_INPUTMODE:
|
|
/* Ignore if value index is out of bounds. */
|
|
if (usage->usage_index >= field->report_count) {
|
|
dev_err(&hdev->dev, "HID_DG_INPUTMODE out of range\n");
|
|
break;
|
|
}
|
|
|
|
hid_data->inputmode = field->report->id;
|
|
hid_data->inputmode_index = usage->usage_index;
|
|
break;
|
|
}
|
|
}
|
|
|
|
/*
|
|
* Interface Descriptor of wacom devices can be incomplete and
|
|
* inconsistent so wacom_features table is used to store stylus
|
|
* device's packet lengths, various maximum values, and tablet
|
|
* resolution based on product ID's.
|
|
*
|
|
* For devices that contain 2 interfaces, wacom_features table is
|
|
* inaccurate for the touch interface. Since the Interface Descriptor
|
|
* for touch interfaces has pretty complete data, this function exists
|
|
* to query tablet for this missing information instead of hard coding in
|
|
* an additional table.
|
|
*
|
|
* A typical Interface Descriptor for a stylus will contain a
|
|
* boot mouse application collection that is not of interest and this
|
|
* function will ignore it.
|
|
*
|
|
* It also contains a digitizer application collection that also is not
|
|
* of interest since any information it contains would be duplicate
|
|
* of what is in wacom_features. Usually it defines a report of an array
|
|
* of bytes that could be used as max length of the stylus packet returned.
|
|
* If it happens to define a Digitizer-Stylus Physical Collection then
|
|
* the X and Y logical values contain valid data but it is ignored.
|
|
*
|
|
* A typical Interface Descriptor for a touch interface will contain a
|
|
* Digitizer-Finger Physical Collection which will define both logical
|
|
* X/Y maximum as well as the physical size of tablet. Since touch
|
|
* interfaces haven't supported pressure or distance, this is enough
|
|
* information to override invalid values in the wacom_features table.
|
|
*
|
|
* Intuos5 touch interface and 3rd gen Bamboo Touch do not contain useful
|
|
* data. We deal with them after returning from this function.
|
|
*/
|
|
static void wacom_usage_mapping(struct hid_device *hdev,
|
|
struct hid_field *field, struct hid_usage *usage)
|
|
{
|
|
struct wacom *wacom = hid_get_drvdata(hdev);
|
|
struct wacom_features *features = &wacom->wacom_wac.features;
|
|
bool finger = WACOM_FINGER_FIELD(field);
|
|
bool pen = WACOM_PEN_FIELD(field);
|
|
|
|
/*
|
|
* Requiring Stylus Usage will ignore boot mouse
|
|
* X/Y values and some cases of invalid Digitizer X/Y
|
|
* values commonly reported.
|
|
*/
|
|
if (!pen && !finger)
|
|
return;
|
|
|
|
/*
|
|
* Bamboo models do not support HID_DG_CONTACTMAX.
|
|
* And, Bamboo Pen only descriptor contains touch.
|
|
*/
|
|
if (features->type != BAMBOO_PT) {
|
|
/* ISDv4 touch devices at least supports one touch point */
|
|
if (finger && !features->touch_max)
|
|
features->touch_max = 1;
|
|
}
|
|
|
|
switch (usage->hid) {
|
|
case HID_GD_X:
|
|
features->x_max = field->logical_maximum;
|
|
if (finger) {
|
|
features->device_type = BTN_TOOL_FINGER;
|
|
features->x_phy = field->physical_maximum;
|
|
if (features->type != BAMBOO_PT) {
|
|
features->unit = field->unit;
|
|
features->unitExpo = field->unit_exponent;
|
|
}
|
|
} else {
|
|
features->device_type = BTN_TOOL_PEN;
|
|
}
|
|
break;
|
|
case HID_GD_Y:
|
|
features->y_max = field->logical_maximum;
|
|
if (finger) {
|
|
features->y_phy = field->physical_maximum;
|
|
if (features->type != BAMBOO_PT) {
|
|
features->unit = field->unit;
|
|
features->unitExpo = field->unit_exponent;
|
|
}
|
|
}
|
|
break;
|
|
case HID_DG_TIPPRESSURE:
|
|
if (pen)
|
|
features->pressure_max = field->logical_maximum;
|
|
break;
|
|
}
|
|
|
|
if (features->type == HID_GENERIC)
|
|
wacom_wac_usage_mapping(hdev, field, usage);
|
|
}
|
|
|
|
static void wacom_post_parse_hid(struct hid_device *hdev,
|
|
struct wacom_features *features)
|
|
{
|
|
struct wacom *wacom = hid_get_drvdata(hdev);
|
|
struct wacom_wac *wacom_wac = &wacom->wacom_wac;
|
|
|
|
if (features->type == HID_GENERIC) {
|
|
/* Any last-minute generic device setup */
|
|
if (features->touch_max > 1) {
|
|
input_mt_init_slots(wacom_wac->input, wacom_wac->features.touch_max,
|
|
INPUT_MT_DIRECT);
|
|
}
|
|
}
|
|
}
|
|
|
|
static void wacom_parse_hid(struct hid_device *hdev,
|
|
struct wacom_features *features)
|
|
{
|
|
struct hid_report_enum *rep_enum;
|
|
struct hid_report *hreport;
|
|
int i, j;
|
|
|
|
/* check features first */
|
|
rep_enum = &hdev->report_enum[HID_FEATURE_REPORT];
|
|
list_for_each_entry(hreport, &rep_enum->report_list, list) {
|
|
for (i = 0; i < hreport->maxfield; i++) {
|
|
/* Ignore if report count is out of bounds. */
|
|
if (hreport->field[i]->report_count < 1)
|
|
continue;
|
|
|
|
for (j = 0; j < hreport->field[i]->maxusage; j++) {
|
|
wacom_feature_mapping(hdev, hreport->field[i],
|
|
hreport->field[i]->usage + j);
|
|
}
|
|
}
|
|
}
|
|
|
|
/* now check the input usages */
|
|
rep_enum = &hdev->report_enum[HID_INPUT_REPORT];
|
|
list_for_each_entry(hreport, &rep_enum->report_list, list) {
|
|
|
|
if (!hreport->maxfield)
|
|
continue;
|
|
|
|
for (i = 0; i < hreport->maxfield; i++)
|
|
for (j = 0; j < hreport->field[i]->maxusage; j++)
|
|
wacom_usage_mapping(hdev, hreport->field[i],
|
|
hreport->field[i]->usage + j);
|
|
}
|
|
|
|
wacom_post_parse_hid(hdev, features);
|
|
}
|
|
|
|
static int wacom_hid_set_device_mode(struct hid_device *hdev)
|
|
{
|
|
struct wacom *wacom = hid_get_drvdata(hdev);
|
|
struct hid_data *hid_data = &wacom->wacom_wac.hid_data;
|
|
struct hid_report *r;
|
|
struct hid_report_enum *re;
|
|
|
|
if (hid_data->inputmode < 0)
|
|
return 0;
|
|
|
|
re = &(hdev->report_enum[HID_FEATURE_REPORT]);
|
|
r = re->report_id_hash[hid_data->inputmode];
|
|
if (r) {
|
|
r->field[0]->value[hid_data->inputmode_index] = 2;
|
|
hid_hw_request(hdev, r, HID_REQ_SET_REPORT);
|
|
}
|
|
return 0;
|
|
}
|
|
|
|
static int wacom_set_device_mode(struct hid_device *hdev, int report_id,
|
|
int length, int mode)
|
|
{
|
|
unsigned char *rep_data;
|
|
int error = -ENOMEM, limit = 0;
|
|
|
|
rep_data = kzalloc(length, GFP_KERNEL);
|
|
if (!rep_data)
|
|
return error;
|
|
|
|
do {
|
|
rep_data[0] = report_id;
|
|
rep_data[1] = mode;
|
|
|
|
error = wacom_set_report(hdev, HID_FEATURE_REPORT, rep_data,
|
|
length, 1);
|
|
if (error >= 0)
|
|
error = wacom_get_report(hdev, HID_FEATURE_REPORT,
|
|
rep_data, length, 1);
|
|
} while ((error < 0 || rep_data[1] != mode) && limit++ < WAC_MSG_RETRIES);
|
|
|
|
kfree(rep_data);
|
|
|
|
return error < 0 ? error : 0;
|
|
}
|
|
|
|
static int wacom_bt_query_tablet_data(struct hid_device *hdev, u8 speed,
|
|
struct wacom_features *features)
|
|
{
|
|
struct wacom *wacom = hid_get_drvdata(hdev);
|
|
int ret;
|
|
u8 rep_data[2];
|
|
|
|
switch (features->type) {
|
|
case GRAPHIRE_BT:
|
|
rep_data[0] = 0x03;
|
|
rep_data[1] = 0x00;
|
|
ret = wacom_set_report(hdev, HID_FEATURE_REPORT, rep_data, 2,
|
|
3);
|
|
|
|
if (ret >= 0) {
|
|
rep_data[0] = speed == 0 ? 0x05 : 0x06;
|
|
rep_data[1] = 0x00;
|
|
|
|
ret = wacom_set_report(hdev, HID_FEATURE_REPORT,
|
|
rep_data, 2, 3);
|
|
|
|
if (ret >= 0) {
|
|
wacom->wacom_wac.bt_high_speed = speed;
|
|
return 0;
|
|
}
|
|
}
|
|
|
|
/*
|
|
* Note that if the raw queries fail, it's not a hard failure
|
|
* and it is safe to continue
|
|
*/
|
|
hid_warn(hdev, "failed to poke device, command %d, err %d\n",
|
|
rep_data[0], ret);
|
|
break;
|
|
case INTUOS4WL:
|
|
if (speed == 1)
|
|
wacom->wacom_wac.bt_features &= ~0x20;
|
|
else
|
|
wacom->wacom_wac.bt_features |= 0x20;
|
|
|
|
rep_data[0] = 0x03;
|
|
rep_data[1] = wacom->wacom_wac.bt_features;
|
|
|
|
ret = wacom_set_report(hdev, HID_FEATURE_REPORT, rep_data, 2,
|
|
1);
|
|
if (ret >= 0)
|
|
wacom->wacom_wac.bt_high_speed = speed;
|
|
break;
|
|
}
|
|
|
|
return 0;
|
|
}
|
|
|
|
/*
|
|
* Switch the tablet into its most-capable mode. Wacom tablets are
|
|
* typically configured to power-up in a mode which sends mouse-like
|
|
* reports to the OS. To get absolute position, pressure data, etc.
|
|
* from the tablet, it is necessary to switch the tablet out of this
|
|
* mode and into one which sends the full range of tablet data.
|
|
*/
|
|
static int wacom_query_tablet_data(struct hid_device *hdev,
|
|
struct wacom_features *features)
|
|
{
|
|
if (hdev->bus == BUS_BLUETOOTH)
|
|
return wacom_bt_query_tablet_data(hdev, 1, features);
|
|
|
|
if (features->type == HID_GENERIC)
|
|
return wacom_hid_set_device_mode(hdev);
|
|
|
|
if (features->device_type == BTN_TOOL_FINGER) {
|
|
if (features->type > TABLETPC) {
|
|
/* MT Tablet PC touch */
|
|
return wacom_set_device_mode(hdev, 3, 4, 4);
|
|
}
|
|
else if (features->type == WACOM_24HDT || features->type == CINTIQ_HYBRID) {
|
|
return wacom_set_device_mode(hdev, 18, 3, 2);
|
|
}
|
|
else if (features->type == WACOM_27QHDT) {
|
|
return wacom_set_device_mode(hdev, 131, 3, 2);
|
|
}
|
|
} else if (features->device_type == BTN_TOOL_PEN) {
|
|
if (features->type <= BAMBOO_PT && features->type != WIRELESS) {
|
|
return wacom_set_device_mode(hdev, 2, 2, 2);
|
|
}
|
|
}
|
|
|
|
return 0;
|
|
}
|
|
|
|
static void wacom_retrieve_hid_descriptor(struct hid_device *hdev,
|
|
struct wacom_features *features)
|
|
{
|
|
struct wacom *wacom = hid_get_drvdata(hdev);
|
|
struct usb_interface *intf = wacom->intf;
|
|
|
|
/* default features */
|
|
features->device_type = BTN_TOOL_PEN;
|
|
features->x_fuzz = 4;
|
|
features->y_fuzz = 4;
|
|
features->pressure_fuzz = 0;
|
|
features->distance_fuzz = 0;
|
|
|
|
/*
|
|
* The wireless device HID is basic and layout conflicts with
|
|
* other tablets (monitor and touch interface can look like pen).
|
|
* Skip the query for this type and modify defaults based on
|
|
* interface number.
|
|
*/
|
|
if (features->type == WIRELESS) {
|
|
if (intf->cur_altsetting->desc.bInterfaceNumber == 0) {
|
|
features->device_type = 0;
|
|
} else if (intf->cur_altsetting->desc.bInterfaceNumber == 2) {
|
|
features->device_type = BTN_TOOL_FINGER;
|
|
features->pktlen = WACOM_PKGLEN_BBTOUCH3;
|
|
}
|
|
}
|
|
|
|
/* only devices that support touch need to retrieve the info */
|
|
if (features->type < BAMBOO_PT)
|
|
return;
|
|
|
|
wacom_parse_hid(hdev, features);
|
|
}
|
|
|
|
struct wacom_hdev_data {
|
|
struct list_head list;
|
|
struct kref kref;
|
|
struct hid_device *dev;
|
|
struct wacom_shared shared;
|
|
};
|
|
|
|
static LIST_HEAD(wacom_udev_list);
|
|
static DEFINE_MUTEX(wacom_udev_list_lock);
|
|
|
|
static bool wacom_are_sibling(struct hid_device *hdev,
|
|
struct hid_device *sibling)
|
|
{
|
|
struct wacom *wacom = hid_get_drvdata(hdev);
|
|
struct wacom_features *features = &wacom->wacom_wac.features;
|
|
int vid = features->oVid;
|
|
int pid = features->oPid;
|
|
int n1,n2;
|
|
|
|
if (vid == 0 && pid == 0) {
|
|
vid = hdev->vendor;
|
|
pid = hdev->product;
|
|
}
|
|
|
|
if (vid != sibling->vendor || pid != sibling->product)
|
|
return false;
|
|
|
|
/* Compare the physical path. */
|
|
n1 = strrchr(hdev->phys, '.') - hdev->phys;
|
|
n2 = strrchr(sibling->phys, '.') - sibling->phys;
|
|
if (n1 != n2 || n1 <= 0 || n2 <= 0)
|
|
return false;
|
|
|
|
return !strncmp(hdev->phys, sibling->phys, n1);
|
|
}
|
|
|
|
static struct wacom_hdev_data *wacom_get_hdev_data(struct hid_device *hdev)
|
|
{
|
|
struct wacom_hdev_data *data;
|
|
|
|
list_for_each_entry(data, &wacom_udev_list, list) {
|
|
if (wacom_are_sibling(hdev, data->dev)) {
|
|
kref_get(&data->kref);
|
|
return data;
|
|
}
|
|
}
|
|
|
|
return NULL;
|
|
}
|
|
|
|
static int wacom_add_shared_data(struct hid_device *hdev)
|
|
{
|
|
struct wacom *wacom = hid_get_drvdata(hdev);
|
|
struct wacom_wac *wacom_wac = &wacom->wacom_wac;
|
|
struct wacom_hdev_data *data;
|
|
int retval = 0;
|
|
|
|
mutex_lock(&wacom_udev_list_lock);
|
|
|
|
data = wacom_get_hdev_data(hdev);
|
|
if (!data) {
|
|
data = kzalloc(sizeof(struct wacom_hdev_data), GFP_KERNEL);
|
|
if (!data) {
|
|
retval = -ENOMEM;
|
|
goto out;
|
|
}
|
|
|
|
kref_init(&data->kref);
|
|
data->dev = hdev;
|
|
list_add_tail(&data->list, &wacom_udev_list);
|
|
}
|
|
|
|
wacom_wac->shared = &data->shared;
|
|
|
|
out:
|
|
mutex_unlock(&wacom_udev_list_lock);
|
|
return retval;
|
|
}
|
|
|
|
static void wacom_release_shared_data(struct kref *kref)
|
|
{
|
|
struct wacom_hdev_data *data =
|
|
container_of(kref, struct wacom_hdev_data, kref);
|
|
|
|
mutex_lock(&wacom_udev_list_lock);
|
|
list_del(&data->list);
|
|
mutex_unlock(&wacom_udev_list_lock);
|
|
|
|
kfree(data);
|
|
}
|
|
|
|
static void wacom_remove_shared_data(struct wacom_wac *wacom)
|
|
{
|
|
struct wacom_hdev_data *data;
|
|
|
|
if (wacom->shared) {
|
|
data = container_of(wacom->shared, struct wacom_hdev_data, shared);
|
|
kref_put(&data->kref, wacom_release_shared_data);
|
|
wacom->shared = NULL;
|
|
}
|
|
}
|
|
|
|
static int wacom_led_control(struct wacom *wacom)
|
|
{
|
|
unsigned char *buf;
|
|
int retval;
|
|
unsigned char report_id = WAC_CMD_LED_CONTROL;
|
|
int buf_size = 9;
|
|
|
|
if (wacom->wacom_wac.pid) { /* wireless connected */
|
|
report_id = WAC_CMD_WL_LED_CONTROL;
|
|
buf_size = 13;
|
|
}
|
|
buf = kzalloc(buf_size, GFP_KERNEL);
|
|
if (!buf)
|
|
return -ENOMEM;
|
|
|
|
if (wacom->wacom_wac.features.type >= INTUOS5S &&
|
|
wacom->wacom_wac.features.type <= INTUOSPL) {
|
|
/*
|
|
* Touch Ring and crop mark LED luminance may take on
|
|
* one of four values:
|
|
* 0 = Low; 1 = Medium; 2 = High; 3 = Off
|
|
*/
|
|
int ring_led = wacom->led.select[0] & 0x03;
|
|
int ring_lum = (((wacom->led.llv & 0x60) >> 5) - 1) & 0x03;
|
|
int crop_lum = 0;
|
|
unsigned char led_bits = (crop_lum << 4) | (ring_lum << 2) | (ring_led);
|
|
|
|
buf[0] = report_id;
|
|
if (wacom->wacom_wac.pid) {
|
|
wacom_get_report(wacom->hdev, HID_FEATURE_REPORT,
|
|
buf, buf_size, WAC_CMD_RETRIES);
|
|
buf[0] = report_id;
|
|
buf[4] = led_bits;
|
|
} else
|
|
buf[1] = led_bits;
|
|
}
|
|
else {
|
|
int led = wacom->led.select[0] | 0x4;
|
|
|
|
if (wacom->wacom_wac.features.type == WACOM_21UX2 ||
|
|
wacom->wacom_wac.features.type == WACOM_24HD)
|
|
led |= (wacom->led.select[1] << 4) | 0x40;
|
|
|
|
buf[0] = report_id;
|
|
buf[1] = led;
|
|
buf[2] = wacom->led.llv;
|
|
buf[3] = wacom->led.hlv;
|
|
buf[4] = wacom->led.img_lum;
|
|
}
|
|
|
|
retval = wacom_set_report(wacom->hdev, HID_FEATURE_REPORT, buf, buf_size,
|
|
WAC_CMD_RETRIES);
|
|
kfree(buf);
|
|
|
|
return retval;
|
|
}
|
|
|
|
static int wacom_led_putimage(struct wacom *wacom, int button_id, u8 xfer_id,
|
|
const unsigned len, const void *img)
|
|
{
|
|
unsigned char *buf;
|
|
int i, retval;
|
|
const unsigned chunk_len = len / 4; /* 4 chunks are needed to be sent */
|
|
|
|
buf = kzalloc(chunk_len + 3 , GFP_KERNEL);
|
|
if (!buf)
|
|
return -ENOMEM;
|
|
|
|
/* Send 'start' command */
|
|
buf[0] = WAC_CMD_ICON_START;
|
|
buf[1] = 1;
|
|
retval = wacom_set_report(wacom->hdev, HID_FEATURE_REPORT, buf, 2,
|
|
WAC_CMD_RETRIES);
|
|
if (retval < 0)
|
|
goto out;
|
|
|
|
buf[0] = xfer_id;
|
|
buf[1] = button_id & 0x07;
|
|
for (i = 0; i < 4; i++) {
|
|
buf[2] = i;
|
|
memcpy(buf + 3, img + i * chunk_len, chunk_len);
|
|
|
|
retval = wacom_set_report(wacom->hdev, HID_FEATURE_REPORT,
|
|
buf, chunk_len + 3, WAC_CMD_RETRIES);
|
|
if (retval < 0)
|
|
break;
|
|
}
|
|
|
|
/* Send 'stop' */
|
|
buf[0] = WAC_CMD_ICON_START;
|
|
buf[1] = 0;
|
|
wacom_set_report(wacom->hdev, HID_FEATURE_REPORT, buf, 2,
|
|
WAC_CMD_RETRIES);
|
|
|
|
out:
|
|
kfree(buf);
|
|
return retval;
|
|
}
|
|
|
|
static ssize_t wacom_led_select_store(struct device *dev, int set_id,
|
|
const char *buf, size_t count)
|
|
{
|
|
struct hid_device *hdev = container_of(dev, struct hid_device, dev);
|
|
struct wacom *wacom = hid_get_drvdata(hdev);
|
|
unsigned int id;
|
|
int err;
|
|
|
|
err = kstrtouint(buf, 10, &id);
|
|
if (err)
|
|
return err;
|
|
|
|
mutex_lock(&wacom->lock);
|
|
|
|
wacom->led.select[set_id] = id & 0x3;
|
|
err = wacom_led_control(wacom);
|
|
|
|
mutex_unlock(&wacom->lock);
|
|
|
|
return err < 0 ? err : count;
|
|
}
|
|
|
|
#define DEVICE_LED_SELECT_ATTR(SET_ID) \
|
|
static ssize_t wacom_led##SET_ID##_select_store(struct device *dev, \
|
|
struct device_attribute *attr, const char *buf, size_t count) \
|
|
{ \
|
|
return wacom_led_select_store(dev, SET_ID, buf, count); \
|
|
} \
|
|
static ssize_t wacom_led##SET_ID##_select_show(struct device *dev, \
|
|
struct device_attribute *attr, char *buf) \
|
|
{ \
|
|
struct hid_device *hdev = container_of(dev, struct hid_device, dev);\
|
|
struct wacom *wacom = hid_get_drvdata(hdev); \
|
|
return scnprintf(buf, PAGE_SIZE, "%d\n", \
|
|
wacom->led.select[SET_ID]); \
|
|
} \
|
|
static DEVICE_ATTR(status_led##SET_ID##_select, DEV_ATTR_RW_PERM, \
|
|
wacom_led##SET_ID##_select_show, \
|
|
wacom_led##SET_ID##_select_store)
|
|
|
|
DEVICE_LED_SELECT_ATTR(0);
|
|
DEVICE_LED_SELECT_ATTR(1);
|
|
|
|
static ssize_t wacom_luminance_store(struct wacom *wacom, u8 *dest,
|
|
const char *buf, size_t count)
|
|
{
|
|
unsigned int value;
|
|
int err;
|
|
|
|
err = kstrtouint(buf, 10, &value);
|
|
if (err)
|
|
return err;
|
|
|
|
mutex_lock(&wacom->lock);
|
|
|
|
*dest = value & 0x7f;
|
|
err = wacom_led_control(wacom);
|
|
|
|
mutex_unlock(&wacom->lock);
|
|
|
|
return err < 0 ? err : count;
|
|
}
|
|
|
|
#define DEVICE_LUMINANCE_ATTR(name, field) \
|
|
static ssize_t wacom_##name##_luminance_store(struct device *dev, \
|
|
struct device_attribute *attr, const char *buf, size_t count) \
|
|
{ \
|
|
struct hid_device *hdev = container_of(dev, struct hid_device, dev);\
|
|
struct wacom *wacom = hid_get_drvdata(hdev); \
|
|
\
|
|
return wacom_luminance_store(wacom, &wacom->led.field, \
|
|
buf, count); \
|
|
} \
|
|
static ssize_t wacom_##name##_luminance_show(struct device *dev, \
|
|
struct device_attribute *attr, char *buf) \
|
|
{ \
|
|
struct wacom *wacom = dev_get_drvdata(dev); \
|
|
return scnprintf(buf, PAGE_SIZE, "%d\n", wacom->led.field); \
|
|
} \
|
|
static DEVICE_ATTR(name##_luminance, DEV_ATTR_RW_PERM, \
|
|
wacom_##name##_luminance_show, \
|
|
wacom_##name##_luminance_store)
|
|
|
|
DEVICE_LUMINANCE_ATTR(status0, llv);
|
|
DEVICE_LUMINANCE_ATTR(status1, hlv);
|
|
DEVICE_LUMINANCE_ATTR(buttons, img_lum);
|
|
|
|
static ssize_t wacom_button_image_store(struct device *dev, int button_id,
|
|
const char *buf, size_t count)
|
|
{
|
|
struct hid_device *hdev = container_of(dev, struct hid_device, dev);
|
|
struct wacom *wacom = hid_get_drvdata(hdev);
|
|
int err;
|
|
unsigned len;
|
|
u8 xfer_id;
|
|
|
|
if (hdev->bus == BUS_BLUETOOTH) {
|
|
len = 256;
|
|
xfer_id = WAC_CMD_ICON_BT_XFER;
|
|
} else {
|
|
len = 1024;
|
|
xfer_id = WAC_CMD_ICON_XFER;
|
|
}
|
|
|
|
if (count != len)
|
|
return -EINVAL;
|
|
|
|
mutex_lock(&wacom->lock);
|
|
|
|
err = wacom_led_putimage(wacom, button_id, xfer_id, len, buf);
|
|
|
|
mutex_unlock(&wacom->lock);
|
|
|
|
return err < 0 ? err : count;
|
|
}
|
|
|
|
#define DEVICE_BTNIMG_ATTR(BUTTON_ID) \
|
|
static ssize_t wacom_btnimg##BUTTON_ID##_store(struct device *dev, \
|
|
struct device_attribute *attr, const char *buf, size_t count) \
|
|
{ \
|
|
return wacom_button_image_store(dev, BUTTON_ID, buf, count); \
|
|
} \
|
|
static DEVICE_ATTR(button##BUTTON_ID##_rawimg, DEV_ATTR_WO_PERM, \
|
|
NULL, wacom_btnimg##BUTTON_ID##_store)
|
|
|
|
DEVICE_BTNIMG_ATTR(0);
|
|
DEVICE_BTNIMG_ATTR(1);
|
|
DEVICE_BTNIMG_ATTR(2);
|
|
DEVICE_BTNIMG_ATTR(3);
|
|
DEVICE_BTNIMG_ATTR(4);
|
|
DEVICE_BTNIMG_ATTR(5);
|
|
DEVICE_BTNIMG_ATTR(6);
|
|
DEVICE_BTNIMG_ATTR(7);
|
|
|
|
static struct attribute *cintiq_led_attrs[] = {
|
|
&dev_attr_status_led0_select.attr,
|
|
&dev_attr_status_led1_select.attr,
|
|
NULL
|
|
};
|
|
|
|
static struct attribute_group cintiq_led_attr_group = {
|
|
.name = "wacom_led",
|
|
.attrs = cintiq_led_attrs,
|
|
};
|
|
|
|
static struct attribute *intuos4_led_attrs[] = {
|
|
&dev_attr_status0_luminance.attr,
|
|
&dev_attr_status1_luminance.attr,
|
|
&dev_attr_status_led0_select.attr,
|
|
&dev_attr_buttons_luminance.attr,
|
|
&dev_attr_button0_rawimg.attr,
|
|
&dev_attr_button1_rawimg.attr,
|
|
&dev_attr_button2_rawimg.attr,
|
|
&dev_attr_button3_rawimg.attr,
|
|
&dev_attr_button4_rawimg.attr,
|
|
&dev_attr_button5_rawimg.attr,
|
|
&dev_attr_button6_rawimg.attr,
|
|
&dev_attr_button7_rawimg.attr,
|
|
NULL
|
|
};
|
|
|
|
static struct attribute_group intuos4_led_attr_group = {
|
|
.name = "wacom_led",
|
|
.attrs = intuos4_led_attrs,
|
|
};
|
|
|
|
static struct attribute *intuos5_led_attrs[] = {
|
|
&dev_attr_status0_luminance.attr,
|
|
&dev_attr_status_led0_select.attr,
|
|
NULL
|
|
};
|
|
|
|
static struct attribute_group intuos5_led_attr_group = {
|
|
.name = "wacom_led",
|
|
.attrs = intuos5_led_attrs,
|
|
};
|
|
|
|
static int wacom_initialize_leds(struct wacom *wacom)
|
|
{
|
|
int error;
|
|
|
|
/* Initialize default values */
|
|
switch (wacom->wacom_wac.features.type) {
|
|
case INTUOS4S:
|
|
case INTUOS4:
|
|
case INTUOS4WL:
|
|
case INTUOS4L:
|
|
wacom->led.select[0] = 0;
|
|
wacom->led.select[1] = 0;
|
|
wacom->led.llv = 10;
|
|
wacom->led.hlv = 20;
|
|
wacom->led.img_lum = 10;
|
|
error = sysfs_create_group(&wacom->hdev->dev.kobj,
|
|
&intuos4_led_attr_group);
|
|
break;
|
|
|
|
case WACOM_24HD:
|
|
case WACOM_21UX2:
|
|
wacom->led.select[0] = 0;
|
|
wacom->led.select[1] = 0;
|
|
wacom->led.llv = 0;
|
|
wacom->led.hlv = 0;
|
|
wacom->led.img_lum = 0;
|
|
|
|
error = sysfs_create_group(&wacom->hdev->dev.kobj,
|
|
&cintiq_led_attr_group);
|
|
break;
|
|
|
|
case INTUOS5S:
|
|
case INTUOS5:
|
|
case INTUOS5L:
|
|
case INTUOSPS:
|
|
case INTUOSPM:
|
|
case INTUOSPL:
|
|
if (wacom->wacom_wac.features.device_type == BTN_TOOL_PEN) {
|
|
wacom->led.select[0] = 0;
|
|
wacom->led.select[1] = 0;
|
|
wacom->led.llv = 32;
|
|
wacom->led.hlv = 0;
|
|
wacom->led.img_lum = 0;
|
|
|
|
error = sysfs_create_group(&wacom->hdev->dev.kobj,
|
|
&intuos5_led_attr_group);
|
|
} else
|
|
return 0;
|
|
break;
|
|
|
|
default:
|
|
return 0;
|
|
}
|
|
|
|
if (error) {
|
|
hid_err(wacom->hdev,
|
|
"cannot create sysfs group err: %d\n", error);
|
|
return error;
|
|
}
|
|
wacom_led_control(wacom);
|
|
wacom->led_initialized = true;
|
|
|
|
return 0;
|
|
}
|
|
|
|
static void wacom_destroy_leds(struct wacom *wacom)
|
|
{
|
|
if (!wacom->led_initialized)
|
|
return;
|
|
|
|
wacom->led_initialized = false;
|
|
|
|
switch (wacom->wacom_wac.features.type) {
|
|
case INTUOS4S:
|
|
case INTUOS4:
|
|
case INTUOS4WL:
|
|
case INTUOS4L:
|
|
sysfs_remove_group(&wacom->hdev->dev.kobj,
|
|
&intuos4_led_attr_group);
|
|
break;
|
|
|
|
case WACOM_24HD:
|
|
case WACOM_21UX2:
|
|
sysfs_remove_group(&wacom->hdev->dev.kobj,
|
|
&cintiq_led_attr_group);
|
|
break;
|
|
|
|
case INTUOS5S:
|
|
case INTUOS5:
|
|
case INTUOS5L:
|
|
case INTUOSPS:
|
|
case INTUOSPM:
|
|
case INTUOSPL:
|
|
if (wacom->wacom_wac.features.device_type == BTN_TOOL_PEN)
|
|
sysfs_remove_group(&wacom->hdev->dev.kobj,
|
|
&intuos5_led_attr_group);
|
|
break;
|
|
}
|
|
}
|
|
|
|
static enum power_supply_property wacom_battery_props[] = {
|
|
POWER_SUPPLY_PROP_STATUS,
|
|
POWER_SUPPLY_PROP_SCOPE,
|
|
POWER_SUPPLY_PROP_CAPACITY
|
|
};
|
|
|
|
static enum power_supply_property wacom_ac_props[] = {
|
|
POWER_SUPPLY_PROP_PRESENT,
|
|
POWER_SUPPLY_PROP_ONLINE,
|
|
POWER_SUPPLY_PROP_SCOPE,
|
|
};
|
|
|
|
static int wacom_battery_get_property(struct power_supply *psy,
|
|
enum power_supply_property psp,
|
|
union power_supply_propval *val)
|
|
{
|
|
struct wacom *wacom = power_supply_get_drvdata(psy);
|
|
int ret = 0;
|
|
|
|
switch (psp) {
|
|
case POWER_SUPPLY_PROP_SCOPE:
|
|
val->intval = POWER_SUPPLY_SCOPE_DEVICE;
|
|
break;
|
|
case POWER_SUPPLY_PROP_CAPACITY:
|
|
val->intval =
|
|
wacom->wacom_wac.battery_capacity;
|
|
break;
|
|
case POWER_SUPPLY_PROP_STATUS:
|
|
if (wacom->wacom_wac.bat_charging)
|
|
val->intval = POWER_SUPPLY_STATUS_CHARGING;
|
|
else if (wacom->wacom_wac.battery_capacity == 100 &&
|
|
wacom->wacom_wac.ps_connected)
|
|
val->intval = POWER_SUPPLY_STATUS_FULL;
|
|
else
|
|
val->intval = POWER_SUPPLY_STATUS_DISCHARGING;
|
|
break;
|
|
default:
|
|
ret = -EINVAL;
|
|
break;
|
|
}
|
|
|
|
return ret;
|
|
}
|
|
|
|
static int wacom_ac_get_property(struct power_supply *psy,
|
|
enum power_supply_property psp,
|
|
union power_supply_propval *val)
|
|
{
|
|
struct wacom *wacom = power_supply_get_drvdata(psy);
|
|
int ret = 0;
|
|
|
|
switch (psp) {
|
|
case POWER_SUPPLY_PROP_PRESENT:
|
|
/* fall through */
|
|
case POWER_SUPPLY_PROP_ONLINE:
|
|
val->intval = wacom->wacom_wac.ps_connected;
|
|
break;
|
|
case POWER_SUPPLY_PROP_SCOPE:
|
|
val->intval = POWER_SUPPLY_SCOPE_DEVICE;
|
|
break;
|
|
default:
|
|
ret = -EINVAL;
|
|
break;
|
|
}
|
|
return ret;
|
|
}
|
|
|
|
static int wacom_initialize_battery(struct wacom *wacom)
|
|
{
|
|
static atomic_t battery_no = ATOMIC_INIT(0);
|
|
struct power_supply_config psy_cfg = { .drv_data = wacom, };
|
|
unsigned long n;
|
|
|
|
if (wacom->wacom_wac.features.quirks & WACOM_QUIRK_BATTERY) {
|
|
struct power_supply_desc *bat_desc = &wacom->battery_desc;
|
|
struct power_supply_desc *ac_desc = &wacom->ac_desc;
|
|
n = atomic_inc_return(&battery_no) - 1;
|
|
|
|
bat_desc->properties = wacom_battery_props;
|
|
bat_desc->num_properties = ARRAY_SIZE(wacom_battery_props);
|
|
bat_desc->get_property = wacom_battery_get_property;
|
|
sprintf(wacom->wacom_wac.bat_name, "wacom_battery_%ld", n);
|
|
bat_desc->name = wacom->wacom_wac.bat_name;
|
|
bat_desc->type = POWER_SUPPLY_TYPE_BATTERY;
|
|
bat_desc->use_for_apm = 0;
|
|
|
|
ac_desc->properties = wacom_ac_props;
|
|
ac_desc->num_properties = ARRAY_SIZE(wacom_ac_props);
|
|
ac_desc->get_property = wacom_ac_get_property;
|
|
sprintf(wacom->wacom_wac.ac_name, "wacom_ac_%ld", n);
|
|
ac_desc->name = wacom->wacom_wac.ac_name;
|
|
ac_desc->type = POWER_SUPPLY_TYPE_MAINS;
|
|
ac_desc->use_for_apm = 0;
|
|
|
|
wacom->battery = power_supply_register(&wacom->hdev->dev,
|
|
&wacom->battery_desc, &psy_cfg);
|
|
if (IS_ERR(wacom->battery))
|
|
return PTR_ERR(wacom->battery);
|
|
|
|
power_supply_powers(wacom->battery, &wacom->hdev->dev);
|
|
|
|
wacom->ac = power_supply_register(&wacom->hdev->dev,
|
|
&wacom->ac_desc,
|
|
&psy_cfg);
|
|
if (IS_ERR(wacom->ac)) {
|
|
power_supply_unregister(wacom->battery);
|
|
return PTR_ERR(wacom->ac);
|
|
}
|
|
|
|
power_supply_powers(wacom->ac, &wacom->hdev->dev);
|
|
}
|
|
|
|
return 0;
|
|
}
|
|
|
|
static void wacom_destroy_battery(struct wacom *wacom)
|
|
{
|
|
if ((wacom->wacom_wac.features.quirks & WACOM_QUIRK_BATTERY) &&
|
|
wacom->battery) {
|
|
power_supply_unregister(wacom->battery);
|
|
wacom->battery = NULL;
|
|
power_supply_unregister(wacom->ac);
|
|
wacom->ac = NULL;
|
|
}
|
|
}
|
|
|
|
static ssize_t wacom_show_speed(struct device *dev,
|
|
struct device_attribute
|
|
*attr, char *buf)
|
|
{
|
|
struct hid_device *hdev = container_of(dev, struct hid_device, dev);
|
|
struct wacom *wacom = hid_get_drvdata(hdev);
|
|
|
|
return snprintf(buf, PAGE_SIZE, "%i\n", wacom->wacom_wac.bt_high_speed);
|
|
}
|
|
|
|
static ssize_t wacom_store_speed(struct device *dev,
|
|
struct device_attribute *attr,
|
|
const char *buf, size_t count)
|
|
{
|
|
struct hid_device *hdev = container_of(dev, struct hid_device, dev);
|
|
struct wacom *wacom = hid_get_drvdata(hdev);
|
|
u8 new_speed;
|
|
|
|
if (kstrtou8(buf, 0, &new_speed))
|
|
return -EINVAL;
|
|
|
|
if (new_speed != 0 && new_speed != 1)
|
|
return -EINVAL;
|
|
|
|
wacom_bt_query_tablet_data(hdev, new_speed, &wacom->wacom_wac.features);
|
|
|
|
return count;
|
|
}
|
|
|
|
static DEVICE_ATTR(speed, DEV_ATTR_RW_PERM,
|
|
wacom_show_speed, wacom_store_speed);
|
|
|
|
static struct input_dev *wacom_allocate_input(struct wacom *wacom)
|
|
{
|
|
struct input_dev *input_dev;
|
|
struct hid_device *hdev = wacom->hdev;
|
|
struct wacom_wac *wacom_wac = &(wacom->wacom_wac);
|
|
|
|
input_dev = input_allocate_device();
|
|
if (!input_dev)
|
|
return NULL;
|
|
|
|
input_dev->name = wacom_wac->name;
|
|
input_dev->phys = hdev->phys;
|
|
input_dev->dev.parent = &hdev->dev;
|
|
input_dev->open = wacom_open;
|
|
input_dev->close = wacom_close;
|
|
input_dev->uniq = hdev->uniq;
|
|
input_dev->id.bustype = hdev->bus;
|
|
input_dev->id.vendor = hdev->vendor;
|
|
input_dev->id.product = wacom_wac->pid ? wacom_wac->pid : hdev->product;
|
|
input_dev->id.version = hdev->version;
|
|
input_set_drvdata(input_dev, wacom);
|
|
|
|
return input_dev;
|
|
}
|
|
|
|
static void wacom_free_inputs(struct wacom *wacom)
|
|
{
|
|
struct wacom_wac *wacom_wac = &(wacom->wacom_wac);
|
|
|
|
if (wacom_wac->input)
|
|
input_free_device(wacom_wac->input);
|
|
if (wacom_wac->pad_input)
|
|
input_free_device(wacom_wac->pad_input);
|
|
wacom_wac->input = NULL;
|
|
wacom_wac->pad_input = NULL;
|
|
}
|
|
|
|
static int wacom_allocate_inputs(struct wacom *wacom)
|
|
{
|
|
struct input_dev *input_dev, *pad_input_dev;
|
|
struct wacom_wac *wacom_wac = &(wacom->wacom_wac);
|
|
|
|
input_dev = wacom_allocate_input(wacom);
|
|
pad_input_dev = wacom_allocate_input(wacom);
|
|
if (!input_dev || !pad_input_dev) {
|
|
wacom_free_inputs(wacom);
|
|
return -ENOMEM;
|
|
}
|
|
|
|
wacom_wac->input = input_dev;
|
|
wacom_wac->pad_input = pad_input_dev;
|
|
wacom_wac->pad_input->name = wacom_wac->pad_name;
|
|
|
|
return 0;
|
|
}
|
|
|
|
static void wacom_clean_inputs(struct wacom *wacom)
|
|
{
|
|
if (wacom->wacom_wac.input) {
|
|
if (wacom->wacom_wac.input_registered)
|
|
input_unregister_device(wacom->wacom_wac.input);
|
|
else
|
|
input_free_device(wacom->wacom_wac.input);
|
|
}
|
|
if (wacom->wacom_wac.pad_input) {
|
|
if (wacom->wacom_wac.pad_registered)
|
|
input_unregister_device(wacom->wacom_wac.pad_input);
|
|
else
|
|
input_free_device(wacom->wacom_wac.pad_input);
|
|
}
|
|
wacom->wacom_wac.input = NULL;
|
|
wacom->wacom_wac.pad_input = NULL;
|
|
wacom_destroy_leds(wacom);
|
|
}
|
|
|
|
static int wacom_register_inputs(struct wacom *wacom)
|
|
{
|
|
struct input_dev *input_dev, *pad_input_dev;
|
|
struct wacom_wac *wacom_wac = &(wacom->wacom_wac);
|
|
int error;
|
|
|
|
input_dev = wacom_wac->input;
|
|
pad_input_dev = wacom_wac->pad_input;
|
|
|
|
if (!input_dev || !pad_input_dev)
|
|
return -EINVAL;
|
|
|
|
error = wacom_setup_pentouch_input_capabilities(input_dev, wacom_wac);
|
|
if (!error) {
|
|
error = input_register_device(input_dev);
|
|
if (error)
|
|
return error;
|
|
wacom_wac->input_registered = true;
|
|
}
|
|
|
|
error = wacom_setup_pad_input_capabilities(pad_input_dev, wacom_wac);
|
|
if (error) {
|
|
/* no pad in use on this interface */
|
|
input_free_device(pad_input_dev);
|
|
wacom_wac->pad_input = NULL;
|
|
pad_input_dev = NULL;
|
|
} else {
|
|
error = input_register_device(pad_input_dev);
|
|
if (error)
|
|
goto fail_register_pad_input;
|
|
wacom_wac->pad_registered = true;
|
|
|
|
error = wacom_initialize_leds(wacom);
|
|
if (error)
|
|
goto fail_leds;
|
|
}
|
|
|
|
return 0;
|
|
|
|
fail_leds:
|
|
input_unregister_device(pad_input_dev);
|
|
pad_input_dev = NULL;
|
|
wacom_wac->pad_registered = false;
|
|
fail_register_pad_input:
|
|
input_unregister_device(input_dev);
|
|
wacom_wac->input = NULL;
|
|
wacom_wac->input_registered = false;
|
|
return error;
|
|
}
|
|
|
|
static void wacom_wireless_work(struct work_struct *work)
|
|
{
|
|
struct wacom *wacom = container_of(work, struct wacom, work);
|
|
struct usb_device *usbdev = wacom->usbdev;
|
|
struct wacom_wac *wacom_wac = &wacom->wacom_wac;
|
|
struct hid_device *hdev1, *hdev2;
|
|
struct wacom *wacom1, *wacom2;
|
|
struct wacom_wac *wacom_wac1, *wacom_wac2;
|
|
int error;
|
|
|
|
/*
|
|
* Regardless if this is a disconnect or a new tablet,
|
|
* remove any existing input and battery devices.
|
|
*/
|
|
|
|
wacom_destroy_battery(wacom);
|
|
|
|
/* Stylus interface */
|
|
hdev1 = usb_get_intfdata(usbdev->config->interface[1]);
|
|
wacom1 = hid_get_drvdata(hdev1);
|
|
wacom_wac1 = &(wacom1->wacom_wac);
|
|
wacom_clean_inputs(wacom1);
|
|
|
|
/* Touch interface */
|
|
hdev2 = usb_get_intfdata(usbdev->config->interface[2]);
|
|
wacom2 = hid_get_drvdata(hdev2);
|
|
wacom_wac2 = &(wacom2->wacom_wac);
|
|
wacom_clean_inputs(wacom2);
|
|
|
|
if (wacom_wac->pid == 0) {
|
|
hid_info(wacom->hdev, "wireless tablet disconnected\n");
|
|
wacom_wac1->shared->type = 0;
|
|
} else {
|
|
const struct hid_device_id *id = wacom_ids;
|
|
|
|
hid_info(wacom->hdev, "wireless tablet connected with PID %x\n",
|
|
wacom_wac->pid);
|
|
|
|
while (id->bus) {
|
|
if (id->vendor == USB_VENDOR_ID_WACOM &&
|
|
id->product == wacom_wac->pid)
|
|
break;
|
|
id++;
|
|
}
|
|
|
|
if (!id->bus) {
|
|
hid_info(wacom->hdev, "ignoring unknown PID.\n");
|
|
return;
|
|
}
|
|
|
|
/* Stylus interface */
|
|
wacom_wac1->features =
|
|
*((struct wacom_features *)id->driver_data);
|
|
wacom_wac1->features.device_type = BTN_TOOL_PEN;
|
|
snprintf(wacom_wac1->name, WACOM_NAME_MAX, "%s (WL) Pen",
|
|
wacom_wac1->features.name);
|
|
snprintf(wacom_wac1->pad_name, WACOM_NAME_MAX, "%s (WL) Pad",
|
|
wacom_wac1->features.name);
|
|
wacom_wac1->shared->touch_max = wacom_wac1->features.touch_max;
|
|
wacom_wac1->shared->type = wacom_wac1->features.type;
|
|
wacom_wac1->pid = wacom_wac->pid;
|
|
error = wacom_allocate_inputs(wacom1) ||
|
|
wacom_register_inputs(wacom1);
|
|
if (error)
|
|
goto fail;
|
|
|
|
/* Touch interface */
|
|
if (wacom_wac1->features.touch_max ||
|
|
wacom_wac1->features.type == INTUOSHT) {
|
|
wacom_wac2->features =
|
|
*((struct wacom_features *)id->driver_data);
|
|
wacom_wac2->features.pktlen = WACOM_PKGLEN_BBTOUCH3;
|
|
wacom_wac2->features.device_type = BTN_TOOL_FINGER;
|
|
wacom_wac2->features.x_max = wacom_wac2->features.y_max = 4096;
|
|
if (wacom_wac2->features.touch_max)
|
|
snprintf(wacom_wac2->name, WACOM_NAME_MAX,
|
|
"%s (WL) Finger",wacom_wac2->features.name);
|
|
else
|
|
snprintf(wacom_wac2->name, WACOM_NAME_MAX,
|
|
"%s (WL) Pad",wacom_wac2->features.name);
|
|
snprintf(wacom_wac2->pad_name, WACOM_NAME_MAX,
|
|
"%s (WL) Pad", wacom_wac2->features.name);
|
|
wacom_wac2->pid = wacom_wac->pid;
|
|
error = wacom_allocate_inputs(wacom2) ||
|
|
wacom_register_inputs(wacom2);
|
|
if (error)
|
|
goto fail;
|
|
|
|
if (wacom_wac1->features.type == INTUOSHT &&
|
|
wacom_wac1->features.touch_max)
|
|
wacom_wac->shared->touch_input = wacom_wac2->input;
|
|
}
|
|
|
|
error = wacom_initialize_battery(wacom);
|
|
if (error)
|
|
goto fail;
|
|
}
|
|
|
|
return;
|
|
|
|
fail:
|
|
wacom_clean_inputs(wacom1);
|
|
wacom_clean_inputs(wacom2);
|
|
return;
|
|
}
|
|
|
|
/*
|
|
* Not all devices report physical dimensions from HID.
|
|
* Compute the default from hardcoded logical dimension
|
|
* and resolution before driver overwrites them.
|
|
*/
|
|
static void wacom_set_default_phy(struct wacom_features *features)
|
|
{
|
|
if (features->x_resolution) {
|
|
features->x_phy = (features->x_max * 100) /
|
|
features->x_resolution;
|
|
features->y_phy = (features->y_max * 100) /
|
|
features->y_resolution;
|
|
}
|
|
}
|
|
|
|
static void wacom_calculate_res(struct wacom_features *features)
|
|
{
|
|
features->x_resolution = wacom_calc_hid_res(features->x_max,
|
|
features->x_phy,
|
|
features->unit,
|
|
features->unitExpo);
|
|
features->y_resolution = wacom_calc_hid_res(features->y_max,
|
|
features->y_phy,
|
|
features->unit,
|
|
features->unitExpo);
|
|
}
|
|
|
|
static size_t wacom_compute_pktlen(struct hid_device *hdev)
|
|
{
|
|
struct hid_report_enum *report_enum;
|
|
struct hid_report *report;
|
|
size_t size = 0;
|
|
|
|
report_enum = hdev->report_enum + HID_INPUT_REPORT;
|
|
|
|
list_for_each_entry(report, &report_enum->report_list, list) {
|
|
size_t report_size = hid_report_len(report);
|
|
if (report_size > size)
|
|
size = report_size;
|
|
}
|
|
|
|
return size;
|
|
}
|
|
|
|
static int wacom_probe(struct hid_device *hdev,
|
|
const struct hid_device_id *id)
|
|
{
|
|
struct usb_interface *intf = to_usb_interface(hdev->dev.parent);
|
|
struct usb_device *dev = interface_to_usbdev(intf);
|
|
struct wacom *wacom;
|
|
struct wacom_wac *wacom_wac;
|
|
struct wacom_features *features;
|
|
int error;
|
|
unsigned int connect_mask = HID_CONNECT_HIDRAW;
|
|
|
|
if (!id->driver_data)
|
|
return -EINVAL;
|
|
|
|
hdev->quirks |= HID_QUIRK_NO_INIT_REPORTS;
|
|
|
|
wacom = kzalloc(sizeof(struct wacom), GFP_KERNEL);
|
|
if (!wacom)
|
|
return -ENOMEM;
|
|
|
|
hid_set_drvdata(hdev, wacom);
|
|
wacom->hdev = hdev;
|
|
|
|
/* ask for the report descriptor to be loaded by HID */
|
|
error = hid_parse(hdev);
|
|
if (error) {
|
|
hid_err(hdev, "parse failed\n");
|
|
goto fail_parse;
|
|
}
|
|
|
|
wacom_wac = &wacom->wacom_wac;
|
|
wacom_wac->features = *((struct wacom_features *)id->driver_data);
|
|
features = &wacom_wac->features;
|
|
features->pktlen = wacom_compute_pktlen(hdev);
|
|
if (features->pktlen > WACOM_PKGLEN_MAX) {
|
|
error = -EINVAL;
|
|
goto fail_pktlen;
|
|
}
|
|
|
|
if (features->check_for_hid_type && features->hid_type != hdev->type) {
|
|
error = -ENODEV;
|
|
goto fail_type;
|
|
}
|
|
|
|
wacom->usbdev = dev;
|
|
wacom->intf = intf;
|
|
mutex_init(&wacom->lock);
|
|
INIT_WORK(&wacom->work, wacom_wireless_work);
|
|
|
|
if (!(features->quirks & WACOM_QUIRK_NO_INPUT)) {
|
|
error = wacom_allocate_inputs(wacom);
|
|
if (error)
|
|
goto fail_allocate_inputs;
|
|
}
|
|
|
|
/* set the default size in case we do not get them from hid */
|
|
wacom_set_default_phy(features);
|
|
|
|
/* Retrieve the physical and logical size for touch devices */
|
|
wacom_retrieve_hid_descriptor(hdev, features);
|
|
|
|
/*
|
|
* Intuos5 has no useful data about its touch interface in its
|
|
* HID descriptor. If this is the touch interface (PacketSize
|
|
* of WACOM_PKGLEN_BBTOUCH3), override the table values.
|
|
*/
|
|
if (features->type >= INTUOS5S && features->type <= INTUOSHT) {
|
|
if (features->pktlen == WACOM_PKGLEN_BBTOUCH3) {
|
|
features->device_type = BTN_TOOL_FINGER;
|
|
|
|
features->x_max = 4096;
|
|
features->y_max = 4096;
|
|
} else {
|
|
features->device_type = BTN_TOOL_PEN;
|
|
}
|
|
}
|
|
|
|
/*
|
|
* Same thing for Bamboo 3rd gen.
|
|
*/
|
|
if ((features->type == BAMBOO_PT) &&
|
|
(features->pktlen == WACOM_PKGLEN_BBTOUCH3) &&
|
|
(features->device_type == BTN_TOOL_PEN)) {
|
|
features->device_type = BTN_TOOL_FINGER;
|
|
|
|
features->x_max = 4096;
|
|
features->y_max = 4096;
|
|
}
|
|
|
|
if (hdev->bus == BUS_BLUETOOTH)
|
|
features->quirks |= WACOM_QUIRK_BATTERY;
|
|
|
|
wacom_setup_device_quirks(features);
|
|
|
|
/* set unit to "100th of a mm" for devices not reported by HID */
|
|
if (!features->unit) {
|
|
features->unit = 0x11;
|
|
features->unitExpo = -3;
|
|
}
|
|
wacom_calculate_res(features);
|
|
|
|
strlcpy(wacom_wac->name, features->name, sizeof(wacom_wac->name));
|
|
snprintf(wacom_wac->pad_name, sizeof(wacom_wac->pad_name),
|
|
"%s Pad", features->name);
|
|
|
|
if (features->quirks & WACOM_QUIRK_MULTI_INPUT) {
|
|
/* Append the device type to the name */
|
|
if (features->device_type != BTN_TOOL_FINGER)
|
|
strlcat(wacom_wac->name, " Pen", WACOM_NAME_MAX);
|
|
else if (features->touch_max)
|
|
strlcat(wacom_wac->name, " Finger", WACOM_NAME_MAX);
|
|
else
|
|
strlcat(wacom_wac->name, " Pad", WACOM_NAME_MAX);
|
|
|
|
error = wacom_add_shared_data(hdev);
|
|
if (error)
|
|
goto fail_shared_data;
|
|
}
|
|
|
|
if (!(features->quirks & WACOM_QUIRK_MONITOR) &&
|
|
(features->quirks & WACOM_QUIRK_BATTERY)) {
|
|
error = wacom_initialize_battery(wacom);
|
|
if (error)
|
|
goto fail_battery;
|
|
}
|
|
|
|
if (!(features->quirks & WACOM_QUIRK_NO_INPUT)) {
|
|
error = wacom_register_inputs(wacom);
|
|
if (error)
|
|
goto fail_register_inputs;
|
|
}
|
|
|
|
if (hdev->bus == BUS_BLUETOOTH) {
|
|
error = device_create_file(&hdev->dev, &dev_attr_speed);
|
|
if (error)
|
|
hid_warn(hdev,
|
|
"can't create sysfs speed attribute err: %d\n",
|
|
error);
|
|
}
|
|
|
|
if (features->type == HID_GENERIC)
|
|
connect_mask |= HID_CONNECT_DRIVER;
|
|
|
|
/* Regular HID work starts now */
|
|
error = hid_hw_start(hdev, connect_mask);
|
|
if (error) {
|
|
hid_err(hdev, "hw start failed\n");
|
|
goto fail_hw_start;
|
|
}
|
|
|
|
/* Note that if query fails it is not a hard failure */
|
|
wacom_query_tablet_data(hdev, features);
|
|
|
|
if (features->quirks & WACOM_QUIRK_MONITOR)
|
|
error = hid_hw_open(hdev);
|
|
|
|
if (wacom_wac->features.type == INTUOSHT && wacom_wac->features.touch_max) {
|
|
if (wacom_wac->features.device_type == BTN_TOOL_FINGER)
|
|
wacom_wac->shared->touch_input = wacom_wac->input;
|
|
}
|
|
|
|
return 0;
|
|
|
|
fail_hw_start:
|
|
if (hdev->bus == BUS_BLUETOOTH)
|
|
device_remove_file(&hdev->dev, &dev_attr_speed);
|
|
fail_register_inputs:
|
|
wacom_clean_inputs(wacom);
|
|
wacom_destroy_battery(wacom);
|
|
fail_battery:
|
|
wacom_remove_shared_data(wacom_wac);
|
|
fail_shared_data:
|
|
wacom_clean_inputs(wacom);
|
|
fail_allocate_inputs:
|
|
fail_type:
|
|
fail_pktlen:
|
|
fail_parse:
|
|
kfree(wacom);
|
|
hid_set_drvdata(hdev, NULL);
|
|
return error;
|
|
}
|
|
|
|
static void wacom_remove(struct hid_device *hdev)
|
|
{
|
|
struct wacom *wacom = hid_get_drvdata(hdev);
|
|
|
|
hid_hw_stop(hdev);
|
|
|
|
cancel_work_sync(&wacom->work);
|
|
wacom_clean_inputs(wacom);
|
|
if (hdev->bus == BUS_BLUETOOTH)
|
|
device_remove_file(&hdev->dev, &dev_attr_speed);
|
|
wacom_destroy_battery(wacom);
|
|
wacom_remove_shared_data(&wacom->wacom_wac);
|
|
|
|
hid_set_drvdata(hdev, NULL);
|
|
kfree(wacom);
|
|
}
|
|
|
|
#ifdef CONFIG_PM
|
|
static int wacom_resume(struct hid_device *hdev)
|
|
{
|
|
struct wacom *wacom = hid_get_drvdata(hdev);
|
|
struct wacom_features *features = &wacom->wacom_wac.features;
|
|
|
|
mutex_lock(&wacom->lock);
|
|
|
|
/* switch to wacom mode first */
|
|
wacom_query_tablet_data(hdev, features);
|
|
wacom_led_control(wacom);
|
|
|
|
mutex_unlock(&wacom->lock);
|
|
|
|
return 0;
|
|
}
|
|
|
|
static int wacom_reset_resume(struct hid_device *hdev)
|
|
{
|
|
return wacom_resume(hdev);
|
|
}
|
|
#endif /* CONFIG_PM */
|
|
|
|
static struct hid_driver wacom_driver = {
|
|
.name = "wacom",
|
|
.id_table = wacom_ids,
|
|
.probe = wacom_probe,
|
|
.remove = wacom_remove,
|
|
.event = wacom_wac_event,
|
|
.report = wacom_wac_report,
|
|
#ifdef CONFIG_PM
|
|
.resume = wacom_resume,
|
|
.reset_resume = wacom_reset_resume,
|
|
#endif
|
|
.raw_event = wacom_raw_event,
|
|
};
|
|
module_hid_driver(wacom_driver);
|
|
|
|
MODULE_VERSION(DRIVER_VERSION);
|
|
MODULE_AUTHOR(DRIVER_AUTHOR);
|
|
MODULE_DESCRIPTION(DRIVER_DESC);
|
|
MODULE_LICENSE(DRIVER_LICENSE);
|