source: code/trunk/src/external/ois/win32/Win32JoyStick.cpp @ 7505

/*
The zlib/libpng License

Copyright (c) 2005-2007 Phillip Castaneda (pjcast -- www.wreckedgames.com)

This software is provided 'as-is', without any express or implied warranty. In no event will
the authors be held liable for any damages arising from the use of this software.

Permission is granted to anyone to use this software for any purpose, including commercial
applications, and to alter it and redistribute it freely, subject to the following
restrictions:

    1. The origin of this software must not be misrepresented; you must not claim that
                you wrote the original software. If you use this software in a product,
                an acknowledgment in the product documentation would be appreciated but is
                not required.

    2. Altered source versions must be plainly marked as such, and must not be
                misrepresented as being the original software.

    3. This notice may not be removed or altered from any source distribution.
*/
#include "Win32/Win32JoyStick.h"
#include "Win32/Win32InputManager.h"
#include "Win32/Win32ForceFeedback.h"
#include "OISEvents.h"
#include "OISException.h"

#include <cassert>

//DX Only defines macros for the JOYSTICK not JOYSTICK2, so fix it
#undef DIJOFS_BUTTON
#undef DIJOFS_POV

#define DIJOFS_BUTTON(n)  (FIELD_OFFSET(DIJOYSTATE2, rgbButtons) + (n))
#define DIJOFS_POV(n)     (FIELD_OFFSET(DIJOYSTATE2, rgdwPOV)+(n)*sizeof(DWORD))
#define DIJOFS_SLIDER0(n) (FIELD_OFFSET(DIJOYSTATE2, rglSlider)+(n) * sizeof(LONG))
#define DIJOFS_SLIDER1(n) (FIELD_OFFSET(DIJOYSTATE2, rglVSlider)+(n) * sizeof(LONG))
#define DIJOFS_SLIDER2(n) (FIELD_OFFSET(DIJOYSTATE2, rglASlider)+(n) * sizeof(LONG))
#define DIJOFS_SLIDER3(n) (FIELD_OFFSET(DIJOYSTATE2, rglFSlider)+(n) * sizeof(LONG))

using namespace OIS;

//--------------------------------------------------------------------------------------------------//
Win32JoyStick::Win32JoyStick( InputManager* creator, IDirectInput8* pDI,
        bool buffered, DWORD coopSettings, const JoyStickInfo &info )
        : JoyStick(info.vendor, buffered, info.devId, creator)
{
        mDirectInput = pDI;
        coopSetting = coopSettings;
        mJoyStick = 0;

        deviceGuid = info.deviceID;

        ff_device = 0;
}

//--------------------------------------------------------------------------------------------------//
Win32JoyStick::~Win32JoyStick()
{
        delete ff_device;

        if(mJoyStick)
        {
                mJoyStick->Unacquire();
                mJoyStick->Release();
                mJoyStick = 0;
        }

        //Return joystick to pool
        JoyStickInfo js;
        js.deviceID = deviceGuid;
        js.devId = mDevID;
        js.vendor = mVendor;
        static_cast<Win32InputManager*>(mCreator)->_returnJoyStick(js);
}

//--------------------------------------------------------------------------------------------------//
void Win32JoyStick::_initialize()
{
        //Clear old state
        mState.mAxes.clear();

        if (ff_device)
        {
                delete ff_device;
                ff_device = 0;
        }

        // Create direct input joystick device.
        if(FAILED(mDirectInput->CreateDevice(deviceGuid, &mJoyStick, NULL)))
                OIS_EXCEPT( E_General, "Win32JoyStick::_initialize() >> Could not initialize joy device!");

        // Set DIJoystick2 data format.
        if(FAILED(mJoyStick->SetDataFormat(&c_dfDIJoystick2)))
                OIS_EXCEPT( E_General, "Win32JoyStick::_initialize() >> data format error!");

        // Set cooperative level as specified when creating input manager.
        HWND hwin = ((Win32InputManager*)mCreator)->getWindowHandle();
        if(FAILED(mJoyStick->SetCooperativeLevel( hwin, coopSetting)))
                OIS_EXCEPT( E_General, "Win32JoyStick::_initialize() >> failed to set cooperation level!");

        // Set buffer size.
        DIPROPDWORD dipdw;
        dipdw.diph.dwSize       = sizeof(DIPROPDWORD);
        dipdw.diph.dwHeaderSize = sizeof(DIPROPHEADER);
        dipdw.diph.dwObj        = 0;
        dipdw.diph.dwHow        = DIPH_DEVICE;
        dipdw.dwData            = JOYSTICK_DX_BUFFERSIZE;

        if( FAILED(mJoyStick->SetProperty(DIPROP_BUFFERSIZE, &dipdw.diph)) )
                OIS_EXCEPT( E_General, "Win32JoyStick::_initialize >> Failed to set buffer size property" );

        // Enumerate all axes/buttons/sliders/force feedback/etc before aquiring
        _enumerate();

        mState.clear();

        capture();
}

//--------------------------------------------------------------------------------------------------//
void Win32JoyStick::_enumerate()
{
        // Get joystick capabilities.
        mDIJoyCaps.dwSize = sizeof(DIDEVCAPS);
        if( FAILED(mJoyStick->GetCapabilities(&mDIJoyCaps)) )
                OIS_EXCEPT( E_General, "Win32JoyStick::_enumerate >> Failed to get capabilities" );

        // => Number of POVs
        mPOVs = (short)mDIJoyCaps.dwPOVs;

        // => Number of buttons and axes.
        mState.mButtons.resize(mDIJoyCaps.dwButtons);
        mState.mAxes.resize(mDIJoyCaps.dwAxes);

        // Enumerate all Force Feedback effects (if any)
        mJoyStick->EnumEffects(DIEnumEffectsCallback, this, DIEFT_ALL);

        //Reset the axis mapping enumeration value
        _AxisNumber = 0;

        // Enumerate and set axis constraints (and check FF Axes)
        mJoyStick->EnumObjects(DIEnumDeviceObjectsCallback, this, DIDFT_AXIS);
}

//--------------------------------------------------------------------------------------------------//
BOOL CALLBACK Win32JoyStick::DIEnumDeviceObjectsCallback(LPCDIDEVICEOBJECTINSTANCE lpddoi, LPVOID pvRef)
{
        Win32JoyStick* _this = (Win32JoyStick*)pvRef;

        //Setup mappings
        DIPROPPOINTER diptr;
        diptr.diph.dwSize       = sizeof(DIPROPPOINTER);
        diptr.diph.dwHeaderSize = sizeof(DIPROPHEADER);
        diptr.diph.dwHow        = DIPH_BYID;
        diptr.diph.dwObj        = lpddoi->dwType;
        //Add a magic number to recognise we set seomthing
        diptr.uData             = 0x13130000 | _this->_AxisNumber;

        //Check if axis is slider, if so, do not treat as regular axis
        if(GUID_Slider == lpddoi->guidType)
        {
                ++_this->mSliders;

                //Decrease Axes, since this slider shows up in a different place
                _this->mState.mAxes.pop_back();
        }
        else if (FAILED(_this->mJoyStick->SetProperty(DIPROP_APPDATA, &diptr.diph)))
        {       //If for some reason we could not set needed user data, just ignore this axis
                return DIENUM_CONTINUE;
        }

        //Increase for next time through
        if(GUID_Slider != lpddoi->guidType)
                _this->_AxisNumber += 1;

        //Set range
        DIPROPRANGE diprg;
        diprg.diph.dwSize       = sizeof(DIPROPRANGE);
        diprg.diph.dwHeaderSize = sizeof(DIPROPHEADER);
        diprg.diph.dwHow        = DIPH_BYID;
        diprg.diph.dwObj        = lpddoi->dwType;
        diprg.lMin              = MIN_AXIS;
        diprg.lMax              = MAX_AXIS;

        if (FAILED(_this->mJoyStick->SetProperty(DIPROP_RANGE, &diprg.diph)))
                OIS_EXCEPT( E_General, "Win32JoyStick::_DIEnumDeviceObjectsCallback >> Failed to set min/max range property" );

        //Check if FF Axes, and if so, increment counter
        if((lpddoi->dwFlags & DIDOI_FFACTUATOR) != 0 )
        {
                if( _this->ff_device )
                {
                        _this->ff_device->_addFFAxis();
                }
        }

        //Force the flags for gain and auto-center support to true,
        //as DInput has no API to query the device for these capabilities
        //(the only way to know is to try them ...)
        if( _this->ff_device )
        {
            _this->ff_device->_setGainSupport(true);
            _this->ff_device->_setAutoCenterSupport(true);
        }

        return DIENUM_CONTINUE;
}

//--------------------------------------------------------------------------------------------------//
BOOL CALLBACK Win32JoyStick::DIEnumEffectsCallback(LPCDIEFFECTINFO pdei, LPVOID pvRef)
{
        Win32JoyStick* _this = (Win32JoyStick*)pvRef;

        //Create the FF instance only after we know there is at least one effect type
        if( _this->ff_device == 0 )
          _this->ff_device = new Win32ForceFeedback(_this->mJoyStick, &_this->mDIJoyCaps);

        _this->ff_device->_addEffectSupport( pdei );

        return DIENUM_CONTINUE;
}

//--------------------------------------------------------------------------------------------------//
void Win32JoyStick::capture()
{
        DIDEVICEOBJECTDATA diBuff[JOYSTICK_DX_BUFFERSIZE];
        DWORD entries = JOYSTICK_DX_BUFFERSIZE;

        // Poll the device to read the current state
        HRESULT hr = mJoyStick->Poll();
        if( hr == DI_OK )
                hr = mJoyStick->GetDeviceData( sizeof(DIDEVICEOBJECTDATA), diBuff, &entries, 0 );

        if( hr != DI_OK )
        {
                hr = mJoyStick->Acquire();
                while( hr == DIERR_INPUTLOST )
                        hr = mJoyStick->Acquire();

                // Poll the device to read the current state
            mJoyStick->Poll();
                hr = mJoyStick->GetDeviceData( sizeof(DIDEVICEOBJECTDATA), diBuff, &entries, 0 );
                //Perhaps the user just tabbed away
                if( FAILED(hr) )
                        return;
        }

        bool axisMoved[24] = {false,false,false,false,false,false,false,false,false,false,false,false,false,false,false,false,
                                                  false,false,false,false,false,false,false,false};
        bool sliderMoved[4] = {false,false,false,false};

        //Loop through all the events
        for(unsigned int i = 0; i < entries; ++i)
        {
                //This may seem outof order, but is in order of the way these variables
                //are declared in the JoyStick State 2 structure.
                switch(diBuff[i].dwOfs)
                {
                //------ slider -//
                case DIJOFS_SLIDER0(0):
                        sliderMoved[0] = true;
                        mState.mSliders[0].abX = diBuff[i].dwData;
                        break;
                case DIJOFS_SLIDER0(1):
                        sliderMoved[0] = true;
                        mState.mSliders[0].abY = diBuff[i].dwData;
                        break;
                //----- Max 4 POVs Next ---------------//
                case DIJOFS_POV(0):
                        if(!_changePOV(0,diBuff[i]))
                                return;
                        break;
                case DIJOFS_POV(1):
                        if(!_changePOV(1,diBuff[i]))
                                return;
                        break;
                case DIJOFS_POV(2):
                        if(!_changePOV(2,diBuff[i]))
                                return;
                        break;
                case DIJOFS_POV(3):
                        if(!_changePOV(3,diBuff[i]))
                                return;
                        break;
                case DIJOFS_SLIDER1(0):
                        sliderMoved[1] = true;
                        mState.mSliders[1].abX = diBuff[i].dwData;
                        break;
                case DIJOFS_SLIDER1(1):
                        sliderMoved[1] = true;
                        mState.mSliders[1].abY = diBuff[i].dwData;
                        break;
                case DIJOFS_SLIDER2(0):
                        sliderMoved[2] = true;
                        mState.mSliders[2].abX = diBuff[i].dwData;
                        break;
                case DIJOFS_SLIDER2(1):
                        sliderMoved[2] = true;
                        mState.mSliders[2].abY = diBuff[i].dwData;
                        break;
                case DIJOFS_SLIDER3(0):
                        sliderMoved[3] = true;
                        mState.mSliders[3].abX = diBuff[i].dwData;
                        break;
                case DIJOFS_SLIDER3(1):
                        sliderMoved[3] = true;
                        mState.mSliders[3].abY = diBuff[i].dwData;
                        break;
                //-----------------------------------------//
                default:
                        //Handle Button Events Easily using the DX Offset Macros
                        if( diBuff[i].dwOfs >= DIJOFS_BUTTON(0) && diBuff[i].dwOfs < DIJOFS_BUTTON(128) )
                        {
                                if(!_doButtonClick((diBuff[i].dwOfs - DIJOFS_BUTTON(0)), diBuff[i]))
                                        return;
                        }
                        else if((short)(diBuff[i].uAppData >> 16) == 0x1313)
                        {       //If it was nothing else, might be axis enumerated earlier (determined by magic number)
                                int axis = (int)(0x0000FFFF & diBuff[i].uAppData); //Mask out the high bit
                                assert( axis >= 0 && axis < (int)mState.mAxes.size() && "Axis out of range!");

                                if(axis >= 0 && axis < (int)mState.mAxes.size())
                                {
                                        mState.mAxes[axis].abs = diBuff[i].dwData;
                                        axisMoved[axis] = true;
                                }
                        }

                        break;
                } //end case
        } //end for

        //Check to see if any of the axes values have changed.. if so send events
        if( mBuffered && mListener && entries > 0 )
        {
                JoyStickEvent temp(this, mState);

                //Update axes
                for( int i = 0; i < 24; ++i )
                        if( axisMoved[i] )
                                if( mListener->axisMoved( temp, i ) == false )
                                        return;

                //Now update sliders
                for( int i = 0; i < 4; ++i )
                        if( sliderMoved[i] )
                                if( mListener->sliderMoved( temp, i ) == false )
                                        return;
        }
}

//--------------------------------------------------------------------------------------------------//
bool Win32JoyStick::_doButtonClick( int button, DIDEVICEOBJECTDATA& di )
{
        if( di.dwData & 0x80 )
        {
                mState.mButtons[button] = true;
                if( mBuffered && mListener )
                        return mListener->buttonPressed( JoyStickEvent( this, mState ), button );
        }
        else
        {
                mState.mButtons[button] = false;
                if( mBuffered && mListener )
                        return mListener->buttonReleased( JoyStickEvent( this, mState ), button );
        }

        return true;
}

//--------------------------------------------------------------------------------------------------//
bool Win32JoyStick::_changePOV( int pov, DIDEVICEOBJECTDATA& di )
{
        //Some drivers report a value of 65,535, instead of —1,
        //for the center position
        if(LOWORD(di.dwData) == 0xFFFF)
        {
                mState.mPOV[pov].direction = Pov::Centered;
        }
        else
        {
                switch(di.dwData)
                {
                        case 0: mState.mPOV[pov].direction = Pov::North; break;
                        case 4500: mState.mPOV[pov].direction = Pov::NorthEast; break;
                        case 9000: mState.mPOV[pov].direction = Pov::East; break;
                        case 13500: mState.mPOV[pov].direction = Pov::SouthEast; break;
                        case 18000: mState.mPOV[pov].direction = Pov::South; break;
                        case 22500: mState.mPOV[pov].direction = Pov::SouthWest; break;
                        case 27000: mState.mPOV[pov].direction = Pov::West; break;
                        case 31500: mState.mPOV[pov].direction = Pov::NorthWest; break;
                }
        }

        if( mBuffered && mListener )
                return mListener->povMoved( JoyStickEvent( this, mState ), pov );

        return true;
}

//--------------------------------------------------------------------------------------------------//
void Win32JoyStick::setBuffered(bool buffered)
{
        mBuffered = buffered;
}

//--------------------------------------------------------------------------------------------------//
Interface* Win32JoyStick::queryInterface(Interface::IType type)
{
        //Thought about using covariant return type here.. however,
        //some devices may allow LED light changing, or other interface stuff

        if( ff_device && type == Interface::ForceFeedback )
                return ff_device;
        else
                return 0;
}