#include "BLEDevice.h"
/* Specify the Service UUID of Server */ // client code
static BLEUUID serviceUUID("79c79196-51cb-4f67-9520-9bc63e6597c1");
/* Specify the Characteristic UUID of Server */
static BLEUUID charUUID("e3038128-ca03-4f22-9f0d-b6547426dc6a");

static boolean doConnect = false;
static boolean connected = false;
static boolean doScan = false;
static BLERemoteCharacteristic* pRemoteCharacteristic;
static BLEAdvertisedDevice* myDevice;

int buttonStateL ;
int buttonStateR ;

#define buttonL 18
#define buttonR 19
static void notifyCallback(BLERemoteCharacteristic* pBLERemoteCharacteristic,
uint8_t* pData, size_t length, bool isNotify)
{
Serial.print("Notify callback for characteristic ");
Serial.print(pBLERemoteCharacteristic->getUUID().toString().c_str());
Serial.print(" of data length ");
Serial.println(length);
Serial.print("data: ");
Serial.println((char*)pData);
}

class MyClientCallback : public BLEClientCallbacks
{
void onConnect(BLEClient* pclient)
{
}
void onDisconnect(BLEClient* pclient)
{
connected = false;
Serial.println("onDisconnect");
}
};
/* Start connection to the BLE Server */
bool connectToServer()
{
Serial.print("Forming a connection to ");
Serial.println(myDevice->getAddress().toString().c_str());
BLEClient* pClient = BLEDevice::createClient();
Serial.println(" - Created client");
pClient->setClientCallbacks(new MyClientCallback());
/* Connect to the remote BLE Server */
pClient->connect(myDevice); // if you pass BLEAdvertisedDevice instead of address, it will be recognized type of peer device address (public or private)
Serial.println(" - Connected to server");
/* Obtain a reference to the service we are after in the remote BLE server */
BLERemoteService* pRemoteService = pClient->getService(serviceUUID);
if (pRemoteService == nullptr)
{
Serial.print("Failed to find our service UUID: ");
Serial.println(serviceUUID.toString().c_str());
pClient->disconnect();
return false;
}
Serial.println(" - Found our service");
/* Obtain a reference to the characteristic in the service of the remote BLE server */
pRemoteCharacteristic = pRemoteService->getCharacteristic(charUUID);
if (pRemoteCharacteristic == nullptr)
{
Serial.print("Failed to find our characteristic UUID: ");
Serial.println(charUUID.toString().c_str());
pClient->disconnect();
return false;
}
Serial.println(" - Found our characteristic");
/* Read the value of the characteristic */
/* Initial value is 'Hello, World!' */
if (pRemoteCharacteristic->canRead())
{
std::string value = pRemoteCharacteristic->readValue();
Serial.print("The characteristic value was: ");
Serial.println(value.c_str());
}
if (pRemoteCharacteristic->canNotify())
{
pRemoteCharacteristic->registerForNotify(notifyCallback);
}
connected = true;
return true;
}
/* Scan for BLE servers and find the first one that advertises the service we are looking for. */
class MyAdvertisedDeviceCallbacks: public BLEAdvertisedDeviceCallbacks
{
/* Called for each advertising BLE server. */
void onResult(BLEAdvertisedDevice advertisedDevice)
{
Serial.print("BLE Advertised Device found: ");
Serial.println(advertisedDevice.toString().c_str());
/* We have found a device, let us now see if it contains the service we are looking for. */
if (advertisedDevice.haveServiceUUID() && advertisedDevice.isAdvertisingService(serviceUUID))
{
BLEDevice::getScan()->stop();
myDevice = new BLEAdvertisedDevice(advertisedDevice);
doConnect = true;
doScan = true;
}
}
};
void setup()
{
Serial.begin(115200);
Serial.println("Starting Arduino BLE Client application...");
BLEDevice::init("ESP32-BLE-Client");

pinMode(buttonL, INPUT_PULLUP);
pinMode(buttonR, INPUT_PULLUP);

/* Retrieve a Scanner and set the callback we want to use to be informed when we
have detected a new device. Specify that we want active scanning and start the
scan to run for 5 seconds. */
BLEScan* pBLEScan = BLEDevice::getScan();
pBLEScan->setAdvertisedDeviceCallbacks(new MyAdvertisedDeviceCallbacks());
pBLEScan->setInterval(1349);
pBLEScan->setWindow(449);
pBLEScan->setActiveScan(true);
pBLEScan->start(5, false);
}
void loop()
{
/* If the flag "doConnect" is true, then we have scanned for and found the desired
BLE Server with which we wish to connect. Now we connect to it. Once we are
connected we set the connected flag to be true. */
if (doConnect == true)
{
if (connectToServer())
{
Serial.println("We are now connected to the BLE Server.");
}
else
{
Serial.println("We have failed to connect to the server; there is nothin more we will do.");
}
doConnect = false;
}
/* If we are connected to a peer BLE Server, update the characteristic each time we are reached
with the current time since boot */
if (connected)
{
String newValue = "";
int buttonStateL = digitalRead(buttonL);
int buttonStateR = digitalRead(buttonR);
if (buttonStateL == LOW)
{
newValue = "left";
}


if (buttonStateR == LOW)
{
newValue = "right";
}


if (buttonStateL || buttonStateR == HIGH)
{
newValue = "no signal";
}

/* Set the characteristic's value to be the array of bytes that is actually a string */
pRemoteCharacteristic->writeValue(newValue.c_str(), newValue.length());
/* You can see this value updated in the Server's Characteristic */
}
else if (doScan)
{
BLEDevice::getScan()->start(0); // better way to do it in arduino
}
// this is just example to start scan after disconnect, most likely there is
delay(2000); /* Delay a second between loops */
}