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
87
88
89
90
91
92
93
94
95
96
97
98
99
100
101
102
103
104
|
/* ISC license. */
#include <string.h>
#include <stdint.h>
#include <errno.h>
#include <skalibs/uint16.h>
#include <skalibs/bytestr.h>
#include <skalibs/error.h>
#include <skalibs/fmtscan.h>
#include <skalibs/stralloc.h>
#include <skalibs/genalloc.h>
#include <bcnm/wpactrl.h>
static size_t bssid_scan (char const *s, char *bssid)
{
unsigned int i = 0 ;
char sep[6] = ":::::\t" ;
for (; i < 6 ; i++)
{
if (!ucharn_scan(s, bssid + i, 1)) goto eproto ;
if (s[2] != sep[i]) goto eproto ;
s += 3 ;
}
return 18 ;
eproto:
return (errno = EPROTO, 0) ;
}
static int flags_scan (char const *s, size_t len, stralloc *sa)
{
while (len)
{
size_t pos ;
if (*s++ != '[') goto eproto ;
len-- ;
pos = byte_chr(s, len, ']') ;
if (pos >= len || !pos) goto eproto ;
if (!stralloc_catb(sa, s, pos) || !stralloc_0(sa)) return 0 ;
s += pos + 1 ; len -= pos + 1 ;
}
return 1 ;
eproto:
return (errno = EPROTO, 0) ;
}
static int wpactrl_scan_parse_one (char const *s, size_t len, wpactrl_scanres_t *thing, stralloc *sa)
{
wpactrl_scanres_t sr ;
size_t pos = byte_chr(s, len, '\t') ;
if (pos >= len) goto eproto ;
if (pos != 18) goto eproto ;
if (bssid_scan(s, sr.bssid) != pos) goto eproto ;
s += pos + 1 ; len -= pos + 1 ;
pos = byte_chr(s, len, '\t') ;
if (pos >= len) goto eproto ;
if (uint16_scan(s, &sr.frequency) != pos) goto eproto ;
s += pos + 1 ; len -= pos + 1 ;
pos = byte_chr(s, len, '\t') ;
if (pos >= len) goto eproto ;
sr.flags_start = sa->len ;
if (!flags_scan(s, pos, sa)) goto eproto ;
s += pos + 1 ; len -= pos + 1 ;
sr.flags_len = sa->len - sr.flags_start ;
sr.ssid_start = sa->len ;
sr.ssid_len = len - 1 ;
if (!stralloc_catb(sa, s, len - 1) || !stralloc_0(sa)) return 0 ;
*thing = sr ;
return 1 ;
eproto:
return (errno = EPROTO, 0) ;
}
int wpactrl_scan_parse (char const *s, size_t len, genalloc *ga, stralloc *sa)
{
int sawasnull = !sa->s ;
int gawasnull = !genalloc_s(wpactrl_scanres_t, ga) ;
size_t sabase = sa->len ;
size_t gabase = genalloc_len(wpactrl_scanres_t, ga) ;
size_t start = byte_chr(s, len, '\n') ;
if (start++ >= len) return (errno = EPROTO, 0) ;
while (start < len)
{
size_t pos = byte_chr(s + start, len - start, '\n') ;
wpactrl_scanres_t thing ;
if (!wpactrl_scan_parse_one(s + start, pos, &thing, sa)) goto err ;
if (!genalloc_append(wpactrl_scanres_t, ga, &thing)) goto err ;
start += pos + 1 ;
}
return 1 ;
err:
{
int e = errno ;
if (gawasnull) genalloc_free(wpactrl_scanres_t, ga) ;
else genalloc_setlen(wpactrl_scanres_t, ga, gabase) ;
if (sawasnull) stralloc_free(sa) ;
else sa->len = sabase ;
errno = e ;
}
return 0 ;
}
|
