Lines Matching refs:bcsp
150 struct bcsp_struct *bcsp = hu->priv; in bcsp_enqueue() local
161 skb_queue_tail(&bcsp->rel, skb); in bcsp_enqueue()
165 skb_queue_tail(&bcsp->unrel, skb); in bcsp_enqueue()
177 static struct sk_buff *bcsp_prepare_pkt(struct bcsp_struct *bcsp, u8 *data, in bcsp_prepare_pkt() argument
238 hdr[0] = bcsp->rxseq_txack << 3; in bcsp_prepare_pkt()
239 bcsp->txack_req = 0; in bcsp_prepare_pkt()
240 BT_DBG("We request packet no %u to card", bcsp->rxseq_txack); in bcsp_prepare_pkt()
243 hdr[0] |= 0x80 + bcsp->msgq_txseq; in bcsp_prepare_pkt()
244 BT_DBG("Sending packet with seqno %u", bcsp->msgq_txseq); in bcsp_prepare_pkt()
245 bcsp->msgq_txseq = (bcsp->msgq_txseq + 1) & 0x07; in bcsp_prepare_pkt()
248 if (bcsp->use_crc) in bcsp_prepare_pkt()
259 if (bcsp->use_crc) in bcsp_prepare_pkt()
267 if (bcsp->use_crc) in bcsp_prepare_pkt()
272 if (bcsp->use_crc) { in bcsp_prepare_pkt()
285 struct bcsp_struct *bcsp = hu->priv; in bcsp_dequeue() local
292 skb = skb_dequeue(&bcsp->unrel); in bcsp_dequeue()
294 struct sk_buff *nskb = bcsp_prepare_pkt(bcsp, skb->data, skb->len, bt_cb(skb)->pkt_type); in bcsp_dequeue()
299 skb_queue_head(&bcsp->unrel, skb); in bcsp_dequeue()
308 spin_lock_irqsave_nested(&bcsp->unack.lock, flags, SINGLE_DEPTH_NESTING); in bcsp_dequeue()
310 if (bcsp->unack.qlen < BCSP_TXWINSIZE) { in bcsp_dequeue()
311 skb = skb_dequeue(&bcsp->rel); in bcsp_dequeue()
313 struct sk_buff *nskb = bcsp_prepare_pkt(bcsp, skb->data, skb->len, in bcsp_dequeue()
316 __skb_queue_tail(&bcsp->unack, skb); in bcsp_dequeue()
317 mod_timer(&bcsp->tbcsp, jiffies + HZ / 4); in bcsp_dequeue()
318 spin_unlock_irqrestore(&bcsp->unack.lock, flags); in bcsp_dequeue()
321 skb_queue_head(&bcsp->rel, skb); in bcsp_dequeue()
327 spin_unlock_irqrestore(&bcsp->unack.lock, flags); in bcsp_dequeue()
333 if (bcsp->txack_req) { in bcsp_dequeue()
336 struct sk_buff *nskb = bcsp_prepare_pkt(bcsp, NULL, 0, BCSP_ACK_PKT); in bcsp_dequeue()
351 static void bcsp_pkt_cull(struct bcsp_struct *bcsp) in bcsp_pkt_cull() argument
358 spin_lock_irqsave(&bcsp->unack.lock, flags); in bcsp_pkt_cull()
360 pkts_to_be_removed = skb_queue_len(&bcsp->unack); in bcsp_pkt_cull()
361 seqno = bcsp->msgq_txseq; in bcsp_pkt_cull()
364 if (bcsp->rxack == seqno) in bcsp_pkt_cull()
370 if (bcsp->rxack != seqno) in bcsp_pkt_cull()
374 pkts_to_be_removed, skb_queue_len(&bcsp->unack), in bcsp_pkt_cull()
378 skb_queue_walk_safe(&bcsp->unack, skb, tmp) { in bcsp_pkt_cull()
383 __skb_unlink(skb, &bcsp->unack); in bcsp_pkt_cull()
387 if (skb_queue_empty(&bcsp->unack)) in bcsp_pkt_cull()
388 del_timer(&bcsp->tbcsp); in bcsp_pkt_cull()
390 spin_unlock_irqrestore(&bcsp->unack.lock, flags); in bcsp_pkt_cull()
401 struct bcsp_struct *bcsp = hu->priv; in bcsp_handle_le_pkt() local
407 if (bcsp->rx_skb->data[1] >> 4 == 4 && bcsp->rx_skb->data[2] == 0 && in bcsp_handle_le_pkt()
408 !memcmp(&bcsp->rx_skb->data[4], conf_pkt, 4)) { in bcsp_handle_le_pkt()
417 skb_queue_head(&bcsp->unrel, nskb); in bcsp_handle_le_pkt()
421 else if (bcsp->rx_skb->data[1] >> 4 == 4 && bcsp->rx_skb->data[2] == 0 && in bcsp_handle_le_pkt()
422 !memcmp(&bcsp->rx_skb->data[4], sync_pkt, 4)) { in bcsp_handle_le_pkt()
427 static inline void bcsp_unslip_one_byte(struct bcsp_struct *bcsp, unsigned char byte) in bcsp_unslip_one_byte() argument
431 switch (bcsp->rx_esc_state) { in bcsp_unslip_one_byte()
435 bcsp->rx_esc_state = BCSP_ESCSTATE_ESC; in bcsp_unslip_one_byte()
438 memcpy(skb_put(bcsp->rx_skb, 1), &byte, 1); in bcsp_unslip_one_byte()
439 if ((bcsp->rx_skb-> data[0] & 0x40) != 0 && in bcsp_unslip_one_byte()
440 bcsp->rx_state != BCSP_W4_CRC) in bcsp_unslip_one_byte()
441 bcsp_crc_update(&bcsp->message_crc, byte); in bcsp_unslip_one_byte()
442 bcsp->rx_count--; in bcsp_unslip_one_byte()
449 memcpy(skb_put(bcsp->rx_skb, 1), &c0, 1); in bcsp_unslip_one_byte()
450 if ((bcsp->rx_skb-> data[0] & 0x40) != 0 && in bcsp_unslip_one_byte()
451 bcsp->rx_state != BCSP_W4_CRC) in bcsp_unslip_one_byte()
452 bcsp_crc_update(&bcsp-> message_crc, 0xc0); in bcsp_unslip_one_byte()
453 bcsp->rx_esc_state = BCSP_ESCSTATE_NOESC; in bcsp_unslip_one_byte()
454 bcsp->rx_count--; in bcsp_unslip_one_byte()
458 memcpy(skb_put(bcsp->rx_skb, 1), &db, 1); in bcsp_unslip_one_byte()
459 if ((bcsp->rx_skb-> data[0] & 0x40) != 0 && in bcsp_unslip_one_byte()
460 bcsp->rx_state != BCSP_W4_CRC) in bcsp_unslip_one_byte()
461 bcsp_crc_update(&bcsp-> message_crc, 0xdb); in bcsp_unslip_one_byte()
462 bcsp->rx_esc_state = BCSP_ESCSTATE_NOESC; in bcsp_unslip_one_byte()
463 bcsp->rx_count--; in bcsp_unslip_one_byte()
468 kfree_skb(bcsp->rx_skb); in bcsp_unslip_one_byte()
469 bcsp->rx_skb = NULL; in bcsp_unslip_one_byte()
470 bcsp->rx_state = BCSP_W4_PKT_DELIMITER; in bcsp_unslip_one_byte()
471 bcsp->rx_count = 0; in bcsp_unslip_one_byte()
478 struct bcsp_struct *bcsp = hu->priv; in bcsp_complete_rx_pkt() local
481 if (bcsp->rx_skb->data[0] & 0x80) { /* reliable pkt */ in bcsp_complete_rx_pkt()
482 BT_DBG("Received seqno %u from card", bcsp->rxseq_txack); in bcsp_complete_rx_pkt()
483 bcsp->rxseq_txack++; in bcsp_complete_rx_pkt()
484 bcsp->rxseq_txack %= 0x8; in bcsp_complete_rx_pkt()
485 bcsp->txack_req = 1; in bcsp_complete_rx_pkt()
491 bcsp->rxack = (bcsp->rx_skb->data[0] >> 3) & 0x07; in bcsp_complete_rx_pkt()
492 BT_DBG("Request for pkt %u from card", bcsp->rxack); in bcsp_complete_rx_pkt()
494 bcsp_pkt_cull(bcsp); in bcsp_complete_rx_pkt()
495 if ((bcsp->rx_skb->data[1] & 0x0f) == 6 && in bcsp_complete_rx_pkt()
496 bcsp->rx_skb->data[0] & 0x80) { in bcsp_complete_rx_pkt()
497 bt_cb(bcsp->rx_skb)->pkt_type = HCI_ACLDATA_PKT; in bcsp_complete_rx_pkt()
499 } else if ((bcsp->rx_skb->data[1] & 0x0f) == 5 && in bcsp_complete_rx_pkt()
500 bcsp->rx_skb->data[0] & 0x80) { in bcsp_complete_rx_pkt()
501 bt_cb(bcsp->rx_skb)->pkt_type = HCI_EVENT_PKT; in bcsp_complete_rx_pkt()
503 } else if ((bcsp->rx_skb->data[1] & 0x0f) == 7) { in bcsp_complete_rx_pkt()
504 bt_cb(bcsp->rx_skb)->pkt_type = HCI_SCODATA_PKT; in bcsp_complete_rx_pkt()
506 } else if ((bcsp->rx_skb->data[1] & 0x0f) == 1 && in bcsp_complete_rx_pkt()
507 !(bcsp->rx_skb->data[0] & 0x80)) { in bcsp_complete_rx_pkt()
515 u8 desc = (bcsp->rx_skb->data[1] & 0x0f); in bcsp_complete_rx_pkt()
520 skb_pull(bcsp->rx_skb, 4); in bcsp_complete_rx_pkt()
521 memcpy(skb_push(bcsp->rx_skb, 1), &desc, 1); in bcsp_complete_rx_pkt()
524 hdr.plen = bcsp->rx_skb->len; in bcsp_complete_rx_pkt()
525 memcpy(skb_push(bcsp->rx_skb, HCI_EVENT_HDR_SIZE), &hdr, HCI_EVENT_HDR_SIZE); in bcsp_complete_rx_pkt()
526 bt_cb(bcsp->rx_skb)->pkt_type = HCI_EVENT_PKT; in bcsp_complete_rx_pkt()
528 hci_recv_frame(hu->hdev, bcsp->rx_skb); in bcsp_complete_rx_pkt()
531 bcsp->rx_skb->data[1] & 0x0f, in bcsp_complete_rx_pkt()
532 bcsp->rx_skb->data[0] & 0x80 ? in bcsp_complete_rx_pkt()
534 kfree_skb(bcsp->rx_skb); in bcsp_complete_rx_pkt()
537 kfree_skb(bcsp->rx_skb); in bcsp_complete_rx_pkt()
540 skb_pull(bcsp->rx_skb, 4); in bcsp_complete_rx_pkt()
542 hci_recv_frame(hu->hdev, bcsp->rx_skb); in bcsp_complete_rx_pkt()
545 bcsp->rx_state = BCSP_W4_PKT_DELIMITER; in bcsp_complete_rx_pkt()
546 bcsp->rx_skb = NULL; in bcsp_complete_rx_pkt()
549 static u16 bscp_get_crc(struct bcsp_struct *bcsp) in bscp_get_crc() argument
551 return get_unaligned_be16(&bcsp->rx_skb->data[bcsp->rx_skb->len - 2]); in bscp_get_crc()
557 struct bcsp_struct *bcsp = hu->priv; in bcsp_recv() local
561 hu, count, bcsp->rx_state, bcsp->rx_count); in bcsp_recv()
565 if (bcsp->rx_count) { in bcsp_recv()
568 kfree_skb(bcsp->rx_skb); in bcsp_recv()
569 bcsp->rx_state = BCSP_W4_PKT_START; in bcsp_recv()
570 bcsp->rx_count = 0; in bcsp_recv()
572 bcsp_unslip_one_byte(bcsp, *ptr); in bcsp_recv()
578 switch (bcsp->rx_state) { in bcsp_recv()
580 if ((0xff & (u8) ~ (bcsp->rx_skb->data[0] + bcsp->rx_skb->data[1] + in bcsp_recv()
581 bcsp->rx_skb->data[2])) != bcsp->rx_skb->data[3]) { in bcsp_recv()
583 kfree_skb(bcsp->rx_skb); in bcsp_recv()
584 bcsp->rx_state = BCSP_W4_PKT_DELIMITER; in bcsp_recv()
585 bcsp->rx_count = 0; in bcsp_recv()
588 if (bcsp->rx_skb->data[0] & 0x80 /* reliable pkt */ in bcsp_recv()
589 && (bcsp->rx_skb->data[0] & 0x07) != bcsp->rxseq_txack) { in bcsp_recv()
591 bcsp->rx_skb->data[0] & 0x07, bcsp->rxseq_txack); in bcsp_recv()
593 kfree_skb(bcsp->rx_skb); in bcsp_recv()
594 bcsp->rx_state = BCSP_W4_PKT_DELIMITER; in bcsp_recv()
595 bcsp->rx_count = 0; in bcsp_recv()
598 bcsp->rx_state = BCSP_W4_DATA; in bcsp_recv()
599 bcsp->rx_count = (bcsp->rx_skb->data[1] >> 4) + in bcsp_recv()
600 (bcsp->rx_skb->data[2] << 4); /* May be 0 */ in bcsp_recv()
604 if (bcsp->rx_skb->data[0] & 0x40) { /* pkt with crc */ in bcsp_recv()
605 bcsp->rx_state = BCSP_W4_CRC; in bcsp_recv()
606 bcsp->rx_count = 2; in bcsp_recv()
612 if (bitrev16(bcsp->message_crc) != bscp_get_crc(bcsp)) { in bcsp_recv()
614 bitrev16(bcsp->message_crc), in bcsp_recv()
615 bscp_get_crc(bcsp)); in bcsp_recv()
617 kfree_skb(bcsp->rx_skb); in bcsp_recv()
618 bcsp->rx_state = BCSP_W4_PKT_DELIMITER; in bcsp_recv()
619 bcsp->rx_count = 0; in bcsp_recv()
622 skb_trim(bcsp->rx_skb, bcsp->rx_skb->len - 2); in bcsp_recv()
629 bcsp->rx_state = BCSP_W4_PKT_START; in bcsp_recv()
645 bcsp->rx_state = BCSP_W4_BCSP_HDR; in bcsp_recv()
646 bcsp->rx_count = 4; in bcsp_recv()
647 bcsp->rx_esc_state = BCSP_ESCSTATE_NOESC; in bcsp_recv()
648 BCSP_CRC_INIT(bcsp->message_crc); in bcsp_recv()
654 bcsp->rx_skb = bt_skb_alloc(0x1005, GFP_ATOMIC); in bcsp_recv()
655 if (!bcsp->rx_skb) { in bcsp_recv()
657 bcsp->rx_state = BCSP_W4_PKT_DELIMITER; in bcsp_recv()
658 bcsp->rx_count = 0; in bcsp_recv()
673 struct bcsp_struct *bcsp = hu->priv; in bcsp_timed_event() local
677 BT_DBG("hu %p retransmitting %u pkts", hu, bcsp->unack.qlen); in bcsp_timed_event()
679 spin_lock_irqsave_nested(&bcsp->unack.lock, flags, SINGLE_DEPTH_NESTING); in bcsp_timed_event()
681 while ((skb = __skb_dequeue_tail(&bcsp->unack)) != NULL) { in bcsp_timed_event()
682 bcsp->msgq_txseq = (bcsp->msgq_txseq - 1) & 0x07; in bcsp_timed_event()
683 skb_queue_head(&bcsp->rel, skb); in bcsp_timed_event()
686 spin_unlock_irqrestore(&bcsp->unack.lock, flags); in bcsp_timed_event()
693 struct bcsp_struct *bcsp; in bcsp_open() local
697 bcsp = kzalloc(sizeof(*bcsp), GFP_KERNEL); in bcsp_open()
698 if (!bcsp) in bcsp_open()
701 hu->priv = bcsp; in bcsp_open()
702 skb_queue_head_init(&bcsp->unack); in bcsp_open()
703 skb_queue_head_init(&bcsp->rel); in bcsp_open()
704 skb_queue_head_init(&bcsp->unrel); in bcsp_open()
706 init_timer(&bcsp->tbcsp); in bcsp_open()
707 bcsp->tbcsp.function = bcsp_timed_event; in bcsp_open()
708 bcsp->tbcsp.data = (u_long) hu; in bcsp_open()
710 bcsp->rx_state = BCSP_W4_PKT_DELIMITER; in bcsp_open()
713 bcsp->use_crc = 1; in bcsp_open()
720 struct bcsp_struct *bcsp = hu->priv; in bcsp_close() local
722 del_timer_sync(&bcsp->tbcsp); in bcsp_close()
728 skb_queue_purge(&bcsp->unack); in bcsp_close()
729 skb_queue_purge(&bcsp->rel); in bcsp_close()
730 skb_queue_purge(&bcsp->unrel); in bcsp_close()
732 kfree(bcsp); in bcsp_close()
736 static const struct hci_uart_proto bcsp = { variable
749 return hci_uart_register_proto(&bcsp); in bcsp_init()
754 return hci_uart_unregister_proto(&bcsp); in bcsp_deinit()