first official prototype

2026-02-17 05:08:17 +00:00 · 2023-06-18 16:16:23 +01:00
parent 22a6aea330
commit 0a91deafd2
4 changed files with 151 additions and 120 deletions
--- a/spoofer.cpp
+++ b/spoofer.cpp
@@ -0,0 +1,79 @@
+#include "spoofer.h"
+
+Spoofer::Spoofer() {
+  // time things
+  memset(&clock_tm,0,sizeof(struct tm));
+  clock_tm.tm_hour  =  10;
+  clock_tm.tm_mday  =  16;
+  clock_tm.tm_mon   =  11;
+  clock_tm.tm_year  = 122;
+  tv.tv_sec =
+  time_2 = mktime(&clock_tm);
+  settimeofday(&tv,&utc);
+
+  // utm things
+  memset(&utm_parameters,0,sizeof(utm_parameters));
+  strcpy(utm_parameters.UAS_operator, getID().c_str());
+  // strcpy(utm_parameters.UAS_operator, "SUKONDEEZ");
+  utm_parameters.region      = 1;
+  utm_parameters.EU_category = 1;
+  utm_parameters.EU_class    = 5;
+  squitter.init(&utm_parameters);
+  memset(&utm_data,0,sizeof(utm_data));
+
+  // define location
+  //  52° 24' 24.4404" -1° 29' 36.564"W
+  lat_d = 
+  utm_data.latitude_d =
+  utm_data.base_latitude = 52.0 + (24.0 / 60.0) + (24.4404 / 3600.0);
+  long_d =
+  utm_data.longitude_d =
+  utm_data.base_longitude =  -1.0 - (29.0 / 60.0) - (36.564 / 3600.0);
+  utm_data.base_alt_m = 42.0;
+
+  utm_data.alt_msl_m = utm_data.base_alt_m + z;
+  utm_data.alt_agl_m = z;
+  utm_data.speed_kn = speed_kn;
+  utm_data.satellites = 8;
+  utm_data.base_valid = 1;
+
+  speed_m_x = ((float) speed_kn) * 0.514444 * 0.2; // Because we update every 200 ms.
+
+  utm_utils.calc_m_per_deg(lat_d,&m_deg_lat,&m_deg_long);
+
+  srand(micros());
+}
+
+void Spoofer::update() {
+  if ((millis() - last_update) < 200) {
+    return;
+  }
+
+  // randomly pick a direction to head and update the heading
+  float ranf = 0.001 * (float) (((int) rand() % 1000) - 500);
+  int dir_change = (int) (max_dir_change * ranf);
+  utm_data.heading = (utm_data.heading + dir_change + 360) % 360;
+
+  // calculate the new x, y
+  float rads = (deg2rad * (float) utm_data.heading);
+  x += speed_m_x * sin(rads);
+  y += speed_m_x * cos(rads);
+
+  // update the x, y
+  utm_data.latitude_d  = utm_data.base_latitude  + (y / m_deg_lat);
+  utm_data.longitude_d = utm_data.base_longitude + (x / m_deg_long);
+
+  // transmit things
+  squitter.transmit(&utm_data);
+  last_update = millis();
+}
+
+String Spoofer::getID() {
+  String characters = String("0123456789ABCDEFGHIJKLMNOPQRSTUVWXYZabcdefghijklmnopqrstuvwxyz");
+  String ID = "";
+  for (int i = 0; i < 16; i++)
+  {
+    ID.concat(characters[(rand() % characters.length())]);
+  }
+  return ID;
+}