[go: up one dir, main page]
Menu ▾ ▴

[ac6419]: / tools / jsset8.c  Maximize  Restore  History

Download this file

117 lines (111 with data), 3.0 kB 

  1
  2
  3
  4
  5
  6
  7
  8
  9
 10
 11
 12
 13
 14
 15
 16
 17
 18
 19
 20
 21
 22
 23
 24
 25
 26
 27
 28
 29
 30
 31
 32
 33
 34
 35
 36
 37
 38
 39
 40
 41
 42
 43
 44
 45
 46
 47
 48
 49
 50
 51
 52
 53
 54
 55
 56
 57
 58
 59
 60
 61
 62
 63
 64
 65
 66
 67
 68
 69
 70
 71
 72
 73
 74
 75
 76
 77
 78
 79
 80
 81
 82
 83
 84
 85
 86
 87
 88
 89
 90
 91
 92
 93
 94
 95
 96
 97
 98
 99
100
101
102
103
104
105
106
107
108
109
110
111
112
113
114
115
116
#include <unistd.h>

#include <fcntl.h>

#include <sys/ioctl.h>

#include <linux/joystick.h>

#include <stdio.h>

#include <stdlib.h>



void print_data(int aval[], int bval[], int axes, int btns) {

    int i;

    for (i=0; i<btns; i++) {

        printf("%2d |", bval[i]);

    }

    for (i=0; i<axes; i++) {

        printf(" %5d |", aval[i]);

    }

    printf("    \r");

    fflush(stdout);

}



void print_data_hdr(int aval[], int bval[], int axes, int btns) {

    int i;

    printf("js0: axes=%d, buttons=%d\n", axes, btns);

    for (i=0; i<btns; i++) {

        printf("b%02d|", i);

    }

    for (i=0; i<axes; i++) {

        printf("  a%02d  |", i, aval[i]);

    }

    printf("\n");

    for (i=0; i<btns; i++) {

        printf("____");

    }

    for (i=0; i<axes; i++) {

        printf("________");

    }

    printf("\n");

}



int main(int argc, char *argv[]) {

    int fd,i;

    int aval[256];

    int bval[256];

    int min[256];

    int max[256];

    int dmin[256];

    int dmax[256];

    int count=0;

    int nobutton=0;

    unsigned char axes, btns;

    struct js_event ev;

    struct js_corr cor[64];

    if (argc>=2)

        fd=open(argv[1], O_RDONLY|O_NONBLOCK);

    else

        fd=open("/dev/input/js0", O_RDONLY|O_NONBLOCK);

    if (fd<0) {    

        perror("Failed to open device");

        return 1;

    }

    ioctl(fd, JSIOCGAXES, &axes);

    ioctl(fd, JSIOCGBUTTONS, &btns);

    for (i=0; i<64; i++) {

        cor[i].type=JS_CORR_NONE;

        cor[i].coef[0]=128;

        cor[i].coef[1]=128;

        cor[i].coef[2]=65536*64;

        cor[i].coef[3]=65536*64;

        min[i]=max[i]=0;

    }

    ioctl(fd, JSIOCSCORR, cor);



    while (read(fd, &ev, sizeof(ev))==sizeof(ev)) {

        if (ev.type&JS_EVENT_BUTTON)

            bval[ev.number]=ev.value;

        if (ev.type&JS_EVENT_AXIS) {

            aval[ev.number]=ev.value;

            if (ev.value<min[ev.number])

                min[ev.number]=ev.value;    

            if (ev.value>max[ev.number])

                max[ev.number]=ev.value;    

        }

    }

    usleep(100000);

    count=0;

    while (count++<100) {

        while (read(fd, &ev, sizeof(ev))==sizeof(ev)) {

            if (ev.type&JS_EVENT_BUTTON)

                bval[ev.number]=ev.value;

            if (ev.type&JS_EVENT_AXIS) {

                aval[ev.number]=ev.value;

                if (ev.value<min[ev.number])

                    min[ev.number]=ev.value;    

                if (ev.value>max[ev.number])

                    max[ev.number]=ev.value;    

            }

        }

        usleep(10000);

    }



    for (i=0; i<axes; i++) {

        cor[i].type=JS_CORR_BROKEN;

        cor[i].coef[0]=0;

        cor[i].coef[1]=0;

        cor[i].coef[2]=255*16384/255;

        cor[i].coef[3]=255*16384/255;

        if ((min[i]==max[i])&&(max[i]==0)) {

            //assume a switching hat

            cor[i].coef[0]=0;

            cor[i].coef[1]=0;

            cor[i].coef[2]=1*16384/1;

            cor[i].coef[3]=1*16384/1;

        }

    }

    ioctl(fd, JSIOCSCORR, cor);

    return 0;

}