apple2pi/src/a2joypad.c

/*
 * Copyright 2013, David Schmenk
 */
#include "a2lib.c"
#include <fcntl.h>
#include <time.h>
#include <linux/input.h>
#include <linux/uinput.h>
#include <signal.h>
#define	FALSE		0
#define	TRUE		(!FALSE)
#define	POLL_HZ		100	/* must be greater than 1 */
struct timespec tv;
struct input_event evkey, evrelx, evrely, evsync;
#define PEN_UP		0
#define PEN_DOWN	1
#define	PEN_SCALE	3
#define	PEN_NOISE	96
#define	BTTN_IO		0xC061
#define	READGP0		0x320
#define	READGP1		0x328
char readgp[] = {
    0xA2, 0x00,       // LDX #PADDLE
    0x78,             // SEI
    0x20, 0x1E, 0xFB, // JSR PREAD
    0x98,             // TYA
    0x60,             // RTS
};
/*
 * Error handling.
 */
int isdebug, stop = FALSE;
#define prdbg(s)	do{if(isdebug)fprintf(stderr,(s));}while(0)
#define die(str, args...) do { \
    prdbg(str); \
    exit(-1); \
} while(0)
static void sig_bye(int signo)
{
    stop = TRUE;
}

void main(int argc, char **argv)
{
    struct uinput_user_dev uidev;
    int a2fd, joyfd, relx, rely, pen, upx, upy, downx, downy, cntrx, cntry, gptoggle;
    unsigned char prevbttns[2], bttns[2];
    
    int pifd = a2open("127.0.0.1");
    if (pifd < 0)
    {
	perror("Unable to connect to Apple II Pi");
	exit(EXIT_FAILURE);
    }
    /*
     * Are we running debug?
     */
    if ((argc > 1) && (strcmp(argv[1], "-D") == 0))
    {
	isdebug = TRUE;	
    }
    else
    {
	if (daemon(0, 0) != 0)
	    die("a2joy: daemon() failure");
	isdebug = FALSE;
    }
    /*
     * Create joystick input device
     */
    prdbg("a2joy: Create joystick input device\n");
    joyfd = open("/dev/uinput", O_WRONLY | O_NONBLOCK);
    if (joyfd < 0)
	die("error: uinput open");
    if (ioctl(joyfd, UI_SET_EVBIT, EV_KEY) < 0)
	die("error: uinput ioctl EV_KEY");
    if (ioctl(joyfd, UI_SET_KEYBIT, BTN_LEFT) < 0)
	die("error: uinput ioctl BTN_LEFT");
    if (ioctl(joyfd, UI_SET_KEYBIT, BTN_RIGHT) < 0)
	die("error: uinput ioctl BTN_RIGHT");
    if (ioctl(joyfd, UI_SET_EVBIT, EV_REL) < 0)
	die("error: ioctl EV_REL");
    if (ioctl(joyfd, UI_SET_RELBIT, REL_X) < 0)
	die("error: ioctl REL_X");
    if (ioctl(joyfd, UI_SET_RELBIT, REL_Y) < 0)
	die("error: ioctl REL_Y");
    if (ioctl(joyfd, UI_SET_EVBIT, EV_SYN) < 0)
	die("error: ioctl EV_SYN");
    bzero(&uidev, sizeof(uidev));
    snprintf(uidev.name, UINPUT_MAX_NAME_SIZE, "Apple2 Pi Joystick");
    uidev.id.bustype = BUS_RS232;
    uidev.id.vendor  = 0x05ac;      /* apple */
    uidev.id.product = 0x2e;
    uidev.id.version = 1;
    write(joyfd, &uidev, sizeof(uidev));
    if (ioctl(joyfd, UI_DEV_CREATE) < 0)
	die("error: ioctl DEV_CREATE");
    /*
     * Initialize event structures.
     */
    bzero(&evkey,  sizeof(evkey));
    bzero(&evsync, sizeof(evsync));
    bzero(&evrelx, sizeof(evrelx));
    bzero(&evrely, sizeof(evrely));
    evkey.type  = EV_KEY;
    evrelx.type = EV_REL;
    evrelx.code = REL_X;
    evrely.type = EV_REL;
    evrely.code = REL_Y;
    evsync.type = EV_SYN;
    /*
     * Add signal handlers.
     */
    if (signal(SIGINT, sig_bye) == SIG_ERR)
	die("signal");
    if (signal(SIGHUP, sig_bye) == SIG_ERR)
	die("signal");
    /*
     * Set poll rate.
     */
    tv.tv_sec = 0;
    tv.tv_nsec = isdebug ? 1E+9/2 : 1E+9/POLL_HZ;
    /*
     * Download 6502 code.
     */
    readgp[1] = 0;
    a2write(pifd, READGP0, sizeof(readgp), readgp);
    readgp[1] = 1;
    a2write(pifd, READGP1, sizeof(readgp), readgp);
    a2quickcall(pifd, READGP0, &upx);
    a2read(pifd, BTTN_IO, 2, prevbttns);
    a2quickcall(pifd, READGP1, &upy);
    upx         += 2;
    upy         += 2;
    gptoggle     = 0;
    pen          = PEN_UP;
    evrelx.value = 0;
    evrely.value = 0;
    /*
     * Poll joystick loop.a
     */
    prdbg("a2joypad: Enter poll loop\n");
    while (!stop)
    {
	if (gptoggle)
	{
	    a2quickcall(pifd, READGP0, &relx);
	    if (relx <= upx || rely <= upy)
	    {
		if (pen == PEN_DOWN)
		{
		    evrelx.value = 0;
		    evrely.value = 0;
		    write(joyfd, &evrelx, sizeof(evrelx));
		    write(joyfd, &evrely, sizeof(evrely));
		    write(joyfd, &evsync, sizeof(evsync));
                    if (downx == cntrx && downy == cntry)
                    {
                        evkey.code  = BTN_LEFT;
                        evkey.value = 1;
                        write(joyfd, &evkey, sizeof(evkey));
                        write(joyfd, &evsync, sizeof(evsync));
                        evkey.value = 0;
                        write(joyfd, &evkey, sizeof(evkey));
                        write(joyfd, &evsync, sizeof(evsync));
                    }
		}
		pen = PEN_UP;
	    }
	    else if (pen == PEN_UP && (relx > upx && rely > upy))
	    {
		pen   = PEN_DOWN;
		downx = cntrx = relx;
		downy = cntry = rely;
	    }
	    if (pen == PEN_DOWN)
	    {
                if (abs(relx - cntrx) < PEN_NOISE && abs(rely - cntry) < PEN_NOISE)
                {
                    evrelx.value = (relx - cntrx) * PEN_SCALE;
                    evrely.value = (rely - cntry) * PEN_SCALE;
                    write(joyfd, &evrelx, sizeof(evrelx));
                    write(joyfd, &evrely, sizeof(evrely));
                    write(joyfd, &evsync, sizeof(evsync));
                }
                cntrx = relx;
                cntry = rely;
	    }
	    if (isdebug) fprintf(stderr, "a2joypad (%d, %d) [%d %d] pen=%d\n", relx, rely, bttns[0] >> 7, bttns[1] >> 7, pen);
	}
	else
	{
	    a2quickcall(pifd, READGP1, &rely);
	}
	gptoggle ^= 1;
	a2read(pifd, BTTN_IO, 2, bttns);
	if ((bttns[0] & 0x80) != prevbttns[0]) 
	{
	    if (!evkey.value)
		evkey.code = (bttns[1] & 0x80) ? BTN_RIGHT : BTN_LEFT;
	    evkey.value    = bttns[0] >> 7;
	    write(joyfd, &evkey, sizeof(evkey));
	    write(joyfd, &evsync, sizeof(evsync));
	    prevbttns[0] = bttns[0] & 0x80;
	    prevbttns[1] = bttns[1] & 0x80;
	}
	nanosleep(&tv, NULL);
    }
    a2close(pifd);
    ioctl(joyfd, UI_DEV_DESTROY);
    close(joyfd);
    prdbg("\na2joypad: Exit\n");
}