534 static inline void dualsense_schedule_work(struct dualsense *ds);
536 static void dualsense_set_lightbar(struct dualsense *ds, uint8_t red, uint8_t green, uint8_t blue);
945 static int dualsense_get_calibration_data(struct dualsense *ds)  in dualsense_get_calibration_data()  argument
947 	struct hid_device *hdev = ds->base.hdev;  in dualsense_get_calibration_data()
965 	ret = ps_get_report(ds->base.hdev, DS_FEATURE_REPORT_CALIBRATION, buf,  in dualsense_get_calibration_data()
968 		hid_err(ds->base.hdev, "Failed to retrieve DualSense calibration info: %d\n", ret);  in dualsense_get_calibration_data()
995 	ds->gyro_calib_data[0].abs_code = ABS_RX;  in dualsense_get_calibration_data()
996 	ds->gyro_calib_data[0].bias = 0;  in dualsense_get_calibration_data()
997 	ds->gyro_calib_data[0].sens_numer = speed_2x*DS_GYRO_RES_PER_DEG_S;  in dualsense_get_calibration_data()
998 	ds->gyro_calib_data[0].sens_denom = abs(gyro_pitch_plus - gyro_pitch_bias) +  in dualsense_get_calibration_data()
1001 	ds->gyro_calib_data[1].abs_code = ABS_RY;  in dualsense_get_calibration_data()
1002 	ds->gyro_calib_data[1].bias = 0;  in dualsense_get_calibration_data()
1003 	ds->gyro_calib_data[1].sens_numer = speed_2x*DS_GYRO_RES_PER_DEG_S;  in dualsense_get_calibration_data()
1004 	ds->gyro_calib_data[1].sens_denom = abs(gyro_yaw_plus - gyro_yaw_bias) +  in dualsense_get_calibration_data()
1007 	ds->gyro_calib_data[2].abs_code = ABS_RZ;  in dualsense_get_calibration_data()
1008 	ds->gyro_calib_data[2].bias = 0;  in dualsense_get_calibration_data()
1009 	ds->gyro_calib_data[2].sens_numer = speed_2x*DS_GYRO_RES_PER_DEG_S;  in dualsense_get_calibration_data()
1010 	ds->gyro_calib_data[2].sens_denom = abs(gyro_roll_plus - gyro_roll_bias) +  in dualsense_get_calibration_data()
1018 	for (i = 0; i < ARRAY_SIZE(ds->gyro_calib_data); i++) {  in dualsense_get_calibration_data()
1019 		if (ds->gyro_calib_data[i].sens_denom == 0) {  in dualsense_get_calibration_data()
1021 					ds->gyro_calib_data[i].abs_code);  in dualsense_get_calibration_data()
1022 			ds->gyro_calib_data[i].bias = 0;  in dualsense_get_calibration_data()
1023 			ds->gyro_calib_data[i].sens_numer = DS_GYRO_RANGE;  in dualsense_get_calibration_data()
1024 			ds->gyro_calib_data[i].sens_denom = S16_MAX;  in dualsense_get_calibration_data()
1033 	ds->accel_calib_data[0].abs_code = ABS_X;  in dualsense_get_calibration_data()
1034 	ds->accel_calib_data[0].bias = acc_x_plus - range_2g / 2;  in dualsense_get_calibration_data()
1035 	ds->accel_calib_data[0].sens_numer = 2*DS_ACC_RES_PER_G;  in dualsense_get_calibration_data()
1036 	ds->accel_calib_data[0].sens_denom = range_2g;  in dualsense_get_calibration_data()
1039 	ds->accel_calib_data[1].abs_code = ABS_Y;  in dualsense_get_calibration_data()
1040 	ds->accel_calib_data[1].bias = acc_y_plus - range_2g / 2;  in dualsense_get_calibration_data()
1041 	ds->accel_calib_data[1].sens_numer = 2*DS_ACC_RES_PER_G;  in dualsense_get_calibration_data()
1042 	ds->accel_calib_data[1].sens_denom = range_2g;  in dualsense_get_calibration_data()
1045 	ds->accel_calib_data[2].abs_code = ABS_Z;  in dualsense_get_calibration_data()
1046 	ds->accel_calib_data[2].bias = acc_z_plus - range_2g / 2;  in dualsense_get_calibration_data()
1047 	ds->accel_calib_data[2].sens_numer = 2*DS_ACC_RES_PER_G;  in dualsense_get_calibration_data()
1048 	ds->accel_calib_data[2].sens_denom = range_2g;  in dualsense_get_calibration_data()
1055 	for (i = 0; i < ARRAY_SIZE(ds->accel_calib_data); i++) {  in dualsense_get_calibration_data()
1056 		if (ds->accel_calib_data[i].sens_denom == 0) {  in dualsense_get_calibration_data()
1058 					ds->accel_calib_data[i].abs_code);  in dualsense_get_calibration_data()
1059 			ds->accel_calib_data[i].bias = 0;  in dualsense_get_calibration_data()
1060 			ds->accel_calib_data[i].sens_numer = DS_ACC_RANGE;  in dualsense_get_calibration_data()
1061 			ds->accel_calib_data[i].sens_denom = S16_MAX;  in dualsense_get_calibration_data()
1071 static int dualsense_get_firmware_info(struct dualsense *ds)  in dualsense_get_firmware_info()  argument
1080 	ret = ps_get_report(ds->base.hdev, DS_FEATURE_REPORT_FIRMWARE_INFO, buf,  in dualsense_get_firmware_info()
1083 		hid_err(ds->base.hdev, "Failed to retrieve DualSense firmware info: %d\n", ret);  in dualsense_get_firmware_info()
1087 	ds->base.hw_version = get_unaligned_le32(&buf[24]);  in dualsense_get_firmware_info()
1088 	ds->base.fw_version = get_unaligned_le32(&buf[28]);  in dualsense_get_firmware_info()
1097 	ds->update_version = get_unaligned_le16(&buf[44]);  in dualsense_get_firmware_info()
1104 static int dualsense_get_mac_address(struct dualsense *ds)  in dualsense_get_mac_address()  argument
1113 	ret = ps_get_report(ds->base.hdev, DS_FEATURE_REPORT_PAIRING_INFO, buf,  in dualsense_get_mac_address()
1116 		hid_err(ds->base.hdev, "Failed to retrieve DualSense pairing info: %d\n", ret);  in dualsense_get_mac_address()
1120 	memcpy(ds->base.mac_address, &buf[1], sizeof(ds->base.mac_address));  in dualsense_get_mac_address()
1131 	struct dualsense *ds = container_of(mc_cdev, struct dualsense, lightbar);  in dualsense_lightbar_set_brightness()  local
1139 	dualsense_set_lightbar(ds, red, green, blue);  in dualsense_lightbar_set_brightness()
1146 	struct dualsense *ds = hid_get_drvdata(hdev);  in dualsense_player_led_get_brightness()  local
1148 	return !!(ds->player_leds_state & BIT(led - ds->player_leds));  in dualsense_player_led_get_brightness()
1154 	struct dualsense *ds = hid_get_drvdata(hdev);  in dualsense_player_led_set_brightness()  local
1158 	spin_lock_irqsave(&ds->base.lock, flags);  in dualsense_player_led_set_brightness()
1160 	led_index = led - ds->player_leds;  in dualsense_player_led_set_brightness()
1162 		ds->player_leds_state &= ~BIT(led_index);  in dualsense_player_led_set_brightness()
1164 		ds->player_leds_state |= BIT(led_index);  in dualsense_player_led_set_brightness()
1166 	ds->update_player_leds = true;  in dualsense_player_led_set_brightness()
1167 	spin_unlock_irqrestore(&ds->base.lock, flags);  in dualsense_player_led_set_brightness()
1169 	dualsense_schedule_work(ds);  in dualsense_player_led_set_brightness()
1174 static void dualsense_init_output_report(struct dualsense *ds, struct dualsense_output_report *rp,  in dualsense_init_output_report()  argument
1177 	struct hid_device *hdev = ds->base.hdev;  in dualsense_init_output_report()
1190 		bt->seq_tag = (ds->output_seq << 4) | 0x0;  in dualsense_init_output_report()
1191 		if (++ds->output_seq == 16)  in dualsense_init_output_report()
1192 			ds->output_seq = 0;  in dualsense_init_output_report()
1213 static inline void dualsense_schedule_work(struct dualsense *ds)  in dualsense_schedule_work()  argument
1217 	spin_lock_irqsave(&ds->base.lock, flags);  in dualsense_schedule_work()
1218 	if (ds->output_worker_initialized)  in dualsense_schedule_work()
1219 		schedule_work(&ds->output_worker);  in dualsense_schedule_work()
1220 	spin_unlock_irqrestore(&ds->base.lock, flags);  in dualsense_schedule_work()
1227 static void dualsense_send_output_report(struct dualsense *ds,  in dualsense_send_output_report()  argument
1230 	struct hid_device *hdev = ds->base.hdev;  in dualsense_send_output_report()
1248 	struct dualsense *ds = container_of(work, struct dualsense, output_worker);  in dualsense_output_worker()  local
1253 	dualsense_init_output_report(ds, &report, ds->output_report_dmabuf);  in dualsense_output_worker()
1256 	spin_lock_irqsave(&ds->base.lock, flags);  in dualsense_output_worker()
1258 	if (ds->update_rumble) {  in dualsense_output_worker()
1261 		if (ds->use_vibration_v2)  in dualsense_output_worker()
1265 		common->motor_left = ds->motor_left;  in dualsense_output_worker()
1266 		common->motor_right = ds->motor_right;  in dualsense_output_worker()
1267 		ds->update_rumble = false;  in dualsense_output_worker()
1270 	if (ds->update_lightbar) {  in dualsense_output_worker()
1272 		common->lightbar_red = ds->lightbar_red;  in dualsense_output_worker()
1273 		common->lightbar_green = ds->lightbar_green;  in dualsense_output_worker()
1274 		common->lightbar_blue = ds->lightbar_blue;  in dualsense_output_worker()
1276 		ds->update_lightbar = false;  in dualsense_output_worker()
1279 	if (ds->update_player_leds) {  in dualsense_output_worker()
1281 		common->player_leds = ds->player_leds_state;  in dualsense_output_worker()
1283 		ds->update_player_leds = false;  in dualsense_output_worker()
1286 	if (ds->update_mic_mute) {  in dualsense_output_worker()
1288 		common->mute_button_led = ds->mic_muted;  in dualsense_output_worker()
1290 		if (ds->mic_muted) {  in dualsense_output_worker()
1300 		ds->update_mic_mute = false;  in dualsense_output_worker()
1303 	spin_unlock_irqrestore(&ds->base.lock, flags);  in dualsense_output_worker()
1305 	dualsense_send_output_report(ds, &report);  in dualsense_output_worker()
1312 	struct dualsense *ds = container_of(ps_dev, struct dualsense, base);  in dualsense_parse_report()  local
1345 	input_report_abs(ds->gamepad, ABS_X,  ds_report->x);  in dualsense_parse_report()
1346 	input_report_abs(ds->gamepad, ABS_Y,  ds_report->y);  in dualsense_parse_report()
1347 	input_report_abs(ds->gamepad, ABS_RX, ds_report->rx);  in dualsense_parse_report()
1348 	input_report_abs(ds->gamepad, ABS_RY, ds_report->ry);  in dualsense_parse_report()
1349 	input_report_abs(ds->gamepad, ABS_Z,  ds_report->z);  in dualsense_parse_report()
1350 	input_report_abs(ds->gamepad, ABS_RZ, ds_report->rz);  in dualsense_parse_report()
1355 	input_report_abs(ds->gamepad, ABS_HAT0X, ps_gamepad_hat_mapping[value].x);  in dualsense_parse_report()
1356 	input_report_abs(ds->gamepad, ABS_HAT0Y, ps_gamepad_hat_mapping[value].y);  in dualsense_parse_report()
1358 	input_report_key(ds->gamepad, BTN_WEST,   ds_report->buttons[0] & DS_BUTTONS0_SQUARE);  in dualsense_parse_report()
1359 	input_report_key(ds->gamepad, BTN_SOUTH,  ds_report->buttons[0] & DS_BUTTONS0_CROSS);  in dualsense_parse_report()
1360 	input_report_key(ds->gamepad, BTN_EAST,   ds_report->buttons[0] & DS_BUTTONS0_CIRCLE);  in dualsense_parse_report()
1361 	input_report_key(ds->gamepad, BTN_NORTH,  ds_report->buttons[0] & DS_BUTTONS0_TRIANGLE);  in dualsense_parse_report()
1362 	input_report_key(ds->gamepad, BTN_TL,     ds_report->buttons[1] & DS_BUTTONS1_L1);  in dualsense_parse_report()
1363 	input_report_key(ds->gamepad, BTN_TR,     ds_report->buttons[1] & DS_BUTTONS1_R1);  in dualsense_parse_report()
1364 	input_report_key(ds->gamepad, BTN_TL2,    ds_report->buttons[1] & DS_BUTTONS1_L2);  in dualsense_parse_report()
1365 	input_report_key(ds->gamepad, BTN_TR2,    ds_report->buttons[1] & DS_BUTTONS1_R2);  in dualsense_parse_report()
1366 	input_report_key(ds->gamepad, BTN_SELECT, ds_report->buttons[1] & DS_BUTTONS1_CREATE);  in dualsense_parse_report()
1367 	input_report_key(ds->gamepad, BTN_START,  ds_report->buttons[1] & DS_BUTTONS1_OPTIONS);  in dualsense_parse_report()
1368 	input_report_key(ds->gamepad, BTN_THUMBL, ds_report->buttons[1] & DS_BUTTONS1_L3);  in dualsense_parse_report()
1369 	input_report_key(ds->gamepad, BTN_THUMBR, ds_report->buttons[1] & DS_BUTTONS1_R3);  in dualsense_parse_report()
1370 	input_report_key(ds->gamepad, BTN_MODE,   ds_report->buttons[2] & DS_BUTTONS2_PS_HOME);  in dualsense_parse_report()
1371 	input_sync(ds->gamepad);  in dualsense_parse_report()
1379 	if (btn_mic_state && !ds->last_btn_mic_state) {  in dualsense_parse_report()
1381 		ds->update_mic_mute = true;  in dualsense_parse_report()
1382 		ds->mic_muted = !ds->mic_muted; /* toggle */  in dualsense_parse_report()
1386 		dualsense_schedule_work(ds);  in dualsense_parse_report()
1388 	ds->last_btn_mic_state = btn_mic_state;  in dualsense_parse_report()
1393 		int calib_data = mult_frac(ds->gyro_calib_data[i].sens_numer,  in dualsense_parse_report()
1394 					   raw_data, ds->gyro_calib_data[i].sens_denom);  in dualsense_parse_report()
1396 		input_report_abs(ds->sensors, ds->gyro_calib_data[i].abs_code, calib_data);  in dualsense_parse_report()
1402 		int calib_data = mult_frac(ds->accel_calib_data[i].sens_numer,  in dualsense_parse_report()
1403 					   raw_data - ds->accel_calib_data[i].bias,  in dualsense_parse_report()
1404 					   ds->accel_calib_data[i].sens_denom);  in dualsense_parse_report()
1406 		input_report_abs(ds->sensors, ds->accel_calib_data[i].abs_code, calib_data);  in dualsense_parse_report()
1411 	if (!ds->sensor_timestamp_initialized) {  in dualsense_parse_report()
1412 		ds->sensor_timestamp_us = DIV_ROUND_CLOSEST(sensor_timestamp, 3);  in dualsense_parse_report()
1413 		ds->sensor_timestamp_initialized = true;  in dualsense_parse_report()
1417 		if (ds->prev_sensor_timestamp > sensor_timestamp)  in dualsense_parse_report()
1418 			delta = (U32_MAX - ds->prev_sensor_timestamp + sensor_timestamp + 1);  in dualsense_parse_report()
1420 			delta = sensor_timestamp - ds->prev_sensor_timestamp;  in dualsense_parse_report()
1421 		ds->sensor_timestamp_us += DIV_ROUND_CLOSEST(delta, 3);  in dualsense_parse_report()
1423 	ds->prev_sensor_timestamp = sensor_timestamp;  in dualsense_parse_report()
1424 	input_event(ds->sensors, EV_MSC, MSC_TIMESTAMP, ds->sensor_timestamp_us);  in dualsense_parse_report()
1425 	input_sync(ds->sensors);  in dualsense_parse_report()
1431 		input_mt_slot(ds->touchpad, i);  in dualsense_parse_report()
1432 		input_mt_report_slot_state(ds->touchpad, MT_TOOL_FINGER, active);  in dualsense_parse_report()
1438 			input_report_abs(ds->touchpad, ABS_MT_POSITION_X, x);  in dualsense_parse_report()
1439 			input_report_abs(ds->touchpad, ABS_MT_POSITION_Y, y);  in dualsense_parse_report()
1442 	input_mt_sync_frame(ds->touchpad);  in dualsense_parse_report()
1443 	input_report_key(ds->touchpad, BTN_LEFT, ds_report->buttons[2] & DS_BUTTONS2_TOUCHPAD);  in dualsense_parse_report()
1444 	input_sync(ds->touchpad);  in dualsense_parse_report()
1488 	struct dualsense *ds = hid_get_drvdata(hdev);  in dualsense_play_effect()  local
1494 	spin_lock_irqsave(&ds->base.lock, flags);  in dualsense_play_effect()
1495 	ds->update_rumble = true;  in dualsense_play_effect()
1496 	ds->motor_left = effect->u.rumble.strong_magnitude / 256;  in dualsense_play_effect()
1497 	ds->motor_right = effect->u.rumble.weak_magnitude / 256;  in dualsense_play_effect()
1498 	spin_unlock_irqrestore(&ds->base.lock, flags);  in dualsense_play_effect()
1500 	dualsense_schedule_work(ds);  in dualsense_play_effect()
1506 	struct dualsense *ds = container_of(ps_dev, struct dualsense, base);  in dualsense_remove()  local
1509 	spin_lock_irqsave(&ds->base.lock, flags);  in dualsense_remove()
1510 	ds->output_worker_initialized = false;  in dualsense_remove()
1511 	spin_unlock_irqrestore(&ds->base.lock, flags);  in dualsense_remove()
1513 	cancel_work_sync(&ds->output_worker);  in dualsense_remove()
1516 static int dualsense_reset_leds(struct dualsense *ds)  in dualsense_reset_leds()  argument
1525 	dualsense_init_output_report(ds, &report, buf);  in dualsense_reset_leds()
1535 	dualsense_send_output_report(ds, &report);  in dualsense_reset_leds()
1541 static void dualsense_set_lightbar(struct dualsense *ds, uint8_t red, uint8_t green, uint8_t blue)  in dualsense_set_lightbar()  argument
1545 	spin_lock_irqsave(&ds->base.lock, flags);  in dualsense_set_lightbar()
1546 	ds->update_lightbar = true;  in dualsense_set_lightbar()
1547 	ds->lightbar_red = red;  in dualsense_set_lightbar()
1548 	ds->lightbar_green = green;  in dualsense_set_lightbar()
1549 	ds->lightbar_blue = blue;  in dualsense_set_lightbar()
1550 	spin_unlock_irqrestore(&ds->base.lock, flags);  in dualsense_set_lightbar()
1552 	dualsense_schedule_work(ds);  in dualsense_set_lightbar()
1555 static void dualsense_set_player_leds(struct dualsense *ds)  in dualsense_set_player_leds()  argument
1571 	uint8_t player_id = ds->base.player_id % ARRAY_SIZE(player_ids);  in dualsense_set_player_leds()
1573 	ds->update_player_leds = true;  in dualsense_set_player_leds()
1574 	ds->player_leds_state = player_ids[player_id];  in dualsense_set_player_leds()
1575 	dualsense_schedule_work(ds);  in dualsense_set_player_leds()
1580 	struct dualsense *ds;  in dualsense_create()  local
1598 	ds = devm_kzalloc(&hdev->dev, sizeof(*ds), GFP_KERNEL);  in dualsense_create()
1599 	if (!ds)  in dualsense_create()
1608 	ps_dev = &ds->base;  in dualsense_create()
1615 	INIT_WORK(&ds->output_worker, dualsense_output_worker);  in dualsense_create()
1616 	ds->output_worker_initialized = true;  in dualsense_create()
1617 	hid_set_drvdata(hdev, ds);  in dualsense_create()
1620 	ds->output_report_dmabuf = devm_kzalloc(&hdev->dev, max_output_report_size, GFP_KERNEL);  in dualsense_create()
1621 	if (!ds->output_report_dmabuf)  in dualsense_create()
1624 	ret = dualsense_get_mac_address(ds);  in dualsense_create()
1629 	snprintf(hdev->uniq, sizeof(hdev->uniq), "%pMR", ds->base.mac_address);  in dualsense_create()
1631 	ret = dualsense_get_firmware_info(ds);  in dualsense_create()
1647 		ds->use_vibration_v2 = ds->update_version >= DS_FEATURE_VERSION(2, 21);  in dualsense_create()
1649 		ds->use_vibration_v2 = true;  in dualsense_create()
1656 	ret = dualsense_get_calibration_data(ds);  in dualsense_create()
1662 	ds->gamepad = ps_gamepad_create(hdev, dualsense_play_effect);  in dualsense_create()
1663 	if (IS_ERR(ds->gamepad)) {  in dualsense_create()
1664 		ret = PTR_ERR(ds->gamepad);  in dualsense_create()
1668 	ps_dev->input_dev_name = dev_name(&ds->gamepad->dev);  in dualsense_create()
1670 	ds->sensors = ps_sensors_create(hdev, DS_ACC_RANGE, DS_ACC_RES_PER_G,  in dualsense_create()
1672 	if (IS_ERR(ds->sensors)) {  in dualsense_create()
1673 		ret = PTR_ERR(ds->sensors);  in dualsense_create()
1677 	ds->touchpad = ps_touchpad_create(hdev, DS_TOUCHPAD_WIDTH, DS_TOUCHPAD_HEIGHT, 2);  in dualsense_create()
1678 	if (IS_ERR(ds->touchpad)) {  in dualsense_create()
1679 		ret = PTR_ERR(ds->touchpad);  in dualsense_create()
1692 	ret = dualsense_reset_leds(ds);  in dualsense_create()
1696 	ret = ps_lightbar_register(ps_dev, &ds->lightbar, dualsense_lightbar_set_brightness);  in dualsense_create()
1701 	dualsense_set_lightbar(ds, 0, 0, 128); /* blue */  in dualsense_create()
1706 		ret = ps_led_register(ps_dev, &ds->player_leds[i], led_info);  in dualsense_create()
1718 	dualsense_set_player_leds(ds);  in dualsense_create()
1725 			ds->base.hw_version, ds->base.fw_version);  in dualsense_create()
1727 	return &ds->base;  in dualsense_create()