repo2/firmware_legacy/test_joy.c
| 46 | markw | #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;
|
|||
}
|
|||
}
|
|||