ble_controller.cpp

/*
 * BLE Controller Implementation
 * 
 * Copyright (c) 2026 Dharagesh, Circuit Digest
 */

#include "ble_controller.h"
#include <BLEDevice.h>
#include <BLEUtils.h>

static BLEClient* pClient = nullptr;
static bool connectedToBms = false;
static bool clientInitialized = false;

// Client callbacks to monitor connection state
class ShieldClientCallbacks : public BLEClientCallbacks {
    void onConnect(BLEClient* pclient) {
        connectedToBms = true;
        Serial.println("BLE Callback: Connected to BMS.");
    }
    
    void onDisconnect(BLEClient* pclient) {
        connectedToBms = false;
        Serial.println("BLE Callback: Disconnected from BMS.");
    }
};

void initBleController() {
    if (clientInitialized) return;
    BLEDevice::init("");
    pClient = BLEDevice::createClient();
    pClient->setClientCallbacks(new ShieldClientCallbacks());
    clientInitialized = true;
    Serial.println("BLE Client Initialized.");
}

bool connectToBms(const String& macAddress, int brand) {
    if (!clientInitialized) {
        initBleController();
    }
    
    // If already connected, do nothing
    if (connectedToBms && pClient != nullptr && pClient->isConnected()) {
        return true;
    }
    
    Serial.print("Attempting link-layer connection to BMS (");
    Serial.print(macAddress);
    Serial.println(")...");
    
    BLEAddress targetAddress(macAddress.c_str());
    
    // Connect to device at BLE link layer
    if (!pClient->connect(targetAddress)) {
        Serial.println("Connection failed.");
        return false;
    }
    
    connectedToBms = true;
    Serial.println("Connected to BMS (Link-Layer lock active).");
    return true;
}

void disconnectBms() {
    if (pClient != nullptr && pClient->isConnected()) {
        pClient->disconnect();
    }
    connectedToBms = false;
    Serial.println("Manually disconnected BLE BMS link.");
}

bool isBmsConnected() {
    return connectedToBms && pClient != nullptr && pClient->isConnected();
}

void handleBleController(const String& macAddress, int brand) {
    // If not connected, attempt connection
    if (!isBmsConnected()) {
        connectToBms(macAddress, brand);
    }
}