Wio TerminalとSigfoxでWiFi位置情報推定

#include "rpcWiFi.h"
#include "TFT_eSPI.h"
#include

TFT_eSPI tft;

struct AP {
  String ssid = "";
  int rssi = INT_MIN;
  String mac = "";
};

void setup()
{
  Serial.begin(9600);
  Serial1.begin(9600);

  // Set WiFi to station mode and disconnect from an AP if it was previously connected
  WiFi.mode(WIFI_STA);
  WiFi.disconnect();
  delay(100);

  //for button A
  pinMode(WIO_KEY_C, INPUT_PULLUP);

  tft.begin();
  tft.setRotation(3);
  tft.fillScreen(TFT_BLACK);
  tft.setTextSize(2);
  debugDisplay("Setup Done");
  Serial1.print("AT$I=10\r");
}

void loop()
{
  displaySerial1();

  if (digitalRead(WIO_KEY_C) == LOW) {
    wifiScan();
  }
  delay(100);
}

void wifiScan()
{
  tft.fillScreen(TFT_BLACK);
  tft.setCursor(0,0);

  AP ap[2];   //RSSI上位2局のWiFi AP情報
  debugDisplay("Wifi Scan Start");

  // WiFi.scanNetworks will return the number of networks found
  int n = WiFi.scanNetworks();
  debugDisplay("Wifi Scan Done");
  if (n == 0) {
    debugDisplay("No Networks Found");
  } else {
    debugDisplay("Networks Found");

    for (int i = 0; i < n; ++i) {
      // Print SSID and RSSI for each network found
      Serial.print(i + 1); Serial.print(": ");
      Serial.print(WiFi.SSID(i)); Serial.print(" (");
      Serial.print(WiFi.RSSI(i)); Serial.print(") ");
      String mac = WiFi.BSSIDstr(i); Serial.println(mac);
      mac.replace(":", "");
      // Sigfoxメッセージとして送信するWiFi MACアドレスを最大2つに絞る
      filterAP(ap, WiFi.SSID(i), WiFi.RSSI(i), mac);
    }
  }

  String msg = "AT$SF=" + ap[0].mac + ap[1].mac; //Sigfoxメッセージ
  debugDisplay("Sigfox Send Message");
  debugDisplay(msg);
  Serial1.println(msg);

  delay(5000);
}

void filterAP(AP* ap, String ssid, int rssi, String mac) {
  if (filterMac(mac)) {
    if (ap[0].rssi < rssi) {
      ap[1] = ap[0];
      ap[0].ssid = ssid;
      ap[0].rssi = rssi;
      ap[0].mac = mac;
    } else if (ap[1].rssi < rssi) {
      ap[1].ssid = ssid;
      ap[1].rssi = rssi;
      ap[1].mac = mac;
    }
  }
}

bool filterMac(String mac) {
  bool pass = true;
  if (mac.length() != 12) pass = false;
  //リザーブMACアドレスならフィルタリング
  if (pass) {
    if (mac.equalsIgnoreCase("000000000000") || mac.equalsIgnoreCase("FFFFFFFFFFFF")) {
      pass = false;
    }
  }
  //マルチキャストMACアドレスならフィルタリング
  if (pass) {
    long LSBbit_1stOct = strtol(mac.substring(0,2).c_str(), NULL, 16);
    if (LSBbit_1stOct % 2 == 1) {
      pass = false;
    }
  }
  return pass;
}

void displaySerial1()
{
  if (Serial1.available()) {
    int w = Serial1.read();
    tft.print(char(w));
    Serial.write(w);
  }
}

void debugDisplay(String s)
{
  tft.println(s);
  Serial.println(s);
}