xref: /openbmc/linux/net/bluetooth/lib.c (revision ff1f8558)
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 
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 */
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 void bt_info(const char *format, ...)
139 {
140 	struct va_format vaf;
141 	va_list args;
142 
143 	va_start(args, format);
144 
145 	vaf.fmt = format;
146 	vaf.va = &args;
147 
148 	pr_info("%pV", &vaf);
149 
150 	va_end(args);
151 }
152 EXPORT_SYMBOL(bt_info);
153 
154 void bt_warn(const char *format, ...)
155 {
156 	struct va_format vaf;
157 	va_list args;
158 
159 	va_start(args, format);
160 
161 	vaf.fmt = format;
162 	vaf.va = &args;
163 
164 	pr_warn("%pV", &vaf);
165 
166 	va_end(args);
167 }
168 EXPORT_SYMBOL(bt_warn);
169 
170 void bt_err(const char *format, ...)
171 {
172 	struct va_format vaf;
173 	va_list args;
174 
175 	va_start(args, format);
176 
177 	vaf.fmt = format;
178 	vaf.va = &args;
179 
180 	pr_err("%pV", &vaf);
181 
182 	va_end(args);
183 }
184 EXPORT_SYMBOL(bt_err);
185 
186 #ifdef CONFIG_BT_FEATURE_DEBUG
187 static bool debug_enable;
188 
189 void bt_dbg_set(bool enable)
190 {
191 	debug_enable = enable;
192 }
193 
194 bool bt_dbg_get(void)
195 {
196 	return debug_enable;
197 }
198 
199 void bt_dbg(const char *format, ...)
200 {
201 	struct va_format vaf;
202 	va_list args;
203 
204 	if (likely(!debug_enable))
205 		return;
206 
207 	va_start(args, format);
208 
209 	vaf.fmt = format;
210 	vaf.va = &args;
211 
212 	printk(KERN_DEBUG pr_fmt("%pV"), &vaf);
213 
214 	va_end(args);
215 }
216 EXPORT_SYMBOL(bt_dbg);
217 #endif
218 
219 void bt_warn_ratelimited(const char *format, ...)
220 {
221 	struct va_format vaf;
222 	va_list args;
223 
224 	va_start(args, format);
225 
226 	vaf.fmt = format;
227 	vaf.va = &args;
228 
229 	pr_warn_ratelimited("%pV", &vaf);
230 
231 	va_end(args);
232 }
233 EXPORT_SYMBOL(bt_warn_ratelimited);
234 
235 void bt_err_ratelimited(const char *format, ...)
236 {
237 	struct va_format vaf;
238 	va_list args;
239 
240 	va_start(args, format);
241 
242 	vaf.fmt = format;
243 	vaf.va = &args;
244 
245 	pr_err_ratelimited("%pV", &vaf);
246 
247 	va_end(args);
248 }
249 EXPORT_SYMBOL(bt_err_ratelimited);
250