summaryrefslogtreecommitdiff
path: root/src/libwpactrl/wpactrl_scan_parse.c
blob: ab4a9fe4b8839f54eb070b3ef787c6613bdf2cda (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
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 ;
}