3 * Bluetooth HCI Three-wire UART driver
5 * Copyright (C) 2012 Intel Corporation
8 * This program is free software; you can redistribute it and/or modify
9 * it under the terms of the GNU General Public License as published by
10 * the Free Software Foundation; either version 2 of the License, or
11 * (at your option) any later version.
13 * This program is distributed in the hope that it will be useful,
14 * but WITHOUT ANY WARRANTY; without even the implied warranty of
15 * MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE. See the
16 * GNU General Public License for more details.
18 * You should have received a copy of the GNU General Public License
19 * along with this program; if not, write to the Free Software
20 * Foundation, Inc., 59 Temple Place, Suite 330, Boston, MA 02111-1307 USA
24 #include <linux/kernel.h>
25 #include <linux/errno.h>
26 #include <linux/skbuff.h>
28 #include <net/bluetooth/bluetooth.h>
29 #include <net/bluetooth/hci_core.h>
33 #define HCI_3WIRE_ACK_PKT 0
34 #define HCI_3WIRE_LINK_PKT 15
36 #define H5_TXWINSIZE 4
38 #define H5_ACK_TIMEOUT msecs_to_jiffies(250)
39 #define H5_SYNC_TIMEOUT msecs_to_jiffies(100)
42 * Maximum Three-wire packet:
43 * 4 byte header + max value for 12-bit length + 2 bytes for CRC
45 #define H5_MAX_LEN (4 + 0xfff + 2)
47 /* Convenience macros for reading Three-wire header values */
48 #define H5_HDR_SEQ(hdr) ((hdr)[0] & 0x07)
49 #define H5_HDR_ACK(hdr) (((hdr)[0] >> 3) & 0x07)
50 #define H5_HDR_CRC(hdr) (((hdr)[0] >> 6) & 0x01)
51 #define H5_HDR_RELIABLE(hdr) (((hdr)[0] >> 7) & 0x01)
52 #define H5_HDR_PKT_TYPE(hdr) ((hdr)[1] & 0x0f)
53 #define H5_HDR_LEN(hdr) ((((hdr)[1] >> 4) & 0xff) + ((hdr)[2] << 4))
55 #define SLIP_DELIMITER 0xc0
57 #define SLIP_ESC_DELIM 0xdc
58 #define SLIP_ESC_ESC 0xdd
61 struct sk_buff_head unack
; /* Unack'ed packets queue */
62 struct sk_buff_head rel
; /* Reliable packets queue */
63 struct sk_buff_head unrel
; /* Unreliable packets queue */
65 struct sk_buff
*rx_skb
; /* Receive buffer */
66 size_t rx_pending
; /* Expecting more bytes */
67 bool rx_esc
; /* SLIP escape mode */
68 u8 rx_ack
; /* Last ack number received */
70 int (*rx_func
) (struct hci_uart
*hu
, u8 c
);
72 struct timer_list timer
; /* Retransmission timer */
74 bool tx_ack_req
; /* Pending ack to send */
75 u8 tx_seq
; /* Next seq number to send */
76 u8 tx_ack
; /* Next ack number to send */
81 static void h5_reset_rx(struct h5
*h5
);
83 static void h5_timed_event(unsigned long arg
)
85 struct hci_uart
*hu
= (struct hci_uart
*) arg
;
86 struct h5
*h5
= hu
->priv
;
90 BT_DBG("hu %p retransmitting %u pkts", hu
, h5
->unack
.qlen
);
92 spin_lock_irqsave_nested(&h5
->unack
.lock
, flags
, SINGLE_DEPTH_NESTING
);
94 while ((skb
= __skb_dequeue_tail(&h5
->unack
)) != NULL
) {
95 h5
->tx_seq
= (h5
->tx_seq
- 1) & 0x07;
96 skb_queue_head(&h5
->rel
, skb
);
99 spin_unlock_irqrestore(&h5
->unack
.lock
, flags
);
101 hci_uart_tx_wakeup(hu
);
104 static void h5_link_control(struct hci_uart
*hu
, const void *data
, size_t len
)
106 struct h5
*h5
= hu
->priv
;
107 struct sk_buff
*nskb
;
109 nskb
= alloc_skb(3, GFP_ATOMIC
);
113 bt_cb(nskb
)->pkt_type
= HCI_3WIRE_LINK_PKT
;
115 memcpy(skb_put(nskb
, len
), data
, len
);
117 skb_queue_tail(&h5
->unrel
, nskb
);
120 static int h5_open(struct hci_uart
*hu
)
123 const unsigned char sync
[] = { 0x01, 0x7e };
127 h5
= kzalloc(sizeof(*h5
), GFP_KERNEL
);
133 skb_queue_head_init(&h5
->unack
);
134 skb_queue_head_init(&h5
->rel
);
135 skb_queue_head_init(&h5
->unrel
);
139 init_timer(&h5
->timer
);
140 h5
->timer
.function
= h5_timed_event
;
141 h5
->timer
.data
= (unsigned long) hu
;
143 set_bit(HCI_UART_INIT_PENDING
, &hu
->hdev_flags
);
145 /* Send initial sync request */
146 h5_link_control(hu
, sync
, sizeof(sync
));
147 mod_timer(&h5
->timer
, jiffies
+ H5_SYNC_TIMEOUT
);
152 static int h5_close(struct hci_uart
*hu
)
154 struct h5
*h5
= hu
->priv
;
156 skb_queue_purge(&h5
->unack
);
157 skb_queue_purge(&h5
->rel
);
158 skb_queue_purge(&h5
->unrel
);
160 del_timer(&h5
->timer
);
167 static void h5_pkt_cull(struct h5
*h5
)
169 struct sk_buff
*skb
, *tmp
;
174 spin_lock_irqsave(&h5
->unack
.lock
, flags
);
176 to_remove
= skb_queue_len(&h5
->unack
);
182 while (to_remove
> 0) {
183 if (h5
->rx_ack
== seq
)
190 if (seq
!= h5
->rx_ack
)
191 BT_ERR("Controller acked invalid packet");
194 skb_queue_walk_safe(&h5
->unack
, skb
, tmp
) {
195 if (i
++ >= to_remove
)
198 __skb_unlink(skb
, &h5
->unack
);
202 if (skb_queue_empty(&h5
->unack
))
203 del_timer(&h5
->timer
);
206 spin_unlock_irqrestore(&h5
->unack
.lock
, flags
);
209 static void h5_handle_internal_rx(struct hci_uart
*hu
)
211 struct h5
*h5
= hu
->priv
;
212 const unsigned char sync_req
[] = { 0x01, 0x7e };
213 const unsigned char sync_rsp
[] = { 0x02, 0x7d };
214 const unsigned char conf_req
[] = { 0x03, 0xfc, 0x01 };
215 const unsigned char conf_rsp
[] = { 0x04, 0x7b, 0x01 };
216 const unsigned char wakeup_req
[] = { 0x05, 0xfa };
217 const unsigned char woken_req
[] = { 0x06, 0xf9 };
218 const unsigned char sleep_req
[] = { 0x07, 0x78 };
219 const unsigned char *hdr
= h5
->rx_skb
->data
;
220 const unsigned char *data
= &h5
->rx_skb
->data
[4];
222 BT_DBG("%s", hu
->hdev
->name
);
224 if (H5_HDR_PKT_TYPE(hdr
) != HCI_3WIRE_LINK_PKT
)
227 if (H5_HDR_LEN(hdr
) < 2)
230 if (memcmp(data
, sync_req
, 2) == 0) {
231 h5_link_control(hu
, sync_rsp
, 2);
232 } else if (memcmp(data
, sync_rsp
, 2) == 0) {
233 h5_link_control(hu
, conf_req
, 3);
234 } else if (memcmp(data
, conf_req
, 2) == 0) {
235 h5_link_control(hu
, conf_rsp
, 2);
236 h5_link_control(hu
, conf_req
, 3);
237 } else if (memcmp(data
, conf_rsp
, 2) == 0) {
238 BT_DBG("Three-wire init sequence complete");
239 hci_uart_init_ready(hu
);
241 } else if (memcmp(data
, sleep_req
, 2) == 0) {
242 BT_DBG("Peer went to sleep");
244 h5_link_control(hu
, wakeup_req
, 2);
245 } else if (memcmp(data
, woken_req
, 2) == 0) {
246 BT_DBG("Peer woke up");
247 h5
->sleeping
= false;
250 BT_DBG("Link Control: 0x%02hhx 0x%02hhx", data
[0], data
[1]);
254 hci_uart_tx_wakeup(hu
);
257 static void h5_complete_rx_pkt(struct hci_uart
*hu
)
259 struct h5
*h5
= hu
->priv
;
260 const unsigned char *hdr
= h5
->rx_skb
->data
;
262 if (H5_HDR_RELIABLE(hdr
)) {
263 h5
->tx_ack
= (h5
->tx_ack
+ 1) % 8;
264 h5
->tx_ack_req
= true;
265 hci_uart_tx_wakeup(hu
);
268 h5
->rx_ack
= H5_HDR_ACK(hdr
);
272 switch (H5_HDR_PKT_TYPE(hdr
)) {
274 case HCI_ACLDATA_PKT
:
275 case HCI_SCODATA_PKT
:
276 bt_cb(h5
->rx_skb
)->pkt_type
= H5_HDR_PKT_TYPE(hdr
);
278 /* Remove Three-wire header */
279 skb_pull(h5
->rx_skb
, 4);
281 hci_recv_frame(h5
->rx_skb
);
287 h5_handle_internal_rx(hu
);
294 static int h5_rx_crc(struct hci_uart
*hu
, unsigned char c
)
296 struct h5
*h5
= hu
->priv
;
298 h5_complete_rx_pkt(hu
);
304 static int h5_rx_payload(struct hci_uart
*hu
, unsigned char c
)
306 struct h5
*h5
= hu
->priv
;
307 const unsigned char *hdr
= h5
->rx_skb
->data
;
309 if (H5_HDR_CRC(hdr
)) {
310 h5
->rx_func
= h5_rx_crc
;
313 h5_complete_rx_pkt(hu
);
320 static int h5_rx_3wire_hdr(struct hci_uart
*hu
, unsigned char c
)
322 struct h5
*h5
= hu
->priv
;
323 const unsigned char *hdr
= h5
->rx_skb
->data
;
325 BT_DBG("%s rx: seq %u ack %u crc %u rel %u type %u len %u",
326 hu
->hdev
->name
, H5_HDR_SEQ(hdr
), H5_HDR_ACK(hdr
),
327 H5_HDR_CRC(hdr
), H5_HDR_RELIABLE(hdr
), H5_HDR_PKT_TYPE(hdr
),
330 if (((hdr
[0] + hdr
[1] + hdr
[2] + hdr
[3]) & 0xff) != 0xff) {
331 BT_ERR("Invalid header checksum");
336 if (H5_HDR_RELIABLE(hdr
) && H5_HDR_SEQ(hdr
) != h5
->tx_ack
) {
337 BT_ERR("Out-of-order packet arrived (%u != %u)",
338 H5_HDR_SEQ(hdr
), h5
->tx_ack
);
343 h5
->rx_func
= h5_rx_payload
;
344 h5
->rx_pending
= H5_HDR_LEN(hdr
);
349 static int h5_rx_pkt_start(struct hci_uart
*hu
, unsigned char c
)
351 struct h5
*h5
= hu
->priv
;
353 if (c
== SLIP_DELIMITER
)
356 h5
->rx_func
= h5_rx_3wire_hdr
;
359 h5
->rx_skb
= bt_skb_alloc(H5_MAX_LEN
, GFP_ATOMIC
);
361 BT_ERR("Can't allocate mem for new packet");
366 h5
->rx_skb
->dev
= (void *) hu
->hdev
;
371 static int h5_rx_delimiter(struct hci_uart
*hu
, unsigned char c
)
373 struct h5
*h5
= hu
->priv
;
375 if (c
== SLIP_DELIMITER
)
376 h5
->rx_func
= h5_rx_pkt_start
;
381 static void h5_unslip_one_byte(struct h5
*h5
, unsigned char c
)
383 const u8 delim
= SLIP_DELIMITER
, esc
= SLIP_ESC
;
386 if (!h5
->rx_esc
&& c
== SLIP_ESC
) {
400 BT_ERR("Invalid esc byte 0x%02hhx", c
);
408 memcpy(skb_put(h5
->rx_skb
, 1), byte
, 1);
411 BT_DBG("unsliped 0x%02hhx, rx_pending %zu", *byte
, h5
->rx_pending
);
414 static void h5_reset_rx(struct h5
*h5
)
417 kfree_skb(h5
->rx_skb
);
421 h5
->rx_func
= h5_rx_delimiter
;
426 static int h5_recv(struct hci_uart
*hu
, void *data
, int count
)
428 struct h5
*h5
= hu
->priv
;
429 unsigned char *ptr
= data
;
431 BT_DBG("%s pending %zu count %d", hu
->hdev
->name
, h5
->rx_pending
,
437 if (h5
->rx_pending
> 0) {
438 if (*ptr
== SLIP_DELIMITER
) {
439 BT_ERR("Too short H5 packet");
444 h5_unslip_one_byte(h5
, *ptr
);
450 processed
= h5
->rx_func(hu
, *ptr
);
461 static int h5_enqueue(struct hci_uart
*hu
, struct sk_buff
*skb
)
463 struct h5
*h5
= hu
->priv
;
465 if (skb
->len
> 0xfff) {
466 BT_ERR("Packet too long (%u bytes)", skb
->len
);
471 switch (bt_cb(skb
)->pkt_type
) {
472 case HCI_ACLDATA_PKT
:
473 case HCI_COMMAND_PKT
:
474 skb_queue_tail(&h5
->rel
, skb
);
477 case HCI_SCODATA_PKT
:
478 skb_queue_tail(&h5
->unrel
, skb
);
482 BT_ERR("Unknown packet type %u", bt_cb(skb
)->pkt_type
);
490 static void h5_slip_delim(struct sk_buff
*skb
)
492 const char delim
= SLIP_DELIMITER
;
494 memcpy(skb_put(skb
, 1), &delim
, 1);
497 static void h5_slip_one_byte(struct sk_buff
*skb
, u8 c
)
499 const char esc_delim
[2] = { SLIP_ESC
, SLIP_ESC_DELIM
};
500 const char esc_esc
[2] = { SLIP_ESC
, SLIP_ESC_ESC
};
504 memcpy(skb_put(skb
, 2), &esc_delim
, 2);
507 memcpy(skb_put(skb
, 2), &esc_esc
, 2);
510 memcpy(skb_put(skb
, 1), &c
, 1);
514 static struct sk_buff
*h5_build_pkt(struct hci_uart
*hu
, bool rel
, u8 pkt_type
,
515 const u8
*data
, size_t len
)
517 struct h5
*h5
= hu
->priv
;
518 struct sk_buff
*nskb
;
523 * Max len of packet: (original len + 4 (H5 hdr) + 2 (crc)) * 2
524 * (because bytes 0xc0 and 0xdb are escaped, worst case is when
525 * the packet is all made of 0xc0 and 0xdb) + 2 (0xc0
526 * delimiters at start and end).
528 nskb
= alloc_skb((len
+ 6) * 2 + 2, GFP_ATOMIC
);
532 bt_cb(nskb
)->pkt_type
= pkt_type
;
536 hdr
[0] = h5
->tx_ack
<< 3;
537 h5
->tx_ack_req
= false;
541 hdr
[0] |= h5
->tx_seq
;
542 h5
->tx_seq
= (h5
->tx_seq
+ 1) % 8;
545 hdr
[1] = pkt_type
| ((len
& 0x0f) << 4);
547 hdr
[3] = ~((hdr
[0] + hdr
[1] + hdr
[2]) & 0xff);
549 BT_DBG("%s tx: seq %u ack %u crc %u rel %u type %u len %u",
550 hu
->hdev
->name
, H5_HDR_SEQ(hdr
), H5_HDR_ACK(hdr
),
551 H5_HDR_CRC(hdr
), H5_HDR_RELIABLE(hdr
), H5_HDR_PKT_TYPE(hdr
),
554 for (i
= 0; i
< 4; i
++)
555 h5_slip_one_byte(nskb
, hdr
[i
]);
557 for (i
= 0; i
< len
; i
++)
558 h5_slip_one_byte(nskb
, data
[i
]);
565 static struct sk_buff
*h5_prepare_pkt(struct hci_uart
*hu
, u8 pkt_type
,
566 const u8
*data
, size_t len
)
571 case HCI_ACLDATA_PKT
:
572 case HCI_COMMAND_PKT
:
575 case HCI_SCODATA_PKT
:
576 case HCI_3WIRE_LINK_PKT
:
577 case HCI_3WIRE_ACK_PKT
:
581 BT_ERR("Unknown packet type %u", pkt_type
);
585 return h5_build_pkt(hu
, rel
, pkt_type
, data
, len
);
588 static struct sk_buff
*h5_dequeue(struct hci_uart
*hu
)
590 struct h5
*h5
= hu
->priv
;
592 struct sk_buff
*skb
, *nskb
;
594 if ((skb
= skb_dequeue(&h5
->unrel
)) != NULL
) {
595 nskb
= h5_prepare_pkt(hu
, bt_cb(skb
)->pkt_type
,
596 skb
->data
, skb
->len
);
602 skb_queue_head(&h5
->unrel
, skb
);
603 BT_ERR("Could not dequeue pkt because alloc_skb failed");
606 spin_lock_irqsave_nested(&h5
->unack
.lock
, flags
, SINGLE_DEPTH_NESTING
);
608 if (h5
->unack
.qlen
>= H5_TXWINSIZE
)
611 if ((skb
= skb_dequeue(&h5
->rel
)) != NULL
) {
612 nskb
= h5_prepare_pkt(hu
, bt_cb(skb
)->pkt_type
,
613 skb
->data
, skb
->len
);
615 __skb_queue_tail(&h5
->unack
, skb
);
616 mod_timer(&h5
->timer
, jiffies
+ H5_ACK_TIMEOUT
);
617 spin_unlock_irqrestore(&h5
->unack
.lock
, flags
);
621 skb_queue_head(&h5
->rel
, skb
);
622 BT_ERR("Could not dequeue pkt because alloc_skb failed");
626 spin_unlock_irqrestore(&h5
->unack
.lock
, flags
);
629 return h5_prepare_pkt(hu
, HCI_3WIRE_ACK_PKT
, NULL
, 0);
634 static int h5_flush(struct hci_uart
*hu
)
640 static struct hci_uart_proto h5p
= {
641 .id
= HCI_UART_3WIRE
,
645 .enqueue
= h5_enqueue
,
646 .dequeue
= h5_dequeue
,
650 int __init
h5_init(void)
652 int err
= hci_uart_register_proto(&h5p
);
655 BT_INFO("HCI Three-wire UART (H5) protocol initialized");
657 BT_ERR("HCI Three-wire UART (H5) protocol init failed");
662 int __exit
h5_deinit(void)
664 return hci_uart_unregister_proto(&h5p
);
This page took 0.045247 seconds and 6 git commands to generate.