Skip to content

Instantly share code, notes, and snippets.

Last active March 27, 2023 17:07
Show Gist options
  • Save JA1TYE/8b13f50a9ca9e0df1f27167e036b0a25 to your computer and use it in GitHub Desktop.
Save JA1TYE/8b13f50a9ca9e0df1f27167e036b0a25 to your computer and use it in GitHub Desktop.
* Example for controlling toio core cube
* Based on BLE_client example
* author unknown
* updated by chegewara
* modified by R.Suzuki(@JA1TYE)
* License:Apache-2.0 License
* Please see for the details
#include "BLEDevice.h"
//#include "BLEScan.h"
// The remote service we wish to connect to.
static BLEUUID serviceUUID("10B20100-5B3B-4571-9508-CF3EFCD7BBAE");
// The characteristic of the remote service we are interested in.
static BLEUUID charUUID("10B20102-5B3B-4571-9508-CF3EFCD7BBAE");
static boolean doConnect = false;
static boolean connected = false;
static boolean doScan = false;
static BLERemoteCharacteristic* pRemoteCharacteristic;
static BLEAdvertisedDevice* myDevice;
static void notifyCallback(
BLERemoteCharacteristic* pBLERemoteCharacteristic,
uint8_t* pData,
size_t length,
bool isNotify) {
Serial.print("Notify callback for characteristic ");
Serial.print(" of data length ");
Serial.print("data: ");
class MyClientCallback : public BLEClientCallbacks {
void onConnect(BLEClient* pclient) {
void onDisconnect(BLEClient* pclient) {
connected = false;
bool connectToServer() {
Serial.print("Forming a connection to ");
BLEClient* pClient = BLEDevice::createClient();
Serial.println(" - Created client");
pClient->setClientCallbacks(new MyClientCallback());
// Connect to the remove 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");
pClient->setMTU(517); //set client to request maximum MTU from server (default is 23 otherwise)
// 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: ");
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: ");
return false;
Serial.println(" - Found our characteristic");
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: ");
// We have found a device, let us now see if it contains the service we are looking for.
if (advertisedDevice.haveServiceUUID() && advertisedDevice.isAdvertisingService(serviceUUID)) {
myDevice = new BLEAdvertisedDevice(advertisedDevice);
doConnect = true;
doScan = true;
} // Found our server
} // onResult
}; // MyAdvertisedDeviceCallbacks
void setup() {
Serial.println("Starting Arduino BLE Client application...");
// 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->start(5, false);
} // End of setup.
// This is the Arduino main loop function.
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 = "Time since boot: " + String(millis()/1000);
// Write the value to contorol toio's motor
//turn 5sec
uint8_t turn_cmd[7] = {0x01,0x01,0x01,0x32,0x02,0x02,0x32};
pRemoteCharacteristic->writeValue(turn_cmd, 7);
//stop 1sec
uint8_t stop_cmd[7] = {0x01,0x01,0x01,0x00,0x02,0x02,0x00};
pRemoteCharacteristic->writeValue(stop_cmd, 7);
}else if(doScan){
BLEDevice::getScan()->start(0); // this is just example to start scan after disconnect, most likely there is better way to do it in arduino
delay(1000); // Delay a second between loops.
} // End of loop
Sign up for free to join this conversation on GitHub. Already have an account? Sign in to comment