Lines Matching refs:bcsp
151 struct bcsp_struct *bcsp = hu->priv; in bcsp_enqueue() local
162 skb_queue_tail(&bcsp->rel, skb); in bcsp_enqueue()
166 skb_queue_tail(&bcsp->unrel, skb); in bcsp_enqueue()
178 static struct sk_buff *bcsp_prepare_pkt(struct bcsp_struct *bcsp, u8 *data, in bcsp_prepare_pkt() argument
241 hdr[0] = bcsp->rxseq_txack << 3; in bcsp_prepare_pkt()
242 bcsp->txack_req = 0; in bcsp_prepare_pkt()
243 BT_DBG("We request packet no %u to card", bcsp->rxseq_txack); in bcsp_prepare_pkt()
246 hdr[0] |= 0x80 + bcsp->msgq_txseq; in bcsp_prepare_pkt()
247 BT_DBG("Sending packet with seqno %u", bcsp->msgq_txseq); in bcsp_prepare_pkt()
248 bcsp->msgq_txseq = (bcsp->msgq_txseq + 1) & 0x07; in bcsp_prepare_pkt()
251 if (bcsp->use_crc) in bcsp_prepare_pkt()
262 if (bcsp->use_crc) in bcsp_prepare_pkt()
270 if (bcsp->use_crc) in bcsp_prepare_pkt()
275 if (bcsp->use_crc) { in bcsp_prepare_pkt()
288 struct bcsp_struct *bcsp = hu->priv; in bcsp_dequeue() local
296 skb = skb_dequeue(&bcsp->unrel); in bcsp_dequeue()
300 nskb = bcsp_prepare_pkt(bcsp, skb->data, skb->len, in bcsp_dequeue()
306 skb_queue_head(&bcsp->unrel, skb); in bcsp_dequeue()
316 spin_lock_irqsave_nested(&bcsp->unack.lock, flags, SINGLE_DEPTH_NESTING); in bcsp_dequeue()
318 if (bcsp->unack.qlen < BCSP_TXWINSIZE) { in bcsp_dequeue()
319 skb = skb_dequeue(&bcsp->rel); in bcsp_dequeue()
323 nskb = bcsp_prepare_pkt(bcsp, skb->data, skb->len, in bcsp_dequeue()
326 __skb_queue_tail(&bcsp->unack, skb); in bcsp_dequeue()
327 mod_timer(&bcsp->tbcsp, jiffies + HZ / 4); in bcsp_dequeue()
328 spin_unlock_irqrestore(&bcsp->unack.lock, flags); in bcsp_dequeue()
331 skb_queue_head(&bcsp->rel, skb); in bcsp_dequeue()
337 spin_unlock_irqrestore(&bcsp->unack.lock, flags); in bcsp_dequeue()
344 if (bcsp->txack_req) { in bcsp_dequeue()
348 struct sk_buff *nskb = bcsp_prepare_pkt(bcsp, NULL, 0, BCSP_ACK_PKT); in bcsp_dequeue()
363 static void bcsp_pkt_cull(struct bcsp_struct *bcsp) in bcsp_pkt_cull() argument
370 spin_lock_irqsave(&bcsp->unack.lock, flags); in bcsp_pkt_cull()
372 pkts_to_be_removed = skb_queue_len(&bcsp->unack); in bcsp_pkt_cull()
373 seqno = bcsp->msgq_txseq; in bcsp_pkt_cull()
376 if (bcsp->rxack == seqno) in bcsp_pkt_cull()
382 if (bcsp->rxack != seqno) in bcsp_pkt_cull()
386 pkts_to_be_removed, skb_queue_len(&bcsp->unack), in bcsp_pkt_cull()
390 skb_queue_walk_safe(&bcsp->unack, skb, tmp) { in bcsp_pkt_cull()
395 __skb_unlink(skb, &bcsp->unack); in bcsp_pkt_cull()
399 if (skb_queue_empty(&bcsp->unack)) in bcsp_pkt_cull()
400 del_timer(&bcsp->tbcsp); in bcsp_pkt_cull()
402 spin_unlock_irqrestore(&bcsp->unack.lock, flags); in bcsp_pkt_cull()
414 struct bcsp_struct *bcsp = hu->priv; in bcsp_handle_le_pkt() local
420 if (bcsp->rx_skb->data[1] >> 4 == 4 && bcsp->rx_skb->data[2] == 0 && in bcsp_handle_le_pkt()
421 !memcmp(&bcsp->rx_skb->data[4], conf_pkt, 4)) { in bcsp_handle_le_pkt()
430 skb_queue_head(&bcsp->unrel, nskb); in bcsp_handle_le_pkt()
434 else if (bcsp->rx_skb->data[1] >> 4 == 4 && bcsp->rx_skb->data[2] == 0 && in bcsp_handle_le_pkt()
435 !memcmp(&bcsp->rx_skb->data[4], sync_pkt, 4)) { in bcsp_handle_le_pkt()
440 static inline void bcsp_unslip_one_byte(struct bcsp_struct *bcsp, unsigned char byte) in bcsp_unslip_one_byte() argument
444 switch (bcsp->rx_esc_state) { in bcsp_unslip_one_byte()
448 bcsp->rx_esc_state = BCSP_ESCSTATE_ESC; in bcsp_unslip_one_byte()
451 skb_put_data(bcsp->rx_skb, &byte, 1); in bcsp_unslip_one_byte()
452 if ((bcsp->rx_skb->data[0] & 0x40) != 0 && in bcsp_unslip_one_byte()
453 bcsp->rx_state != BCSP_W4_CRC) in bcsp_unslip_one_byte()
454 bcsp_crc_update(&bcsp->message_crc, byte); in bcsp_unslip_one_byte()
455 bcsp->rx_count--; in bcsp_unslip_one_byte()
462 skb_put_data(bcsp->rx_skb, &c0, 1); in bcsp_unslip_one_byte()
463 if ((bcsp->rx_skb->data[0] & 0x40) != 0 && in bcsp_unslip_one_byte()
464 bcsp->rx_state != BCSP_W4_CRC) in bcsp_unslip_one_byte()
465 bcsp_crc_update(&bcsp->message_crc, 0xc0); in bcsp_unslip_one_byte()
466 bcsp->rx_esc_state = BCSP_ESCSTATE_NOESC; in bcsp_unslip_one_byte()
467 bcsp->rx_count--; in bcsp_unslip_one_byte()
471 skb_put_data(bcsp->rx_skb, &db, 1); in bcsp_unslip_one_byte()
472 if ((bcsp->rx_skb->data[0] & 0x40) != 0 && in bcsp_unslip_one_byte()
473 bcsp->rx_state != BCSP_W4_CRC) in bcsp_unslip_one_byte()
474 bcsp_crc_update(&bcsp->message_crc, 0xdb); in bcsp_unslip_one_byte()
475 bcsp->rx_esc_state = BCSP_ESCSTATE_NOESC; in bcsp_unslip_one_byte()
476 bcsp->rx_count--; in bcsp_unslip_one_byte()
481 kfree_skb(bcsp->rx_skb); in bcsp_unslip_one_byte()
482 bcsp->rx_skb = NULL; in bcsp_unslip_one_byte()
483 bcsp->rx_state = BCSP_W4_PKT_DELIMITER; in bcsp_unslip_one_byte()
484 bcsp->rx_count = 0; in bcsp_unslip_one_byte()
491 struct bcsp_struct *bcsp = hu->priv; in bcsp_complete_rx_pkt() local
494 if (bcsp->rx_skb->data[0] & 0x80) { /* reliable pkt */ in bcsp_complete_rx_pkt()
495 BT_DBG("Received seqno %u from card", bcsp->rxseq_txack); in bcsp_complete_rx_pkt()
498 if ((bcsp->rx_skb->data[0] & 0x07) == bcsp->rxseq_txack) { in bcsp_complete_rx_pkt()
499 bcsp->rxseq_txack++; in bcsp_complete_rx_pkt()
500 bcsp->rxseq_txack %= 0x8; in bcsp_complete_rx_pkt()
506 bcsp->rx_skb->data[0] & 0x07, bcsp->rxseq_txack); in bcsp_complete_rx_pkt()
513 bcsp->txack_req = 1; in bcsp_complete_rx_pkt()
519 bcsp->rxack = (bcsp->rx_skb->data[0] >> 3) & 0x07; in bcsp_complete_rx_pkt()
520 BT_DBG("Request for pkt %u from card", bcsp->rxack); in bcsp_complete_rx_pkt()
525 bcsp_pkt_cull(bcsp); in bcsp_complete_rx_pkt()
528 if ((bcsp->rx_skb->data[1] & 0x0f) == 6 && in bcsp_complete_rx_pkt()
529 (bcsp->rx_skb->data[0] & 0x80)) { in bcsp_complete_rx_pkt()
530 hci_skb_pkt_type(bcsp->rx_skb) = HCI_ACLDATA_PKT; in bcsp_complete_rx_pkt()
532 } else if ((bcsp->rx_skb->data[1] & 0x0f) == 5 && in bcsp_complete_rx_pkt()
533 (bcsp->rx_skb->data[0] & 0x80)) { in bcsp_complete_rx_pkt()
534 hci_skb_pkt_type(bcsp->rx_skb) = HCI_EVENT_PKT; in bcsp_complete_rx_pkt()
536 } else if ((bcsp->rx_skb->data[1] & 0x0f) == 7) { in bcsp_complete_rx_pkt()
537 hci_skb_pkt_type(bcsp->rx_skb) = HCI_SCODATA_PKT; in bcsp_complete_rx_pkt()
539 } else if ((bcsp->rx_skb->data[1] & 0x0f) == 1 && in bcsp_complete_rx_pkt()
540 !(bcsp->rx_skb->data[0] & 0x80)) { in bcsp_complete_rx_pkt()
550 u8 desc = (bcsp->rx_skb->data[1] & 0x0f); in bcsp_complete_rx_pkt()
555 skb_pull(bcsp->rx_skb, 4); in bcsp_complete_rx_pkt()
556 memcpy(skb_push(bcsp->rx_skb, 1), &desc, 1); in bcsp_complete_rx_pkt()
559 hdr.plen = bcsp->rx_skb->len; in bcsp_complete_rx_pkt()
560 memcpy(skb_push(bcsp->rx_skb, HCI_EVENT_HDR_SIZE), &hdr, HCI_EVENT_HDR_SIZE); in bcsp_complete_rx_pkt()
561 hci_skb_pkt_type(bcsp->rx_skb) = HCI_EVENT_PKT; in bcsp_complete_rx_pkt()
563 hci_recv_frame(hu->hdev, bcsp->rx_skb); in bcsp_complete_rx_pkt()
566 bcsp->rx_skb->data[1] & 0x0f, in bcsp_complete_rx_pkt()
567 bcsp->rx_skb->data[0] & 0x80 ? in bcsp_complete_rx_pkt()
569 kfree_skb(bcsp->rx_skb); in bcsp_complete_rx_pkt()
572 kfree_skb(bcsp->rx_skb); in bcsp_complete_rx_pkt()
575 skb_pull(bcsp->rx_skb, 4); in bcsp_complete_rx_pkt()
577 hci_recv_frame(hu->hdev, bcsp->rx_skb); in bcsp_complete_rx_pkt()
582 kfree_skb(bcsp->rx_skb); in bcsp_complete_rx_pkt()
585 bcsp->rx_state = BCSP_W4_PKT_DELIMITER; in bcsp_complete_rx_pkt()
586 bcsp->rx_skb = NULL; in bcsp_complete_rx_pkt()
589 static u16 bscp_get_crc(struct bcsp_struct *bcsp) in bscp_get_crc() argument
591 return get_unaligned_be16(&bcsp->rx_skb->data[bcsp->rx_skb->len - 2]); in bscp_get_crc()
597 struct bcsp_struct *bcsp = hu->priv; in bcsp_recv() local
601 hu, count, bcsp->rx_state, bcsp->rx_count); in bcsp_recv()
605 if (bcsp->rx_count) { in bcsp_recv()
608 kfree_skb(bcsp->rx_skb); in bcsp_recv()
609 bcsp->rx_state = BCSP_W4_PKT_START; in bcsp_recv()
610 bcsp->rx_count = 0; in bcsp_recv()
612 bcsp_unslip_one_byte(bcsp, *ptr); in bcsp_recv()
618 switch (bcsp->rx_state) { in bcsp_recv()
620 if ((0xff & (u8)~(bcsp->rx_skb->data[0] + bcsp->rx_skb->data[1] + in bcsp_recv()
621 bcsp->rx_skb->data[2])) != bcsp->rx_skb->data[3]) { in bcsp_recv()
623 kfree_skb(bcsp->rx_skb); in bcsp_recv()
624 bcsp->rx_state = BCSP_W4_PKT_DELIMITER; in bcsp_recv()
625 bcsp->rx_count = 0; in bcsp_recv()
628 bcsp->rx_state = BCSP_W4_DATA; in bcsp_recv()
629 bcsp->rx_count = (bcsp->rx_skb->data[1] >> 4) + in bcsp_recv()
630 (bcsp->rx_skb->data[2] << 4); /* May be 0 */ in bcsp_recv()
634 if (bcsp->rx_skb->data[0] & 0x40) { /* pkt with crc */ in bcsp_recv()
635 bcsp->rx_state = BCSP_W4_CRC; in bcsp_recv()
636 bcsp->rx_count = 2; in bcsp_recv()
642 if (bitrev16(bcsp->message_crc) != bscp_get_crc(bcsp)) { in bcsp_recv()
644 bitrev16(bcsp->message_crc), in bcsp_recv()
645 bscp_get_crc(bcsp)); in bcsp_recv()
647 kfree_skb(bcsp->rx_skb); in bcsp_recv()
648 bcsp->rx_state = BCSP_W4_PKT_DELIMITER; in bcsp_recv()
649 bcsp->rx_count = 0; in bcsp_recv()
652 skb_trim(bcsp->rx_skb, bcsp->rx_skb->len - 2); in bcsp_recv()
659 bcsp->rx_state = BCSP_W4_PKT_START; in bcsp_recv()
675 bcsp->rx_state = BCSP_W4_BCSP_HDR; in bcsp_recv()
676 bcsp->rx_count = 4; in bcsp_recv()
677 bcsp->rx_esc_state = BCSP_ESCSTATE_NOESC; in bcsp_recv()
678 BCSP_CRC_INIT(bcsp->message_crc); in bcsp_recv()
685 bcsp->rx_skb = bt_skb_alloc(0x1005, GFP_ATOMIC); in bcsp_recv()
686 if (!bcsp->rx_skb) { in bcsp_recv()
688 bcsp->rx_state = BCSP_W4_PKT_DELIMITER; in bcsp_recv()
689 bcsp->rx_count = 0; in bcsp_recv()
703 struct bcsp_struct *bcsp = from_timer(bcsp, t, tbcsp); in bcsp_timed_event() local
704 struct hci_uart *hu = bcsp->hu; in bcsp_timed_event()
708 BT_DBG("hu %p retransmitting %u pkts", hu, bcsp->unack.qlen); in bcsp_timed_event()
710 spin_lock_irqsave_nested(&bcsp->unack.lock, flags, SINGLE_DEPTH_NESTING); in bcsp_timed_event()
712 while ((skb = __skb_dequeue_tail(&bcsp->unack)) != NULL) { in bcsp_timed_event()
713 bcsp->msgq_txseq = (bcsp->msgq_txseq - 1) & 0x07; in bcsp_timed_event()
714 skb_queue_head(&bcsp->rel, skb); in bcsp_timed_event()
717 spin_unlock_irqrestore(&bcsp->unack.lock, flags); in bcsp_timed_event()
724 struct bcsp_struct *bcsp; in bcsp_open() local
728 bcsp = kzalloc(sizeof(*bcsp), GFP_KERNEL); in bcsp_open()
729 if (!bcsp) in bcsp_open()
732 hu->priv = bcsp; in bcsp_open()
733 bcsp->hu = hu; in bcsp_open()
734 skb_queue_head_init(&bcsp->unack); in bcsp_open()
735 skb_queue_head_init(&bcsp->rel); in bcsp_open()
736 skb_queue_head_init(&bcsp->unrel); in bcsp_open()
738 timer_setup(&bcsp->tbcsp, bcsp_timed_event, 0); in bcsp_open()
740 bcsp->rx_state = BCSP_W4_PKT_DELIMITER; in bcsp_open()
743 bcsp->use_crc = 1; in bcsp_open()
750 struct bcsp_struct *bcsp = hu->priv; in bcsp_close() local
752 del_timer_sync(&bcsp->tbcsp); in bcsp_close()
758 skb_queue_purge(&bcsp->unack); in bcsp_close()
759 skb_queue_purge(&bcsp->rel); in bcsp_close()
760 skb_queue_purge(&bcsp->unrel); in bcsp_close()
762 kfree(bcsp); in bcsp_close()
766 static const struct hci_uart_proto bcsp = { variable
779 return hci_uart_register_proto(&bcsp); in bcsp_init()
784 return hci_uart_unregister_proto(&bcsp); in bcsp_deinit()