132c88cbcSSimon Wood /* 264013800SSimon Wood * Force feedback support for Logitech Gaming Wheels 332c88cbcSSimon Wood * 464013800SSimon Wood * Including G27, G25, DFP, DFGT, FFEX, Momo, Momo2 & 564013800SSimon Wood * Speed Force Wireless (WiiWheel) 632c88cbcSSimon Wood * 732c88cbcSSimon Wood * Copyright (c) 2010 Simon Wood <simon@mungewell.org> 832c88cbcSSimon Wood */ 932c88cbcSSimon Wood 1032c88cbcSSimon Wood /* 1132c88cbcSSimon Wood * This program is free software; you can redistribute it and/or modify 1232c88cbcSSimon Wood * it under the terms of the GNU General Public License as published by 1332c88cbcSSimon Wood * the Free Software Foundation; either version 2 of the License, or 1432c88cbcSSimon Wood * (at your option) any later version. 1532c88cbcSSimon Wood * 1632c88cbcSSimon Wood * This program is distributed in the hope that it will be useful, 1732c88cbcSSimon Wood * but WITHOUT ANY WARRANTY; without even the implied warranty of 1832c88cbcSSimon Wood * MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE. See the 1932c88cbcSSimon Wood * GNU General Public License for more details. 2032c88cbcSSimon Wood * 2132c88cbcSSimon Wood * You should have received a copy of the GNU General Public License 2232c88cbcSSimon Wood * along with this program; if not, write to the Free Software 2332c88cbcSSimon Wood * Foundation, Inc., 59 Temple Place, Suite 330, Boston, MA 02111-1307 USA 2432c88cbcSSimon Wood */ 2532c88cbcSSimon Wood 2632c88cbcSSimon Wood 2732c88cbcSSimon Wood #include <linux/input.h> 2832c88cbcSSimon Wood #include <linux/usb.h> 2932c88cbcSSimon Wood #include <linux/hid.h> 3032c88cbcSSimon Wood 3132c88cbcSSimon Wood #include "usbhid/usbhid.h" 3232c88cbcSSimon Wood #include "hid-lg.h" 33a54dc779SMichal Malý #include "hid-lg4ff.h" 347362cd22SMichal Malý #include "hid-ids.h" 3532c88cbcSSimon Wood 36b96d23ecSMichal Malý #define LG4FF_MMODE_IS_MULTIMODE 0 37e7c23449SMichal Malý #define LG4FF_MMODE_SWITCHED 1 38e7c23449SMichal Malý #define LG4FF_MMODE_NOT_MULTIMODE 2 39e7c23449SMichal Malý 40b96d23ecSMichal Malý #define LG4FF_MODE_NATIVE_IDX 0 41b96d23ecSMichal Malý #define LG4FF_MODE_DFEX_IDX 1 42b96d23ecSMichal Malý #define LG4FF_MODE_DFP_IDX 2 43b96d23ecSMichal Malý #define LG4FF_MODE_G25_IDX 3 44b96d23ecSMichal Malý #define LG4FF_MODE_DFGT_IDX 4 45b96d23ecSMichal Malý #define LG4FF_MODE_G27_IDX 5 4629fae1c8SSimon Wood #define LG4FF_MODE_G29_IDX 6 4729fae1c8SSimon Wood #define LG4FF_MODE_MAX_IDX 7 48b96d23ecSMichal Malý 49b96d23ecSMichal Malý #define LG4FF_MODE_NATIVE BIT(LG4FF_MODE_NATIVE_IDX) 50b96d23ecSMichal Malý #define LG4FF_MODE_DFEX BIT(LG4FF_MODE_DFEX_IDX) 51b96d23ecSMichal Malý #define LG4FF_MODE_DFP BIT(LG4FF_MODE_DFP_IDX) 52b96d23ecSMichal Malý #define LG4FF_MODE_G25 BIT(LG4FF_MODE_G25_IDX) 53b96d23ecSMichal Malý #define LG4FF_MODE_DFGT BIT(LG4FF_MODE_DFGT_IDX) 54b96d23ecSMichal Malý #define LG4FF_MODE_G27 BIT(LG4FF_MODE_G27_IDX) 5529fae1c8SSimon Wood #define LG4FF_MODE_G29 BIT(LG4FF_MODE_G29_IDX) 56b96d23ecSMichal Malý 57b96d23ecSMichal Malý #define LG4FF_DFEX_TAG "DF-EX" 58b96d23ecSMichal Malý #define LG4FF_DFEX_NAME "Driving Force / Formula EX" 59b96d23ecSMichal Malý #define LG4FF_DFP_TAG "DFP" 60b96d23ecSMichal Malý #define LG4FF_DFP_NAME "Driving Force Pro" 61b96d23ecSMichal Malý #define LG4FF_G25_TAG "G25" 62b96d23ecSMichal Malý #define LG4FF_G25_NAME "G25 Racing Wheel" 63b96d23ecSMichal Malý #define LG4FF_G27_TAG "G27" 64b96d23ecSMichal Malý #define LG4FF_G27_NAME "G27 Racing Wheel" 6529fae1c8SSimon Wood #define LG4FF_G29_TAG "G29" 6629fae1c8SSimon Wood #define LG4FF_G29_NAME "G29 Racing Wheel" 67b96d23ecSMichal Malý #define LG4FF_DFGT_TAG "DFGT" 68b96d23ecSMichal Malý #define LG4FF_DFGT_NAME "Driving Force GT" 69b96d23ecSMichal Malý 70e7c23449SMichal Malý #define LG4FF_FFEX_REV_MAJ 0x21 71e7c23449SMichal Malý #define LG4FF_FFEX_REV_MIN 0x00 72e7c23449SMichal Malý 73d0afd848SMichal Malý static void lg4ff_set_range_dfp(struct hid_device *hid, u16 range); 74d0afd848SMichal Malý static void lg4ff_set_range_g25(struct hid_device *hid, u16 range); 7530bb75d7SMichal Malý 7672529c65SMichal Malý struct lg4ff_wheel_data { 775d9d60adSMichal Malý const u32 product_id; 78961af46fSSimon Wood u16 combine; 792a552c30SMichal Malý u16 range; 805d9d60adSMichal Malý const u16 min_range; 815d9d60adSMichal Malý const u16 max_range; 8222bcefdcSSimon Wood #ifdef CONFIG_LEDS_CLASS 832a552c30SMichal Malý u8 led_state; 8422bcefdcSSimon Wood struct led_classdev *led[5]; 8522bcefdcSSimon Wood #endif 865d9d60adSMichal Malý const u32 alternate_modes; 875d9d60adSMichal Malý const char * const real_tag; 885d9d60adSMichal Malý const char * const real_name; 895d9d60adSMichal Malý const u16 real_product_id; 9072529c65SMichal Malý 9130bb75d7SMichal Malý void (*set_range)(struct hid_device *hid, u16 range); 9230bb75d7SMichal Malý }; 9330bb75d7SMichal Malý 9472529c65SMichal Malý struct lg4ff_device_entry { 95c918fe78SMichal Malý spinlock_t report_lock; /* Protect output HID report */ 96c28abd8cSMichal Malý struct hid_report *report; 9772529c65SMichal Malý struct lg4ff_wheel_data wdata; 9872529c65SMichal Malý }; 9972529c65SMichal Malý 1007362cd22SMichal Malý static const signed short lg4ff_wheel_effects[] = { 10132c88cbcSSimon Wood FF_CONSTANT, 10232c88cbcSSimon Wood FF_AUTOCENTER, 10332c88cbcSSimon Wood -1 10432c88cbcSSimon Wood }; 10532c88cbcSSimon Wood 1067362cd22SMichal Malý struct lg4ff_wheel { 1072a552c30SMichal Malý const u32 product_id; 1087362cd22SMichal Malý const signed short *ff_effects; 1092a552c30SMichal Malý const u16 min_range; 1102a552c30SMichal Malý const u16 max_range; 11130bb75d7SMichal Malý void (*set_range)(struct hid_device *hid, u16 range); 1127362cd22SMichal Malý }; 1137362cd22SMichal Malý 114e7c23449SMichal Malý struct lg4ff_compat_mode_switch { 1152a552c30SMichal Malý const u8 cmd_count; /* Number of commands to send */ 1162a552c30SMichal Malý const u8 cmd[]; 117e7c23449SMichal Malý }; 118e7c23449SMichal Malý 119e7c23449SMichal Malý struct lg4ff_wheel_ident_info { 120bbec1bd0SSimon Wood const u32 modes; 121e7c23449SMichal Malý const u16 mask; 122e7c23449SMichal Malý const u16 result; 123e7c23449SMichal Malý const u16 real_product_id; 124e7c23449SMichal Malý }; 125e7c23449SMichal Malý 126b96d23ecSMichal Malý struct lg4ff_multimode_wheel { 127b96d23ecSMichal Malý const u16 product_id; 128b96d23ecSMichal Malý const u32 alternate_modes; 129b96d23ecSMichal Malý const char *real_tag; 130b96d23ecSMichal Malý const char *real_name; 131b96d23ecSMichal Malý }; 132b96d23ecSMichal Malý 133b96d23ecSMichal Malý struct lg4ff_alternate_mode { 134b96d23ecSMichal Malý const u16 product_id; 135b96d23ecSMichal Malý const char *tag; 136b96d23ecSMichal Malý const char *name; 137b96d23ecSMichal Malý }; 138b96d23ecSMichal Malý 1397362cd22SMichal Malý static const struct lg4ff_wheel lg4ff_devices[] = { 140*560bea30SSimon Wood {USB_DEVICE_ID_LOGITECH_WINGMAN_FFG, lg4ff_wheel_effects, 40, 180, NULL}, 14130bb75d7SMichal Malý {USB_DEVICE_ID_LOGITECH_WHEEL, lg4ff_wheel_effects, 40, 270, NULL}, 14230bb75d7SMichal Malý {USB_DEVICE_ID_LOGITECH_MOMO_WHEEL, lg4ff_wheel_effects, 40, 270, NULL}, 143d0afd848SMichal Malý {USB_DEVICE_ID_LOGITECH_DFP_WHEEL, lg4ff_wheel_effects, 40, 900, lg4ff_set_range_dfp}, 144d0afd848SMichal Malý {USB_DEVICE_ID_LOGITECH_G25_WHEEL, lg4ff_wheel_effects, 40, 900, lg4ff_set_range_g25}, 145d0afd848SMichal Malý {USB_DEVICE_ID_LOGITECH_DFGT_WHEEL, lg4ff_wheel_effects, 40, 900, lg4ff_set_range_g25}, 146d0afd848SMichal Malý {USB_DEVICE_ID_LOGITECH_G27_WHEEL, lg4ff_wheel_effects, 40, 900, lg4ff_set_range_g25}, 14729fae1c8SSimon Wood {USB_DEVICE_ID_LOGITECH_G29_WHEEL, lg4ff_wheel_effects, 40, 900, lg4ff_set_range_g25}, 14830bb75d7SMichal Malý {USB_DEVICE_ID_LOGITECH_MOMO_WHEEL2, lg4ff_wheel_effects, 40, 270, NULL}, 14930bb75d7SMichal Malý {USB_DEVICE_ID_LOGITECH_WII_WHEEL, lg4ff_wheel_effects, 40, 270, NULL} 1507362cd22SMichal Malý }; 1517362cd22SMichal Malý 152b96d23ecSMichal Malý static const struct lg4ff_multimode_wheel lg4ff_multimode_wheels[] = { 153b96d23ecSMichal Malý {USB_DEVICE_ID_LOGITECH_DFP_WHEEL, 154b96d23ecSMichal Malý LG4FF_MODE_NATIVE | LG4FF_MODE_DFP | LG4FF_MODE_DFEX, 155b96d23ecSMichal Malý LG4FF_DFP_TAG, LG4FF_DFP_NAME}, 156b96d23ecSMichal Malý {USB_DEVICE_ID_LOGITECH_G25_WHEEL, 157b96d23ecSMichal Malý LG4FF_MODE_NATIVE | LG4FF_MODE_G25 | LG4FF_MODE_DFP | LG4FF_MODE_DFEX, 158b96d23ecSMichal Malý LG4FF_G25_TAG, LG4FF_G25_NAME}, 159b96d23ecSMichal Malý {USB_DEVICE_ID_LOGITECH_DFGT_WHEEL, 160b96d23ecSMichal Malý LG4FF_MODE_NATIVE | LG4FF_MODE_DFGT | LG4FF_MODE_DFP | LG4FF_MODE_DFEX, 161b96d23ecSMichal Malý LG4FF_DFGT_TAG, LG4FF_DFGT_NAME}, 162b96d23ecSMichal Malý {USB_DEVICE_ID_LOGITECH_G27_WHEEL, 163b96d23ecSMichal Malý LG4FF_MODE_NATIVE | LG4FF_MODE_G27 | LG4FF_MODE_G25 | LG4FF_MODE_DFP | LG4FF_MODE_DFEX, 164b96d23ecSMichal Malý LG4FF_G27_TAG, LG4FF_G27_NAME}, 16529fae1c8SSimon Wood {USB_DEVICE_ID_LOGITECH_G29_WHEEL, 16629fae1c8SSimon Wood LG4FF_MODE_NATIVE | LG4FF_MODE_G29 | LG4FF_MODE_G27 | LG4FF_MODE_G25 | LG4FF_MODE_DFGT | LG4FF_MODE_DFP | LG4FF_MODE_DFEX, 16729fae1c8SSimon Wood LG4FF_G29_TAG, LG4FF_G29_NAME}, 168b96d23ecSMichal Malý }; 169b96d23ecSMichal Malý 170b96d23ecSMichal Malý static const struct lg4ff_alternate_mode lg4ff_alternate_modes[] = { 171b96d23ecSMichal Malý [LG4FF_MODE_NATIVE_IDX] = {0, "native", ""}, 172b96d23ecSMichal Malý [LG4FF_MODE_DFEX_IDX] = {USB_DEVICE_ID_LOGITECH_WHEEL, LG4FF_DFEX_TAG, LG4FF_DFEX_NAME}, 173b96d23ecSMichal Malý [LG4FF_MODE_DFP_IDX] = {USB_DEVICE_ID_LOGITECH_DFP_WHEEL, LG4FF_DFP_TAG, LG4FF_DFP_NAME}, 174b96d23ecSMichal Malý [LG4FF_MODE_G25_IDX] = {USB_DEVICE_ID_LOGITECH_G25_WHEEL, LG4FF_G25_TAG, LG4FF_G25_NAME}, 175b96d23ecSMichal Malý [LG4FF_MODE_DFGT_IDX] = {USB_DEVICE_ID_LOGITECH_DFGT_WHEEL, LG4FF_DFGT_TAG, LG4FF_DFGT_NAME}, 17629fae1c8SSimon Wood [LG4FF_MODE_G27_IDX] = {USB_DEVICE_ID_LOGITECH_G27_WHEEL, LG4FF_G27_TAG, LG4FF_G27_NAME}, 17729fae1c8SSimon Wood [LG4FF_MODE_G29_IDX] = {USB_DEVICE_ID_LOGITECH_G29_WHEEL, LG4FF_G29_TAG, LG4FF_G29_NAME}, 178b96d23ecSMichal Malý }; 179b96d23ecSMichal Malý 180e7c23449SMichal Malý /* Multimode wheel identificators */ 181e7c23449SMichal Malý static const struct lg4ff_wheel_ident_info lg4ff_dfp_ident_info = { 182bbec1bd0SSimon Wood LG4FF_MODE_DFP | LG4FF_MODE_DFEX, 183e7c23449SMichal Malý 0xf000, 184e7c23449SMichal Malý 0x1000, 185e7c23449SMichal Malý USB_DEVICE_ID_LOGITECH_DFP_WHEEL 18696440c8aSMichal Malý }; 18796440c8aSMichal Malý 188e7c23449SMichal Malý static const struct lg4ff_wheel_ident_info lg4ff_g25_ident_info = { 189bbec1bd0SSimon Wood LG4FF_MODE_G25 | LG4FF_MODE_DFP | LG4FF_MODE_DFEX, 190e7c23449SMichal Malý 0xff00, 191e7c23449SMichal Malý 0x1200, 192e7c23449SMichal Malý USB_DEVICE_ID_LOGITECH_G25_WHEEL 19396440c8aSMichal Malý }; 19496440c8aSMichal Malý 195e7c23449SMichal Malý static const struct lg4ff_wheel_ident_info lg4ff_g27_ident_info = { 196bbec1bd0SSimon Wood LG4FF_MODE_G27 | LG4FF_MODE_G25 | LG4FF_MODE_DFP | LG4FF_MODE_DFEX, 197e7c23449SMichal Malý 0xfff0, 198e7c23449SMichal Malý 0x1230, 199e7c23449SMichal Malý USB_DEVICE_ID_LOGITECH_G27_WHEEL 200e7c23449SMichal Malý }; 201e7c23449SMichal Malý 202e7c23449SMichal Malý static const struct lg4ff_wheel_ident_info lg4ff_dfgt_ident_info = { 203bbec1bd0SSimon Wood LG4FF_MODE_DFGT | LG4FF_MODE_DFP | LG4FF_MODE_DFEX, 204e7c23449SMichal Malý 0xff00, 205e7c23449SMichal Malý 0x1300, 206e7c23449SMichal Malý USB_DEVICE_ID_LOGITECH_DFGT_WHEEL 207e7c23449SMichal Malý }; 208e7c23449SMichal Malý 20929fae1c8SSimon Wood static const struct lg4ff_wheel_ident_info lg4ff_g29_ident_info = { 21029fae1c8SSimon Wood LG4FF_MODE_G29 | LG4FF_MODE_G27 | LG4FF_MODE_G25 | LG4FF_MODE_DFGT | LG4FF_MODE_DFP | LG4FF_MODE_DFEX, 21129fae1c8SSimon Wood 0xfff8, 21229fae1c8SSimon Wood 0x1350, 21329fae1c8SSimon Wood USB_DEVICE_ID_LOGITECH_G29_WHEEL 21429fae1c8SSimon Wood }; 21529fae1c8SSimon Wood 21629fae1c8SSimon Wood static const struct lg4ff_wheel_ident_info lg4ff_g29_ident_info2 = { 21729fae1c8SSimon Wood LG4FF_MODE_G29 | LG4FF_MODE_G27 | LG4FF_MODE_G25 | LG4FF_MODE_DFGT | LG4FF_MODE_DFP | LG4FF_MODE_DFEX, 21829fae1c8SSimon Wood 0xff00, 21929fae1c8SSimon Wood 0x8900, 22029fae1c8SSimon Wood USB_DEVICE_ID_LOGITECH_G29_WHEEL 22129fae1c8SSimon Wood }; 22229fae1c8SSimon Wood 223e7c23449SMichal Malý /* Multimode wheel identification checklists */ 224bbec1bd0SSimon Wood static const struct lg4ff_wheel_ident_info *lg4ff_main_checklist[] = { 22529fae1c8SSimon Wood &lg4ff_g29_ident_info, 22629fae1c8SSimon Wood &lg4ff_g29_ident_info2, 227bbec1bd0SSimon Wood &lg4ff_dfgt_ident_info, 228e7c23449SMichal Malý &lg4ff_g27_ident_info, 229e7c23449SMichal Malý &lg4ff_g25_ident_info, 230bbec1bd0SSimon Wood &lg4ff_dfp_ident_info 231e7c23449SMichal Malý }; 232e7c23449SMichal Malý 233e7c23449SMichal Malý /* Compatibility mode switching commands */ 234f31a2de3SMichal Malý /* EXT_CMD9 - Understood by G27 and DFGT */ 235f31a2de3SMichal Malý static const struct lg4ff_compat_mode_switch lg4ff_mode_switch_ext09_dfex = { 236f31a2de3SMichal Malý 2, 237f31a2de3SMichal Malý {0xf8, 0x0a, 0x00, 0x00, 0x00, 0x00, 0x00, /* Revert mode upon USB reset */ 238f31a2de3SMichal Malý 0xf8, 0x09, 0x00, 0x01, 0x00, 0x00, 0x00} /* Switch mode to DF-EX with detach */ 239f31a2de3SMichal Malý }; 240f31a2de3SMichal Malý 241f31a2de3SMichal Malý static const struct lg4ff_compat_mode_switch lg4ff_mode_switch_ext09_dfp = { 242f31a2de3SMichal Malý 2, 243f31a2de3SMichal Malý {0xf8, 0x0a, 0x00, 0x00, 0x00, 0x00, 0x00, /* Revert mode upon USB reset */ 244f31a2de3SMichal Malý 0xf8, 0x09, 0x01, 0x01, 0x00, 0x00, 0x00} /* Switch mode to DFP with detach */ 245f31a2de3SMichal Malý }; 246f31a2de3SMichal Malý 247f31a2de3SMichal Malý static const struct lg4ff_compat_mode_switch lg4ff_mode_switch_ext09_g25 = { 248f31a2de3SMichal Malý 2, 249f31a2de3SMichal Malý {0xf8, 0x0a, 0x00, 0x00, 0x00, 0x00, 0x00, /* Revert mode upon USB reset */ 250f31a2de3SMichal Malý 0xf8, 0x09, 0x02, 0x01, 0x00, 0x00, 0x00} /* Switch mode to G25 with detach */ 251f31a2de3SMichal Malý }; 252f31a2de3SMichal Malý 253f31a2de3SMichal Malý static const struct lg4ff_compat_mode_switch lg4ff_mode_switch_ext09_dfgt = { 254f31a2de3SMichal Malý 2, 255f31a2de3SMichal Malý {0xf8, 0x0a, 0x00, 0x00, 0x00, 0x00, 0x00, /* Revert mode upon USB reset */ 256f31a2de3SMichal Malý 0xf8, 0x09, 0x03, 0x01, 0x00, 0x00, 0x00} /* Switch mode to DFGT with detach */ 257f31a2de3SMichal Malý }; 258f31a2de3SMichal Malý 259f31a2de3SMichal Malý static const struct lg4ff_compat_mode_switch lg4ff_mode_switch_ext09_g27 = { 260f31a2de3SMichal Malý 2, 261f31a2de3SMichal Malý {0xf8, 0x0a, 0x00, 0x00, 0x00, 0x00, 0x00, /* Revert mode upon USB reset */ 262f31a2de3SMichal Malý 0xf8, 0x09, 0x04, 0x01, 0x00, 0x00, 0x00} /* Switch mode to G27 with detach */ 263f31a2de3SMichal Malý }; 264f31a2de3SMichal Malý 26529fae1c8SSimon Wood static const struct lg4ff_compat_mode_switch lg4ff_mode_switch_ext09_g29 = { 26629fae1c8SSimon Wood 2, 26729fae1c8SSimon Wood {0xf8, 0x0a, 0x00, 0x00, 0x00, 0x00, 0x00, /* Revert mode upon USB reset */ 26829fae1c8SSimon Wood 0xf8, 0x09, 0x05, 0x01, 0x01, 0x00, 0x00} /* Switch mode to G29 with detach */ 26929fae1c8SSimon Wood }; 27029fae1c8SSimon Wood 271f31a2de3SMichal Malý /* EXT_CMD1 - Understood by DFP, G25, G27 and DFGT */ 272f31a2de3SMichal Malý static const struct lg4ff_compat_mode_switch lg4ff_mode_switch_ext01_dfp = { 27396440c8aSMichal Malý 1, 27496440c8aSMichal Malý {0xf8, 0x01, 0x00, 0x00, 0x00, 0x00, 0x00} 27596440c8aSMichal Malý }; 27696440c8aSMichal Malý 277f31a2de3SMichal Malý /* EXT_CMD16 - Understood by G25 and G27 */ 278f31a2de3SMichal Malý static const struct lg4ff_compat_mode_switch lg4ff_mode_switch_ext16_g25 = { 27996440c8aSMichal Malý 1, 28096440c8aSMichal Malý {0xf8, 0x10, 0x00, 0x00, 0x00, 0x00, 0x00} 28196440c8aSMichal Malý }; 28296440c8aSMichal Malý 2832b24a960SMichal Malý /* Recalculates X axis value accordingly to currently selected range */ 2842a552c30SMichal Malý static s32 lg4ff_adjust_dfp_x_axis(s32 value, u16 range) 2852b24a960SMichal Malý { 2862a552c30SMichal Malý u16 max_range; 2872a552c30SMichal Malý s32 new_value; 2882b24a960SMichal Malý 2892b24a960SMichal Malý if (range == 900) 2902b24a960SMichal Malý return value; 2912b24a960SMichal Malý else if (range == 200) 2922b24a960SMichal Malý return value; 2932b24a960SMichal Malý else if (range < 200) 2942b24a960SMichal Malý max_range = 200; 2952b24a960SMichal Malý else 2962b24a960SMichal Malý max_range = 900; 2972b24a960SMichal Malý 2982b24a960SMichal Malý new_value = 8192 + mult_frac(value - 8192, max_range, range); 2992b24a960SMichal Malý if (new_value < 0) 3002b24a960SMichal Malý return 0; 3012b24a960SMichal Malý else if (new_value > 16383) 3022b24a960SMichal Malý return 16383; 3032b24a960SMichal Malý else 3042b24a960SMichal Malý return new_value; 3052b24a960SMichal Malý } 3062b24a960SMichal Malý 3072b24a960SMichal Malý int lg4ff_adjust_input_event(struct hid_device *hid, struct hid_field *field, 3082a552c30SMichal Malý struct hid_usage *usage, s32 value, struct lg_drv_data *drv_data) 3092b24a960SMichal Malý { 3102b24a960SMichal Malý struct lg4ff_device_entry *entry = drv_data->device_props; 3112a552c30SMichal Malý s32 new_value = 0; 3122b24a960SMichal Malý 3132b24a960SMichal Malý if (!entry) { 3142b24a960SMichal Malý hid_err(hid, "Device properties not found"); 3152b24a960SMichal Malý return 0; 3162b24a960SMichal Malý } 3172b24a960SMichal Malý 31872529c65SMichal Malý switch (entry->wdata.product_id) { 3192b24a960SMichal Malý case USB_DEVICE_ID_LOGITECH_DFP_WHEEL: 3202b24a960SMichal Malý switch (usage->code) { 3212b24a960SMichal Malý case ABS_X: 32272529c65SMichal Malý new_value = lg4ff_adjust_dfp_x_axis(value, entry->wdata.range); 3232b24a960SMichal Malý input_event(field->hidinput->input, usage->type, usage->code, new_value); 3242b24a960SMichal Malý return 1; 3252b24a960SMichal Malý default: 3262b24a960SMichal Malý return 0; 3272b24a960SMichal Malý } 3282b24a960SMichal Malý default: 3292b24a960SMichal Malý return 0; 3302b24a960SMichal Malý } 3312b24a960SMichal Malý } 3322b24a960SMichal Malý 333c832f86eSSimon Wood int lg4ff_raw_event(struct hid_device *hdev, struct hid_report *report, 334c832f86eSSimon Wood u8 *rd, int size, struct lg_drv_data *drv_data) 335c832f86eSSimon Wood { 336b456634bSSimon Wood int offset; 337c832f86eSSimon Wood struct lg4ff_device_entry *entry = drv_data->device_props; 338c832f86eSSimon Wood 339c832f86eSSimon Wood if (!entry) 340c832f86eSSimon Wood return 0; 341c832f86eSSimon Wood 342c832f86eSSimon Wood /* adjust HID report present combined pedals data */ 343c832f86eSSimon Wood if (entry->wdata.combine) { 344c832f86eSSimon Wood switch (entry->wdata.product_id) { 345c832f86eSSimon Wood case USB_DEVICE_ID_LOGITECH_WHEEL: 346c832f86eSSimon Wood rd[5] = rd[3]; 347c832f86eSSimon Wood rd[6] = 0x7F; 348c832f86eSSimon Wood return 1; 349*560bea30SSimon Wood case USB_DEVICE_ID_LOGITECH_WINGMAN_FFG: 350c832f86eSSimon Wood case USB_DEVICE_ID_LOGITECH_MOMO_WHEEL: 351c832f86eSSimon Wood case USB_DEVICE_ID_LOGITECH_MOMO_WHEEL2: 352c832f86eSSimon Wood rd[4] = rd[3]; 353c832f86eSSimon Wood rd[5] = 0x7F; 354c832f86eSSimon Wood return 1; 355c832f86eSSimon Wood case USB_DEVICE_ID_LOGITECH_DFP_WHEEL: 356c832f86eSSimon Wood rd[5] = rd[4]; 357c832f86eSSimon Wood rd[6] = 0x7F; 358c832f86eSSimon Wood return 1; 359b456634bSSimon Wood case USB_DEVICE_ID_LOGITECH_G25_WHEEL: 360b456634bSSimon Wood case USB_DEVICE_ID_LOGITECH_G27_WHEEL: 361b456634bSSimon Wood offset = 5; 362b456634bSSimon Wood break; 363b456634bSSimon Wood case USB_DEVICE_ID_LOGITECH_DFGT_WHEEL: 364b456634bSSimon Wood case USB_DEVICE_ID_LOGITECH_G29_WHEEL: 365b456634bSSimon Wood offset = 6; 366b456634bSSimon Wood break; 367b456634bSSimon Wood case USB_DEVICE_ID_LOGITECH_WII_WHEEL: 368b456634bSSimon Wood offset = 3; 369b456634bSSimon Wood break; 370c832f86eSSimon Wood default: 371c832f86eSSimon Wood return 0; 372c832f86eSSimon Wood } 373b456634bSSimon Wood 374b456634bSSimon Wood /* Compute a combined axis when wheel does not supply it */ 375b456634bSSimon Wood rd[offset] = (0xFF + rd[offset] - rd[offset+1]) >> 1; 376b456634bSSimon Wood rd[offset+1] = 0x7F; 377b456634bSSimon Wood return 1; 378c832f86eSSimon Wood } 379c832f86eSSimon Wood 380c832f86eSSimon Wood return 0; 381c832f86eSSimon Wood } 382c832f86eSSimon Wood 3835d9d60adSMichal Malý static void lg4ff_init_wheel_data(struct lg4ff_wheel_data * const wdata, const struct lg4ff_wheel *wheel, 3845d9d60adSMichal Malý const struct lg4ff_multimode_wheel *mmode_wheel, 3855d9d60adSMichal Malý const u16 real_product_id) 3865d9d60adSMichal Malý { 3875d9d60adSMichal Malý u32 alternate_modes = 0; 3885d9d60adSMichal Malý const char *real_tag = NULL; 3895d9d60adSMichal Malý const char *real_name = NULL; 3905d9d60adSMichal Malý 3915d9d60adSMichal Malý if (mmode_wheel) { 3925d9d60adSMichal Malý alternate_modes = mmode_wheel->alternate_modes; 3935d9d60adSMichal Malý real_tag = mmode_wheel->real_tag; 3945d9d60adSMichal Malý real_name = mmode_wheel->real_name; 3955d9d60adSMichal Malý } 3965d9d60adSMichal Malý 3975d9d60adSMichal Malý { 3985d9d60adSMichal Malý struct lg4ff_wheel_data t_wdata = { .product_id = wheel->product_id, 3995d9d60adSMichal Malý .real_product_id = real_product_id, 400961af46fSSimon Wood .combine = 0, 4015d9d60adSMichal Malý .min_range = wheel->min_range, 4025d9d60adSMichal Malý .max_range = wheel->max_range, 4035d9d60adSMichal Malý .set_range = wheel->set_range, 4045d9d60adSMichal Malý .alternate_modes = alternate_modes, 4055d9d60adSMichal Malý .real_tag = real_tag, 4065d9d60adSMichal Malý .real_name = real_name }; 4075d9d60adSMichal Malý 4085d9d60adSMichal Malý memcpy(wdata, &t_wdata, sizeof(t_wdata)); 4095d9d60adSMichal Malý } 4105d9d60adSMichal Malý } 4115d9d60adSMichal Malý 412d0afd848SMichal Malý static int lg4ff_play(struct input_dev *dev, void *data, struct ff_effect *effect) 41332c88cbcSSimon Wood { 41432c88cbcSSimon Wood struct hid_device *hid = input_get_drvdata(dev); 415c918fe78SMichal Malý struct lg4ff_device_entry *entry; 416c918fe78SMichal Malý struct lg_drv_data *drv_data; 417c918fe78SMichal Malý unsigned long flags; 418c28abd8cSMichal Malý s32 *value; 41932c88cbcSSimon Wood int x; 42032c88cbcSSimon Wood 421c918fe78SMichal Malý drv_data = hid_get_drvdata(hid); 422c918fe78SMichal Malý if (!drv_data) { 423c918fe78SMichal Malý hid_err(hid, "Private driver data not found!\n"); 424c918fe78SMichal Malý return -EINVAL; 425c918fe78SMichal Malý } 426c918fe78SMichal Malý 427c918fe78SMichal Malý entry = drv_data->device_props; 428c918fe78SMichal Malý if (!entry) { 429c918fe78SMichal Malý hid_err(hid, "Device properties not found!\n"); 430c918fe78SMichal Malý return -EINVAL; 431c918fe78SMichal Malý } 432c28abd8cSMichal Malý value = entry->report->field[0]->value; 433c918fe78SMichal Malý 434a80fe5d6SMichal Malý #define CLAMP(x) do { if (x < 0) x = 0; else if (x > 0xff) x = 0xff; } while (0) 43532c88cbcSSimon Wood 43632c88cbcSSimon Wood switch (effect->type) { 43732c88cbcSSimon Wood case FF_CONSTANT: 43832c88cbcSSimon Wood x = effect->u.ramp.start_level + 0x80; /* 0x80 is no force */ 43932c88cbcSSimon Wood CLAMP(x); 44056930e7aSSimon Wood 441c918fe78SMichal Malý spin_lock_irqsave(&entry->report_lock, flags); 44256930e7aSSimon Wood if (x == 0x80) { 44356930e7aSSimon Wood /* De-activate force in slot-1*/ 44456930e7aSSimon Wood value[0] = 0x13; 44556930e7aSSimon Wood value[1] = 0x00; 44656930e7aSSimon Wood value[2] = 0x00; 44756930e7aSSimon Wood value[3] = 0x00; 44856930e7aSSimon Wood value[4] = 0x00; 44956930e7aSSimon Wood value[5] = 0x00; 45056930e7aSSimon Wood value[6] = 0x00; 45156930e7aSSimon Wood 452c28abd8cSMichal Malý hid_hw_request(hid, entry->report, HID_REQ_SET_REPORT); 453c918fe78SMichal Malý spin_unlock_irqrestore(&entry->report_lock, flags); 45456930e7aSSimon Wood return 0; 45556930e7aSSimon Wood } 45656930e7aSSimon Wood 45774479ba8SMichal Malý value[0] = 0x11; /* Slot 1 */ 45874479ba8SMichal Malý value[1] = 0x08; 45974479ba8SMichal Malý value[2] = x; 46074479ba8SMichal Malý value[3] = 0x80; 46174479ba8SMichal Malý value[4] = 0x00; 46274479ba8SMichal Malý value[5] = 0x00; 46374479ba8SMichal Malý value[6] = 0x00; 46432c88cbcSSimon Wood 465c28abd8cSMichal Malý hid_hw_request(hid, entry->report, HID_REQ_SET_REPORT); 466c918fe78SMichal Malý spin_unlock_irqrestore(&entry->report_lock, flags); 46732c88cbcSSimon Wood break; 46832c88cbcSSimon Wood } 46932c88cbcSSimon Wood return 0; 47032c88cbcSSimon Wood } 47132c88cbcSSimon Wood 4726e2de8e0SMichal Malý /* Sends default autocentering command compatible with 4736e2de8e0SMichal Malý * all wheels except Formula Force EX */ 474d0afd848SMichal Malý static void lg4ff_set_autocenter_default(struct input_dev *dev, u16 magnitude) 47532c88cbcSSimon Wood { 47632c88cbcSSimon Wood struct hid_device *hid = input_get_drvdata(dev); 47732c88cbcSSimon Wood struct list_head *report_list = &hid->report_enum[HID_OUTPUT_REPORT].report_list; 47832c88cbcSSimon Wood struct hid_report *report = list_entry(report_list->next, struct hid_report, list); 4792a552c30SMichal Malý s32 *value = report->field[0]->value; 4802a552c30SMichal Malý u32 expand_a, expand_b; 4811859762eSSimon Wood struct lg4ff_device_entry *entry; 4821859762eSSimon Wood struct lg_drv_data *drv_data; 483c918fe78SMichal Malý unsigned long flags; 4841859762eSSimon Wood 4851859762eSSimon Wood drv_data = hid_get_drvdata(hid); 4861859762eSSimon Wood if (!drv_data) { 4871859762eSSimon Wood hid_err(hid, "Private driver data not found!\n"); 4881859762eSSimon Wood return; 4891859762eSSimon Wood } 4901859762eSSimon Wood 4911859762eSSimon Wood entry = drv_data->device_props; 4921859762eSSimon Wood if (!entry) { 4931859762eSSimon Wood hid_err(hid, "Device properties not found!\n"); 4941859762eSSimon Wood return; 4951859762eSSimon Wood } 496c28abd8cSMichal Malý value = entry->report->field[0]->value; 497f8c23156SSimon Wood 498d2c02da5SSimon Wood /* De-activate Auto-Center */ 499c918fe78SMichal Malý spin_lock_irqsave(&entry->report_lock, flags); 500d2c02da5SSimon Wood if (magnitude == 0) { 501d2c02da5SSimon Wood value[0] = 0xf5; 502d2c02da5SSimon Wood value[1] = 0x00; 503d2c02da5SSimon Wood value[2] = 0x00; 504d2c02da5SSimon Wood value[3] = 0x00; 505d2c02da5SSimon Wood value[4] = 0x00; 506d2c02da5SSimon Wood value[5] = 0x00; 507d2c02da5SSimon Wood value[6] = 0x00; 508d2c02da5SSimon Wood 509c28abd8cSMichal Malý hid_hw_request(hid, entry->report, HID_REQ_SET_REPORT); 510c918fe78SMichal Malý spin_unlock_irqrestore(&entry->report_lock, flags); 511d2c02da5SSimon Wood return; 512d2c02da5SSimon Wood } 513d2c02da5SSimon Wood 514f8c23156SSimon Wood if (magnitude <= 0xaaaa) { 515f8c23156SSimon Wood expand_a = 0x0c * magnitude; 516f8c23156SSimon Wood expand_b = 0x80 * magnitude; 517f8c23156SSimon Wood } else { 518f8c23156SSimon Wood expand_a = (0x0c * 0xaaaa) + 0x06 * (magnitude - 0xaaaa); 519f8c23156SSimon Wood expand_b = (0x80 * 0xaaaa) + 0xff * (magnitude - 0xaaaa); 520f8c23156SSimon Wood } 52132c88cbcSSimon Wood 5221859762eSSimon Wood /* Adjust for non-MOMO wheels */ 52372529c65SMichal Malý switch (entry->wdata.product_id) { 5241859762eSSimon Wood case USB_DEVICE_ID_LOGITECH_MOMO_WHEEL: 5251859762eSSimon Wood case USB_DEVICE_ID_LOGITECH_MOMO_WHEEL2: 5261859762eSSimon Wood break; 5271859762eSSimon Wood default: 5281859762eSSimon Wood expand_a = expand_a >> 1; 5291859762eSSimon Wood break; 5301859762eSSimon Wood } 5311859762eSSimon Wood 53274479ba8SMichal Malý value[0] = 0xfe; 53374479ba8SMichal Malý value[1] = 0x0d; 534f8c23156SSimon Wood value[2] = expand_a / 0xaaaa; 535f8c23156SSimon Wood value[3] = expand_a / 0xaaaa; 536f8c23156SSimon Wood value[4] = expand_b / 0xaaaa; 53774479ba8SMichal Malý value[5] = 0x00; 53874479ba8SMichal Malý value[6] = 0x00; 53932c88cbcSSimon Wood 540c28abd8cSMichal Malý hid_hw_request(hid, entry->report, HID_REQ_SET_REPORT); 541d2c02da5SSimon Wood 542d2c02da5SSimon Wood /* Activate Auto-Center */ 543d2c02da5SSimon Wood value[0] = 0x14; 544d2c02da5SSimon Wood value[1] = 0x00; 545d2c02da5SSimon Wood value[2] = 0x00; 546d2c02da5SSimon Wood value[3] = 0x00; 547d2c02da5SSimon Wood value[4] = 0x00; 548d2c02da5SSimon Wood value[5] = 0x00; 549d2c02da5SSimon Wood value[6] = 0x00; 550d2c02da5SSimon Wood 551c28abd8cSMichal Malý hid_hw_request(hid, entry->report, HID_REQ_SET_REPORT); 552c918fe78SMichal Malý spin_unlock_irqrestore(&entry->report_lock, flags); 55332c88cbcSSimon Wood } 55432c88cbcSSimon Wood 5556e2de8e0SMichal Malý /* Sends autocentering command compatible with Formula Force EX */ 556d0afd848SMichal Malý static void lg4ff_set_autocenter_ffex(struct input_dev *dev, u16 magnitude) 5576e2de8e0SMichal Malý { 5586e2de8e0SMichal Malý struct hid_device *hid = input_get_drvdata(dev); 559c918fe78SMichal Malý struct lg4ff_device_entry *entry; 560c918fe78SMichal Malý struct lg_drv_data *drv_data; 561c918fe78SMichal Malý unsigned long flags; 562c28abd8cSMichal Malý s32 *value; 5636e2de8e0SMichal Malý magnitude = magnitude * 90 / 65535; 5646e2de8e0SMichal Malý 565c918fe78SMichal Malý drv_data = hid_get_drvdata(hid); 566c918fe78SMichal Malý if (!drv_data) { 567c918fe78SMichal Malý hid_err(hid, "Private driver data not found!\n"); 568c918fe78SMichal Malý return; 569c918fe78SMichal Malý } 570c918fe78SMichal Malý 571c918fe78SMichal Malý entry = drv_data->device_props; 572c918fe78SMichal Malý if (!entry) { 573c918fe78SMichal Malý hid_err(hid, "Device properties not found!\n"); 574c918fe78SMichal Malý return; 575c918fe78SMichal Malý } 576c28abd8cSMichal Malý value = entry->report->field[0]->value; 577c918fe78SMichal Malý 578c918fe78SMichal Malý spin_lock_irqsave(&entry->report_lock, flags); 57974479ba8SMichal Malý value[0] = 0xfe; 58074479ba8SMichal Malý value[1] = 0x03; 58174479ba8SMichal Malý value[2] = magnitude >> 14; 58274479ba8SMichal Malý value[3] = magnitude >> 14; 58374479ba8SMichal Malý value[4] = magnitude; 58474479ba8SMichal Malý value[5] = 0x00; 58574479ba8SMichal Malý value[6] = 0x00; 5866e2de8e0SMichal Malý 587c28abd8cSMichal Malý hid_hw_request(hid, entry->report, HID_REQ_SET_REPORT); 588c918fe78SMichal Malý spin_unlock_irqrestore(&entry->report_lock, flags); 5896e2de8e0SMichal Malý } 5906e2de8e0SMichal Malý 59130bb75d7SMichal Malý /* Sends command to set range compatible with G25/G27/Driving Force GT */ 592d0afd848SMichal Malý static void lg4ff_set_range_g25(struct hid_device *hid, u16 range) 59330bb75d7SMichal Malý { 594c918fe78SMichal Malý struct lg4ff_device_entry *entry; 595c918fe78SMichal Malý struct lg_drv_data *drv_data; 596c918fe78SMichal Malý unsigned long flags; 597c28abd8cSMichal Malý s32 *value; 59874479ba8SMichal Malý 599c918fe78SMichal Malý drv_data = hid_get_drvdata(hid); 600c918fe78SMichal Malý if (!drv_data) { 601c918fe78SMichal Malý hid_err(hid, "Private driver data not found!\n"); 602c918fe78SMichal Malý return; 603c918fe78SMichal Malý } 604c918fe78SMichal Malý 605c918fe78SMichal Malý entry = drv_data->device_props; 606c918fe78SMichal Malý if (!entry) { 607c918fe78SMichal Malý hid_err(hid, "Device properties not found!\n"); 608c918fe78SMichal Malý return; 609c918fe78SMichal Malý } 610c28abd8cSMichal Malý value = entry->report->field[0]->value; 61130bb75d7SMichal Malý dbg_hid("G25/G27/DFGT: setting range to %u\n", range); 61230bb75d7SMichal Malý 613c918fe78SMichal Malý spin_lock_irqsave(&entry->report_lock, flags); 61474479ba8SMichal Malý value[0] = 0xf8; 61574479ba8SMichal Malý value[1] = 0x81; 61674479ba8SMichal Malý value[2] = range & 0x00ff; 61774479ba8SMichal Malý value[3] = (range & 0xff00) >> 8; 61874479ba8SMichal Malý value[4] = 0x00; 61974479ba8SMichal Malý value[5] = 0x00; 62074479ba8SMichal Malý value[6] = 0x00; 62130bb75d7SMichal Malý 622c28abd8cSMichal Malý hid_hw_request(hid, entry->report, HID_REQ_SET_REPORT); 623c918fe78SMichal Malý spin_unlock_irqrestore(&entry->report_lock, flags); 62430bb75d7SMichal Malý } 62530bb75d7SMichal Malý 62630bb75d7SMichal Malý /* Sends commands to set range compatible with Driving Force Pro wheel */ 627d0afd848SMichal Malý static void lg4ff_set_range_dfp(struct hid_device *hid, u16 range) 62830bb75d7SMichal Malý { 629c918fe78SMichal Malý struct lg4ff_device_entry *entry; 630c918fe78SMichal Malý struct lg_drv_data *drv_data; 631c918fe78SMichal Malý unsigned long flags; 632c28abd8cSMichal Malý int start_left, start_right, full_range; 633c28abd8cSMichal Malý s32 *value; 63474479ba8SMichal Malý 635c918fe78SMichal Malý drv_data = hid_get_drvdata(hid); 636c918fe78SMichal Malý if (!drv_data) { 637c918fe78SMichal Malý hid_err(hid, "Private driver data not found!\n"); 638c918fe78SMichal Malý return; 639c918fe78SMichal Malý } 640c918fe78SMichal Malý 641c918fe78SMichal Malý entry = drv_data->device_props; 642c918fe78SMichal Malý if (!entry) { 643c918fe78SMichal Malý hid_err(hid, "Device properties not found!\n"); 644c918fe78SMichal Malý return; 645c918fe78SMichal Malý } 646c28abd8cSMichal Malý value = entry->report->field[0]->value; 64730bb75d7SMichal Malý dbg_hid("Driving Force Pro: setting range to %u\n", range); 64830bb75d7SMichal Malý 64930bb75d7SMichal Malý /* Prepare "coarse" limit command */ 650c918fe78SMichal Malý spin_lock_irqsave(&entry->report_lock, flags); 65174479ba8SMichal Malý value[0] = 0xf8; 65274479ba8SMichal Malý value[1] = 0x00; /* Set later */ 65374479ba8SMichal Malý value[2] = 0x00; 65474479ba8SMichal Malý value[3] = 0x00; 65574479ba8SMichal Malý value[4] = 0x00; 65674479ba8SMichal Malý value[5] = 0x00; 65774479ba8SMichal Malý value[6] = 0x00; 65830bb75d7SMichal Malý 65930bb75d7SMichal Malý if (range > 200) { 660c28abd8cSMichal Malý value[1] = 0x03; 66130bb75d7SMichal Malý full_range = 900; 66230bb75d7SMichal Malý } else { 663c28abd8cSMichal Malý value[1] = 0x02; 66430bb75d7SMichal Malý full_range = 200; 66530bb75d7SMichal Malý } 666c28abd8cSMichal Malý hid_hw_request(hid, entry->report, HID_REQ_SET_REPORT); 66730bb75d7SMichal Malý 66830bb75d7SMichal Malý /* Prepare "fine" limit command */ 66974479ba8SMichal Malý value[0] = 0x81; 67074479ba8SMichal Malý value[1] = 0x0b; 67174479ba8SMichal Malý value[2] = 0x00; 67274479ba8SMichal Malý value[3] = 0x00; 67374479ba8SMichal Malý value[4] = 0x00; 67474479ba8SMichal Malý value[5] = 0x00; 67574479ba8SMichal Malý value[6] = 0x00; 67630bb75d7SMichal Malý 67730bb75d7SMichal Malý if (range == 200 || range == 900) { /* Do not apply any fine limit */ 678c28abd8cSMichal Malý hid_hw_request(hid, entry->report, HID_REQ_SET_REPORT); 679c918fe78SMichal Malý spin_unlock_irqrestore(&entry->report_lock, flags); 68030bb75d7SMichal Malý return; 68130bb75d7SMichal Malý } 68230bb75d7SMichal Malý 68330bb75d7SMichal Malý /* Construct fine limit command */ 68430bb75d7SMichal Malý start_left = (((full_range - range + 1) * 2047) / full_range); 68530bb75d7SMichal Malý start_right = 0xfff - start_left; 68630bb75d7SMichal Malý 68774479ba8SMichal Malý value[2] = start_left >> 4; 68874479ba8SMichal Malý value[3] = start_right >> 4; 68974479ba8SMichal Malý value[4] = 0xff; 69074479ba8SMichal Malý value[5] = (start_right & 0xe) << 4 | (start_left & 0xe); 69174479ba8SMichal Malý value[6] = 0xff; 69230bb75d7SMichal Malý 693c28abd8cSMichal Malý hid_hw_request(hid, entry->report, HID_REQ_SET_REPORT); 694c918fe78SMichal Malý spin_unlock_irqrestore(&entry->report_lock, flags); 69530bb75d7SMichal Malý } 69630bb75d7SMichal Malý 697f31a2de3SMichal Malý static const struct lg4ff_compat_mode_switch *lg4ff_get_mode_switch_command(const u16 real_product_id, const u16 target_product_id) 698f31a2de3SMichal Malý { 699f31a2de3SMichal Malý switch (real_product_id) { 700f31a2de3SMichal Malý case USB_DEVICE_ID_LOGITECH_DFP_WHEEL: 701f31a2de3SMichal Malý switch (target_product_id) { 702f31a2de3SMichal Malý case USB_DEVICE_ID_LOGITECH_DFP_WHEEL: 703f31a2de3SMichal Malý return &lg4ff_mode_switch_ext01_dfp; 704f31a2de3SMichal Malý /* DFP can only be switched to its native mode */ 705f31a2de3SMichal Malý default: 706f31a2de3SMichal Malý return NULL; 707f31a2de3SMichal Malý } 708f31a2de3SMichal Malý break; 709f31a2de3SMichal Malý case USB_DEVICE_ID_LOGITECH_G25_WHEEL: 710f31a2de3SMichal Malý switch (target_product_id) { 711f31a2de3SMichal Malý case USB_DEVICE_ID_LOGITECH_DFP_WHEEL: 712f31a2de3SMichal Malý return &lg4ff_mode_switch_ext01_dfp; 713f31a2de3SMichal Malý case USB_DEVICE_ID_LOGITECH_G25_WHEEL: 714f31a2de3SMichal Malý return &lg4ff_mode_switch_ext16_g25; 715f31a2de3SMichal Malý /* G25 can only be switched to DFP mode or its native mode */ 716f31a2de3SMichal Malý default: 717f31a2de3SMichal Malý return NULL; 718f31a2de3SMichal Malý } 719f31a2de3SMichal Malý break; 720f31a2de3SMichal Malý case USB_DEVICE_ID_LOGITECH_G27_WHEEL: 721f31a2de3SMichal Malý switch (target_product_id) { 722f31a2de3SMichal Malý case USB_DEVICE_ID_LOGITECH_WHEEL: 723f31a2de3SMichal Malý return &lg4ff_mode_switch_ext09_dfex; 724f31a2de3SMichal Malý case USB_DEVICE_ID_LOGITECH_DFP_WHEEL: 725f31a2de3SMichal Malý return &lg4ff_mode_switch_ext09_dfp; 726f31a2de3SMichal Malý case USB_DEVICE_ID_LOGITECH_G25_WHEEL: 727f31a2de3SMichal Malý return &lg4ff_mode_switch_ext09_g25; 728f31a2de3SMichal Malý case USB_DEVICE_ID_LOGITECH_G27_WHEEL: 729f31a2de3SMichal Malý return &lg4ff_mode_switch_ext09_g27; 730f31a2de3SMichal Malý /* G27 can only be switched to DF-EX, DFP, G25 or its native mode */ 731f31a2de3SMichal Malý default: 732f31a2de3SMichal Malý return NULL; 733f31a2de3SMichal Malý } 734f31a2de3SMichal Malý break; 73529fae1c8SSimon Wood case USB_DEVICE_ID_LOGITECH_G29_WHEEL: 73629fae1c8SSimon Wood switch (target_product_id) { 73729fae1c8SSimon Wood case USB_DEVICE_ID_LOGITECH_DFP_WHEEL: 73829fae1c8SSimon Wood return &lg4ff_mode_switch_ext09_dfp; 73929fae1c8SSimon Wood case USB_DEVICE_ID_LOGITECH_DFGT_WHEEL: 74029fae1c8SSimon Wood return &lg4ff_mode_switch_ext09_dfgt; 74129fae1c8SSimon Wood case USB_DEVICE_ID_LOGITECH_G25_WHEEL: 74229fae1c8SSimon Wood return &lg4ff_mode_switch_ext09_g25; 74329fae1c8SSimon Wood case USB_DEVICE_ID_LOGITECH_G27_WHEEL: 74429fae1c8SSimon Wood return &lg4ff_mode_switch_ext09_g27; 74529fae1c8SSimon Wood case USB_DEVICE_ID_LOGITECH_G29_WHEEL: 74629fae1c8SSimon Wood return &lg4ff_mode_switch_ext09_g29; 74729fae1c8SSimon Wood /* G29 can only be switched to DF-EX, DFP, DFGT, G25, G27 or its native mode */ 74829fae1c8SSimon Wood default: 74929fae1c8SSimon Wood return NULL; 75029fae1c8SSimon Wood } 75129fae1c8SSimon Wood break; 752f31a2de3SMichal Malý case USB_DEVICE_ID_LOGITECH_DFGT_WHEEL: 753f31a2de3SMichal Malý switch (target_product_id) { 754f31a2de3SMichal Malý case USB_DEVICE_ID_LOGITECH_WHEEL: 755f31a2de3SMichal Malý return &lg4ff_mode_switch_ext09_dfex; 756f31a2de3SMichal Malý case USB_DEVICE_ID_LOGITECH_DFP_WHEEL: 757f31a2de3SMichal Malý return &lg4ff_mode_switch_ext09_dfp; 758f31a2de3SMichal Malý case USB_DEVICE_ID_LOGITECH_DFGT_WHEEL: 759f31a2de3SMichal Malý return &lg4ff_mode_switch_ext09_dfgt; 760f31a2de3SMichal Malý /* DFGT can only be switched to DF-EX, DFP or its native mode */ 761f31a2de3SMichal Malý default: 762f31a2de3SMichal Malý return NULL; 763f31a2de3SMichal Malý } 764f31a2de3SMichal Malý break; 765f31a2de3SMichal Malý /* No other wheels have multiple modes */ 766f31a2de3SMichal Malý default: 767f31a2de3SMichal Malý return NULL; 768f31a2de3SMichal Malý } 769f31a2de3SMichal Malý } 770f31a2de3SMichal Malý 771e7c23449SMichal Malý static int lg4ff_switch_compatibility_mode(struct hid_device *hid, const struct lg4ff_compat_mode_switch *s) 77296440c8aSMichal Malý { 773c918fe78SMichal Malý struct lg4ff_device_entry *entry; 774c918fe78SMichal Malý struct lg_drv_data *drv_data; 775c918fe78SMichal Malý unsigned long flags; 776c28abd8cSMichal Malý s32 *value; 777e7c23449SMichal Malý u8 i; 77896440c8aSMichal Malý 779c918fe78SMichal Malý drv_data = hid_get_drvdata(hid); 780c918fe78SMichal Malý if (!drv_data) { 781c918fe78SMichal Malý hid_err(hid, "Private driver data not found!\n"); 782c918fe78SMichal Malý return -EINVAL; 783c918fe78SMichal Malý } 784c918fe78SMichal Malý 785c918fe78SMichal Malý entry = drv_data->device_props; 786c918fe78SMichal Malý if (!entry) { 787c918fe78SMichal Malý hid_err(hid, "Device properties not found!\n"); 788c918fe78SMichal Malý return -EINVAL; 789c918fe78SMichal Malý } 790c28abd8cSMichal Malý value = entry->report->field[0]->value; 791c918fe78SMichal Malý 792c918fe78SMichal Malý spin_lock_irqsave(&entry->report_lock, flags); 793e7c23449SMichal Malý for (i = 0; i < s->cmd_count; i++) { 794c1740d13SMichal Malý u8 j; 79596440c8aSMichal Malý 796c1740d13SMichal Malý for (j = 0; j < 7; j++) 797c1740d13SMichal Malý value[j] = s->cmd[j + (7*i)]; 798c1740d13SMichal Malý 799c28abd8cSMichal Malý hid_hw_request(hid, entry->report, HID_REQ_SET_REPORT); 80096440c8aSMichal Malý } 801c918fe78SMichal Malý spin_unlock_irqrestore(&entry->report_lock, flags); 802c1740d13SMichal Malý hid_hw_wait(hid); 803e7c23449SMichal Malý return 0; 80496440c8aSMichal Malý } 80532c88cbcSSimon Wood 806b96d23ecSMichal Malý static ssize_t lg4ff_alternate_modes_show(struct device *dev, struct device_attribute *attr, char *buf) 807b96d23ecSMichal Malý { 808b96d23ecSMichal Malý struct hid_device *hid = to_hid_device(dev); 809b96d23ecSMichal Malý struct lg4ff_device_entry *entry; 810b96d23ecSMichal Malý struct lg_drv_data *drv_data; 811b96d23ecSMichal Malý ssize_t count = 0; 812b96d23ecSMichal Malý int i; 813b96d23ecSMichal Malý 814b96d23ecSMichal Malý drv_data = hid_get_drvdata(hid); 815b96d23ecSMichal Malý if (!drv_data) { 816b96d23ecSMichal Malý hid_err(hid, "Private driver data not found!\n"); 817b96d23ecSMichal Malý return 0; 818b96d23ecSMichal Malý } 819b96d23ecSMichal Malý 820b96d23ecSMichal Malý entry = drv_data->device_props; 821b96d23ecSMichal Malý if (!entry) { 822b96d23ecSMichal Malý hid_err(hid, "Device properties not found!\n"); 823b96d23ecSMichal Malý return 0; 824b96d23ecSMichal Malý } 825b96d23ecSMichal Malý 82672529c65SMichal Malý if (!entry->wdata.real_name) { 827b96d23ecSMichal Malý hid_err(hid, "NULL pointer to string\n"); 828b96d23ecSMichal Malý return 0; 829b96d23ecSMichal Malý } 830b96d23ecSMichal Malý 831b96d23ecSMichal Malý for (i = 0; i < LG4FF_MODE_MAX_IDX; i++) { 83272529c65SMichal Malý if (entry->wdata.alternate_modes & BIT(i)) { 833b96d23ecSMichal Malý /* Print tag and full name */ 834b96d23ecSMichal Malý count += scnprintf(buf + count, PAGE_SIZE - count, "%s: %s", 835b96d23ecSMichal Malý lg4ff_alternate_modes[i].tag, 83672529c65SMichal Malý !lg4ff_alternate_modes[i].product_id ? entry->wdata.real_name : lg4ff_alternate_modes[i].name); 837b96d23ecSMichal Malý if (count >= PAGE_SIZE - 1) 838b96d23ecSMichal Malý return count; 839b96d23ecSMichal Malý 840b96d23ecSMichal Malý /* Mark the currently active mode with an asterisk */ 84172529c65SMichal Malý if (lg4ff_alternate_modes[i].product_id == entry->wdata.product_id || 84272529c65SMichal Malý (lg4ff_alternate_modes[i].product_id == 0 && entry->wdata.product_id == entry->wdata.real_product_id)) 843b96d23ecSMichal Malý count += scnprintf(buf + count, PAGE_SIZE - count, " *\n"); 844b96d23ecSMichal Malý else 845b96d23ecSMichal Malý count += scnprintf(buf + count, PAGE_SIZE - count, "\n"); 846b96d23ecSMichal Malý 847b96d23ecSMichal Malý if (count >= PAGE_SIZE - 1) 848b96d23ecSMichal Malý return count; 849b96d23ecSMichal Malý } 850b96d23ecSMichal Malý } 851b96d23ecSMichal Malý 852b96d23ecSMichal Malý return count; 853b96d23ecSMichal Malý } 854b96d23ecSMichal Malý 855b96d23ecSMichal Malý static ssize_t lg4ff_alternate_modes_store(struct device *dev, struct device_attribute *attr, const char *buf, size_t count) 856b96d23ecSMichal Malý { 857f31a2de3SMichal Malý struct hid_device *hid = to_hid_device(dev); 858f31a2de3SMichal Malý struct lg4ff_device_entry *entry; 859f31a2de3SMichal Malý struct lg_drv_data *drv_data; 860f31a2de3SMichal Malý const struct lg4ff_compat_mode_switch *s; 861f31a2de3SMichal Malý u16 target_product_id = 0; 862f31a2de3SMichal Malý int i, ret; 863f31a2de3SMichal Malý char *lbuf; 864f31a2de3SMichal Malý 865f31a2de3SMichal Malý drv_data = hid_get_drvdata(hid); 866f31a2de3SMichal Malý if (!drv_data) { 867f31a2de3SMichal Malý hid_err(hid, "Private driver data not found!\n"); 868f31a2de3SMichal Malý return -EINVAL; 869f31a2de3SMichal Malý } 870f31a2de3SMichal Malý 871f31a2de3SMichal Malý entry = drv_data->device_props; 872f31a2de3SMichal Malý if (!entry) { 873f31a2de3SMichal Malý hid_err(hid, "Device properties not found!\n"); 874f31a2de3SMichal Malý return -EINVAL; 875f31a2de3SMichal Malý } 876f31a2de3SMichal Malý 877f31a2de3SMichal Malý /* Allow \n at the end of the input parameter */ 878f31a2de3SMichal Malý lbuf = kasprintf(GFP_KERNEL, "%s", buf); 879f31a2de3SMichal Malý if (!lbuf) 880f31a2de3SMichal Malý return -ENOMEM; 881f31a2de3SMichal Malý 882f31a2de3SMichal Malý i = strlen(lbuf); 883f31a2de3SMichal Malý if (lbuf[i-1] == '\n') { 884f31a2de3SMichal Malý if (i == 1) { 885f31a2de3SMichal Malý kfree(lbuf); 886f31a2de3SMichal Malý return -EINVAL; 887f31a2de3SMichal Malý } 888f31a2de3SMichal Malý lbuf[i-1] = '\0'; 889f31a2de3SMichal Malý } 890f31a2de3SMichal Malý 891f31a2de3SMichal Malý for (i = 0; i < LG4FF_MODE_MAX_IDX; i++) { 892f31a2de3SMichal Malý const u16 mode_product_id = lg4ff_alternate_modes[i].product_id; 893f31a2de3SMichal Malý const char *tag = lg4ff_alternate_modes[i].tag; 894f31a2de3SMichal Malý 89572529c65SMichal Malý if (entry->wdata.alternate_modes & BIT(i)) { 896f31a2de3SMichal Malý if (!strcmp(tag, lbuf)) { 897f31a2de3SMichal Malý if (!mode_product_id) 89872529c65SMichal Malý target_product_id = entry->wdata.real_product_id; 899f31a2de3SMichal Malý else 900f31a2de3SMichal Malý target_product_id = mode_product_id; 901f31a2de3SMichal Malý break; 902f31a2de3SMichal Malý } 903f31a2de3SMichal Malý } 904f31a2de3SMichal Malý } 905f31a2de3SMichal Malý 906f31a2de3SMichal Malý if (i == LG4FF_MODE_MAX_IDX) { 907f31a2de3SMichal Malý hid_info(hid, "Requested mode \"%s\" is not supported by the device\n", lbuf); 908f31a2de3SMichal Malý kfree(lbuf); 909f31a2de3SMichal Malý return -EINVAL; 910f31a2de3SMichal Malý } 911f31a2de3SMichal Malý kfree(lbuf); /* Not needed anymore */ 912f31a2de3SMichal Malý 91372529c65SMichal Malý if (target_product_id == entry->wdata.product_id) /* Nothing to do */ 914f31a2de3SMichal Malý return count; 915f31a2de3SMichal Malý 916f31a2de3SMichal Malý /* Automatic switching has to be disabled for the switch to DF-EX mode to work correctly */ 917f31a2de3SMichal Malý if (target_product_id == USB_DEVICE_ID_LOGITECH_WHEEL && !lg4ff_no_autoswitch) { 918f31a2de3SMichal Malý hid_info(hid, "\"%s\" cannot be switched to \"DF-EX\" mode. Load the \"hid_logitech\" module with \"lg4ff_no_autoswitch=1\" parameter set and try again\n", 91972529c65SMichal Malý entry->wdata.real_name); 920f31a2de3SMichal Malý return -EINVAL; 921f31a2de3SMichal Malý } 922f31a2de3SMichal Malý 923f31a2de3SMichal Malý /* Take care of hardware limitations */ 92472529c65SMichal Malý if ((entry->wdata.real_product_id == USB_DEVICE_ID_LOGITECH_DFP_WHEEL || entry->wdata.real_product_id == USB_DEVICE_ID_LOGITECH_G25_WHEEL) && 92572529c65SMichal Malý entry->wdata.product_id > target_product_id) { 92672529c65SMichal Malý hid_info(hid, "\"%s\" cannot be switched back into \"%s\" mode\n", entry->wdata.real_name, lg4ff_alternate_modes[i].name); 927f31a2de3SMichal Malý return -EINVAL; 928f31a2de3SMichal Malý } 929f31a2de3SMichal Malý 93072529c65SMichal Malý s = lg4ff_get_mode_switch_command(entry->wdata.real_product_id, target_product_id); 931f31a2de3SMichal Malý if (!s) { 932f31a2de3SMichal Malý hid_err(hid, "Invalid target product ID %X\n", target_product_id); 933f31a2de3SMichal Malý return -EINVAL; 934f31a2de3SMichal Malý } 935f31a2de3SMichal Malý 936f31a2de3SMichal Malý ret = lg4ff_switch_compatibility_mode(hid, s); 937f31a2de3SMichal Malý return (ret == 0 ? count : ret); 938b96d23ecSMichal Malý } 939b96d23ecSMichal Malý static DEVICE_ATTR(alternate_modes, S_IRUSR | S_IWUSR | S_IRGRP | S_IWGRP | S_IROTH, lg4ff_alternate_modes_show, lg4ff_alternate_modes_store); 940b96d23ecSMichal Malý 941961af46fSSimon Wood static ssize_t lg4ff_combine_show(struct device *dev, struct device_attribute *attr, 942961af46fSSimon Wood char *buf) 943961af46fSSimon Wood { 944961af46fSSimon Wood struct hid_device *hid = to_hid_device(dev); 945961af46fSSimon Wood struct lg4ff_device_entry *entry; 946961af46fSSimon Wood struct lg_drv_data *drv_data; 947961af46fSSimon Wood size_t count; 948961af46fSSimon Wood 949961af46fSSimon Wood drv_data = hid_get_drvdata(hid); 950961af46fSSimon Wood if (!drv_data) { 951961af46fSSimon Wood hid_err(hid, "Private driver data not found!\n"); 952961af46fSSimon Wood return 0; 953961af46fSSimon Wood } 954961af46fSSimon Wood 955961af46fSSimon Wood entry = drv_data->device_props; 956961af46fSSimon Wood if (!entry) { 957961af46fSSimon Wood hid_err(hid, "Device properties not found!\n"); 958961af46fSSimon Wood return 0; 959961af46fSSimon Wood } 960961af46fSSimon Wood 961961af46fSSimon Wood count = scnprintf(buf, PAGE_SIZE, "%u\n", entry->wdata.combine); 962961af46fSSimon Wood return count; 963961af46fSSimon Wood } 964961af46fSSimon Wood 965961af46fSSimon Wood static ssize_t lg4ff_combine_store(struct device *dev, struct device_attribute *attr, 966961af46fSSimon Wood const char *buf, size_t count) 967961af46fSSimon Wood { 968961af46fSSimon Wood struct hid_device *hid = to_hid_device(dev); 969961af46fSSimon Wood struct lg4ff_device_entry *entry; 970961af46fSSimon Wood struct lg_drv_data *drv_data; 971961af46fSSimon Wood u16 combine = simple_strtoul(buf, NULL, 10); 972961af46fSSimon Wood 973961af46fSSimon Wood drv_data = hid_get_drvdata(hid); 974961af46fSSimon Wood if (!drv_data) { 975961af46fSSimon Wood hid_err(hid, "Private driver data not found!\n"); 976961af46fSSimon Wood return -EINVAL; 977961af46fSSimon Wood } 978961af46fSSimon Wood 979961af46fSSimon Wood entry = drv_data->device_props; 980961af46fSSimon Wood if (!entry) { 981961af46fSSimon Wood hid_err(hid, "Device properties not found!\n"); 982961af46fSSimon Wood return -EINVAL; 983961af46fSSimon Wood } 984961af46fSSimon Wood 985961af46fSSimon Wood if (combine > 1) 986961af46fSSimon Wood combine = 1; 987961af46fSSimon Wood 988961af46fSSimon Wood entry->wdata.combine = combine; 989961af46fSSimon Wood return count; 990961af46fSSimon Wood } 991961af46fSSimon Wood static DEVICE_ATTR(combine_pedals, S_IRUSR | S_IWUSR | S_IRGRP | S_IWGRP | S_IROTH, lg4ff_combine_show, lg4ff_combine_store); 992961af46fSSimon Wood 993fbf85e2aSMichal Malý /* Export the currently set range of the wheel */ 994fbf85e2aSMichal Malý static ssize_t lg4ff_range_show(struct device *dev, struct device_attribute *attr, 9952f1cec32SVivien Didelot char *buf) 99630bb75d7SMichal Malý { 99730bb75d7SMichal Malý struct hid_device *hid = to_hid_device(dev); 9983b6b17b7SMichal Malý struct lg4ff_device_entry *entry; 9993b6b17b7SMichal Malý struct lg_drv_data *drv_data; 100030bb75d7SMichal Malý size_t count; 100130bb75d7SMichal Malý 10023b6b17b7SMichal Malý drv_data = hid_get_drvdata(hid); 10033b6b17b7SMichal Malý if (!drv_data) { 10043b6b17b7SMichal Malý hid_err(hid, "Private driver data not found!\n"); 10053b6b17b7SMichal Malý return 0; 100630bb75d7SMichal Malý } 10073b6b17b7SMichal Malý 10083b6b17b7SMichal Malý entry = drv_data->device_props; 10093b6b17b7SMichal Malý if (!entry) { 10103b6b17b7SMichal Malý hid_err(hid, "Device properties not found!\n"); 101130bb75d7SMichal Malý return 0; 101230bb75d7SMichal Malý } 101330bb75d7SMichal Malý 101472529c65SMichal Malý count = scnprintf(buf, PAGE_SIZE, "%u\n", entry->wdata.range); 101530bb75d7SMichal Malý return count; 101630bb75d7SMichal Malý } 101730bb75d7SMichal Malý 101830bb75d7SMichal Malý /* Set range to user specified value, call appropriate function 101930bb75d7SMichal Malý * according to the type of the wheel */ 1020fbf85e2aSMichal Malý static ssize_t lg4ff_range_store(struct device *dev, struct device_attribute *attr, 10212f1cec32SVivien Didelot const char *buf, size_t count) 102230bb75d7SMichal Malý { 102330bb75d7SMichal Malý struct hid_device *hid = to_hid_device(dev); 10243b6b17b7SMichal Malý struct lg4ff_device_entry *entry; 10253b6b17b7SMichal Malý struct lg_drv_data *drv_data; 10262a552c30SMichal Malý u16 range = simple_strtoul(buf, NULL, 10); 102730bb75d7SMichal Malý 10283b6b17b7SMichal Malý drv_data = hid_get_drvdata(hid); 10293b6b17b7SMichal Malý if (!drv_data) { 10303b6b17b7SMichal Malý hid_err(hid, "Private driver data not found!\n"); 103129ff6657SSimon Wood return -EINVAL; 103230bb75d7SMichal Malý } 10333b6b17b7SMichal Malý 10343b6b17b7SMichal Malý entry = drv_data->device_props; 10353b6b17b7SMichal Malý if (!entry) { 10363b6b17b7SMichal Malý hid_err(hid, "Device properties not found!\n"); 103729ff6657SSimon Wood return -EINVAL; 103830bb75d7SMichal Malý } 103930bb75d7SMichal Malý 104030bb75d7SMichal Malý if (range == 0) 104172529c65SMichal Malý range = entry->wdata.max_range; 104230bb75d7SMichal Malý 104330bb75d7SMichal Malý /* Check if the wheel supports range setting 104430bb75d7SMichal Malý * and that the range is within limits for the wheel */ 104572529c65SMichal Malý if (entry->wdata.set_range && range >= entry->wdata.min_range && range <= entry->wdata.max_range) { 104672529c65SMichal Malý entry->wdata.set_range(hid, range); 104772529c65SMichal Malý entry->wdata.range = range; 104830bb75d7SMichal Malý } 104930bb75d7SMichal Malý 105030bb75d7SMichal Malý return count; 105130bb75d7SMichal Malý } 1052fbf85e2aSMichal Malý static DEVICE_ATTR(range, S_IRUSR | S_IWUSR | S_IRGRP | S_IWGRP | S_IROTH, lg4ff_range_show, lg4ff_range_store); 105330bb75d7SMichal Malý 1054b96d23ecSMichal Malý static ssize_t lg4ff_real_id_show(struct device *dev, struct device_attribute *attr, char *buf) 1055b96d23ecSMichal Malý { 1056b96d23ecSMichal Malý struct hid_device *hid = to_hid_device(dev); 1057b96d23ecSMichal Malý struct lg4ff_device_entry *entry; 1058b96d23ecSMichal Malý struct lg_drv_data *drv_data; 1059b96d23ecSMichal Malý size_t count; 1060b96d23ecSMichal Malý 1061b96d23ecSMichal Malý drv_data = hid_get_drvdata(hid); 1062b96d23ecSMichal Malý if (!drv_data) { 1063b96d23ecSMichal Malý hid_err(hid, "Private driver data not found!\n"); 1064b96d23ecSMichal Malý return 0; 1065b96d23ecSMichal Malý } 1066b96d23ecSMichal Malý 1067b96d23ecSMichal Malý entry = drv_data->device_props; 1068b96d23ecSMichal Malý if (!entry) { 1069b96d23ecSMichal Malý hid_err(hid, "Device properties not found!\n"); 1070b96d23ecSMichal Malý return 0; 1071b96d23ecSMichal Malý } 1072b96d23ecSMichal Malý 107372529c65SMichal Malý if (!entry->wdata.real_tag || !entry->wdata.real_name) { 1074b96d23ecSMichal Malý hid_err(hid, "NULL pointer to string\n"); 1075b96d23ecSMichal Malý return 0; 1076b96d23ecSMichal Malý } 1077b96d23ecSMichal Malý 107872529c65SMichal Malý count = scnprintf(buf, PAGE_SIZE, "%s: %s\n", entry->wdata.real_tag, entry->wdata.real_name); 1079b96d23ecSMichal Malý return count; 1080b96d23ecSMichal Malý } 1081b96d23ecSMichal Malý 1082b96d23ecSMichal Malý static ssize_t lg4ff_real_id_store(struct device *dev, struct device_attribute *attr, const char *buf, size_t count) 1083b96d23ecSMichal Malý { 1084b96d23ecSMichal Malý /* Real ID is a read-only value */ 1085b96d23ecSMichal Malý return -EPERM; 1086b96d23ecSMichal Malý } 1087b96d23ecSMichal Malý static DEVICE_ATTR(real_id, S_IRUGO, lg4ff_real_id_show, lg4ff_real_id_store); 1088b96d23ecSMichal Malý 108922bcefdcSSimon Wood #ifdef CONFIG_LEDS_CLASS 10902a552c30SMichal Malý static void lg4ff_set_leds(struct hid_device *hid, u8 leds) 109122bcefdcSSimon Wood { 1092c918fe78SMichal Malý struct lg_drv_data *drv_data; 1093c918fe78SMichal Malý struct lg4ff_device_entry *entry; 1094c918fe78SMichal Malý unsigned long flags; 1095c28abd8cSMichal Malý s32 *value; 109622bcefdcSSimon Wood 1097c918fe78SMichal Malý drv_data = hid_get_drvdata(hid); 1098c918fe78SMichal Malý if (!drv_data) { 1099c918fe78SMichal Malý hid_err(hid, "Private driver data not found!\n"); 1100c918fe78SMichal Malý return; 1101c918fe78SMichal Malý } 1102c918fe78SMichal Malý 1103c918fe78SMichal Malý entry = drv_data->device_props; 1104c918fe78SMichal Malý if (!entry) { 1105c918fe78SMichal Malý hid_err(hid, "Device properties not found!\n"); 1106c918fe78SMichal Malý return; 1107c918fe78SMichal Malý } 1108c28abd8cSMichal Malý value = entry->report->field[0]->value; 1109c918fe78SMichal Malý 1110c918fe78SMichal Malý spin_lock_irqsave(&entry->report_lock, flags); 111174479ba8SMichal Malý value[0] = 0xf8; 111274479ba8SMichal Malý value[1] = 0x12; 111374479ba8SMichal Malý value[2] = leds; 111474479ba8SMichal Malý value[3] = 0x00; 111574479ba8SMichal Malý value[4] = 0x00; 111674479ba8SMichal Malý value[5] = 0x00; 111774479ba8SMichal Malý value[6] = 0x00; 1118c28abd8cSMichal Malý hid_hw_request(hid, entry->report, HID_REQ_SET_REPORT); 1119c918fe78SMichal Malý spin_unlock_irqrestore(&entry->report_lock, flags); 112022bcefdcSSimon Wood } 112122bcefdcSSimon Wood 112222bcefdcSSimon Wood static void lg4ff_led_set_brightness(struct led_classdev *led_cdev, 112322bcefdcSSimon Wood enum led_brightness value) 112422bcefdcSSimon Wood { 112522bcefdcSSimon Wood struct device *dev = led_cdev->dev->parent; 1126ee79a8f8SGeliang Tang struct hid_device *hid = to_hid_device(dev); 11274629fd16SAxel Lin struct lg_drv_data *drv_data = hid_get_drvdata(hid); 112822bcefdcSSimon Wood struct lg4ff_device_entry *entry; 112922bcefdcSSimon Wood int i, state = 0; 113022bcefdcSSimon Wood 113122bcefdcSSimon Wood if (!drv_data) { 113222bcefdcSSimon Wood hid_err(hid, "Device data not found."); 113322bcefdcSSimon Wood return; 113422bcefdcSSimon Wood } 113522bcefdcSSimon Wood 1136371a1d9eSMichal Malý entry = drv_data->device_props; 113722bcefdcSSimon Wood 113822bcefdcSSimon Wood if (!entry) { 113922bcefdcSSimon Wood hid_err(hid, "Device properties not found."); 114022bcefdcSSimon Wood return; 114122bcefdcSSimon Wood } 114222bcefdcSSimon Wood 114322bcefdcSSimon Wood for (i = 0; i < 5; i++) { 114472529c65SMichal Malý if (led_cdev != entry->wdata.led[i]) 114522bcefdcSSimon Wood continue; 114672529c65SMichal Malý state = (entry->wdata.led_state >> i) & 1; 114722bcefdcSSimon Wood if (value == LED_OFF && state) { 114872529c65SMichal Malý entry->wdata.led_state &= ~(1 << i); 114972529c65SMichal Malý lg4ff_set_leds(hid, entry->wdata.led_state); 115022bcefdcSSimon Wood } else if (value != LED_OFF && !state) { 115172529c65SMichal Malý entry->wdata.led_state |= 1 << i; 115272529c65SMichal Malý lg4ff_set_leds(hid, entry->wdata.led_state); 115322bcefdcSSimon Wood } 115422bcefdcSSimon Wood break; 115522bcefdcSSimon Wood } 115622bcefdcSSimon Wood } 115722bcefdcSSimon Wood 115822bcefdcSSimon Wood static enum led_brightness lg4ff_led_get_brightness(struct led_classdev *led_cdev) 115922bcefdcSSimon Wood { 116022bcefdcSSimon Wood struct device *dev = led_cdev->dev->parent; 1161ee79a8f8SGeliang Tang struct hid_device *hid = to_hid_device(dev); 11624629fd16SAxel Lin struct lg_drv_data *drv_data = hid_get_drvdata(hid); 116322bcefdcSSimon Wood struct lg4ff_device_entry *entry; 116422bcefdcSSimon Wood int i, value = 0; 116522bcefdcSSimon Wood 116622bcefdcSSimon Wood if (!drv_data) { 116722bcefdcSSimon Wood hid_err(hid, "Device data not found."); 116822bcefdcSSimon Wood return LED_OFF; 116922bcefdcSSimon Wood } 117022bcefdcSSimon Wood 1171371a1d9eSMichal Malý entry = drv_data->device_props; 117222bcefdcSSimon Wood 117322bcefdcSSimon Wood if (!entry) { 117422bcefdcSSimon Wood hid_err(hid, "Device properties not found."); 117522bcefdcSSimon Wood return LED_OFF; 117622bcefdcSSimon Wood } 117722bcefdcSSimon Wood 117822bcefdcSSimon Wood for (i = 0; i < 5; i++) 117972529c65SMichal Malý if (led_cdev == entry->wdata.led[i]) { 118072529c65SMichal Malý value = (entry->wdata.led_state >> i) & 1; 118122bcefdcSSimon Wood break; 118222bcefdcSSimon Wood } 118322bcefdcSSimon Wood 118422bcefdcSSimon Wood return value ? LED_FULL : LED_OFF; 118522bcefdcSSimon Wood } 118622bcefdcSSimon Wood #endif 118722bcefdcSSimon Wood 1188e7c23449SMichal Malý static u16 lg4ff_identify_multimode_wheel(struct hid_device *hid, const u16 reported_product_id, const u16 bcdDevice) 1189e7c23449SMichal Malý { 1190bbec1bd0SSimon Wood u32 current_mode; 1191bbec1bd0SSimon Wood int i; 1192e7c23449SMichal Malý 1193bbec1bd0SSimon Wood /* identify current mode from USB PID */ 1194bbec1bd0SSimon Wood for (i = 1; i < ARRAY_SIZE(lg4ff_alternate_modes); i++) { 1195bbec1bd0SSimon Wood dbg_hid("Testing whether PID is %X\n", lg4ff_alternate_modes[i].product_id); 1196bbec1bd0SSimon Wood if (reported_product_id == lg4ff_alternate_modes[i].product_id) 1197e7c23449SMichal Malý break; 1198e7c23449SMichal Malý } 1199e7c23449SMichal Malý 1200bbec1bd0SSimon Wood if (i == ARRAY_SIZE(lg4ff_alternate_modes)) 1201bbec1bd0SSimon Wood return 0; 1202e7c23449SMichal Malý 1203bbec1bd0SSimon Wood current_mode = BIT(i); 1204bbec1bd0SSimon Wood 1205bbec1bd0SSimon Wood for (i = 0; i < ARRAY_SIZE(lg4ff_main_checklist); i++) { 1206bbec1bd0SSimon Wood const u16 mask = lg4ff_main_checklist[i]->mask; 1207bbec1bd0SSimon Wood const u16 result = lg4ff_main_checklist[i]->result; 1208bbec1bd0SSimon Wood const u16 real_product_id = lg4ff_main_checklist[i]->real_product_id; 1209bbec1bd0SSimon Wood 1210bbec1bd0SSimon Wood if ((current_mode & lg4ff_main_checklist[i]->modes) && \ 1211bbec1bd0SSimon Wood (bcdDevice & mask) == result) { 1212e7c23449SMichal Malý dbg_hid("Found wheel with real PID %X whose reported PID is %X\n", real_product_id, reported_product_id); 1213e7c23449SMichal Malý return real_product_id; 1214e7c23449SMichal Malý } 1215e7c23449SMichal Malý } 1216e7c23449SMichal Malý 1217f31a2de3SMichal Malý /* No match found. This is either Driving Force or an unknown 1218f31a2de3SMichal Malý * wheel model, do not touch it */ 1219e7c23449SMichal Malý dbg_hid("Wheel with bcdDevice %X was not recognized as multimode wheel, leaving in its current mode\n", bcdDevice); 1220e7c23449SMichal Malý return 0; 1221e7c23449SMichal Malý } 1222e7c23449SMichal Malý 1223e7c23449SMichal Malý static int lg4ff_handle_multimode_wheel(struct hid_device *hid, u16 *real_product_id, const u16 bcdDevice) 1224e7c23449SMichal Malý { 1225e7c23449SMichal Malý const u16 reported_product_id = hid->product; 1226e7c23449SMichal Malý int ret; 1227e7c23449SMichal Malý 1228e7c23449SMichal Malý *real_product_id = lg4ff_identify_multimode_wheel(hid, reported_product_id, bcdDevice); 1229e7c23449SMichal Malý /* Probed wheel is not a multimode wheel */ 1230e7c23449SMichal Malý if (!*real_product_id) { 1231e7c23449SMichal Malý *real_product_id = reported_product_id; 1232e7c23449SMichal Malý dbg_hid("Wheel is not a multimode wheel\n"); 1233e7c23449SMichal Malý return LG4FF_MMODE_NOT_MULTIMODE; 1234e7c23449SMichal Malý } 1235e7c23449SMichal Malý 1236e7c23449SMichal Malý /* Switch from "Driving Force" mode to native mode automatically. 1237e7c23449SMichal Malý * Otherwise keep the wheel in its current mode */ 1238e7c23449SMichal Malý if (reported_product_id == USB_DEVICE_ID_LOGITECH_WHEEL && 1239a54dc779SMichal Malý reported_product_id != *real_product_id && 1240a54dc779SMichal Malý !lg4ff_no_autoswitch) { 1241f31a2de3SMichal Malý const struct lg4ff_compat_mode_switch *s = lg4ff_get_mode_switch_command(*real_product_id, *real_product_id); 1242e7c23449SMichal Malý 1243f31a2de3SMichal Malý if (!s) { 1244e7c23449SMichal Malý hid_err(hid, "Invalid product id %X\n", *real_product_id); 1245b96d23ecSMichal Malý return LG4FF_MMODE_NOT_MULTIMODE; 1246e7c23449SMichal Malý } 1247e7c23449SMichal Malý 1248e7c23449SMichal Malý ret = lg4ff_switch_compatibility_mode(hid, s); 1249e7c23449SMichal Malý if (ret) { 1250e7c23449SMichal Malý /* Wheel could not have been switched to native mode, 1251e7c23449SMichal Malý * leave it in "Driving Force" mode and continue */ 1252e7c23449SMichal Malý hid_err(hid, "Unable to switch wheel mode, errno %d\n", ret); 1253b96d23ecSMichal Malý return LG4FF_MMODE_IS_MULTIMODE; 1254e7c23449SMichal Malý } 1255e7c23449SMichal Malý return LG4FF_MMODE_SWITCHED; 1256e7c23449SMichal Malý } 1257e7c23449SMichal Malý 1258b96d23ecSMichal Malý return LG4FF_MMODE_IS_MULTIMODE; 1259e7c23449SMichal Malý } 1260e7c23449SMichal Malý 1261e7c23449SMichal Malý 126232c88cbcSSimon Wood int lg4ff_init(struct hid_device *hid) 126332c88cbcSSimon Wood { 126432c88cbcSSimon Wood struct hid_input *hidinput = list_entry(hid->inputs.next, struct hid_input, list); 126532c88cbcSSimon Wood struct input_dev *dev = hidinput->input; 1266c28abd8cSMichal Malý struct list_head *report_list = &hid->report_enum[HID_OUTPUT_REPORT].report_list; 1267c28abd8cSMichal Malý struct hid_report *report = list_entry(report_list->next, struct hid_report, list); 1268e7c23449SMichal Malý const struct usb_device_descriptor *udesc = &(hid_to_usb_dev(hid)->descriptor); 1269e7c23449SMichal Malý const u16 bcdDevice = le16_to_cpu(udesc->bcdDevice); 12705d9d60adSMichal Malý const struct lg4ff_multimode_wheel *mmode_wheel = NULL; 127130bb75d7SMichal Malý struct lg4ff_device_entry *entry; 12723b6b17b7SMichal Malý struct lg_drv_data *drv_data; 1273b96d23ecSMichal Malý int error, i, j; 1274b96d23ecSMichal Malý int mmode_ret, mmode_idx = -1; 1275e7c23449SMichal Malý u16 real_product_id; 127632c88cbcSSimon Wood 127732c88cbcSSimon Wood /* Check that the report looks ok */ 12780fb6bd06SKees Cook if (!hid_validate_values(hid, HID_OUTPUT_REPORT, 0, 0, 7)) 127932c88cbcSSimon Wood return -1; 128032c88cbcSSimon Wood 128172529c65SMichal Malý drv_data = hid_get_drvdata(hid); 128272529c65SMichal Malý if (!drv_data) { 128372529c65SMichal Malý hid_err(hid, "Cannot add device, private driver data not allocated\n"); 128472529c65SMichal Malý return -1; 128572529c65SMichal Malý } 128672529c65SMichal Malý entry = kzalloc(sizeof(*entry), GFP_KERNEL); 128772529c65SMichal Malý if (!entry) 128872529c65SMichal Malý return -ENOMEM; 1289c918fe78SMichal Malý spin_lock_init(&entry->report_lock); 1290c28abd8cSMichal Malý entry->report = report; 129172529c65SMichal Malý drv_data->device_props = entry; 129272529c65SMichal Malý 1293e7c23449SMichal Malý /* Check if a multimode wheel has been connected and 1294e7c23449SMichal Malý * handle it appropriately */ 1295b96d23ecSMichal Malý mmode_ret = lg4ff_handle_multimode_wheel(hid, &real_product_id, bcdDevice); 1296e7c23449SMichal Malý 1297e7c23449SMichal Malý /* Wheel has been told to switch to native mode. There is no point in going on 1298e7c23449SMichal Malý * with the initialization as the wheel will do a USB reset when it switches mode 1299e7c23449SMichal Malý */ 1300b96d23ecSMichal Malý if (mmode_ret == LG4FF_MMODE_SWITCHED) 1301e7c23449SMichal Malý return 0; 130272529c65SMichal Malý else if (mmode_ret < 0) { 130372529c65SMichal Malý hid_err(hid, "Unable to switch device mode during initialization, errno %d\n", mmode_ret); 130472529c65SMichal Malý error = mmode_ret; 130572529c65SMichal Malý goto err_init; 130672529c65SMichal Malý } 1307e7c23449SMichal Malý 13087362cd22SMichal Malý /* Check what wheel has been connected */ 13097362cd22SMichal Malý for (i = 0; i < ARRAY_SIZE(lg4ff_devices); i++) { 13107362cd22SMichal Malý if (hid->product == lg4ff_devices[i].product_id) { 13117362cd22SMichal Malý dbg_hid("Found compatible device, product ID %04X\n", lg4ff_devices[i].product_id); 13127362cd22SMichal Malý break; 13137362cd22SMichal Malý } 13147362cd22SMichal Malý } 13157362cd22SMichal Malý 13167362cd22SMichal Malý if (i == ARRAY_SIZE(lg4ff_devices)) { 13179c2a6bd1SMichal Malý hid_err(hid, "This device is flagged to be handled by the lg4ff module but this module does not know how to handle it. " 13189c2a6bd1SMichal Malý "Please report this as a bug to LKML, Simon Wood <simon@mungewell.org> or " 13199c2a6bd1SMichal Malý "Michal Maly <madcatxster@devoid-pointer.net>\n"); 132072529c65SMichal Malý error = -1; 132172529c65SMichal Malý goto err_init; 13227362cd22SMichal Malý } 13237362cd22SMichal Malý 1324b96d23ecSMichal Malý if (mmode_ret == LG4FF_MMODE_IS_MULTIMODE) { 1325b96d23ecSMichal Malý for (mmode_idx = 0; mmode_idx < ARRAY_SIZE(lg4ff_multimode_wheels); mmode_idx++) { 1326b96d23ecSMichal Malý if (real_product_id == lg4ff_multimode_wheels[mmode_idx].product_id) 1327b96d23ecSMichal Malý break; 1328b96d23ecSMichal Malý } 1329b96d23ecSMichal Malý 1330b96d23ecSMichal Malý if (mmode_idx == ARRAY_SIZE(lg4ff_multimode_wheels)) { 1331b96d23ecSMichal Malý hid_err(hid, "Device product ID %X is not listed as a multimode wheel", real_product_id); 133272529c65SMichal Malý error = -1; 133372529c65SMichal Malý goto err_init; 1334b96d23ecSMichal Malý } 1335b96d23ecSMichal Malý } 1336b96d23ecSMichal Malý 13377362cd22SMichal Malý /* Set supported force feedback capabilities */ 13387362cd22SMichal Malý for (j = 0; lg4ff_devices[i].ff_effects[j] >= 0; j++) 13397362cd22SMichal Malý set_bit(lg4ff_devices[i].ff_effects[j], dev->ffbit); 134032c88cbcSSimon Wood 1341d0afd848SMichal Malý error = input_ff_create_memless(dev, NULL, lg4ff_play); 134232c88cbcSSimon Wood 134332c88cbcSSimon Wood if (error) 134472529c65SMichal Malý goto err_init; 134532c88cbcSSimon Wood 13465d9d60adSMichal Malý /* Initialize device properties */ 1347b96d23ecSMichal Malý if (mmode_ret == LG4FF_MMODE_IS_MULTIMODE) { 1348b96d23ecSMichal Malý BUG_ON(mmode_idx == -1); 13495d9d60adSMichal Malý mmode_wheel = &lg4ff_multimode_wheels[mmode_idx]; 1350b96d23ecSMichal Malý } 13515d9d60adSMichal Malý lg4ff_init_wheel_data(&entry->wdata, &lg4ff_devices[i], mmode_wheel, real_product_id); 135230bb75d7SMichal Malý 1353114a55cfSSimon Wood /* Check if autocentering is available and 1354114a55cfSSimon Wood * set the centering force to zero by default */ 1355114a55cfSSimon Wood if (test_bit(FF_AUTOCENTER, dev->ffbit)) { 1356e7c23449SMichal Malý /* Formula Force EX expects different autocentering command */ 1357e7c23449SMichal Malý if ((bcdDevice >> 8) == LG4FF_FFEX_REV_MAJ && 1358e7c23449SMichal Malý (bcdDevice & 0xff) == LG4FF_FFEX_REV_MIN) 1359d0afd848SMichal Malý dev->ff->set_autocenter = lg4ff_set_autocenter_ffex; 1360114a55cfSSimon Wood else 1361d0afd848SMichal Malý dev->ff->set_autocenter = lg4ff_set_autocenter_default; 1362114a55cfSSimon Wood 1363114a55cfSSimon Wood dev->ff->set_autocenter(dev, 0); 1364114a55cfSSimon Wood } 1365114a55cfSSimon Wood 136630bb75d7SMichal Malý /* Create sysfs interface */ 1367961af46fSSimon Wood error = device_create_file(&hid->dev, &dev_attr_combine_pedals); 1368961af46fSSimon Wood if (error) 1369961af46fSSimon Wood hid_warn(hid, "Unable to create sysfs interface for \"combine\", errno %d\n", error); 137030bb75d7SMichal Malý error = device_create_file(&hid->dev, &dev_attr_range); 137130bb75d7SMichal Malý if (error) 1372d61a70ecSMichal Malý hid_warn(hid, "Unable to create sysfs interface for \"range\", errno %d\n", error); 1373b96d23ecSMichal Malý if (mmode_ret == LG4FF_MMODE_IS_MULTIMODE) { 1374b96d23ecSMichal Malý error = device_create_file(&hid->dev, &dev_attr_real_id); 1375b96d23ecSMichal Malý if (error) 1376d61a70ecSMichal Malý hid_warn(hid, "Unable to create sysfs interface for \"real_id\", errno %d\n", error); 1377b96d23ecSMichal Malý error = device_create_file(&hid->dev, &dev_attr_alternate_modes); 1378b96d23ecSMichal Malý if (error) 1379d61a70ecSMichal Malý hid_warn(hid, "Unable to create sysfs interface for \"alternate_modes\", errno %d\n", error); 1380b96d23ecSMichal Malý } 138130bb75d7SMichal Malý dbg_hid("sysfs interface created\n"); 138230bb75d7SMichal Malý 138330bb75d7SMichal Malý /* Set the maximum range to start with */ 138472529c65SMichal Malý entry->wdata.range = entry->wdata.max_range; 138572529c65SMichal Malý if (entry->wdata.set_range) 138672529c65SMichal Malý entry->wdata.set_range(hid, entry->wdata.range); 138730bb75d7SMichal Malý 138822bcefdcSSimon Wood #ifdef CONFIG_LEDS_CLASS 138929fae1c8SSimon Wood /* register led subsystem - G27/G29 only */ 139072529c65SMichal Malý entry->wdata.led_state = 0; 139122bcefdcSSimon Wood for (j = 0; j < 5; j++) 139272529c65SMichal Malý entry->wdata.led[j] = NULL; 139322bcefdcSSimon Wood 139429fae1c8SSimon Wood if (lg4ff_devices[i].product_id == USB_DEVICE_ID_LOGITECH_G27_WHEEL || 139529fae1c8SSimon Wood lg4ff_devices[i].product_id == USB_DEVICE_ID_LOGITECH_G29_WHEEL) { 139622bcefdcSSimon Wood struct led_classdev *led; 139722bcefdcSSimon Wood size_t name_sz; 139822bcefdcSSimon Wood char *name; 139922bcefdcSSimon Wood 140022bcefdcSSimon Wood lg4ff_set_leds(hid, 0); 140122bcefdcSSimon Wood 140222bcefdcSSimon Wood name_sz = strlen(dev_name(&hid->dev)) + 8; 140322bcefdcSSimon Wood 140422bcefdcSSimon Wood for (j = 0; j < 5; j++) { 140522bcefdcSSimon Wood led = kzalloc(sizeof(struct led_classdev)+name_sz, GFP_KERNEL); 140622bcefdcSSimon Wood if (!led) { 140722bcefdcSSimon Wood hid_err(hid, "can't allocate memory for LED %d\n", j); 140872529c65SMichal Malý goto err_leds; 140922bcefdcSSimon Wood } 141022bcefdcSSimon Wood 141122bcefdcSSimon Wood name = (void *)(&led[1]); 141222bcefdcSSimon Wood snprintf(name, name_sz, "%s::RPM%d", dev_name(&hid->dev), j+1); 141322bcefdcSSimon Wood led->name = name; 141422bcefdcSSimon Wood led->brightness = 0; 141522bcefdcSSimon Wood led->max_brightness = 1; 141622bcefdcSSimon Wood led->brightness_get = lg4ff_led_get_brightness; 141722bcefdcSSimon Wood led->brightness_set = lg4ff_led_set_brightness; 141822bcefdcSSimon Wood 141972529c65SMichal Malý entry->wdata.led[j] = led; 142022bcefdcSSimon Wood error = led_classdev_register(&hid->dev, led); 142122bcefdcSSimon Wood 142222bcefdcSSimon Wood if (error) { 142322bcefdcSSimon Wood hid_err(hid, "failed to register LED %d. Aborting.\n", j); 142472529c65SMichal Malý err_leds: 142522bcefdcSSimon Wood /* Deregister LEDs (if any) */ 142622bcefdcSSimon Wood for (j = 0; j < 5; j++) { 142772529c65SMichal Malý led = entry->wdata.led[j]; 142872529c65SMichal Malý entry->wdata.led[j] = NULL; 142922bcefdcSSimon Wood if (!led) 143022bcefdcSSimon Wood continue; 143122bcefdcSSimon Wood led_classdev_unregister(led); 143222bcefdcSSimon Wood kfree(led); 143322bcefdcSSimon Wood } 143422bcefdcSSimon Wood goto out; /* Let the driver continue without LEDs */ 143522bcefdcSSimon Wood } 143622bcefdcSSimon Wood } 143722bcefdcSSimon Wood } 143822bcefdcSSimon Wood out: 1439c6e6dc87SJiri Kosina #endif 144064013800SSimon Wood hid_info(hid, "Force feedback support for Logitech Gaming Wheels\n"); 144132c88cbcSSimon Wood return 0; 144272529c65SMichal Malý 144372529c65SMichal Malý err_init: 144472529c65SMichal Malý drv_data->device_props = NULL; 144572529c65SMichal Malý kfree(entry); 144672529c65SMichal Malý return error; 144732c88cbcSSimon Wood } 144832c88cbcSSimon Wood 144930bb75d7SMichal Malý int lg4ff_deinit(struct hid_device *hid) 145030bb75d7SMichal Malý { 145130bb75d7SMichal Malý struct lg4ff_device_entry *entry; 14523b6b17b7SMichal Malý struct lg_drv_data *drv_data; 14536a2e176bSMichal Malý 14543b6b17b7SMichal Malý drv_data = hid_get_drvdata(hid); 14553b6b17b7SMichal Malý if (!drv_data) { 14563b6b17b7SMichal Malý hid_err(hid, "Error while deinitializing device, no private driver data.\n"); 145730bb75d7SMichal Malý return -1; 145830bb75d7SMichal Malý } 14593b6b17b7SMichal Malý entry = drv_data->device_props; 1460e7c23449SMichal Malý if (!entry) 1461e7c23449SMichal Malý goto out; /* Nothing more to do */ 1462e7c23449SMichal Malý 1463b96d23ecSMichal Malý /* Multimode devices will have at least the "MODE_NATIVE" bit set */ 146472529c65SMichal Malý if (entry->wdata.alternate_modes) { 1465b96d23ecSMichal Malý device_remove_file(&hid->dev, &dev_attr_real_id); 1466b96d23ecSMichal Malý device_remove_file(&hid->dev, &dev_attr_alternate_modes); 1467b96d23ecSMichal Malý } 1468b96d23ecSMichal Malý 1469961af46fSSimon Wood device_remove_file(&hid->dev, &dev_attr_combine_pedals); 147072529c65SMichal Malý device_remove_file(&hid->dev, &dev_attr_range); 147122bcefdcSSimon Wood #ifdef CONFIG_LEDS_CLASS 147222bcefdcSSimon Wood { 147322bcefdcSSimon Wood int j; 147422bcefdcSSimon Wood struct led_classdev *led; 147522bcefdcSSimon Wood 147622bcefdcSSimon Wood /* Deregister LEDs (if any) */ 147722bcefdcSSimon Wood for (j = 0; j < 5; j++) { 147822bcefdcSSimon Wood 147972529c65SMichal Malý led = entry->wdata.led[j]; 148072529c65SMichal Malý entry->wdata.led[j] = NULL; 148122bcefdcSSimon Wood if (!led) 148222bcefdcSSimon Wood continue; 148322bcefdcSSimon Wood led_classdev_unregister(led); 148422bcefdcSSimon Wood kfree(led); 148522bcefdcSSimon Wood } 148622bcefdcSSimon Wood } 148722bcefdcSSimon Wood #endif 1488b211a638SMichal Malý hid_hw_stop(hid); 1489b211a638SMichal Malý drv_data->device_props = NULL; 149022bcefdcSSimon Wood 14913b6b17b7SMichal Malý kfree(entry); 1492e7c23449SMichal Malý out: 149330bb75d7SMichal Malý dbg_hid("Device successfully unregistered\n"); 149430bb75d7SMichal Malý return 0; 149530bb75d7SMichal Malý } 1496