Adding support for the MagicMotion Smart Mini Vibe

Author: blackspherefollower

Buttplug.Server.Managers.UWPBluetoothManager/UWPBluetoothDeviceFactory.cs

@@ -8,6 +8,7 @@
 using Windows.Devices.Bluetooth;
 using Windows.Devices.Bluetooth.Advertisement;
 using Windows.Devices.Bluetooth.GenericAttributeProfile;
+using System.Collections.Generic;
 
 namespace Buttplug.Server.Managers.UWPBluetoothManager
 {
@@ -32,30 +33,35 @@ public UWPBluetoothDeviceFactory([NotNull] IButtplugLogManager aLogManager, [Not
 
         public bool MayBeDevice(BluetoothLEAdvertisement aAdvertisement)
         {
-            if (_deviceInfo.Names.Any() && !_deviceInfo.Names.Contains(aAdvertisement.LocalName))
+            var advertName = aAdvertisement.LocalName;
+            var advertGUIDs = new List<Guid>();
+            advertGUIDs.AddRange(aAdvertisement.ServiceUuids);
+
+            if (_deviceInfo.Names.Any() && !_deviceInfo.Names.Contains(advertName))
             {
                 return false;
             }
-            else if (_deviceInfo.Names.Any() && !aAdvertisement.ServiceUuids.Any())
+
+            if (_deviceInfo.Names.Any() && !advertGUIDs.Any())
             {
-                _bpLogger.Debug("Found " + aAdvertisement.LocalName + " for " + _deviceInfo.GetType().ToString());
+                _bpLogger.Debug("Found " + advertName + " for " + _deviceInfo.GetType().ToString());
                 _bpLogger.Debug("No advertised services?");
                 return true;
             }
 
-            _bpLogger.Debug("Found " + aAdvertisement.LocalName + " for " + _deviceInfo.GetType().ToString());
+            _bpLogger.Debug("Found " + advertName + " for " + _deviceInfo.GetType().ToString());
             foreach (var s in _deviceInfo.Services)
             {
                 _bpLogger.Debug("Expecting " + s.ToString());
             }
 
-            foreach (var s in aAdvertisement.ServiceUuids)
+            foreach (var s in advertGUIDs)
             {
                 _bpLogger.Debug("Got " + s.ToString());
             }
 
             // Intersect doesn't intersect until the enumerator is called
-            var sv = _deviceInfo.Services.Intersect(aAdvertisement.ServiceUuids);
+            var sv = _deviceInfo.Services.Intersect(advertGUIDs);
             foreach (var s in sv)
             {
                 _bpLogger.Debug("Matched " + s.ToString());
@@ -91,6 +97,11 @@ public async Task<IButtplugDevice> CreateDeviceAsync([NotNull] BluetoothLEDevice
                 return null;
             }
 
+            foreach (var s in chrResult.Characteristics)
+            {
+                _bpLogger.Trace("Found characteristics UUID: " + s.Uuid + " (" + aDevice.Name + ")");
+            }
+
             var chrs = from x in chrResult.Characteristics
                        where _deviceInfo.Characteristics.Contains(x.Uuid)
                        select x;

Buttplug.Server/Bluetooth/BluetoothSubtypeManager.cs

@@ -25,6 +25,7 @@ protected BluetoothSubtypeManager([NotNull] IButtplugLogManager aLogManager)
                 new LovenseRev1BluetoothInfo(),
                 new LovenseRev2BluetoothInfo(),
                 new LovenseRev3BluetoothInfo(),
+                new MagicMotionBluetoothInfo(),
                 new VibratissimoBluetoothInfo(),
                 new VorzeA10CycloneInfo(),
             };

Buttplug.Server/Bluetooth/Devices/MagicMotion.cs

@@ -0,0 +1,84 @@
+using System;
+using System.Text;
+using System.Threading.Tasks;
+using Buttplug.Core;
+using Buttplug.Core.Messages;
+
+namespace Buttplug.Server.Bluetooth.Devices
+{
+    internal class MagicMotionBluetoothInfo : IBluetoothDeviceInfo
+    {
+        public enum Chrs : uint
+        {
+            Tx = 0,
+            Rx,
+        }
+
+        /*
+         * This has 6 services! Not sure what does what yet
+         *
+         * 78667579-7b48-43db-b8c5-7928a6b0a335  // Magic Motion's primary
+         * 00001800-0000-1000-8000-00805f9b34fb
+         * 00001801-0000-1000-8000-00805f9b34fb
+         * 3d3cbc0e-f76b-11e3-8fcd-b2227cce2b54  // Unknown service
+         * 0000180f-0000-1000-8000-00805f9b34fb
+         * 0000180a-0000-1000-8000-00805f9b34fb
+         */
+
+        public Guid[] Services { get; } = { new Guid("78667579-7b48-43db-b8c5-7928a6b0a335") };
+
+        public string[] Names { get; } =
+        {
+            "Smart Mini Vibe"
+        };
+
+        public Guid[] Characteristics { get; } =
+        {
+            // tx characteristic
+            new Guid("78667579-7b48-43db-b8c5-7928a6b0a335"),
+
+            // other characteristic... this one's advertised
+            new Guid("78667579-a914-49a4-8333-aa3c0cd8fedc"),
+        };
+
+        public IButtplugDevice CreateDevice(IButtplugLogManager aLogManager,
+            IBluetoothDeviceInterface aInterface)
+        {
+            return new MagicMotion(aLogManager,
+                aInterface);
+        }
+    }
+
+    internal class MagicMotion : ButtplugBluetoothDevice
+    {
+        public MagicMotion(IButtplugLogManager aLogManager,
+                       IBluetoothDeviceInterface aInterface)
+            : base(aLogManager,
+                   $"MagicMotion Device ({aInterface.Name})",
+                   aInterface)
+        {
+            MsgFuncs.Add(typeof(SingleMotorVibrateCmd), HandleSingleMotorVibrateCmd);
+            MsgFuncs.Add(typeof(StopDeviceCmd), HandleStopDeviceCmd);
+        }
+
+        private async Task<ButtplugMessage> HandleStopDeviceCmd(ButtplugDeviceMessage aMsg)
+        {
+            return await HandleSingleMotorVibrateCmd(new SingleMotorVibrateCmd(aMsg.DeviceIndex, 0, aMsg.Id));
+        }
+
+        private async Task<ButtplugMessage> HandleSingleMotorVibrateCmd(ButtplugDeviceMessage aMsg)
+        {
+            var cmdMsg = aMsg as SingleMotorVibrateCmd;
+            if (cmdMsg is null)
+            {
+                return BpLogger.LogErrorMsg(aMsg.Id, Error.ErrorClass.ERROR_DEVICE, "Wrong Handler");
+            }
+
+            var data = new byte[] { 0x0b, 0xff, 0x04, 0x0a, 0x32, 0x32, 0x00, 0x04, 0x08, 0x00, 0x64, 0x00 };
+            data[9] = Convert.ToByte(cmdMsg.Speed * byte.MaxValue);
+
+            // While there are 3 lovense revs right now, all of the characteristic arrays are the same.
+            return await Interface.WriteValue(aMsg.Id, (uint)MagicMotionBluetoothInfo.Chrs.Tx, data);
+        }
+    }
+}

Buttplug.Server/Buttplug.Server.csproj

@@ -51,6 +51,7 @@
     <Compile Include="Bluetooth\ButtplugBluetoothDevice.cs" />
     <Compile Include="Bluetooth\Devices\FleshlightLaunch.cs" />
     <Compile Include="Bluetooth\Devices\Kiiroo.cs" />
+    <Compile Include="Bluetooth\Devices\MagicMotion.cs" />
     <Compile Include="Bluetooth\Devices\Vibratissimo.cs" />
     <Compile Include="Bluetooth\Devices\Lovense.cs" />
     <Compile Include="Bluetooth\Devices\VorzeA10Cyclone.cs" />