thib8956/spacenav-driver
1
0
Fork 0
Code Issues Pull Requests Releases 1 Wiki Activity

Add spnav_sensitivity()

Browse Source
This commit is contained in:
Thibaud Gasser 2018-05-23 15:10:11 +02:00
parent 6454d27d6e
commit 39c8cec778
2 changed files with 18 additions and 6 deletions
Show Stats Download Patch File Download Diff File Expand all files Collapse all files

1
main.c
View File

@ -147,6 +147,7 @@ int main(int argc, char const *argv[])
*/ */
spnav_event ev; spnav_event ev;
spnav_open(); spnav_open();
spnav_sensitivity(0.1);
for (;;) { for (;;) {
spnav_wait_event_timeout(&ev, 400); spnav_wait_event_timeout(&ev, 400);

23
spnav.c
View File

@ -17,6 +17,8 @@ enum {
}; };
static bool IS_OPEN = false; static bool IS_OPEN = false;
/* Sensitivity is multiplied with every motion (1.0 normal). */
static double SPNAV_SENS = 1.0;
/* HID device for SpaceNavigator mouse */ /* HID device for SpaceNavigator mouse */
hid_device *device = NULL; hid_device *device = NULL;
@ -66,9 +68,9 @@ int read_event(hid_device *device, spnav_event* ev, int ms) {
return ev->type; return ev->type;
} }
ev->motion.type = 1; ev->motion.type = 1;
ev->motion.x = convert_input((buf[1] & 0x0000ff), buf[2]); ev->motion.x = (int) SPNAV_SENS * convert_input((buf[1] & 0x0000ff), buf[2]);
ev->motion.y = convert_input((buf[3] & 0x0000ff), buf[4]); ev->motion.y = (int) SPNAV_SENS * convert_input((buf[3] & 0x0000ff), buf[4]);
ev->motion.z = convert_input((buf[5] & 0x0000ff), buf[6]); ev->motion.z = (int) SPNAV_SENS * convert_input((buf[5] & 0x0000ff), buf[6]);
// DEBUG_PRINT("Translation x=%d, y=%d, z=%d\n", ev->motion.x, ev->motion.y, ev->motion.z); // DEBUG_PRINT("Translation x=%d, y=%d, z=%d\n", ev->motion.x, ev->motion.y, ev->motion.z);
break; break;
case ROTATION: case ROTATION:
@ -77,9 +79,9 @@ int read_event(hid_device *device, spnav_event* ev, int ms) {
return ev->type; return ev->type;
} }
ev->motion.type = 1; ev->motion.type = 1;
ev->motion.rx = convert_input((buf[1] & 0x0000ff), buf[2]); ev->motion.rx = (int) SPNAV_SENS * convert_input((buf[1] & 0x0000ff), buf[2]);
ev->motion.ry = convert_input((buf[3] & 0x0000ff), buf[4]); ev->motion.ry = (int) SPNAV_SENS * convert_input((buf[3] & 0x0000ff), buf[4]);
ev->motion.rz = convert_input((buf[5] & 0x0000ff), buf[6]); ev->motion.rz = (int) SPNAV_SENS * convert_input((buf[5] & 0x0000ff), buf[6]);
// DEBUG_PRINT("Rotation rx=%d, ry=%d, rz=%d\n", ev->motion.rx, ev->motion.ry, ev->motion.rz); // DEBUG_PRINT("Rotation rx=%d, ry=%d, rz=%d\n", ev->motion.rx, ev->motion.ry, ev->motion.rz);
break; break;
case BTN: case BTN:
@ -153,6 +155,15 @@ int spnav_wait_event_timeout(spnav_event *event, int milliseconds) {
} }
return read_event(device, event, milliseconds);; return read_event(device, event, milliseconds);;
} }
int spnav_sensitivity(double sens) {
if (sens < 1.0) {
DEBUG_PRINT("Invalid sensitivity value %f", sens);
return -1;
}
SPNAV_SENS = sens;
return 0;
}
/* /*
int spnav_wait_event(spnav_event *event); int spnav_wait_event(spnav_event *event);
int spnav_poll_event(spnav_event *event, int timeout); */ int spnav_poll_event(spnav_event *event, int timeout); */