Lines Matching refs:sc
583 static void sony_set_leds(struct sony_sc *sc);
585 static inline void sony_schedule_work(struct sony_sc *sc, in sony_schedule_work() argument
592 spin_lock_irqsave(&sc->lock, flags); in sony_schedule_work()
593 if (!sc->defer_initialization && sc->state_worker_initialized) in sony_schedule_work()
594 schedule_work(&sc->state_worker); in sony_schedule_work()
595 spin_unlock_irqrestore(&sc->lock, flags); in sony_schedule_work()
598 if (sc->hotplug_worker_initialized) in sony_schedule_work()
599 schedule_work(&sc->hotplug_worker); in sony_schedule_work()
609 struct sony_sc *sc = hid_get_drvdata(hdev); in ds4_show_poll_interval() local
611 return snprintf(buf, PAGE_SIZE, "%i\n", sc->ds4_bt_poll_interval); in ds4_show_poll_interval()
619 struct sony_sc *sc = hid_get_drvdata(hdev); in ds4_store_poll_interval() local
629 spin_lock_irqsave(&sc->lock, flags); in ds4_store_poll_interval()
630 sc->ds4_bt_poll_interval = interval; in ds4_store_poll_interval()
631 spin_unlock_irqrestore(&sc->lock, flags); in ds4_store_poll_interval()
633 sony_schedule_work(sc, SONY_WORKER_STATE); in ds4_store_poll_interval()
646 struct sony_sc *sc = hid_get_drvdata(hdev); in sony_show_firmware_version() local
648 return snprintf(buf, PAGE_SIZE, "0x%04x\n", sc->fw_version); in sony_show_firmware_version()
658 struct sony_sc *sc = hid_get_drvdata(hdev); in sony_show_hardware_version() local
660 return snprintf(buf, PAGE_SIZE, "0x%04x\n", sc->hw_version); in sony_show_hardware_version()
843 struct sony_sc *sc = hid_get_drvdata(hdev); in sony_report_fixup() local
845 if (sc->quirks & (SINO_LITE_CONTROLLER | FUTUREMAX_DANCE_MAT)) in sony_report_fixup()
852 if ((sc->quirks & VAIO_RDESC_CONSTANT) && *rsize >= 56 && in sony_report_fixup()
864 if (sc->quirks & MOTION_CONTROLLER) in sony_report_fixup()
867 if (sc->quirks & PS3REMOTE) in sony_report_fixup()
874 if ((sc->quirks & SIXAXIS_CONTROLLER_USB) && *rsize >= 45 && in sony_report_fixup()
890 static void sixaxis_parse_report(struct sony_sc *sc, u8 *rd, int size) in sixaxis_parse_report() argument
903 offset = (sc->quirks & MOTION_CONTROLLER) ? 12 : 30; in sixaxis_parse_report()
916 spin_lock_irqsave(&sc->lock, flags); in sixaxis_parse_report()
917 sc->cable_state = cable_state; in sixaxis_parse_report()
918 sc->battery_capacity = battery_capacity; in sixaxis_parse_report()
919 sc->battery_charging = battery_charging; in sixaxis_parse_report()
920 spin_unlock_irqrestore(&sc->lock, flags); in sixaxis_parse_report()
922 if (sc->quirks & SIXAXIS_CONTROLLER) { in sixaxis_parse_report()
927 input_report_abs(sc->sensor_dev, ABS_X, val); in sixaxis_parse_report()
931 input_report_abs(sc->sensor_dev, ABS_Y, val); in sixaxis_parse_report()
934 input_report_abs(sc->sensor_dev, ABS_Z, val); in sixaxis_parse_report()
936 input_sync(sc->sensor_dev); in sixaxis_parse_report()
940 static void dualshock4_parse_report(struct sony_sc *sc, u8 *rd, int size) in dualshock4_parse_report() argument
942 struct hid_input *hidinput = list_entry(sc->hdev->inputs.next, in dualshock4_parse_report()
951 int data_offset = (sc->quirks & DUALSHOCK4_CONTROLLER_BT) ? 2 : 0; in dualshock4_parse_report()
955 input_report_key(sc->touchpad, BTN_LEFT, rd[offset+2] & 0x2); in dualshock4_parse_report()
1011 if (!sc->timestamp_initialized) { in dualshock4_parse_report()
1012 sc->timestamp_us = ((unsigned int)timestamp * 16) / 3; in dualshock4_parse_report()
1013 sc->timestamp_initialized = true; in dualshock4_parse_report()
1017 if (sc->prev_timestamp > timestamp) in dualshock4_parse_report()
1018 delta = (U16_MAX - sc->prev_timestamp + timestamp + 1); in dualshock4_parse_report()
1020 delta = timestamp - sc->prev_timestamp; in dualshock4_parse_report()
1021 sc->timestamp_us += (delta * 16) / 3; in dualshock4_parse_report()
1023 sc->prev_timestamp = timestamp; in dualshock4_parse_report()
1024 input_event(sc->sensor_dev, EV_MSC, MSC_TIMESTAMP, sc->timestamp_us); in dualshock4_parse_report()
1030 struct ds4_calibration_data *calib = &sc->ds4_calib_data[n]; in dualshock4_parse_report()
1041 input_report_abs(sc->sensor_dev, calib->abs_code, calib_data); in dualshock4_parse_report()
1044 input_sync(sc->sensor_dev); in dualshock4_parse_report()
1071 spin_lock_irqsave(&sc->lock, flags); in dualshock4_parse_report()
1072 sc->cable_state = cable_state; in dualshock4_parse_report()
1073 sc->battery_capacity = battery_capacity; in dualshock4_parse_report()
1074 sc->battery_charging = battery_charging; in dualshock4_parse_report()
1075 spin_unlock_irqrestore(&sc->lock, flags); in dualshock4_parse_report()
1084 max_touch_data = (sc->quirks & DUALSHOCK4_CONTROLLER_BT) ? 4 : 3; in dualshock4_parse_report()
1111 input_mt_slot(sc->touchpad, n); in dualshock4_parse_report()
1112 input_mt_report_slot_state(sc->touchpad, MT_TOOL_FINGER, active); in dualshock4_parse_report()
1115 input_report_abs(sc->touchpad, ABS_MT_POSITION_X, x); in dualshock4_parse_report()
1116 input_report_abs(sc->touchpad, ABS_MT_POSITION_Y, y); in dualshock4_parse_report()
1121 input_mt_sync_frame(sc->touchpad); in dualshock4_parse_report()
1122 input_sync(sc->touchpad); in dualshock4_parse_report()
1126 static void nsg_mrxu_parse_report(struct sony_sc *sc, u8 *rd, int size) in nsg_mrxu_parse_report() argument
1151 input_report_key(sc->touchpad, BTN_LEFT, rd[offset] & 0x0F); in nsg_mrxu_parse_report()
1165 input_mt_slot(sc->touchpad, n); in nsg_mrxu_parse_report()
1166 input_mt_report_slot_state(sc->touchpad, MT_TOOL_FINGER, active & 0x03); in nsg_mrxu_parse_report()
1171 input_report_abs(sc->touchpad, ABS_MT_TOUCH_MAJOR, in nsg_mrxu_parse_report()
1173 input_report_abs(sc->touchpad, ABS_MT_TOUCH_MINOR, in nsg_mrxu_parse_report()
1175 input_report_abs(sc->touchpad, ABS_MT_ORIENTATION, in nsg_mrxu_parse_report()
1177 input_report_abs(sc->touchpad, ABS_MT_POSITION_X, x); in nsg_mrxu_parse_report()
1178 input_report_abs(sc->touchpad, ABS_MT_POSITION_Y, in nsg_mrxu_parse_report()
1186 input_report_rel(sc->touchpad, REL_X, relx); in nsg_mrxu_parse_report()
1187 input_report_rel(sc->touchpad, REL_Y, rely); in nsg_mrxu_parse_report()
1195 input_mt_sync_frame(sc->touchpad); in nsg_mrxu_parse_report()
1197 input_sync(sc->touchpad); in nsg_mrxu_parse_report()
1203 struct sony_sc *sc = hid_get_drvdata(hdev); in sony_raw_event() local
1209 if ((sc->quirks & SIXAXIS_CONTROLLER) && rd[0] == 0x01 && size == 49) { in sony_raw_event()
1226 sixaxis_parse_report(sc, rd, size); in sony_raw_event()
1227 } else if ((sc->quirks & MOTION_CONTROLLER_BT) && rd[0] == 0x01 && size == 49) { in sony_raw_event()
1228 sixaxis_parse_report(sc, rd, size); in sony_raw_event()
1229 } else if ((sc->quirks & NAVIGATION_CONTROLLER) && rd[0] == 0x01 && in sony_raw_event()
1231 sixaxis_parse_report(sc, rd, size); in sony_raw_event()
1232 } else if ((sc->quirks & DUALSHOCK4_CONTROLLER_USB) && rd[0] == 0x01 && in sony_raw_event()
1234 dualshock4_parse_report(sc, rd, size); in sony_raw_event()
1235 } else if (((sc->quirks & DUALSHOCK4_CONTROLLER_BT) && rd[0] == 0x11 && in sony_raw_event()
1246 hid_dbg(sc->hdev, "DualShock 4 input report's CRC check failed, received crc 0x%0x != 0x%0x\n", in sony_raw_event()
1251 dualshock4_parse_report(sc, rd, size); in sony_raw_event()
1252 } else if ((sc->quirks & DUALSHOCK4_DONGLE) && rd[0] == 0x01 && in sony_raw_event()
1264 spin_lock_irqsave(&sc->lock, flags); in sony_raw_event()
1265 dongle_state = sc->ds4_dongle_state; in sony_raw_event()
1266 spin_unlock_irqrestore(&sc->lock, flags); in sony_raw_event()
1277 hid_info(sc->hdev, "DualShock 4 USB dongle: controller connected\n"); in sony_raw_event()
1278 sony_set_leds(sc); in sony_raw_event()
1280 spin_lock_irqsave(&sc->lock, flags); in sony_raw_event()
1281 sc->ds4_dongle_state = DONGLE_CALIBRATING; in sony_raw_event()
1282 spin_unlock_irqrestore(&sc->lock, flags); in sony_raw_event()
1284 sony_schedule_work(sc, SONY_WORKER_HOTPLUG); in sony_raw_event()
1292 hid_info(sc->hdev, "DualShock 4 USB dongle: controller disconnected\n"); in sony_raw_event()
1294 spin_lock_irqsave(&sc->lock, flags); in sony_raw_event()
1295 sc->ds4_dongle_state = DONGLE_DISCONNECTED; in sony_raw_event()
1296 spin_unlock_irqrestore(&sc->lock, flags); in sony_raw_event()
1307 dualshock4_parse_report(sc, rd, size); in sony_raw_event()
1309 } else if ((sc->quirks & NSG_MRXU_REMOTE) && rd[0] == 0x02) { in sony_raw_event()
1310 nsg_mrxu_parse_report(sc, rd, size); in sony_raw_event()
1314 if (sc->defer_initialization) { in sony_raw_event()
1315 sc->defer_initialization = 0; in sony_raw_event()
1316 sony_schedule_work(sc, SONY_WORKER_STATE); in sony_raw_event()
1326 struct sony_sc *sc = hid_get_drvdata(hdev); in sony_mapping() local
1328 if (sc->quirks & BUZZ_CONTROLLER) { in sony_mapping()
1351 if (sc->quirks & PS3REMOTE) in sony_mapping()
1354 if (sc->quirks & NAVIGATION_CONTROLLER) in sony_mapping()
1357 if (sc->quirks & SIXAXIS_CONTROLLER) in sony_mapping()
1360 if (sc->quirks & DUALSHOCK4_CONTROLLER) in sony_mapping()
1368 static int sony_register_touchpad(struct sony_sc *sc, int touch_count, in sony_register_touchpad() argument
1375 sc->touchpad = devm_input_allocate_device(&sc->hdev->dev); in sony_register_touchpad()
1376 if (!sc->touchpad) in sony_register_touchpad()
1379 input_set_drvdata(sc->touchpad, sc); in sony_register_touchpad()
1380 sc->touchpad->dev.parent = &sc->hdev->dev; in sony_register_touchpad()
1381 sc->touchpad->phys = sc->hdev->phys; in sony_register_touchpad()
1382 sc->touchpad->uniq = sc->hdev->uniq; in sony_register_touchpad()
1383 sc->touchpad->id.bustype = sc->hdev->bus; in sony_register_touchpad()
1384 sc->touchpad->id.vendor = sc->hdev->vendor; in sony_register_touchpad()
1385 sc->touchpad->id.product = sc->hdev->product; in sony_register_touchpad()
1386 sc->touchpad->id.version = sc->hdev->version; in sony_register_touchpad()
1391 name_sz = strlen(sc->hdev->name) + sizeof(DS4_TOUCHPAD_SUFFIX); in sony_register_touchpad()
1392 name = devm_kzalloc(&sc->hdev->dev, name_sz, GFP_KERNEL); in sony_register_touchpad()
1395 snprintf(name, name_sz, "%s" DS4_TOUCHPAD_SUFFIX, sc->hdev->name); in sony_register_touchpad()
1396 sc->touchpad->name = name; in sony_register_touchpad()
1399 __set_bit(EV_KEY, sc->touchpad->evbit); in sony_register_touchpad()
1400 __set_bit(BTN_LEFT, sc->touchpad->keybit); in sony_register_touchpad()
1401 __set_bit(INPUT_PROP_BUTTONPAD, sc->touchpad->propbit); in sony_register_touchpad()
1403 input_set_abs_params(sc->touchpad, ABS_MT_POSITION_X, 0, w, 0, 0); in sony_register_touchpad()
1404 input_set_abs_params(sc->touchpad, ABS_MT_POSITION_Y, 0, h, 0, 0); in sony_register_touchpad()
1407 input_set_abs_params(sc->touchpad, ABS_MT_TOUCH_MAJOR, in sony_register_touchpad()
1410 input_set_abs_params(sc->touchpad, ABS_MT_TOUCH_MINOR, in sony_register_touchpad()
1413 input_set_abs_params(sc->touchpad, ABS_MT_ORIENTATION, in sony_register_touchpad()
1417 if (sc->quirks & NSG_MRXU_REMOTE) { in sony_register_touchpad()
1418 __set_bit(EV_REL, sc->touchpad->evbit); in sony_register_touchpad()
1421 ret = input_mt_init_slots(sc->touchpad, touch_count, INPUT_MT_POINTER); in sony_register_touchpad()
1425 ret = input_register_device(sc->touchpad); in sony_register_touchpad()
1432 static int sony_register_sensors(struct sony_sc *sc) in sony_register_sensors() argument
1439 sc->sensor_dev = devm_input_allocate_device(&sc->hdev->dev); in sony_register_sensors()
1440 if (!sc->sensor_dev) in sony_register_sensors()
1443 input_set_drvdata(sc->sensor_dev, sc); in sony_register_sensors()
1444 sc->sensor_dev->dev.parent = &sc->hdev->dev; in sony_register_sensors()
1445 sc->sensor_dev->phys = sc->hdev->phys; in sony_register_sensors()
1446 sc->sensor_dev->uniq = sc->hdev->uniq; in sony_register_sensors()
1447 sc->sensor_dev->id.bustype = sc->hdev->bus; in sony_register_sensors()
1448 sc->sensor_dev->id.vendor = sc->hdev->vendor; in sony_register_sensors()
1449 sc->sensor_dev->id.product = sc->hdev->product; in sony_register_sensors()
1450 sc->sensor_dev->id.version = sc->hdev->version; in sony_register_sensors()
1455 name_sz = strlen(sc->hdev->name) + sizeof(SENSOR_SUFFIX); in sony_register_sensors()
1456 name = devm_kzalloc(&sc->hdev->dev, name_sz, GFP_KERNEL); in sony_register_sensors()
1459 snprintf(name, name_sz, "%s" SENSOR_SUFFIX, sc->hdev->name); in sony_register_sensors()
1460 sc->sensor_dev->name = name; in sony_register_sensors()
1462 if (sc->quirks & SIXAXIS_CONTROLLER) { in sony_register_sensors()
1469 input_set_abs_params(sc->sensor_dev, ABS_X, -512, 511, 4, 0); in sony_register_sensors()
1470 input_set_abs_params(sc->sensor_dev, ABS_Y, -512, 511, 4, 0); in sony_register_sensors()
1471 input_set_abs_params(sc->sensor_dev, ABS_Z, -512, 511, 4, 0); in sony_register_sensors()
1472 input_abs_set_res(sc->sensor_dev, ABS_X, SIXAXIS_ACC_RES_PER_G); in sony_register_sensors()
1473 input_abs_set_res(sc->sensor_dev, ABS_Y, SIXAXIS_ACC_RES_PER_G); in sony_register_sensors()
1474 input_abs_set_res(sc->sensor_dev, ABS_Z, SIXAXIS_ACC_RES_PER_G); in sony_register_sensors()
1475 } else if (sc->quirks & DUALSHOCK4_CONTROLLER) { in sony_register_sensors()
1477 input_set_abs_params(sc->sensor_dev, ABS_X, -range, range, 16, 0); in sony_register_sensors()
1478 input_set_abs_params(sc->sensor_dev, ABS_Y, -range, range, 16, 0); in sony_register_sensors()
1479 input_set_abs_params(sc->sensor_dev, ABS_Z, -range, range, 16, 0); in sony_register_sensors()
1480 input_abs_set_res(sc->sensor_dev, ABS_X, DS4_ACC_RES_PER_G); in sony_register_sensors()
1481 input_abs_set_res(sc->sensor_dev, ABS_Y, DS4_ACC_RES_PER_G); in sony_register_sensors()
1482 input_abs_set_res(sc->sensor_dev, ABS_Z, DS4_ACC_RES_PER_G); in sony_register_sensors()
1485 input_set_abs_params(sc->sensor_dev, ABS_RX, -range, range, 16, 0); in sony_register_sensors()
1486 input_set_abs_params(sc->sensor_dev, ABS_RY, -range, range, 16, 0); in sony_register_sensors()
1487 input_set_abs_params(sc->sensor_dev, ABS_RZ, -range, range, 16, 0); in sony_register_sensors()
1488 input_abs_set_res(sc->sensor_dev, ABS_RX, DS4_GYRO_RES_PER_DEG_S); in sony_register_sensors()
1489 input_abs_set_res(sc->sensor_dev, ABS_RY, DS4_GYRO_RES_PER_DEG_S); in sony_register_sensors()
1490 input_abs_set_res(sc->sensor_dev, ABS_RZ, DS4_GYRO_RES_PER_DEG_S); in sony_register_sensors()
1492 __set_bit(EV_MSC, sc->sensor_dev->evbit); in sony_register_sensors()
1493 __set_bit(MSC_TIMESTAMP, sc->sensor_dev->mscbit); in sony_register_sensors()
1496 __set_bit(INPUT_PROP_ACCELEROMETER, sc->sensor_dev->propbit); in sony_register_sensors()
1498 ret = input_register_device(sc->sensor_dev); in sony_register_sensors()
1512 struct sony_sc *sc = hid_get_drvdata(hdev); in sixaxis_set_operational_usb() local
1544 if (sc->quirks & SHANWAN_GAMEPAD) in sixaxis_set_operational_usb()
1581 static int dualshock4_get_calibration_data(struct sony_sc *sc) in dualshock4_get_calibration_data() argument
1599 if (sc->quirks & (DUALSHOCK4_CONTROLLER_USB | DUALSHOCK4_DONGLE)) { in dualshock4_get_calibration_data()
1604 ret = hid_hw_raw_request(sc->hdev, 0x02, buf, in dualshock4_get_calibration_data()
1621 ret = hid_hw_raw_request(sc->hdev, 0x05, buf, in dualshock4_get_calibration_data()
1633 …hid_warn(sc->hdev, "DualShock 4 calibration report's CRC check failed, received crc 0x%0x != 0x%0x… in dualshock4_get_calibration_data()
1636 hid_warn(sc->hdev, "Retrying DualShock 4 get calibration report request\n"); in dualshock4_get_calibration_data()
1651 if (sc->quirks & DUALSHOCK4_CONTROLLER_USB) { in dualshock4_get_calibration_data()
1680 sc->ds4_calib_data[0].abs_code = ABS_RX; in dualshock4_get_calibration_data()
1681 sc->ds4_calib_data[0].bias = gyro_pitch_bias; in dualshock4_get_calibration_data()
1682 sc->ds4_calib_data[0].sens_numer = speed_2x*DS4_GYRO_RES_PER_DEG_S; in dualshock4_get_calibration_data()
1683 sc->ds4_calib_data[0].sens_denom = gyro_pitch_plus - gyro_pitch_minus; in dualshock4_get_calibration_data()
1685 sc->ds4_calib_data[1].abs_code = ABS_RY; in dualshock4_get_calibration_data()
1686 sc->ds4_calib_data[1].bias = gyro_yaw_bias; in dualshock4_get_calibration_data()
1687 sc->ds4_calib_data[1].sens_numer = speed_2x*DS4_GYRO_RES_PER_DEG_S; in dualshock4_get_calibration_data()
1688 sc->ds4_calib_data[1].sens_denom = gyro_yaw_plus - gyro_yaw_minus; in dualshock4_get_calibration_data()
1690 sc->ds4_calib_data[2].abs_code = ABS_RZ; in dualshock4_get_calibration_data()
1691 sc->ds4_calib_data[2].bias = gyro_roll_bias; in dualshock4_get_calibration_data()
1692 sc->ds4_calib_data[2].sens_numer = speed_2x*DS4_GYRO_RES_PER_DEG_S; in dualshock4_get_calibration_data()
1693 sc->ds4_calib_data[2].sens_denom = gyro_roll_plus - gyro_roll_minus; in dualshock4_get_calibration_data()
1699 sc->ds4_calib_data[3].abs_code = ABS_X; in dualshock4_get_calibration_data()
1700 sc->ds4_calib_data[3].bias = acc_x_plus - range_2g / 2; in dualshock4_get_calibration_data()
1701 sc->ds4_calib_data[3].sens_numer = 2*DS4_ACC_RES_PER_G; in dualshock4_get_calibration_data()
1702 sc->ds4_calib_data[3].sens_denom = range_2g; in dualshock4_get_calibration_data()
1705 sc->ds4_calib_data[4].abs_code = ABS_Y; in dualshock4_get_calibration_data()
1706 sc->ds4_calib_data[4].bias = acc_y_plus - range_2g / 2; in dualshock4_get_calibration_data()
1707 sc->ds4_calib_data[4].sens_numer = 2*DS4_ACC_RES_PER_G; in dualshock4_get_calibration_data()
1708 sc->ds4_calib_data[4].sens_denom = range_2g; in dualshock4_get_calibration_data()
1711 sc->ds4_calib_data[5].abs_code = ABS_Z; in dualshock4_get_calibration_data()
1712 sc->ds4_calib_data[5].bias = acc_z_plus - range_2g / 2; in dualshock4_get_calibration_data()
1713 sc->ds4_calib_data[5].sens_numer = 2*DS4_ACC_RES_PER_G; in dualshock4_get_calibration_data()
1714 sc->ds4_calib_data[5].sens_denom = range_2g; in dualshock4_get_calibration_data()
1723 struct sony_sc *sc = container_of(work, struct sony_sc, hotplug_worker); in dualshock4_calibration_work() local
1728 ret = dualshock4_get_calibration_data(sc); in dualshock4_calibration_work()
1736 hid_err(sc->hdev, "DualShock 4 USB dongle: calibration failed, disabling device\n"); in dualshock4_calibration_work()
1739 hid_info(sc->hdev, "DualShock 4 USB dongle: calibration completed\n"); in dualshock4_calibration_work()
1743 spin_lock_irqsave(&sc->lock, flags); in dualshock4_calibration_work()
1744 sc->ds4_dongle_state = dongle_state; in dualshock4_calibration_work()
1745 spin_unlock_irqrestore(&sc->lock, flags); in dualshock4_calibration_work()
1748 static int dualshock4_get_version_info(struct sony_sc *sc) in dualshock4_get_version_info() argument
1757 ret = hid_hw_raw_request(sc->hdev, 0xA3, buf, in dualshock4_get_version_info()
1766 sc->hw_version = get_unaligned_le16(&buf[35]); in dualshock4_get_version_info()
1767 sc->fw_version = get_unaligned_le16(&buf[41]); in dualshock4_get_version_info()
1773 static void sixaxis_set_leds_from_id(struct sony_sc *sc) in sixaxis_set_leds_from_id() argument
1788 int id = sc->device_id; in sixaxis_set_leds_from_id()
1796 memcpy(sc->led_state, sixaxis_leds[id], sizeof(sixaxis_leds[id])); in sixaxis_set_leds_from_id()
1799 static void dualshock4_set_leds_from_id(struct sony_sc *sc) in dualshock4_set_leds_from_id() argument
1812 int id = sc->device_id; in dualshock4_set_leds_from_id()
1820 memcpy(sc->led_state, color_code[id], sizeof(color_code[id])); in dualshock4_set_leds_from_id()
1823 static void buzz_set_leds(struct sony_sc *sc) in buzz_set_leds() argument
1825 struct hid_device *hdev = sc->hdev; in buzz_set_leds()
1835 value[1] = sc->led_state[0] ? 0xff : 0x00; in buzz_set_leds()
1836 value[2] = sc->led_state[1] ? 0xff : 0x00; in buzz_set_leds()
1837 value[3] = sc->led_state[2] ? 0xff : 0x00; in buzz_set_leds()
1838 value[4] = sc->led_state[3] ? 0xff : 0x00; in buzz_set_leds()
1844 static void sony_set_leds(struct sony_sc *sc) in sony_set_leds() argument
1846 if (!(sc->quirks & BUZZ_CONTROLLER)) in sony_set_leds()
1847 sony_schedule_work(sc, SONY_WORKER_STATE); in sony_set_leds()
1849 buzz_set_leds(sc); in sony_set_leds()
1964 static int sony_leds_init(struct sony_sc *sc) in sony_leds_init() argument
1966 struct hid_device *hdev = sc->hdev; in sony_leds_init()
1979 BUG_ON(!(sc->quirks & SONY_LED_SUPPORT)); in sony_leds_init()
1981 if (sc->quirks & BUZZ_CONTROLLER) { in sony_leds_init()
1982 sc->led_count = 4; in sony_leds_init()
1989 } else if (sc->quirks & DUALSHOCK4_CONTROLLER) { in sony_leds_init()
1990 dualshock4_set_leds_from_id(sc); in sony_leds_init()
1991 sc->led_state[3] = 1; in sony_leds_init()
1992 sc->led_count = 4; in sony_leds_init()
1998 } else if (sc->quirks & MOTION_CONTROLLER) { in sony_leds_init()
1999 sc->led_count = 3; in sony_leds_init()
2004 } else if (sc->quirks & NAVIGATION_CONTROLLER) { in sony_leds_init()
2007 memcpy(sc->led_state, navigation_leds, sizeof(navigation_leds)); in sony_leds_init()
2008 sc->led_count = 1; in sony_leds_init()
2014 sixaxis_set_leds_from_id(sc); in sony_leds_init()
2015 sc->led_count = 4; in sony_leds_init()
2027 sony_set_leds(sc); in sony_leds_init()
2031 for (n = 0; n < sc->led_count; n++) { in sony_leds_init()
2049 led->brightness = sc->led_state[n]; in sony_leds_init()
2058 sc->leds[n] = led; in sony_leds_init()
2070 static void sixaxis_send_output_report(struct sony_sc *sc) in sixaxis_send_output_report() argument
2085 (struct sixaxis_output_report *)sc->output_report_dmabuf; in sixaxis_send_output_report()
2092 report->rumble.right_motor_on = sc->right ? 1 : 0; in sixaxis_send_output_report()
2093 report->rumble.left_motor_force = sc->left; in sixaxis_send_output_report()
2096 report->leds_bitmap |= sc->led_state[0] << 1; in sixaxis_send_output_report()
2097 report->leds_bitmap |= sc->led_state[1] << 2; in sixaxis_send_output_report()
2098 report->leds_bitmap |= sc->led_state[2] << 3; in sixaxis_send_output_report()
2099 report->leds_bitmap |= sc->led_state[3] << 4; in sixaxis_send_output_report()
2115 if (sc->led_delay_on[n] || sc->led_delay_off[n]) { in sixaxis_send_output_report()
2116 report->led[3 - n].duty_off = sc->led_delay_off[n]; in sixaxis_send_output_report()
2117 report->led[3 - n].duty_on = sc->led_delay_on[n]; in sixaxis_send_output_report()
2122 if (sc->quirks & SHANWAN_GAMEPAD) in sixaxis_send_output_report()
2123 hid_hw_output_report(sc->hdev, (u8 *)report, in sixaxis_send_output_report()
2126 hid_hw_raw_request(sc->hdev, report->report_id, (u8 *)report, in sixaxis_send_output_report()
2131 static void dualshock4_send_output_report(struct sony_sc *sc) in dualshock4_send_output_report() argument
2133 struct hid_device *hdev = sc->hdev; in dualshock4_send_output_report()
2134 u8 *buf = sc->output_report_dmabuf; in dualshock4_send_output_report()
2146 if (sc->quirks & (DUALSHOCK4_CONTROLLER_USB | DUALSHOCK4_DONGLE)) { in dualshock4_send_output_report()
2154 buf[1] = 0xC0 /* HID + CRC */ | sc->ds4_bt_poll_interval; in dualshock4_send_output_report()
2160 buf[offset++] = sc->right; in dualshock4_send_output_report()
2161 buf[offset++] = sc->left; in dualshock4_send_output_report()
2167 if (sc->led_state[3]) { in dualshock4_send_output_report()
2168 buf[offset++] = sc->led_state[0]; in dualshock4_send_output_report()
2169 buf[offset++] = sc->led_state[1]; in dualshock4_send_output_report()
2170 buf[offset++] = sc->led_state[2]; in dualshock4_send_output_report()
2176 buf[offset++] = sc->led_delay_on[3]; in dualshock4_send_output_report()
2177 buf[offset++] = sc->led_delay_off[3]; in dualshock4_send_output_report()
2179 if (sc->quirks & (DUALSHOCK4_CONTROLLER_USB | DUALSHOCK4_DONGLE)) in dualshock4_send_output_report()
2193 static void motion_send_output_report(struct sony_sc *sc) in motion_send_output_report() argument
2195 struct hid_device *hdev = sc->hdev; in motion_send_output_report()
2197 (struct motion_output_report_02 *)sc->output_report_dmabuf; in motion_send_output_report()
2202 report->r = sc->led_state[0]; in motion_send_output_report()
2203 report->g = sc->led_state[1]; in motion_send_output_report()
2204 report->b = sc->led_state[2]; in motion_send_output_report()
2207 report->rumble = max(sc->right, sc->left); in motion_send_output_report()
2213 static inline void sony_send_output_report(struct sony_sc *sc) in sony_send_output_report() argument
2215 if (sc->send_output_report) in sony_send_output_report()
2216 sc->send_output_report(sc); in sony_send_output_report()
2221 struct sony_sc *sc = container_of(work, struct sony_sc, state_worker); in sony_state_worker() local
2223 sc->send_output_report(sc); in sony_state_worker()
2226 static int sony_allocate_output_report(struct sony_sc *sc) in sony_allocate_output_report() argument
2228 if ((sc->quirks & SIXAXIS_CONTROLLER) || in sony_allocate_output_report()
2229 (sc->quirks & NAVIGATION_CONTROLLER)) in sony_allocate_output_report()
2230 sc->output_report_dmabuf = in sony_allocate_output_report()
2231 devm_kmalloc(&sc->hdev->dev, in sony_allocate_output_report()
2234 else if (sc->quirks & DUALSHOCK4_CONTROLLER_BT) in sony_allocate_output_report()
2235 sc->output_report_dmabuf = devm_kmalloc(&sc->hdev->dev, in sony_allocate_output_report()
2238 else if (sc->quirks & (DUALSHOCK4_CONTROLLER_USB | DUALSHOCK4_DONGLE)) in sony_allocate_output_report()
2239 sc->output_report_dmabuf = devm_kmalloc(&sc->hdev->dev, in sony_allocate_output_report()
2242 else if (sc->quirks & MOTION_CONTROLLER) in sony_allocate_output_report()
2243 sc->output_report_dmabuf = devm_kmalloc(&sc->hdev->dev, in sony_allocate_output_report()
2249 if (!sc->output_report_dmabuf) in sony_allocate_output_report()
2260 struct sony_sc *sc = hid_get_drvdata(hid); in sony_play_effect() local
2265 sc->left = effect->u.rumble.strong_magnitude / 256; in sony_play_effect()
2266 sc->right = effect->u.rumble.weak_magnitude / 256; in sony_play_effect()
2268 sony_schedule_work(sc, SONY_WORKER_STATE); in sony_play_effect()
2272 static int sony_init_ff(struct sony_sc *sc) in sony_init_ff() argument
2277 if (list_empty(&sc->hdev->inputs)) { in sony_init_ff()
2278 hid_err(sc->hdev, "no inputs found\n"); in sony_init_ff()
2281 hidinput = list_entry(sc->hdev->inputs.next, struct hid_input, list); in sony_init_ff()
2289 static int sony_init_ff(struct sony_sc *sc) in sony_init_ff() argument
2300 struct sony_sc *sc = power_supply_get_drvdata(psy); in sony_battery_get_property() local
2305 spin_lock_irqsave(&sc->lock, flags); in sony_battery_get_property()
2306 battery_charging = sc->battery_charging; in sony_battery_get_property()
2307 battery_capacity = sc->battery_capacity; in sony_battery_get_property()
2308 cable_state = sc->cable_state; in sony_battery_get_property()
2309 spin_unlock_irqrestore(&sc->lock, flags); in sony_battery_get_property()
2337 static int sony_battery_probe(struct sony_sc *sc, int append_dev_id) in sony_battery_probe() argument
2342 struct power_supply_config psy_cfg = { .drv_data = sc, }; in sony_battery_probe()
2343 struct hid_device *hdev = sc->hdev; in sony_battery_probe()
2350 sc->battery_capacity = 100; in sony_battery_probe()
2352 sc->battery_desc.properties = sony_battery_props; in sony_battery_probe()
2353 sc->battery_desc.num_properties = ARRAY_SIZE(sony_battery_props); in sony_battery_probe()
2354 sc->battery_desc.get_property = sony_battery_get_property; in sony_battery_probe()
2355 sc->battery_desc.type = POWER_SUPPLY_TYPE_BATTERY; in sony_battery_probe()
2356 sc->battery_desc.use_for_apm = 0; in sony_battery_probe()
2357 sc->battery_desc.name = devm_kasprintf(&hdev->dev, GFP_KERNEL, in sony_battery_probe()
2358 battery_str_fmt, sc->mac_address, sc->device_id); in sony_battery_probe()
2359 if (!sc->battery_desc.name) in sony_battery_probe()
2362 sc->battery = devm_power_supply_register(&hdev->dev, &sc->battery_desc, in sony_battery_probe()
2364 if (IS_ERR(sc->battery)) { in sony_battery_probe()
2365 ret = PTR_ERR(sc->battery); in sony_battery_probe()
2370 power_supply_powers(sc->battery, &hdev->dev); in sony_battery_probe()
2394 static int sony_check_add_dev_list(struct sony_sc *sc) in sony_check_add_dev_list() argument
2403 ret = memcmp(sc->mac_address, entry->mac_address, in sony_check_add_dev_list()
2404 sizeof(sc->mac_address)); in sony_check_add_dev_list()
2406 if (sony_compare_connection_type(sc, entry)) { in sony_check_add_dev_list()
2410 hid_info(sc->hdev, in sony_check_add_dev_list()
2412 sc->mac_address); in sony_check_add_dev_list()
2419 list_add(&(sc->list_node), &sony_device_list); in sony_check_add_dev_list()
2426 static void sony_remove_dev_list(struct sony_sc *sc) in sony_remove_dev_list() argument
2430 if (sc->list_node.next) { in sony_remove_dev_list()
2432 list_del(&(sc->list_node)); in sony_remove_dev_list()
2437 static int sony_get_bt_devaddr(struct sony_sc *sc) in sony_get_bt_devaddr() argument
2442 ret = strlen(sc->hdev->uniq); in sony_get_bt_devaddr()
2446 ret = sscanf(sc->hdev->uniq, in sony_get_bt_devaddr()
2448 &sc->mac_address[5], &sc->mac_address[4], &sc->mac_address[3], in sony_get_bt_devaddr()
2449 &sc->mac_address[2], &sc->mac_address[1], &sc->mac_address[0]); in sony_get_bt_devaddr()
2457 static int sony_check_add(struct sony_sc *sc) in sony_check_add() argument
2462 if ((sc->quirks & DUALSHOCK4_CONTROLLER_BT) || in sony_check_add()
2463 (sc->quirks & MOTION_CONTROLLER_BT) || in sony_check_add()
2464 (sc->quirks & NAVIGATION_CONTROLLER_BT) || in sony_check_add()
2465 (sc->quirks & SIXAXIS_CONTROLLER_BT)) { in sony_check_add()
2472 if (sony_get_bt_devaddr(sc) < 0) { in sony_check_add()
2473 hid_warn(sc->hdev, "UNIQ does not contain a MAC address; duplicate check skipped\n"); in sony_check_add()
2476 } else if (sc->quirks & (DUALSHOCK4_CONTROLLER_USB | DUALSHOCK4_DONGLE)) { in sony_check_add()
2486 ret = hid_hw_raw_request(sc->hdev, 0x81, buf, in sony_check_add()
2491 hid_err(sc->hdev, "failed to retrieve feature report 0x81 with the DualShock 4 MAC address\n"); in sony_check_add()
2496 memcpy(sc->mac_address, &buf[1], sizeof(sc->mac_address)); in sony_check_add()
2498 snprintf(sc->hdev->uniq, sizeof(sc->hdev->uniq), in sony_check_add()
2499 "%pMR", sc->mac_address); in sony_check_add()
2500 } else if ((sc->quirks & SIXAXIS_CONTROLLER_USB) || in sony_check_add()
2501 (sc->quirks & NAVIGATION_CONTROLLER_USB)) { in sony_check_add()
2511 ret = hid_hw_raw_request(sc->hdev, 0xf2, buf, in sony_check_add()
2516 hid_err(sc->hdev, "failed to retrieve feature report 0xf2 with the Sixaxis MAC address\n"); in sony_check_add()
2526 sc->mac_address[5-n] = buf[4+n]; in sony_check_add()
2528 snprintf(sc->hdev->uniq, sizeof(sc->hdev->uniq), in sony_check_add()
2529 "%pMR", sc->mac_address); in sony_check_add()
2534 ret = sony_check_add_dev_list(sc); in sony_check_add()
2543 static int sony_set_device_id(struct sony_sc *sc) in sony_set_device_id() argument
2551 if ((sc->quirks & SIXAXIS_CONTROLLER) || in sony_set_device_id()
2552 (sc->quirks & DUALSHOCK4_CONTROLLER)) { in sony_set_device_id()
2556 sc->device_id = -1; in sony_set_device_id()
2559 sc->device_id = ret; in sony_set_device_id()
2561 sc->device_id = -1; in sony_set_device_id()
2567 static void sony_release_device_id(struct sony_sc *sc) in sony_release_device_id() argument
2569 if (sc->device_id >= 0) { in sony_release_device_id()
2570 ida_simple_remove(&sony_device_id_allocator, sc->device_id); in sony_release_device_id()
2571 sc->device_id = -1; in sony_release_device_id()
2575 static inline void sony_init_output_report(struct sony_sc *sc, in sony_init_output_report() argument
2578 sc->send_output_report = send_output_report; in sony_init_output_report()
2580 if (!sc->state_worker_initialized) in sony_init_output_report()
2581 INIT_WORK(&sc->state_worker, sony_state_worker); in sony_init_output_report()
2583 sc->state_worker_initialized = 1; in sony_init_output_report()
2586 static inline void sony_cancel_work_sync(struct sony_sc *sc) in sony_cancel_work_sync() argument
2590 if (sc->hotplug_worker_initialized) in sony_cancel_work_sync()
2591 cancel_work_sync(&sc->hotplug_worker); in sony_cancel_work_sync()
2592 if (sc->state_worker_initialized) { in sony_cancel_work_sync()
2593 spin_lock_irqsave(&sc->lock, flags); in sony_cancel_work_sync()
2594 sc->state_worker_initialized = 0; in sony_cancel_work_sync()
2595 spin_unlock_irqrestore(&sc->lock, flags); in sony_cancel_work_sync()
2596 cancel_work_sync(&sc->state_worker); in sony_cancel_work_sync()
2603 struct sony_sc *sc = hid_get_drvdata(hdev); in sony_input_configured() local
2607 ret = sony_set_device_id(sc); in sony_input_configured()
2613 ret = append_dev_id = sony_check_add(sc); in sony_input_configured()
2617 ret = sony_allocate_output_report(sc); in sony_input_configured()
2623 if (sc->quirks & NAVIGATION_CONTROLLER_USB) { in sony_input_configured()
2642 sc->defer_initialization = 1; in sony_input_configured()
2650 sony_init_output_report(sc, sixaxis_send_output_report); in sony_input_configured()
2651 } else if (sc->quirks & NAVIGATION_CONTROLLER_BT) { in sony_input_configured()
2664 sony_init_output_report(sc, sixaxis_send_output_report); in sony_input_configured()
2665 } else if (sc->quirks & SIXAXIS_CONTROLLER_USB) { in sony_input_configured()
2674 sc->defer_initialization = 1; in sony_input_configured()
2682 ret = sony_register_sensors(sc); in sony_input_configured()
2684 hid_err(sc->hdev, in sony_input_configured()
2689 sony_init_output_report(sc, sixaxis_send_output_report); in sony_input_configured()
2690 } else if (sc->quirks & SIXAXIS_CONTROLLER_BT) { in sony_input_configured()
2703 ret = sony_register_sensors(sc); in sony_input_configured()
2705 hid_err(sc->hdev, in sony_input_configured()
2710 sony_init_output_report(sc, sixaxis_send_output_report); in sony_input_configured()
2711 } else if (sc->quirks & DUALSHOCK4_CONTROLLER) { in sony_input_configured()
2712 ret = dualshock4_get_calibration_data(sc); in sony_input_configured()
2718 ret = dualshock4_get_version_info(sc); in sony_input_configured()
2720 hid_err(sc->hdev, "Failed to get version data from Dualshock 4\n"); in sony_input_configured()
2724 ret = device_create_file(&sc->hdev->dev, &dev_attr_firmware_version); in sony_input_configured()
2727 sc->fw_version = 0; in sony_input_configured()
2728 sc->hw_version = 0; in sony_input_configured()
2729 hid_err(sc->hdev, "can't create sysfs firmware_version attribute err: %d\n", ret); in sony_input_configured()
2733 ret = device_create_file(&sc->hdev->dev, &dev_attr_hardware_version); in sony_input_configured()
2735 sc->hw_version = 0; in sony_input_configured()
2736 hid_err(sc->hdev, "can't create sysfs hardware_version attribute err: %d\n", ret); in sony_input_configured()
2744 ret = sony_register_touchpad(sc, 2, 1920, 942, 0, 0, 0); in sony_input_configured()
2746 hid_err(sc->hdev, in sony_input_configured()
2752 ret = sony_register_sensors(sc); in sony_input_configured()
2754 hid_err(sc->hdev, in sony_input_configured()
2759 if (sc->quirks & DUALSHOCK4_CONTROLLER_BT) { in sony_input_configured()
2760 sc->ds4_bt_poll_interval = DS4_BT_DEFAULT_POLL_INTERVAL_MS; in sony_input_configured()
2761 ret = device_create_file(&sc->hdev->dev, &dev_attr_bt_poll_interval); in sony_input_configured()
2763 hid_warn(sc->hdev, in sony_input_configured()
2768 if (sc->quirks & DUALSHOCK4_DONGLE) { in sony_input_configured()
2769 INIT_WORK(&sc->hotplug_worker, dualshock4_calibration_work); in sony_input_configured()
2770 sc->hotplug_worker_initialized = 1; in sony_input_configured()
2771 sc->ds4_dongle_state = DONGLE_DISCONNECTED; in sony_input_configured()
2774 sony_init_output_report(sc, dualshock4_send_output_report); in sony_input_configured()
2775 } else if (sc->quirks & NSG_MRXU_REMOTE) { in sony_input_configured()
2780 ret = sony_register_touchpad(sc, 2, in sony_input_configured()
2783 hid_err(sc->hdev, in sony_input_configured()
2789 } else if (sc->quirks & MOTION_CONTROLLER) { in sony_input_configured()
2790 sony_init_output_report(sc, motion_send_output_report); in sony_input_configured()
2795 if (sc->quirks & SONY_LED_SUPPORT) { in sony_input_configured()
2796 ret = sony_leds_init(sc); in sony_input_configured()
2801 if (sc->quirks & SONY_BATTERY_SUPPORT) { in sony_input_configured()
2802 ret = sony_battery_probe(sc, append_dev_id); in sony_input_configured()
2814 if (sc->quirks & SONY_FF_SUPPORT) { in sony_input_configured()
2815 ret = sony_init_ff(sc); in sony_input_configured()
2828 if (sc->ds4_bt_poll_interval) in sony_input_configured()
2829 device_remove_file(&sc->hdev->dev, &dev_attr_bt_poll_interval); in sony_input_configured()
2830 if (sc->fw_version) in sony_input_configured()
2831 device_remove_file(&sc->hdev->dev, &dev_attr_firmware_version); in sony_input_configured()
2832 if (sc->hw_version) in sony_input_configured()
2833 device_remove_file(&sc->hdev->dev, &dev_attr_hardware_version); in sony_input_configured()
2834 sony_cancel_work_sync(sc); in sony_input_configured()
2835 sony_remove_dev_list(sc); in sony_input_configured()
2836 sony_release_device_id(sc); in sony_input_configured()
2844 struct sony_sc *sc; in sony_probe() local
2853 sc = devm_kzalloc(&hdev->dev, sizeof(*sc), GFP_KERNEL); in sony_probe()
2854 if (sc == NULL) { in sony_probe()
2859 spin_lock_init(&sc->lock); in sony_probe()
2861 sc->quirks = quirks; in sony_probe()
2862 hid_set_drvdata(hdev, sc); in sony_probe()
2863 sc->hdev = hdev; in sony_probe()
2871 if (sc->quirks & VAIO_RDESC_CONSTANT) in sony_probe()
2873 else if (sc->quirks & SIXAXIS_CONTROLLER) in sony_probe()
2882 if (sc->quirks & (SIXAXIS_CONTROLLER | DUALSHOCK4_CONTROLLER)) in sony_probe()
2910 struct sony_sc *sc = hid_get_drvdata(hdev); in sony_remove() local
2914 if (sc->quirks & DUALSHOCK4_CONTROLLER_BT) in sony_remove()
2915 device_remove_file(&sc->hdev->dev, &dev_attr_bt_poll_interval); in sony_remove()
2917 if (sc->fw_version) in sony_remove()
2918 device_remove_file(&sc->hdev->dev, &dev_attr_firmware_version); in sony_remove()
2920 if (sc->hw_version) in sony_remove()
2921 device_remove_file(&sc->hdev->dev, &dev_attr_hardware_version); in sony_remove()
2923 sony_cancel_work_sync(sc); in sony_remove()
2925 sony_remove_dev_list(sc); in sony_remove()
2927 sony_release_device_id(sc); in sony_remove()
2940 struct sony_sc *sc = hid_get_drvdata(hdev); in sony_suspend() local
2942 sc->left = sc->right = 0; in sony_suspend()
2943 sony_send_output_report(sc); in sony_suspend()
2952 struct sony_sc *sc = hid_get_drvdata(hdev); in sony_resume() local
2958 if ((sc->quirks & SIXAXIS_CONTROLLER_USB) || in sony_resume()
2959 (sc->quirks & NAVIGATION_CONTROLLER_USB)) { in sony_resume()
2960 sixaxis_set_operational_usb(sc->hdev); in sony_resume()
2961 sc->defer_initialization = 1; in sony_resume()