blob: c156e61a89e7f44f502deec30b3c11b645b4d42f (
plain)
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
|
#include "modemman.h"
#include "modem.h"
#define MAX_CHANNELS 10
#define TTY_START 11
struct llist {
struct modem *modem;
struct llist *next;
};
static struct llist *llist = NULL;
static int n_llist = 0;
int modem_manager_init(int channels) {
int i;
assert(channels <= MAX_CHANNELS && channels > 0);
assert(n_llist == 0);
for (i = TTY_START; i < TTY_START+MAX_CHANNLES && n_llist < channels; i++) {
char d[PATH_MAX];
struct modem *m;
snprintf(d, sizeof(d), "/dev/ttyI%i", i);
if (m = modem_open(d)) {
struct llist *l = malloc(sizeof(struct llist));
assert(l);
l->modem = m;
l->next = llist;
llist = l;
n_llist++;
}
}
if (n_llist < channels) {
daemon_log(LOG_ERR, "Failed to allocate the requested channels. Got %i of %i.", n_llist, channels);
modem_manager_done();
return -1;
}
return 0;
}
void modem_manager_done(void) {
while (llist) {
struct llist *l;
modem_close(l->modem);
l = llist;
llist = l->next;
free(l);
n_llist = 0;
}
assert(!n_llist && !llist);
}
|