Support BLE with fixing left/right motor vibration error

DualSense2Xbox/DualSense2Xbox.csproj

@@ -46,6 +46,7 @@
   <ItemGroup>
     <Compile Include="DualSense_Base.cs" />
     <Compile Include="DualSense_Base_Static.cs" />
+    <Compile Include="DualSense_Bluetooth.cs" />
     <Compile Include="DualSense_USB.cs" />
     <Compile Include="GTA_AdaptiveTrigger.cs" />
     <Compile Include="Program.cs" />

DualSense2Xbox/DualSense_Base_Static.cs

@@ -18,5 +18,49 @@ public static Int64 VibrateTrigger(byte Freq)
         {
             return ((Int64)Freq << 56) | 0x00FF000000FF0026;
         }
+        private static readonly uint[] ChecksumTableCRC32 =
+        {
+            0xd202ef8d, 0xa505df1b, 0x3c0c8ea1, 0x4b0bbe37, 0xd56f2b94, 0xa2681b02, 0x3b614ab8, 0x4c667a2e,
+            0xdcd967bf, 0xabde5729, 0x32d70693, 0x45d03605, 0xdbb4a3a6, 0xacb39330, 0x35bac28a, 0x42bdf21c,
+            0xcfb5ffe9, 0xb8b2cf7f, 0x21bb9ec5, 0x56bcae53, 0xc8d83bf0, 0xbfdf0b66, 0x26d65adc, 0x51d16a4a,
+            0xc16e77db, 0xb669474d, 0x2f6016f7, 0x58672661, 0xc603b3c2, 0xb1048354, 0x280dd2ee, 0x5f0ae278,
+            0xe96ccf45, 0x9e6bffd3, 0x762ae69, 0x70659eff, 0xee010b5c, 0x99063bca, 0xf6a70, 0x77085ae6,
+            0xe7b74777, 0x90b077e1, 0x9b9265b, 0x7ebe16cd, 0xe0da836e, 0x97ddb3f8, 0xed4e242, 0x79d3d2d4,
+            0xf4dbdf21, 0x83dcefb7, 0x1ad5be0d, 0x6dd28e9b, 0xf3b61b38, 0x84b12bae, 0x1db87a14, 0x6abf4a82,
+            0xfa005713, 0x8d076785, 0x140e363f, 0x630906a9, 0xfd6d930a, 0x8a6aa39c, 0x1363f226, 0x6464c2b0,
+            0xa4deae1d, 0xd3d99e8b, 0x4ad0cf31, 0x3dd7ffa7, 0xa3b36a04, 0xd4b45a92, 0x4dbd0b28, 0x3aba3bbe,
+            0xaa05262f, 0xdd0216b9, 0x440b4703, 0x330c7795, 0xad68e236, 0xda6fd2a0, 0x4366831a, 0x3461b38c,
+            0xb969be79, 0xce6e8eef, 0x5767df55, 0x2060efc3, 0xbe047a60, 0xc9034af6, 0x500a1b4c, 0x270d2bda,
+            0xb7b2364b, 0xc0b506dd, 0x59bc5767, 0x2ebb67f1, 0xb0dff252, 0xc7d8c2c4, 0x5ed1937e, 0x29d6a3e8,
+            0x9fb08ed5, 0xe8b7be43, 0x71beeff9, 0x6b9df6f, 0x98dd4acc, 0xefda7a5a, 0x76d32be0, 0x1d41b76,
+            0x916b06e7, 0xe66c3671, 0x7f6567cb, 0x862575d, 0x9606c2fe, 0xe101f268, 0x7808a3d2, 0xf0f9344,
+            0x82079eb1, 0xf500ae27, 0x6c09ff9d, 0x1b0ecf0b, 0x856a5aa8, 0xf26d6a3e, 0x6b643b84, 0x1c630b12,
+            0x8cdc1683, 0xfbdb2615, 0x62d277af, 0x15d54739, 0x8bb1d29a, 0xfcb6e20c, 0x65bfb3b6, 0x12b88320,
+            0x3fba6cad, 0x48bd5c3b, 0xd1b40d81, 0xa6b33d17, 0x38d7a8b4, 0x4fd09822, 0xd6d9c998, 0xa1def90e,
+            0x3161e49f, 0x4666d409, 0xdf6f85b3, 0xa868b525, 0x360c2086, 0x410b1010, 0xd80241aa, 0xaf05713c,
+            0x220d7cc9, 0x550a4c5f, 0xcc031de5, 0xbb042d73, 0x2560b8d0, 0x52678846, 0xcb6ed9fc, 0xbc69e96a,
+            0x2cd6f4fb, 0x5bd1c46d, 0xc2d895d7, 0xb5dfa541, 0x2bbb30e2, 0x5cbc0074, 0xc5b551ce, 0xb2b26158,
+            0x4d44c65, 0x73d37cf3, 0xeada2d49, 0x9ddd1ddf, 0x3b9887c, 0x74beb8ea, 0xedb7e950, 0x9ab0d9c6,
+            0xa0fc457, 0x7d08f4c1, 0xe401a57b, 0x930695ed, 0xd62004e, 0x7a6530d8, 0xe36c6162, 0x946b51f4,
+            0x19635c01, 0x6e646c97, 0xf76d3d2d, 0x806a0dbb, 0x1e0e9818, 0x6909a88e, 0xf000f934, 0x8707c9a2,
+            0x17b8d433, 0x60bfe4a5, 0xf9b6b51f, 0x8eb18589, 0x10d5102a, 0x67d220bc, 0xfedb7106, 0x89dc4190,
+            0x49662d3d, 0x3e611dab, 0xa7684c11, 0xd06f7c87, 0x4e0be924, 0x390cd9b2, 0xa0058808, 0xd702b89e,
+            0x47bda50f, 0x30ba9599, 0xa9b3c423, 0xdeb4f4b5, 0x40d06116, 0x37d75180, 0xaede003a, 0xd9d930ac,
+            0x54d13d59, 0x23d60dcf, 0xbadf5c75, 0xcdd86ce3, 0x53bcf940, 0x24bbc9d6, 0xbdb2986c, 0xcab5a8fa,
+            0x5a0ab56b, 0x2d0d85fd, 0xb404d447, 0xc303e4d1, 0x5d677172, 0x2a6041e4, 0xb369105e, 0xc46e20c8,
+            0x72080df5, 0x50f3d63, 0x9c066cd9, 0xeb015c4f, 0x7565c9ec, 0x262f97a, 0x9b6ba8c0, 0xec6c9856,
+            0x7cd385c7, 0xbd4b551, 0x92dde4eb, 0xe5dad47d, 0x7bbe41de, 0xcb97148, 0x95b020f2, 0xe2b71064,
+            0x6fbf1d91, 0x18b82d07, 0x81b17cbd, 0xf6b64c2b, 0x68d2d988, 0x1fd5e91e, 0x86dcb8a4, 0xf1db8832,
+            0x616495a3, 0x1663a535, 0x8f6af48f, 0xf86dc419, 0x660951ba, 0x110e612c, 0x88073096, 0xff000000
+        };
+        protected static uint ComputeCRC32(byte[] byteData, int Size)
+        {
+            if (Size < 0)
+                throw new ArgumentOutOfRangeException("In ComputeCRC32: the Size is negative.");
+            uint hashResult = 0xeada2d49;
+            for (int i = 0; i < Size; ++i)
+                hashResult = ChecksumTableCRC32[(hashResult & 0xFF) ^ byteData[i]] ^ (hashResult >> 8);
+            return hashResult;
+        }
     }
 }

DualSense2Xbox/DualSense_Bluetooth.cs

@@ -0,0 +1,61 @@
+using Device.Net;
+using System;
+
+
+namespace DualSense2Xbox
+{
+    class DualSense_Bluetooth : DualSense_Base
+    {
+        public DualSense_Bluetooth(IDevice _device)
+            : base(_device)
+        {
+            if (ReadBufferSize != 78)
+                throw new Exception("Unknown Read Buffer!");
+        }
+        public override void RefreshButtonStatus()
+        {
+            var DeviceInputByteArray = ReadDeviceInput();
+            UpdateButtonStatus(DeviceInputByteArray[2], DeviceInputByteArray[3], DeviceInputByteArray[4], DeviceInputByteArray[5], DeviceInputByteArray[6], DeviceInputByteArray[7], DeviceInputByteArray[9], DeviceInputByteArray[10]);
+        }
+        public override void SetVibration(byte Left, byte Right)
+        {
+            LeftMotor = Left;
+            RightMotor = Right;
+            SendHaptics();
+        }
+        public override void SetAdaptiveTrigger(bool IsLeftTrigger, Int64 Parameter)
+        {
+            if (IsLeftTrigger)
+                LeftAdaptiveTrigger = Parameter;
+            else
+                RightAdaptiveTrigger = Parameter;
+            SendHaptics();
+        }
+        private void SendHaptics()
+        {
+            var LeftTriggerParameter = BitConverter.GetBytes(LeftAdaptiveTrigger);
+            var RightTriggerParameter = BitConverter.GetBytes(RightAdaptiveTrigger);
+
+            var outputReport = new byte[WriteBufferSize];
+            outputReport[0] = 0x31;
+            outputReport[1] = 0x02; // report type
+            outputReport[2] = 0x1 | 0x2 | 0x4 | 0x8; // flags determiing what changes this packet will perform
+            outputReport[4] = RightMotor;
+            outputReport[5] = LeftMotor;
+            for (int i = 0; i < 7; ++i)
+            {
+                outputReport[12 + i] = RightTriggerParameter[i];
+                outputReport[23 + i] = LeftTriggerParameter[i];
+            }
+            outputReport[21] = RightTriggerParameter[7];
+            outputReport[32] = LeftTriggerParameter[7];
+
+            //Produce CRC32 and Copy to Send Buffer
+            uint _CRC32 = ComputeCRC32(outputReport, 74);
+            byte[] _CRC32_Bytes = BitConverter.GetBytes(_CRC32);
+            Array.Copy(_CRC32_Bytes, 0, outputReport, 74, 4);
+
+            SendData(outputReport);
+        }
+    }
+}

DualSense2Xbox/DualSense_USB.cs

@@ -40,8 +40,8 @@ private void SendHaptics()
             var outputReport = new byte[WriteBufferSize];
             outputReport[0] = 0x02; // report type
             outputReport[1] = 0x1 | 0x2 | 0x4 | 0x8; // flags determiing what changes this packet will perform
-            outputReport[3] = LeftMotor;
-            outputReport[4] = RightMotor;
+            outputReport[3] = RightMotor;
+            outputReport[4] = LeftMotor;
             for (int i = 0; i < 7; ++i)
             {
                 outputReport[11 + i] = RightTriggerParameter[i];
@@ -51,6 +51,5 @@ private void SendHaptics()
             outputReport[31] = LeftTriggerParameter[7];
             SendData(outputReport);
         }
-
     }
 }

DualSense2Xbox/Program.cs

@@ -24,10 +24,15 @@ static void Main(string[] args)
             int DualSenseCount = DualSenseList.Length;
             if (DualSenseCount <= 0)
                 throw new Exception("Cannot find DualSense. Check the cable again!");
-            if (DualSenseList[0].ReadBufferSize != 64)
-                throw new NotImplementedException("Currently this application supports USB connection only.");
             var DualSenseDevice = DeviceManager.Current.GetDevice(DualSenseList[0]);
-            DualSense_USB dualSense = new DualSense_USB(DualSenseDevice); 
+
+            DualSense_Base dualSense;
+            if (DualSenseList[0].ReadBufferSize == 64)
+                dualSense = new DualSense_USB(DualSenseDevice);
+            else if (DualSenseList[0].ReadBufferSize == 78)
+                dualSense = new DualSense_Bluetooth(DualSenseDevice);
+            else
+                throw new NotImplementedException("Currently this application supports USB connection only.");
 
             //Set Adaptive Trigger as "Normal"
             dualSense.SetLeftAdaptiveTrigger(DualSense_Base.NormalTrigger);