feat: Add base motorbunny protocol with vibration

Add Motorbunny support, with vibration. Still need to add rotation.

Author: qdot

Buttplug/Devices/Configuration/DeviceConfigurationManager.cs

@@ -65,6 +65,7 @@ protected DeviceConfigurationManager()
 AddProtocol("realtouch",typeof(RealTouchProtocol));
 AddProtocol("svakom",typeof(SvakomProtocol));
 AddProtocol("realov",typeof(RealovProtocol));
+AddProtocol("motorbunny",typeof(MotorbunnyProtocol));
 
 // ET312 turned off until deadlocks and caching are fixed. See #593, #594, #595
 // AddProtocol("erostek-et312", typeof(ErostekET312Protocol));

Buttplug/Devices/Protocols/MotorbunnyProtocol.cs

@@ -0,0 +1,79 @@
+usingSystem;
+usingSystem.Linq;
+usingSystem.Threading;
+usingSystem.Threading.Tasks;
+usingButtplug.Core.Logging;
+usingButtplug.Core.Messages;
+
+namespaceButtplug.Devices.Protocols
+{
+internalclassMotorbunnyProtocol:ButtplugDeviceProtocol
+{
+privatedouble_vibratorSpeed;
+
+publicMotorbunnyProtocol(IButtplugLogManageraLogManager,
+IButtplugDeviceImplaInterface)
+:base(aLogManager,
+"Motorbunny",
+aInterface)
+{
+AddMessageHandler<SingleMotorVibrateCmd>(HandleSingleMotorVibrateCmd);
+AddMessageHandler<VibrateCmd>(HandleVibrateCmd,newMessageAttributes(){FeatureCount=1});
+AddMessageHandler<StopDeviceCmd>(HandleStopDeviceCmd);
+}
+
+privateasyncTask<ButtplugMessage>HandleStopDeviceCmd(ButtplugDeviceMessageaMsg,CancellationTokenaToken)
+{
+BpLogger.Debug("Stopping Device "+Name);
+returnawaitHandleSingleMotorVibrateCmd(newSingleMotorVibrateCmd(aMsg.DeviceIndex,0,aMsg.Id),aToken).ConfigureAwait(false);
+}
+
+privateasyncTask<ButtplugMessage>HandleSingleMotorVibrateCmd(ButtplugDeviceMessageaMsg,CancellationTokenaToken)
+{
+varcmdMsg=CheckMessageHandler<SingleMotorVibrateCmd>(aMsg);
+
+returnawaitHandleVibrateCmd(VibrateCmd.Create(cmdMsg.DeviceIndex,cmdMsg.Id,cmdMsg.Speed,1),aToken).ConfigureAwait(false);
+}
+
+privateasyncTask<ButtplugMessage>HandleVibrateCmd(ButtplugDeviceMessageaMsg,CancellationTokenaToken)
+{
+varcmdMsg=CheckGenericMessageHandler<VibrateCmd>(aMsg,1);
+varv=cmdMsg.Speeds[0];
+
+if(Math.Abs(v.Speed-_vibratorSpeed)<0.001&&SentVibration)
+{
+returnnewOk(cmdMsg.Id);
+}
+
+SentVibration=true;
+
+// If speed is zero, send the magic stop packet, otherwise *weird* things happen.
+if((cmdMsg.Speeds[0].Speed*255)<5)
+{
+awaitInterface.WriteValueAsync(newbyte[]{0xf0,0x00,0x00,0x00,0x00,0xec},aToken).ConfigureAwait(false);
+returnnewOk(aMsg.Id);
+}
+
+
+varcmdData=newbyte[]{0xff};
+
+for(vari=0;i<7;++i)
+{
+cmdData=cmdData.Concat(newbyte[]{(byte)(cmdMsg.Speeds[0].Speed*255),0x14}).ToArray();
+}
+
+bytecrc=0;
+
+// Skip the first byte for the CRC
+for(varj=1;j<cmdData.Length;++j)
+{
+crc=(byte)(cmdData[j]+crc);
+}
+
+cmdData=cmdData.Concat(newbyte[]{crc,0xec}).ToArray();
+
+awaitInterface.WriteValueAsync(cmdData,aToken).ConfigureAwait(false);
+returnnewOk(aMsg.Id);
+}
+}
+}