// kjinput.cc 
// see /usr/share/doc/joystick../joystick.txt

#include <stdio.h>
#include <error.h>
#include <errno.h>
#include <unistd.h>
#include <sys/ioctl.h>
#include <fcntl.h>
#include <string.h>
#include "kjinput.h"

KLJoyStick::KLJoyStick(const char *devname)
{
  x=y=z=bt=0;
  fd=0; valid=0;  dev=NULL;
  jsrp=0;

  dev=new char [strlen(devname)+1];
  strcpy(dev,devname);
  
  fd=open(dev,O_RDONLY|O_NONBLOCK);
  if(fd<0)
    {
       perror("The port is not found.");
       return;
    }
  valid=1;
  SetAxisMax(1000);
  Read();
}

KLJoyStick::~KLJoyStick()
{
  if(dev) delete [] dev;
}

int KLJoyStick::Read(void)
{
  if(!valid) return -1;
  
  int r;
  while(1)
    {
      r=read(fd,((char *)(&js))+jsrp,sizeof(js)-jsrp);
      if(r<0)
	{
	  if(errno==EAGAIN) return 0;
	  perror("some error on joystick");
	  return -1;
	}
      jsrp+=r;
      if(jsrp<sizeof(js))
	{
	  puts("trucated??");
	  return 0;
	}
      jsrp=0;
      switch(js.type&(~JS_EVENT_INIT))
	{
	case JS_EVENT_BUTTON:
	  if (js.value)
	    bt |= (1 << js.number);
	  else
	    bt &= ~(1 << js.number);
	  break;

	case JS_EVENT_AXIS:
	  int val=js.value*amax/32767;
	  switch(js.number)
	    {
	    case 0: x=val; break;
	    case 1: y=val; break;
	    case 2: z=val; break;
	    }
	  break;
	}
    }
}

#if 0

int main(void)
{
  KLJoyStick stick("/dev/input/js0");
  int x,y,z,bt;
  while(1)
    {
      stick.GetButtons(x,y,z,bt);
      printf("% 5d  % 5d  % 5d   %04X\n",x,y,z,bt);
      usleep(1000);
    }
}


#endif