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
|
#include "fifoqueue.h"
#include "broevent.h"
#ifdef BROCCOLI
#include <broccoli.h>
#endif
char *host_default = "127.0.0.1";
char *port_default = "47760";
Fifo_q * q;
static void
modbus_register_received(BroConn *conn, void *data, BroRecord *record)
{
int type = BRO_TYPE_COUNT;
uint64 *address = NULL;
uint64 *value = NULL;
// TODO: handle regtype
address = bro_record_get_named_val(record, "address", &type);
if (!address) {
// TODO: handle error
return;
}
value = bro_record_get_named_val(record, "register", &type);
if (!value) {
// TODO: handle error
return;
}
#ifdef DEBUG
printf("Received value %"PRIu64" from uid=%"PRIu64"\n",*value,*address);
#endif
add_to_queue(q, create_sensor_object(*value, *address));
#ifdef DEBUG
printf("Added to queue.\n");
#endif
}
void *
bro_event_listener(void * args)
{
q = (Fifo_q *) args;
int fd = -1;
BroConn *bc = NULL;
bro_init(NULL);
char hostname[512];
snprintf(hostname, 512, "%s:%s", host_default, port_default);
if (! (bc = bro_conn_new_str(hostname, BRO_CFLAG_RECONNECT | BRO_CFLAG_ALWAYS_QUEUE)))
{
printf("Could not get Bro connection handle.\n");
exit(-1);
}
bro_debug_calltrace = 0;
bro_debug_messages = 0;
bro_event_registry_add(bc, "pasad_register_received",
(BroEventFunc) modbus_register_received, NULL);
if (! bro_conn_connect(bc))
{
printf("Could not connect to Bro at %s:%s.\n", host_default,
port_default);
exit(-1);
}
fd =bro_conn_get_fd(bc);
fd_set rfds;
setbuf(stdout,NULL);
while(true)
{
FD_ZERO(&rfds);
FD_SET(fd,&rfds);
if(select(fd+1,&rfds,NULL,NULL,NULL) == -1){
printf("select(): Bad file descriptor");
break;
}
bro_conn_process_input(bc);
}
bro_conn_delete(bc);
}
|
