/*
     PLIB - A Suite of Portable Game Libraries
     Copyright (C) 1998,2002  Steve Baker

     This library is free software; you can redistribute it and/or
     modify it under the terms of the GNU Library General Public
     License as published by the Free Software Foundation; either
     version 2 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
     Library General Public License for more details.

     You should have received a copy of the GNU Library General Public
     License along with this library; if not, write to the Free Software
     Foundation, Inc., 59 Temple Place, Suite 330, Boston, MA  02111-1307 USA

     For further information visit http://plib.sourceforge.net

     $Id: jsLinux.cxx 2017 2005-02-21 07:37:25Z bram $
*/

#include "js.h"

#if defined (UL_LINUX)

#include <linux/joystick.h>

#if defined(JS_VERSION) && JS_VERSION >= 0x010000

#include <sys/param.h>
#include <fcntl.h>
#include <sys/ioctl.h>

struct os_specific_s {
  js_event     js          ;
  int          tmp_buttons ;
  float        tmp_axes [ _JS_MAX_AXES ] ;
  char         fname [ 128 ] ;
  int          fd ;
};

void jsInit () {}

void jsJoystick::open ()
{
  name [0] = '\0' ;

  for ( int i = 0 ; i < _JS_MAX_AXES ; i++ )
    os->tmp_axes [ i ] = 0.0f ;

  os->tmp_buttons = 0 ;

  os->fd = ::open ( os->fname, O_RDONLY ) ;

  error = ( os->fd < 0 ) ;

  if ( error )
    return ;

  /*
    Set the correct number of axes for the linux driver
  */

  /* Melchior Franz's fixes for big-endian Linuxes since writing 
   *  to the upper byte of an uninitialized word doesn't work. 
   *  9 April 2003 
   */
  unsigned char u ;
  ioctl ( os->fd, JSIOCGAXES   , &u ) ; 
  num_axes = u ;
  ioctl ( os->fd, JSIOCGBUTTONS, &u ) ;
  num_buttons = u ;
  ioctl ( os->fd, JSIOCGNAME ( sizeof(name) ), name ) ;
  fcntl ( os->fd, F_SETFL      , O_NONBLOCK   ) ;

  int all_axes = num_axes;
  if ( num_axes > _JS_MAX_AXES )
    num_axes = _JS_MAX_AXES ;

  // Remove any deadband value already done in the kernel.
  // Since we have our own deadband management this is save to do so.
  struct js_corr* corr = new js_corr[ all_axes ] ;
  ioctl ( os->fd, JSIOCGCORR, corr );
  for ( int i = 0; i < num_axes ; ++i ) {
    if ( corr[ i ] . type == JS_CORR_BROKEN ) {
      int nodeadband = ( corr[ i ] . coef[ 0 ] + corr[ i ] . coef[ 1 ] ) / 2 ;
      corr[ i ] . coef[ 0 ] = nodeadband ;
      corr[ i ] . coef[ 1 ] = nodeadband ;
    }
  }
  ioctl ( os->fd, JSIOCSCORR, corr );
  delete [] corr;

  for ( int i = 0 ; i < _JS_MAX_AXES ; i++ )
  {
    max       [ i ] = 32767.0f ;
    center    [ i ] = 0.0f ;
    min       [ i ] = -32767.0f ;
    dead_band [ i ] = 0.0f ;
    saturate  [ i ] = 1.0f ;
  }
}



void jsJoystick::close ()
{
  if ( ! error )
    ::close ( os->fd ) ;
  delete os;
}


jsJoystick::jsJoystick ( int ident )
{
  id = ident ;
  os = new struct os_specific_s;

  sprintf ( os->fname, "/dev/input/js%d", ident ) ;

  if ( access ( os->fname, F_OK ) != 0 )
    sprintf ( os->fname, "/dev/js%d", ident ) ;

  open () ;
}


void jsJoystick::rawRead ( int *buttons, float *axes )
{
  if ( error )
  {
    if ( buttons )
      *buttons = 0 ;

    if ( axes )
      for ( int i = 0 ; i < num_axes ; i++ )
        axes[i] = 1500.0f ;

    return ;
  }

  while (1)
  {
    int status = ::read ( os->fd, &(os->js), sizeof(js_event) ) ;

    if ( status != sizeof(js_event) )
    {
      /* use the old values */

      if ( buttons != NULL ) *buttons = os->tmp_buttons ;
      if ( axes    != NULL )
        memcpy ( axes, os->tmp_axes, sizeof(float) * num_axes ) ;

      if ( errno == EAGAIN )
        return ;

      perror( os->fname ) ;
      setError () ;
      return ;
    }

    switch ( os->js.type & ~JS_EVENT_INIT )
    {
      case JS_EVENT_BUTTON :
        if ( os->js.value == 0 ) /* clear the flag */
          os->tmp_buttons &= ~(1 << os->js.number) ;
        else
          os->tmp_buttons |=  (1 << os->js.number) ;
        break ;

      case JS_EVENT_AXIS:
        if ( os->js.number < num_axes )
        {
          os->tmp_axes [ os->js.number ] = (float) os->js.value ;

          if ( axes )
            memcpy ( axes, os->tmp_axes, sizeof(float) * num_axes ) ;
        }
        break ;

      default:
        ulSetError ( UL_WARNING, "PLIB_JS: Unrecognised /dev/js return!?!" ) ;

        /* use the old values */

        if ( buttons != NULL ) *buttons = os->tmp_buttons ;
        if ( axes    != NULL )
          memcpy ( axes, os->tmp_axes, sizeof(float) * num_axes ) ;

        return ;
    }

    if ( buttons != NULL )
      *buttons = os->tmp_buttons ;
  }
}

#endif
#endif
