MeshCore/src/helpers/AdvertDataHelpers.cpp at 4f00d2ce3934917011cc3c3f92c982bd19e85536 · meshcore-dev/MeshCore · GitHub

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
#include <helpers/AdvertDataHelpers.h>

  uint8_t AdvertDataBuilder::encodeTo(uint8_t app_data[]) {
    app_data[0] = _type;
    int i = 1;
    if (_has_loc) {
      app_data[0] |= ADV_LATLON_MASK;
      memcpy(&app_data[i], &_lat, 4); i += 4;
      memcpy(&app_data[i], &_lon, 4); i += 4;
    }
    if (_caps) {
      app_data[0] |= ADV_CAPS_MASK;
      memcpy(&app_data[i], &_caps, 2); i += 2;
    }
    if (_extra2) {
      app_data[0] |= ADV_FEAT2_MASK;
      memcpy(&app_data[i], &_extra2, 2); i += 2;
    }
    if (_name && *_name != 0) {
      app_data[0] |= ADV_NAME_MASK;
      const char* sp = _name;
      while (*sp && i < MAX_ADVERT_DATA_SIZE) {
        app_data[i++] = *sp++;
      }
    }
    return i;
  }

  AdvertDataParser::AdvertDataParser(const uint8_t app_data[], uint8_t app_data_len) {
    _name[0] = 0;
    _lat = _lon = 0;
    _flags = app_data[0];
    _valid = false;
    _caps = _extra2 = 0;

    int i = 1;
    if (_flags & ADV_LATLON_MASK) {
      memcpy(&_lat, &app_data[i], 4); i += 4;
      memcpy(&_lon, &app_data[i], 4); i += 4;
    }
    if (_flags & ADV_CAPS_MASK) {
      memcpy(&_caps, &app_data[i], 2); i += 2;
    }
    if (_flags & ADV_FEAT2_MASK) {
      memcpy(&_extra2, &app_data[i], 2); i += 2;
    }

    if (app_data_len >= i) {
      int nlen = 0;
      if (_flags & ADV_NAME_MASK) {
        nlen = app_data_len - i;  // remainder of app_data
      }
      if (nlen > 0) {
        memcpy(_name, &app_data[i], nlen);
        _name[nlen] = 0;  // set null terminator
      }
      _valid = true;
    }
  }

#include <Arduino.h>

void AdvertTimeHelper::formatRelativeTimeDiff(char dest[], int32_t seconds_from_now, bool short_fmt) {
  const char *suffix;
  if (seconds_from_now < 0) {
    suffix = short_fmt ? "" : " ago";
    seconds_from_now = -seconds_from_now;
  } else {
    suffix = short_fmt ? "" : " from now";
  }

  if (seconds_from_now < 60) {
    sprintf(dest, "%d secs %s", seconds_from_now, suffix);
  } else {
    int32_t mins = seconds_from_now / 60;
    if (mins < 60) {
      sprintf(dest, "%d mins %s", mins, suffix);
    } else {
      int32_t hours = mins / 60;
      if (hours < 24) {
        sprintf(dest, "%d hours %s", hours, suffix);
      } else {
        sprintf(dest, "%d days %s", hours / 24, suffix);
      }
    }
  }
}