45 lines
1009 B
C
45 lines
1009 B
C
#include <stdio.h>
|
|
#include <stdlib.h>
|
|
|
|
#define MAX_STR 255
|
|
#define SPNAV_VENDOR_ID 0x046d
|
|
#define SPNAV_PRODUCT_ID 0xc626
|
|
|
|
#include <signal.h>
|
|
#include <stdbool.h>
|
|
#include "spnav.h"
|
|
|
|
static bool INTERRUPTED = false;
|
|
|
|
void sighandler(int signo) {
|
|
if (signo == SIGINT) {
|
|
INTERRUPTED = true;
|
|
}
|
|
}
|
|
|
|
int main(int argc, char const* argv[]) {
|
|
signal(SIGINT, sighandler);
|
|
spnav_event ev;
|
|
spnav_open();
|
|
spnav_sensitivity(0.1);
|
|
spnav_deadzone(10);
|
|
for (;;) {
|
|
spnav_wait_event_timeout(&ev, 400);
|
|
|
|
switch (ev.type) {
|
|
case MOTION:
|
|
printf("x=%d, y=%d, z=%d ", ev.motion.x, ev.motion.y, ev.motion.z);
|
|
printf("rx=%d, ry=%d, rz=%d\n", ev.motion.rx, ev.motion.ry, ev.motion.rz);
|
|
break;
|
|
case BUTTON:
|
|
printf("bnum=%d, pressed=%d\n", ev.button.bnum, ev.button.press);
|
|
break;
|
|
}
|
|
|
|
if (INTERRUPTED) {
|
|
break;
|
|
}
|
|
}
|
|
spnav_close();
|
|
}
|