mirror/btstack
1
0
Fork 0
mirror of https://github.com/bluekitchen/btstack.git synced 2025-03-28 08:37:22 +00:00
Code Issues Packages Projects Releases Wiki Activity

em9301: support vendor specific set baudrate command

Browse Source
This commit is contained in:
Matthias Ringwald 2017-07-25 17:09:38 +02:00
parent 688f976463
commit d40c3de009
1 changed files with 38 additions and 2 deletions
Show Stats Download Patch File Download Diff File Expand all files Collapse all files

40
chipset/em9301/btstack_chipset_em9301.c
View File

@ -47,15 +47,32 @@
#include "btstack_config.h" #include "btstack_config.h"
#include "btstack_chipset_em9301.h" #include "btstack_chipset_em9301.h"
#include "btstack_debug.h"
#include <stddef.h> /* NULL */ #include <stddef.h> /* NULL */
#include <stdio.h>
#include <string.h> /* memcpy */ #include <string.h> /* memcpy */
#include "hci.h" #include "hci.h"
// should go to some common place // should go to some common place
#define OPCODE(ogf, ocf) (ocf | ogf << 10) #define OPCODE(ogf, ocf) (ocf | ogf << 10)
static const uint32_t baudrates[] = {
0,
0,
0,
9600,
14400,
19200,
28800,
38400,
57600,
76800,
115200,
230400,
460800,
921600,
1843200,
};
static void chipset_set_bd_addr_command(bd_addr_t addr, uint8_t *hci_cmd_buffer){ static void chipset_set_bd_addr_command(bd_addr_t addr, uint8_t *hci_cmd_buffer){
little_endian_store_16(hci_cmd_buffer, 0, OPCODE(OGF_VENDOR, 0x02)); little_endian_store_16(hci_cmd_buffer, 0, OPCODE(OGF_VENDOR, 0x02));
@ -63,11 +80,30 @@ static void chipset_set_bd_addr_command(bd_addr_t addr, uint8_t *hci_cmd_buffer)
reverse_bd_addr(addr, &hci_cmd_buffer[3]); reverse_bd_addr(addr, &hci_cmd_buffer[3]);
} }
static void chipset_set_baudrate_command(uint32_t baudrate, uint8_t *hci_cmd_buffer){
// lookup baudrates
int i;
int found;
for (i=0;i < sizeof(baudrates)/sizeof(uint32_t);i++){
if (baudrates[i] == baudrate){
found = i;
break;
}
}
if (!found){
log_error("Baudrate %u not found in table", baudrate);
return;
}
little_endian_store_16(hci_cmd_buffer, 0, OPCODE(OGF_VENDOR, 0x07));
hci_cmd_buffer[2] = 0x01;
hci_cmd_buffer[3] = i;
}
static const btstack_chipset_t btstack_chipset_em9301 = { static const btstack_chipset_t btstack_chipset_em9301 = {
"EM9301", "EM9301",
NULL, // chipset_init not used NULL, // chipset_init not used
NULL, // chipset_next_command not used NULL, // chipset_next_command not used
NULL, // chipset_set_baudrate_command not needed as we're connected via SPI chipset_set_baudrate_command,
chipset_set_bd_addr_command, chipset_set_bd_addr_command,
}; };