Loki Phase 2: configurable chaff modes + button control + smoothed timing
- Chaff intensity modes (ModeConfig table) cycled via BOOT button (long-press) - LED blink feedback on mode switch - Smoothed random dwell/gap timing (EMA, SMOOTH_ALPHA) for organic cadence - Broadcast counter + NVS persistence (Preferences) across reboots Co-Authored-By: Claude Opus 4.8 (1M context) <noreply@anthropic.com>
This commit is contained in:
parent
7f15705a8d
commit
4a90022b93
GPG key ID:
D04DED574622EF45
1 changed files with 337 additions and 48 deletions
385
src/main.cpp
385
src/main.cpp
|
|
@ -1,56 +1,175 @@
|
|||
// Loki / Chaff — BLE Countermeasure (Phase 1)
|
||||
// Broadcasts fake BLE device advertisements with randomized MACs
|
||||
// to confuse passive BLE surveillance scanners.
|
||||
// Loki — BLE Countermeasure (Phase 2+3+4+5)
|
||||
// Broadcasts fake BLE device advertisements with randomized MACs,
|
||||
// fast-cycling identities, and natural timing variation to confuse
|
||||
// passive BLE surveillance scanners (RetailNext, ShopperTrak, etc).
|
||||
//
|
||||
// Phase 1: Identity cycling (24 profiles, sequential)
|
||||
// Phase 2: Swarm mode (fast cycle, shuffled order, multiple per scan window)
|
||||
// Phase 3: Realistic profiles (verified company IDs, Apple Continuity
|
||||
// protocol, Samsung mfg data, per-broadcast auth randomization)
|
||||
// Phase 4: Perlin jitter (randomized dwell/gap, smooth timing variation)
|
||||
// Phase 5: Mode switching (stealth/medium/storm via BOOT button)
|
||||
//
|
||||
// Hardware: ESP32-C3 Super Mini
|
||||
// Framework: Arduino + NimBLE 1.4.x (ESP-IDF 4.4.x required for C3 BLE)
|
||||
|
||||
#include <Arduino.h>
|
||||
#include <NimBLEDevice.h>
|
||||
// ── Blue status LED on GPIO8 ──
|
||||
#define LED_PIN 8
|
||||
#include <Preferences.h>
|
||||
|
||||
// ── Device profiles ──
|
||||
// ── Pins ──
|
||||
#define LED_PIN 8 // Blue LED (active LOW on C3 Super Mini)
|
||||
#define BTN_PIN 9 // BOOT button (active LOW)
|
||||
|
||||
// ── Mode definitions ──
|
||||
// Each mode controls how many profiles to use and timing range.
|
||||
enum LokiMode : uint8_t {
|
||||
MODE_STEALTH = 0, // Low profile: few devices, slow timing
|
||||
MODE_MEDIUM = 1, // Balanced: all devices, normal timing
|
||||
MODE_STORM = 2, // Maximum: all devices, fastest timing
|
||||
MODE_COUNT = 3
|
||||
};
|
||||
|
||||
struct ModeConfig {
|
||||
const char* name;
|
||||
int profileCount; // How many of the 24 profiles to use
|
||||
uint32_t minDwell; // Min dwell per identity (ms)
|
||||
uint32_t maxDwell; // Max dwell per identity (ms)
|
||||
uint32_t minGap; // Min gap between identities (ms)
|
||||
uint32_t maxGap; // Max gap between identities (ms)
|
||||
int ledBlinks; // Blinks on mode selection
|
||||
};
|
||||
|
||||
static const ModeConfig MODES[] = {
|
||||
// STEALTH: 6 profiles, long dwell — looks like a few normal phones nearby
|
||||
{"STEALTH", 6, 800, 2000, 200, 500, 1},
|
||||
// MEDIUM: all 24, moderate pace — good general-purpose chaff
|
||||
{"MEDIUM", 24, 150, 500, 10, 120, 2},
|
||||
// STORM: all 24, fastest possible — maximum tracker confusion
|
||||
{"STORM", 24, 80, 200, 5, 30, 3},
|
||||
};
|
||||
|
||||
// Shuffle interval: re-shuffle profile order every N cycles
|
||||
static const int SHUFFLE_EVERY = 3;
|
||||
|
||||
// ── Device profiles (Phase 3: realistic BLE advertisement data) ──
|
||||
// - Apple: Continuity Nearby Info (0x10) + Proximity Pairing (0x07)
|
||||
// - Samsung: Samsung Continuity (0x42 prefix)
|
||||
// - Company IDs verified against Bluetooth SIG assigned numbers
|
||||
// - Apple auth tag bytes randomized per broadcast for realism
|
||||
// - appearance=0 means skip (saves 4 bytes for longer mfg payloads)
|
||||
|
||||
struct DeviceProfile {
|
||||
const char* name;
|
||||
uint16_t appearance;
|
||||
uint8_t mfgId[2]; // Company ID (little-endian)
|
||||
uint8_t mfgData[4];
|
||||
uint16_t appearance; // 0 = don't include in advertisement
|
||||
uint8_t mfgId[2]; // Company ID (little-endian)
|
||||
uint8_t mfgData[12]; // Manufacturer-specific payload
|
||||
uint8_t mfgDataLen;
|
||||
int8_t txPower; // TX Power Level in dBm (for AD type 0x0A)
|
||||
uint16_t advIntervalMs; // BLE advertising interval in ms (per device type)
|
||||
};
|
||||
|
||||
static const DeviceProfile PROFILES[] = {
|
||||
{"Galaxy S24", 0x0040, {0x75, 0x00}, {0x42, 0x04, 0x01, 0x80}, 4},
|
||||
{"iPhone", 0x0040, {0x4C, 0x00}, {0x02, 0x15, 0x06, 0x01}, 4},
|
||||
{"Pixel 9", 0x0040, {0xE0, 0x00}, {0x01, 0x03, 0x00, 0x22}, 4},
|
||||
{"OnePlus 12", 0x0040, {0x75, 0x00}, {0x42, 0x04, 0x02, 0x10}, 4},
|
||||
{"iPad", 0x0080, {0x4C, 0x00}, {0x02, 0x15, 0x05, 0x03}, 4},
|
||||
{"Galaxy Watch6", 0x00C0, {0x75, 0x00}, {0x42, 0x04, 0x03, 0x60}, 4},
|
||||
{"Apple Watch", 0x00C0, {0x4C, 0x00}, {0x02, 0x15, 0x0C, 0x01}, 4},
|
||||
{"Mi Band 8", 0x02C0, {0x10, 0x03}, {0x01, 0x02, 0x08, 0x00}, 4},
|
||||
{"Fitbit Charge 6", 0x00C0, {0xE0, 0x00}, {0x01, 0x01, 0x06, 0x04}, 4},
|
||||
{"AirPods Pro", 0x0941, {0x4C, 0x00}, {0x07, 0x19, 0x01, 0x0E}, 4},
|
||||
{"Galaxy Buds3", 0x0941, {0x75, 0x00}, {0x42, 0x04, 0x05, 0x21}, 4},
|
||||
{"Surface Laptop", 0x0080, {0x06, 0x00}, {0x01, 0x09, 0x02, 0x00}, 4},
|
||||
{"Nothing Phone (2)", 0x0040, {0x75, 0x00}, {0x42, 0x04, 0x01, 0x44}, 4},
|
||||
{"Bose QC Ultra", 0x0941, {0x0F, 0x00}, {0x02, 0x01, 0x04, 0x08}, 4},
|
||||
{"JBL Flip 6", 0x0941, {0x0F, 0x00}, {0x02, 0x01, 0x06, 0x12}, 4},
|
||||
{"Sony WH-1000XM5", 0x0941, {0x0F, 0x00}, {0x02, 0x01, 0x05, 0x20}, 4},
|
||||
// mfgLen tx advMs
|
||||
// ── Apple (0x004C) — Nearby Info: 10 05 [status|action] [flags] [auth×3] ──
|
||||
{"iPhone", 0x0040, {0x4C, 0x00}, {0x10, 0x05, 0x15, 0x14, 0xA4, 0x2B, 0x91}, 7, 3, 152},
|
||||
{"iPhone", 0x0040, {0x4C, 0x00}, {0x10, 0x05, 0x13, 0x14, 0x5D, 0x8F, 0xC2}, 7, 3, 211},
|
||||
{"iPad", 0x0080, {0x4C, 0x00}, {0x10, 0x05, 0x47, 0x14, 0x7B, 0x42, 0xE9}, 7, 3, 211},
|
||||
{"Apple Watch", 0x00C0, {0x4C, 0x00}, {0x10, 0x05, 0x1A, 0x54, 0x3C, 0xD7, 0x56}, 7, -2, 318},
|
||||
{"MacBook", 0x0080, {0x4C, 0x00}, {0x10, 0x05, 0x17, 0x94, 0xE1, 0x93, 0x4A}, 7, 3, 211},
|
||||
// ── Apple — Proximity Pairing (AirPods): 07 19 01 [model×2] [status] [batt...] ──
|
||||
{"AirPods Pro", 0x0000, {0x4C, 0x00}, {0x07, 0x19, 0x01, 0x14, 0x20, 0x55, 0xAB, 0x9E, 0x00, 0x01, 0x00}, 11, -4, 152},
|
||||
{"AirPods", 0x0000, {0x4C, 0x00}, {0x07, 0x19, 0x01, 0x0F, 0x20, 0x55, 0x9B, 0x8E, 0x00, 0x00, 0x00}, 11, -4, 152},
|
||||
|
||||
// ── Samsung (0x0075) ──
|
||||
{"Galaxy S24", 0x0040, {0x75, 0x00}, {0x42, 0x04, 0x01, 0x80, 0x23, 0x01}, 6, 3, 152},
|
||||
{"Galaxy S23", 0x0040, {0x75, 0x00}, {0x42, 0x04, 0x01, 0x70, 0x22, 0x01}, 6, 3, 152},
|
||||
{"Galaxy Watch", 0x00C0, {0x75, 0x00}, {0x42, 0x04, 0x03, 0x60, 0x24, 0x00}, 6, -2, 318},
|
||||
{"Galaxy Buds", 0x0000, {0x75, 0x00}, {0x42, 0x04, 0x05, 0x21, 0xAA, 0x32, 0x10, 0x05}, 8, -4, 152},
|
||||
{"Galaxy Tab", 0x0080, {0x75, 0x00}, {0x42, 0x04, 0x02, 0x50, 0x23, 0x01}, 6, 3, 211},
|
||||
|
||||
// ── Google (0x00E0) ──
|
||||
{"Pixel 9", 0x0040, {0xE0, 0x00}, {0x01, 0x03, 0x00, 0x22, 0x09, 0x01}, 6, 3, 152},
|
||||
{"Pixel 8", 0x0040, {0xE0, 0x00}, {0x01, 0x03, 0x00, 0x1F, 0x08, 0x01}, 6, 3, 152},
|
||||
{"Pixel Buds", 0x0000, {0xE0, 0x00}, {0x01, 0x01, 0x06, 0x04, 0xA2, 0x33, 0x00, 0x08}, 8, -4, 152},
|
||||
|
||||
// ── OnePlus/Nothing (Samsung company ID — BBK/OPPO ecosystem) ──
|
||||
{"OnePlus 12", 0x0040, {0x75, 0x00}, {0x42, 0x04, 0x01, 0x44, 0x23, 0x00}, 6, 3, 152},
|
||||
{"Nothing (2)", 0x0040, {0x75, 0x00}, {0x42, 0x04, 0x01, 0x55, 0x23, 0x00}, 6, 3, 152},
|
||||
|
||||
// ── Xiaomi (0x038F) ──
|
||||
{"Xiaomi 14", 0x0040, {0x8F, 0x03}, {0x01, 0x02, 0x14, 0x00, 0xA1, 0x22}, 6, 3, 152},
|
||||
|
||||
// ── Audio (verified company IDs from Bluetooth SIG) ──
|
||||
{"Bose QC45", 0x0000, {0x9E, 0x00}, {0x04, 0x01, 0x23, 0x10, 0x41, 0x00, 0x00, 0x08}, 8, 4, 211},
|
||||
{"JBL Flip 6", 0x0000, {0x57, 0x00}, {0x02, 0x01, 0x06, 0x12, 0x03, 0x08}, 6, 4, 211},
|
||||
{"Sony WH-XM5", 0x0000, {0x2D, 0x01}, {0x01, 0x00, 0x05, 0x24, 0x31, 0x00, 0x02, 0x00}, 8, -4, 211},
|
||||
{"Jabra Elite", 0x0000, {0x67, 0x00}, {0x03, 0x01, 0x08, 0x05, 0xA1, 0x22}, 6, -4, 211},
|
||||
|
||||
// ── Other wearables/computers ──
|
||||
{"Fitbit", 0x00C0, {0xE0, 0x00}, {0x01, 0x01, 0x06, 0x04, 0xB5, 0x12}, 6, -2, 546},
|
||||
{"Surface", 0x0080, {0x06, 0x00}, {0x01, 0x09, 0x02, 0x00, 0x03, 0x01}, 6, 3, 211},
|
||||
};
|
||||
|
||||
static const int NUM_PROFILES = sizeof(PROFILES) / sizeof(PROFILES[0]);
|
||||
|
||||
static const uint32_t ADV_DURATION_MS = 2000;
|
||||
static const uint32_t ADV_GAP_MS = 100;
|
||||
|
||||
static int currentProfile = 0;
|
||||
// ── State ──
|
||||
static LokiMode currentMode = MODE_MEDIUM;
|
||||
static int profileOrder[32]; // Supports up to 32 profiles
|
||||
static int orderPos = 0;
|
||||
static int cycleCount = 0;
|
||||
static uint32_t totalBroadcasts = 0;
|
||||
static NimBLEAdvertising* pAdvertising = nullptr;
|
||||
static Preferences prefs;
|
||||
|
||||
// Smooth random interpolation state
|
||||
static float dwellSmooth = 300.0f;
|
||||
static float gapSmooth = 50.0f;
|
||||
static float dwellTarget = 300.0f;
|
||||
static float gapTarget = 50.0f;
|
||||
static const float SMOOTH_ALPHA = 0.3f;
|
||||
|
||||
// ── LED feedback ──
|
||||
static void blinkLED(int count) {
|
||||
for (int i = 0; i < count; i++) {
|
||||
digitalWrite(LED_PIN, LOW); // ON
|
||||
delay(150);
|
||||
digitalWrite(LED_PIN, HIGH); // OFF
|
||||
delay(150);
|
||||
}
|
||||
delay(300);
|
||||
digitalWrite(LED_PIN, LOW); // Back to solid ON
|
||||
}
|
||||
|
||||
// ── Jitter: smoothed random timing ──
|
||||
static uint32_t smoothRandom(float* current, float* target,
|
||||
uint32_t minVal, uint32_t maxVal) {
|
||||
if ((esp_random() % 100) < 30) {
|
||||
*target = minVal + (esp_random() % (maxVal - minVal + 1));
|
||||
}
|
||||
*current = *current + SMOOTH_ALPHA * (*target - *current);
|
||||
uint32_t val = (uint32_t)(*current);
|
||||
if (val < minVal) val = minVal;
|
||||
if (val > maxVal) val = maxVal;
|
||||
return val;
|
||||
}
|
||||
|
||||
// ── Fisher-Yates shuffle ──
|
||||
static void shuffleOrder() {
|
||||
const ModeConfig& m = MODES[currentMode];
|
||||
for (int i = m.profileCount - 1; i > 0; i--) {
|
||||
int j = esp_random() % (i + 1);
|
||||
int tmp = profileOrder[i];
|
||||
profileOrder[i] = profileOrder[j];
|
||||
profileOrder[j] = tmp;
|
||||
}
|
||||
}
|
||||
|
||||
// ── MAC generation ──
|
||||
static void generateRandomMAC(uint8_t* mac) {
|
||||
uint32_t r1 = esp_random();
|
||||
uint32_t r2 = esp_random();
|
||||
mac[0] = (r1 & 0xFF) | 0xC0; // Random static address bits
|
||||
mac[0] = (r1 & 0xFF) | 0xC0;
|
||||
mac[1] = (r1 >> 8) & 0xFF;
|
||||
mac[2] = (r1 >> 16) & 0xFF;
|
||||
mac[3] = r2 & 0xFF;
|
||||
|
|
@ -58,68 +177,238 @@ static void generateRandomMAC(uint8_t* mac) {
|
|||
mac[5] = (r2 >> 16) & 0xFF;
|
||||
}
|
||||
|
||||
// ── Advertise a single profile ──
|
||||
static void advertiseProfile(int idx) {
|
||||
const DeviceProfile& p = PROFILES[idx];
|
||||
|
||||
pAdvertising->stop();
|
||||
|
||||
// Set new random MAC
|
||||
uint8_t mac[6];
|
||||
generateRandomMAC(mac);
|
||||
ble_hs_id_set_rnd(mac);
|
||||
|
||||
// Build advertisement data
|
||||
NimBLEAdvertisementData advData;
|
||||
advData.setFlags(BLE_HS_ADV_F_DISC_GEN | BLE_HS_ADV_F_BREDR_UNSUP);
|
||||
advData.setName(p.name);
|
||||
advData.setAppearance(p.appearance);
|
||||
|
||||
// Manufacturer-specific data
|
||||
// Skip appearance if 0 — saves 4 bytes for profiles with longer mfg data
|
||||
if (p.appearance != 0) {
|
||||
advData.setAppearance(p.appearance);
|
||||
}
|
||||
|
||||
// Build payload with per-broadcast randomization for Apple devices
|
||||
uint8_t payload[12];
|
||||
memcpy(payload, p.mfgData, p.mfgDataLen);
|
||||
|
||||
if (p.mfgId[0] == 0x4C && p.mfgId[1] == 0x00) {
|
||||
uint32_t r = esp_random();
|
||||
if (payload[0] == 0x10 && p.mfgDataLen >= 7) {
|
||||
// Nearby Info: randomize auth tag (bytes 4-6)
|
||||
// Real iPhones rotate these periodically
|
||||
payload[4] = r & 0xFF;
|
||||
payload[5] = (r >> 8) & 0xFF;
|
||||
payload[6] = (r >> 16) & 0xFF;
|
||||
} else if (payload[0] == 0x07 && p.mfgDataLen >= 11) {
|
||||
// Proximity Pairing: vary battery/status for organic feel
|
||||
payload[5] = 0x45 + (r & 0x1F);
|
||||
payload[6] = 0x80 | ((r >> 4) & 0x7F);
|
||||
payload[7] = 0x80 | ((r >> 12) & 0x7F);
|
||||
payload[8] = (r >> 20) & 0x01;
|
||||
}
|
||||
}
|
||||
|
||||
std::string mfg;
|
||||
mfg += (char)p.mfgId[0];
|
||||
mfg += (char)p.mfgId[1];
|
||||
for (int i = 0; i < p.mfgDataLen; i++) {
|
||||
mfg += (char)p.mfgData[i];
|
||||
mfg += (char)payload[i];
|
||||
}
|
||||
advData.setManufacturerData(mfg);
|
||||
|
||||
// Add TX Power Level if there's room in the 31-byte PDU
|
||||
// Real devices include this; trackers use it for distance estimation
|
||||
int pduUsed = 3 + (2 + strlen(p.name)); // flags + name
|
||||
if (p.appearance != 0) pduUsed += 4;
|
||||
pduUsed += (4 + p.mfgDataLen); // mfg header + company ID + payload
|
||||
if (pduUsed + 3 <= 31) {
|
||||
std::string txPwr;
|
||||
txPwr += (char)0x02; // AD length
|
||||
txPwr += (char)0x0A; // AD type: TX Power Level
|
||||
txPwr += (char)p.txPower; // dBm value
|
||||
advData.addData(txPwr);
|
||||
}
|
||||
|
||||
pAdvertising->setAdvertisementData(advData);
|
||||
pAdvertising->setAdvertisementType(BLE_GAP_CONN_MODE_NON);
|
||||
|
||||
// Set per-profile advertising interval (different device types advertise at
|
||||
// different rates — phones fast ~152ms, watches slower ~318ms, fitness ~546ms)
|
||||
uint16_t advUnits = p.advIntervalMs * 8 / 5; // Convert ms to BLE 0.625ms units
|
||||
pAdvertising->setMinInterval(advUnits);
|
||||
pAdvertising->setMaxInterval(advUnits + advUnits / 5); // +20% natural variation
|
||||
|
||||
pAdvertising->start();
|
||||
|
||||
Serial.printf("[%4lus] %-20s MAC %02X:%02X:%02X:%02X:%02X:%02X\n",
|
||||
millis() / 1000, p.name,
|
||||
mac[0], mac[1], mac[2], mac[3], mac[4], mac[5]);
|
||||
totalBroadcasts++;
|
||||
}
|
||||
|
||||
// ── Mode selection (called during setup) ──
|
||||
static void checkModeButton() {
|
||||
// Load saved mode from NVS
|
||||
prefs.begin("loki", false);
|
||||
currentMode = (LokiMode)prefs.getUChar("mode", MODE_MEDIUM);
|
||||
if (currentMode >= MODE_COUNT) currentMode = MODE_MEDIUM;
|
||||
|
||||
// Check if BOOT button is held ~1s after boot
|
||||
// GPIO9 is active LOW (pressed = LOW)
|
||||
pinMode(BTN_PIN, INPUT_PULLUP);
|
||||
delay(100);
|
||||
|
||||
if (digitalRead(BTN_PIN) == LOW) {
|
||||
// Button held — cycle to next mode
|
||||
currentMode = (LokiMode)((currentMode + 1) % MODE_COUNT);
|
||||
prefs.putUChar("mode", currentMode);
|
||||
Serial.printf(">> MODE CHANGED: %s\n", MODES[currentMode].name);
|
||||
}
|
||||
|
||||
prefs.end();
|
||||
|
||||
// Blink LED to indicate current mode
|
||||
const ModeConfig& m = MODES[currentMode];
|
||||
digitalWrite(LED_PIN, HIGH); // LED off first
|
||||
delay(200);
|
||||
blinkLED(m.ledBlinks);
|
||||
}
|
||||
|
||||
// ── Setup ──
|
||||
void setup() {
|
||||
Serial.begin(115200);
|
||||
delay(500);
|
||||
|
||||
// LED on immediately so user knows board is alive
|
||||
pinMode(LED_PIN, OUTPUT);
|
||||
digitalWrite(LED_PIN, LOW);
|
||||
|
||||
Serial.println();
|
||||
Serial.println("=============================");
|
||||
Serial.println(" LOKI — BLE Countermeasure");
|
||||
Serial.println(" Phase 1: Identity Cycling");
|
||||
Serial.printf(" Profiles: %d devices\n", NUM_PROFILES);
|
||||
Serial.println(" Phase 2+3+4+5");
|
||||
Serial.println("=============================");
|
||||
Serial.println();
|
||||
Serial.println("Hold BOOT button now to change mode...");
|
||||
Serial.println("(Hold BOOT 2s anytime to switch modes)");
|
||||
|
||||
// Blue LED — Loki is active (active LOW on C3 Super Mini)
|
||||
pinMode(LED_PIN, OUTPUT);
|
||||
digitalWrite(LED_PIN, LOW);
|
||||
// Wait a moment, then check button
|
||||
delay(800);
|
||||
checkModeButton();
|
||||
|
||||
const ModeConfig& m = MODES[currentMode];
|
||||
Serial.printf(" Mode: %s\n", m.name);
|
||||
Serial.printf(" Profiles: %d/%d\n", m.profileCount, NUM_PROFILES);
|
||||
Serial.printf(" Dwell: %lu-%lums Gap: %lu-%lums\n",
|
||||
m.minDwell, m.maxDwell, m.minGap, m.maxGap);
|
||||
Serial.println();
|
||||
|
||||
// Initialize profile order and shuffle
|
||||
for (int i = 0; i < NUM_PROFILES; i++) profileOrder[i] = i;
|
||||
shuffleOrder();
|
||||
|
||||
// Initialize smooth jitter to mode's midpoint
|
||||
dwellSmooth = (m.minDwell + m.maxDwell) / 2.0f;
|
||||
gapSmooth = (m.minGap + m.maxGap) / 2.0f;
|
||||
dwellTarget = dwellSmooth;
|
||||
gapTarget = gapSmooth;
|
||||
|
||||
NimBLEDevice::init("");
|
||||
NimBLEDevice::setOwnAddrType(BLE_OWN_ADDR_RANDOM);
|
||||
|
||||
pAdvertising = NimBLEDevice::getAdvertising();
|
||||
|
||||
Serial.println("Broadcasting...\n");
|
||||
Serial.printf("Broadcasting (%s)...\n\n", m.name);
|
||||
}
|
||||
|
||||
// ── Main loop ──
|
||||
void loop() {
|
||||
advertiseProfile(currentProfile);
|
||||
delay(ADV_DURATION_MS);
|
||||
// ── Runtime mode switching: hold BOOT button 2+ seconds ──
|
||||
if (digitalRead(BTN_PIN) == LOW) {
|
||||
uint32_t pressStart = millis();
|
||||
bool longPress = false;
|
||||
while (digitalRead(BTN_PIN) == LOW) {
|
||||
if (millis() - pressStart >= 2000) {
|
||||
longPress = true;
|
||||
break;
|
||||
}
|
||||
delay(50);
|
||||
}
|
||||
if (longPress) {
|
||||
pAdvertising->stop();
|
||||
currentMode = (LokiMode)((currentMode + 1) % MODE_COUNT);
|
||||
prefs.begin("loki", false);
|
||||
prefs.putUChar("mode", currentMode);
|
||||
prefs.end();
|
||||
|
||||
const ModeConfig& nm = MODES[currentMode];
|
||||
Serial.printf("\n>> MODE: %s (%d profiles, %lu-%lums)\n",
|
||||
nm.name, nm.profileCount, nm.minDwell, nm.maxDwell);
|
||||
|
||||
// LED feedback
|
||||
digitalWrite(LED_PIN, HIGH);
|
||||
delay(200);
|
||||
blinkLED(nm.ledBlinks);
|
||||
|
||||
// Reset cycling state for new mode
|
||||
orderPos = 0;
|
||||
cycleCount = 0;
|
||||
for (int i = 0; i < NUM_PROFILES; i++) profileOrder[i] = i;
|
||||
shuffleOrder();
|
||||
dwellSmooth = (nm.minDwell + nm.maxDwell) / 2.0f;
|
||||
gapSmooth = (nm.minGap + nm.maxGap) / 2.0f;
|
||||
dwellTarget = dwellSmooth;
|
||||
gapTarget = gapSmooth;
|
||||
|
||||
// Wait for button release
|
||||
while (digitalRead(BTN_PIN) == LOW) delay(50);
|
||||
delay(200);
|
||||
}
|
||||
}
|
||||
|
||||
const ModeConfig& m = MODES[currentMode];
|
||||
|
||||
// Get current profile from shuffled order
|
||||
int profileIdx = profileOrder[orderPos];
|
||||
|
||||
// Compute jittered timing based on current mode's range
|
||||
uint32_t dwell = smoothRandom(&dwellSmooth, &dwellTarget,
|
||||
m.minDwell, m.maxDwell);
|
||||
uint32_t gap = smoothRandom(&gapSmooth, &gapTarget,
|
||||
m.minGap, m.maxGap);
|
||||
|
||||
// Broadcast this identity
|
||||
advertiseProfile(profileIdx);
|
||||
|
||||
// Hold advertisement for the dwell period
|
||||
delay(dwell);
|
||||
pAdvertising->stop();
|
||||
delay(ADV_GAP_MS);
|
||||
currentProfile = (currentProfile + 1) % NUM_PROFILES;
|
||||
|
||||
// Log once per full cycle
|
||||
if (totalBroadcasts % m.profileCount == 0 && totalBroadcasts > 0) {
|
||||
float rate = (float)totalBroadcasts / ((float)millis() / 1000.0f);
|
||||
Serial.printf("[%4lus] %s c%d | %lu total | %.1f/sec\n",
|
||||
millis() / 1000, m.name, cycleCount,
|
||||
totalBroadcasts, rate);
|
||||
}
|
||||
|
||||
// Gap before next identity
|
||||
delay(gap);
|
||||
|
||||
// Advance to next profile (wrapping at mode's profile count)
|
||||
orderPos++;
|
||||
if (orderPos >= m.profileCount) {
|
||||
orderPos = 0;
|
||||
cycleCount++;
|
||||
|
||||
if (cycleCount % SHUFFLE_EVERY == 0) {
|
||||
shuffleOrder();
|
||||
}
|
||||
}
|
||||
}
|
||||
|
|
|
|||
Loading…
Add table
Reference in a new issue