1 /* $NetBSD: btpin.c,v 1.8 2019/10/12 17:50:56 christos Exp $ */ 2 3 /*- 4 * Copyright (c) 2006 Itronix Inc. 5 * All rights reserved. 6 * 7 * Written by Iain Hibbert for Itronix Inc. 8 * 9 * Redistribution and use in source and binary forms, with or without 10 * modification, are permitted provided that the following conditions 11 * are met: 12 * 1. Redistributions of source code must retain the above copyright 13 * notice, this list of conditions and the following disclaimer. 14 * 2. Redistributions in binary form must reproduce the above copyright 15 * notice, this list of conditions and the following disclaimer in the 16 * documentation and/or other materials provided with the distribution. 17 * 3. The name of Itronix Inc. may not be used to endorse 18 * or promote products derived from this software without specific 19 * prior written permission. 20 * 21 * THIS SOFTWARE IS PROVIDED BY ITRONIX INC. ``AS IS'' AND 22 * ANY EXPRESS OR IMPLIED WARRANTIES, INCLUDING, BUT NOT LIMITED 23 * TO, THE IMPLIED WARRANTIES OF MERCHANTABILITY AND FITNESS FOR A PARTICULAR 24 * PURPOSE ARE DISCLAIMED. IN NO EVENT SHALL ITRONIX INC. BE LIABLE FOR ANY 25 * DIRECT, INDIRECT, INCIDENTAL, SPECIAL, EXEMPLARY, OR CONSEQUENTIAL DAMAGES 26 * (INCLUDING, BUT NOT LIMITED TO, PROCUREMENT OF SUBSTITUTE GOODS OR SERVICES; 27 * LOSS OF USE, DATA, OR PROFITS; OR BUSINESS INTERRUPTION) HOWEVER CAUSED AND 28 * ON ANY THEORY OF LIABILITY, WHETHER IN 29 * CONTRACT, STRICT LIABILITY, OR TORT (INCLUDING NEGLIGENCE OR OTHERWISE) 30 * ARISING IN ANY WAY OUT OF THE USE OF THIS SOFTWARE, EVEN IF ADVISED OF THE 31 * POSSIBILITY OF SUCH DAMAGE. 32 */ 33 34 #include <sys/cdefs.h> 35 __COPYRIGHT("@(#) Copyright (c) 2006 Itronix, Inc. All rights reserved."); 36 __RCSID("$NetBSD: btpin.c,v 1.8 2019/10/12 17:50:56 christos Exp $"); 37 38 #include <sys/types.h> 39 #include <sys/un.h> 40 #include <bluetooth.h> 41 #include <err.h> 42 #include <errno.h> 43 #include <stdlib.h> 44 #include <string.h> 45 #include <time.h> 46 #include <unistd.h> 47 48 __dead static void usage(void); 49 50 int 51 main(int ac, char *av[]) 52 { 53 bthcid_pin_response_t rp; 54 struct sockaddr_un un; 55 struct sockaddr_bt bt; 56 char *pin = NULL; 57 int ch, s, len, pair; 58 59 memset(&rp, 0, sizeof(rp)); 60 len = -1; 61 pair = 0; 62 63 memset(&un, 0, sizeof(un)); 64 un.sun_len = sizeof(un); 65 un.sun_family = AF_LOCAL; 66 strlcpy(un.sun_path, BTHCID_SOCKET_NAME, sizeof(un.sun_path)); 67 68 while ((ch = getopt(ac, av, "a:d:l:Pp:rs:")) != -1) { 69 switch (ch) { 70 case 'a': 71 if (!bt_aton(optarg, &rp.raddr)) { 72 struct hostent *he = NULL; 73 74 if ((he = bt_gethostbyname(optarg)) == NULL) 75 errx(EXIT_FAILURE, "%s: %s", optarg, 76 hstrerror(h_errno)); 77 78 bdaddr_copy(&rp.raddr, (bdaddr_t *)he->h_addr); 79 } 80 break; 81 82 case 'd': 83 if (!bt_devaddr(optarg, &rp.laddr)) 84 err(EXIT_FAILURE, "%s", optarg); 85 86 break; 87 88 case 'l': 89 len = atoi(optarg); 90 if (len < 1 || len > HCI_PIN_SIZE) 91 errx(EXIT_FAILURE, "Invalid PIN length"); 92 93 break; 94 95 case 'P': 96 pair++; 97 break; 98 99 case 'p': 100 pin = optarg; 101 break; 102 103 case 'r': 104 if (len == -1) 105 len = 4; 106 107 break; 108 109 case 's': 110 strlcpy(un.sun_path, optarg, sizeof(un.sun_path)); 111 break; 112 113 default: 114 usage(); 115 } 116 } 117 118 if (bdaddr_any(&rp.raddr)) 119 usage(); 120 121 if (pin == NULL) { 122 if (len == -1) 123 usage(); 124 125 srandom(time(NULL)); 126 127 pin = (char *)rp.pin; 128 while (len-- > 0) 129 *pin++ = '0' + (random() % 10); 130 131 printf("PIN: %.*s\n", HCI_PIN_SIZE, rp.pin); 132 } else { 133 if (len != -1) 134 usage(); 135 len = strlen(pin); 136 if (len > HCI_PIN_SIZE) 137 len = HCI_PIN_SIZE; 138 139 memcpy(rp.pin, pin, len); 140 } 141 142 s = socket(PF_LOCAL, SOCK_STREAM, 0); 143 if (s == -1) 144 err(EXIT_FAILURE, "socket"); 145 146 if (connect(s, (struct sockaddr *)&un, sizeof(un)) == -1) 147 err(EXIT_FAILURE, "connect(\"%s\")", un.sun_path); 148 149 if (send(s, &rp, sizeof(rp), 0) != sizeof(rp)) 150 err(EXIT_FAILURE, "send"); 151 152 close(s); 153 154 if (pair == 0) 155 exit(EXIT_SUCCESS); 156 157 s = socket(PF_BLUETOOTH, SOCK_SEQPACKET, BTPROTO_L2CAP); 158 if (s == -1) 159 err(EXIT_FAILURE, "socket"); 160 161 ch = L2CAP_LM_AUTH; 162 if (setsockopt(s, BTPROTO_L2CAP, SO_L2CAP_LM, &ch, sizeof(ch)) == -1) 163 err(EXIT_FAILURE, "SO_L2CAP_LM"); 164 165 memset(&bt, 0, sizeof(bt)); 166 bt.bt_len = sizeof(bt); 167 bt.bt_family = AF_BLUETOOTH; 168 bdaddr_copy(&bt.bt_bdaddr, &rp.laddr); 169 if (bind(s, (struct sockaddr *)&bt, sizeof(bt)) == -1) 170 err(EXIT_FAILURE, "bind"); 171 172 fprintf(stdout, "Pairing.. "); 173 fflush(stdout); 174 175 bt.bt_psm = L2CAP_PSM_SDP; 176 bdaddr_copy(&bt.bt_bdaddr, &rp.raddr); 177 if (connect(s, (struct sockaddr *)&bt, sizeof(bt)) == -1) { 178 fprintf(stdout, "failed (%s)\n", strerror(errno)); 179 exit(EXIT_FAILURE); 180 } 181 182 close(s); 183 fprintf(stdout, "done\n"); 184 185 exit(EXIT_SUCCESS); 186 } 187 188 static void 189 usage(void) 190 { 191 192 fprintf(stderr, 193 "usage: %s [-P] [-d device] [-s socket] {-p pin | -r [-l len]} -a addr\n" 194 "", getprogname()); 195 196 exit(EXIT_FAILURE); 197 } 198