xref: /openbmc/linux/net/bluetooth/lib.c (revision 1da177e4)
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 #include <linux/config.h>
28 #include <linux/module.h>
29 
30 #include <linux/kernel.h>
31 #include <linux/stddef.h>
32 #include <linux/string.h>
33 #include <asm/errno.h>
34 
35 #include <net/bluetooth/bluetooth.h>
36 
37 void bt_dump(char *pref, __u8 *buf, int count)
38 {
39 	char *ptr;
40 	char line[100];
41 	unsigned int i;
42 
43 	printk(KERN_INFO "%s: dump, len %d\n", pref, count);
44 
45 	ptr = line;
46 	*ptr = 0;
47 	for (i = 0; i < count; i++) {
48 		ptr += sprintf(ptr, " %2.2X", buf[i]);
49 
50 		if (i && !((i + 1) % 20)) {
51 			printk(KERN_INFO "%s:%s\n", pref, line);
52 			ptr = line;
53 			*ptr = 0;
54 		}
55 	}
56 
57 	if (line[0])
58 		printk(KERN_INFO "%s:%s\n", pref, line);
59 }
60 EXPORT_SYMBOL(bt_dump);
61 
62 void baswap(bdaddr_t *dst, bdaddr_t *src)
63 {
64 	unsigned char *d = (unsigned char *) dst;
65 	unsigned char *s = (unsigned char *) src;
66 	unsigned int i;
67 
68 	for (i = 0; i < 6; i++)
69 		d[i] = s[5 - i];
70 }
71 EXPORT_SYMBOL(baswap);
72 
73 char *batostr(bdaddr_t *ba)
74 {
75 	static char str[2][18];
76 	static int i = 1;
77 
78 	i ^= 1;
79 	sprintf(str[i], "%2.2X:%2.2X:%2.2X:%2.2X:%2.2X:%2.2X",
80 		ba->b[0], ba->b[1], ba->b[2],
81 		ba->b[3], ba->b[4], ba->b[5]);
82 
83 	return str[i];
84 }
85 EXPORT_SYMBOL(batostr);
86 
87 /* Bluetooth error codes to Unix errno mapping */
88 int bt_err(__u16 code)
89 {
90 	switch (code) {
91 	case 0:
92 		return 0;
93 
94 	case 0x01:
95 		return EBADRQC;
96 
97 	case 0x02:
98 		return ENOTCONN;
99 
100 	case 0x03:
101 		return EIO;
102 
103 	case 0x04:
104 		return EHOSTDOWN;
105 
106 	case 0x05:
107 		return EACCES;
108 
109 	case 0x06:
110 		return EBADE;
111 
112 	case 0x07:
113 		return ENOMEM;
114 
115 	case 0x08:
116 		return ETIMEDOUT;
117 
118 	case 0x09:
119 		return EMLINK;
120 
121 	case 0x0a:
122 		return EMLINK;
123 
124 	case 0x0b:
125 		return EALREADY;
126 
127 	case 0x0c:
128 		return EBUSY;
129 
130 	case 0x0d:
131 	case 0x0e:
132 	case 0x0f:
133 		return ECONNREFUSED;
134 
135 	case 0x10:
136 		return ETIMEDOUT;
137 
138 	case 0x11:
139 	case 0x27:
140 	case 0x29:
141 	case 0x20:
142 		return EOPNOTSUPP;
143 
144 	case 0x12:
145 		return EINVAL;
146 
147 	case 0x13:
148 	case 0x14:
149 	case 0x15:
150 		return ECONNRESET;
151 
152 	case 0x16:
153 		return ECONNABORTED;
154 
155 	case 0x17:
156 		return ELOOP;
157 
158 	case 0x18:
159 		return EACCES;
160 
161 	case 0x1a:
162 		return EPROTONOSUPPORT;
163 
164 	case 0x1b:
165 		return ECONNREFUSED;
166 
167 	case 0x19:
168 	case 0x1e:
169 	case 0x23:
170 	case 0x24:
171 	case 0x25:
172 		return EPROTO;
173 
174 	default:
175 		return ENOSYS;
176 	}
177 }
178 EXPORT_SYMBOL(bt_err);
179