mirror of
https://github.com/bluekitchen/btstack.git
synced 2025-04-10 06:44:32 +00:00
btstack_uart_block_posix: inline btstack_uart_posix
This commit is contained in:
parent
b52fe0206e
commit
b300903afd
@ -43,16 +43,16 @@
|
||||
*/
|
||||
|
||||
#include "btstack_uart_block.h"
|
||||
#include "btstack_uart_posix.h"
|
||||
#include "btstack_debug.h"
|
||||
|
||||
#include <termios.h> /* POSIX terminal control definitions */
|
||||
#include <fcntl.h> /* File control definitions */
|
||||
#include <unistd.h> /* UNIX standard function definitions */
|
||||
// #include <stdio.h>
|
||||
// #include <string.h>
|
||||
|
||||
// uart config
|
||||
static const hci_transport_config_uart_t * uart_config;
|
||||
|
||||
// data source for integration with BTstack Runloop
|
||||
static btstack_data_source_t transport_data_source;
|
||||
|
||||
// block write
|
||||
@ -67,6 +67,12 @@ static uint8_t * read_bytes_data;
|
||||
static void (*block_sent)(void);
|
||||
static void (*block_received)(void);
|
||||
|
||||
|
||||
static int btstack_uart_posix_init(const hci_transport_config_uart_t * config){
|
||||
uart_config = config;
|
||||
return 0;
|
||||
}
|
||||
|
||||
static void btstack_uart_posix_process_write(btstack_data_source_t *ds) {
|
||||
|
||||
if (write_bytes_len == 0) return;
|
||||
@ -144,18 +150,122 @@ static void hci_transport_h5_process(btstack_data_source_t *ds, btstack_data_sou
|
||||
}
|
||||
}
|
||||
|
||||
static int btstack_uart_posix_init(const hci_transport_config_uart_t * config){
|
||||
uart_config = config;
|
||||
static int btstack_uart_posix_set_baudrate(uint32_t baudrate){
|
||||
|
||||
int fd = transport_data_source.fd;
|
||||
|
||||
log_info("h4_set_baudrate %u", baudrate);
|
||||
|
||||
struct termios toptions;
|
||||
|
||||
if (tcgetattr(fd, &toptions) < 0) {
|
||||
perror("posix_open: Couldn't get term attributes");
|
||||
return -1;
|
||||
}
|
||||
|
||||
speed_t brate = baudrate; // let you override switch below if needed
|
||||
switch(baudrate) {
|
||||
case 57600: brate=B57600; break;
|
||||
case 115200: brate=B115200; break;
|
||||
#ifdef B230400
|
||||
case 230400: brate=B230400; break;
|
||||
#endif
|
||||
#ifdef B460800
|
||||
case 460800: brate=B460800; break;
|
||||
#endif
|
||||
#ifdef B921600
|
||||
case 921600: brate=B921600; break;
|
||||
#endif
|
||||
|
||||
// Hacks to switch to 2/3 mbps on FTDI FT232 chipsets
|
||||
// requires special config in Info.plist or Registry
|
||||
case 2000000:
|
||||
#if defined(HAVE_POSIX_B300_MAPPED_TO_2000000)
|
||||
log_info("hci_transport_posix: using B300 for 2 mbps");
|
||||
brate=B300;
|
||||
#elif defined(HAVE_POSIX_B1200_MAPPED_TO_2000000)
|
||||
log_info("hci_transport_posix: using B1200 for 2 mbps");
|
||||
brate=B1200;
|
||||
#endif
|
||||
break;
|
||||
case 3000000:
|
||||
#if defined(HAVE_POSIX_B600_MAPPED_TO_3000000)
|
||||
log_info("hci_transport_posix: using B600 for 3 mbps");
|
||||
brate=B600;
|
||||
#elif defined(HAVE_POSIX_B2400_MAPPED_TO_3000000)
|
||||
log_info("hci_transport_posix: using B2400 for 3 mbps");
|
||||
brate=B2400;
|
||||
#endif
|
||||
break;
|
||||
default:
|
||||
break;
|
||||
}
|
||||
cfsetospeed(&toptions, brate);
|
||||
cfsetispeed(&toptions, brate);
|
||||
|
||||
if( tcsetattr(fd, TCSANOW, &toptions) < 0) {
|
||||
perror("posix_set_baudrate: Couldn't set term attributes");
|
||||
return -1;
|
||||
}
|
||||
|
||||
return 0;
|
||||
}
|
||||
|
||||
static int btstack_uart_posix_open_new(void){
|
||||
static int btstack_uart_posix_open(void){
|
||||
|
||||
int fd = btstack_uart_posix_open(uart_config->device_name, uart_config->flowcontrol, uart_config->baudrate_init);
|
||||
if (fd < 0){
|
||||
return fd;
|
||||
const char * device_name = uart_config->device_name;
|
||||
const int flowcontrol = uart_config->flowcontrol;
|
||||
const uint32_t baudrate = uart_config->baudrate_init;
|
||||
|
||||
struct termios toptions;
|
||||
int flags = O_RDWR | O_NOCTTY | O_NONBLOCK;
|
||||
int fd = open(device_name, flags);
|
||||
if (fd == -1) {
|
||||
perror("posix_open: Unable to open port ");
|
||||
perror(device_name);
|
||||
return -1;
|
||||
}
|
||||
|
||||
if (tcgetattr(fd, &toptions) < 0) {
|
||||
perror("posix_open: Couldn't get term attributes");
|
||||
return -1;
|
||||
}
|
||||
|
||||
cfmakeraw(&toptions); // make raw
|
||||
|
||||
// 8N1
|
||||
toptions.c_cflag &= ~CSTOPB;
|
||||
toptions.c_cflag |= CS8;
|
||||
|
||||
// 8E1
|
||||
// toptions.c_cflag |= PARENB; // enable even parity
|
||||
//
|
||||
|
||||
if (flowcontrol) {
|
||||
// with flow control
|
||||
toptions.c_cflag |= CRTSCTS;
|
||||
} else {
|
||||
// no flow control
|
||||
toptions.c_cflag &= ~CRTSCTS;
|
||||
}
|
||||
|
||||
toptions.c_cflag |= CREAD | CLOCAL; // turn on READ & ignore ctrl lines
|
||||
toptions.c_iflag &= ~(IXON | IXOFF | IXANY); // turn off s/w flow ctrl
|
||||
|
||||
// see: http://unixwiz.net/techtips/termios-vmin-vtime.html
|
||||
toptions.c_cc[VMIN] = 1;
|
||||
toptions.c_cc[VTIME] = 0;
|
||||
|
||||
if(tcsetattr(fd, TCSANOW, &toptions) < 0) {
|
||||
perror("posix_open: Couldn't set term attributes");
|
||||
return -1;
|
||||
}
|
||||
|
||||
// also set baudrate
|
||||
if (btstack_uart_posix_set_baudrate(baudrate) < 0){
|
||||
return -1;
|
||||
}
|
||||
|
||||
// set up data_source
|
||||
btstack_run_loop_set_data_source_fd(&transport_data_source, fd);
|
||||
btstack_run_loop_set_data_source_handler(&transport_data_source, &hci_transport_h5_process);
|
||||
@ -183,12 +293,25 @@ static void btstack_uart_posix_set_block_sent( void (*block_handler)(void)){
|
||||
block_sent = block_handler;
|
||||
}
|
||||
|
||||
static int btstack_uart_posix_set_baudrate_new(uint32_t baudrate){
|
||||
return btstack_uart_posix_set_baudrate(transport_data_source.fd, baudrate);
|
||||
}
|
||||
static int btstack_uart_posix_set_parity(int parity){
|
||||
|
||||
static int btstack_uart_posix_set_parity_new(int parity){
|
||||
return btstack_uart_posix_set_parity(transport_data_source.fd, parity);
|
||||
int fd = transport_data_source.fd;
|
||||
|
||||
struct termios toptions;
|
||||
if (tcgetattr(fd, &toptions) < 0) {
|
||||
perror("posix_set_parity: Couldn't get term attributes");
|
||||
return -1;
|
||||
}
|
||||
if (parity){
|
||||
toptions.c_cflag |= PARENB; // enable even parity
|
||||
} else {
|
||||
toptions.c_cflag &= ~PARENB; // enable even parity
|
||||
}
|
||||
if(tcsetattr(fd, TCSANOW, &toptions) < 0) {
|
||||
perror("posix_set_parity: Couldn't set term attributes");
|
||||
return -1;
|
||||
}
|
||||
return 0;
|
||||
}
|
||||
|
||||
static void btstack_uart_posix_send_block(const uint8_t *data, uint16_t size){
|
||||
@ -217,12 +340,12 @@ static void btstack_uart_posix_receive_block(uint8_t *buffer, uint16_t len){
|
||||
|
||||
static const btstack_uart_block_t btstack_uart_posix = {
|
||||
/* int (*init)(hci_transport_config_uart_t * config); */ &btstack_uart_posix_init,
|
||||
/* int (*open)(void); */ &btstack_uart_posix_open_new,
|
||||
/* int (*open)(void); */ &btstack_uart_posix_open,
|
||||
/* int (*close)(void); */ &btstack_uart_posix_close_new,
|
||||
/* void (*set_block_received)(void (*handler)(void)); */ &btstack_uart_posix_set_block_received,
|
||||
/* void (*set_block_sent)(void (*handler)(void)); */ &btstack_uart_posix_set_block_sent,
|
||||
/* int (*set_baudrate)(uint32_t baudrate); */ &btstack_uart_posix_set_baudrate_new,
|
||||
/* int (*set_parity)(int parity); */ &btstack_uart_posix_set_parity_new,
|
||||
/* int (*set_baudrate)(uint32_t baudrate); */ &btstack_uart_posix_set_baudrate,
|
||||
/* int (*set_parity)(int parity); */ &btstack_uart_posix_set_parity,
|
||||
/* void (*receive_block)(uint8_t *buffer, uint16_t len); */ &btstack_uart_posix_receive_block,
|
||||
/* void (*send_block)(const uint8_t *buffer, uint16_t length); */ &btstack_uart_posix_send_block
|
||||
};
|
||||
|
@ -1,199 +0,0 @@
|
||||
/*
|
||||
* Copyright (C) 2016 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
|
||||
*
|
||||
*/
|
||||
|
||||
/*
|
||||
* btstack_uart_posix.c
|
||||
*
|
||||
* Common code to access serial port via POSIX interface
|
||||
* Used by hci_transport_h4_posix.c and hci_transport_h5.posix
|
||||
*
|
||||
*/
|
||||
|
||||
#include "btstack_uart_posix.h"
|
||||
#include "btstack_debug.h"
|
||||
|
||||
#include <termios.h> /* POSIX terminal control definitions */
|
||||
#include <fcntl.h> /* File control definitions */
|
||||
#include <unistd.h> /* UNIX standard function definitions */
|
||||
// #include <stdio.h>
|
||||
// #include <string.h>
|
||||
|
||||
int btstack_uart_posix_open(const char * device_name, int flowcontrol, uint32_t baudrate){
|
||||
|
||||
struct termios toptions;
|
||||
int flags = O_RDWR | O_NOCTTY | O_NONBLOCK;
|
||||
int fd = open(device_name, flags);
|
||||
if (fd == -1) {
|
||||
perror("posix_open: Unable to open port ");
|
||||
perror(device_name);
|
||||
return -1;
|
||||
}
|
||||
|
||||
if (tcgetattr(fd, &toptions) < 0) {
|
||||
perror("posix_open: Couldn't get term attributes");
|
||||
return -1;
|
||||
}
|
||||
|
||||
cfmakeraw(&toptions); // make raw
|
||||
|
||||
// 8N1
|
||||
toptions.c_cflag &= ~CSTOPB;
|
||||
toptions.c_cflag |= CS8;
|
||||
|
||||
// 8E1
|
||||
// toptions.c_cflag |= PARENB; // enable even parity
|
||||
//
|
||||
|
||||
if (flowcontrol) {
|
||||
// with flow control
|
||||
toptions.c_cflag |= CRTSCTS;
|
||||
} else {
|
||||
// no flow control
|
||||
toptions.c_cflag &= ~CRTSCTS;
|
||||
}
|
||||
|
||||
toptions.c_cflag |= CREAD | CLOCAL; // turn on READ & ignore ctrl lines
|
||||
toptions.c_iflag &= ~(IXON | IXOFF | IXANY); // turn off s/w flow ctrl
|
||||
|
||||
// see: http://unixwiz.net/techtips/termios-vmin-vtime.html
|
||||
toptions.c_cc[VMIN] = 1;
|
||||
toptions.c_cc[VTIME] = 0;
|
||||
|
||||
if(tcsetattr(fd, TCSANOW, &toptions) < 0) {
|
||||
perror("posix_open: Couldn't set term attributes");
|
||||
return -1;
|
||||
}
|
||||
|
||||
// also set baudrate
|
||||
if (btstack_uart_posix_set_baudrate(fd, baudrate) < 0){
|
||||
return -1;
|
||||
}
|
||||
|
||||
return fd;
|
||||
}
|
||||
|
||||
int btstack_uart_posix_set_baudrate(int fd, uint32_t baudrate){
|
||||
log_info("h4_set_baudrate %u", baudrate);
|
||||
|
||||
struct termios toptions;
|
||||
|
||||
if (tcgetattr(fd, &toptions) < 0) {
|
||||
perror("posix_open: Couldn't get term attributes");
|
||||
return -1;
|
||||
}
|
||||
|
||||
speed_t brate = baudrate; // let you override switch below if needed
|
||||
switch(baudrate) {
|
||||
case 57600: brate=B57600; break;
|
||||
case 115200: brate=B115200; break;
|
||||
#ifdef B230400
|
||||
case 230400: brate=B230400; break;
|
||||
#endif
|
||||
#ifdef B460800
|
||||
case 460800: brate=B460800; break;
|
||||
#endif
|
||||
#ifdef B921600
|
||||
case 921600: brate=B921600; break;
|
||||
#endif
|
||||
|
||||
// Hacks to switch to 2/3 mbps on FTDI FT232 chipsets
|
||||
// requires special config in Info.plist or Registry
|
||||
case 2000000:
|
||||
#if defined(HAVE_POSIX_B300_MAPPED_TO_2000000)
|
||||
log_info("hci_transport_posix: using B300 for 2 mbps");
|
||||
brate=B300;
|
||||
#elif defined(HAVE_POSIX_B1200_MAPPED_TO_2000000)
|
||||
log_info("hci_transport_posix: using B1200 for 2 mbps");
|
||||
brate=B1200;
|
||||
#endif
|
||||
break;
|
||||
case 3000000:
|
||||
#if defined(HAVE_POSIX_B600_MAPPED_TO_3000000)
|
||||
log_info("hci_transport_posix: using B600 for 3 mbps");
|
||||
brate=B600;
|
||||
#elif defined(HAVE_POSIX_B2400_MAPPED_TO_3000000)
|
||||
log_info("hci_transport_posix: using B2400 for 3 mbps");
|
||||
brate=B2400;
|
||||
#endif
|
||||
break;
|
||||
default:
|
||||
break;
|
||||
}
|
||||
cfsetospeed(&toptions, brate);
|
||||
cfsetispeed(&toptions, brate);
|
||||
|
||||
if( tcsetattr(fd, TCSANOW, &toptions) < 0) {
|
||||
perror("posix_set_baudrate: Couldn't set term attributes");
|
||||
return -1;
|
||||
}
|
||||
|
||||
return 0;
|
||||
}
|
||||
|
||||
int btstack_uart_posix_set_parity(int fd, int parity){
|
||||
struct termios toptions;
|
||||
if (tcgetattr(fd, &toptions) < 0) {
|
||||
perror("posix_set_parity: Couldn't get term attributes");
|
||||
return -1;
|
||||
}
|
||||
if (parity){
|
||||
toptions.c_cflag |= PARENB; // enable even parity
|
||||
} else {
|
||||
toptions.c_cflag &= ~PARENB; // enable even parity
|
||||
}
|
||||
if(tcsetattr(fd, TCSANOW, &toptions) < 0) {
|
||||
perror("posix_set_parity: Couldn't set term attributes");
|
||||
return -1;
|
||||
}
|
||||
return 0;
|
||||
}
|
||||
|
||||
// Generic helper
|
||||
void btstack_uart_posix_write(int fd, const uint8_t * data, int size){
|
||||
// log_info("btstack_uart_posix_write (%u bytes)", size);
|
||||
// log_info_hexdump(data, size);
|
||||
while (size > 0) {
|
||||
int bytes_written = write(fd, data, size);
|
||||
if (bytes_written < 0) {
|
||||
usleep(5000);
|
||||
continue;
|
||||
}
|
||||
data += bytes_written;
|
||||
size -= bytes_written;
|
||||
}
|
||||
}
|
||||
|
@ -1,84 +0,0 @@
|
||||
/*
|
||||
* Copyright (C) 2016 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
|
||||
*
|
||||
*/
|
||||
|
||||
/*
|
||||
* btstack_uart_posix.h
|
||||
*
|
||||
* Common code to access serial port via POSIX interface
|
||||
* Used by hci_transport_h4_posix.c and hci_transport_h5.posix
|
||||
*
|
||||
*/
|
||||
|
||||
#ifndef __BTSTACK_UART_POSIX_H
|
||||
#define __BTSTACK_UART_POSIX_H
|
||||
|
||||
#include <stdint.h>
|
||||
|
||||
/**
|
||||
* @brief Open serial port
|
||||
* @param device_name
|
||||
* @param flowcontrol enabled
|
||||
* @param baudrate
|
||||
* @returns fd if successful
|
||||
*/
|
||||
int btstack_uart_posix_open(const char * device_name, int flowcontrol, uint32_t baudrate);
|
||||
|
||||
/**
|
||||
* @brief Set Baudrate
|
||||
* @param fd
|
||||
* @param baudrate
|
||||
* @returns 0 if successful
|
||||
*/
|
||||
int btstack_uart_posix_set_baudrate(int fd, uint32_t baudrate);
|
||||
|
||||
/**
|
||||
* @brief Set Parity
|
||||
* @param fd
|
||||
* @param parity
|
||||
* @returns 0 if successful
|
||||
*/
|
||||
int btstack_uart_posix_set_parity(int fd, int parity);
|
||||
|
||||
/**
|
||||
* @brief Blocking write
|
||||
* @param fd
|
||||
* @param data
|
||||
* @param size
|
||||
*/
|
||||
void btstack_uart_posix_write(int fd, const uint8_t * data, int size);
|
||||
|
||||
#endif
|
@ -55,7 +55,6 @@
|
||||
#include "btstack_debug.h"
|
||||
#include "hci.h"
|
||||
#include "hci_transport.h"
|
||||
#include "btstack_uart_posix.h"
|
||||
#include "btstack_uart_block.h"
|
||||
|
||||
#ifdef HAVE_EHCILL
|
||||
|
@ -53,7 +53,6 @@
|
||||
#include "btstack_slip.h"
|
||||
#include "btstack_debug.h"
|
||||
#include "hci_transport.h"
|
||||
#include "btstack_uart_posix.h"
|
||||
#include "btstack_uart_block.h"
|
||||
|
||||
#ifdef HAVE_EHCILL
|
||||
|
@ -39,7 +39,6 @@ libBTstack_SOURCES = \
|
||||
|
||||
BTdaemon_SOURCES = \
|
||||
daemon.c \
|
||||
btstack_uart_posix.c \
|
||||
btstack_uart_block_posix.c \
|
||||
hci_transport_h4_posix.c \
|
||||
$(libBTstack_SOURCES) \
|
||||
|
@ -10,7 +10,6 @@ CORE += \
|
||||
btstack_chipset_tc3566x.c \
|
||||
btstack_link_key_db_fs.c \
|
||||
btstack_run_loop_posix.c \
|
||||
btstack_uart_posix.c \
|
||||
btstack_uart_block_posix.c \
|
||||
hci_transport_h4_posix.c \
|
||||
main.c \
|
||||
|
Loading…
x
Reference in New Issue
Block a user