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
|
#include <stdio.h>
#include <unistd.h>
#include <sys/timerfd.h>
#include "nfcommander.h"
#include "config.h"
#include "libyhy.h"
static int reader_fd = -1;
static int timer_fd = -1;
int init(){
char reader_version[100];
size_t poll_timeout = 1000;
struct itimerspec timer_cfg = {
0
};
if(config_get("nfc", "interval")){
poll_timeout = strtoul(config_get("nfc", "interval"), NULL, 10);
}
timer_cfg.it_value.tv_sec = timer_cfg.it_interval.tv_sec = poll_timeout / 1000;
timer_cfg.it_value.tv_nsec = timer_cfg.it_interval.tv_nsec = (poll_timeout % 1000) * 1e6;
char* port = config_get("nfc", "device");
if(!port){
printf("Please configure nfc.device to the reader serial port\n");
return 1;
}
//TODO set cloexec, nonblock
printf("Opening %s with polltime %lu\n", port, poll_timeout);
reader_fd = yhy_open(port);
if(reader_fd < 0){
printf("Failed to open reader connection at %s\n", port);
return 1;
}
if(yhy_sync_read_version(reader_fd, reader_version, sizeof(reader_version)) > 0){
printf("Connected YHY reader reports firmware: %s\n", reader_version);
}
//create timerfd
timer_fd = timerfd_create(CLOCK_MONOTONIC, TFD_CLOEXEC);
if(timer_fd < 0){
printf("Failed to create timer fd\n");
return 1;
}
if(timerfd_settime(timer_fd, 0, &timer_cfg, NULL)){
printf("Failed to set timer\n");
return 1;
}
core_manage_fd(reader_fd, 1, system_reader);
core_manage_fd(timer_fd, 1, system_reader);
return 0;
}
int handle(int fd){
uint8_t buffer[1024];
if(fd == timer_fd){
//acknowledge the timer
read(fd, buffer, sizeof(buffer));
//see if there is a tag
//TODO
return 0;
}
printf("Unknown FD in reader_yhy handler\n");
return 1;
}
static void __attribute__((destructor)) cleanup(){
core_manage_fd(reader_fd, 0, system_reader);
close(reader_fd);
reader_fd = -1;
core_manage_fd(timer_fd, 0, system_reader);
close(timer_fd);
timer_fd = -1;
}
|