//private EffectBlock effectBlockNew = null; //Block to be loaded
private void func_OnEffectObj(IntPtr data, object userData)
{
Trace.WriteLine("");
//Trace.WriteLine(vJoy_Extra.FfbGetEffect());
const int ERROR_SUCCESS = 0;
Trace.WriteLine(String.Format("Got FFB Packet"));
int id = -1;
FFBPType type = (FFBPType)0;
Int32 effectBlockIndex = -1;
if (joystick.Ffb_h_DeviceID(data, ref id) != ERROR_SUCCESS)
{
Trace.WriteLine("Error: Unable to read DevID");
return;
}
if (joystick.Ffb_h_Type(data, ref type) != ERROR_SUCCESS)
{
Trace.WriteLine("Error: Unable to read FFB type");
return;
}
Trace.WriteLine(type.ToString());
if (joystick.Ffb_h_EBI(data, ref effectBlockIndex) != ERROR_SUCCESS)
{ effectBlockIndex = -1; }
FFBDevice srcDevice = devices[id - 1];
//Read Based on Type
switch (type)
{
case FFBPType.PT_EFFREP:
vJoy.FFB_EFF_REPORT effectParam = new vJoy.FFB_EFF_REPORT();
if (joystick.Ffb_h_Eff_Report(data, ref effectParam) != ERROR_SUCCESS)
{
Trace.WriteLine("Error: Unable read Effect Param");
return;
}
Trace.WriteLine(String.Format("Got Effect Param on EBI: {0}", effectParam.EffectBlockIndex));
Trace.WriteLine(String.Format("EffectType: {0}", effectParam.EffectType.ToString()));
Trace.WriteLine(String.Format("Duration : {0}", effectParam.Duration));
Trace.WriteLine(String.Format("TrigerRpt : {0}", effectParam.TrigerRpt));
Trace.WriteLine(String.Format("SamplePrd : {0}", effectParam.SamplePrd));
Trace.WriteLine(String.Format("Gain : {0}", effectParam.Gain));
Trace.WriteLine(String.Format("TrigerBtn : {0}", effectParam.TrigerBtn));
Trace.WriteLine(String.Format("Polar : {0}", effectParam.Polar));
Trace.WriteLine(String.Format("Dir1 : {0}", effectParam.DirX));
Trace.WriteLine(String.Format("Dir2 : {0}", effectParam.DirY));
byte[] rawP = new byte[0];
int len = 0;
uint transfertype = 0;
joystick.Ffb_h_Packet(data, ref transfertype, ref len, ref rawP);
Trace.WriteLine(String.Format("TypeSpecificBlockOffset1 : {0}", BitConverter.ToUInt16(rawP, len - 4)));
Trace.WriteLine(String.Format("TypeSpecificBlockOffset2 : {0}", BitConverter.ToUInt16(rawP, len - 2)));
srcDevice.EffectBlocks[(Byte)effectBlockIndex].ffbHeader = effectParam;
break;
case FFBPType.PT_ENVREP:
vJoy.FFB_EFF_ENVLP envEffect = new vJoy.FFB_EFF_ENVLP();
if (joystick.Ffb_h_Eff_Envlp(data, ref envEffect) != ERROR_SUCCESS)
{
Trace.WriteLine("Error: Unable read Envelope Effect");
return;
}
srcDevice.EffectBlocks[(Byte)effectBlockIndex].SecondaryEffectData(envEffect);
Trace.WriteLine(String.Format("Got Envelope Effect on EBI: {0}", envEffect.EffectBlockIndex));
//Trace.WriteLine(String.Format("Start : {0}", envEffect.AttackLevel));
//Trace.WriteLine(String.Format("STime : {0}", envEffect.AttackTime));
//Trace.WriteLine(String.Format("End : {0}", envEffect.FadeLevel));
//Trace.WriteLine(String.Format("ETime : {0}", envEffect.FadeTime));
break;
case FFBPType.PT_CONDREP:
vJoy.FFB_EFF_COND condEffect = new vJoy.FFB_EFF_COND();
if (joystick.Ffb_h_Eff_Cond(data, ref condEffect) != ERROR_SUCCESS)
{
Trace.WriteLine("Error: Unable read Conditional Effect");
return;
}
Trace.WriteLine(String.Format("Got Conditional Effect on EBI (Not Supported): {0}", effectBlockIndex));
break;
case FFBPType.PT_PRIDREP:
vJoy.FFB_EFF_PERIOD perEffect = new vJoy.FFB_EFF_PERIOD();
if (joystick.Ffb_h_Eff_Period(data, ref perEffect) != ERROR_SUCCESS)
{
Trace.WriteLine("Error: Unable read Periodic Effect");
return;
}
Trace.WriteLine(String.Format("Got Periodic Effect on EBI: {0}", perEffect.EffectBlockIndex));
//Trace.WriteLine(String.Format("Magnitude : {0}", perEffect.Magnitude));
//Trace.WriteLine(String.Format("Offset : {0}", perEffect.Offset));
//Trace.WriteLine(String.Format("Phase : {0}", perEffect.Phase));
//Trace.WriteLine(String.Format("Period : {0}", perEffect.Period));
srcDevice.EffectBlocks[(Byte)effectBlockIndex].PrimaryEffectData(perEffect);
break;
case FFBPType.PT_CONSTREP:
vJoy.FFB_EFF_CONSTANT constEffect = new vJoy.FFB_EFF_CONSTANT();
if (joystick.Ffb_h_Eff_Constant(data, ref constEffect) != ERROR_SUCCESS)
{
Trace.WriteLine("Error: Unable read Constant Effect");
return;
}
Trace.WriteLine(String.Format("Got Const Effect on EBI : {0}", constEffect.EffectBlockIndex));
//Trace.WriteLine(String.Format("Magnitude : {0}", constEffect.Magnitude));
srcDevice.EffectBlocks[(Byte)effectBlockIndex].PrimaryEffectData(constEffect);
break;
case FFBPType.PT_RAMPREP:
vJoy.FFB_EFF_RAMP rampEffect = new vJoy.FFB_EFF_RAMP();
if (joystick.Ffb_h_Eff_Ramp(data, ref rampEffect) != ERROR_SUCCESS)
{
Trace.WriteLine("Error: Unable read Ramp Effect");
return;
}
Trace.WriteLine(String.Format("Got Ramp Effect on EBI (Not Tested): {0}", rampEffect.EffectBlockIndex));
//Trace.WriteLine(String.Format("Start : {0}", rampEffect.Start));
//Trace.WriteLine(String.Format("End : {0}", rampEffect.End));
srcDevice.EffectBlocks[(Byte)effectBlockIndex].PrimaryEffectData(rampEffect);
break;
case FFBPType.PT_CSTMREP:
Trace.WriteLine("Error: Unkown command");
break;
case FFBPType.PT_SMPLREP:
Trace.WriteLine("Error: Unkown command");
break;
case FFBPType.PT_EFOPREP:
vJoy.FFB_EFF_OP effect_OP = new vJoy.FFB_EFF_OP();
if (joystick.Ffb_h_EffOp(data, ref effect_OP) != ERROR_SUCCESS)
{
Trace.WriteLine("Error: Unable read Effect OP");
return;
}
Trace.WriteLine(String.Format("Effect Command : {0}, Loops : {1}, EBI : {2} ", effect_OP.EffectOp.ToString(), effect_OP.LoopCount, effect_OP.EffectBlockIndex));
switch (effect_OP.EffectOp)
{
case FFBOP.EFF_START:
lock (vibThreadSentry)
{
Trace.WriteLine("Effect Start");
srcDevice.EffectBlocks[(byte)effectBlockIndex].Start(effect_OP.LoopCount);
}
break;
case FFBOP.EFF_STOP:
lock (vibThreadSentry)
{
Trace.WriteLine("Effect Stop");
srcDevice.EffectBlocks[(byte)effectBlockIndex].Stop();
}
break;
default:
Trace.WriteLine("Error: Unkown command");
break;
}
break;
case FFBPType.PT_BLKFRREP:
Trace.WriteLine("Free Block");
lock (vibThreadSentry)
{
srcDevice.RemoveBlock((Byte)effectBlockIndex);
}
break;
case FFBPType.PT_CTRLREP:
FFB_CTRL control = (FFB_CTRL)0;
if (joystick.Ffb_h_DevCtrl(data, ref control) != ERROR_SUCCESS)
{
Trace.WriteLine("Error: Unable read Dev Control");
return;
}
//byte[] rawP2 = new byte[0];
//int len2 = 0;
//uint transfertype2 = 0;
//joystick.Ffb_h_Packet(data, ref transfertype2, ref len2, ref rawP2);
//Trace.WriteLine(String.Format("DevControlThing : {0}", BitConverter.ToUInt16(rawP2, len2 - 2)));
switch (control)
{
case FFB_CTRL.CTRL_ENACT:
Trace.WriteLine("Enable all actuators (Not Supported)");
break;
case FFB_CTRL.CTRL_DISACT:
Trace.WriteLine("Disable all actuators (Not Supported)");
break;
case FFB_CTRL.CTRL_STOPALL:
Trace.WriteLine("Stop All Effects");
//Set All To Zero + Pause
foreach (BaseEffectBlock peffect in srcDevice.EffectBlocks.Values)
{
peffect.Stop();
}
break;
case FFB_CTRL.CTRL_DEVRST:
Trace.WriteLine("Reset Device");
lock (vibThreadSentry)
{
srcDevice.ClearBlocks();
srcDevice.DevicePaused = false;
}
break;
case FFB_CTRL.CTRL_DEVPAUSE:
Trace.WriteLine("Pause all effects");
foreach (BaseEffectBlock peffect in srcDevice.EffectBlocks.Values)
{
peffect.DevPause();
}
srcDevice.DevicePaused = true;
break;
case FFB_CTRL.CTRL_DEVCONT:
Trace.WriteLine("Resume all effects paused by DevPause");
foreach (BaseEffectBlock peffect in srcDevice.EffectBlocks.Values)
{
peffect.DevPause();
}
srcDevice.DevicePaused = false;
break;
default:
Trace.WriteLine("Unkown Command");
break;
}
break;
case FFBPType.PT_GAINREP:
byte gain = 1;
if (joystick.Ffb_h_DevGain(data, ref gain) != ERROR_SUCCESS)
{
Trace.WriteLine("Error: Unable read Dev Gain Command");
return;
}
Trace.WriteLine((String.Format("Gain Set : {0}", gain)));
srcDevice.DeviceGain = (Single)gain / vJoyConstants.EFFECT_MAX_GAIN;
break;
case FFBPType.PT_SETCREP:
Trace.WriteLine("Error: Unkown command");
break;
//Feature
case FFBPType.PT_NEWEFREP:
FFBEType nextEffect = (FFBEType)0;
if (joystick.Ffb_h_EffNew(data, ref nextEffect) != ERROR_SUCCESS)
{
Trace.WriteLine("Error: Unable read new effect");
return;
}
Trace.WriteLine((String.Format("Incomming Effect : {0}", nextEffect.ToString())));
//Add + Load Block
//Use effecct type as an index
byte free_ebi = srcDevice.NextKey();
if (free_ebi != 0)
{
BaseEffectBlock newBlock;
switch (nextEffect)
{
//ET_NONE
case FFBEType.ET_CONST:
newBlock = new ConstEffectBlock();
break;
case FFBEType.ET_RAMP:
newBlock = new RampEffectBlock();
break;
case FFBEType.ET_SQR:
newBlock = new SquareEffectBlock();
break;
case FFBEType.ET_SINE:
newBlock = new SineEffectBlock();
break;
case FFBEType.ET_TRNGL:
newBlock = new TrangleEffectBlock();
break;
case FFBEType.ET_STUP:
newBlock = new SawUpEffectBlock();
break;
case FFBEType.ET_STDN:
newBlock = new SawDownEffectBlock();
break;
//Conditinal effects (unsurported)
case FFBEType.ET_SPRNG:
case FFBEType.ET_DMPR:
case FFBEType.ET_INRT:
case FFBEType.ET_FRCTN:
Trace.WriteLine("Unsupported Conditinal Effect");
newBlock = new NullEffectBlock();
break;
case FFBEType.ET_CSTM: //Custom (need test case)
Trace.WriteLine("Unsupported Custom Effect");
newBlock = new NullEffectBlock();
break;
default:
Trace.WriteLine("Unkown Effect");
newBlock = new NullEffectBlock();
break;
}
if (newBlock != null)
{
newBlock.m_effectType = nextEffect;
//TODO, If Blockload support arrives
//Do AddBlock/ebi selection @ Blockload
lock (vibThreadSentry)
{
srcDevice.AddBlock(free_ebi, newBlock);
}
}
}
break;
case FFBPType.PT_BLKLDREP:
Trace.WriteLine("BULK LOAD (Not Supported)");
break;
case FFBPType.PT_POOLREP:
Trace.WriteLine("Pool Report (Not supported)");
break;
default:
Trace.WriteLine("Error: Unkown command");
break;
}
}
public override void PrimaryEffectData(object eff)
{
periodEffect = (vJoy.FFB_EFF_PERIOD)eff;
}
private static void OnEffectObj(IntPtr data, object userData)
{
int id = 0;
FFBPType type = 0;
int DSize = 0;
Byte[] arr = new Byte[20];
UInt32 wType = 0;
IntPtr bytes = IntPtr.Zero;
string TypeStr = "";
// Get FFB packet raw data
var result = joystick.Ffb_h_Packet(data, ref wType, ref DSize, ref arr);
dlg.FfbTextBox_Write(String.Format("\r\n\r\n ============= FFB Packet size Size {0} =============", DSize + 8));
// Get the ID of the device that this DDB packet refers to
result = joystick.Ffb_h_DeviceID(data, ref id);
dlg.FfbTextBox_Write(String.Format("\r\n > Device ID: {0}", id));
// Get the type of the packet
result = joystick.Ffb_h_Type(data, ref type);
if (result == 0)
{
bool ok = PacketType2Str(type, ref TypeStr);
if (!ok)
dlg.FfbTextBox_Write(String.Format("\r\n > Packet Type: {0}", type));
else
dlg.FfbTextBox_Write(String.Format("\r\n > Packet Type: {0}", TypeStr));
};
// Get the index of the effect block (Always 1)
int iBlock = 0;
result = joystick.Ffb_h_EBI(data, ref iBlock);
if (result == 0)
dlg.FfbTextBox_Write(String.Format("\r\n > Effect Block Index: {0}", iBlock));
// TODO: Add constant magnitude
#region Effect Report
// Effect Report
vJoy.FFB_EFF_REPORT Effect = new vJoy.FFB_EFF_REPORT();
result = joystick.Ffb_h_Eff_Report(data, ref Effect);
if (result == 0)
{
///// This is an Effect Block
// Effect type
if (!EffectType2Str(Effect.EffectType, ref TypeStr))
dlg.FfbTextBox_Write(String.Format("\r\n >> Effect Report: {0}", Effect.EffectType));
else
dlg.FfbTextBox_Write(String.Format("\r\n >> Effect Report: {0}", TypeStr));
// Effect Direction
if (Effect.Polar)
dlg.FfbTextBox_Write(String.Format("\r\n >> Direction: {0} deg ({1:D2})", Polar2Deg(Effect.Direction), Effect.Direction));
else
{
dlg.FfbTextBox_Write(String.Format("\r\n >> X Direction: {0:X2}", Effect.DirX));
dlg.FfbTextBox_Write(String.Format("\r\n >> Y Direction: {0:X2}", Effect.DirY));
};
// Duration of the effect
if (Effect.Duration == 0xFFFF)
dlg.FfbTextBox_Write(String.Format("\r\n >> Duration: Infinit"));
else
dlg.FfbTextBox_Write(String.Format("\r\n >> Duration: {0} MilliSec", (int)(Effect.Duration)));
// Trigger Repeat
if (Effect.TrigerRpt == 0xFFFF)
dlg.FfbTextBox_Write(String.Format("\r\n >> Trigger Repeat: Infinit"));
else
dlg.FfbTextBox_Write(String.Format("\r\n >> Trigger Repeat: {0}", (int)(Effect.TrigerRpt)));
// Sample Period
if (Effect.SamplePrd == 0xFFFF)
dlg.FfbTextBox_Write(String.Format("\r\n >> Sample Period: Infinit"));
else
dlg.FfbTextBox_Write(String.Format("\r\n >> Sample Period: {0}", (int)(Effect.SamplePrd)));
// Gain
dlg.FfbTextBox_Write(String.Format("\r\n >> Gain: {0}%", Byte2Percent(Effect.Gain)));
};
#endregion Effect Report
#region PID Device Control
// Device Control (Global controls such as Device Reset, Device Pause .....
FFB_CTRL Control = FFB_CTRL.CTRL_STOPALL;
string CtrlStr = "";
if ((0 == joystick.Ffb_h_DevCtrl(data, ref Control)) && DevCtrl2Str(Control, ref CtrlStr))
dlg.FfbTextBox_Write(String.Format("\r\n >> PID Device Control: {0}", CtrlStr));
#endregion
#region Effect Operation
vJoy.FFB_EFF_OP Operation = new vJoy.FFB_EFF_OP();
string EffOpStr = "";
if (0 == joystick.Ffb_h_EffOp(data, ref Operation) && EffectOpStr(Operation.EffectOp, ref EffOpStr))
{
dlg.FfbTextBox_Write(String.Format("\r\n >> Effect Operation: {0}", EffOpStr));
if (Operation.LoopCount == 0xFF)
dlg.FfbTextBox_Write(String.Format("\r\n >> Loop until stopped"));
else
dlg.FfbTextBox_Write(String.Format("\r\n >> Loop {0} times", (int)(Operation.LoopCount)));
};
#endregion
#region Global Device Gain
Byte Gain = 0;
if (0 == joystick.Ffb_h_DevGain(data, ref Gain))
dlg.FfbTextBox_Write(String.Format("\r\n >> Global Device Gain: {0}", Byte2Percent(Gain)));
#endregion
#region Condition
vJoy.FFB_EFF_COND Condition = new vJoy.FFB_EFF_COND();
if (0 == joystick.Ffb_h_Eff_Cond(data, ref Condition))
{
if (Condition.isY)
dlg.FfbTextBox_Write(String.Format("\r\n >> Y Axis"));
else
dlg.FfbTextBox_Write(String.Format("\r\n >> X Axis"));
dlg.FfbTextBox_Write(String.Format("\r\n >> Center Point Offset: {0}", Condition.CenterPointOffset));
dlg.FfbTextBox_Write(String.Format("\r\n >> Positive Coefficient: {0}", Condition.PosCoeff));
dlg.FfbTextBox_Write(String.Format("\r\n >> Negative Coefficient: {0}", Condition.NegCoeff));
dlg.FfbTextBox_Write(String.Format("\r\n >> Positive Saturation: {0}", Condition.PosSatur ));
dlg.FfbTextBox_Write(String.Format("\r\n >> Negative Saturation: {0}", Condition.NegSatur));
dlg.FfbTextBox_Write(String.Format("\r\n >> Dead Band: {0}", Condition.DeadBand));
}
#endregion
#region Envelope
vJoy.FFB_EFF_ENVLP Envelope = new vJoy.FFB_EFF_ENVLP();
if (0 == joystick.Ffb_h_Eff_Envlp(data, ref Envelope))
{
dlg.FfbTextBox_Write(String.Format("\r\n >> Attack Level: {0}", Envelope.AttackLevel));
dlg.FfbTextBox_Write(String.Format("\r\n >> Fade Level: {0}", Envelope.FadeLevel ));
dlg.FfbTextBox_Write(String.Format("\r\n >> Attack Time: {0}", (int)(Envelope.AttackTime)));
dlg.FfbTextBox_Write(String.Format("\r\n >> Fade Time: {0}", (int)(Envelope.FadeTime)));
};
#endregion
#region Periodic
vJoy.FFB_EFF_PERIOD EffPrd = new vJoy.FFB_EFF_PERIOD();
if (0 == joystick.Ffb_h_Eff_Period(data, ref EffPrd))
{
dlg.FfbTextBox_Write(String.Format("\r\n >> Magnitude: {0}", EffPrd.Magnitude));
dlg.FfbTextBox_Write(String.Format("\r\n >> Offset: {0}", EffPrd.Offset));
dlg.FfbTextBox_Write(String.Format("\r\n >> Phase: {0}", EffPrd.Phase));
dlg.FfbTextBox_Write(String.Format("\r\n >> Period: {0}", (int)(EffPrd.Period)));
};
#endregion
#region Effect Type
FFBEType EffectType = FFBEType.ET_NONE;
if (0 == joystick.Ffb_h_EffNew(data, ref EffectType))
{
if (EffectType2Str(EffectType, ref TypeStr))
dlg.FfbTextBox_Write(String.Format("\r\n >> Effect Type: {0}", TypeStr));
else
dlg.FfbTextBox_Write(String.Format("\r\n >> Effect Type: Unknown"));
}
#endregion
#region Ramp Effect
vJoy.FFB_EFF_RAMP RampEffect = new vJoy.FFB_EFF_RAMP();
if (0 == joystick.Ffb_h_Eff_Ramp(data, ref RampEffect))
{
dlg.FfbTextBox_Write(String.Format("\r\n >> Ramp Start: {0}", RampEffect.Start));
dlg.FfbTextBox_Write(String.Format("\r\n >> Ramp End: {0}", RampEffect.End));
};
#endregion
#region Constant Effect
vJoy.FFB_EFF_CONSTANT ConstantEffect = new vJoy.FFB_EFF_CONSTANT();
if (0 == joystick.Ffb_h_Eff_Constant(data, ref ConstantEffect))
{
dlg.FfbTextBox_Write(String.Format("\r\n >> Constant Magnitude: {0}", ConstantEffect.Magnitude));
};
#endregion
dlg.FfbTextBox_Write(String.Format("\r\n ==============================================\r\n"));
}