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