mirror of
https://github.com/bluekitchen/btstack.git
synced 2025-01-31 18:33:00 +00:00
ublox_spp_service_server: Implementation of the ublox SPP-like profile
This commit is contained in:
parent
c9d24807fb
commit
733ac1e89f
@ -122,7 +122,7 @@ EXAMPLES = \
|
|||||||
gap_inquiry \
|
gap_inquiry \
|
||||||
gap_le_advertisements \
|
gap_le_advertisements \
|
||||||
gap_link_keys \
|
gap_link_keys \
|
||||||
gatt_battery_query \
|
gatt_battery_query \
|
||||||
gatt_browser \
|
gatt_browser \
|
||||||
gatt_heart_rate_client \
|
gatt_heart_rate_client \
|
||||||
hfp_ag_demo \
|
hfp_ag_demo \
|
||||||
@ -141,6 +141,8 @@ EXAMPLES = \
|
|||||||
le_streamer_client \
|
le_streamer_client \
|
||||||
led_counter \
|
led_counter \
|
||||||
mod_player \
|
mod_player \
|
||||||
|
nordic_spp_le_counter \
|
||||||
|
nordic_spp_le_streamer \
|
||||||
pbap_client_demo \
|
pbap_client_demo \
|
||||||
sdp_bnep_query \
|
sdp_bnep_query \
|
||||||
sdp_general_query \
|
sdp_general_query \
|
||||||
@ -153,6 +155,7 @@ EXAMPLES = \
|
|||||||
spp_counter \
|
spp_counter \
|
||||||
spp_streamer \
|
spp_streamer \
|
||||||
spp_streamer_client \
|
spp_streamer_client \
|
||||||
|
ublox_spp_le_counter \
|
||||||
|
|
||||||
EXAMPLES_USING_LE = \
|
EXAMPLES_USING_LE = \
|
||||||
ancs_client_demo \
|
ancs_client_demo \
|
||||||
@ -171,6 +174,7 @@ EXAMPLES_USING_LE = \
|
|||||||
sm_pairing_central \
|
sm_pairing_central \
|
||||||
sm_pairing_peripheral \
|
sm_pairing_peripheral \
|
||||||
spp_and_le_counter \
|
spp_and_le_counter \
|
||||||
|
ublox_spp_le_counter \
|
||||||
|
|
||||||
# .o for .c
|
# .o for .c
|
||||||
CORE_OBJ = $(CORE:.c=.o)
|
CORE_OBJ = $(CORE:.c=.o)
|
||||||
@ -332,6 +336,9 @@ nordic_spp_le_counter: nordic_spp_le_counter.h ${CORE_OBJ} ${COMMON_OBJ} ${ATT_O
|
|||||||
nordic_spp_le_streamer: nordic_spp_le_streamer.h ${CORE_OBJ} ${COMMON_OBJ} ${ATT_OBJ} ${GATT_SERVER_OBJ} ${SM_OBJ} nordic_spp_service_server.o nordic_spp_le_streamer.c
|
nordic_spp_le_streamer: nordic_spp_le_streamer.h ${CORE_OBJ} ${COMMON_OBJ} ${ATT_OBJ} ${GATT_SERVER_OBJ} ${SM_OBJ} nordic_spp_service_server.o nordic_spp_le_streamer.c
|
||||||
${CC} $(filter-out nordic_spp_le_streamer.h,$^) ${CFLAGS} ${LDFLAGS} -o $@
|
${CC} $(filter-out nordic_spp_le_streamer.h,$^) ${CFLAGS} ${LDFLAGS} -o $@
|
||||||
|
|
||||||
|
ublox_spp_le_counter: ublox_spp_le_counter.h ${CORE_OBJ} ${COMMON_OBJ} ${ATT_OBJ} ${GATT_SERVER_OBJ} ${SM_OBJ} ublox_spp_service_server.o ublox_spp_le_counter.c
|
||||||
|
${CC} $(filter-out ublox_spp_le_counter.h,$^) ${CFLAGS} ${LDFLAGS} -o $@
|
||||||
|
|
||||||
clean:
|
clean:
|
||||||
rm -f ${EXAMPLES} *_demo
|
rm -f ${EXAMPLES} *_demo
|
||||||
rm -f *.o *.out *.hex *.exe *.wav *.sbc
|
rm -f *.o *.out *.hex *.exe *.wav *.sbc
|
||||||
@ -339,6 +346,7 @@ clean:
|
|||||||
rm -f gatt_battery_query.h gatt_browser.h sm_pairing_peripheral.h spp_and_le_streamer.h
|
rm -f gatt_battery_query.h gatt_browser.h sm_pairing_peripheral.h spp_and_le_streamer.h
|
||||||
rm -f le_data_channel_server.h sm_pairing_central.h
|
rm -f le_data_channel_server.h sm_pairing_central.h
|
||||||
rm -f nordic_spp_le_counter.h nordic_spp_le_streamer.h nordic_spp_le_counter nordic_spp_le_streamer
|
rm -f nordic_spp_le_counter.h nordic_spp_le_streamer.h nordic_spp_le_counter nordic_spp_le_streamer
|
||||||
|
rm -f ublox_spp_le_counter.h ublox_spp_le_counter
|
||||||
rm -f le_streamer_and_counter_client.h le_streamer_and_counter_client
|
rm -f le_streamer_and_counter_client.h le_streamer_and_counter_client
|
||||||
rm -f sco_output.msbc sco_input.msbc
|
rm -f sco_output.msbc sco_input.msbc
|
||||||
rm -rf *.dSYM
|
rm -rf *.dSYM
|
||||||
|
210
example/ublox_spp_le_counter.c
Normal file
210
example/ublox_spp_le_counter.c
Normal file
@ -0,0 +1,210 @@
|
|||||||
|
/*
|
||||||
|
* Copyright (C) 2014 BlueKitchen GmbH
|
||||||
|
*
|
||||||
|
* Redistribution and use in source and binary forms, with or without
|
||||||
|
* modification, are permitted provided that the following conditions
|
||||||
|
* are met:
|
||||||
|
*
|
||||||
|
* 1. Redistributions of source code must retain the above copyright
|
||||||
|
* notice, this list of conditions and the following disclaimer.
|
||||||
|
* 2. Redistributions in binary form must reproduce the above copyright
|
||||||
|
* notice, this list of conditions and the following disclaimer in the
|
||||||
|
* documentation and/or other materials provided with the distribution.
|
||||||
|
* 3. Neither the name of the copyright holders nor the names of
|
||||||
|
* contributors may be used to endorse or promote products derived
|
||||||
|
* from this software without specific prior written permission.
|
||||||
|
* 4. Any redistribution, use, or modification is done solely for
|
||||||
|
* personal benefit and not for any commercial purpose or for
|
||||||
|
* monetary gain.
|
||||||
|
*
|
||||||
|
* THIS SOFTWARE IS PROVIDED BY BLUEKITCHEN GMBH AND CONTRIBUTORS
|
||||||
|
* ``AS IS'' AND ANY EXPRESS OR IMPLIED WARRANTIES, INCLUDING, BUT NOT
|
||||||
|
* LIMITED TO, THE IMPLIED WARRANTIES OF MERCHANTABILITY AND FITNESS
|
||||||
|
* FOR A PARTICULAR PURPOSE ARE DISCLAIMED. IN NO EVENT SHALL MATTHIAS
|
||||||
|
* RINGWALD OR CONTRIBUTORS BE LIABLE FOR ANY DIRECT, INDIRECT,
|
||||||
|
* INCIDENTAL, SPECIAL, EXEMPLARY, OR CONSEQUENTIAL DAMAGES (INCLUDING,
|
||||||
|
* BUT NOT LIMITED TO, PROCUREMENT OF SUBSTITUTE GOODS OR SERVICES; LOSS
|
||||||
|
* OF USE, DATA, OR PROFITS; OR BUSINESS INTERRUPTION) HOWEVER CAUSED
|
||||||
|
* AND ON ANY THEORY OF LIABILITY, WHETHER IN CONTRACT, STRICT LIABILITY,
|
||||||
|
* OR TORT (INCLUDING NEGLIGENCE OR OTHERWISE) ARISING IN ANY WAY OUT OF
|
||||||
|
* THE USE OF THIS SOFTWARE, EVEN IF ADVISED OF THE POSSIBILITY OF
|
||||||
|
* SUCH DAMAGE.
|
||||||
|
*
|
||||||
|
* Please inquire about commercial licensing options at
|
||||||
|
* contact@bluekitchen-gmbh.com
|
||||||
|
*
|
||||||
|
*/
|
||||||
|
|
||||||
|
#define __BTSTACK_FILE__ "ublox_le_counter.c"
|
||||||
|
|
||||||
|
// *****************************************************************************
|
||||||
|
/* EXAMPLE_START(ublox_le_counter): LE Peripheral - Nordic SPP-like profile
|
||||||
|
*
|
||||||
|
*/
|
||||||
|
// *****************************************************************************
|
||||||
|
|
||||||
|
#include <stdint.h>
|
||||||
|
#include <stdio.h>
|
||||||
|
#include <stdlib.h>
|
||||||
|
#include <string.h>
|
||||||
|
|
||||||
|
#include "ublox_spp_le_counter.h"
|
||||||
|
#include "btstack.h"
|
||||||
|
#include "ble/gatt-service/ublox_spp_service_server.h"
|
||||||
|
|
||||||
|
#define HEARTBEAT_PERIOD_MS 1000
|
||||||
|
|
||||||
|
/* @section Main Application Setup
|
||||||
|
*
|
||||||
|
* @text Listing MainConfiguration shows main application code.
|
||||||
|
* It initializes L2CAP, the Security Manager and configures the ATT Server with the pre-compiled
|
||||||
|
* ATT Database generated from $ublox_le_counter.gatt$.
|
||||||
|
* Additionally, it enables the Battery Service Server with the current battery level.
|
||||||
|
* Finally, it configures the advertisements
|
||||||
|
* and the heartbeat handler and boots the Bluetooth stack.
|
||||||
|
* In this example, the Advertisement contains the Flags attribute and the device name.
|
||||||
|
* The flag 0x06 indicates: LE General Discoverable Mode and BR/EDR not supported.
|
||||||
|
*/
|
||||||
|
|
||||||
|
/* LISTING_START(MainConfiguration): Init L2CAP SM ATT Server and start heartbeat timer */
|
||||||
|
static btstack_timer_source_t heartbeat;
|
||||||
|
static hci_con_handle_t con_handle = HCI_CON_HANDLE_INVALID;
|
||||||
|
static btstack_context_callback_registration_t send_request;
|
||||||
|
static btstack_packet_callback_registration_t hci_event_callback_registration;
|
||||||
|
|
||||||
|
const uint8_t adv_data[] = {
|
||||||
|
// Flags general discoverable, BR/EDR not supported
|
||||||
|
2, BLUETOOTH_DATA_TYPE_FLAGS, 0x06,
|
||||||
|
// Name
|
||||||
|
9, BLUETOOTH_DATA_TYPE_COMPLETE_LOCAL_NAME, 'u', 'B', 'l','o', 'x', 'S', 'P', 'P',
|
||||||
|
// UUID ...
|
||||||
|
17, BLUETOOTH_DATA_TYPE_COMPLETE_LIST_OF_128_BIT_SERVICE_CLASS_UUIDS, 0x1, 0xd7, 0xe9, 0x1, 0x4f, 0xf3, 0x44, 0xe7, 0x83, 0x8f, 0xe2, 0x26, 0xb9, 0xe1, 0x56, 0x24,
|
||||||
|
};
|
||||||
|
|
||||||
|
const uint8_t adv_data_len = sizeof(adv_data);
|
||||||
|
|
||||||
|
/* LISTING_END */
|
||||||
|
|
||||||
|
/*
|
||||||
|
* @section Heartbeat Handler
|
||||||
|
*
|
||||||
|
* @text The heartbeat handler updates the value of the single Characteristic provided in this example,
|
||||||
|
* and request a ATT_EVENT_CAN_SEND_NOW to send a notification if enabled see Listing heartbeat.
|
||||||
|
*/
|
||||||
|
|
||||||
|
/* LISTING_START(heartbeat): Hearbeat Handler */
|
||||||
|
static int counter = 0;
|
||||||
|
static char counter_string[30];
|
||||||
|
static int counter_string_len;
|
||||||
|
|
||||||
|
static void beat(void){
|
||||||
|
counter++;
|
||||||
|
counter_string_len = sprintf(counter_string, "BTstack counter %03u", counter);
|
||||||
|
}
|
||||||
|
|
||||||
|
static void ublox_can_send(void * context){
|
||||||
|
UNUSED(context);
|
||||||
|
beat();
|
||||||
|
printf("SEND: %s\n", counter_string);
|
||||||
|
ublox_spp_service_server_send(con_handle, (uint8_t*) counter_string, counter_string_len);
|
||||||
|
}
|
||||||
|
|
||||||
|
static void heartbeat_handler(struct btstack_timer_source *ts){
|
||||||
|
if (con_handle != HCI_CON_HANDLE_INVALID) {
|
||||||
|
send_request.callback = &ublox_can_send;
|
||||||
|
ublox_spp_service_server_request_can_send_now(&send_request, con_handle);
|
||||||
|
}
|
||||||
|
btstack_run_loop_set_timer(ts, HEARTBEAT_PERIOD_MS);
|
||||||
|
btstack_run_loop_add_timer(ts);
|
||||||
|
}
|
||||||
|
/* LISTING_END */
|
||||||
|
|
||||||
|
static void ublox_data(hci_con_handle_t handle, const uint8_t * data, uint16_t size){
|
||||||
|
if (size == 0 && con_handle == HCI_CON_HANDLE_INVALID ){
|
||||||
|
con_handle = handle;
|
||||||
|
printf("Connected with handle 0x%04x\n", con_handle);
|
||||||
|
} else {
|
||||||
|
printf("RECV: ");
|
||||||
|
printf_hexdump(data, size);
|
||||||
|
}
|
||||||
|
}
|
||||||
|
|
||||||
|
static void ublox_flow_control(hci_con_handle_t handle, uint16_t credits){
|
||||||
|
if (con_handle == HCI_CON_HANDLE_INVALID ){
|
||||||
|
con_handle = handle;
|
||||||
|
printf("Connected with handle 0x%04x\n", handle);
|
||||||
|
}
|
||||||
|
printf("credits %d\n", credits);
|
||||||
|
}
|
||||||
|
/*
|
||||||
|
* @section Packet Handler
|
||||||
|
*
|
||||||
|
* @text The packet handler is used to:
|
||||||
|
* - stop the counter after a disconnect
|
||||||
|
*/
|
||||||
|
|
||||||
|
/* LISTING_START(packetHandler): Packet Handler */
|
||||||
|
static void packet_handler (uint8_t packet_type, uint16_t channel, uint8_t *packet, uint16_t size){
|
||||||
|
UNUSED(channel);
|
||||||
|
UNUSED(size);
|
||||||
|
|
||||||
|
switch (packet_type) {
|
||||||
|
case HCI_EVENT_PACKET:
|
||||||
|
switch (hci_event_packet_get_type(packet)) {
|
||||||
|
case HCI_EVENT_DISCONNECTION_COMPLETE:
|
||||||
|
con_handle = HCI_CON_HANDLE_INVALID;
|
||||||
|
break;
|
||||||
|
default:
|
||||||
|
break;
|
||||||
|
}
|
||||||
|
break;
|
||||||
|
}
|
||||||
|
}
|
||||||
|
/* LISTING_END */
|
||||||
|
|
||||||
|
|
||||||
|
int btstack_main(void);
|
||||||
|
int btstack_main(void)
|
||||||
|
{
|
||||||
|
// register for HCI events
|
||||||
|
hci_event_callback_registration.callback = &packet_handler;
|
||||||
|
hci_add_event_handler(&hci_event_callback_registration);
|
||||||
|
|
||||||
|
l2cap_init();
|
||||||
|
|
||||||
|
// setup LE device DB
|
||||||
|
le_device_db_init();
|
||||||
|
|
||||||
|
// setup SM: Display only
|
||||||
|
sm_init();
|
||||||
|
|
||||||
|
// setup ATT server
|
||||||
|
att_server_init(profile_data, NULL, NULL);
|
||||||
|
|
||||||
|
// setup Nordic SPP service
|
||||||
|
ublox_spp_service_server_init(&ublox_data, &ublox_flow_control);
|
||||||
|
|
||||||
|
// setup advertisements
|
||||||
|
uint16_t adv_int_min = 0x0030;
|
||||||
|
uint16_t adv_int_max = 0x0030;
|
||||||
|
uint8_t adv_type = 0;
|
||||||
|
bd_addr_t null_addr;
|
||||||
|
memset(null_addr, 0, 6);
|
||||||
|
gap_advertisements_set_params(adv_int_min, adv_int_max, adv_type, 0, null_addr, 0x07, 0x00);
|
||||||
|
gap_advertisements_set_data(adv_data_len, (uint8_t*) adv_data);
|
||||||
|
gap_advertisements_enable(1);
|
||||||
|
|
||||||
|
// set one-shot timer
|
||||||
|
heartbeat.process = &heartbeat_handler;
|
||||||
|
btstack_run_loop_set_timer(&heartbeat, HEARTBEAT_PERIOD_MS);
|
||||||
|
btstack_run_loop_add_timer(&heartbeat);
|
||||||
|
|
||||||
|
// beat once
|
||||||
|
beat();
|
||||||
|
|
||||||
|
// turn on!
|
||||||
|
hci_power_control(HCI_POWER_ON);
|
||||||
|
|
||||||
|
return 0;
|
||||||
|
}
|
||||||
|
/* EXAMPLE_END */
|
4
example/ublox_spp_le_counter.gatt
Normal file
4
example/ublox_spp_le_counter.gatt
Normal file
@ -0,0 +1,4 @@
|
|||||||
|
PRIMARY_SERVICE, GAP_SERVICE
|
||||||
|
CHARACTERISTIC, GAP_DEVICE_NAME, READ, "uBlox SPP Counter"
|
||||||
|
|
||||||
|
#import <ublox_spp_service.gatt>
|
13
port/libusb/.gitignore
vendored
13
port/libusb/.gitignore
vendored
@ -16,6 +16,7 @@ ble_peripheral_test
|
|||||||
bnep_test
|
bnep_test
|
||||||
btstack_link_key_db_fs_a.c
|
btstack_link_key_db_fs_a.c
|
||||||
btstack_link_key_db_fs_b.c
|
btstack_link_key_db_fs_b.c
|
||||||
|
build*
|
||||||
classic_test
|
classic_test
|
||||||
csr_set_bd_addr
|
csr_set_bd_addr
|
||||||
dut_mode_classic
|
dut_mode_classic
|
||||||
@ -57,6 +58,10 @@ le_streamer_and_counter_client.h
|
|||||||
le_streamer_client
|
le_streamer_client
|
||||||
led_counter
|
led_counter
|
||||||
mod_player
|
mod_player
|
||||||
|
nordic_spp_le_counter
|
||||||
|
nordic_spp_le_counter.h
|
||||||
|
nordic_spp_le_streamer
|
||||||
|
nordic_spp_le_streamer.h
|
||||||
panu_demo
|
panu_demo
|
||||||
pbap_client_demo
|
pbap_client_demo
|
||||||
profile.h
|
profile.h
|
||||||
@ -65,6 +70,7 @@ sco_output*
|
|||||||
sdp_bnep_query
|
sdp_bnep_query
|
||||||
sdp_general_query
|
sdp_general_query
|
||||||
sdp_rfcomm_query
|
sdp_rfcomm_query
|
||||||
|
sine_player
|
||||||
sm_pairing_central
|
sm_pairing_central
|
||||||
sm_pairing_central.h
|
sm_pairing_central.h
|
||||||
sm_pairing_peripheral
|
sm_pairing_peripheral
|
||||||
@ -76,8 +82,5 @@ spp_and_le_streamer.h
|
|||||||
spp_counter
|
spp_counter
|
||||||
spp_streamer
|
spp_streamer
|
||||||
spp_streamer_client
|
spp_streamer_client
|
||||||
build*
|
ublox_spp_le_counter
|
||||||
nordic_spp_le_counter
|
ublox_spp_le_counter.h
|
||||||
nordic_spp_le_counter.h
|
|
||||||
nordic_spp_le_streamer
|
|
||||||
nordic_spp_le_streamer.h
|
|
9
src/ble/gatt-service/ublox_spp_service.gatt
Normal file
9
src/ble/gatt-service/ublox_spp_service.gatt
Normal file
@ -0,0 +1,9 @@
|
|||||||
|
// Specification ublox SPP-like profile
|
||||||
|
|
||||||
|
// ublox SPP-like
|
||||||
|
PRIMARY_SERVICE, 2456E1B9-26E2-8F83-E744-F34F01E9D701
|
||||||
|
// FIFO
|
||||||
|
CHARACTERISTIC, 2456E1B9-26E2-8F83-E744-F34F01E9D703, DYNAMIC | NOTIFY | INDICATE | WRITE | WRITE_WITHOUT_RESPONSE,
|
||||||
|
// Credits
|
||||||
|
CHARACTERISTIC, 2456E1B9-26E2-8F83-E744-F34F01E9D704, DYNAMIC | NOTIFY | INDICATE | WRITE | WRITE_WITHOUT_RESPONSE,
|
||||||
|
|
271
src/ble/gatt-service/ublox_spp_service_server.c
Normal file
271
src/ble/gatt-service/ublox_spp_service_server.c
Normal file
@ -0,0 +1,271 @@
|
|||||||
|
/*
|
||||||
|
* Copyright (C) 2018 BlueKitchen GmbH
|
||||||
|
*
|
||||||
|
* Redistribution and use in source and binary forms, with or without
|
||||||
|
* modification, are permitted provided that the following conditions
|
||||||
|
* are met:
|
||||||
|
*
|
||||||
|
* 1. Redistributions of source code must retain the above copyright
|
||||||
|
* notice, this list of conditions and the following disclaimer.
|
||||||
|
* 2. Redistributions in binary form must reproduce the above copyright
|
||||||
|
* notice, this list of conditions and the following disclaimer in the
|
||||||
|
* documentation and/or other materials provided with the distribution.
|
||||||
|
* 3. Neither the name of the copyright holders nor the names of
|
||||||
|
* contributors may be used to endorse or promote products derived
|
||||||
|
* from this software without specific prior written permission.
|
||||||
|
* 4. Any redistribution, use, or modification is done solely for
|
||||||
|
* personal benefit and not for any commercial purpose or for
|
||||||
|
* monetary gain.
|
||||||
|
*
|
||||||
|
* THIS SOFTWARE IS PROVIDED BY BLUEKITCHEN GMBH AND CONTRIBUTORS
|
||||||
|
* ``AS IS'' AND ANY EXPRESS OR IMPLIED WARRANTIES, INCLUDING, BUT NOT
|
||||||
|
* LIMITED TO, THE IMPLIED WARRANTIES OF MERCHANTABILITY AND FITNESS
|
||||||
|
* FOR A PARTICULAR PURPOSE ARE DISCLAIMED. IN NO EVENT SHALL MATTHIAS
|
||||||
|
* RINGWALD OR CONTRIBUTORS BE LIABLE FOR ANY DIRECT, INDIRECT,
|
||||||
|
* INCIDENTAL, SPECIAL, EXEMPLARY, OR CONSEQUENTIAL DAMAGES (INCLUDING,
|
||||||
|
* BUT NOT LIMITED TO, PROCUREMENT OF SUBSTITUTE GOODS OR SERVICES; LOSS
|
||||||
|
* OF USE, DATA, OR PROFITS; OR BUSINESS INTERRUPTION) HOWEVER CAUSED
|
||||||
|
* AND ON ANY THEORY OF LIABILITY, WHETHER IN CONTRACT, STRICT LIABILITY,
|
||||||
|
* OR TORT (INCLUDING NEGLIGENCE OR OTHERWISE) ARISING IN ANY WAY OUT OF
|
||||||
|
* THE USE OF THIS SOFTWARE, EVEN IF ADVISED OF THE POSSIBILITY OF
|
||||||
|
* SUCH DAMAGE.
|
||||||
|
*
|
||||||
|
* Please inquire about commercial licensing options at
|
||||||
|
* contact@bluekitchen-gmbh.com
|
||||||
|
*
|
||||||
|
*/
|
||||||
|
|
||||||
|
#define __BTSTACK_FILE__ "ublox_spp_service_server.c"
|
||||||
|
|
||||||
|
/**
|
||||||
|
* Implementation of the ublox SPP-like profile
|
||||||
|
*
|
||||||
|
* To use with your application, add '#import <ublox_spp_service.gatt' to your .gatt file
|
||||||
|
* and call all functions below. All strings and blobs need to stay valid after calling the functions.
|
||||||
|
*/
|
||||||
|
|
||||||
|
#include "btstack_defines.h"
|
||||||
|
#include "btstack_event.h"
|
||||||
|
#include "btstack_debug.h"
|
||||||
|
#include "btstack_util.h"
|
||||||
|
#include "bluetooth_gatt.h"
|
||||||
|
#include "hci.h"
|
||||||
|
#include "ble/att_db.h"
|
||||||
|
#include "ble/att_server.h"
|
||||||
|
#include "ble/gatt-service/ublox_spp_service_server.h"
|
||||||
|
|
||||||
|
#define UBLOX_SPP_MAX_CREDITS 16
|
||||||
|
#define UBLOX_SPP_CREDITS_THRESHOLD 8
|
||||||
|
|
||||||
|
//
|
||||||
|
static const uint8_t ublox_spp_profile_uuid128[] = { 0x24, 0x56, 0xE1, 0xB9, 0x26, 0xE2, 0x8F, 0x83, 0xE7, 0x44, 0xF3, 0x4F, 0x01, 0xE9, 0xD7, 0x01 };
|
||||||
|
static const uint8_t ublox_spp_fifo_uuid128[] = { 0x24, 0x56, 0xE1, 0xB9, 0x26, 0xE2, 0x8F, 0x83, 0xE7, 0x44, 0xF3, 0x4F, 0x01, 0xE9, 0xD7, 0x03 };
|
||||||
|
static const uint8_t ublox_spp_credits_uuid128[] = { 0x24, 0x56, 0xE1, 0xB9, 0x26, 0xE2, 0x8F, 0x83, 0xE7, 0x44, 0xF3, 0x4F, 0x01, 0xE9, 0xD7, 0x04 };
|
||||||
|
|
||||||
|
typedef struct {
|
||||||
|
hci_con_handle_t con_handle;
|
||||||
|
|
||||||
|
// characteristic: FIFO
|
||||||
|
uint16_t fifo_value_handle;
|
||||||
|
uint8_t data[20];
|
||||||
|
|
||||||
|
// characteristic descriptor: Client Characteristic Configuration
|
||||||
|
uint16_t fifo_client_configuration_descriptor_handle;
|
||||||
|
uint16_t fifo_client_configuration_descriptor_value; // none, notify or indicate;
|
||||||
|
btstack_context_callback_registration_t fifo_callback;
|
||||||
|
|
||||||
|
// characteristic: Flow control/credits
|
||||||
|
uint16_t credits_value_handle;
|
||||||
|
uint16_t incoming_credits;
|
||||||
|
uint16_t outgoing_credits;
|
||||||
|
uint8_t delta_credits;
|
||||||
|
|
||||||
|
// characteristic descriptor: Client Characteristic Configuration
|
||||||
|
uint16_t credits_client_configuration_descriptor_handle;
|
||||||
|
uint16_t credits_client_configuration_descriptor_value;
|
||||||
|
|
||||||
|
btstack_context_callback_registration_t credits_callback;
|
||||||
|
|
||||||
|
void (*client_data_callback)(hci_con_handle_t con_handle, const uint8_t * data, uint16_t size);
|
||||||
|
void (*client_credits_callback)(hci_con_handle_t con_handle, uint16_t credits);
|
||||||
|
|
||||||
|
// flow control
|
||||||
|
btstack_context_callback_registration_t * request;
|
||||||
|
} ublox_spp_service_t;
|
||||||
|
|
||||||
|
static att_service_handler_t ublox_spp_service;
|
||||||
|
static ublox_spp_service_t ublox_spp;
|
||||||
|
|
||||||
|
static int ublox_spp_service_flow_control_enabled(ublox_spp_service_t * instance){
|
||||||
|
return instance->credits_client_configuration_descriptor_value;
|
||||||
|
}
|
||||||
|
|
||||||
|
static ublox_spp_service_t * ublox_get_instance_for_con_handle(hci_con_handle_t con_handle){
|
||||||
|
ublox_spp_service_t * instance = &ublox_spp;
|
||||||
|
if (con_handle == HCI_CON_HANDLE_INVALID) return NULL;
|
||||||
|
instance->con_handle = con_handle;
|
||||||
|
return instance;
|
||||||
|
}
|
||||||
|
|
||||||
|
static inline void ublox_spp_service_init_credits(ublox_spp_service_t * instance){
|
||||||
|
instance->incoming_credits = 0;
|
||||||
|
instance->outgoing_credits = 0;
|
||||||
|
instance->delta_credits = UBLOX_SPP_MAX_CREDITS;
|
||||||
|
}
|
||||||
|
|
||||||
|
static uint16_t ublox_spp_service_read_callback(hci_con_handle_t con_handle, uint16_t attribute_handle, uint16_t offset, uint8_t * buffer, uint16_t buffer_size){
|
||||||
|
UNUSED(offset);
|
||||||
|
UNUSED(buffer_size);
|
||||||
|
ublox_spp_service_t * instance = ublox_get_instance_for_con_handle(con_handle);
|
||||||
|
if (!instance) return 0;
|
||||||
|
|
||||||
|
if (attribute_handle == instance->fifo_client_configuration_descriptor_handle){
|
||||||
|
if (buffer){
|
||||||
|
little_endian_store_16(buffer, 0, instance->fifo_client_configuration_descriptor_value);
|
||||||
|
}
|
||||||
|
return 2;
|
||||||
|
}
|
||||||
|
|
||||||
|
if (attribute_handle == instance->credits_client_configuration_descriptor_handle){
|
||||||
|
if (buffer){
|
||||||
|
little_endian_store_16(buffer, 0, instance->credits_client_configuration_descriptor_value);
|
||||||
|
}
|
||||||
|
return 2;
|
||||||
|
}
|
||||||
|
return 0;
|
||||||
|
}
|
||||||
|
|
||||||
|
|
||||||
|
static int ublox_spp_service_write_callback(hci_con_handle_t con_handle, uint16_t attribute_handle, uint16_t transaction_mode, uint16_t offset, uint8_t *buffer, uint16_t buffer_size){
|
||||||
|
UNUSED(transaction_mode);
|
||||||
|
UNUSED(offset);
|
||||||
|
ublox_spp_service_t * instance = ublox_get_instance_for_con_handle(con_handle);
|
||||||
|
if (!instance) return 0;
|
||||||
|
|
||||||
|
if (attribute_handle == instance->fifo_value_handle){
|
||||||
|
instance->client_data_callback(con_handle, &buffer[0], buffer_size);
|
||||||
|
if (!ublox_spp_service_flow_control_enabled(instance)) return 0;
|
||||||
|
if (!instance->incoming_credits) return 0;
|
||||||
|
instance->incoming_credits--;
|
||||||
|
if (instance->incoming_credits < UBLOX_SPP_CREDITS_THRESHOLD){
|
||||||
|
att_server_request_to_send_notification(&instance->credits_callback, instance->con_handle);
|
||||||
|
}
|
||||||
|
}
|
||||||
|
|
||||||
|
if (attribute_handle == instance->fifo_client_configuration_descriptor_handle){
|
||||||
|
if (buffer_size < 2){
|
||||||
|
return ATT_ERROR_INVALID_OFFSET;
|
||||||
|
}
|
||||||
|
instance->fifo_client_configuration_descriptor_value = little_endian_read_16(buffer, 0);
|
||||||
|
instance->client_data_callback(con_handle, NULL, 0);
|
||||||
|
}
|
||||||
|
|
||||||
|
if (attribute_handle == instance->credits_value_handle){
|
||||||
|
if (!ublox_spp_service_flow_control_enabled(instance)) return 0;
|
||||||
|
int8_t credits = (int8_t)buffer[0];
|
||||||
|
if (credits <= 0) return 0;
|
||||||
|
instance->outgoing_credits += credits;
|
||||||
|
if (instance->request){
|
||||||
|
btstack_context_callback_registration_t * request = instance->request;
|
||||||
|
instance->request = NULL;
|
||||||
|
att_server_request_to_send_notification(request, instance->con_handle);
|
||||||
|
}
|
||||||
|
}
|
||||||
|
|
||||||
|
if (attribute_handle == instance->credits_client_configuration_descriptor_handle){
|
||||||
|
if (buffer_size < 2){
|
||||||
|
return ATT_ERROR_INVALID_OFFSET;
|
||||||
|
}
|
||||||
|
instance->credits_client_configuration_descriptor_value = little_endian_read_16(buffer, 0);
|
||||||
|
|
||||||
|
ublox_spp_service_init_credits(instance);
|
||||||
|
if (instance->credits_client_configuration_descriptor_value){
|
||||||
|
att_server_request_to_send_notification(&instance->credits_callback, instance->con_handle);
|
||||||
|
}
|
||||||
|
}
|
||||||
|
|
||||||
|
return 0;
|
||||||
|
}
|
||||||
|
|
||||||
|
static void ublox_spp_credits_callback(void * context){
|
||||||
|
ublox_spp_service_t * instance = (ublox_spp_service_t *) context;
|
||||||
|
if (!instance) return;
|
||||||
|
|
||||||
|
instance->delta_credits = UBLOX_SPP_MAX_CREDITS - instance->incoming_credits;
|
||||||
|
if (instance->delta_credits){
|
||||||
|
instance->incoming_credits = UBLOX_SPP_MAX_CREDITS;
|
||||||
|
att_server_notify(instance->con_handle, instance->credits_value_handle, &instance->delta_credits, 1);
|
||||||
|
}
|
||||||
|
}
|
||||||
|
/**
|
||||||
|
* @brief Init ublox SPP Service Server with ATT DB
|
||||||
|
* @param callback for tx data from peer
|
||||||
|
*/
|
||||||
|
void ublox_spp_service_server_init(void (*client_data_callback)(hci_con_handle_t con_handle, const uint8_t * data, uint16_t size),
|
||||||
|
void (*client_credits_callback)(hci_con_handle_t con_handle, uint16_t credits)){
|
||||||
|
ublox_spp_service_t * instance = &ublox_spp;
|
||||||
|
instance->client_data_callback = client_data_callback;
|
||||||
|
instance->client_credits_callback = client_credits_callback;
|
||||||
|
|
||||||
|
instance->credits_callback.callback = ublox_spp_credits_callback;
|
||||||
|
instance->credits_callback.context = instance;
|
||||||
|
ublox_spp_service_init_credits(instance);
|
||||||
|
|
||||||
|
|
||||||
|
// get service handle range
|
||||||
|
uint16_t start_handle = 0;
|
||||||
|
uint16_t end_handle = 0xfff;
|
||||||
|
int service_found = gatt_server_get_get_handle_range_for_service_with_uuid128(ublox_spp_profile_uuid128, &start_handle, &end_handle);
|
||||||
|
if (!service_found) return;
|
||||||
|
|
||||||
|
// get characteristic value handle and client configuration handle
|
||||||
|
// FIFO
|
||||||
|
instance->fifo_value_handle = gatt_server_get_value_handle_for_characteristic_with_uuid128(start_handle, end_handle, ublox_spp_fifo_uuid128);
|
||||||
|
instance->fifo_client_configuration_descriptor_handle = gatt_server_get_client_configuration_handle_for_characteristic_with_uuid128(start_handle, end_handle, ublox_spp_fifo_uuid128);
|
||||||
|
// Credits
|
||||||
|
instance->credits_value_handle = gatt_server_get_value_handle_for_characteristic_with_uuid128(start_handle, end_handle, ublox_spp_credits_uuid128);
|
||||||
|
instance->credits_client_configuration_descriptor_handle = gatt_server_get_client_configuration_handle_for_characteristic_with_uuid128(start_handle, end_handle, ublox_spp_credits_uuid128);
|
||||||
|
|
||||||
|
log_info("FIFO value handle 0x%02x", instance->fifo_value_handle);
|
||||||
|
log_info("FIFO CCC value handle 0x%02x", instance->fifo_client_configuration_descriptor_handle);
|
||||||
|
log_info("Credits value handle 0x%02x", instance->credits_value_handle);
|
||||||
|
log_info("Credits CCC value handle 0x%02x", instance->credits_client_configuration_descriptor_handle);
|
||||||
|
|
||||||
|
// register service with ATT Server
|
||||||
|
ublox_spp_service.start_handle = start_handle;
|
||||||
|
ublox_spp_service.end_handle = end_handle;
|
||||||
|
ublox_spp_service.read_callback = &ublox_spp_service_read_callback;
|
||||||
|
ublox_spp_service.write_callback = &ublox_spp_service_write_callback;
|
||||||
|
att_server_register_service_handler(&ublox_spp_service);
|
||||||
|
}
|
||||||
|
|
||||||
|
/**
|
||||||
|
* @brief Queue send request. When called, one packet can be send via ublox_spp_service_send below
|
||||||
|
* @param request
|
||||||
|
* @param con_handle
|
||||||
|
*/
|
||||||
|
void ublox_spp_service_server_request_can_send_now(btstack_context_callback_registration_t * request, hci_con_handle_t con_handle){
|
||||||
|
ublox_spp_service_t * instance = &ublox_spp;
|
||||||
|
if (!ublox_spp_service_flow_control_enabled(instance) || instance->outgoing_credits) {
|
||||||
|
att_server_request_to_send_notification(request, con_handle);
|
||||||
|
return;
|
||||||
|
}
|
||||||
|
instance->request = request;
|
||||||
|
}
|
||||||
|
|
||||||
|
/**
|
||||||
|
* @brief Send data
|
||||||
|
* @param con_handle
|
||||||
|
* @param data
|
||||||
|
* @param size
|
||||||
|
*/
|
||||||
|
int ublox_spp_service_server_send(hci_con_handle_t con_handle, const uint8_t * data, uint16_t size){
|
||||||
|
ublox_spp_service_t * instance = &ublox_spp;
|
||||||
|
if (ublox_spp_service_flow_control_enabled(instance)){
|
||||||
|
if (instance->outgoing_credits > 0){
|
||||||
|
instance->outgoing_credits--;
|
||||||
|
}
|
||||||
|
}
|
||||||
|
return att_server_notify(con_handle, instance->fifo_value_handle, &data[0], size);
|
||||||
|
}
|
||||||
|
|
87
src/ble/gatt-service/ublox_spp_service_server.h
Normal file
87
src/ble/gatt-service/ublox_spp_service_server.h
Normal file
@ -0,0 +1,87 @@
|
|||||||
|
/*
|
||||||
|
* Copyright (C) 2018 BlueKitchen GmbH
|
||||||
|
*
|
||||||
|
* Redistribution and use in source and binary forms, with or without
|
||||||
|
* modification, are permitted provided that the following conditions
|
||||||
|
* are met:
|
||||||
|
*
|
||||||
|
* 1. Redistributions of source code must retain the above copyright
|
||||||
|
* notice, this list of conditions and the following disclaimer.
|
||||||
|
* 2. Redistributions in binary form must reproduce the above copyright
|
||||||
|
* notice, this list of conditions and the following disclaimer in the
|
||||||
|
* documentation and/or other materials provided with the distribution.
|
||||||
|
* 3. Neither the name of the copyright holders nor the names of
|
||||||
|
* contributors may be used to endorse or promote products derived
|
||||||
|
* from this software without specific prior written permission.
|
||||||
|
* 4. Any redistribution, use, or modification is done solely for
|
||||||
|
* personal benefit and not for any commercial purpose or for
|
||||||
|
* monetary gain.
|
||||||
|
*
|
||||||
|
* THIS SOFTWARE IS PROVIDED BY BLUEKITCHEN GMBH AND CONTRIBUTORS
|
||||||
|
* ``AS IS'' AND ANY EXPRESS OR IMPLIED WARRANTIES, INCLUDING, BUT NOT
|
||||||
|
* LIMITED TO, THE IMPLIED WARRANTIES OF MERCHANTABILITY AND FITNESS
|
||||||
|
* FOR A PARTICULAR PURPOSE ARE DISCLAIMED. IN NO EVENT SHALL MATTHIAS
|
||||||
|
* RINGWALD OR CONTRIBUTORS BE LIABLE FOR ANY DIRECT, INDIRECT,
|
||||||
|
* INCIDENTAL, SPECIAL, EXEMPLARY, OR CONSEQUENTIAL DAMAGES (INCLUDING,
|
||||||
|
* BUT NOT LIMITED TO, PROCUREMENT OF SUBSTITUTE GOODS OR SERVICES; LOSS
|
||||||
|
* OF USE, DATA, OR PROFITS; OR BUSINESS INTERRUPTION) HOWEVER CAUSED
|
||||||
|
* AND ON ANY THEORY OF LIABILITY, WHETHER IN CONTRACT, STRICT LIABILITY,
|
||||||
|
* OR TORT (INCLUDING NEGLIGENCE OR OTHERWISE) ARISING IN ANY WAY OUT OF
|
||||||
|
* THE USE OF THIS SOFTWARE, EVEN IF ADVISED OF THE POSSIBILITY OF
|
||||||
|
* SUCH DAMAGE.
|
||||||
|
*
|
||||||
|
* Please inquire about commercial licensing options at
|
||||||
|
* contact@bluekitchen-gmbh.com
|
||||||
|
*
|
||||||
|
*/
|
||||||
|
#ifndef __UBLOX_SPP_H
|
||||||
|
#define __UBLOX_SPP_H
|
||||||
|
|
||||||
|
#include <stdint.h>
|
||||||
|
#include "bluetooth.h"
|
||||||
|
#include "btstack_defines.h"
|
||||||
|
|
||||||
|
#if defined __cplusplus
|
||||||
|
extern "C" {
|
||||||
|
#endif
|
||||||
|
|
||||||
|
/* API_START */
|
||||||
|
|
||||||
|
/**
|
||||||
|
* Implementation of the ublox SPP-like profile
|
||||||
|
*
|
||||||
|
* To use with your application, add '#import <ublox_spp_service.gatt' to your .gatt file
|
||||||
|
* and call all functions below. All strings and blobs need to stay valid after calling the functions.
|
||||||
|
*/
|
||||||
|
|
||||||
|
/**
|
||||||
|
* @brief Init ublox SPP Service Server with ATT DB
|
||||||
|
* @param client_data_callback
|
||||||
|
* @param client_flow_control_callback
|
||||||
|
*/
|
||||||
|
void ublox_spp_service_server_init(void (*client_data_callback)(hci_con_handle_t con_handle, const uint8_t * data, uint16_t size),
|
||||||
|
void (*client_flow_control_callback)(hci_con_handle_t con_handle, uint16_t credits));
|
||||||
|
|
||||||
|
/**
|
||||||
|
* @brief Queue send request. When called, one packet can be send via ublox_spp_service_send below
|
||||||
|
* @param request
|
||||||
|
* @param con_handle
|
||||||
|
*/
|
||||||
|
void ublox_spp_service_server_request_can_send_now(btstack_context_callback_registration_t * request, hci_con_handle_t con_handle);
|
||||||
|
|
||||||
|
/**
|
||||||
|
* @brief Send data
|
||||||
|
* @param con_handle
|
||||||
|
* @param data
|
||||||
|
* @param size
|
||||||
|
*/
|
||||||
|
int ublox_spp_service_server_send(hci_con_handle_t con_handle, const uint8_t * data, uint16_t size);
|
||||||
|
|
||||||
|
/* API_END */
|
||||||
|
|
||||||
|
#if defined __cplusplus
|
||||||
|
}
|
||||||
|
#endif
|
||||||
|
|
||||||
|
#endif
|
||||||
|
|
Loading…
x
Reference in New Issue
Block a user