249 lines
7.8 KiB
C++
249 lines
7.8 KiB
C++
/*
|
|
; Project: Open Vehicle Monitor System
|
|
; Date: 14th March 2017
|
|
;
|
|
; Changes:
|
|
; 1.0 Initial release
|
|
;
|
|
; (C) 2011 Michael Stegen / Stegen Electronics
|
|
; (C) 2011-2017 Mark Webb-Johnson
|
|
; (C) 2011 Sonny Chen @ EPRO/DX
|
|
;
|
|
; Permission is hereby granted, free of charge, to any person obtaining a copy
|
|
; of this software and associated documentation files (the "Software"), to deal
|
|
; in the Software without restriction, including without limitation the rights
|
|
; to use, copy, modify, merge, publish, distribute, sublicense, and/or sell
|
|
; copies of the Software, and to permit persons to whom the Software is
|
|
; furnished to do so, subject to the following conditions:
|
|
;
|
|
; The above copyright notice and this permission notice shall be included in
|
|
; all copies or substantial portions of the Software.
|
|
;
|
|
; THE SOFTWARE IS PROVIDED "AS IS", WITHOUT WARRANTY OF ANY KIND, EXPRESS OR
|
|
; IMPLIED, INCLUDING BUT NOT LIMITED TO THE WARRANTIES OF MERCHANTABILITY,
|
|
; FITNESS FOR A PARTICULAR PURPOSE AND NONINFRINGEMENT. IN NO EVENT SHALL THE
|
|
; AUTHORS OR COPYRIGHT HOLDERS BE LIABLE FOR ANY CLAIM, DAMAGES OR OTHER
|
|
; LIABILITY, WHETHER IN AN ACTION OF CONTRACT, TORT OR OTHERWISE, ARISING FROM,
|
|
; OUT OF OR IN CONNECTION WITH THE SOFTWARE OR THE USE OR OTHER DEALINGS IN
|
|
; THE SOFTWARE.
|
|
*/
|
|
|
|
#include <string.h>
|
|
#include "esp_system.h"
|
|
#include "esp32bluetooth_app_console.h"
|
|
|
|
#include "ovms_log.h"
|
|
static const char *TAG = "bt-app-console";
|
|
|
|
// Demo property (just for testing)
|
|
static uint8_t char1_str[] = {'O','V','M','S'};
|
|
static esp_gatt_char_prop_t a_property = 0;
|
|
|
|
#define GATTS_DEMO_CHAR_VAL_LEN_MAX 0x40
|
|
static esp_attr_value_t gatts_demo_char1_val =
|
|
{
|
|
.attr_max_len = GATTS_DEMO_CHAR_VAL_LEN_MAX,
|
|
.attr_len = sizeof(char1_str),
|
|
.attr_value = char1_str,
|
|
};
|
|
// End of demo property
|
|
|
|
OvmsBluetoothAppConsole MyBluetoothAppConsole __attribute__ ((init_priority (8016)));
|
|
|
|
OvmsBluetoothAppConsole::OvmsBluetoothAppConsole()
|
|
: esp32bluetoothApp("console")
|
|
{
|
|
ESP_LOGI(TAG, "Initialising Bluetooth CONSOLE App (8016)");
|
|
|
|
m_char_handle = 0;
|
|
memset(&m_char_uuid, 0, sizeof(m_char_uuid));
|
|
m_perm = 0;
|
|
m_property = 0;
|
|
m_descr_handle = 0;
|
|
memset(&m_descr_uuid, 0, sizeof(m_descr_uuid));
|
|
m_notifying = false;
|
|
m_console = NULL;
|
|
|
|
m_app_id = GATTS_APP_UUID_OVMS_CONSOLE;
|
|
MyBluetoothGATTS.RegisterApp(this);
|
|
}
|
|
|
|
OvmsBluetoothAppConsole::~OvmsBluetoothAppConsole()
|
|
{
|
|
if (m_console)
|
|
{
|
|
delete m_console;
|
|
m_console = NULL;
|
|
}
|
|
}
|
|
|
|
void OvmsBluetoothAppConsole::DataFromConsole(const char* data, size_t len)
|
|
{
|
|
// This is called by the console, to send data out
|
|
ESP_LOGV(TAG,"Transmitting %d bytes from console",len);
|
|
MyCommandApp.HexDump(TAG, "tx", data, len);
|
|
while ((len > 0)&&(m_notifying))
|
|
{
|
|
size_t togo = (len <= m_mtu)?len:m_mtu;
|
|
ESP_LOGV(TAG,"Indicate %d bytes (mtu %d)",togo,m_mtu);
|
|
esp_ble_gatts_send_indicate(m_gatts_if,
|
|
m_conn_id,
|
|
m_char_handle,
|
|
togo,
|
|
(uint8_t*)data,
|
|
false);
|
|
len -= togo;
|
|
data += togo;
|
|
}
|
|
}
|
|
|
|
void OvmsBluetoothAppConsole::EventRegistered(esp_ble_gatts_cb_param_t::gatts_reg_evt_param *reg)
|
|
{
|
|
m_service_id.is_primary = true;
|
|
m_service_id.id.inst_id = 0x00;
|
|
m_service_id.id.uuid.len = ESP_UUID_LEN_16;
|
|
m_service_id.id.uuid.uuid.uuid16 = GATTS_SERVICE_UUID_OVMS_CONSOLE;
|
|
ESP_LOGI(TAG,"ESP_GATTS_REG_EVT Creating service %04x on interface %d",
|
|
m_service_id.id.uuid.uuid.uuid16,
|
|
m_gatts_if);
|
|
esp_ble_gatts_create_service(m_gatts_if, &m_service_id, GATTS_NUM_HANDLE_OVMS_CONSOLE);
|
|
}
|
|
|
|
void OvmsBluetoothAppConsole::EventCreate(esp_ble_gatts_cb_param_t::gatts_add_attr_tab_evt_param *attrtab)
|
|
{
|
|
m_char_uuid.len = ESP_UUID_LEN_16;
|
|
m_char_uuid.uuid.uuid16 = GATTS_CHAR_UUID_OVMS_CONSOLE;
|
|
a_property = ESP_GATT_CHAR_PROP_BIT_READ | ESP_GATT_CHAR_PROP_BIT_WRITE | ESP_GATT_CHAR_PROP_BIT_NOTIFY;
|
|
esp_err_t add_char_ret =
|
|
esp_ble_gatts_add_char(m_service_handle,
|
|
&m_char_uuid,
|
|
ESP_GATT_PERM_READ | ESP_GATT_PERM_WRITE,
|
|
a_property,
|
|
&gatts_demo_char1_val,
|
|
NULL);
|
|
if (add_char_ret)
|
|
{
|
|
ESP_LOGE(TAG, "add char failed, error code =%x",add_char_ret);
|
|
}
|
|
|
|
esp_ble_gatts_start_service(m_service_handle);
|
|
}
|
|
|
|
void OvmsBluetoothAppConsole::EventConnect(esp_ble_gatts_cb_param_t::gatts_connect_evt_param *connect)
|
|
{
|
|
m_notifying = false;
|
|
|
|
if (m_console)
|
|
{
|
|
delete m_console;
|
|
}
|
|
m_console = new OvmsBluetoothConsole(this);
|
|
}
|
|
|
|
void OvmsBluetoothAppConsole::EventDisconnect(esp_ble_gatts_cb_param_t::gatts_disconnect_evt_param *disconnect)
|
|
{
|
|
m_notifying = false;
|
|
|
|
if (m_console)
|
|
{
|
|
delete m_console;
|
|
m_console = NULL;
|
|
}
|
|
}
|
|
|
|
void OvmsBluetoothAppConsole::EventAddChar(esp_ble_gatts_cb_param_t::gatts_add_char_evt_param *addchar)
|
|
{
|
|
uint16_t length = 0;
|
|
const uint8_t *prf_char;
|
|
|
|
m_char_handle = addchar->attr_handle;
|
|
m_descr_uuid.len = ESP_UUID_LEN_16;
|
|
m_descr_uuid.uuid.uuid16 = ESP_GATT_UUID_CHAR_CLIENT_CONFIG;
|
|
esp_err_t get_attr_ret = esp_ble_gatts_get_attr_value(addchar->attr_handle, &length, &prf_char);
|
|
if (get_attr_ret == ESP_FAIL)
|
|
{
|
|
ESP_LOGE(TAG, "ILLEGAL HANDLE");
|
|
}
|
|
|
|
esp_err_t add_descr_ret = esp_ble_gatts_add_char_descr(
|
|
m_service_handle,
|
|
&m_descr_uuid,
|
|
ESP_GATT_PERM_READ | ESP_GATT_PERM_WRITE,
|
|
NULL,NULL);
|
|
if (add_descr_ret)
|
|
{
|
|
ESP_LOGE(TAG, "add char descr failed, error code = %x", add_descr_ret);
|
|
}
|
|
}
|
|
|
|
void OvmsBluetoothAppConsole::EventAddCharDescr(esp_ble_gatts_cb_param_t::gatts_add_char_descr_evt_param *adddescr)
|
|
{
|
|
m_descr_handle = adddescr->attr_handle;
|
|
}
|
|
|
|
void OvmsBluetoothAppConsole::EventRead(esp_ble_gatts_cb_param_t::gatts_read_evt_param *read)
|
|
{
|
|
// Direct reads don't reply with anything, as we rely on notification listeners
|
|
esp_gatt_rsp_t rsp;
|
|
memset(&rsp, 0, sizeof(esp_gatt_rsp_t));
|
|
rsp.attr_value.handle = read->handle;
|
|
rsp.attr_value.len = 0;
|
|
esp_ble_gatts_send_response(m_gatts_if,
|
|
read->conn_id,
|
|
read->trans_id,
|
|
ESP_GATT_OK, &rsp);
|
|
}
|
|
|
|
void OvmsBluetoothAppConsole::EventWrite(esp_ble_gatts_cb_param_t::gatts_write_evt_param *write)
|
|
{
|
|
if (!write->is_prep)
|
|
{
|
|
if (m_descr_handle == write->handle && write->len == 2)
|
|
{
|
|
uint16_t descr_value = write->value[1]<<8 | write->value[0];
|
|
if (descr_value == 0x0001)
|
|
{
|
|
if (a_property & ESP_GATT_CHAR_PROP_BIT_NOTIFY)
|
|
{
|
|
ESP_LOGI(TAG, "notify enable");
|
|
uint8_t notify_data[15];
|
|
for (int k = 0; k < sizeof(notify_data); ++k)
|
|
{
|
|
notify_data[k] = k%0xff;
|
|
}
|
|
// The size of notify_data[] mus tbe less than MTU size
|
|
m_notifying = true;
|
|
}
|
|
}
|
|
else if (descr_value == 0x0000)
|
|
{
|
|
ESP_LOGI(TAG, "notify disable ");
|
|
m_notifying = false;
|
|
}
|
|
else
|
|
{
|
|
ESP_LOGE(TAG, "unknown value");
|
|
}
|
|
}
|
|
else if (m_char_handle == write->handle)
|
|
{
|
|
// A write to the characteristic
|
|
ESP_LOGV(TAG,"Received %d bytes for console",write->len);
|
|
MyCommandApp.HexDump(TAG, "rx", (const char*)write->value, write->len);
|
|
if (m_console)
|
|
m_console->DataToConsole(write->value, write->len);
|
|
}
|
|
}
|
|
if (write->need_rsp)
|
|
{
|
|
esp_ble_gatts_send_response(m_gatts_if,
|
|
write->conn_id,
|
|
write->trans_id,
|
|
ESP_GATT_OK, NULL);
|
|
}
|
|
}
|
|
|
|
void OvmsBluetoothAppConsole::EventExecWrite(esp_ble_gatts_cb_param_t::gatts_exec_write_evt_param *execwrite)
|
|
{
|
|
}
|