740 lines
19 KiB
C
740 lines
19 KiB
C
|
// SPDX-License-Identifier: GPL-2.0-or-later
|
||
|
/*
|
||
|
* Copyright (c) 2023, NVIDIA CORPORATION & AFFILIATES. All rights reserved.
|
||
|
*
|
||
|
* HID driver for NVIDIA SHIELD peripherals.
|
||
|
*/
|
||
|
|
||
|
#include <linux/hid.h>
|
||
|
#include <linux/input-event-codes.h>
|
||
|
#include <linux/input.h>
|
||
|
#include <linux/leds.h>
|
||
|
#include <linux/module.h>
|
||
|
#include <linux/spinlock.h>
|
||
|
#include <linux/workqueue.h>
|
||
|
|
||
|
#include "hid-ids.h"
|
||
|
|
||
|
#define NOT_INIT_STR "NOT INITIALIZED"
|
||
|
#define android_map_key(c) hid_map_usage(hi, usage, bit, max, EV_KEY, (c))
|
||
|
|
||
|
enum {
|
||
|
HID_USAGE_ANDROID_PLAYPAUSE_BTN = 0xcd, /* Double-tap volume slider */
|
||
|
HID_USAGE_ANDROID_VOLUMEUP_BTN = 0xe9,
|
||
|
HID_USAGE_ANDROID_VOLUMEDOWN_BTN = 0xea,
|
||
|
HID_USAGE_ANDROID_SEARCH_BTN = 0x221, /* NVIDIA btn on Thunderstrike */
|
||
|
HID_USAGE_ANDROID_HOME_BTN = 0x223,
|
||
|
HID_USAGE_ANDROID_BACK_BTN = 0x224,
|
||
|
};
|
||
|
|
||
|
enum {
|
||
|
SHIELD_FW_VERSION_INITIALIZED = 0,
|
||
|
SHIELD_BOARD_INFO_INITIALIZED,
|
||
|
};
|
||
|
|
||
|
enum {
|
||
|
THUNDERSTRIKE_FW_VERSION_UPDATE = 0,
|
||
|
THUNDERSTRIKE_BOARD_INFO_UPDATE,
|
||
|
THUNDERSTRIKE_HAPTICS_UPDATE,
|
||
|
THUNDERSTRIKE_LED_UPDATE,
|
||
|
};
|
||
|
|
||
|
enum {
|
||
|
THUNDERSTRIKE_HOSTCMD_REPORT_SIZE = 33,
|
||
|
THUNDERSTRIKE_HOSTCMD_REQ_REPORT_ID = 0x4,
|
||
|
THUNDERSTRIKE_HOSTCMD_RESP_REPORT_ID = 0x3,
|
||
|
};
|
||
|
|
||
|
enum {
|
||
|
THUNDERSTRIKE_HOSTCMD_ID_FW_VERSION = 1,
|
||
|
THUNDERSTRIKE_HOSTCMD_ID_LED = 6,
|
||
|
THUNDERSTRIKE_HOSTCMD_ID_BOARD_INFO = 16,
|
||
|
THUNDERSTRIKE_HOSTCMD_ID_USB_INIT = 53,
|
||
|
THUNDERSTRIKE_HOSTCMD_ID_HAPTICS = 57,
|
||
|
THUNDERSTRIKE_HOSTCMD_ID_BLUETOOTH_INIT = 58,
|
||
|
};
|
||
|
|
||
|
enum thunderstrike_led_state {
|
||
|
THUNDERSTRIKE_LED_OFF = 1,
|
||
|
THUNDERSTRIKE_LED_ON = 8,
|
||
|
} __packed;
|
||
|
static_assert(sizeof(enum thunderstrike_led_state) == 1);
|
||
|
|
||
|
struct thunderstrike_hostcmd_board_info {
|
||
|
__le16 revision;
|
||
|
__le16 serial[7];
|
||
|
} __packed;
|
||
|
|
||
|
struct thunderstrike_hostcmd_haptics {
|
||
|
u8 motor_left;
|
||
|
u8 motor_right;
|
||
|
} __packed;
|
||
|
|
||
|
struct thunderstrike_hostcmd_resp_report {
|
||
|
u8 report_id; /* THUNDERSTRIKE_HOSTCMD_RESP_REPORT_ID */
|
||
|
u8 cmd_id;
|
||
|
u8 reserved_at_10;
|
||
|
|
||
|
union {
|
||
|
struct thunderstrike_hostcmd_board_info board_info;
|
||
|
struct thunderstrike_hostcmd_haptics motors;
|
||
|
__le16 fw_version;
|
||
|
enum thunderstrike_led_state led_state;
|
||
|
u8 payload[30];
|
||
|
} __packed;
|
||
|
} __packed;
|
||
|
static_assert(sizeof(struct thunderstrike_hostcmd_resp_report) ==
|
||
|
THUNDERSTRIKE_HOSTCMD_REPORT_SIZE);
|
||
|
|
||
|
struct thunderstrike_hostcmd_req_report {
|
||
|
u8 report_id; /* THUNDERSTRIKE_HOSTCMD_REQ_REPORT_ID */
|
||
|
u8 cmd_id;
|
||
|
u8 reserved_at_10;
|
||
|
|
||
|
union {
|
||
|
struct __packed {
|
||
|
u8 update;
|
||
|
enum thunderstrike_led_state state;
|
||
|
} led;
|
||
|
struct __packed {
|
||
|
u8 update;
|
||
|
struct thunderstrike_hostcmd_haptics motors;
|
||
|
} haptics;
|
||
|
} __packed;
|
||
|
u8 reserved_at_30[27];
|
||
|
} __packed;
|
||
|
static_assert(sizeof(struct thunderstrike_hostcmd_req_report) ==
|
||
|
THUNDERSTRIKE_HOSTCMD_REPORT_SIZE);
|
||
|
|
||
|
/* Common struct for shield accessories. */
|
||
|
struct shield_device {
|
||
|
struct hid_device *hdev;
|
||
|
|
||
|
unsigned long initialized_flags;
|
||
|
const char *codename;
|
||
|
u16 fw_version;
|
||
|
struct {
|
||
|
u16 revision;
|
||
|
char serial_number[15];
|
||
|
} board_info;
|
||
|
};
|
||
|
|
||
|
struct thunderstrike {
|
||
|
struct shield_device base;
|
||
|
|
||
|
/* Sub-devices */
|
||
|
struct input_dev *haptics_dev;
|
||
|
struct led_classdev led_dev;
|
||
|
|
||
|
/* Resources */
|
||
|
void *req_report_dmabuf;
|
||
|
unsigned long update_flags;
|
||
|
struct thunderstrike_hostcmd_haptics haptics_val;
|
||
|
spinlock_t haptics_update_lock;
|
||
|
u8 led_state : 1;
|
||
|
enum thunderstrike_led_state led_value;
|
||
|
struct work_struct hostcmd_req_work;
|
||
|
};
|
||
|
|
||
|
static inline void thunderstrike_hostcmd_req_report_init(
|
||
|
struct thunderstrike_hostcmd_req_report *report, u8 cmd_id)
|
||
|
{
|
||
|
memset(report, 0, sizeof(*report));
|
||
|
report->report_id = THUNDERSTRIKE_HOSTCMD_REQ_REPORT_ID;
|
||
|
report->cmd_id = cmd_id;
|
||
|
}
|
||
|
|
||
|
static inline void shield_strrev(char *dest, size_t len, u16 rev)
|
||
|
{
|
||
|
dest[0] = ('A' - 1) + (rev >> 8);
|
||
|
snprintf(&dest[1], len - 1, "%02X", 0xff & rev);
|
||
|
}
|
||
|
|
||
|
static struct input_dev *shield_allocate_input_dev(struct hid_device *hdev,
|
||
|
const char *name_suffix)
|
||
|
{
|
||
|
struct input_dev *idev;
|
||
|
|
||
|
idev = input_allocate_device();
|
||
|
if (!idev)
|
||
|
goto err_device;
|
||
|
|
||
|
idev->id.bustype = hdev->bus;
|
||
|
idev->id.vendor = hdev->vendor;
|
||
|
idev->id.product = hdev->product;
|
||
|
idev->id.version = hdev->version;
|
||
|
idev->uniq = hdev->uniq;
|
||
|
idev->name = devm_kasprintf(&hdev->dev, GFP_KERNEL, "%s %s", hdev->name,
|
||
|
name_suffix);
|
||
|
if (!idev->name)
|
||
|
goto err_name;
|
||
|
|
||
|
input_set_drvdata(idev, hdev);
|
||
|
|
||
|
return idev;
|
||
|
|
||
|
err_name:
|
||
|
input_free_device(idev);
|
||
|
err_device:
|
||
|
return ERR_PTR(-ENOMEM);
|
||
|
}
|
||
|
|
||
|
static struct input_dev *shield_haptics_create(
|
||
|
struct shield_device *dev,
|
||
|
int (*play_effect)(struct input_dev *, void *, struct ff_effect *))
|
||
|
{
|
||
|
struct input_dev *haptics;
|
||
|
int ret;
|
||
|
|
||
|
if (!IS_ENABLED(CONFIG_NVIDIA_SHIELD_FF))
|
||
|
return NULL;
|
||
|
|
||
|
haptics = shield_allocate_input_dev(dev->hdev, "Haptics");
|
||
|
if (IS_ERR(haptics))
|
||
|
return haptics;
|
||
|
|
||
|
input_set_capability(haptics, EV_FF, FF_RUMBLE);
|
||
|
input_ff_create_memless(haptics, NULL, play_effect);
|
||
|
|
||
|
ret = input_register_device(haptics);
|
||
|
if (ret)
|
||
|
goto err;
|
||
|
|
||
|
return haptics;
|
||
|
|
||
|
err:
|
||
|
input_free_device(haptics);
|
||
|
return ERR_PTR(ret);
|
||
|
}
|
||
|
|
||
|
static inline void thunderstrike_send_hostcmd_request(struct thunderstrike *ts)
|
||
|
{
|
||
|
struct thunderstrike_hostcmd_req_report *report = ts->req_report_dmabuf;
|
||
|
struct shield_device *shield_dev = &ts->base;
|
||
|
int ret;
|
||
|
|
||
|
ret = hid_hw_raw_request(shield_dev->hdev, report->report_id,
|
||
|
ts->req_report_dmabuf,
|
||
|
THUNDERSTRIKE_HOSTCMD_REPORT_SIZE,
|
||
|
HID_OUTPUT_REPORT, HID_REQ_SET_REPORT);
|
||
|
|
||
|
if (ret < 0) {
|
||
|
hid_err(shield_dev->hdev,
|
||
|
"Failed to output Thunderstrike HOSTCMD request HID report due to %pe\n",
|
||
|
ERR_PTR(ret));
|
||
|
}
|
||
|
}
|
||
|
|
||
|
static void thunderstrike_hostcmd_req_work_handler(struct work_struct *work)
|
||
|
{
|
||
|
struct thunderstrike *ts =
|
||
|
container_of(work, struct thunderstrike, hostcmd_req_work);
|
||
|
struct thunderstrike_hostcmd_req_report *report;
|
||
|
unsigned long flags;
|
||
|
|
||
|
report = ts->req_report_dmabuf;
|
||
|
|
||
|
if (test_and_clear_bit(THUNDERSTRIKE_FW_VERSION_UPDATE, &ts->update_flags)) {
|
||
|
thunderstrike_hostcmd_req_report_init(
|
||
|
report, THUNDERSTRIKE_HOSTCMD_ID_FW_VERSION);
|
||
|
thunderstrike_send_hostcmd_request(ts);
|
||
|
}
|
||
|
|
||
|
if (test_and_clear_bit(THUNDERSTRIKE_LED_UPDATE, &ts->update_flags)) {
|
||
|
thunderstrike_hostcmd_req_report_init(report, THUNDERSTRIKE_HOSTCMD_ID_LED);
|
||
|
report->led.update = 1;
|
||
|
report->led.state = ts->led_value;
|
||
|
thunderstrike_send_hostcmd_request(ts);
|
||
|
}
|
||
|
|
||
|
if (test_and_clear_bit(THUNDERSTRIKE_BOARD_INFO_UPDATE, &ts->update_flags)) {
|
||
|
thunderstrike_hostcmd_req_report_init(
|
||
|
report, THUNDERSTRIKE_HOSTCMD_ID_BOARD_INFO);
|
||
|
thunderstrike_send_hostcmd_request(ts);
|
||
|
}
|
||
|
|
||
|
if (test_and_clear_bit(THUNDERSTRIKE_HAPTICS_UPDATE, &ts->update_flags)) {
|
||
|
thunderstrike_hostcmd_req_report_init(
|
||
|
report, THUNDERSTRIKE_HOSTCMD_ID_HAPTICS);
|
||
|
|
||
|
report->haptics.update = 1;
|
||
|
spin_lock_irqsave(&ts->haptics_update_lock, flags);
|
||
|
report->haptics.motors = ts->haptics_val;
|
||
|
spin_unlock_irqrestore(&ts->haptics_update_lock, flags);
|
||
|
|
||
|
thunderstrike_send_hostcmd_request(ts);
|
||
|
}
|
||
|
}
|
||
|
|
||
|
static inline void thunderstrike_request_firmware_version(struct thunderstrike *ts)
|
||
|
{
|
||
|
set_bit(THUNDERSTRIKE_FW_VERSION_UPDATE, &ts->update_flags);
|
||
|
schedule_work(&ts->hostcmd_req_work);
|
||
|
}
|
||
|
|
||
|
static inline void thunderstrike_request_board_info(struct thunderstrike *ts)
|
||
|
{
|
||
|
set_bit(THUNDERSTRIKE_BOARD_INFO_UPDATE, &ts->update_flags);
|
||
|
schedule_work(&ts->hostcmd_req_work);
|
||
|
}
|
||
|
|
||
|
static inline int
|
||
|
thunderstrike_update_haptics(struct thunderstrike *ts,
|
||
|
struct thunderstrike_hostcmd_haptics *motors)
|
||
|
{
|
||
|
unsigned long flags;
|
||
|
|
||
|
spin_lock_irqsave(&ts->haptics_update_lock, flags);
|
||
|
ts->haptics_val = *motors;
|
||
|
spin_unlock_irqrestore(&ts->haptics_update_lock, flags);
|
||
|
|
||
|
set_bit(THUNDERSTRIKE_HAPTICS_UPDATE, &ts->update_flags);
|
||
|
schedule_work(&ts->hostcmd_req_work);
|
||
|
|
||
|
return 0;
|
||
|
}
|
||
|
|
||
|
static int thunderstrike_play_effect(struct input_dev *idev, void *data,
|
||
|
struct ff_effect *effect)
|
||
|
{
|
||
|
struct hid_device *hdev = input_get_drvdata(idev);
|
||
|
struct thunderstrike_hostcmd_haptics motors;
|
||
|
struct shield_device *shield_dev;
|
||
|
struct thunderstrike *ts;
|
||
|
|
||
|
if (effect->type != FF_RUMBLE)
|
||
|
return 0;
|
||
|
|
||
|
shield_dev = hid_get_drvdata(hdev);
|
||
|
ts = container_of(shield_dev, struct thunderstrike, base);
|
||
|
|
||
|
/* Thunderstrike motor values range from 0 to 32 inclusively */
|
||
|
motors.motor_left = effect->u.rumble.strong_magnitude / 2047;
|
||
|
motors.motor_right = effect->u.rumble.weak_magnitude / 2047;
|
||
|
|
||
|
hid_dbg(hdev, "Thunderstrike FF_RUMBLE request, left: %u right: %u\n",
|
||
|
motors.motor_left, motors.motor_right);
|
||
|
|
||
|
return thunderstrike_update_haptics(ts, &motors);
|
||
|
}
|
||
|
|
||
|
static enum led_brightness
|
||
|
thunderstrike_led_get_brightness(struct led_classdev *led)
|
||
|
{
|
||
|
struct hid_device *hdev = to_hid_device(led->dev->parent);
|
||
|
struct shield_device *shield_dev = hid_get_drvdata(hdev);
|
||
|
struct thunderstrike *ts;
|
||
|
|
||
|
ts = container_of(shield_dev, struct thunderstrike, base);
|
||
|
|
||
|
return ts->led_state;
|
||
|
}
|
||
|
|
||
|
static void thunderstrike_led_set_brightness(struct led_classdev *led,
|
||
|
enum led_brightness value)
|
||
|
{
|
||
|
struct hid_device *hdev = to_hid_device(led->dev->parent);
|
||
|
struct shield_device *shield_dev = hid_get_drvdata(hdev);
|
||
|
struct thunderstrike *ts;
|
||
|
|
||
|
ts = container_of(shield_dev, struct thunderstrike, base);
|
||
|
|
||
|
switch (value) {
|
||
|
case LED_OFF:
|
||
|
ts->led_value = THUNDERSTRIKE_LED_OFF;
|
||
|
break;
|
||
|
default:
|
||
|
ts->led_value = THUNDERSTRIKE_LED_ON;
|
||
|
break;
|
||
|
}
|
||
|
|
||
|
set_bit(THUNDERSTRIKE_LED_UPDATE, &ts->update_flags);
|
||
|
schedule_work(&ts->hostcmd_req_work);
|
||
|
}
|
||
|
|
||
|
static void
|
||
|
thunderstrike_parse_fw_version_payload(struct shield_device *shield_dev,
|
||
|
__le16 fw_version)
|
||
|
{
|
||
|
shield_dev->fw_version = le16_to_cpu(fw_version);
|
||
|
|
||
|
set_bit(SHIELD_FW_VERSION_INITIALIZED, &shield_dev->initialized_flags);
|
||
|
|
||
|
hid_dbg(shield_dev->hdev, "Thunderstrike firmware version 0x%04X\n",
|
||
|
shield_dev->fw_version);
|
||
|
}
|
||
|
|
||
|
static void
|
||
|
thunderstrike_parse_board_info_payload(struct shield_device *shield_dev,
|
||
|
struct thunderstrike_hostcmd_board_info *board_info)
|
||
|
{
|
||
|
char board_revision_str[4];
|
||
|
int i;
|
||
|
|
||
|
shield_dev->board_info.revision = le16_to_cpu(board_info->revision);
|
||
|
for (i = 0; i < 7; ++i) {
|
||
|
u16 val = le16_to_cpu(board_info->serial[i]);
|
||
|
|
||
|
shield_dev->board_info.serial_number[2 * i] = val & 0xFF;
|
||
|
shield_dev->board_info.serial_number[2 * i + 1] = val >> 8;
|
||
|
}
|
||
|
shield_dev->board_info.serial_number[14] = '\0';
|
||
|
|
||
|
set_bit(SHIELD_BOARD_INFO_INITIALIZED, &shield_dev->initialized_flags);
|
||
|
|
||
|
shield_strrev(board_revision_str, 4, shield_dev->board_info.revision);
|
||
|
hid_dbg(shield_dev->hdev,
|
||
|
"Thunderstrike BOARD_REVISION_%s (0x%04X) S/N: %s\n",
|
||
|
board_revision_str, shield_dev->board_info.revision,
|
||
|
shield_dev->board_info.serial_number);
|
||
|
}
|
||
|
|
||
|
static inline void
|
||
|
thunderstrike_parse_haptics_payload(struct shield_device *shield_dev,
|
||
|
struct thunderstrike_hostcmd_haptics *haptics)
|
||
|
{
|
||
|
hid_dbg(shield_dev->hdev,
|
||
|
"Thunderstrike haptics HOSTCMD response, left: %u right: %u\n",
|
||
|
haptics->motor_left, haptics->motor_right);
|
||
|
}
|
||
|
|
||
|
static void
|
||
|
thunderstrike_parse_led_payload(struct shield_device *shield_dev,
|
||
|
enum thunderstrike_led_state led_state)
|
||
|
{
|
||
|
struct thunderstrike *ts = container_of(shield_dev, struct thunderstrike, base);
|
||
|
|
||
|
switch (led_state) {
|
||
|
case THUNDERSTRIKE_LED_OFF:
|
||
|
ts->led_state = 0;
|
||
|
break;
|
||
|
case THUNDERSTRIKE_LED_ON:
|
||
|
ts->led_state = 1;
|
||
|
break;
|
||
|
}
|
||
|
|
||
|
hid_dbg(shield_dev->hdev, "Thunderstrike led HOSTCMD response, 0x%02X\n", led_state);
|
||
|
}
|
||
|
|
||
|
static int thunderstrike_parse_report(struct shield_device *shield_dev,
|
||
|
struct hid_report *report, u8 *data,
|
||
|
int size)
|
||
|
{
|
||
|
struct thunderstrike_hostcmd_resp_report *hostcmd_resp_report;
|
||
|
struct thunderstrike *ts =
|
||
|
container_of(shield_dev, struct thunderstrike, base);
|
||
|
struct hid_device *hdev = shield_dev->hdev;
|
||
|
|
||
|
switch (report->id) {
|
||
|
case THUNDERSTRIKE_HOSTCMD_RESP_REPORT_ID:
|
||
|
if (size != THUNDERSTRIKE_HOSTCMD_REPORT_SIZE) {
|
||
|
hid_err(hdev,
|
||
|
"Encountered Thunderstrike HOSTCMD HID report with unexpected size %d\n",
|
||
|
size);
|
||
|
return -EINVAL;
|
||
|
}
|
||
|
|
||
|
hostcmd_resp_report =
|
||
|
(struct thunderstrike_hostcmd_resp_report *)data;
|
||
|
|
||
|
switch (hostcmd_resp_report->cmd_id) {
|
||
|
case THUNDERSTRIKE_HOSTCMD_ID_FW_VERSION:
|
||
|
thunderstrike_parse_fw_version_payload(
|
||
|
shield_dev, hostcmd_resp_report->fw_version);
|
||
|
break;
|
||
|
case THUNDERSTRIKE_HOSTCMD_ID_LED:
|
||
|
thunderstrike_parse_led_payload(shield_dev, hostcmd_resp_report->led_state);
|
||
|
break;
|
||
|
case THUNDERSTRIKE_HOSTCMD_ID_BOARD_INFO:
|
||
|
thunderstrike_parse_board_info_payload(
|
||
|
shield_dev, &hostcmd_resp_report->board_info);
|
||
|
break;
|
||
|
case THUNDERSTRIKE_HOSTCMD_ID_HAPTICS:
|
||
|
thunderstrike_parse_haptics_payload(
|
||
|
shield_dev, &hostcmd_resp_report->motors);
|
||
|
break;
|
||
|
|
||
|
case THUNDERSTRIKE_HOSTCMD_ID_USB_INIT:
|
||
|
case THUNDERSTRIKE_HOSTCMD_ID_BLUETOOTH_INIT:
|
||
|
/* May block HOSTCMD requests till received initially */
|
||
|
thunderstrike_request_firmware_version(ts);
|
||
|
thunderstrike_request_board_info(ts);
|
||
|
/* Only HOSTCMD that can be triggered without a request */
|
||
|
return 0;
|
||
|
default:
|
||
|
hid_warn(hdev,
|
||
|
"Unhandled Thunderstrike HOSTCMD id %d\n",
|
||
|
hostcmd_resp_report->cmd_id);
|
||
|
return -ENOENT;
|
||
|
}
|
||
|
|
||
|
break;
|
||
|
default:
|
||
|
return 0;
|
||
|
}
|
||
|
|
||
|
return 0;
|
||
|
}
|
||
|
|
||
|
static inline int thunderstrike_led_create(struct thunderstrike *ts)
|
||
|
{
|
||
|
struct led_classdev *led = &ts->led_dev;
|
||
|
|
||
|
led->name = "thunderstrike:blue:led";
|
||
|
led->max_brightness = 1;
|
||
|
led->flags = LED_CORE_SUSPENDRESUME;
|
||
|
led->brightness_get = &thunderstrike_led_get_brightness;
|
||
|
led->brightness_set = &thunderstrike_led_set_brightness;
|
||
|
|
||
|
return led_classdev_register(&ts->base.hdev->dev, led);
|
||
|
}
|
||
|
|
||
|
static struct shield_device *thunderstrike_create(struct hid_device *hdev)
|
||
|
{
|
||
|
struct shield_device *shield_dev;
|
||
|
struct thunderstrike *ts;
|
||
|
int ret;
|
||
|
|
||
|
ts = devm_kzalloc(&hdev->dev, sizeof(*ts), GFP_KERNEL);
|
||
|
if (!ts)
|
||
|
return ERR_PTR(-ENOMEM);
|
||
|
|
||
|
ts->req_report_dmabuf = devm_kzalloc(
|
||
|
&hdev->dev, THUNDERSTRIKE_HOSTCMD_REPORT_SIZE, GFP_KERNEL);
|
||
|
if (!ts->req_report_dmabuf)
|
||
|
return ERR_PTR(-ENOMEM);
|
||
|
|
||
|
shield_dev = &ts->base;
|
||
|
shield_dev->hdev = hdev;
|
||
|
shield_dev->codename = "Thunderstrike";
|
||
|
|
||
|
spin_lock_init(&ts->haptics_update_lock);
|
||
|
INIT_WORK(&ts->hostcmd_req_work, thunderstrike_hostcmd_req_work_handler);
|
||
|
|
||
|
hid_set_drvdata(hdev, shield_dev);
|
||
|
|
||
|
ts->haptics_dev = shield_haptics_create(shield_dev, thunderstrike_play_effect);
|
||
|
if (IS_ERR(ts->haptics_dev))
|
||
|
return ERR_CAST(ts->haptics_dev);
|
||
|
|
||
|
ret = thunderstrike_led_create(ts);
|
||
|
if (ret) {
|
||
|
hid_err(hdev, "Failed to create Thunderstrike LED instance\n");
|
||
|
goto err;
|
||
|
}
|
||
|
|
||
|
hid_info(hdev, "Registered Thunderstrike controller\n");
|
||
|
return shield_dev;
|
||
|
|
||
|
err:
|
||
|
if (ts->haptics_dev)
|
||
|
input_unregister_device(ts->haptics_dev);
|
||
|
return ERR_CAST(ts->haptics_dev);
|
||
|
}
|
||
|
|
||
|
static int android_input_mapping(struct hid_device *hdev, struct hid_input *hi,
|
||
|
struct hid_field *field,
|
||
|
struct hid_usage *usage, unsigned long **bit,
|
||
|
int *max)
|
||
|
{
|
||
|
if ((usage->hid & HID_USAGE_PAGE) != HID_UP_CONSUMER)
|
||
|
return 0;
|
||
|
|
||
|
switch (usage->hid & HID_USAGE) {
|
||
|
case HID_USAGE_ANDROID_PLAYPAUSE_BTN:
|
||
|
android_map_key(KEY_PLAYPAUSE);
|
||
|
break;
|
||
|
case HID_USAGE_ANDROID_VOLUMEUP_BTN:
|
||
|
android_map_key(KEY_VOLUMEUP);
|
||
|
break;
|
||
|
case HID_USAGE_ANDROID_VOLUMEDOWN_BTN:
|
||
|
android_map_key(KEY_VOLUMEDOWN);
|
||
|
break;
|
||
|
case HID_USAGE_ANDROID_SEARCH_BTN:
|
||
|
android_map_key(BTN_Z);
|
||
|
break;
|
||
|
case HID_USAGE_ANDROID_HOME_BTN:
|
||
|
android_map_key(BTN_MODE);
|
||
|
break;
|
||
|
case HID_USAGE_ANDROID_BACK_BTN:
|
||
|
android_map_key(BTN_SELECT);
|
||
|
break;
|
||
|
default:
|
||
|
return 0;
|
||
|
}
|
||
|
|
||
|
return 1;
|
||
|
}
|
||
|
|
||
|
static ssize_t firmware_version_show(struct device *dev,
|
||
|
struct device_attribute *attr, char *buf)
|
||
|
{
|
||
|
struct hid_device *hdev = to_hid_device(dev);
|
||
|
struct shield_device *shield_dev;
|
||
|
int ret;
|
||
|
|
||
|
shield_dev = hid_get_drvdata(hdev);
|
||
|
|
||
|
if (test_bit(SHIELD_FW_VERSION_INITIALIZED, &shield_dev->initialized_flags))
|
||
|
ret = sysfs_emit(buf, "0x%04X\n", shield_dev->fw_version);
|
||
|
else
|
||
|
ret = sysfs_emit(buf, NOT_INIT_STR "\n");
|
||
|
|
||
|
return ret;
|
||
|
}
|
||
|
|
||
|
static DEVICE_ATTR_RO(firmware_version);
|
||
|
|
||
|
static ssize_t hardware_version_show(struct device *dev,
|
||
|
struct device_attribute *attr, char *buf)
|
||
|
{
|
||
|
struct hid_device *hdev = to_hid_device(dev);
|
||
|
struct shield_device *shield_dev;
|
||
|
char board_revision_str[4];
|
||
|
int ret;
|
||
|
|
||
|
shield_dev = hid_get_drvdata(hdev);
|
||
|
|
||
|
if (test_bit(SHIELD_BOARD_INFO_INITIALIZED, &shield_dev->initialized_flags)) {
|
||
|
shield_strrev(board_revision_str, 4, shield_dev->board_info.revision);
|
||
|
ret = sysfs_emit(buf, "%s BOARD_REVISION_%s (0x%04X)\n",
|
||
|
shield_dev->codename, board_revision_str,
|
||
|
shield_dev->board_info.revision);
|
||
|
} else
|
||
|
ret = sysfs_emit(buf, NOT_INIT_STR "\n");
|
||
|
|
||
|
return ret;
|
||
|
}
|
||
|
|
||
|
static DEVICE_ATTR_RO(hardware_version);
|
||
|
|
||
|
static ssize_t serial_number_show(struct device *dev,
|
||
|
struct device_attribute *attr, char *buf)
|
||
|
{
|
||
|
struct hid_device *hdev = to_hid_device(dev);
|
||
|
struct shield_device *shield_dev;
|
||
|
int ret;
|
||
|
|
||
|
shield_dev = hid_get_drvdata(hdev);
|
||
|
|
||
|
if (test_bit(SHIELD_BOARD_INFO_INITIALIZED, &shield_dev->initialized_flags))
|
||
|
ret = sysfs_emit(buf, "%s\n", shield_dev->board_info.serial_number);
|
||
|
else
|
||
|
ret = sysfs_emit(buf, NOT_INIT_STR "\n");
|
||
|
|
||
|
return ret;
|
||
|
}
|
||
|
|
||
|
static DEVICE_ATTR_RO(serial_number);
|
||
|
|
||
|
static struct attribute *shield_device_attrs[] = {
|
||
|
&dev_attr_firmware_version.attr,
|
||
|
&dev_attr_hardware_version.attr,
|
||
|
&dev_attr_serial_number.attr,
|
||
|
NULL,
|
||
|
};
|
||
|
ATTRIBUTE_GROUPS(shield_device);
|
||
|
|
||
|
static int shield_raw_event(struct hid_device *hdev, struct hid_report *report,
|
||
|
u8 *data, int size)
|
||
|
{
|
||
|
struct shield_device *dev = hid_get_drvdata(hdev);
|
||
|
|
||
|
return thunderstrike_parse_report(dev, report, data, size);
|
||
|
}
|
||
|
|
||
|
static int shield_probe(struct hid_device *hdev, const struct hid_device_id *id)
|
||
|
{
|
||
|
struct shield_device *shield_dev = NULL;
|
||
|
struct thunderstrike *ts;
|
||
|
int ret;
|
||
|
|
||
|
ret = hid_parse(hdev);
|
||
|
if (ret) {
|
||
|
hid_err(hdev, "Parse failed\n");
|
||
|
return ret;
|
||
|
}
|
||
|
|
||
|
switch (id->product) {
|
||
|
case USB_DEVICE_ID_NVIDIA_THUNDERSTRIKE_CONTROLLER:
|
||
|
shield_dev = thunderstrike_create(hdev);
|
||
|
break;
|
||
|
}
|
||
|
|
||
|
if (unlikely(!shield_dev)) {
|
||
|
hid_err(hdev, "Failed to identify SHIELD device\n");
|
||
|
return -ENODEV;
|
||
|
}
|
||
|
if (IS_ERR(shield_dev)) {
|
||
|
hid_err(hdev, "Failed to create SHIELD device\n");
|
||
|
return PTR_ERR(shield_dev);
|
||
|
}
|
||
|
|
||
|
ts = container_of(shield_dev, struct thunderstrike, base);
|
||
|
|
||
|
ret = hid_hw_start(hdev, HID_CONNECT_HIDINPUT);
|
||
|
if (ret) {
|
||
|
hid_err(hdev, "Failed to start HID device\n");
|
||
|
goto err_haptics;
|
||
|
}
|
||
|
|
||
|
ret = hid_hw_open(hdev);
|
||
|
if (ret) {
|
||
|
hid_err(hdev, "Failed to open HID device\n");
|
||
|
goto err_stop;
|
||
|
}
|
||
|
|
||
|
thunderstrike_request_firmware_version(ts);
|
||
|
thunderstrike_request_board_info(ts);
|
||
|
|
||
|
return ret;
|
||
|
|
||
|
err_stop:
|
||
|
hid_hw_stop(hdev);
|
||
|
err_haptics:
|
||
|
if (ts->haptics_dev)
|
||
|
input_unregister_device(ts->haptics_dev);
|
||
|
return ret;
|
||
|
}
|
||
|
|
||
|
static void shield_remove(struct hid_device *hdev)
|
||
|
{
|
||
|
struct shield_device *dev = hid_get_drvdata(hdev);
|
||
|
struct thunderstrike *ts;
|
||
|
|
||
|
ts = container_of(dev, struct thunderstrike, base);
|
||
|
|
||
|
hid_hw_close(hdev);
|
||
|
led_classdev_unregister(&ts->led_dev);
|
||
|
if (ts->haptics_dev)
|
||
|
input_unregister_device(ts->haptics_dev);
|
||
|
cancel_work_sync(&ts->hostcmd_req_work);
|
||
|
hid_hw_stop(hdev);
|
||
|
}
|
||
|
|
||
|
static const struct hid_device_id shield_devices[] = {
|
||
|
{ HID_BLUETOOTH_DEVICE(USB_VENDOR_ID_NVIDIA,
|
||
|
USB_DEVICE_ID_NVIDIA_THUNDERSTRIKE_CONTROLLER) },
|
||
|
{ HID_USB_DEVICE(USB_VENDOR_ID_NVIDIA,
|
||
|
USB_DEVICE_ID_NVIDIA_THUNDERSTRIKE_CONTROLLER) },
|
||
|
{ }
|
||
|
};
|
||
|
MODULE_DEVICE_TABLE(hid, shield_devices);
|
||
|
|
||
|
static struct hid_driver shield_driver = {
|
||
|
.name = "shield",
|
||
|
.id_table = shield_devices,
|
||
|
.input_mapping = android_input_mapping,
|
||
|
.probe = shield_probe,
|
||
|
.remove = shield_remove,
|
||
|
.raw_event = shield_raw_event,
|
||
|
.driver = {
|
||
|
.dev_groups = shield_device_groups,
|
||
|
},
|
||
|
};
|
||
|
module_hid_driver(shield_driver);
|
||
|
|
||
|
MODULE_AUTHOR("Rahul Rameshbabu <rrameshbabu@nvidia.com>");
|
||
|
MODULE_DESCRIPTION("HID Driver for NVIDIA SHIELD peripherals.");
|
||
|
MODULE_LICENSE("GPL");
|