drivers/bluetooth/hci_bcsp.c

49 	struct	sk_buff *rx_skb;
405 	if (bcsp->rx_skb->data[1] >> 4 == 4 && bcsp->rx_skb->data[2] == 0 &&
406 	    !memcmp(&bcsp->rx_skb->data[4], conf_pkt, 4)) {
419 	else if (bcsp->rx_skb->data[1] >> 4 == 4 && bcsp->rx_skb->data[2] == 0 &&
420 		 !memcmp(&bcsp->rx_skb->data[4], sync_pkt, 4)) {
436 			skb_put_data(bcsp->rx_skb, &byte, 1);
437 			if ((bcsp->rx_skb->data[0] & 0x40) != 0 &&
447 			skb_put_data(bcsp->rx_skb, &c0, 1);
448 			if ((bcsp->rx_skb->data[0] & 0x40) != 0 &&
456 			skb_put_data(bcsp->rx_skb, &db, 1);
457 			if ((bcsp->rx_skb->data[0] & 0x40) != 0 &&
466 			kfree_skb(bcsp->rx_skb);
467 			bcsp->rx_skb = NULL;
479 	if (bcsp->rx_skb->data[0] & 0x80) {	/* reliable pkt */
483 		if ((bcsp->rx_skb->data[0] & 0x07) == bcsp->rxseq_txack) {
491 			       bcsp->rx_skb->data[0] & 0x07, bcsp->rxseq_txack);
504 	bcsp->rxack = (bcsp->rx_skb->data[0] >> 3) & 0x07;
513 		if ((bcsp->rx_skb->data[1] & 0x0f) == 6 &&
514 		    (bcsp->rx_skb->data[0] & 0x80)) {
515 			hci_skb_pkt_type(bcsp->rx_skb) = HCI_ACLDATA_PKT;
517 		} else if ((bcsp->rx_skb->data[1] & 0x0f) == 5 &&
518 			   (bcsp->rx_skb->data[0] & 0x80)) {
519 			hci_skb_pkt_type(bcsp->rx_skb) = HCI_EVENT_PKT;
521 		} else if ((bcsp->rx_skb->data[1] & 0x0f) == 7) {
522 			hci_skb_pkt_type(bcsp->rx_skb) = HCI_SCODATA_PKT;
524 		} else if ((bcsp->rx_skb->data[1] & 0x0f) == 1 &&
525 			   !(bcsp->rx_skb->data[0] & 0x80)) {
535 		u8 desc = (bcsp->rx_skb->data[1] & 0x0f);
540 				skb_pull(bcsp->rx_skb, 4);
541 				memcpy(skb_push(bcsp->rx_skb, 1), &desc, 1);
544 				hdr.plen = bcsp->rx_skb->len;
545 				memcpy(skb_push(bcsp->rx_skb, HCI_EVENT_HDR_SIZE), &hdr, HCI_EVENT_HDR_SIZE);
546 				hci_skb_pkt_type(bcsp->rx_skb) = HCI_EVENT_PKT;
548 				hci_recv_frame(hu->hdev, bcsp->rx_skb);
551 				       bcsp->rx_skb->data[1] & 0x0f,
552 				       bcsp->rx_skb->data[0] & 0x80 ?
554 				kfree_skb(bcsp->rx_skb);
557 			kfree_skb(bcsp->rx_skb);
560 		skb_pull(bcsp->rx_skb, 4);
562 		hci_recv_frame(hu->hdev, bcsp->rx_skb);
567 		kfree_skb(bcsp->rx_skb);
571 	bcsp->rx_skb = NULL;
576 	return get_unaligned_be16(&bcsp->rx_skb->data[bcsp->rx_skb->len - 2]);
593 				kfree_skb(bcsp->rx_skb);
594 				bcsp->rx_skb = NULL;
606 			if ((0xff & (u8)~(bcsp->rx_skb->data[0] + bcsp->rx_skb->data[1] +
607 			    bcsp->rx_skb->data[2])) != bcsp->rx_skb->data[3]) {
609 				kfree_skb(bcsp->rx_skb);
610 				bcsp->rx_skb = NULL;
616 			bcsp->rx_count = (bcsp->rx_skb->data[1] >> 4) +
617 					(bcsp->rx_skb->data[2] << 4);	/* May be 0 */
621 			if (bcsp->rx_skb->data[0] & 0x40) {	/* pkt with crc */
634 				kfree_skb(bcsp->rx_skb);
635 				bcsp->rx_skb = NULL;
640 			skb_trim(bcsp->rx_skb, bcsp->rx_skb->len - 2);
673 				bcsp->rx_skb = bt_skb_alloc(0x1005, GFP_ATOMIC);
674 				if (!bcsp->rx_skb) {
750 	if (bcsp->rx_skb) {
751 		kfree_skb(bcsp->rx_skb);
752 		bcsp->rx_skb = NULL;