Logo Search packages:      
Sourcecode: wine version File versions  Download package

effect_linuxinput.c

/*              DirectInput Linux Event Device Effect
 *
 * Copyright 2005 Daniel Remenak
 *
 * Thanks to Google's Summer of Code Program (2005)
 *
 * This library is free software; you can redistribute it and/or
 * modify it under the terms of the GNU Lesser General Public
 * License as published by the Free Software Foundation; either
 * version 2.1 of the License, or (at your option) any later version.
 *
 * This library is distributed in the hope that it will be useful,
 * but WITHOUT ANY WARRANTY; without even the implied warranty of
 * MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE.  See the GNU
 * Lesser General Public License for more details.
 *
 * You should have received a copy of the GNU Lesser General Public
 * License along with this library; if not, write to the Free Software
 * Foundation, Inc., 51 Franklin St, Fifth Floor, Boston, MA 02110-1301, USA
 */

#include "config.h"

#ifdef HAVE_STRUCT_FF_EFFECT_DIRECTION

#include <stdarg.h>
#include <string.h>
#ifdef HAVE_LINUX_INPUT_H
#  include <linux/input.h>
#endif
#include <errno.h>
#ifdef HAVE_UNISTD_H
#  include <unistd.h>
#endif
#include <math.h>
#include "wine/debug.h"
#include "wine/unicode.h"
#include "windef.h"
#include "winbase.h"
#include "winerror.h"
#include "dinput.h"

#include "device_private.h"

WINE_DEFAULT_DEBUG_CHANNEL(dinput);

static const IDirectInputEffectVtbl LinuxInputEffectVtbl;
typedef struct LinuxInputEffectImpl LinuxInputEffectImpl;
struct LinuxInputEffectImpl
{
    const void *lpVtbl;
    LONG    ref;
    GUID    guid;

    /* Effect data */
    struct ff_effect effect;

    /* Parent device */
    int*    fd;
};


/******************************************************************************
 *      DirectInputEffect Functional Helper
 */

static DWORD _typeFromGUID(REFGUID guid)
{
    if (IsEqualGUID(guid, &GUID_ConstantForce)) {
      return DIEFT_CONSTANTFORCE;
    } else if (IsEqualGUID(guid, &GUID_Square)
            || IsEqualGUID(guid, &GUID_Sine)
            || IsEqualGUID(guid, &GUID_Triangle)
            || IsEqualGUID(guid, &GUID_SawtoothUp)
            || IsEqualGUID(guid, &GUID_SawtoothDown)) {
      return DIEFT_PERIODIC;
    } else if (IsEqualGUID(guid, &GUID_RampForce)) {
      return DIEFT_RAMPFORCE;
    } else if (IsEqualGUID(guid, &GUID_Spring)
            || IsEqualGUID(guid, &GUID_Damper)
            || IsEqualGUID(guid, &GUID_Inertia)
            || IsEqualGUID(guid, &GUID_Friction)) {
      return DIEFT_CONDITION;
    } else if (IsEqualGUID(guid, &GUID_CustomForce)) {
      return DIEFT_CUSTOMFORCE;
    } else {
        WARN("GUID (%s) is not a known force type\n", _dump_dinput_GUID(guid));
      return 0;
    }
}


/******************************************************************************
 *      DirectInputEffect debug helpers 
 */

static void _dump_DIEFFECT_flags(DWORD dwFlags)
{
    if (TRACE_ON(dinput)) {
        unsigned int   i;
        static const struct {
            DWORD       mask;
            const char  *name;
        } flags[] = {
#define FE(x) { x, #x}
            FE(DIEFF_CARTESIAN),
            FE(DIEFF_OBJECTIDS),
            FE(DIEFF_OBJECTOFFSETS),
            FE(DIEFF_POLAR),
            FE(DIEFF_SPHERICAL)
#undef FE
        };
        for (i = 0; i < (sizeof(flags) / sizeof(flags[0])); i++)
            if (flags[i].mask & dwFlags)
                DPRINTF("%s ", flags[i].name);
        DPRINTF("\n");
    }       
}

static void _dump_DIENVELOPE(LPDIENVELOPE env)
{
    if (env->dwSize != sizeof(DIENVELOPE)) {
        WARN("Non-standard DIENVELOPE structure size (%d instead of %d).\n",
           env->dwSize, sizeof(DIENVELOPE));
    }
    TRACE("Envelope has attack (level: %d time: %d), fade (level: %d time: %d)\n",
        env->dwAttackLevel, env->dwAttackTime, env->dwFadeLevel, env->dwFadeTime);
} 

static void _dump_DICONSTANTFORCE(LPDICONSTANTFORCE frc)
{
    TRACE("Constant force has magnitude %d\n", frc->lMagnitude);
}

static void _dump_DIPERIODIC(LPDIPERIODIC frc)
{
    TRACE("Periodic force has magnitude %d, offset %d, phase %d, period %d\n",
        frc->dwMagnitude, frc->lOffset, frc->dwPhase, frc->dwPeriod);
}

static void _dump_DIRAMPFORCE(LPDIRAMPFORCE frc)
{
    TRACE("Ramp force has start %d, end %d\n",
        frc->lStart, frc->lEnd);
}

static void _dump_DICONDITION(LPDICONDITION frc)
{
    TRACE("Condition has offset %d, pos/neg coefficients %d and %d, pos/neg saturations %d and %d, deadband %d\n",
        frc->lOffset, frc->lPositiveCoefficient, frc->lNegativeCoefficient,
        frc->dwPositiveSaturation, frc->dwNegativeSaturation, frc->lDeadBand);
}

static void _dump_DICUSTOMFORCE(LPDICUSTOMFORCE frc)
{
    unsigned int i;
    TRACE("Custom force uses %d channels, sample period %d.  Has %d samples at %p.\n",
        frc->cChannels, frc->dwSamplePeriod, frc->cSamples, frc->rglForceData);
    if (frc->cSamples % frc->cChannels != 0)
      WARN("Custom force has a non-integral samples-per-channel count!\n");
    if (TRACE_ON(dinput)) {
      DPRINTF("Custom force data (time aligned, axes in order):\n");
      for (i = 1; i <= frc->cSamples; ++i) {
          DPRINTF("%d ", frc->rglForceData[i]);
          if (i % frc->cChannels == 0)
            DPRINTF("\n");
      }     
    }
}

static void _dump_DIEFFECT(LPCDIEFFECT eff, REFGUID guid)
{
    unsigned int i;
    DWORD type = _typeFromGUID(guid);

    TRACE("Dumping DIEFFECT structure:\n");
    TRACE("  - dwSize: %d\n", eff->dwSize);
    if ((eff->dwSize != sizeof(DIEFFECT)) && (eff->dwSize != sizeof(DIEFFECT_DX5))) {
        WARN("Non-standard DIEFFECT structure size (%d instead of %d or %d).\n",
           eff->dwSize, sizeof(DIEFFECT), sizeof(DIEFFECT_DX5));
    }
    TRACE("  - dwFlags: %d\n", eff->dwFlags);
    TRACE("    ");
    _dump_DIEFFECT_flags(eff->dwFlags); 
    TRACE("  - dwDuration: %d\n", eff->dwDuration);
    TRACE("  - dwGain: %d\n", eff->dwGain);
    if ((eff->dwGain > 10000) || (eff->dwGain < 0))
      WARN("dwGain is out of range (0 - 10,000)\n"); 
    TRACE("  - dwTriggerButton: %d\n", eff->dwTriggerButton);
    TRACE("  - dwTriggerRepeatInterval: %d\n", eff->dwTriggerRepeatInterval);
    TRACE("  - cAxes: %d\n", eff->cAxes);
    TRACE("  - rgdwAxes: %p\n", eff->rgdwAxes);
    if (TRACE_ON(dinput)) {
      TRACE("    ");    
      for (i = 0; i < eff->cAxes; ++i)
          DPRINTF("%d ", eff->rgdwAxes[i]);
      DPRINTF("\n");
    }
    TRACE("  - rglDirection: %p\n", eff->rglDirection);
    TRACE("  - lpEnvelope: %p\n", eff->lpEnvelope);
    TRACE("  - cbTypeSpecificParams: %d\n", eff->cbTypeSpecificParams);
    TRACE("  - lpvTypeSpecificParams: %p\n", eff->lpvTypeSpecificParams);
    if (eff->dwSize > sizeof(DIEFFECT_DX5))
      TRACE("  - dwStartDelay: %d\n", eff->dwStartDelay);
    if (eff->lpEnvelope != NULL)
      _dump_DIENVELOPE(eff->lpEnvelope);
    if (type == DIEFT_CONSTANTFORCE) {
      if (eff->cbTypeSpecificParams != sizeof(DICONSTANTFORCE)) {
          WARN("Effect claims to be a constant force but the type-specific params are the wrong size!\n"); 
      } else {
          _dump_DICONSTANTFORCE(eff->lpvTypeSpecificParams);
      }
    } else if (type == DIEFT_PERIODIC) { 
        if (eff->cbTypeSpecificParams != sizeof(DIPERIODIC)) {
            WARN("Effect claims to be a periodic force but the type-specific params are the wrong size!\n");
        } else {
            _dump_DIPERIODIC(eff->lpvTypeSpecificParams);
        }
    } else if (type == DIEFT_RAMPFORCE) {
        if (eff->cbTypeSpecificParams != sizeof(DIRAMPFORCE)) {
            WARN("Effect claims to be a ramp force but the type-specific params are the wrong size!\n");
        } else {
            _dump_DIRAMPFORCE(eff->lpvTypeSpecificParams);
        }
    } else if (type == DIEFT_CONDITION) { 
        if (eff->cbTypeSpecificParams != sizeof(DICONDITION)) {
            WARN("Effect claims to be a condition but the type-specific params are the wrong size!\n");
        } else {
            _dump_DICONDITION(eff->lpvTypeSpecificParams);
        }
    } else if (type == DIEFT_CUSTOMFORCE) {
        if (eff->cbTypeSpecificParams != sizeof(DICUSTOMFORCE)) {
            WARN("Effect claims to be a custom force but the type-specific params are the wrong size!\n");
        } else {
            _dump_DICUSTOMFORCE(eff->lpvTypeSpecificParams);
        }
    }
}


/******************************************************************************
 *      LinuxInputEffectImpl 
 */

static ULONG WINAPI LinuxInputEffectImpl_AddRef(
      LPDIRECTINPUTEFFECT iface)
{
    LinuxInputEffectImpl *This = (LinuxInputEffectImpl *)iface;
    return InterlockedIncrement(&(This->ref));
}

static HRESULT WINAPI LinuxInputEffectImpl_Download(
      LPDIRECTINPUTEFFECT iface)
{
    LinuxInputEffectImpl *This = (LinuxInputEffectImpl *)iface;

    TRACE("(this=%p)\n", This);

    if (ioctl(*(This->fd), EVIOCSFF, &This->effect) == -1) {
      if (errno == ENOMEM) {
          return DIERR_DEVICEFULL;
      } else {
          FIXME("Could not upload effect. Assuming a disconnected device.\n");
          return DIERR_INPUTLOST;
      }
    }

    return DI_OK;
}

static HRESULT WINAPI LinuxInputEffectImpl_Escape(
      LPDIRECTINPUTEFFECT iface,
        LPDIEFFESCAPE pesc)
{
    WARN("(this=%p,%p): invalid: no hardware-specific escape codes in this" 
         " driver!\n", iface, pesc);

    return DI_OK;
}

static HRESULT WINAPI LinuxInputEffectImpl_GetEffectGuid(
        LPDIRECTINPUTEFFECT iface,
      LPGUID pguid)
{
    LinuxInputEffectImpl *This = (LinuxInputEffectImpl*)iface;

    TRACE("(this=%p,%p)\n", This, pguid);

    pguid = &This->guid;
    
    return DI_OK;
}

static HRESULT WINAPI LinuxInputEffectImpl_GetEffectStatus(
        LPDIRECTINPUTEFFECT iface,
      LPDWORD pdwFlags)
{
    TRACE("(this=%p,%p)\n", iface, pdwFlags);

    /* linux sends the effect status through an event.
     * that event is trapped by our parent joystick driver
     * and there is no clean way to pass it back to us. */
    FIXME("Not enough information to provide a status.\n");

    (*pdwFlags) = 0;

    return DI_OK;
}

static HRESULT WINAPI LinuxInputEffectImpl_GetParameters(
      LPDIRECTINPUTEFFECT iface,
      LPDIEFFECT peff,
      DWORD dwFlags)
{
    HRESULT diErr = DI_OK;
    LinuxInputEffectImpl *This = (LinuxInputEffectImpl *)iface;
    TRACE("(this=%p,%p,%d)\n", This, peff, dwFlags);

    /* Major conversion factors are:
     * times: millisecond (linux) -> microsecond (windows) (x * 1000)
     * forces: scale 0x7FFF (linux) -> scale 10000 (windows) approx ((x / 33) * 10)
     * angles: scale 0x7FFF (linux) -> scale 35999 (windows) approx ((x / 33) * 36)
     * angle bases: 0 -> -y (down) (linux) -> 0 -> +x (right) (windows)
     */

    if (dwFlags & DIEP_AXES) {
      if (peff->cAxes < 2 /* linuxinput effects always use 2 axes, x and y */)
          diErr = DIERR_MOREDATA;
      peff->cAxes = 2; 
      if (diErr)
          return diErr;
      else {
          peff->rgdwAxes[0] = DIJOFS_X;
          peff->rgdwAxes[1] = DIJOFS_Y;
      }
    }
 
    if (dwFlags & DIEP_DIRECTION) {
        if (peff->cAxes < 2)
            diErr = DIERR_MOREDATA;
        peff->cAxes = 2; 
        if (diErr)
            return diErr;
        else {
          if (peff->dwFlags & DIEFF_CARTESIAN) {
            peff->rglDirection[0] = (long)(sin(M_PI * 3 * This->effect.direction / 0x7FFF) * 1000);
            peff->rglDirection[1] = (long)(cos(M_PI * 3 * This->effect.direction / 0x7FFF) * 1000);
          } else {
            /* Polar and spherical coordinates are the same for two or less
             * axes.
             * Note that we also use this case if NO flags are marked.
             * According to MSDN, we should return the direction in the
             * format that it was specified in, if no flags are marked.
             */
            peff->rglDirection[0] = (This->effect.direction / 33) * 36 + 9000;
            if (peff->rglDirection[0] > 35999)
                peff->rglDirection[0] -= 35999;
          }
      }
    }

    if (dwFlags & DIEP_DURATION) {
      peff->dwDuration = (DWORD)This->effect.replay.length * 1000;
    }

    if (dwFlags & DIEP_ENVELOPE) {
      struct ff_envelope* env;
      if (This->effect.type == FF_CONSTANT) env = &This->effect.u.constant.envelope;
      else if (This->effect.type == FF_PERIODIC) env = &This->effect.u.periodic.envelope;
      else if (This->effect.type == FF_RAMP) env = &This->effect.u.ramp.envelope;
      else env = NULL;
      if (env == NULL) {
          peff->lpEnvelope = NULL;
      } else if (peff->lpEnvelope == NULL) {
          return DIERR_INVALIDPARAM;
      } else { 
          peff->lpEnvelope->dwAttackLevel = (env->attack_level / 33) * 10;
          peff->lpEnvelope->dwAttackTime = env->attack_length * 1000;
          peff->lpEnvelope->dwFadeLevel = (env->fade_level / 33) * 10;
          peff->lpEnvelope->dwFadeTime = env->fade_length * 1000;
      }
    }

    if (dwFlags & DIEP_GAIN) {
      /* the linux input ff driver apparently has no support
         * for setting the device's gain. */
      peff->dwGain = DI_FFNOMINALMAX;
    }

    if (dwFlags & DIEP_SAMPLEPERIOD) {
      /* the linux input ff driver has no support for setting
       * the playback sample period.  0 means default. */
      peff->dwSamplePeriod = 0;
    }

    if (dwFlags & DIEP_STARTDELAY) {
      peff->dwStartDelay = This->effect.replay.delay * 1000;
    }

    if (dwFlags & DIEP_TRIGGERBUTTON) {
      FIXME("LinuxInput button mapping needs redoing; for now, assuming we're using an actual joystick.\n");
      peff->dwTriggerButton = DIJOFS_BUTTON(This->effect.trigger.button - BTN_JOYSTICK);
    }

    if (dwFlags & DIEP_TRIGGERREPEATINTERVAL) {
      peff->dwTriggerRepeatInterval = This->effect.trigger.interval * 1000;
    }

    if (dwFlags & DIEP_TYPESPECIFICPARAMS) {
      int expectedsize = 0;
      if (This->effect.type == FF_PERIODIC) {
          expectedsize = sizeof(DIPERIODIC);
      } else if (This->effect.type == FF_CONSTANT) {
          expectedsize = sizeof(DICONSTANTFORCE);
      } else if (This->effect.type == FF_SPRING 
            || This->effect.type == FF_FRICTION 
            || This->effect.type == FF_INERTIA 
            || This->effect.type == FF_DAMPER) {
          expectedsize = sizeof(DICONDITION) * 2;
      } else if (This->effect.type == FF_RAMP) {
          expectedsize = sizeof(DIRAMPFORCE);
      }
      if (expectedsize > peff->cbTypeSpecificParams)
          diErr = DIERR_MOREDATA;
      peff->cbTypeSpecificParams = expectedsize;
      if (diErr)
          return diErr;
      else {
          if (This->effect.type == FF_PERIODIC) {
                LPDIPERIODIC tsp = (LPDIPERIODIC)(peff->lpvTypeSpecificParams);
            tsp->dwMagnitude = (This->effect.u.periodic.magnitude / 33) * 10;
            tsp->lOffset = (This->effect.u.periodic.offset / 33) * 10;
            tsp->dwPhase = (This->effect.u.periodic.phase / 33) * 36;
            tsp->dwPeriod = (This->effect.u.periodic.period * 1000);
          } else if (This->effect.type == FF_CONSTANT) {
                LPDICONSTANTFORCE tsp = (LPDICONSTANTFORCE)(peff->lpvTypeSpecificParams);
            tsp->lMagnitude = (This->effect.u.constant.level / 33) * 10;
          } else if (This->effect.type == FF_SPRING 
                || This->effect.type == FF_FRICTION 
                || This->effect.type == FF_INERTIA 
                || This->effect.type == FF_DAMPER) {
                LPDICONDITION tsp = (LPDICONDITION)(peff->lpvTypeSpecificParams);
            int i;
            for (i = 0; i < 2; ++i) {
                tsp[i].lOffset = (This->effect.u.condition[i].center / 33) * 10; 
                tsp[i].lPositiveCoefficient = (This->effect.u.condition[i].right_coeff / 33) * 10;
                tsp[i].lNegativeCoefficient = (This->effect.u.condition[i].left_coeff / 33) * 10; 
                tsp[i].dwPositiveSaturation = (This->effect.u.condition[i].right_saturation / 33) * 10;
                tsp[i].dwNegativeSaturation = (This->effect.u.condition[i].left_saturation / 33) * 10;
                tsp[i].lDeadBand = (This->effect.u.condition[i].deadband / 33) * 10;
            }
          } else if (This->effect.type == FF_RAMP) {
                LPDIRAMPFORCE tsp = (LPDIRAMPFORCE)(peff->lpvTypeSpecificParams);
            tsp->lStart = (This->effect.u.ramp.start_level / 33) * 10;
            tsp->lEnd = (This->effect.u.ramp.end_level / 33) * 10;
          }
      }
    } 

    return diErr;
}

static HRESULT WINAPI LinuxInputEffectImpl_Initialize(
        LPDIRECTINPUTEFFECT iface,
      HINSTANCE hinst,
      DWORD dwVersion,
      REFGUID rguid)
{
    FIXME("(this=%p,%p,%d,%s): stub!\n",
       iface, hinst, dwVersion, debugstr_guid(rguid));

    return DI_OK;
}

static HRESULT WINAPI LinuxInputEffectImpl_QueryInterface(
      LPDIRECTINPUTEFFECT iface,
      REFIID riid,
      void **ppvObject)
{
    LinuxInputEffectImpl* This = (LinuxInputEffectImpl*)iface;

    TRACE("(this=%p,%s,%p)\n", This, debugstr_guid(riid), ppvObject);

    if (IsEqualGUID(&IID_IUnknown, riid) ||
      IsEqualGUID(&IID_IDirectInputEffect, riid)) {
          LinuxInputEffectImpl_AddRef(iface);
          *ppvObject = This;
          return 0;
    }

    TRACE("Unsupported interface!\n");
    return E_FAIL;
}

static HRESULT WINAPI LinuxInputEffectImpl_Start(
      LPDIRECTINPUTEFFECT iface,
      DWORD dwIterations,
      DWORD dwFlags)
{
    struct input_event event;
    LinuxInputEffectImpl* This = (LinuxInputEffectImpl*)iface;

    TRACE("(this=%p,%d,%d)\n", This, dwIterations, dwFlags);

    if (!(dwFlags & DIES_NODOWNLOAD)) {
      /* Download the effect if necessary */
      if (This->effect.id == -1) {
          HRESULT res = LinuxInputEffectImpl_Download(iface);
          if (res != DI_OK)
            return res;
      }
    }

    if (dwFlags & DIES_SOLO) {
      FIXME("Solo mode requested: should be stopping all effects here!\n");
    }

    event.type = EV_FF;
    event.code = This->effect.id;
    event.value = dwIterations;
    if (write(*(This->fd), &event, sizeof(event)) == -1) {
      FIXME("Unable to write event.  Assuming device disconnected.\n");
      return DIERR_INPUTLOST;
    }

    return DI_OK;
}

static HRESULT WINAPI LinuxInputEffectImpl_SetParameters(
        LPDIRECTINPUTEFFECT iface,
        LPCDIEFFECT peff,
        DWORD dwFlags)
{       
    LinuxInputEffectImpl* This = (LinuxInputEffectImpl*)iface; 
    DWORD type = _typeFromGUID(&This->guid);
    HRESULT retval = DI_OK;

    TRACE("(this=%p,%p,%d)\n", This, peff, dwFlags);

    _dump_DIEFFECT(peff, &This->guid);

    if ((dwFlags & !DIEP_NORESTART & !DIEP_NODOWNLOAD & !DIEP_START) == 0) {
      /* set everything */
      dwFlags = DIEP_AXES | DIEP_DIRECTION | DIEP_DURATION | DIEP_ENVELOPE |
          DIEP_GAIN | DIEP_SAMPLEPERIOD | DIEP_STARTDELAY | DIEP_TRIGGERBUTTON |
          DIEP_TRIGGERREPEATINTERVAL | DIEP_TYPESPECIFICPARAMS;
    }

    if (dwFlags & DIEP_AXES) {
      /* the linux input effect system only supports one or two axes */
      if (peff->cAxes > 2)
          return DIERR_INVALIDPARAM;
      else if (peff->cAxes < 1)
          return DIERR_INCOMPLETEEFFECT;
    }

    /* some of this may look funky, but it's 'cause the linux driver and directx have
     * different opinions about which way direction "0" is.  directx has 0 along the x
     * axis (left), linux has it along the y axis (down). */ 
    if (dwFlags & DIEP_DIRECTION) {
      if (peff->cAxes == 1) {
          if (peff->dwFlags & DIEFF_CARTESIAN) {
            if (dwFlags & DIEP_AXES) {
                if (peff->rgdwAxes[0] == DIJOFS_X && peff->rglDirection[0] >= 0)
                  This->effect.direction = 0x4000;
                else if (peff->rgdwAxes[0] == DIJOFS_X && peff->rglDirection[0] < 0)
                  This->effect.direction = 0xC000;
                else if (peff->rgdwAxes[0] == DIJOFS_Y && peff->rglDirection[0] >= 0)
                  This->effect.direction = 0;
                else if (peff->rgdwAxes[0] == DIJOFS_Y && peff->rglDirection[0] < 0)
                  This->effect.direction = 0x8000;
            }
          } else {
            /* one-axis effects must use cartesian coords */
            return DIERR_INVALIDPARAM;
          }
      } else { /* two axes */
          if (peff->dwFlags & DIEFF_CARTESIAN) {
            /* avoid divide-by-zero */
            if (peff->rglDirection[1] == 0) {
                    if (peff->rglDirection[0] >= 0)
                        This->effect.direction = 0x4000;
                    else if (peff->rglDirection[0] < 0)
                        This->effect.direction = 0xC000;
            } else {
                This->effect.direction = (int)(atan(peff->rglDirection[0] / peff->rglDirection[1]) * 0x7FFF / (3 * M_PI));
            }
          } else {
            /* Polar and spherical are the same for 2 axes */
            /* Precision is important here, so we do double math with exact constants */
            This->effect.direction = (int)(((double)peff->rglDirection[0] - 90) / 35999) * 0x7FFF;
          }
      }
    }

    if (dwFlags & DIEP_DURATION)
      This->effect.replay.length = peff->dwDuration / 1000;

    if (dwFlags & DIEP_ENVELOPE) {
        struct ff_envelope* env;
        if (This->effect.type == FF_CONSTANT) env = &This->effect.u.constant.envelope;
        else if (This->effect.type == FF_PERIODIC) env = &This->effect.u.periodic.envelope;
        else if (This->effect.type == FF_RAMP) env = &This->effect.u.ramp.envelope;
        else env = NULL; 

      if (peff->lpEnvelope == NULL) {
          /* if this type had an envelope, reset it
           * note that length can never be zero, so we set it to something minuscule */
          if (env) {
            env->attack_length = 0x10;
            env->attack_level = 0x7FFF;
            env->fade_length = 0x10;
            env->fade_level = 0x7FFF;
          }
      } else {
          /* did we get passed an envelope for a type that doesn't even have one? */
          if (!env) return DIERR_INVALIDPARAM;
          /* copy the envelope */
          env->attack_length = peff->lpEnvelope->dwAttackTime / 1000;
          env->attack_level = (peff->lpEnvelope->dwAttackLevel / 10) * 32;
          env->fade_length = peff->lpEnvelope->dwFadeTime / 1000;
          env->fade_level = (peff->lpEnvelope->dwFadeLevel / 10) * 32;
      }
    }

    /* Gain and Sample Period settings are not supported by the linux
     * event system */
    if (dwFlags & DIEP_GAIN)
      TRACE("Gain requested but no gain functionality present.\n");

    if (dwFlags & DIEP_SAMPLEPERIOD)
      TRACE("Sample period requested but no sample period functionality present.\n");

    if (dwFlags & DIEP_STARTDELAY)
      This->effect.replay.delay = peff->dwStartDelay / 1000;

    if (dwFlags & DIEP_TRIGGERBUTTON) {
      if (peff->dwTriggerButton != -1) {
          FIXME("Linuxinput button mapping needs redoing, assuming we're using a joystick.\n");
          FIXME("Trigger button translation not yet implemented!\n");
      }
      This->effect.trigger.button = 0;
    }

    if (dwFlags & DIEP_TRIGGERREPEATINTERVAL)
      This->effect.trigger.interval = peff->dwTriggerRepeatInterval / 1000;

    if (dwFlags & DIEP_TYPESPECIFICPARAMS) {
      if (!(peff->lpvTypeSpecificParams))
          return DIERR_INCOMPLETEEFFECT;
      if (type == DIEFT_PERIODIC) {
            LPCDIPERIODIC tsp;
            if (peff->cbTypeSpecificParams != sizeof(DIPERIODIC))
                return DIERR_INVALIDPARAM;
            tsp = (LPCDIPERIODIC)(peff->lpvTypeSpecificParams);
          This->effect.u.periodic.magnitude = (tsp->dwMagnitude / 10) * 32;
          This->effect.u.periodic.offset = (tsp->lOffset / 10) * 32;
          This->effect.u.periodic.phase = (tsp->dwPhase / 9) * 8; /* == (/ 36 * 32) */
          This->effect.u.periodic.period = tsp->dwPeriod / 1000;
      } else if (type == DIEFT_CONSTANTFORCE) {
            LPCDICONSTANTFORCE tsp;
            if (peff->cbTypeSpecificParams != sizeof(DICONSTANTFORCE))
                return DIERR_INVALIDPARAM;
            tsp = (LPCDICONSTANTFORCE)(peff->lpvTypeSpecificParams);
          This->effect.u.constant.level = (tsp->lMagnitude / 10) * 32;
      } else if (type == DIEFT_RAMPFORCE) {
            LPCDIRAMPFORCE tsp;
            if (peff->cbTypeSpecificParams != sizeof(DIRAMPFORCE))
                return DIERR_INVALIDPARAM;
            tsp = (LPCDIRAMPFORCE)(peff->lpvTypeSpecificParams);
          This->effect.u.ramp.start_level = (tsp->lStart / 10) * 32;
          This->effect.u.ramp.end_level = (tsp->lStart / 10) * 32;
      } else if (type == DIEFT_CONDITION) {
            LPCDICONDITION tsp = (LPCDICONDITION)(peff->lpvTypeSpecificParams);
            if (peff->cbTypeSpecificParams == sizeof(DICONDITION)) {
            /* One condition block.  This needs to be rotated to direction,
             * and expanded to separate x and y conditions. */
            int i;
            double factor[2];
            factor[0] = asin((This->effect.direction * 3.0 * M_PI) / 0x7FFF);
            factor[1] = acos((This->effect.direction * 3.0 * M_PI) / 0x7FFF);
                for (i = 0; i < 2; ++i) {
                    This->effect.u.condition[i].center = (int)(factor[i] * (tsp->lOffset / 10) * 32);
                    This->effect.u.condition[i].right_coeff = (int)(factor[i] * (tsp->lPositiveCoefficient / 10) * 32);
                    This->effect.u.condition[i].left_coeff = (int)(factor[i] * (tsp->lNegativeCoefficient / 10) * 32); 
                    This->effect.u.condition[i].right_saturation = (int)(factor[i] * (tsp->dwPositiveSaturation / 10) * 32);
                    This->effect.u.condition[i].left_saturation = (int)(factor[i] * (tsp->dwNegativeSaturation / 10) * 32);
                    This->effect.u.condition[i].deadband = (int)(factor[i] * (tsp->lDeadBand / 10) * 32);
                }
          } else if (peff->cbTypeSpecificParams == 2 * sizeof(DICONDITION)) {
            /* Two condition blocks.  Direct parameter copy. */
            int i;
                for (i = 0; i < 2; ++i) {
                This->effect.u.condition[i].center = (tsp[i].lOffset / 10) * 32;
                This->effect.u.condition[i].right_coeff = (tsp[i].lPositiveCoefficient / 10) * 32;
                This->effect.u.condition[i].left_coeff = (tsp[i].lNegativeCoefficient / 10) * 32;
                This->effect.u.condition[i].right_saturation = (tsp[i].dwPositiveSaturation / 10) * 32;
                This->effect.u.condition[i].left_saturation = (tsp[i].dwNegativeSaturation / 10) * 32;
                This->effect.u.condition[i].deadband = (tsp[i].lDeadBand / 10) * 32;
            }
          } else {
                return DIERR_INVALIDPARAM;
          }
      } else {
          FIXME("Custom force types are not supported\n");  
          return DIERR_INVALIDPARAM;
      }
    }

    if (!(dwFlags & DIEP_NODOWNLOAD))
      retval = LinuxInputEffectImpl_Download(iface);
    if (retval != DI_OK)
      return DI_DOWNLOADSKIPPED;

    if (dwFlags & DIEP_NORESTART)
      TRACE("DIEP_NORESTART: not handled (we have no control of that).\n");

    if (dwFlags & DIEP_START)
      retval = LinuxInputEffectImpl_Start(iface, 1, 0);
    if (retval != DI_OK)
      return retval;
 
    return DI_OK;
}   

static ULONG WINAPI LinuxInputEffectImpl_Release(
      LPDIRECTINPUTEFFECT iface)
{
    LinuxInputEffectImpl *This = (LinuxInputEffectImpl *)iface;
    ULONG ref = InterlockedDecrement(&(This->ref));

    if (ref == 0)
        HeapFree(GetProcessHeap(), 0, This);
    return ref;
}

static HRESULT WINAPI LinuxInputEffectImpl_Stop(
        LPDIRECTINPUTEFFECT iface)
{
    struct input_event event;
    LinuxInputEffectImpl *This = (LinuxInputEffectImpl *)iface;

    TRACE("(this=%p)\n", This);

    event.type = EV_FF;
    event.code = This->effect.id;
    event.value = 0;
    /* we don't care about the success or failure of this call */
    write(*(This->fd), &event, sizeof(event));

    return DI_OK;
}

static HRESULT WINAPI LinuxInputEffectImpl_Unload(
      LPDIRECTINPUTEFFECT iface)
{
    LinuxInputEffectImpl *This = (LinuxInputEffectImpl *)iface;
    TRACE("(this=%p)\n", This);

    /* Erase the downloaded effect */
    if (ioctl(*(This->fd), EVIOCRMFF, This->effect.id) == -1)
      return DIERR_INVALIDPARAM;

    /* Mark the effect as deallocated */
    This->effect.id = -1;

    return DI_OK;
}

/******************************************************************************
 *      LinuxInputEffect
 */

HRESULT linuxinput_create_effect(
      int* fd,
      REFGUID rguid,
      LPDIRECTINPUTEFFECT* peff)
{
    LinuxInputEffectImpl* newEffect = HeapAlloc(GetProcessHeap(), 
      HEAP_ZERO_MEMORY, sizeof(LinuxInputEffectImpl));
    DWORD type = _typeFromGUID(rguid);
    
    newEffect->lpVtbl = &LinuxInputEffectVtbl;
    newEffect->ref = 1;
    memcpy(&(newEffect->guid), rguid, sizeof(*rguid));
    newEffect->fd = fd;
    
    /* set the type.  this cannot be changed over the effect's life. */
    switch (type) {
      case DIEFT_PERIODIC: 
          newEffect->effect.type = FF_PERIODIC;
          if (IsEqualGUID(rguid, &GUID_Sine)) {
            newEffect->effect.u.periodic.waveform = FF_SINE;
          } else if (IsEqualGUID(rguid, &GUID_Triangle)) {
                newEffect->effect.u.periodic.waveform = FF_TRIANGLE;
            } else if (IsEqualGUID(rguid, &GUID_Square)) {
                newEffect->effect.u.periodic.waveform = FF_SQUARE;
            } else if (IsEqualGUID(rguid, &GUID_SawtoothUp)) {
                newEffect->effect.u.periodic.waveform = FF_SAW_UP;
            } else if (IsEqualGUID(rguid, &GUID_SawtoothDown)) {
                newEffect->effect.u.periodic.waveform = FF_SAW_DOWN;
          }
          break;
      case DIEFT_CONSTANTFORCE: 
            newEffect->effect.type = FF_CONSTANT;
          break;
      case DIEFT_RAMPFORCE: 
          newEffect->effect.type = FF_RAMP;
          break;
      case DIEFT_CONDITION: 
          if (IsEqualGUID(rguid, &GUID_Spring)) {
            newEffect->effect.type = FF_SPRING;
            } else if (IsEqualGUID(rguid, &GUID_Friction)) {
            newEffect->effect.type = FF_FRICTION;
            } else if (IsEqualGUID(rguid, &GUID_Inertia)) {
            newEffect->effect.type = FF_INERTIA;
            } else if (IsEqualGUID(rguid, &GUID_Damper)) {
            newEffect->effect.type = FF_DAMPER;
          }
          break;
      case DIEFT_CUSTOMFORCE:
          FIXME("Custom forces are not supported.\n");
          HeapFree(GetProcessHeap(), 0, newEffect);
          return DIERR_INVALIDPARAM;
      default:
          FIXME("Unknown force type.\n");
            HeapFree(GetProcessHeap(), 0, newEffect);
          return DIERR_INVALIDPARAM;
    }

    /* mark as non-uploaded */
    newEffect->effect.id = -1;

    *peff = (LPDIRECTINPUTEFFECT)newEffect; 

    TRACE("Creating linux input system effect (%p) with guid %s\n", 
        *peff, _dump_dinput_GUID(rguid));

    return DI_OK;
}

HRESULT linuxinput_get_info_A(
      int fd,
      REFGUID rguid,
      LPDIEFFECTINFOA info)
{
    DWORD type = _typeFromGUID(rguid);

    TRACE("(%d, %s, %p) type=%d\n", fd, _dump_dinput_GUID(rguid), info, type);

    if (!info) return E_POINTER;

    if (info->dwSize != sizeof(DIEFFECTINFOA)) return DIERR_INVALIDPARAM;

    info->guid = *rguid;
    
    info->dwEffType = type; 
    /* the event device API does not support querying for all these things
     * therefore we assume that we have support for them
     * that's not as dangerous as it sounds, since drivers are allowed to
     * ignore parameters they claim to support anyway */
    info->dwEffType |= DIEFT_DEADBAND | DIEFT_FFATTACK | DIEFT_FFFADE 
                    | DIEFT_POSNEGCOEFFICIENTS | DIEFT_POSNEGSATURATION
                | DIEFT_SATURATION | DIEFT_STARTDELAY; 

    /* again, assume we have support for everything */
    info->dwStaticParams = DIEP_ALLPARAMS;
    info->dwDynamicParams = info->dwStaticParams;

    /* yes, this is windows behavior (print the GUID_Name for name) */
    strcpy((char*)&(info->tszName), _dump_dinput_GUID(rguid));

    return DI_OK;
}

HRESULT linuxinput_get_info_W(
      int fd,
      REFGUID rguid,
      LPDIEFFECTINFOW info)
{
    DWORD type = _typeFromGUID(rguid);

    TRACE("(%d, %s, %p) type=%d\n", fd, _dump_dinput_GUID(rguid), info, type);

    if (!info) return E_POINTER;

    if (info->dwSize != sizeof(DIEFFECTINFOW)) return DIERR_INVALIDPARAM;

    info->guid = *rguid;

    info->dwEffType = type;
    /* the event device API does not support querying for all these things
     * therefore we assume that we have support for them
     * that's not as dangerous as it sounds, since drivers are allowed to
     * ignore parameters they claim to support anyway */
    info->dwEffType |= DIEFT_DEADBAND | DIEFT_FFATTACK | DIEFT_FFFADE
                    | DIEFT_POSNEGCOEFFICIENTS | DIEFT_POSNEGSATURATION
                    | DIEFT_SATURATION | DIEFT_STARTDELAY; 

    /* again, assume we have support for everything */
    info->dwStaticParams = DIEP_ALLPARAMS;
    info->dwDynamicParams = info->dwStaticParams;

    /* yes, this is windows behavior (print the GUID_Name for name) */
    MultiByteToWideChar(CP_ACP, 0, _dump_dinput_GUID(rguid), -1, 
                    (WCHAR*)&(info->tszName), MAX_PATH);

    return DI_OK;
}

static const IDirectInputEffectVtbl LinuxInputEffectVtbl = {
    LinuxInputEffectImpl_QueryInterface,
    LinuxInputEffectImpl_AddRef,
    LinuxInputEffectImpl_Release,
    LinuxInputEffectImpl_Initialize,
    LinuxInputEffectImpl_GetEffectGuid,
    LinuxInputEffectImpl_GetParameters,
    LinuxInputEffectImpl_SetParameters,
    LinuxInputEffectImpl_Start,
    LinuxInputEffectImpl_Stop,
    LinuxInputEffectImpl_GetEffectStatus,
    LinuxInputEffectImpl_Download,
    LinuxInputEffectImpl_Unload,
    LinuxInputEffectImpl_Escape
};

#endif /* HAVE_STRUCT_FF_EFFECT_DIRECTION */

Generated by  Doxygen 1.6.0   Back to index