BMPCC_Remote_Esp32/BMPCCAdvertisedDeviceCallbacks.cpp at master · creacominc/BMPCC_Remote_Esp32 · GitHub

1
2
3
4
5
6
7
8
9
10
11
12
13
14
15
16
17
18
19
20
21
22
23
24
25
26
27
28
29
30
31
32
33
34
35
36
37
38
39
40
41
#include "BMPCCAdvertisedDeviceCallbacks.h"

#include <functional>

#include <BLEAddress.h>
#include <HardwareSerial.h>
#include <BLEDevice.h>


BMPCCAdvertisedDeviceCallbacks::BMPCCAdvertisedDeviceCallbacks( CameraMap_t & _Cameras,
                                                                BLEUUID & _cameraControlServiceUUID )
  : BLEAdvertisedDeviceCallbacks()
  , m_Cameras( _Cameras )
  , m_cameraControlServiceUUID( _cameraControlServiceUUID )
{
}

BMPCCAdvertisedDeviceCallbacks::~BMPCCAdvertisedDeviceCallbacks()
{
}


void BMPCCAdvertisedDeviceCallbacks::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( m_cameraControlServiceUUID ))
  {
    Serial.println("found a camera.");
    BLEAddress address( advertisedDevice.getAddress() );
    std::string addressStr( address.toString() );
    std::string msg = "Camera address: " + addressStr;
    Serial.println( msg.c_str() );
    if( m_Cameras.end() == m_Cameras.find( addressStr ) )
    {
      m_Cameras[ addressStr ] = new BLEAdvertisedDevice( advertisedDevice );
    }
  }
}