i_mouse.cpp
1.86 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
#include "blc_core.h"
#include "blc_channel.h"
#include "blc_program.h"
#include <unistd.h>
#include <termios.h>
#include <libgen.h> //basename
int main(int argc, char** argv){
char const *period_str, *text, *gain_str;
char const *channel_name, *filename, *time_str;
char const *number_str;
char *default_output;
int number, ret;
uint64_t executing_time, previous_executing_time;
size_t linecap=0;
ssize_t line_size;
blc_channel channel;
float gain;
int fd;
int period, read_chars_nb;
signed char data[3];
asprintf(&default_output, "/%s%d", basename(argv[0]), getpid());
blc_program_set_description("Read the movements of the mouse");
blc_program_add_option(&gain_str, 'g', "gain", "real", "Gain to multiply the values between [-128, 127]", "1");
blc_program_add_option(&channel_name, 'o', "output_channel", "string", "Name of the channel to output the data", default_output);
blc_program_add_option(&period_str, 'p', "period", "integer", "Period in µs to read the mouse", "0");
blc_program_init(&argc, &argv, blc_quit);
blc_command_forward_blc_channels();
SSCANF(1, gain_str, "%f", &gain);
SSCANF(1, period_str, "%d", &period);
SYSTEM_ERROR_CHECK(fd=open("/dev/input/mice", O_RDONLY | O_NONBLOCK), -1, "Opening mouse file");
channel.create_or_open(channel_name, BLC_CHANNEL_WRITE, 'FL32', 'NDEF', 1, 2);
blc_loop_try_add_posting_semaphore(channel.sem_new_data);
blc_loop_try_add_waiting_semaphore(channel.sem_ack_data);
channel.publish();
BLC_COMMAND_LOOP(period){
read_chars_nb=read(fd, data, sizeof(data));
if (read_chars_nb==-1){
CLEAR(data);
}
channel.floats[0]=data[1]*gain;
channel.floats[1]=data[2]*gain;
}
SYSTEM_ERROR_CHECK(close(fd), -1, "Closing ");
FREE(default_output);
return EXIT_SUCCESS;
}