ControllerDevice.cs

using System;
using SlimDX.DirectInput;

namespace XOutput
{

    public struct OutputState
    {
        public byte LX, LY, RX, RY, L2, R2;
        public bool A, B, X, Y, Start, Back, L1, R1, L3, R3, Home;
        public bool DpadUp, DpadRight, DpadDown, DpadLeft;
    }

    public class ControllerDevice
    {
        public Joystick joystick;
        public Keyboard keyboard;
        public string name;

        public OutputState cOutput;
        public byte[] mapping = new byte[42];
        bool[] buttons;
        int[] dPads;
        int[] analogs;


        delegate byte input(byte subType, byte num);

        public ControllerDevice(Joystick joy, Keyboard keyb)
        {
            keyboard = keyb;
            joystick = joy;
            name = joystick.Information.InstanceName;
            cOutput = new OutputState();
            for (int i = 0; i < 42; i++)
            {
                mapping[i] = 255; //Changed default mapping to blank
            }
            byte[] saveData = SaveManager.Load(joy.Information.ProductName.ToString());
            if (saveData != null)
                mapping = saveData;
        }

        #region Utility Functions

        public void Save()
        {
            SaveManager.Save(joystick.Information.ProductName, mapping);
        }

        private int[] GetAxes(JoystickState jstate)
        {
            return new int[] { jstate.X, jstate.Y, jstate.Z, jstate.RotationX, jstate.RotationY, jstate.RotationZ };
        }

        private unsafe byte toByte(bool n)
        {
            return *((byte*)(&n));
        }

        private bool[] getPov(byte n)
        {
            bool[] b = new bool[4];
            int i = dPads[n];
            switch (i)
            {
                case -1: b[0] = false; b[1] = false; b[2] = false; b[3] = false; break;
                case 0: b[0] = true; b[1] = false; b[2] = false; b[3] = false; break;
                case 4500: b[0] = true; b[1] = false; b[2] = false; b[3] = true; break;
                case 9000: b[0] = false; b[1] = false; b[2] = false; b[3] = true; break;
                case 13500: b[0] = false; b[1] = true; b[2] = false; b[3] = true; break;
                case 18000: b[0] = false; b[1] = true; b[2] = false; b[3] = false; break;
                case 22500: b[0] = false; b[1] = true; b[2] = true; b[3] = false; break;
                case 27000: b[0] = false; b[1] = false; b[2] = true; b[3] = false; break;
                case 31500: b[0] = true; b[1] = false; b[2] = true; b[3] = false; break;
            }
            return b;
        }

        #endregion

        #region Input Types

        byte Button(byte subType, byte num)
        {
            int i = (int)toByte(buttons[num]) * 255;
            return (byte)i;
        }

        byte Analog(byte subType, byte num)
        {
            int p = analogs[num];
            switch (subType)
            {
                case 0: //Normal
                    return (byte)(p / 256);
                case 1: //Inverted
                    return (byte)((65535 - p) / 256);
                case 2: //Half
                    int m = (p - 32767) / 129;
                    if (m < 0)
                    {
                        m = 0;
                    }
                    return (byte)m;
                case 3: //Inverted Half
                    m = (p - 32767) / 129;
                    if (-m < 0)
                    {
                        m = 0;
                    }
                    return (byte)-m;
            }
            return 0;
        }

        byte DPad(byte subType, byte num)
        {
            int i = (int)toByte(getPov(num)[subType]) * 255;
            return (byte)i;
        }

        #endregion

        private void updateInput()
        {
            joystick.Poll();
            keyboard.Poll();
            JoystickState jState = joystick.GetCurrentState();
            KeyboardState kState = keyboard.GetCurrentState();
            System.Collections.Generic.IList<Key> keys = kState.PressedKeys;
            bool ctrl = false;
            bool alt = false;
            for(int i = 0; i < keys.Count; i++)
            {
                if(keys[i] == Key.LeftAlt)
                {
                    alt = true;
                }
                else if(keys[i] == Key.LeftControl)
                {
                    ctrl = true;
                }
            }
            buttons = jState.GetButtons();
            dPads = jState.GetPointOfViewControllers();
            analogs = GetAxes(jState);

            input funcButton = Button;
            input funcAnalog = Analog;
            input funcDPad = DPad;
            input[] funcArray = new input[] { funcButton, funcAnalog, funcDPad };

            byte[] output = new byte[21];
            for (int i = 0; i < 21; i++)
            {
                if (mapping[i * 2] == 255)
                {
                    //if the sticks are disabled, their values are set to the center position
                    if (i >= 17 && i <= 20)
                        output[i] = (byte)(32767 / 256);
                    continue;
                }
                byte subtype = (byte)(mapping[i * 2] & 0x0F);
                byte type = (byte)((mapping[i * 2] & 0xF0) >> 4);
                byte num = mapping[(i * 2) + 1];
                output[i] = funcArray[type](subtype, num);
            }

            cOutput.A = output[0] != 0;
            cOutput.B = output[1] != 0;
            cOutput.X = output[2] != 0;
            cOutput.Y = output[3] != 0;

            cOutput.DpadUp = output[4] != 0;
            cOutput.DpadDown = output[5] != 0;
            cOutput.DpadLeft = output[6] != 0;
            cOutput.DpadRight = output[7] != 0;

            cOutput.L2 = output[9];
            cOutput.R2 = output[8];

            cOutput.L1 = output[10] != 0 || ctrl;
            cOutput.R1 = output[11] != 0 || alt;

            cOutput.L3 = output[12] != 0;
            cOutput.R3 = output[13] != 0;

            cOutput.Home = output[14] != 0;
            cOutput.Start = output[15] != 0;
            cOutput.Back = output[16] != 0;

            cOutput.LY = output[17];
            cOutput.LX = output[18];
            cOutput.RY = output[19];
            cOutput.RX = output[20];
        }


        public byte[] getoutput()
        {
            updateInput();
            byte[] Report = new byte[64];
            Report[1] = 0x02;
            Report[2] = 0x05;
            Report[3] = 0x12;

            Report[10] = (byte)(
                ((cOutput.Back ? 1 : 0) << 0) |
                ((cOutput.L3 ? 1 : 0) << 1) |
                ((cOutput.R3 ? 1 : 0) << 2) |
                ((cOutput.Start ? 1 : 0) << 3) |
                ((cOutput.DpadUp ? 1 : 0) << 4) |
                ((cOutput.DpadRight ? 1 : 0) << 5) |
                ((cOutput.DpadDown ? 1 : 0) << 6) |
                ((cOutput.DpadLeft ? 1 : 0) << 7));

            Report[11] = (byte)(
                ((cOutput.L1 ? 1 : 0) << 2) |
                ((cOutput.R1 ? 1 : 0) << 3) |
                ((cOutput.Y ? 1 : 0) << 4) |
                ((cOutput.B ? 1 : 0) << 5) |
                ((cOutput.A ? 1 : 0) << 6) |
                ((cOutput.X ? 1 : 0) << 7));

            //Guide
            Report[12] = (byte)(cOutput.Home ? 0xFF : 0x00);


            Report[14] = cOutput.LX; //Left Stick X


            Report[15] = cOutput.LY; //Left Stick Y


            Report[16] = cOutput.RX; //Right Stick X


            Report[17] = cOutput.RY; //Right Stick Y
           
 

            Report[26] = cOutput.R2;
            Report[27] = cOutput.L2;

            return Report;
        }


    }
}