#include <linux/sockios.h>
#include <time.h>
#include <inttypes.h>
+#include <sys/wait.h>
#include "lib/bluetooth.h"
#include "lib/hci.h"
#define SEC_USEC(_t) (_t * 1000000L)
#define TS_USEC(_ts) (SEC_USEC((_ts)->tv_sec) + NSEC_USEC((_ts)->tv_nsec))
+#define DEFAULT_BIG_ID 0x01
+#define DEFAULT_BIS_ID 0x01
+
/* Test modes */
enum {
SEND,
struct bt_iso_qos *iso_qos;
static bool inout;
+static uint8_t num_bis = 1;
+
struct lookup_table {
const char *name;
int flag;
struct sockaddr_iso addr;
int sk;
- mgmt_set_experimental();
-
/* Create socket */
sk = socket(PF_BLUETOOTH, SOCK_SEQPACKET, BTPROTO_ISO);
if (sk < 0) {
return -1;
}
+static int *bcast_do_connect_mbis(uint8_t count, char *peer)
+{
+ int *sk;
+ uint8_t sk_cnt = 0;
+
+ sk = malloc(count * sizeof(*sk));
+ if (!sk) {
+ syslog(LOG_ERR, "Can't allocate socket array");
+ return NULL;
+ }
+
+ defer_setup = 1;
+
+ for (int i = 0; i < count; i++) {
+ if (i == count - 1)
+ defer_setup = 0;
+
+ sk[i] = do_connect(peer);
+ if (sk[i] < 0) {
+ syslog(LOG_ERR, "Can't create socket: %s (%d)",
+ strerror(errno), errno);
+
+ goto error;
+ }
+
+ sk_cnt++;
+ }
+
+ return sk;
+
+error:
+ for (int i = 0; i < sk_cnt; i++)
+ close(sk[i]);
+
+ free(sk);
+ return NULL;
+
+}
+
static void do_listen(char *filename, void (*handler)(int fd, int sk),
char *peer)
{
if (peer) {
str2ba(peer, &addr->iso_bc->bc_bdaddr);
addr->iso_bc->bc_bdaddr_type = bdaddr_type;
- addr->iso_bc->bc_num_bis = 1;
- addr->iso_bc->bc_bis[0] = 1;
+ addr->iso_bc->bc_num_bis = num_bis;
+
+ for (int i = 0; i < num_bis; i++)
+ addr->iso_bc->bc_bis[i] = i + 1;
+
optlen += sizeof(*addr->iso_bc);
}
strerror(errno), errno);
if (errno != ENOTCONN)
return;
+
r = 0;
}
return len;
}
-static void do_send(int sk, int fd, struct bt_iso_io_qos *out, uint32_t num,
- bool repeat)
+static void do_send(int sk, int fd, char *peer, bool repeat)
{
uint32_t seq;
struct timespec t_start;
- int len, used;
+ int send_len, used;
+ socklen_t len;
+ struct bt_iso_qos qos;
+ uint32_t num;
+ struct bt_iso_io_qos *out;
+
+ syslog(LOG_INFO, "Sending ...");
+
+ /* Read QoS */
+ if (!strcmp(peer, "00:00:00:00:00:00"))
+ out = &qos.bcast.out;
+ else
+ out = &qos.ucast.out;
+
+ memset(&qos, 0, sizeof(qos));
+ len = sizeof(qos);
+ if (getsockopt(sk, SOL_BLUETOOTH, BT_ISO_QOS, &qos, &len) < 0) {
+ syslog(LOG_ERR, "Can't get Output QoS socket option: %s (%d)",
+ strerror(errno), errno);
+ out->sdu = ISO_DEFAULT_MTU;
+ }
+
+ /* num of packets = latency (ms) / interval (us) */
+ num = (out->latency * 1000 / out->interval);
+
+ syslog(LOG_INFO, "Number of packets: %d", num);
+
+ if (!sndbuf)
+ /* Use socket buffer as a jitter buffer for the entire buffer
+ * latency:
+ * jitter buffer = 2 * (SDU * subevents)
+ */
+ sndbuf = 2 * ((out->latency * 1000 / out->interval) *
+ out->sdu);
+
+ len = sizeof(sndbuf);
+ if (setsockopt(sk, SOL_SOCKET, SO_SNDBUF, &sndbuf, len) < 0) {
+ syslog(LOG_ERR, "Can't set socket SO_SNDBUF option: %s (%d)",
+ strerror(errno), errno);
+ }
+
+ syslog(LOG_INFO, "Socket jitter buffer: %d buffer", sndbuf);
+
+ if (sndto.tv_usec) {
+ len = sizeof(sndto);
+ if (setsockopt(sk, SOL_SOCKET, SO_SNDTIMEO, &sndto, len) < 0) {
+ syslog(LOG_ERR, "Can't set socket SO_SNDTIMEO option: "
+ "%s (%d)", strerror(errno), errno);
+ } else {
+ syslog(LOG_INFO, "Socket send timeout: %ld usec",
+ sndto.tv_usec);
+ }
+ }
+
+ for (int i = 6; i < out->sdu; i++)
+ buf[i] = 0x7f;
if (clock_gettime(CLOCK_MONOTONIC, &t_start) < 0) {
perror("clock_gettime");
for (seq = 0; ; seq++) {
if (fd >= 0) {
- len = read_file(fd, out->sdu, repeat);
- if (len < 0) {
+ send_len = read_file(fd, out->sdu, repeat);
+ if (send_len < 0) {
syslog(LOG_ERR, "read failed: %s (%d)",
- strerror(-len), -len);
+ strerror(-send_len), -send_len);
exit(1);
}
} else
- len = out->sdu;
+ send_len = out->sdu;
- len = send(sk, buf, len, 0);
- if (len <= 0) {
+ send_len = send(sk, buf, send_len, 0);
+ if (send_len <= 0) {
syslog(LOG_ERR, "send failed: %s (%d)",
strerror(errno), errno);
exit(1);
if (!quiet)
syslog(LOG_INFO,
"[seq %d] %d bytes buffered %d (%d bytes)",
- seq, len, used / len, used);
+ seq, send_len, used / send_len, used);
if (seq && !((seq + 1) % num))
send_wait(&t_start, num * out->interval);
static void send_mode(char *filename, char *peer, int i, bool repeat)
{
- struct bt_iso_qos qos;
- socklen_t len;
int sk, fd = -1;
- uint32_t num;
- struct bt_iso_io_qos *out;
+ int *sk_arr;
+ uint8_t nconn = strcmp(peer, "00:00:00:00:00:00") ? 1 : num_bis;
+
+ mgmt_set_experimental();
if (filename) {
char altername[PATH_MAX];
fd = open_file(filename);
}
+ if (nconn > 1) {
+ sk_arr = bcast_do_connect_mbis(nconn, peer);
+ if (!sk_arr)
+ exit(1);
+
+ for (int i = 0; i < nconn; i++) {
+ if (fork()) {
+ /* Parent */
+ continue;
+ }
+
+ /* Child */
+ do_send(sk_arr[i], fd, peer, repeat);
+ exit(0);
+ }
+
+ /* Wait for children to exit */
+ while (wait(NULL) > 0)
+ ;
+
+ for (int i = 0; i < nconn; i++)
+ close(sk_arr[i]);
+
+ free(sk_arr);
+ return;
+ }
+
sk = do_connect(peer);
if (sk < 0) {
syslog(LOG_ERR, "Can't connect to the server: %s (%d)",
sleep(abs(defer_setup) - 1);
}
- syslog(LOG_INFO, "Sending ...");
-
- /* Read QoS */
- if (!strcmp(peer, "00:00:00:00:00:00"))
- out = &qos.bcast.out;
- else
- out = &qos.ucast.out;
-
- memset(&qos, 0, sizeof(qos));
- len = sizeof(qos);
- if (getsockopt(sk, SOL_BLUETOOTH, BT_ISO_QOS, &qos, &len) < 0) {
- syslog(LOG_ERR, "Can't get Output QoS socket option: %s (%d)",
- strerror(errno), errno);
- out->sdu = ISO_DEFAULT_MTU;
- }
-
- /* num of packets = latency (ms) / interval (us) */
- num = (out->latency * 1000 / out->interval);
-
- syslog(LOG_INFO, "Number of packets: %d", num);
-
- if (!sndbuf)
- /* Use socket buffer as a jitter buffer for the entire buffer
- * latency:
- * jitter buffer = 2 * (SDU * subevents)
- */
- sndbuf = 2 * ((out->latency * 1000 / out->interval) *
- out->sdu);
-
- len = sizeof(sndbuf);
- if (setsockopt(sk, SOL_SOCKET, SO_SNDBUF, &sndbuf, len) < 0) {
- syslog(LOG_ERR, "Can't set socket SO_SNDBUF option: %s (%d)",
- strerror(errno), errno);
- }
-
- syslog(LOG_INFO, "Socket jitter buffer: %d buffer", sndbuf);
-
- if (sndto.tv_usec) {
- len = sizeof(sndto);
- if (setsockopt(sk, SOL_SOCKET, SO_SNDTIMEO, &sndto, len) < 0) {
- syslog(LOG_ERR, "Can't set socket SO_SNDTIMEO option: "
- "%s (%d)", strerror(errno), errno);
- } else {
- syslog(LOG_INFO, "Socket send timeout: %ld usec",
- sndto.tv_usec);
- }
- }
-
- for (i = 6; i < out->sdu; i++)
- buf[i] = 0x7f;
-
- do_send(sk, fd, out, num, repeat);
+ do_send(sk, fd, peer, repeat);
}
static void reconnect_mode(char *peer)
{
+ mgmt_set_experimental();
+
while (1) {
int sk;
static void multy_connect_mode(char *peer)
{
+ mgmt_set_experimental();
+
while (1) {
int i, sk;
"\t[-B, --preset <value>]\n"
"\t[-G, --CIG/BIG <value>]\n"
"\t[-T, --CIS/BIS <value>]\n"
- "\t[-V, --type <value>] address type (help for list)\n");
+ "\t[-V, --type <value>] address type (help for list)\n"
+ "\t[-N, --nbis <value>] Number of BISes to create/synchronize to\n");
}
static const struct option main_options[] = {
{ "CIG/BIG", required_argument, NULL, 'G'},
{ "CIS/BIS", required_argument, NULL, 'T'},
{ "type", required_argument, NULL, 'V'},
+ { "nbis", required_argument, NULL, 'N'},
{}
};
char *filename = NULL;
bool repeat = false;
unsigned int i;
+ uint8_t nconn = 1;
+ char *peer;
iso_qos = malloc(sizeof(*iso_qos));
/* Default to 16_2_1 */
int opt;
opt = getopt_long(argc, argv,
- "d::cmr::s::nb:i:j:hqt:CV:W:M:S:P:F:I:L:Y:R:B:G:T:e:k:",
+ "d::cmr::s::nb:i:j:hqt:CV:W:M:S:P:F:I:L:Y:R:B:G:T:e:k:N:",
main_options, NULL);
if (opt < 0)
break;
exit(1);
break;
+ case 'N':
+ if (optarg)
+ num_bis = atoi(optarg);
+
+ if (num_bis > 1) {
+ /* If the user requested multiple BISes,
+ * make sure that all BISes are bound
+ * for the same BIG and advertising set
+ */
+ if (iso_qos->bcast.big == BT_ISO_QOS_BIG_UNSET)
+ iso_qos->bcast.big = DEFAULT_BIG_ID;
+
+ if (iso_qos->bcast.bis == BT_ISO_QOS_BIS_UNSET)
+ iso_qos->bcast.bis = DEFAULT_BIS_ID;
+ }
+ break;
+
/* fall through */
default:
usage();
break;
case CONNECT:
- sk = do_connect(argv[optind + i]);
- if (sk < 0)
- exit(1);
- dump_mode(-1, sk);
+ peer = argv[optind + i];
+
+ mgmt_set_experimental();
+
+ if (!strcmp(peer, "00:00:00:00:00:00"))
+ nconn = num_bis;
+
+ if (nconn > 1) {
+ int *sk_arr = bcast_do_connect_mbis(nconn,
+ peer);
+
+ if (!sk_arr)
+ exit(1);
+
+ for (int i = 0; i < nconn; i++) {
+ if (fork()) {
+ /* Parent */
+ continue;
+ }
+
+ /* Child */
+ dump_mode(-1, sk_arr[i]);
+ exit(0);
+ }
+
+ /* Wait for children to exit */
+ while (wait(NULL) > 0)
+ ;
+
+ for (int i = 0; i < nconn; i++)
+ close(sk_arr[i]);
+
+ free(sk_arr);
+ } else {
+ sk = do_connect(argv[optind + i]);
+ if (sk < 0)
+ exit(1);
+ dump_mode(-1, sk);
+ }
+
break;
case RECV:
projects / platform / upstream / bluez.git / commitdiff