Exemple #1
0
        //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;
            }
        }
        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"));

        }