btdevctl.c revision 1.8 1 1.8 plunky /* $NetBSD: btdevctl.c,v 1.8 2009/05/12 18:39:20 plunky Exp $ */
2 1.1 plunky
3 1.1 plunky /*-
4 1.1 plunky * Copyright (c) 2006 Itronix Inc.
5 1.1 plunky * All rights reserved.
6 1.1 plunky *
7 1.1 plunky * Written by Iain Hibbert for Itronix Inc.
8 1.1 plunky *
9 1.1 plunky * Redistribution and use in source and binary forms, with or without
10 1.1 plunky * modification, are permitted provided that the following conditions
11 1.1 plunky * are met:
12 1.1 plunky * 1. Redistributions of source code must retain the above copyright
13 1.1 plunky * notice, this list of conditions and the following disclaimer.
14 1.1 plunky * 2. Redistributions in binary form must reproduce the above copyright
15 1.1 plunky * notice, this list of conditions and the following disclaimer in the
16 1.1 plunky * documentation and/or other materials provided with the distribution.
17 1.1 plunky * 3. The name of Itronix Inc. may not be used to endorse
18 1.1 plunky * or promote products derived from this software without specific
19 1.1 plunky * prior written permission.
20 1.1 plunky *
21 1.1 plunky * THIS SOFTWARE IS PROVIDED BY ITRONIX INC. ``AS IS'' AND
22 1.1 plunky * ANY EXPRESS OR IMPLIED WARRANTIES, INCLUDING, BUT NOT LIMITED
23 1.1 plunky * TO, THE IMPLIED WARRANTIES OF MERCHANTABILITY AND FITNESS FOR A PARTICULAR
24 1.1 plunky * PURPOSE ARE DISCLAIMED. IN NO EVENT SHALL ITRONIX INC. BE LIABLE FOR ANY
25 1.1 plunky * DIRECT, INDIRECT, INCIDENTAL, SPECIAL, EXEMPLARY, OR CONSEQUENTIAL DAMAGES
26 1.1 plunky * (INCLUDING, BUT NOT LIMITED TO, PROCUREMENT OF SUBSTITUTE GOODS OR SERVICES;
27 1.1 plunky * LOSS OF USE, DATA, OR PROFITS; OR BUSINESS INTERRUPTION) HOWEVER CAUSED AND
28 1.1 plunky * ON ANY THEORY OF LIABILITY, WHETHER IN
29 1.1 plunky * CONTRACT, STRICT LIABILITY, OR TORT (INCLUDING NEGLIGENCE OR OTHERWISE)
30 1.1 plunky * ARISING IN ANY WAY OUT OF THE USE OF THIS SOFTWARE, EVEN IF ADVISED OF THE
31 1.1 plunky * POSSIBILITY OF SUCH DAMAGE.
32 1.1 plunky */
33 1.1 plunky
34 1.1 plunky #include <sys/cdefs.h>
35 1.8 plunky __COPYRIGHT("@(#) Copyright (c) 2006 The NetBSD Foundation, Inc.\
36 1.8 plunky @(#) Copyright (c) 2006 Itronix, Inc.\
37 1.8 plunky All rights reserved.");
38 1.8 plunky __RCSID("$NetBSD: btdevctl.c,v 1.8 2009/05/12 18:39:20 plunky Exp $");
39 1.1 plunky
40 1.1 plunky #include <prop/proplib.h>
41 1.2 plunky #include <sys/ioctl.h>
42 1.1 plunky
43 1.2 plunky #include <bluetooth.h>
44 1.2 plunky #include <ctype.h>
45 1.1 plunky #include <err.h>
46 1.1 plunky #include <fcntl.h>
47 1.1 plunky #include <stdlib.h>
48 1.1 plunky #include <string.h>
49 1.1 plunky #include <unistd.h>
50 1.1 plunky
51 1.2 plunky #include <dev/bluetooth/btdev.h>
52 1.2 plunky
53 1.1 plunky #include "btdevctl.h"
54 1.1 plunky
55 1.2 plunky #define BTHUB_PATH "/dev/bthub"
56 1.1 plunky
57 1.2 plunky int main(int, char *[]);
58 1.2 plunky void usage(void);
59 1.2 plunky char *uppercase(const char *);
60 1.2 plunky int bthub_pioctl(unsigned long, prop_dictionary_t);
61 1.1 plunky
62 1.2 plunky int
63 1.2 plunky main(int argc, char *argv[])
64 1.1 plunky {
65 1.2 plunky prop_dictionary_t dev;
66 1.2 plunky prop_object_t obj;
67 1.2 plunky bdaddr_t laddr, raddr;
68 1.4 plunky const char *service, *mode;
69 1.4 plunky int ch, query, verbose, attach, detach, set, none;
70 1.2 plunky
71 1.2 plunky bdaddr_copy(&laddr, BDADDR_ANY);
72 1.2 plunky bdaddr_copy(&raddr, BDADDR_ANY);
73 1.2 plunky service = NULL;
74 1.4 plunky mode = NULL;
75 1.5 pavel query = false;
76 1.5 pavel verbose = false;
77 1.5 pavel attach = false;
78 1.5 pavel detach = false;
79 1.5 pavel set = false;
80 1.5 pavel none = false;
81 1.2 plunky
82 1.4 plunky while ((ch = getopt(argc, argv, "Aa:Dd:hm:qs:v")) != -1) {
83 1.2 plunky switch (ch) {
84 1.2 plunky case 'A': /* Attach device */
85 1.5 pavel attach = true;
86 1.2 plunky break;
87 1.2 plunky
88 1.2 plunky case 'a': /* remote address */
89 1.2 plunky if (!bt_aton(optarg, &raddr)) {
90 1.2 plunky struct hostent *he = NULL;
91 1.2 plunky
92 1.2 plunky if ((he = bt_gethostbyname(optarg)) == NULL)
93 1.2 plunky errx(EXIT_FAILURE, "%s: %s",
94 1.2 plunky optarg, hstrerror(h_errno));
95 1.2 plunky
96 1.2 plunky bdaddr_copy(&raddr, (bdaddr_t *)he->h_addr);
97 1.2 plunky }
98 1.2 plunky break;
99 1.2 plunky
100 1.2 plunky case 'D': /* Detach device */
101 1.5 pavel detach = true;
102 1.2 plunky break;
103 1.2 plunky
104 1.2 plunky case 'd': /* local device address */
105 1.2 plunky if (!bt_devaddr(optarg, &laddr))
106 1.2 plunky err(EXIT_FAILURE, "%s", optarg);
107 1.2 plunky
108 1.2 plunky break;
109 1.2 plunky
110 1.4 plunky case 'm': /* link mode */
111 1.4 plunky if (strcasecmp(optarg, "none") == 0)
112 1.5 pavel none = true;
113 1.4 plunky else if (strcasecmp(optarg, BTDEVauth) == 0)
114 1.4 plunky mode = BTDEVauth;
115 1.4 plunky else if (strcasecmp(optarg, BTDEVencrypt) == 0)
116 1.4 plunky mode = BTDEVencrypt;
117 1.4 plunky else if (strcasecmp(optarg, BTDEVsecure) == 0)
118 1.4 plunky mode = BTDEVsecure;
119 1.4 plunky else
120 1.6 plunky errx(EXIT_FAILURE, "%s: unknown mode", optarg);
121 1.4 plunky
122 1.4 plunky break;
123 1.4 plunky
124 1.2 plunky case 'q':
125 1.5 pavel query = true;
126 1.2 plunky break;
127 1.2 plunky
128 1.2 plunky case 's': /* service */
129 1.2 plunky service = uppercase(optarg);
130 1.2 plunky break;
131 1.2 plunky
132 1.2 plunky case 'v': /* verbose */
133 1.5 pavel verbose = true;
134 1.2 plunky break;
135 1.2 plunky
136 1.2 plunky case 'h':
137 1.2 plunky default:
138 1.2 plunky usage();
139 1.2 plunky }
140 1.2 plunky }
141 1.2 plunky
142 1.2 plunky argc -= optind;
143 1.2 plunky argv += optind;
144 1.2 plunky
145 1.2 plunky if (argc > 0
146 1.5 pavel || (attach == true && detach == true)
147 1.2 plunky || bdaddr_any(&laddr)
148 1.2 plunky || bdaddr_any(&raddr)
149 1.2 plunky || service == NULL)
150 1.2 plunky usage();
151 1.2 plunky
152 1.5 pavel if (attach == false && detach == false)
153 1.5 pavel verbose = true;
154 1.2 plunky
155 1.2 plunky dev = db_get(&laddr, &raddr, service);
156 1.5 pavel if (dev == NULL || query == true) {
157 1.5 pavel if (verbose == true)
158 1.2 plunky printf("Performing SDP query for service '%s'..\n", service);
159 1.2 plunky
160 1.2 plunky dev = cfg_query(&laddr, &raddr, service);
161 1.2 plunky if (dev == NULL)
162 1.2 plunky errx(EXIT_FAILURE, "%s/%s not found", bt_ntoa(&raddr, NULL), service);
163 1.1 plunky
164 1.5 pavel set = true;
165 1.2 plunky }
166 1.2 plunky
167 1.4 plunky if (mode != NULL) {
168 1.4 plunky obj = prop_string_create_cstring_nocopy(mode);
169 1.4 plunky if (obj == NULL || !prop_dictionary_set(dev, BTDEVmode, obj))
170 1.4 plunky errx(EXIT_FAILURE, "proplib failure (%s)", BTDEVmode);
171 1.4 plunky
172 1.4 plunky prop_object_release(obj);
173 1.5 pavel set = true;
174 1.4 plunky }
175 1.4 plunky
176 1.5 pavel if (none == true) {
177 1.4 plunky prop_dictionary_remove(dev, BTDEVmode);
178 1.5 pavel set = true;
179 1.4 plunky }
180 1.4 plunky
181 1.5 pavel if (set == true && !db_set(dev, &laddr, &raddr, service))
182 1.4 plunky errx(EXIT_FAILURE, "service store failed");
183 1.4 plunky
184 1.2 plunky /* add binary local-bdaddr */
185 1.2 plunky obj = prop_data_create_data(&laddr, sizeof(laddr));
186 1.2 plunky if (obj == NULL || !prop_dictionary_set(dev, BTDEVladdr, obj))
187 1.2 plunky errx(EXIT_FAILURE, "proplib failure (%s)", BTDEVladdr);
188 1.1 plunky
189 1.2 plunky prop_object_release(obj);
190 1.1 plunky
191 1.2 plunky /* add binary remote-bdaddr */
192 1.2 plunky obj = prop_data_create_data(&raddr, sizeof(raddr));
193 1.2 plunky if (obj == NULL || !prop_dictionary_set(dev, BTDEVraddr, obj))
194 1.2 plunky errx(EXIT_FAILURE, "proplib failure (%s)", BTDEVraddr);
195 1.1 plunky
196 1.2 plunky prop_object_release(obj);
197 1.1 plunky
198 1.3 plunky /* add service name */
199 1.3 plunky obj = prop_string_create_cstring(service);
200 1.3 plunky if (obj == NULL || !prop_dictionary_set(dev, BTDEVservice, obj))
201 1.3 plunky errx(EXIT_FAILURE, "proplib failure (%s)", BTDEVservice);
202 1.3 plunky
203 1.3 plunky prop_object_release(obj);
204 1.3 plunky
205 1.5 pavel if (verbose == true)
206 1.2 plunky cfg_print(dev);
207 1.1 plunky
208 1.5 pavel if (attach == true)
209 1.2 plunky bthub_pioctl(BTDEV_ATTACH, dev);
210 1.1 plunky
211 1.5 pavel if (detach == true)
212 1.2 plunky bthub_pioctl(BTDEV_DETACH, dev);
213 1.1 plunky
214 1.2 plunky exit(EXIT_SUCCESS);
215 1.1 plunky }
216 1.1 plunky
217 1.2 plunky void
218 1.2 plunky usage(void)
219 1.1 plunky {
220 1.1 plunky
221 1.2 plunky fprintf(stderr,
222 1.4 plunky "usage: %s [-A | -D] [-qv] [-m mode] -a address -d device -s service\n"
223 1.2 plunky "Where:\n"
224 1.2 plunky "\t-A attach device\n"
225 1.2 plunky "\t-a address remote device address\n"
226 1.2 plunky "\t-D detach device\n"
227 1.2 plunky "\t-d device local device address\n"
228 1.4 plunky "\t-m mode link mode\n"
229 1.2 plunky "\t-q force SDP query\n"
230 1.2 plunky "\t-s service remote service\n"
231 1.2 plunky "\t-v verbose\n"
232 1.2 plunky "", getprogname());
233 1.1 plunky
234 1.2 plunky exit(EXIT_FAILURE);
235 1.2 plunky }
236 1.1 plunky
237 1.2 plunky char *
238 1.2 plunky uppercase(const char *arg)
239 1.2 plunky {
240 1.2 plunky char *str, *ptr;
241 1.1 plunky
242 1.2 plunky str = strdup(arg);
243 1.2 plunky if (str == NULL)
244 1.2 plunky err(EXIT_FAILURE, "strdup");
245 1.1 plunky
246 1.2 plunky for (ptr = str ; *ptr ; ptr++)
247 1.2 plunky *ptr = (char)toupper((int)*ptr);
248 1.1 plunky
249 1.2 plunky return str;
250 1.1 plunky }
251 1.1 plunky
252 1.1 plunky int
253 1.2 plunky bthub_pioctl(unsigned long cmd, prop_dictionary_t dict)
254 1.1 plunky {
255 1.1 plunky int fd;
256 1.1 plunky
257 1.2 plunky fd = open(BTHUB_PATH, O_WRONLY, 0);
258 1.1 plunky if (fd < 0)
259 1.2 plunky err(EXIT_FAILURE, "%s", BTHUB_PATH);
260 1.1 plunky
261 1.2 plunky if (prop_dictionary_send_ioctl(dict, fd, cmd))
262 1.2 plunky err(EXIT_FAILURE, "%s", BTHUB_PATH);
263 1.1 plunky
264 1.1 plunky close(fd);
265 1.2 plunky return EXIT_SUCCESS;
266 1.1 plunky }
267