diff options
author | Linus Torvalds <torvalds@ppc970.osdl.org> | 2005-04-16 18:20:36 -0400 |
---|---|---|
committer | Linus Torvalds <torvalds@ppc970.osdl.org> | 2005-04-16 18:20:36 -0400 |
commit | 1da177e4c3f41524e886b7f1b8a0c1fc7321cac2 (patch) | |
tree | 0bba044c4ce775e45a88a51686b5d9f90697ea9d /drivers/bluetooth/hci_h4.c |
Linux-2.6.12-rc2v2.6.12-rc2
Initial git repository build. I'm not bothering with the full history,
even though we have it. We can create a separate "historical" git
archive of that later if we want to, and in the meantime it's about
3.2GB when imported into git - space that would just make the early
git days unnecessarily complicated, when we don't have a lot of good
infrastructure for it.
Let it rip!
Diffstat (limited to 'drivers/bluetooth/hci_h4.c')
-rw-r--r-- | drivers/bluetooth/hci_h4.c | 282 |
1 files changed, 282 insertions, 0 deletions
diff --git a/drivers/bluetooth/hci_h4.c b/drivers/bluetooth/hci_h4.c new file mode 100644 index 000000000000..ade94a57bb11 --- /dev/null +++ b/drivers/bluetooth/hci_h4.c | |||
@@ -0,0 +1,282 @@ | |||
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 | /* | ||
26 | * Bluetooth HCI UART(H4) protocol. | ||
27 | * | ||
28 | * $Id: hci_h4.c,v 1.3 2002/09/09 01:17:32 maxk Exp $ | ||
29 | */ | ||
30 | #define VERSION "1.2" | ||
31 | |||
32 | #include <linux/config.h> | ||
33 | #include <linux/module.h> | ||
34 | |||
35 | #include <linux/kernel.h> | ||
36 | #include <linux/init.h> | ||
37 | #include <linux/sched.h> | ||
38 | #include <linux/types.h> | ||
39 | #include <linux/fcntl.h> | ||
40 | #include <linux/interrupt.h> | ||
41 | #include <linux/ptrace.h> | ||
42 | #include <linux/poll.h> | ||
43 | |||
44 | #include <linux/slab.h> | ||
45 | #include <linux/tty.h> | ||
46 | #include <linux/errno.h> | ||
47 | #include <linux/string.h> | ||
48 | #include <linux/signal.h> | ||
49 | #include <linux/ioctl.h> | ||
50 | #include <linux/skbuff.h> | ||
51 | |||
52 | #include <net/bluetooth/bluetooth.h> | ||
53 | #include <net/bluetooth/hci_core.h> | ||
54 | #include "hci_uart.h" | ||
55 | #include "hci_h4.h" | ||
56 | |||
57 | #ifndef CONFIG_BT_HCIUART_DEBUG | ||
58 | #undef BT_DBG | ||
59 | #define BT_DBG( A... ) | ||
60 | #undef BT_DMP | ||
61 | #define BT_DMP( A... ) | ||
62 | #endif | ||
63 | |||
64 | /* Initialize protocol */ | ||
65 | static int h4_open(struct hci_uart *hu) | ||
66 | { | ||
67 | struct h4_struct *h4; | ||
68 | |||
69 | BT_DBG("hu %p", hu); | ||
70 | |||
71 | h4 = kmalloc(sizeof(*h4), GFP_ATOMIC); | ||
72 | if (!h4) | ||
73 | return -ENOMEM; | ||
74 | memset(h4, 0, sizeof(*h4)); | ||
75 | |||
76 | skb_queue_head_init(&h4->txq); | ||
77 | |||
78 | hu->priv = h4; | ||
79 | return 0; | ||
80 | } | ||
81 | |||
82 | /* Flush protocol data */ | ||
83 | static int h4_flush(struct hci_uart *hu) | ||
84 | { | ||
85 | struct h4_struct *h4 = hu->priv; | ||
86 | |||
87 | BT_DBG("hu %p", hu); | ||
88 | skb_queue_purge(&h4->txq); | ||
89 | return 0; | ||
90 | } | ||
91 | |||
92 | /* Close protocol */ | ||
93 | static int h4_close(struct hci_uart *hu) | ||
94 | { | ||
95 | struct h4_struct *h4 = hu->priv; | ||
96 | hu->priv = NULL; | ||
97 | |||
98 | BT_DBG("hu %p", hu); | ||
99 | |||
100 | skb_queue_purge(&h4->txq); | ||
101 | if (h4->rx_skb) | ||
102 | kfree_skb(h4->rx_skb); | ||
103 | |||
104 | hu->priv = NULL; | ||
105 | kfree(h4); | ||
106 | return 0; | ||
107 | } | ||
108 | |||
109 | /* Enqueue frame for transmittion (padding, crc, etc) */ | ||
110 | static int h4_enqueue(struct hci_uart *hu, struct sk_buff *skb) | ||
111 | { | ||
112 | struct h4_struct *h4 = hu->priv; | ||
113 | |||
114 | BT_DBG("hu %p skb %p", hu, skb); | ||
115 | |||
116 | /* Prepend skb with frame type */ | ||
117 | memcpy(skb_push(skb, 1), &skb->pkt_type, 1); | ||
118 | skb_queue_tail(&h4->txq, skb); | ||
119 | return 0; | ||
120 | } | ||
121 | |||
122 | static inline int h4_check_data_len(struct h4_struct *h4, int len) | ||
123 | { | ||
124 | register int room = skb_tailroom(h4->rx_skb); | ||
125 | |||
126 | BT_DBG("len %d room %d", len, room); | ||
127 | if (!len) { | ||
128 | BT_DMP(h4->rx_skb->data, h4->rx_skb->len); | ||
129 | hci_recv_frame(h4->rx_skb); | ||
130 | } else if (len > room) { | ||
131 | BT_ERR("Data length is too large"); | ||
132 | kfree_skb(h4->rx_skb); | ||
133 | } else { | ||
134 | h4->rx_state = H4_W4_DATA; | ||
135 | h4->rx_count = len; | ||
136 | return len; | ||
137 | } | ||
138 | |||
139 | h4->rx_state = H4_W4_PACKET_TYPE; | ||
140 | h4->rx_skb = NULL; | ||
141 | h4->rx_count = 0; | ||
142 | return 0; | ||
143 | } | ||
144 | |||
145 | /* Recv data */ | ||
146 | static int h4_recv(struct hci_uart *hu, void *data, int count) | ||
147 | { | ||
148 | struct h4_struct *h4 = hu->priv; | ||
149 | register char *ptr; | ||
150 | struct hci_event_hdr *eh; | ||
151 | struct hci_acl_hdr *ah; | ||
152 | struct hci_sco_hdr *sh; | ||
153 | register int len, type, dlen; | ||
154 | |||
155 | BT_DBG("hu %p count %d rx_state %ld rx_count %ld", | ||
156 | hu, count, h4->rx_state, h4->rx_count); | ||
157 | |||
158 | ptr = data; | ||
159 | while (count) { | ||
160 | if (h4->rx_count) { | ||
161 | len = min_t(unsigned int, h4->rx_count, count); | ||
162 | memcpy(skb_put(h4->rx_skb, len), ptr, len); | ||
163 | h4->rx_count -= len; count -= len; ptr += len; | ||
164 | |||
165 | if (h4->rx_count) | ||
166 | continue; | ||
167 | |||
168 | switch (h4->rx_state) { | ||
169 | case H4_W4_DATA: | ||
170 | BT_DBG("Complete data"); | ||
171 | |||
172 | BT_DMP(h4->rx_skb->data, h4->rx_skb->len); | ||
173 | |||
174 | hci_recv_frame(h4->rx_skb); | ||
175 | |||
176 | h4->rx_state = H4_W4_PACKET_TYPE; | ||
177 | h4->rx_skb = NULL; | ||
178 | continue; | ||
179 | |||
180 | case H4_W4_EVENT_HDR: | ||
181 | eh = (struct hci_event_hdr *) h4->rx_skb->data; | ||
182 | |||
183 | BT_DBG("Event header: evt 0x%2.2x plen %d", eh->evt, eh->plen); | ||
184 | |||
185 | h4_check_data_len(h4, eh->plen); | ||
186 | continue; | ||
187 | |||
188 | case H4_W4_ACL_HDR: | ||
189 | ah = (struct hci_acl_hdr *) h4->rx_skb->data; | ||
190 | dlen = __le16_to_cpu(ah->dlen); | ||
191 | |||
192 | BT_DBG("ACL header: dlen %d", dlen); | ||
193 | |||
194 | h4_check_data_len(h4, dlen); | ||
195 | continue; | ||
196 | |||
197 | case H4_W4_SCO_HDR: | ||
198 | sh = (struct hci_sco_hdr *) h4->rx_skb->data; | ||
199 | |||
200 | BT_DBG("SCO header: dlen %d", sh->dlen); | ||
201 | |||
202 | h4_check_data_len(h4, sh->dlen); | ||
203 | continue; | ||
204 | } | ||
205 | } | ||
206 | |||
207 | /* H4_W4_PACKET_TYPE */ | ||
208 | switch (*ptr) { | ||
209 | case HCI_EVENT_PKT: | ||
210 | BT_DBG("Event packet"); | ||
211 | h4->rx_state = H4_W4_EVENT_HDR; | ||
212 | h4->rx_count = HCI_EVENT_HDR_SIZE; | ||
213 | type = HCI_EVENT_PKT; | ||
214 | break; | ||
215 | |||
216 | case HCI_ACLDATA_PKT: | ||
217 | BT_DBG("ACL packet"); | ||
218 | h4->rx_state = H4_W4_ACL_HDR; | ||
219 | h4->rx_count = HCI_ACL_HDR_SIZE; | ||
220 | type = HCI_ACLDATA_PKT; | ||
221 | break; | ||
222 | |||
223 | case HCI_SCODATA_PKT: | ||
224 | BT_DBG("SCO packet"); | ||
225 | h4->rx_state = H4_W4_SCO_HDR; | ||
226 | h4->rx_count = HCI_SCO_HDR_SIZE; | ||
227 | type = HCI_SCODATA_PKT; | ||
228 | break; | ||
229 | |||
230 | default: | ||
231 | BT_ERR("Unknown HCI packet type %2.2x", (__u8)*ptr); | ||
232 | hu->hdev->stat.err_rx++; | ||
233 | ptr++; count--; | ||
234 | continue; | ||
235 | }; | ||
236 | ptr++; count--; | ||
237 | |||
238 | /* Allocate packet */ | ||
239 | h4->rx_skb = bt_skb_alloc(HCI_MAX_FRAME_SIZE, GFP_ATOMIC); | ||
240 | if (!h4->rx_skb) { | ||
241 | BT_ERR("Can't allocate mem for new packet"); | ||
242 | h4->rx_state = H4_W4_PACKET_TYPE; | ||
243 | h4->rx_count = 0; | ||
244 | return 0; | ||
245 | } | ||
246 | h4->rx_skb->dev = (void *) hu->hdev; | ||
247 | h4->rx_skb->pkt_type = type; | ||
248 | } | ||
249 | return count; | ||
250 | } | ||
251 | |||
252 | static struct sk_buff *h4_dequeue(struct hci_uart *hu) | ||
253 | { | ||
254 | struct h4_struct *h4 = hu->priv; | ||
255 | return skb_dequeue(&h4->txq); | ||
256 | } | ||
257 | |||
258 | static struct hci_uart_proto h4p = { | ||
259 | .id = HCI_UART_H4, | ||
260 | .open = h4_open, | ||
261 | .close = h4_close, | ||
262 | .recv = h4_recv, | ||
263 | .enqueue = h4_enqueue, | ||
264 | .dequeue = h4_dequeue, | ||
265 | .flush = h4_flush, | ||
266 | }; | ||
267 | |||
268 | int h4_init(void) | ||
269 | { | ||
270 | int err = hci_uart_register_proto(&h4p); | ||
271 | if (!err) | ||
272 | BT_INFO("HCI H4 protocol initialized"); | ||
273 | else | ||
274 | BT_ERR("HCI H4 protocol registration failed"); | ||
275 | |||
276 | return err; | ||
277 | } | ||
278 | |||
279 | int h4_deinit(void) | ||
280 | { | ||
281 | return hci_uart_unregister_proto(&h4p); | ||
282 | } | ||