258 lines
9.9 KiB
C++
258 lines
9.9 KiB
C++
//
|
|
// Created by awalol on 2026/3/4.
|
|
//
|
|
|
|
#include <array>
|
|
#include <cstdint>
|
|
#include <iomanip>
|
|
#include <iostream>
|
|
|
|
#include "hci_cmd.h"
|
|
|
|
inline const char *opcode_to_str(const uint16_t opcode) {
|
|
switch (opcode) {
|
|
case HCI_OPCODE_HCI_INQUIRY:
|
|
return "HCI_INQUIRY";
|
|
case HCI_OPCODE_HCI_INQUIRY_CANCEL:
|
|
return "HCI_INQUIRY_CANCEL";
|
|
case HCI_OPCODE_HCI_CREATE_CONNECTION:
|
|
return "HCI_CREATE_CONNECTION";
|
|
case HCI_OPCODE_HCI_ACCEPT_CONNECTION_REQUEST:
|
|
return "HCI_ACCEPT_CONNECTION_REQUEST";
|
|
case HCI_OPCODE_HCI_LINK_KEY_REQUEST_REPLY:
|
|
return "HCI_LINK_KEY_REQUEST_REPLY";
|
|
case HCI_OPCODE_HCI_LINK_KEY_REQUEST_NEGATIVE_REPLY:
|
|
return "HCI_LINK_KEY_REQUEST_NEGATIVE_REPLY";
|
|
case HCI_OPCODE_HCI_REJECT_CONNECTION_REQUEST:
|
|
return "HCI_REJECT_CONNECTION_REQUEST";
|
|
case HCI_OPCODE_HCI_AUTHENTICATION_REQUESTED:
|
|
return "HCI_AUTHENTICATION_REQUESTED";
|
|
case HCI_OPCODE_HCI_SET_CONNECTION_ENCRYPTION:
|
|
return "HCI_SET_CONNECTION_ENCRYPTION";
|
|
case HCI_OPCODE_HCI_READ_REMOTE_SUPPORTED_FEATURES_COMMAND:
|
|
return "HCI_READ_REMOTE_SUPPORTED_FEATURES";
|
|
case HCI_OPCODE_HCI_READ_REMOTE_EXTENDED_FEATURES_COMMAND:
|
|
return "HCI_READ_REMOTE_EXTENDED_FEATURES";
|
|
case HCI_OPCODE_HCI_SWITCH_ROLE_COMMAND:
|
|
return "HCI_SWITCH_ROLE";
|
|
case HCI_OPCODE_HCI_IO_CAPABILITY_REQUEST_REPLY:
|
|
return "HCI_IO_CAPABILITY_REQUEST_REPLY";
|
|
case HCI_OPCODE_HCI_USER_CONFIRMATION_REQUEST_REPLY:
|
|
return "HCI_USER_CONFIRMATION_REQUEST_REPLY";
|
|
case HCI_OPCODE_HCI_DISCONNECT:
|
|
return "HCI_DISCONNECT";
|
|
case HCI_OPCODE_HCI_SET_EVENT_MASK:
|
|
return "HCI_SET_EVENT_MASK";
|
|
case HCI_OPCODE_HCI_RESET:
|
|
return "HCI_RESET";
|
|
case HCI_OPCODE_HCI_WRITE_LOCAL_NAME:
|
|
return "HCI_WRITE_LOCAL_NAME";
|
|
case HCI_OPCODE_HCI_READ_LOCAL_NAME:
|
|
return "HCI_READ_LOCAL_NAME";
|
|
case HCI_OPCODE_HCI_WRITE_PAGE_TIMEOUT:
|
|
return "HCI_WRITE_PAGE_TIMEOUT";
|
|
case HCI_OPCODE_HCI_WRITE_SCAN_ENABLE:
|
|
return "HCI_WRITE_SCAN_ENABLE";
|
|
case HCI_OPCODE_HCI_WRITE_CLASS_OF_DEVICE:
|
|
return "HCI_WRITE_CLASS_OF_DEVICE";
|
|
case HCI_OPCODE_HCI_WRITE_INQUIRY_MODE:
|
|
return "HCI_WRITE_INQUIRY_MODE";
|
|
case HCI_OPCODE_HCI_WRITE_EXTENDED_INQUIRY_RESPONSE:
|
|
return "HCI_WRITE_EXTENDED_INQUIRY_RESPONSE";
|
|
case HCI_OPCODE_HCI_WRITE_PAGE_SCAN_TYPE:
|
|
return "HCI_WRITE_PAGE_SCAN_TYPE";
|
|
case HCI_OPCODE_HCI_WRITE_SIMPLE_PAIRING_MODE:
|
|
return "HCI_WRITE_SIMPLE_PAIRING_MODE";
|
|
case HCI_OPCODE_HCI_SET_EVENT_MASK_2:
|
|
return "HCI_SET_EVENT_MASK_2";
|
|
case HCI_OPCODE_HCI_WRITE_LE_HOST_SUPPORTED:
|
|
return "HCI_WRITE_LE_HOST_SUPPORTED";
|
|
case HCI_OPCODE_HCI_WRITE_SECURE_CONNECTIONS_HOST_SUPPORT:
|
|
return "HCI_WRITE_SECURE_CONNECTIONS_HOST_SUPPORT";
|
|
case HCI_OPCODE_HCI_WRITE_DEFAULT_LINK_POLICY_SETTING:
|
|
return "HCI_WRITE_DEFAULT_LINK_POLICY_SETTING";
|
|
case HCI_OPCODE_HCI_READ_LOCAL_VERSION_INFORMATION:
|
|
return "HCI_READ_LOCAL_VERSION_INFORMATION";
|
|
case HCI_OPCODE_HCI_READ_LOCAL_SUPPORTED_COMMANDS:
|
|
return "HCI_READ_LOCAL_SUPPORTED_COMMANDS";
|
|
case HCI_OPCODE_HCI_READ_LOCAL_SUPPORTED_FEATURES:
|
|
return "HCI_READ_LOCAL_SUPPORTED_FEATURES";
|
|
case HCI_OPCODE_HCI_READ_BUFFER_SIZE:
|
|
return "HCI_READ_BUFFER_SIZE";
|
|
case HCI_OPCODE_HCI_READ_BD_ADDR:
|
|
return "HCI_READ_BD_ADDR";
|
|
case HCI_OPCODE_HCI_READ_ENCRYPTION_KEY_SIZE:
|
|
return "HCI_READ_ENCRYPTION_KEY_SIZE";
|
|
case 0xFC01:
|
|
return "HCI_VENDOR_0xFC01";
|
|
default:
|
|
return "UNKNOWN_OPCODE";
|
|
}
|
|
}
|
|
|
|
inline constexpr uint32_t crc32_table_entry(uint32_t index) {
|
|
for (unsigned bit = 0; bit < 8; ++bit) {
|
|
index = (index >> 1) ^ (0xEDB88320 & -(index & 1));
|
|
}
|
|
return index;
|
|
}
|
|
|
|
inline constexpr auto make_crc32_table() {
|
|
std::array<uint32_t, 256> table{};
|
|
for (uint32_t i = 0; i < table.size(); ++i) {
|
|
table[i] = crc32_table_entry(i);
|
|
}
|
|
return table;
|
|
}
|
|
|
|
inline constexpr auto crc32_lookup_table = make_crc32_table();
|
|
|
|
inline uint32_t crc32_seeded(const uint8_t *data, size_t size, const uint32_t seed) {
|
|
uint32_t crc = ~seed;
|
|
|
|
while (size--) {
|
|
crc = (crc >> 8) ^ crc32_lookup_table[(crc ^ *data++) & 0xff];
|
|
}
|
|
|
|
return ~crc;
|
|
}
|
|
|
|
inline uint32_t crc32(const uint8_t* data, size_t size) {
|
|
return crc32_seeded(data, size, 0xEADA2D49); // 0xA2 seed
|
|
}
|
|
|
|
inline void fill_output_report_checksum(uint8_t* outputData,size_t len)
|
|
{
|
|
uint32_t crc = crc32(outputData, len - 4);
|
|
outputData[len - 4] = (crc >> 0) & 0xFF;
|
|
outputData[len - 3] = (crc >> 8) & 0xFF;
|
|
outputData[len - 2] = (crc >> 16) & 0xFF;
|
|
outputData[len - 1] = (crc >> 24) & 0xFF;
|
|
}
|
|
|
|
inline uint32_t crc32_feature(const uint8_t *data, std::size_t size) {
|
|
// https://github.com/rafaelvaloto/Dualsense-Multiplatform/blob/main/Source/Private/GCore/Utils/CR32.cpp
|
|
return crc32_seeded(data, size, 0x2060efc3); // 0x53 seed
|
|
}
|
|
|
|
inline void fill_feature_report_checksum(uint8_t *data, const size_t len) {
|
|
uint32_t crc = crc32_feature(data,len - 4);
|
|
data[len - 4] = (crc >> 0) & 0xFF;
|
|
data[len - 3] = (crc >> 8) & 0xFF;
|
|
data[len - 2] = (crc >> 16) & 0xFF;
|
|
data[len - 1] = (crc >> 24) & 0xFF;
|
|
}
|
|
|
|
enum PowerState : uint8_t {
|
|
Discharging = 0x00, // Use PowerPercent
|
|
Charging = 0x01, // Use PowerPercent
|
|
Complete = 0x02, // PowerPercent not valid? assume 100%?
|
|
AbnormalVoltage = 0x0A, // PowerPercent not valid?
|
|
AbnormalTemperature = 0x0B, // PowerPercent not valid?
|
|
ChargingError = 0x0F // PowerPercent not valid?
|
|
};
|
|
|
|
enum Direction : uint8_t {
|
|
North = 0,
|
|
NorthEast,
|
|
East,
|
|
SouthEast,
|
|
South,
|
|
SouthWest,
|
|
West,
|
|
NorthWest,
|
|
None = 8
|
|
};
|
|
|
|
struct __attribute__((packed)) TouchFingerData { // 4
|
|
/*0.0*/ uint32_t Index : 7;
|
|
/*0.7*/ uint32_t NotTouching : 1;
|
|
/*1.0*/ uint32_t FingerX : 12;
|
|
/*2.4*/ uint32_t FingerY : 12;
|
|
};
|
|
|
|
struct __attribute__((packed)) TouchData { // 9
|
|
/*0*/ TouchFingerData Finger[2];
|
|
/*8*/ uint8_t Timestamp;
|
|
};
|
|
|
|
struct __attribute__((packed)) USBGetStateData { // 63
|
|
/* 0 */ uint8_t LeftStickX;
|
|
/* 1 */ uint8_t LeftStickY;
|
|
/* 2 */ uint8_t RightStickX;
|
|
/* 3 */ uint8_t RightStickY;
|
|
/* 4 */ uint8_t TriggerLeft;
|
|
/* 5 */ uint8_t TriggerRight;
|
|
/* 6 */ uint8_t SeqNo; // always 0x01 on BT
|
|
/* 7.0*/ Direction DPad : 4;
|
|
/* 7.4*/ uint8_t ButtonSquare : 1;
|
|
/* 7.5*/ uint8_t ButtonCross : 1;
|
|
/* 7.6*/ uint8_t ButtonCircle : 1;
|
|
/* 7.7*/ uint8_t ButtonTriangle : 1;
|
|
/* 8.0*/ uint8_t ButtonL1 : 1;
|
|
/* 8.1*/ uint8_t ButtonR1 : 1;
|
|
/* 8.2*/ uint8_t ButtonL2 : 1;
|
|
/* 8.3*/ uint8_t ButtonR2 : 1;
|
|
/* 8.4*/ uint8_t ButtonCreate : 1;
|
|
/* 8.5*/ uint8_t ButtonOptions : 1;
|
|
/* 8.6*/ uint8_t ButtonL3 : 1;
|
|
/* 8.7*/ uint8_t ButtonR3 : 1;
|
|
/* 9.0*/ uint8_t ButtonHome : 1;
|
|
/* 9.1*/ uint8_t ButtonPad : 1;
|
|
/* 9.2*/ uint8_t ButtonMute : 1;
|
|
/* 9.3*/ uint8_t UNK1 : 1; // appears unused
|
|
/* 9.4*/ uint8_t ButtonLeftFunction : 1; // DualSense Edge
|
|
/* 9.5*/ uint8_t ButtonRightFunction : 1; // DualSense Edge
|
|
/* 9.6*/ uint8_t ButtonLeftPaddle : 1; // DualSense Edge
|
|
/* 9.7*/ uint8_t ButtonRightPaddle : 1; // DualSense Edge
|
|
/*10 */ uint8_t UNK2; // appears unused
|
|
/*11 */ uint32_t UNK_COUNTER; // Linux driver calls this reserved, tools leak calls the 2 high bytes "random"
|
|
/*15 */ int16_t AngularVelocityX;
|
|
/*17 */ int16_t AngularVelocityZ;
|
|
/*19 */ int16_t AngularVelocityY;
|
|
/*21 */ int16_t AccelerometerX;
|
|
/*23 */ int16_t AccelerometerY;
|
|
/*25 */ int16_t AccelerometerZ;
|
|
/*27 */ uint32_t SensorTimestamp;
|
|
/*31 */ int8_t Temperature; // reserved2 in Linux driver
|
|
/*32 */ TouchData Touch;
|
|
/*41.0*/ uint8_t TriggerRightStopLocation: 4; // trigger stop can be a range from 0 to 9 (F/9.0 for Apple interface)
|
|
/*41.4*/ uint8_t TriggerRightStatus: 4;
|
|
/*42.0*/ uint8_t TriggerLeftStopLocation: 4;
|
|
/*42.4*/ uint8_t TriggerLeftStatus: 4; // 0 feedbackNoLoad
|
|
// 1 feedbackLoadApplied
|
|
// 0 weaponReady
|
|
// 1 weaponFiring
|
|
// 2 weaponFired
|
|
// 0 vibrationNotVibrating
|
|
// 1 vibrationIsVibrating
|
|
/*43 */ uint32_t HostTimestamp; // mirrors data from report write
|
|
/*47.0*/ uint8_t TriggerRightEffect: 4; // Active trigger effect, previously we thought this was status max
|
|
/*47.4*/ uint8_t TriggerLeftEffect: 4; // 0 for reset and all other effects
|
|
// 1 for feedback effect
|
|
// 2 for weapon effect
|
|
// 3 for vibration
|
|
/*48 */ uint32_t DeviceTimeStamp;
|
|
/*52.0*/ uint8_t PowerPercent : 4; // 0x00-0x0A
|
|
/*52.4*/ PowerState Power : 4;
|
|
/*53.0*/ uint8_t PluggedHeadphones : 1;
|
|
/*53.1*/ uint8_t PluggedMic : 1;
|
|
/*53.2*/ uint8_t MicMuted: 1; // Mic muted by powersave/mute command
|
|
/*53.3*/ uint8_t PluggedUsbData : 1;
|
|
/*53.4*/ uint8_t PluggedUsbPower : 1; // appears that this cannot be 1 if PluggedUsbData is 1
|
|
/*53.5*/ uint8_t UsbPowerOnBT : 1; // appears this is only 1 if BT connected and USB powered
|
|
/*53.5*/ uint8_t DockDetect : 1;
|
|
/*53.5*/ uint8_t PluggedUnk : 1;
|
|
/*54.0*/ uint8_t PluggedExternalMic : 1; // Is external mic active (automatic in mic auto mode)
|
|
/*54.1*/ uint8_t HapticLowPassFilter : 1; // Is the Haptic Low-Pass-Filter active?
|
|
/*54.2*/ uint8_t PluggedUnk3 : 6;
|
|
/*55 */ uint8_t AesCmac[8];
|
|
};
|
|
|
|
inline void print_hex(const uint8_t* data,size_t size) {
|
|
for (int i = 0; i < size; i++) {
|
|
std::cout << std::hex << std::setw(2) << std::setfill('0') << static_cast<int>(data[i]) << " ";
|
|
}
|
|
std::cout << std::endl;
|
|
}
|