xref: /openbmc/linux/net/bluetooth/lib.c (revision 594b31ea)
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 
331da177e4SLinus Torvalds void baswap(bdaddr_t *dst, bdaddr_t *src)
341da177e4SLinus Torvalds {
351da177e4SLinus Torvalds 	unsigned char *d = (unsigned char *) dst;
361da177e4SLinus Torvalds 	unsigned char *s = (unsigned char *) src;
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 */
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 
1382b0bf6c8SJoe Perches void bt_info(const char *format, ...)
139e1447d8dSJoe Perches {
140e1447d8dSJoe Perches 	struct va_format vaf;
141e1447d8dSJoe Perches 	va_list args;
142e1447d8dSJoe Perches 
143e1447d8dSJoe Perches 	va_start(args, format);
144e1447d8dSJoe Perches 
145e1447d8dSJoe Perches 	vaf.fmt = format;
146e1447d8dSJoe Perches 	vaf.va = &args;
147e1447d8dSJoe Perches 
1482b0bf6c8SJoe Perches 	pr_info("%pV", &vaf);
149e1447d8dSJoe Perches 
150e1447d8dSJoe Perches 	va_end(args);
151e1447d8dSJoe Perches }
1523ed7003eSJoe Perches EXPORT_SYMBOL(bt_info);
1533ed7003eSJoe Perches 
154594b31eaSFrederic Danis void bt_warn(const char *format, ...)
155594b31eaSFrederic Danis {
156594b31eaSFrederic Danis 	struct va_format vaf;
157594b31eaSFrederic Danis 	va_list args;
158594b31eaSFrederic Danis 
159594b31eaSFrederic Danis 	va_start(args, format);
160594b31eaSFrederic Danis 
161594b31eaSFrederic Danis 	vaf.fmt = format;
162594b31eaSFrederic Danis 	vaf.va = &args;
163594b31eaSFrederic Danis 
164594b31eaSFrederic Danis 	pr_warn("%pV", &vaf);
165594b31eaSFrederic Danis 
166594b31eaSFrederic Danis 	va_end(args);
167594b31eaSFrederic Danis }
168594b31eaSFrederic Danis EXPORT_SYMBOL(bt_warn);
169594b31eaSFrederic Danis 
1702b0bf6c8SJoe Perches void bt_err(const char *format, ...)
1713ed7003eSJoe Perches {
1723ed7003eSJoe Perches 	struct va_format vaf;
1733ed7003eSJoe Perches 	va_list args;
1743ed7003eSJoe Perches 
1753ed7003eSJoe Perches 	va_start(args, format);
1763ed7003eSJoe Perches 
1773ed7003eSJoe Perches 	vaf.fmt = format;
1783ed7003eSJoe Perches 	vaf.va = &args;
1793ed7003eSJoe Perches 
1802b0bf6c8SJoe Perches 	pr_err("%pV", &vaf);
1813ed7003eSJoe Perches 
1823ed7003eSJoe Perches 	va_end(args);
1833ed7003eSJoe Perches }
1843ed7003eSJoe Perches EXPORT_SYMBOL(bt_err);
185e781b7f7SSzymon Janc 
186e781b7f7SSzymon Janc void bt_err_ratelimited(const char *format, ...)
187e781b7f7SSzymon Janc {
188e781b7f7SSzymon Janc 	struct va_format vaf;
189e781b7f7SSzymon Janc 	va_list args;
190e781b7f7SSzymon Janc 
191e781b7f7SSzymon Janc 	va_start(args, format);
192e781b7f7SSzymon Janc 
193e781b7f7SSzymon Janc 	vaf.fmt = format;
194e781b7f7SSzymon Janc 	vaf.va = &args;
195e781b7f7SSzymon Janc 
196e781b7f7SSzymon Janc 	pr_err_ratelimited("%pV", &vaf);
197e781b7f7SSzymon Janc 
198e781b7f7SSzymon Janc 	va_end(args);
199e781b7f7SSzymon Janc }
200e781b7f7SSzymon Janc EXPORT_SYMBOL(bt_err_ratelimited);
201