Быстро переподключиться к устройству Bluetooth RFCOMM с помощью API сокета Linux

У меня есть очень простое клиентское приложение Bluetooth RFCOMM, которое пытается поддерживать поток Bluetooth с устройства Bluetooth, которое является преобразователем UART в Bluetooth. Мое желаемое поведение заключается в том, что когда Bluetooth-передатчик перезапускается (он может сделать это менее чем за 2 секунды), я могу вернуться к нему очень быстро. В настоящее время благодаря SO_RCVTIMEO я очень быстро отключаюсь, но попытка восстановить соединение приводит к нескольким секундам...

connect: Device or resource busy
Not connected
connect: Device or resource busy
Not connected
connect: Device or resource busy

... Сообщения. Это независимо от того, перезапускаю ли я свой процесс или нет. Вы можете себе представить, что это немного непрактично, если я хочу часто выключать свой Bluetooth-передатчик (перепрограммирование). Есть ли какие-либо параметры сокета или другие настройки Bluetooth, которые я мог бы изменить, чтобы исправить это поведение?

#include <sys/types.h>
#include <sys/socket.h>
#include <bluetooth/bluetooth.h>
#include <bluetooth/rfcomm.h>
#include <unistd.h>
#include <errno.h>

int connect_to_bluetooth( char const* btaddr )
{
   int sock = socket( AF_BLUETOOTH, SOCK_STREAM, BTPROTO_RFCOMM );
   if(sock < 0) {
       perror("socket");
       return -1;
   }
   bdaddr_t ba;
   struct sockaddr_rc addr;
   str2ba( btaddr, &ba );
   memset( &addr, 0, sizeof(addr) );
   addr.rc_family = AF_BLUETOOTH;
   memcpy( &(addr.rc_bdaddr), &ba, sizeof(ba) );
   addr.rc_channel = 1;
   int result = connect( sock, (struct sockaddr *)&addr, sizeof(addr ) );

   if(result == 0)
   {
       struct timeval tv;
       tv.tv_sec = 2;
       setsockopt(sock, SOL_SOCKET, SO_RCVTIMEO,(struct timeval *)&tv,sizeof(struct timeval));
       setsockopt(sock, SOL_SOCKET, SO_SNDTIMEO,(struct timeval *)&tv,sizeof(struct timeval));

       printf("Connected to %s\n", btaddr);
       return sock;
   }
   close(sock);
   printf("Not connected\n");
   perror("connect");
   return -1;
}


int main(int argc, char** argv)
{
    printf("Connect to bluetooth device\n");

    int sock;
    if(argc < 2)
        return 1;
    while( (sock = connect_to_bluetooth(argv[1])) == -1) usleep(500000);

    while(1)
    {
        char buf[128];
        ssize_t r = read(sock,buf, 128);
        if(r > 0)
        {
            write(0, buf, r); // write to stdout
        }
        else
        {
            perror("read");
            printf("Errno is %i\n", errno);
            close(sock);
            while( (sock = connect_to_bluetooth(argv[1])) == -1) {
                usleep(500000);
            }
        }
    }
    return 0;
}

0 ответов

Другие вопросы по тегам