Subversion Repositories or1k

/*
 * Microwindows touch screen driver for G.Mate YOPY
 *
 * Copyright (c) 2000 Century Software Embedded Technologies
 *
 * Requires /dev/yopy-ts kernel mouse driver.
 */
#include <stdio.h>
#include <stdlib.h>
#include <unistd.h>
#include <errno.h>
#include <fcntl.h>
#include <math.h>
#include <sys/ioctl.h>
#include "device.h"
 
/* file descriptor for touch panel */
static int pd_fd = -1;
 
/* Hack extern to used when hiding the mouse cursor
 * There needs to be a better way to do this
*/
extern SCREENDEVICE scrdev;
 
static int cal[7];
 
typedef struct {
        int x, y;
} XYPOINT;
 
#define TRANSFORMATION_UNITS_PER_PIXEL 4
static int GetPointerCalibrationData(void)
{
  /*
   * Read the calibration data from the calibration file.
   * Calibration file format is seven coefficients separated by spaces.
   */
 
  /* Get pointer calibration data from this file */
  const char cal_filename[] = "/etc/ts.conf";
 
  int items;
 
  FILE* f = fopen(cal_filename, "r");
  if ( f == NULL )
    {
      EPRINTF("Error %d opening pointer calibration file %s.\n",
	      errno, cal_filename);
      return -1;
    }
 
  items = fscanf(f, "%d %d %d %d %d %d %d",
		 &cal[0], &cal[1], &cal[2], &cal[3], &cal[4], &cal[5], &cal[6]);
  if ( items != 7 )
    {
      EPRINTF("Improperly formatted pointer calibration file %s.\n",
	      cal_filename);
      return -1;
    }
 
#ifdef TEST
  EPRINTF("a=%d b=%d c=%d d=%d e=%d f=%d s=%d\n",
	  cal[0], cal[1], cal[2], cal[3], cal[4], cal[5], cal[6]);
#endif
 
  return 0;
}
 
static XYPOINT DeviceToScreen(XYPOINT p)
{
  /*
   * Transform device coordinates to screen coordinates.
   * Take a point p in device coordinates and return the corresponding
   * point in screen coodinates.
   * This can scale, translate, rotate and/or skew, based on the coefficients
   * calculated above based on the list of screen vs. device coordinates.
   */
 
  static XYPOINT prev;
  /* set slop at 3/4 pixel */
  const short slop = TRANSFORMATION_UNITS_PER_PIXEL * 3 / 4;
  XYPOINT new, out;
 
  /* transform */
  new.x = (cal[0] * p.x + cal[1] * p.y + cal[2]) / cal[6];
  new.y = (cal[3] * p.x + cal[4] * p.y + cal[5]) / cal[6];
 
  /* hysteresis (thanks to John Siau) */
  if ( abs(new.x - prev.x) >= slop )
    out.x = (new.x | 0x3) ^ 0x3;
  else
    out.x = prev.x;
 
  if ( abs(new.y - prev.y) >= slop )
    out.y = (new.y | 0x3) ^ 0x3;
  else
    out.y = prev.y;
 
  prev = out;
 
  return out;
}
 
static int PD_Open(MOUSEDEVICE *pmd)
{
  /*
   * open up the touch-panel device.
   * Return the fd if successful, or negative if unsuccessful.
   */
 
  pd_fd = open("/dev/yopy-ts", O_NONBLOCK);
  if (pd_fd < 0) {
    EPRINTF("Error %d opening touch panel\n", errno);
    return -1;
  }
 
  GetPointerCalibrationData();
  GdHideCursor(&scrdev);
 
  return pd_fd;
}
 
static void PD_Close(void)
{
  /* Close the touch panel device. */
  if (pd_fd >= 0)
    close(pd_fd);
  pd_fd = -1;
}
 
static int PD_GetButtonInfo(void)
{
  /* get "mouse" buttons supported */
  return MWBUTTON_L;
}
 
static void PD_GetDefaultAccel(int *pscale,int *pthresh)
{
  /*
   * Get default mouse acceleration settings
   * This doesn't make sense for a touch panel.
   * Just return something inconspicuous for now.
   */
  *pscale = 3;
  *pthresh = 5;
}
 
 
static int PD_Read(MWCOORD *px, MWCOORD *py, MWCOORD *pz, int *pb)
{
  /* read a data point */
 
  unsigned long data;
  int bytes_read;
 
  XYPOINT transformed;
 
  bytes_read = read(pd_fd, &data, sizeof(data));
 
  if (bytes_read != sizeof(data)) {
    if (errno == EINTR || errno == EAGAIN) {
      return 0;
    }
    return 0;
  }
 
  transformed.x = (data & 0x3ff);
  transformed.y = (data >> 10) & 0x3ff;
 
  transformed = DeviceToScreen(transformed);
 
  transformed.x >>= 2;
  transformed.y >>= 2;
 
  *px = transformed.x;
  *py = transformed.y;
 
  *pb = (((data >> 31) & 0x1) ? MWBUTTON_L : 0);
 
  *pz = 0;
 
  if(! *pb )
    return 3;			/* only have button data */
  else 
    return 2;			/* have full set of data */
}
 
MOUSEDEVICE mousedev = {
  PD_Open,
  PD_Close,
  PD_GetButtonInfo,
  PD_GetDefaultAccel,
  PD_Read,
  NULL
};
 
#ifdef TEST
int main(int argc, char ** v)
{
  MWCOORD x, y, z;
  int	b;
  int result;
  int mouse = -1;
  DPRINTF("Opening touch panel...\n");
 
  if((result=PD_Open(0)) < 0)
    DPRINTF("Error %d, result %d opening touch-panel\n", errno, result);
 
  while(1) {
    result = PD_Read(&x, &y, &z, &b);
    if( result > 0) {
      if(mouse != b) {
	mouse = b;
	if(mouse) 
	  DPRINTF("Pen Down\n");
	else
	  DPRINTF("Pen Up\n");
      }
      DPRINTF("%d,%d,%d,%d,%d\n", result, x, y, z, b);
    }
  }
}
#endif