xref: /openbmc/linux/net/bluetooth/lib.c (revision 63db780a)
1 /*
2    BlueZ - Bluetooth protocol stack for Linux
3    Copyright (C) 2000-2001 Qualcomm Incorporated
4 
5    Written 2000,2001 by Maxim Krasnyansky <maxk@qualcomm.com>
6 
7    This program is free software; you can redistribute it and/or modify
8    it under the terms of the GNU General Public License version 2 as
9    published by the Free Software Foundation;
10 
11    THE SOFTWARE IS PROVIDED "AS IS", WITHOUT WARRANTY OF ANY KIND, EXPRESS
12    OR IMPLIED, INCLUDING BUT NOT LIMITED TO THE WARRANTIES OF MERCHANTABILITY,
13    FITNESS FOR A PARTICULAR PURPOSE AND NONINFRINGEMENT OF THIRD PARTY RIGHTS.
14    IN NO EVENT SHALL THE COPYRIGHT HOLDER(S) AND AUTHOR(S) BE LIABLE FOR ANY
15    CLAIM, OR ANY SPECIAL INDIRECT OR CONSEQUENTIAL DAMAGES, OR ANY DAMAGES
16    WHATSOEVER RESULTING FROM LOSS OF USE, DATA OR PROFITS, WHETHER IN AN
17    ACTION OF CONTRACT, NEGLIGENCE OR OTHER TORTIOUS ACTION, ARISING OUT OF
18    OR IN CONNECTION WITH THE USE OR PERFORMANCE OF THIS SOFTWARE.
19 
20    ALL LIABILITY, INCLUDING LIABILITY FOR INFRINGEMENT OF ANY PATENTS,
21    COPYRIGHTS, TRADEMARKS OR OTHER RIGHTS, RELATING TO USE OF THIS
22    SOFTWARE IS DISCLAIMED.
23 */
24 
25 /* Bluetooth kernel library. */
26 
27 #define pr_fmt(fmt) "Bluetooth: " fmt
28 
29 #include <linux/export.h>
30 
31 #include <net/bluetooth/bluetooth.h>
32 
baswap(bdaddr_t * dst,const bdaddr_t * src)33 void baswap(bdaddr_t *dst, const bdaddr_t *src)
34 {
35 	const unsigned char *s = (const unsigned char *)src;
36 	unsigned char *d = (unsigned char *)dst;
37 	unsigned int i;
38 
39 	for (i = 0; i < 6; i++)
40 		d[i] = s[5 - i];
41 }
42 EXPORT_SYMBOL(baswap);
43 
44 /* Bluetooth error codes to Unix errno mapping */
bt_to_errno(__u16 code)45 int bt_to_errno(__u16 code)
46 {
47 	switch (code) {
48 	case 0:
49 		return 0;
50 
51 	case 0x01:
52 		return EBADRQC;
53 
54 	case 0x02:
55 		return ENOTCONN;
56 
57 	case 0x03:
58 		return EIO;
59 
60 	case 0x04:
61 	case 0x3c:
62 		return EHOSTDOWN;
63 
64 	case 0x05:
65 		return EACCES;
66 
67 	case 0x06:
68 		return EBADE;
69 
70 	case 0x07:
71 		return ENOMEM;
72 
73 	case 0x08:
74 		return ETIMEDOUT;
75 
76 	case 0x09:
77 		return EMLINK;
78 
79 	case 0x0a:
80 		return EMLINK;
81 
82 	case 0x0b:
83 		return EALREADY;
84 
85 	case 0x0c:
86 		return EBUSY;
87 
88 	case 0x0d:
89 	case 0x0e:
90 	case 0x0f:
91 		return ECONNREFUSED;
92 
93 	case 0x10:
94 		return ETIMEDOUT;
95 
96 	case 0x11:
97 	case 0x27:
98 	case 0x29:
99 	case 0x20:
100 		return EOPNOTSUPP;
101 
102 	case 0x12:
103 		return EINVAL;
104 
105 	case 0x13:
106 	case 0x14:
107 	case 0x15:
108 		return ECONNRESET;
109 
110 	case 0x16:
111 		return ECONNABORTED;
112 
113 	case 0x17:
114 		return ELOOP;
115 
116 	case 0x18:
117 		return EACCES;
118 
119 	case 0x1a:
120 		return EPROTONOSUPPORT;
121 
122 	case 0x1b:
123 		return ECONNREFUSED;
124 
125 	case 0x19:
126 	case 0x1e:
127 	case 0x23:
128 	case 0x24:
129 	case 0x25:
130 		return EPROTO;
131 
132 	default:
133 		return ENOSYS;
134 	}
135 }
136 EXPORT_SYMBOL(bt_to_errno);
137 
138 /* Unix errno to Bluetooth error codes mapping */
bt_status(int err)139 __u8 bt_status(int err)
140 {
141 	/* Don't convert if already positive value */
142 	if (err >= 0)
143 		return err;
144 
145 	switch (err) {
146 	case -EBADRQC:
147 		return 0x01;
148 
149 	case -ENOTCONN:
150 		return 0x02;
151 
152 	case -EIO:
153 		return 0x03;
154 
155 	case -EHOSTDOWN:
156 		return 0x04;
157 
158 	case -EACCES:
159 		return 0x05;
160 
161 	case -EBADE:
162 		return 0x06;
163 
164 	case -ENOMEM:
165 		return 0x07;
166 
167 	case -ETIMEDOUT:
168 		return 0x08;
169 
170 	case -EMLINK:
171 		return 0x09;
172 
173 	case -EALREADY:
174 		return 0x0b;
175 
176 	case -EBUSY:
177 		return 0x0c;
178 
179 	case -ECONNREFUSED:
180 		return 0x0d;
181 
182 	case -EOPNOTSUPP:
183 		return 0x11;
184 
185 	case -EINVAL:
186 		return 0x12;
187 
188 	case -ECONNRESET:
189 		return 0x13;
190 
191 	case -ECONNABORTED:
192 		return 0x16;
193 
194 	case -ELOOP:
195 		return 0x17;
196 
197 	case -EPROTONOSUPPORT:
198 		return 0x1a;
199 
200 	case -EPROTO:
201 		return 0x19;
202 
203 	default:
204 		return 0x1f;
205 	}
206 }
207 EXPORT_SYMBOL(bt_status);
208 
bt_info(const char * format,...)209 void bt_info(const char *format, ...)
210 {
211 	struct va_format vaf;
212 	va_list args;
213 
214 	va_start(args, format);
215 
216 	vaf.fmt = format;
217 	vaf.va = &args;
218 
219 	pr_info("%pV", &vaf);
220 
221 	va_end(args);
222 }
223 EXPORT_SYMBOL(bt_info);
224 
bt_warn(const char * format,...)225 void bt_warn(const char *format, ...)
226 {
227 	struct va_format vaf;
228 	va_list args;
229 
230 	va_start(args, format);
231 
232 	vaf.fmt = format;
233 	vaf.va = &args;
234 
235 	pr_warn("%pV", &vaf);
236 
237 	va_end(args);
238 }
239 EXPORT_SYMBOL(bt_warn);
240 
bt_err(const char * format,...)241 void bt_err(const char *format, ...)
242 {
243 	struct va_format vaf;
244 	va_list args;
245 
246 	va_start(args, format);
247 
248 	vaf.fmt = format;
249 	vaf.va = &args;
250 
251 	pr_err("%pV", &vaf);
252 
253 	va_end(args);
254 }
255 EXPORT_SYMBOL(bt_err);
256 
257 #ifdef CONFIG_BT_FEATURE_DEBUG
258 static bool debug_enable;
259 
bt_dbg_set(bool enable)260 void bt_dbg_set(bool enable)
261 {
262 	debug_enable = enable;
263 }
264 
bt_dbg_get(void)265 bool bt_dbg_get(void)
266 {
267 	return debug_enable;
268 }
269 
bt_dbg(const char * format,...)270 void bt_dbg(const char *format, ...)
271 {
272 	struct va_format vaf;
273 	va_list args;
274 
275 	if (likely(!debug_enable))
276 		return;
277 
278 	va_start(args, format);
279 
280 	vaf.fmt = format;
281 	vaf.va = &args;
282 
283 	printk(KERN_DEBUG pr_fmt("%pV"), &vaf);
284 
285 	va_end(args);
286 }
287 EXPORT_SYMBOL(bt_dbg);
288 #endif
289 
bt_warn_ratelimited(const char * format,...)290 void bt_warn_ratelimited(const char *format, ...)
291 {
292 	struct va_format vaf;
293 	va_list args;
294 
295 	va_start(args, format);
296 
297 	vaf.fmt = format;
298 	vaf.va = &args;
299 
300 	pr_warn_ratelimited("%pV", &vaf);
301 
302 	va_end(args);
303 }
304 EXPORT_SYMBOL(bt_warn_ratelimited);
305 
bt_err_ratelimited(const char * format,...)306 void bt_err_ratelimited(const char *format, ...)
307 {
308 	struct va_format vaf;
309 	va_list args;
310 
311 	va_start(args, format);
312 
313 	vaf.fmt = format;
314 	vaf.va = &args;
315 
316 	pr_err_ratelimited("%pV", &vaf);
317 
318 	va_end(args);
319 }
320 EXPORT_SYMBOL(bt_err_ratelimited);
321