Subversion Repositories shark

/*
 * Project: S.Ha.R.K.
 *
 * Coordinators:
 *   Giorgio Buttazzo    <giorgio@sssup.it>
 *   Paolo Gai           <pj@gandalf.sssup.it>
 *
 * Authors     :
 *   Mauro Marinoni      <mauro.marinoni@unipv.it>
 *
 *
 * ReTiS Lab (Scuola Superiore S.Anna - Pisa - Italy)
 *
 * http://www.sssup.it
 * http://retis.sssup.it
 * http://shark.sssup.it
 */

//#define __JOY_DEBUG__
//#define __JOY_DUMP__

#include <kernel/kern.h>

#include "../include/drivers/shark_input26.h"
#include "../include/drivers/shark_joy26.h"

#include <kernel/func.h>

/* Devices */
extern int ns558_init(void);
extern int ns558_exit(void);

extern int analog_init(void);
extern int analog_exit(void);

extern int joydump_init(void);
extern int joydump_exit(void);

/* Handler */
extern int joystick_init(void);
extern int joystick_exit(void);

/* Functions */
extern int joystick_get(int *type, int *number, int *value);

#define JS_EVENT_BUTTON         0x01    /* button pressed/released */
#define JS_EVENT_AXIS           0x02    /* joystick moved */
#define JS_EVENT_INIT           0x80    /* initial state of device */

/* joystick driver currently installed */
static int joystick_installed = FALSE;
static int joystick_enabled = FALSE;

static int axis[4], button;

/* Called by handler */
void shark_joy_exec(void) {
        int type, number, value;

        if (joystick_enabled == FALSE)
                return;

        if (joystick_get(&type, &number, &value))
                return;

        switch (type) {                                 /* TODO */
                case JS_EVENT_BUTTON:
                        if (value)
                                button |= 1 << number;
                        else
                                button &= ~(1 << number);
                        break;
                case JS_EVENT_AXIS:
                        axis[number] = value;
                        break;
                default:
                        return;
        }
#ifdef __JOY_DEBUG__
        printk(KERN_DEBUG "shark_joy.c: (%4d,%4d) (%4d,%4d) %4x\n", axis[0], axis[1], axis[2], axis[3], button);
#endif
}

/* User Functions */
void joy_getstatus(int *axe0, int *axe1, int *axe2, int *axe3, int *buttons)
{
        if (axe0)
                *axe0 = axis[0];
        if (axe1)
                *axe1 = axis[1];
        if (axe2)
                *axe2 = axis[2];
        if (axe3)
                *axe3 = axis[3];
        if (buttons)
                *buttons = button;
}

void joy_setstatus(int axe0, int axe1, int axe2, int axe3, int buttons)
{
        if ((axe0 > -32767) && (axe0 < 32767))
                axis[0] = axe0;
        if ((axe1 > -32767) && (axe1 < 32767))
                axis[1] = axe1;
        if ((axe2 > -32767) && (axe2 < 32767))
                axis[2] = axe2;
        if ((axe3 > -32767) && (axe3 < 32767))
                axis[3] = axe3;
        button = buttons;
}

void joy_enable(void)
{
        joystick_enabled = TRUE;
#ifdef __JOY_DEBUG__
        printk("shark_joy.c: Joystick Enabled.\n");
#endif
}

void joy_disable(void)
{
        joystick_enabled = FALSE;
#ifdef __JOY_DEBUG__
        printk("shark_joy.c: Joystick Disabled.\n");
#endif
}


/* Init the Linux Joystick Driver */
int JOY26_installed(void) {
        return joystick_installed;
}

int JOY26_init(void) {

        int ret;

        if (INPUT26_installed() == FALSE)
                if (INPUT26_init()) {
                        printk(KERN_ERR "Unable to open Input SubSystem.\n");
                        return -1;
                }

        ret = ns558_init();
        if (ret) {
                printk(KERN_ERR "Gameport_Init return: %d\n", ret);
                return -1;
        }

#ifdef __JOY_DUMP__
        ret = joydump_init();
#else
        ret = analog_init();
#endif
        if (ret) {
                printk(KERN_ERR "Joystick_Device_Init return: %d\n", ret);
                return -1;
        }

        ret = joystick_init();
        if (ret) {
                printk(KERN_ERR "Joystick_Handler_Init return: %d\n", ret);
                return -1;
        }

        joystick_installed = TRUE;
        joystick_enabled = TRUE;

        return 0;
}

int JOY26_close(void) {
        if (!joystick_installed)
                return -1;

        joystick_enabled = FALSE;
        joystick_exit();
#ifdef __JOY_DUMP__
        joydump_exit();
#else
        analog_exit();
#endif
        ns558_exit();

        joystick_installed = FALSE;
        return 0;
}