static int
hostmode(char const *arg, int brief)
{
struct hostent *he = NULL;
bdaddr_t ba;
char bastr[32];
int reverse;
if (bt_aton(arg, &ba) == 1) {
reverse = 1;
he = bt_gethostbyaddr((char const *) &ba, sizeof(ba),
AF_BLUETOOTH);
} else {
reverse = 0;
he = bt_gethostbyname(arg);
}
if (he == NULL) {
herror(reverse? bt_ntoa(&ba, bastr) : arg);
return (1);
}
if (brief)
printf("%s", reverse? he->h_name :
bt_ntoa((bdaddr_t *)(he->h_addr), bastr));
else
printf("Host %s has %s %s\n",
reverse? bt_ntoa(&ba, bastr) : arg,
reverse? "name" : "address",
reverse? he->h_name :
bt_ntoa((bdaddr_t *)(he->h_addr), bastr));
return (0);
}
/* Print BDADDR */
static char *
bdaddrpr(bdaddr_t const *ba)
{
extern int numeric_bdaddr;
static char str[24];
struct hostent *he = NULL;
if (memcmp(ba, NG_HCI_BDADDR_ANY, sizeof(*ba)) == 0) {
str[0] = '*';
str[1] = 0;
return (str);
}
if (!numeric_bdaddr &&
(he = bt_gethostbyaddr((char *)ba, sizeof(*ba), AF_BLUETOOTH)) != NULL) {
strlcpy(str, he->h_name, sizeof(str));
return (str);
}
bt_ntoa(ba, str);
return (str);
} /* bdaddrpr */
static int
hid_known(bdaddr_t *bdaddr, int argc, char **argv)
{
struct hid_device *hd = NULL;
struct hostent *he = NULL;
int e = FAILED;
if (read_config_file() == 0) {
if (read_hids_file() == 0) {
e = OK;
for (hd = get_next_hid_device(hd);
hd != NULL;
hd = get_next_hid_device(hd)) {
if (hd->new_device)
continue;
he = bt_gethostbyaddr((char *) &hd->bdaddr,
sizeof(hd->bdaddr),
AF_BLUETOOTH);
fprintf(stdout,
"%s %s\n", bt_ntoa(&hd->bdaddr, NULL),
(he != NULL && he->h_name != NULL)?
he->h_name : "");
}
}
clean_config();
}
return (e);
}
char const *
hci_bdaddr2str(bdaddr_t const *ba)
{
extern int numeric_bdaddr;
static char buffer[MAXHOSTNAMELEN];
struct hostent *he = NULL;
if (memcmp(ba, NG_HCI_BDADDR_ANY, sizeof(*ba)) == 0) {
buffer[0] = '*';
buffer[1] = 0;
return (buffer);
}
if (!numeric_bdaddr &&
(he = bt_gethostbyaddr((char *)ba, sizeof(*ba), AF_BLUETOOTH)) != NULL) {
strlcpy(buffer, he->h_name, sizeof(buffer));
return (buffer);
}
bt_ntoa(ba, buffer);
return (buffer);
} /* hci_bdaddr2str */
static char *
bdaddrpr(bdaddr_p const ba, char *str, int len)
{
static char buffer[MAXHOSTNAMELEN];
struct hostent *he = NULL;
if (str == NULL) {
str = buffer;
len = sizeof(buffer);
}
if (memcmp(ba, NG_HCI_BDADDR_ANY, sizeof(*ba)) == 0) {
str[0] = '*';
str[1] = 0;
return (str);
}
if (!numeric_bdaddr &&
(he = bt_gethostbyaddr((char *)ba, sizeof(*ba), AF_BLUETOOTH)) != NULL) {
strlcpy(str, he->h_name, len);
return (str);
}
bt_ntoa(ba, str);
return (str);
} /* bdaddrpr */
int
main(int argc, char *argv[])
{
bdaddr_t src, dst;
struct hostent *he;
uint8_t *echo_data;
struct sockaddr_l2cap sa;
int32_t n, s, count, wait, flood, echo_size, numeric;
char *endp, *rname;
/* Set defaults */
memcpy(&src, NG_HCI_BDADDR_ANY, sizeof(src));
memcpy(&dst, NG_HCI_BDADDR_ANY, sizeof(dst));
echo_data = (uint8_t *) calloc(NG_L2CAP_MAX_ECHO_SIZE, sizeof(uint8_t));
if (echo_data == NULL) {
fprintf(stderr, "Failed to allocate echo data buffer");
exit(1);
}
/*
* Set default echo size to the NG_L2CAP_MTU_MINIMUM minus
* the size of the L2CAP signalling command header.
*/
echo_size = NG_L2CAP_MTU_MINIMUM - sizeof(ng_l2cap_cmd_hdr_t);
count = -1; /* unimited */
wait = 1; /* sec */
flood = 0;
numeric = 0;
/* Parse command line arguments */
while ((n = getopt(argc, argv, "a:c:fi:nS:s:h")) != -1) {
switch (n) {
case 'a':
if (!bt_aton(optarg, &dst)) {
if ((he = bt_gethostbyname(optarg)) == NULL)
errx(1, "%s: %s", optarg, hstrerror(h_errno));
memcpy(&dst, he->h_addr, sizeof(dst));
}
break;
case 'c':
count = strtol(optarg, &endp, 10);
if (count <= 0 || *endp != '\0')
usage();
break;
case 'f':
flood = 1;
break;
case 'i':
wait = strtol(optarg, &endp, 10);
if (wait <= 0 || *endp != '\0')
usage();
break;
case 'n':
numeric = 1;
break;
case 'S':
if (!bt_aton(optarg, &src)) {
if ((he = bt_gethostbyname(optarg)) == NULL)
errx(1, "%s: %s", optarg, hstrerror(h_errno));
memcpy(&src, he->h_addr, sizeof(src));
}
break;
case 's':
echo_size = strtol(optarg, &endp, 10);
if (echo_size < sizeof(int32_t) ||
echo_size > NG_L2CAP_MAX_ECHO_SIZE ||
*endp != '\0')
usage();
break;
case 'h':
default:
usage();
break;
}
}
if (memcmp(&dst, NG_HCI_BDADDR_ANY, sizeof(dst)) == 0)
usage();
he = bt_gethostbyaddr((const char *)&dst, sizeof(dst), AF_BLUETOOTH);
if (he == NULL || he->h_name == NULL || he->h_name[0] == '\0' || numeric)
asprintf(&rname, "%s", bt_ntoa(&dst, NULL));
else
rname = strdup(he->h_name);
if (rname == NULL)
errx(1, "Failed to create remote hostname");
s = socket(PF_BLUETOOTH, SOCK_RAW, BLUETOOTH_PROTO_L2CAP);
if (s < 0)
err(2, "Could not create socket");
memset(&sa, 0, sizeof(sa));
sa.l2cap_len = sizeof(sa);
sa.l2cap_family = AF_BLUETOOTH;
memcpy(&sa.l2cap_bdaddr, &src, sizeof(sa.l2cap_bdaddr));
if (bind(s, (struct sockaddr *) &sa, sizeof(sa)) < 0)
err(3,
"Could not bind socket, src bdaddr=%s", bt_ntoa(&sa.l2cap_bdaddr, NULL));
memset(&sa, 0, sizeof(sa));
sa.l2cap_len = sizeof(sa);
sa.l2cap_family = AF_BLUETOOTH;
memcpy(&sa.l2cap_bdaddr, &dst, sizeof(sa.l2cap_bdaddr));
if (connect(s, (struct sockaddr *) &sa, sizeof(sa)) < 0)
err(4,
"Could not connect socket, dst bdaddr=%s", bt_ntoa(&sa.l2cap_bdaddr, NULL));
/* Fill pattern */
for (n = 0; n < echo_size; ) {
int32_t avail = min(echo_size - n, PATTERN_SIZE);
memcpy(echo_data + n, pattern, avail);
n += avail;
}
/* Start ping'ing */
for (n = 0; count == -1 || count > 0; n ++) {
struct ng_btsocket_l2cap_raw_ping r;
struct timeval a, b;
int32_t fail;
if (gettimeofday(&a, NULL) < 0)
err(5, "Could not gettimeofday(a)");
fail = 0;
*((int32_t *) echo_data) = htonl(n);
r.result = 0;
r.echo_size = echo_size;
r.echo_data = echo_data;
if (ioctl(s, SIOC_L2CAP_L2CA_PING, &r, sizeof(r)) < 0) {
r.result = errno;
fail = 1;
/*
warn("Could not ping, dst bdaddr=%s",
bt_ntoa(&r.echo_dst, NULL));
*/
}
if (gettimeofday(&b, NULL) < 0)
err(7, "Could not gettimeofday(b)");
tv_sub(&b, &a);
fprintf(stdout,
"%d bytes from %s seq_no=%d time=%.3f ms result=%#x %s\n",
r.echo_size,
rname,
ntohl(*((int32_t *)(r.echo_data))),
tv2msec(&b), r.result,
((fail == 0)? "" : strerror(errno)));
if (!flood) {
/* Wait */
a.tv_sec = wait;
a.tv_usec = 0;
select(0, NULL, NULL, NULL, &a);
}
if (count != -1)
count --;
}
free(rname);
free(echo_data);
close(s);
return (0);
} /* main */
