11da177e4SLinus Torvalds /*
21da177e4SLinus Torvalds BlueZ - Bluetooth protocol stack for Linux
31da177e4SLinus Torvalds Copyright (C) 2000-2001 Qualcomm Incorporated
41da177e4SLinus Torvalds
51da177e4SLinus Torvalds Written 2000,2001 by Maxim Krasnyansky <maxk@qualcomm.com>
61da177e4SLinus Torvalds
71da177e4SLinus Torvalds This program is free software; you can redistribute it and/or modify
81da177e4SLinus Torvalds it under the terms of the GNU General Public License version 2 as
91da177e4SLinus Torvalds published by the Free Software Foundation;
101da177e4SLinus Torvalds
111da177e4SLinus Torvalds THE SOFTWARE IS PROVIDED "AS IS", WITHOUT WARRANTY OF ANY KIND, EXPRESS
121da177e4SLinus Torvalds OR IMPLIED, INCLUDING BUT NOT LIMITED TO THE WARRANTIES OF MERCHANTABILITY,
131da177e4SLinus Torvalds FITNESS FOR A PARTICULAR PURPOSE AND NONINFRINGEMENT OF THIRD PARTY RIGHTS.
141da177e4SLinus Torvalds IN NO EVENT SHALL THE COPYRIGHT HOLDER(S) AND AUTHOR(S) BE LIABLE FOR ANY
151da177e4SLinus Torvalds CLAIM, OR ANY SPECIAL INDIRECT OR CONSEQUENTIAL DAMAGES, OR ANY DAMAGES
161da177e4SLinus Torvalds WHATSOEVER RESULTING FROM LOSS OF USE, DATA OR PROFITS, WHETHER IN AN
171da177e4SLinus Torvalds ACTION OF CONTRACT, NEGLIGENCE OR OTHER TORTIOUS ACTION, ARISING OUT OF
181da177e4SLinus Torvalds OR IN CONNECTION WITH THE USE OR PERFORMANCE OF THIS SOFTWARE.
191da177e4SLinus Torvalds
201da177e4SLinus Torvalds ALL LIABILITY, INCLUDING LIABILITY FOR INFRINGEMENT OF ANY PATENTS,
211da177e4SLinus Torvalds COPYRIGHTS, TRADEMARKS OR OTHER RIGHTS, RELATING TO USE OF THIS
221da177e4SLinus Torvalds SOFTWARE IS DISCLAIMED.
231da177e4SLinus Torvalds */
241da177e4SLinus Torvalds
251da177e4SLinus Torvalds /* Bluetooth kernel library. */
261da177e4SLinus Torvalds
273ed7003eSJoe Perches #define pr_fmt(fmt) "Bluetooth: " fmt
283ed7003eSJoe Perches
298c520a59SGustavo Padovan #include <linux/export.h>
301da177e4SLinus Torvalds
311da177e4SLinus Torvalds #include <net/bluetooth/bluetooth.h>
321da177e4SLinus Torvalds
baswap(bdaddr_t * dst,const bdaddr_t * src)3365bce462SLoic Poulain void baswap(bdaddr_t *dst, const bdaddr_t *src)
341da177e4SLinus Torvalds {
3565bce462SLoic Poulain const unsigned char *s = (const unsigned char *)src;
361da177e4SLinus Torvalds unsigned char *d = (unsigned char *)dst;
371da177e4SLinus Torvalds unsigned int i;
381da177e4SLinus Torvalds
391da177e4SLinus Torvalds for (i = 0; i < 6; i++)
401da177e4SLinus Torvalds d[i] = s[5 - i];
411da177e4SLinus Torvalds }
421da177e4SLinus Torvalds EXPORT_SYMBOL(baswap);
431da177e4SLinus Torvalds
441da177e4SLinus Torvalds /* Bluetooth error codes to Unix errno mapping */
bt_to_errno(__u16 code)45e175072fSJoe Perches int bt_to_errno(__u16 code)
461da177e4SLinus Torvalds {
471da177e4SLinus Torvalds switch (code) {
481da177e4SLinus Torvalds case 0:
491da177e4SLinus Torvalds return 0;
501da177e4SLinus Torvalds
511da177e4SLinus Torvalds case 0x01:
521da177e4SLinus Torvalds return EBADRQC;
531da177e4SLinus Torvalds
541da177e4SLinus Torvalds case 0x02:
551da177e4SLinus Torvalds return ENOTCONN;
561da177e4SLinus Torvalds
571da177e4SLinus Torvalds case 0x03:
581da177e4SLinus Torvalds return EIO;
591da177e4SLinus Torvalds
601da177e4SLinus Torvalds case 0x04:
6143bb5605SJohan Hedberg case 0x3c:
621da177e4SLinus Torvalds return EHOSTDOWN;
631da177e4SLinus Torvalds
641da177e4SLinus Torvalds case 0x05:
651da177e4SLinus Torvalds return EACCES;
661da177e4SLinus Torvalds
671da177e4SLinus Torvalds case 0x06:
681da177e4SLinus Torvalds return EBADE;
691da177e4SLinus Torvalds
701da177e4SLinus Torvalds case 0x07:
711da177e4SLinus Torvalds return ENOMEM;
721da177e4SLinus Torvalds
731da177e4SLinus Torvalds case 0x08:
741da177e4SLinus Torvalds return ETIMEDOUT;
751da177e4SLinus Torvalds
761da177e4SLinus Torvalds case 0x09:
771da177e4SLinus Torvalds return EMLINK;
781da177e4SLinus Torvalds
791da177e4SLinus Torvalds case 0x0a:
801da177e4SLinus Torvalds return EMLINK;
811da177e4SLinus Torvalds
821da177e4SLinus Torvalds case 0x0b:
831da177e4SLinus Torvalds return EALREADY;
841da177e4SLinus Torvalds
851da177e4SLinus Torvalds case 0x0c:
861da177e4SLinus Torvalds return EBUSY;
871da177e4SLinus Torvalds
881da177e4SLinus Torvalds case 0x0d:
891da177e4SLinus Torvalds case 0x0e:
901da177e4SLinus Torvalds case 0x0f:
911da177e4SLinus Torvalds return ECONNREFUSED;
921da177e4SLinus Torvalds
931da177e4SLinus Torvalds case 0x10:
941da177e4SLinus Torvalds return ETIMEDOUT;
951da177e4SLinus Torvalds
961da177e4SLinus Torvalds case 0x11:
971da177e4SLinus Torvalds case 0x27:
981da177e4SLinus Torvalds case 0x29:
991da177e4SLinus Torvalds case 0x20:
1001da177e4SLinus Torvalds return EOPNOTSUPP;
1011da177e4SLinus Torvalds
1021da177e4SLinus Torvalds case 0x12:
1031da177e4SLinus Torvalds return EINVAL;
1041da177e4SLinus Torvalds
1051da177e4SLinus Torvalds case 0x13:
1061da177e4SLinus Torvalds case 0x14:
1071da177e4SLinus Torvalds case 0x15:
1081da177e4SLinus Torvalds return ECONNRESET;
1091da177e4SLinus Torvalds
1101da177e4SLinus Torvalds case 0x16:
1111da177e4SLinus Torvalds return ECONNABORTED;
1121da177e4SLinus Torvalds
1131da177e4SLinus Torvalds case 0x17:
1141da177e4SLinus Torvalds return ELOOP;
1151da177e4SLinus Torvalds
1161da177e4SLinus Torvalds case 0x18:
1171da177e4SLinus Torvalds return EACCES;
1181da177e4SLinus Torvalds
1191da177e4SLinus Torvalds case 0x1a:
1201da177e4SLinus Torvalds return EPROTONOSUPPORT;
1211da177e4SLinus Torvalds
1221da177e4SLinus Torvalds case 0x1b:
1231da177e4SLinus Torvalds return ECONNREFUSED;
1241da177e4SLinus Torvalds
1251da177e4SLinus Torvalds case 0x19:
1261da177e4SLinus Torvalds case 0x1e:
1271da177e4SLinus Torvalds case 0x23:
1281da177e4SLinus Torvalds case 0x24:
1291da177e4SLinus Torvalds case 0x25:
1301da177e4SLinus Torvalds return EPROTO;
1311da177e4SLinus Torvalds
1321da177e4SLinus Torvalds default:
1331da177e4SLinus Torvalds return ENOSYS;
1341da177e4SLinus Torvalds }
1351da177e4SLinus Torvalds }
136e175072fSJoe Perches EXPORT_SYMBOL(bt_to_errno);
137e1447d8dSJoe Perches
138ca2045e0SLuiz Augusto von Dentz /* Unix errno to Bluetooth error codes mapping */
bt_status(int err)139ca2045e0SLuiz Augusto von Dentz __u8 bt_status(int err)
140ca2045e0SLuiz Augusto von Dentz {
141ca2045e0SLuiz Augusto von Dentz /* Don't convert if already positive value */
142ca2045e0SLuiz Augusto von Dentz if (err >= 0)
143ca2045e0SLuiz Augusto von Dentz return err;
144ca2045e0SLuiz Augusto von Dentz
145ca2045e0SLuiz Augusto von Dentz switch (err) {
146ca2045e0SLuiz Augusto von Dentz case -EBADRQC:
147ca2045e0SLuiz Augusto von Dentz return 0x01;
148ca2045e0SLuiz Augusto von Dentz
149ca2045e0SLuiz Augusto von Dentz case -ENOTCONN:
150ca2045e0SLuiz Augusto von Dentz return 0x02;
151ca2045e0SLuiz Augusto von Dentz
152ca2045e0SLuiz Augusto von Dentz case -EIO:
153ca2045e0SLuiz Augusto von Dentz return 0x03;
154ca2045e0SLuiz Augusto von Dentz
155ca2045e0SLuiz Augusto von Dentz case -EHOSTDOWN:
156ca2045e0SLuiz Augusto von Dentz return 0x04;
157ca2045e0SLuiz Augusto von Dentz
158ca2045e0SLuiz Augusto von Dentz case -EACCES:
159ca2045e0SLuiz Augusto von Dentz return 0x05;
160ca2045e0SLuiz Augusto von Dentz
161ca2045e0SLuiz Augusto von Dentz case -EBADE:
162ca2045e0SLuiz Augusto von Dentz return 0x06;
163ca2045e0SLuiz Augusto von Dentz
164ca2045e0SLuiz Augusto von Dentz case -ENOMEM:
165ca2045e0SLuiz Augusto von Dentz return 0x07;
166ca2045e0SLuiz Augusto von Dentz
167ca2045e0SLuiz Augusto von Dentz case -ETIMEDOUT:
168ca2045e0SLuiz Augusto von Dentz return 0x08;
169ca2045e0SLuiz Augusto von Dentz
170ca2045e0SLuiz Augusto von Dentz case -EMLINK:
171ca2045e0SLuiz Augusto von Dentz return 0x09;
172ca2045e0SLuiz Augusto von Dentz
173*63db780aSChristophe JAILLET case -EALREADY:
174ca2045e0SLuiz Augusto von Dentz return 0x0b;
175ca2045e0SLuiz Augusto von Dentz
176ca2045e0SLuiz Augusto von Dentz case -EBUSY:
177ca2045e0SLuiz Augusto von Dentz return 0x0c;
178ca2045e0SLuiz Augusto von Dentz
179ca2045e0SLuiz Augusto von Dentz case -ECONNREFUSED:
180ca2045e0SLuiz Augusto von Dentz return 0x0d;
181ca2045e0SLuiz Augusto von Dentz
182ca2045e0SLuiz Augusto von Dentz case -EOPNOTSUPP:
183ca2045e0SLuiz Augusto von Dentz return 0x11;
184ca2045e0SLuiz Augusto von Dentz
185ca2045e0SLuiz Augusto von Dentz case -EINVAL:
186ca2045e0SLuiz Augusto von Dentz return 0x12;
187ca2045e0SLuiz Augusto von Dentz
188ca2045e0SLuiz Augusto von Dentz case -ECONNRESET:
189ca2045e0SLuiz Augusto von Dentz return 0x13;
190ca2045e0SLuiz Augusto von Dentz
191ca2045e0SLuiz Augusto von Dentz case -ECONNABORTED:
192ca2045e0SLuiz Augusto von Dentz return 0x16;
193ca2045e0SLuiz Augusto von Dentz
194*63db780aSChristophe JAILLET case -ELOOP:
195ca2045e0SLuiz Augusto von Dentz return 0x17;
196ca2045e0SLuiz Augusto von Dentz
197ca2045e0SLuiz Augusto von Dentz case -EPROTONOSUPPORT:
198ca2045e0SLuiz Augusto von Dentz return 0x1a;
199ca2045e0SLuiz Augusto von Dentz
200ca2045e0SLuiz Augusto von Dentz case -EPROTO:
201ca2045e0SLuiz Augusto von Dentz return 0x19;
202ca2045e0SLuiz Augusto von Dentz
203ca2045e0SLuiz Augusto von Dentz default:
204ca2045e0SLuiz Augusto von Dentz return 0x1f;
205ca2045e0SLuiz Augusto von Dentz }
206ca2045e0SLuiz Augusto von Dentz }
207ca2045e0SLuiz Augusto von Dentz EXPORT_SYMBOL(bt_status);
208ca2045e0SLuiz Augusto von Dentz
bt_info(const char * format,...)2092b0bf6c8SJoe Perches void bt_info(const char *format, ...)
210e1447d8dSJoe Perches {
211e1447d8dSJoe Perches struct va_format vaf;
212e1447d8dSJoe Perches va_list args;
213e1447d8dSJoe Perches
214e1447d8dSJoe Perches va_start(args, format);
215e1447d8dSJoe Perches
216e1447d8dSJoe Perches vaf.fmt = format;
217e1447d8dSJoe Perches vaf.va = &args;
218e1447d8dSJoe Perches
2192b0bf6c8SJoe Perches pr_info("%pV", &vaf);
220e1447d8dSJoe Perches
221e1447d8dSJoe Perches va_end(args);
222e1447d8dSJoe Perches }
2233ed7003eSJoe Perches EXPORT_SYMBOL(bt_info);
2243ed7003eSJoe Perches
bt_warn(const char * format,...)225594b31eaSFrederic Danis void bt_warn(const char *format, ...)
226594b31eaSFrederic Danis {
227594b31eaSFrederic Danis struct va_format vaf;
228594b31eaSFrederic Danis va_list args;
229594b31eaSFrederic Danis
230594b31eaSFrederic Danis va_start(args, format);
231594b31eaSFrederic Danis
232594b31eaSFrederic Danis vaf.fmt = format;
233594b31eaSFrederic Danis vaf.va = &args;
234594b31eaSFrederic Danis
235594b31eaSFrederic Danis pr_warn("%pV", &vaf);
236594b31eaSFrederic Danis
237594b31eaSFrederic Danis va_end(args);
238594b31eaSFrederic Danis }
239594b31eaSFrederic Danis EXPORT_SYMBOL(bt_warn);
240594b31eaSFrederic Danis
bt_err(const char * format,...)2412b0bf6c8SJoe Perches void bt_err(const char *format, ...)
2423ed7003eSJoe Perches {
2433ed7003eSJoe Perches struct va_format vaf;
2443ed7003eSJoe Perches va_list args;
2453ed7003eSJoe Perches
2463ed7003eSJoe Perches va_start(args, format);
2473ed7003eSJoe Perches
2483ed7003eSJoe Perches vaf.fmt = format;
2493ed7003eSJoe Perches vaf.va = &args;
2503ed7003eSJoe Perches
2512b0bf6c8SJoe Perches pr_err("%pV", &vaf);
2523ed7003eSJoe Perches
2533ed7003eSJoe Perches va_end(args);
2543ed7003eSJoe Perches }
2553ed7003eSJoe Perches EXPORT_SYMBOL(bt_err);
256e781b7f7SSzymon Janc
257e625e50cSMarcel Holtmann #ifdef CONFIG_BT_FEATURE_DEBUG
258e625e50cSMarcel Holtmann static bool debug_enable;
259e625e50cSMarcel Holtmann
bt_dbg_set(bool enable)260e625e50cSMarcel Holtmann void bt_dbg_set(bool enable)
261e625e50cSMarcel Holtmann {
262e625e50cSMarcel Holtmann debug_enable = enable;
263e625e50cSMarcel Holtmann }
264e625e50cSMarcel Holtmann
bt_dbg_get(void)265e625e50cSMarcel Holtmann bool bt_dbg_get(void)
266e625e50cSMarcel Holtmann {
267e625e50cSMarcel Holtmann return debug_enable;
268e625e50cSMarcel Holtmann }
269e625e50cSMarcel Holtmann
bt_dbg(const char * format,...)270e625e50cSMarcel Holtmann void bt_dbg(const char *format, ...)
271e625e50cSMarcel Holtmann {
272e625e50cSMarcel Holtmann struct va_format vaf;
273e625e50cSMarcel Holtmann va_list args;
274e625e50cSMarcel Holtmann
275e625e50cSMarcel Holtmann if (likely(!debug_enable))
276e625e50cSMarcel Holtmann return;
277e625e50cSMarcel Holtmann
278e625e50cSMarcel Holtmann va_start(args, format);
279e625e50cSMarcel Holtmann
280e625e50cSMarcel Holtmann vaf.fmt = format;
281e625e50cSMarcel Holtmann vaf.va = &args;
282e625e50cSMarcel Holtmann
283e625e50cSMarcel Holtmann printk(KERN_DEBUG pr_fmt("%pV"), &vaf);
284e625e50cSMarcel Holtmann
285e625e50cSMarcel Holtmann va_end(args);
286e625e50cSMarcel Holtmann }
287e625e50cSMarcel Holtmann EXPORT_SYMBOL(bt_dbg);
288e625e50cSMarcel Holtmann #endif
289e625e50cSMarcel Holtmann
bt_warn_ratelimited(const char * format,...)29036278a5dSAlain Michaud void bt_warn_ratelimited(const char *format, ...)
29136278a5dSAlain Michaud {
29236278a5dSAlain Michaud struct va_format vaf;
29336278a5dSAlain Michaud va_list args;
29436278a5dSAlain Michaud
29536278a5dSAlain Michaud va_start(args, format);
29636278a5dSAlain Michaud
29736278a5dSAlain Michaud vaf.fmt = format;
29836278a5dSAlain Michaud vaf.va = &args;
29936278a5dSAlain Michaud
30036278a5dSAlain Michaud pr_warn_ratelimited("%pV", &vaf);
30136278a5dSAlain Michaud
30236278a5dSAlain Michaud va_end(args);
30336278a5dSAlain Michaud }
30436278a5dSAlain Michaud EXPORT_SYMBOL(bt_warn_ratelimited);
30536278a5dSAlain Michaud
bt_err_ratelimited(const char * format,...)306e781b7f7SSzymon Janc void bt_err_ratelimited(const char *format, ...)
307e781b7f7SSzymon Janc {
308e781b7f7SSzymon Janc struct va_format vaf;
309e781b7f7SSzymon Janc va_list args;
310e781b7f7SSzymon Janc
311e781b7f7SSzymon Janc va_start(args, format);
312e781b7f7SSzymon Janc
313e781b7f7SSzymon Janc vaf.fmt = format;
314e781b7f7SSzymon Janc vaf.va = &args;
315e781b7f7SSzymon Janc
316e781b7f7SSzymon Janc pr_err_ratelimited("%pV", &vaf);
317e781b7f7SSzymon Janc
318e781b7f7SSzymon Janc va_end(args);
319e781b7f7SSzymon Janc }
320e781b7f7SSzymon Janc EXPORT_SYMBOL(bt_err_ratelimited);
321