Blame view

RIOT/sys/net/gnrc/netif/gnrc_netif_addr_from_str.c 1.87 KB
a752c7ab   elopes   add first test an...
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
  /*
   * Copyright (C) 2015 Martine Lenders <mlenders@inf.fu-berlin.de>
   * Copyright (C) 2015 René Kijewski <rene.kijewski@fu-berlin.de>
   *
   * This file is subject to the terms and conditions of the GNU Lesser
   * General Public License v2.1. See the file LICENSE in the top level
   * directory for more details.
   */
  
  /**
   * @{
   *
   * @file
   */
  
  #include "net/gnrc/netif.h"
  
  static inline int _dehex(char c, int default_)
  {
      if ('0' <= c && c <= '9') {
          return c - '0';
      }
      else if ('A' <= c && c <= 'F') {
          return c - 'A' + 10;
      }
      else if ('a' <= c && c <= 'f') {
          return c - 'a' + 10;
      }
      else {
          return default_;
      }
  }
  
  size_t gnrc_netif_addr_from_str(uint8_t *out, size_t out_len, const char *str)
  {
      /* Walk over str from the end. */
      /* Take two chars a time as one hex value (%hhx). */
      /* Leading zeros can be omitted. */
      /* Every non-hexadimal character is a delimiter. */
      /* Leading, tailing and adjacent delimiters are forbidden. */
  
      const char *end_str = str;
      uint8_t *out_end = out;
      size_t count = 0;
      int assert_cell = 1;
  
      if (!str || !*str) {
          return 0;
      }
      while (end_str[1]) {
          ++end_str;
      }
  
      while (end_str >= str) {
          int a = 0, b = _dehex(*end_str--, -1);
          if (b < 0) {
              if (assert_cell) {
                  return 0;
              }
              else {
                  assert_cell = 1;
                  continue;
              }
          }
          assert_cell = 0;
  
          if (end_str >= str) {
              a = _dehex(*end_str--, 0);
          }
  
          if (++count > out_len) {
              return 0;
          }
          *out_end++ = (a << 4) | b;
      }
      if (assert_cell) {
          return 0;
      }
      /* out is reversed */
  
      while (out < --out_end) {
          uint8_t tmp = *out_end;
          *out_end = *out;
          *out++ = tmp;
      }
  
      return count;
  }
  
  /** @} */