Project

General

Profile

#include "joystick.h"

#include <stdio.h>
#include <poll.h>
#include <termios.h>
#include <unistd.h>

extern char native_porta;
extern char native_trig;

void read_keys();

struct termios oldt, newt;
void term_init()
{
tcgetattr(STDIN_FILENO, &oldt);
newt = oldt;
newt.c_lflag &= ~( ICANON | ECHO );
tcsetattr( STDIN_FILENO, TCSANOW, &newt);
}

void term_close()
{
tcsetattr(STDIN_FILENO, TCSANOW, &oldt);
}

int main(void)
{
term_init();

fprintf(stderr,"Polling\n");
int i;
for (i=0;i!=200;++i)
{
struct joystick_status joy;
read_keys();
joystick_poll(&joy);

fprintf(stderr, "x:%d y:%d fire:%d\n", joy.x_, joy.y_, joy.fire_);

usleep(100000);
}


//void joystick_poll(struct joystick_status * status);
//void joystick_wait(struct joystick_status * status, enum JoyWait waitFor);

term_close();

return 0;
}

void read_keys()
{
struct pollfd fds[1];
fds[0].fd = STDIN_FILENO;
fds[0].events = POLLIN;
native_porta = 0xff;
native_trig = 0xff;
while (poll(&fds[0], 1, 0))
{
char buffer[0];
read(0,&buffer[0],1);

if (buffer[0] == 0x41) fprintf(stderr, "UP\n");
if (buffer[0] == 0x42) fprintf(stderr, "DOWN\n");
if (buffer[0] == 0x44) fprintf(stderr, "LEFT\n");
if (buffer[0] == 0x43) fprintf(stderr, "RIGHT\n");
if (buffer[0] == 0x20) fprintf(stderr, "FIRE\n");

// RLDU
if (buffer[0] == 0x41) native_porta=0xff&~(1<<0);
if (buffer[0] == 0x42) native_porta=0xff&~(1<<1);
if (buffer[0] == 0x44) native_porta=0xff&~(1<<2);
if (buffer[0] == 0x43) native_porta=0xff&~(1<<3);
if (buffer[0] == 0x20) native_trig=0xff&~1;

fds[0].fd = STDIN_FILENO;
fds[0].events = POLLIN;
}
}


(34-34/35)