mirror/btstack
1
0
Fork 0
mirror of https://github.com/bluekitchen/btstack.git synced 2025-04-03 10:20:18 +00:00
Code Issues Packages Projects Releases Wiki Activity

ble server: added calculate bytes to copy

Browse Source
This commit is contained in:
mila@ringwald.ch 2014-07-04 15:17:38 +00:00
parent ff8c64ca60
commit 41f1a65d77
1 changed files with 55 additions and 53 deletions
Show Stats Download Patch File Download Diff File Expand all files Collapse all files

34
MSP-EXP430F5438-CC256x/example-ble/ble_server.c
View File

@ -115,13 +115,11 @@ void hexdump2(void *data, int size){
// enable LE, setup ADV data // enable LE, setup ADV data
static void app_packet_handler (uint8_t packet_type, uint16_t channel, uint8_t *packet, uint16_t size){ static void app_packet_handler (uint8_t packet_type, uint16_t channel, uint8_t *packet, uint16_t size){
if (packet_type != HCI_EVENT_PACKET) return;
bd_addr_t addr; bd_addr_t addr;
uint8_t adv_data[] = { 02, 01, 05, 03, 02, 0xf0, 0xff }; uint8_t adv_data[] = { 02, 01, 05, 03, 02, 0xf0, 0xff };
switch (packet_type) {
case HCI_EVENT_PACKET:
switch (packet[0]) { switch (packet[0]) {
case BTSTACK_EVENT_STATE: case BTSTACK_EVENT_STATE:
// bt stack activated, get started - set local name // bt stack activated, get started - set local name
if (packet[2] == HCI_STATE_WORKING) { if (packet[2] == HCI_STATE_WORKING) {
@ -157,8 +155,10 @@ static void app_packet_handler (uint8_t packet_type, uint16_t channel, uint8_t *
hci_send_cmd(&hci_le_set_advertise_enable, 1); hci_send_cmd(&hci_le_set_advertise_enable, 1);
break; break;
} }
default:
break;
} }
}
} }
// test profile // test profile
@ -196,17 +196,23 @@ static uint16_t get_write_att_value_len(uint16_t att_handle){
return value_len; return value_len;
} }
uint16_t att_read_callback(uint16_t con_handle, uint16_t att_handle, uint16_t offset, uint8_t * buffer, uint16_t buffer_size){ static uint16_t get_bytes_to_copy(uint16_t value_len, uint16_t offset){
printf("READ Callback, handle %04x\n", att_handle);
uint16_t value_len = get_att_read_value_len(att_handle);
if (!buffer) return value_len;
if (value_len <= offset ) return 0; if (value_len <= offset ) return 0;
uint16_t bytes_to_copy = value_len - offset; uint16_t bytes_to_copy = value_len - offset;
if (bytes_to_copy > buffer_size) { if (bytes_to_copy > buffer_size) {
bytes_to_copy = buffer-size; bytes_to_copy = buffer_size;
} }
return bytes_to_copy;
}
uint16_t att_read_callback(uint16_t con_handle, uint16_t att_handle, uint16_t offset, uint8_t * buffer, uint16_t buffer_size){
printf("READ Callback, handle %04x\n", att_handle);
uint16_t value_len = get_att_read_value_len(att_handle);
if (!buffer) return value_len;
uint16_t bytes_to_copy = get_bytes_to_copy(value_len, offset);
if (!bytes_to_copy) return 0;
switch(att_handle){ switch(att_handle){
case ATT_CHARACTERISTIC_FFF1_01_HANDLE: case ATT_CHARACTERISTIC_FFF1_01_HANDLE:
@ -224,12 +230,8 @@ static int att_write_callback(uint16_t con_handle, uint16_t att_handle, uint16_t
printf("WRITE Callback, handle %04x\n", att_handle); printf("WRITE Callback, handle %04x\n", att_handle);
uint16_t value_len = get_write_att_value_len(att_handle); uint16_t value_len = get_write_att_value_len(att_handle);
if (value_len <= offset ) return ATT_ERROR_INVALID_OFFSET; uint16_t bytes_to_copy = get_bytes_to_copy(value_len, offset);
if (!bytes_to_copy) return ATT_ERROR_INVALID_OFFSET;
uint16_t bytes_to_copy = value_len - offset;
if (bytes_to_copy > buffer_size) {
bytes_to_copy = buffer-size;
}
switch(att_handle){ switch(att_handle){
case ATT_CHARACTERISTIC_FFF1_01_HANDLE: case ATT_CHARACTERISTIC_FFF1_01_HANDLE: