#define MAXAGE 100
struct entry {
- char addr[12];
- int bat;
- int tmp;
- int hum;
- int ticks;
- int rssi;
+ char addr[12];
+ int bat;
+ int tmp;
+ int hum;
+ int ticks;
+ int rssi;
};
struct elem {
- struct elem *next;
- int age;
- struct entry entry;
+ struct elem *next;
+ int age;
+ struct entry entry;
};
struct elem *head = NULL;
-void dbgEntry(struct entry *entry) {
- if (entry) {
- Serial.print(entry->addr);
- Serial.print(" Bat: ");
- Serial.print(entry->bat);
- Serial.print(" Temp: ");
- Serial.print(entry->tmp);
- Serial.print(" Hum: ");
- Serial.print(entry->hum);
- Serial.print(" Tm: ");
- Serial.print(entry->ticks);
- Serial.print(" Rssi: ");
- Serial.print(entry->rssi);
- } else {
- Serial.print("<NULL ENTRY>");
- }
+void dbgEntry(struct entry *entry)
+{
+ if (entry) {
+ Serial.print(entry->addr);
+ Serial.print(" Bat: ");
+ Serial.print(entry->bat);
+ Serial.print(" Temp: ");
+ Serial.print(entry->tmp);
+ Serial.print(" Hum: ");
+ Serial.print(entry->hum);
+ Serial.print(" Tm: ");
+ Serial.print(entry->ticks);
+ Serial.print(" Rssi: ");
+ Serial.print(entry->rssi);
+ } else {
+ Serial.print("<NULL ENTRY>");
+ }
}
-void dbgOp(int pos, String str1, struct entry* entry1,
- String str2, struct entry* entry2) {
- Serial.print("pos ");
- Serial.print(pos);
- Serial.print(" ");
- Serial.print(str1);
- Serial.print(" ");
- dbgEntry(entry1);
- if (str2) {
+void dbgOp(int pos, String str1, struct entry *entry1,
+ String str2, struct entry *entry2)
+{
+ Serial.print("pos ");
+ Serial.print(pos);
Serial.print(" ");
- Serial.print(str2);
+ Serial.print(str1);
Serial.print(" ");
- dbgEntry(entry2);
- }
- Serial.println();
+ dbgEntry(entry1);
+ if (str2) {
+ Serial.print(" ");
+ Serial.print(str2);
+ Serial.print(" ");
+ dbgEntry(entry2);
+ }
+ Serial.println();
}
-void display(int pos, entry *oldval, entry* newval) {
- if (!newval) return;
- tft.setViewport(pos * (tft.width() / 2) + 4, 4,
- tft.width() / 2 - 8, tft.height() - 8);
- tft.fillScreen(TFT_BLACK);
- tft.setCursor(0, 0, 4);
- tft.setTextColor(TFT_WHITE);
- tft.setTextSize(1);
- tft.println(newval->addr + 3);
- tft.setTextColor(TFT_RED);
- tft.setTextSize(2);
- tft.print(newval->tmp / 10);
- tft.print(".");
- tft.println(newval->tmp % 10);
- tft.setTextColor(TFT_BLUE);
- tft.print(newval->hum / 10);
- tft.print(".");
- tft.println(newval->hum % 10);
- // tft.setTextColor(TFT_GREEN);
- // tft.setTextSize(1);
- // tft.print(newval->bat / 100);
- // tft.print(".");
- // tft.print(newval->bat % 100);
- // tft.print(" ");
- // tft.println(newval->rssi);
- tft.resetViewport();
+void display(int pos, entry *oldval, entry *newval)
+{
+ if (!newval)
+ return;
+ tft.setViewport(pos * (tft.width() / 2) + 4, 4,
+ tft.width() / 2 - 8, tft.height() - 8);
+ tft.fillScreen(TFT_BLACK);
+ tft.setCursor(0, 0, 4);
+ tft.setTextColor(TFT_WHITE);
+ tft.setTextSize(1);
+ tft.println(newval->addr + 3);
+ tft.setTextColor(TFT_RED);
+ tft.setTextSize(2);
+ tft.print(newval->tmp / 10);
+ tft.print(".");
+ tft.println(newval->tmp % 10);
+ tft.setTextColor(TFT_BLUE);
+ tft.print(newval->hum / 10);
+ tft.print(".");
+ tft.println(newval->hum % 10);
+ // tft.setTextColor(TFT_GREEN);
+ // tft.setTextSize(1);
+ // tft.print(newval->bat / 100);
+ // tft.print(".");
+ // tft.print(newval->bat % 100);
+ // tft.print(" ");
+ // tft.println(newval->rssi);
+ tft.resetViewport();
}
-void updateCache(struct entry *newentry) {
- struct elem **cur_p = &head;
- struct elem *cur = *cur_p;
- struct elem *slots[SLOTS] = {NULL};
- struct elem *target = NULL;
- int pos = 0;
-
- while (true) {
- bool at_the_end = !cur;
- if (pos < SLOTS) slots[pos] = cur;
- // First handle insertion because it _can_ happen with cur == NULL
- if (at_the_end || cur->entry.rssi < newentry->rssi) {
- dbgOp(pos, "potentially insert", newentry,
- "before", cur ? &(cur->entry) : NULL);
- if (cur && strcmp(cur->entry.addr, newentry->addr) == 0) {
- dbgOp(pos, "update instead of insert", newentry,
- "replacing", &(cur->entry));
- target = cur;
- } else {
- if (target) {
- dbgOp(pos, "not inserting because update scheduled", newentry,
- "before", cur ? &(cur->entry) : NULL);
- } else {
- dbgOp(pos, "really insert", newentry,
- "before", cur ? &(cur->entry) : NULL);
- (*cur_p) = (struct elem*)malloc(sizeof(struct elem));
- (*cur_p)->next = cur;
- (*cur_p)->age = 0;
- (*cur_p)->entry = *newentry;
- }
- }
+void updateCache(struct entry *newentry)
+{
+ struct elem **cur_p = &head;
+ struct elem *cur = *cur_p;
+ struct elem *slots[SLOTS] = { NULL };
+ struct elem *target = NULL;
+ int pos = 0;
+
+ while (true) {
+ bool at_the_end = !cur;
+ if (pos < SLOTS)
+ slots[pos] = cur;
+ // First handle insertion because it _can_ happen with cur == NULL
+ if (at_the_end || cur->entry.rssi < newentry->rssi) {
+ dbgOp(pos, "potentially insert", newentry,
+ "before", cur ? &(cur->entry) : NULL);
+ if (cur && strcmp(cur->entry.addr, newentry->addr) == 0) {
+ dbgOp(pos, "update instead of insert", newentry,
+ "replacing", &(cur->entry));
+ target = cur;
+ } else {
+ if (target) {
+ dbgOp(pos, "not inserting because update scheduled",
+ newentry, "before", cur ? &(cur->entry) : NULL);
+ } else {
+ dbgOp(pos, "really insert", newentry,
+ "before", cur ? &(cur->entry) : NULL);
+ (*cur_p) = (struct elem *) malloc(sizeof(struct elem));
+ (*cur_p)->next = cur;
+ (*cur_p)->age = 0;
+ (*cur_p)->entry = *newentry;
+ }
+ }
+ }
+ if (at_the_end)
+ break;
+ // The rest of the operations in the loop assume that `cur` exists
+ (cur->age)++;
+ if (strcmp(cur->entry.addr, newentry->addr) == 0
+ || cur->age > MAXAGE) {
+ dbgOp(pos, "potentially delete", &(cur->entry), "", NULL);
+ if (target == cur) {
+ dbgOp(pos, "do not delete", &(cur->entry),
+ "scheduled for replacement by", newentry);
+ } else {
+ if (strcmp(cur->entry.addr, newentry->addr) == 0 &&
+ (!(cur->next)
+ || cur->next->entry.rssi < newentry->rssi)) {
+ dbgOp(pos, "update instead of delete", &(cur->entry),
+ "already at the insersion point for", newentry);
+ target = cur;
+ } else {
+ dbgOp(pos, "really delete", &(cur->entry), "", NULL);
+ (*cur_p) = cur->next;
+ free(cur);
+ cur = *cur_p;
+ if (pos < SLOTS)
+ slots[pos] = NULL;
+ pos--; // This may make it negative, but it will be bumped up next
+ }
+ }
+ }
+ // Proceed to the next element of the list
+ cur_p = &(cur->next);
+ cur = *cur_p;
+ pos++;
}
- if (at_the_end) break;
- // The rest of the operations in the loop assume that `cur` exists
- (cur->age)++;
- if (strcmp(cur->entry.addr, newentry->addr) == 0 || cur->age > MAXAGE) {
- dbgOp(pos, "potentially delete", &(cur->entry), "", NULL);
- if (target == cur) {
- dbgOp(pos, "do not delete", &(cur->entry),
- "scheduled for replacement by", newentry);
- } else {
- if (strcmp(cur->entry.addr, newentry->addr) == 0 &&
- (!(cur->next) || cur->next->entry.rssi < newentry->rssi)) {
- dbgOp(pos, "update instead of delete", &(cur->entry),
- "already at the insersion point for", newentry);
- target = cur;
- } else {
- dbgOp(pos, "really delete", &(cur->entry), "", NULL);
- (*cur_p) = cur->next;
- free(cur);
- cur = *cur_p;
- if (pos < SLOTS) slots[pos] = NULL;
- pos--; // This may make it negative, but it will be bumped up next
- }
- }
+ // Finished modifying the list, now display
+ for (cur = head, pos = 0; pos < SLOTS;
+ cur = cur ? cur->next : cur, pos++) {
+ if (target && (slots[pos] == target)) {
+ // old = slots[pos], new = nentry
+ dbgOp(pos, "Display before updating, old",
+ slots[pos] ? &(slots[pos]->entry) : NULL, "new",
+ newentry);
+ display(pos, slots[pos] ? &(slots[pos]->entry) : NULL,
+ newentry);
+ } else {
+ //old = slots[pos], new = cur
+ dbgOp(pos, "Display as different elems, old",
+ slots[pos] ? &(slots[pos]->entry) : NULL, "new",
+ cur ? &(cur->entry) : NULL);
+ display(pos, slots[pos] ? &(slots[pos]->entry) : NULL,
+ cur ? &(cur->entry) : NULL);
+ }
}
- // Proceed to the next element of the list
- cur_p = &(cur->next);
- cur = *cur_p;
- pos++;
- }
- // Finished modifying the list, now display
- for (cur = head, pos = 0; pos < SLOTS; cur = cur ? cur->next : cur, pos++) {
- if (target && (slots[pos] == target)) {
- // old = slots[pos], new = nentry
- dbgOp(pos, "Display before updating, old", slots[pos] ? &(slots[pos]->entry) : NULL,
- "new", newentry);
- display(pos, slots[pos] ? &(slots[pos]->entry) : NULL, newentry);
- } else {
- //old = slots[pos], new = cur
- dbgOp(pos, "Display as different elems, old", slots[pos] ? &(slots[pos]->entry) : NULL,
- "new", cur ? &(cur->entry) : NULL);
- display(pos, slots[pos] ? &(slots[pos]->entry) : NULL, cur ? &(cur->entry) : NULL);
+ // Now we can actually update the entry
+ if (target) {
+ target->entry = *newentry;
+ target->age = 0;
}
- }
- // Now we can actually update the entry
- if (target) {
- target->entry = *newentry;
- target->age = 0;
- }
}
-void dbgDevEv(BLEDevice peripheral) {
+void dbgDevEv(BLEDevice peripheral)
+{
#if 0
- Serial.print("Address: ");
- Serial.println(peripheral.address());
- Serial.print("RSSI: ");
- Serial.println(peripheral.rssi());
- if (peripheral.hasAdvertisementData()) {
- uint8_t buf[128];
- int m = peripheral.advertisementDataLength();
- peripheral.advertisementData(buf, m);
- Serial.print("ADV: ");
- for (int i = 0; i < m; i++)
- Serial.print(buf[i], HEX);
- Serial.println();
- }
- if (peripheral.hasManufacturerData()) {
- uint8_t buf[128];
- int m = peripheral.manufacturerDataLength();
- peripheral.manufacturerData(buf, m);
- Serial.print("MFR len: ");
- Serial.print(m);
- Serial.print(" data: ");
- for (int i = 0; i < m; i++) {
- Serial.print(buf[i] >> 4, HEX);
- Serial.print(buf[i] & 0x0f, HEX);
+ Serial.print("Address: ");
+ Serial.println(peripheral.address());
+ Serial.print("RSSI: ");
+ Serial.println(peripheral.rssi());
+ if (peripheral.hasAdvertisementData()) {
+ uint8_t buf[128];
+ int m = peripheral.advertisementDataLength();
+ peripheral.advertisementData(buf, m);
+ Serial.print("ADV: ");
+ for (int i = 0; i < m; i++)
+ Serial.print(buf[i], HEX);
+ Serial.println();
+ }
+ if (peripheral.hasManufacturerData()) {
+ uint8_t buf[128];
+ int m = peripheral.manufacturerDataLength();
+ peripheral.manufacturerData(buf, m);
+ Serial.print("MFR len: ");
+ Serial.print(m);
+ Serial.print(" data: ");
+ for (int i = 0; i < m; i++) {
+ Serial.print(buf[i] >> 4, HEX);
+ Serial.print(buf[i] & 0x0f, HEX);
+ }
+ Serial.println();
}
Serial.println();
- }
- Serial.println();
#endif
}
-void advHandler(BLEDevice dev) {
- if (dev.address().substring(0,6) == "a3:e4:") {
- dbgDevEv(dev);
- if (dev.hasManufacturerData()) {
- int len = dev.manufacturerDataLength();
- if (len == 20) {
- uint8_t buf[20];
- dev.manufacturerData(buf, len);
- struct entry newentry = {
- .bat = ((buf[11] << 8) + buf[10]) / 10,
- .tmp = ((buf[13] << 8) + buf[12]) * 10 / 16,
- .hum = ((buf[15] << 8) + buf[14]) * 10 / 16,
- .ticks = (buf[18] << 16) + (buf[17] << 8) + buf[16],
- .rssi = dev.rssi()
- };
- strncpy(newentry.addr, dev.address().substring(6).c_str(),
- sizeof(newentry.addr));
- newentry.addr[sizeof(newentry.addr) - 1] = '\0';
- updateCache(&newentry);
- }
+void advHandler(BLEDevice dev)
+{
+ if (dev.address().substring(0, 6) == "a3:e4:") {
+ dbgDevEv(dev);
+ if (dev.hasManufacturerData()) {
+ int len = dev.manufacturerDataLength();
+ if (len == 20) {
+ uint8_t buf[20];
+ dev.manufacturerData(buf, len);
+ struct entry newentry = {
+ .bat = ((buf[11] << 8) + buf[10]) / 10,
+ .tmp = ((buf[13] << 8) + buf[12]) * 10 / 16,
+ .hum = ((buf[15] << 8) + buf[14]) * 10 / 16,
+ .ticks = (buf[18] << 16) + (buf[17] << 8) + buf[16],
+ .rssi = dev.rssi()
+ };
+ strncpy(newentry.addr, dev.address().substring(6).c_str(),
+ sizeof(newentry.addr));
+ newentry.addr[sizeof(newentry.addr) - 1] = '\0';
+ updateCache(&newentry);
+ }
+ }
}
- }
}
-void setup() {
- Serial.begin(115200);
- while(!Serial);
- if (!BLE.begin()) {
- Serial.println("starting Bluetooth® Low Energy module failed!");
- while (1);
- }
+void setup()
+{
+ Serial.begin(115200);
+ while (!Serial);
+ if (!BLE.begin()) {
+ Serial.println("starting Bluetooth® Low Energy module failed!");
+ while (1);
+ }
- tft.init();
- tft.setRotation(1);
- tft.fillScreen(TFT_BLACK);
- tft.setViewport(0, 0, tft.width() / 2, tft.height());
- tft.frameViewport(TFT_NAVY, 1);
- tft.resetViewport();
- tft.setViewport(tft.width() / 2, 0, tft.width() / 2, tft.height());
- tft.frameViewport(TFT_NAVY, 1);
- tft.resetViewport();
+ tft.init();
+ tft.setRotation(1);
+ tft.fillScreen(TFT_BLACK);
+ tft.setViewport(0, 0, tft.width() / 2, tft.height());
+ tft.frameViewport(TFT_NAVY, 1);
+ tft.resetViewport();
+ tft.setViewport(tft.width() / 2, 0, tft.width() / 2, tft.height());
+ tft.frameViewport(TFT_NAVY, 1);
+ tft.resetViewport();
- BLE.setEventHandler(BLEDiscovered, advHandler);
- BLE.scan(true);
+ BLE.setEventHandler(BLEDiscovered, advHandler);
+ BLE.scan(true);
}
-void loop() {
- BLE.poll();
+void loop()
+{
+ BLE.poll();
}
projects / ThermoBeaconDisplay.git / commitdiff