/* Recv data */ static int h4_recv(struct hci_uart *hu, void *data, int count) { if(mt6622_hack == 0) { int ret; ret = hci_recv_stream_fragment(hu->hdev, data, count); if (ret < 0) { BT_ERR("Frame Reassembly Failed"); return ret; } return count; } else { struct h4_struct *h4 = hu->priv; register char *ptr; struct hci_event_hdr *eh; struct hci_acl_hdr *ah; struct hci_sco_hdr *sh; register int len, type, dlen; int iDiscard = 0; int while_count = 0; BT_DBG("hu %p count %d rx_state %ld rx_count %ld", hu, count, h4->rx_state, h4->rx_count); ptr = data; while (count) { while_count ++; if(while_count > 5000){ BT_ERR("h4_recv while_count %d\n", while_count); } if (h4->rx_count) { len = min_t(unsigned int, h4->rx_count, count); memcpy(skb_put(h4->rx_skb, len), ptr, len); h4->rx_count -= len; count -= len; ptr += len; if (h4->rx_count) continue; switch (h4->rx_state) { case H4_W4_DATA: iDiscard = 0; /* default not to drop packet */ if(HCI_EVENT_PKT == bt_cb(h4->rx_skb)->pkt_type){ unsigned short usOpCode = 0; eh = hci_event_hdr(h4->rx_skb); switch(eh->evt){ case HCI_EV_CMD_COMPLETE: usOpCode = (((unsigned short)(h4->rx_skb->data[4])) << 8) | ((unsigned short)(h4->rx_skb->data[3])); if(usOpCode == 0xFCC0){ iDiscard = 1; clear_bit(1, &h4->ulMagic); /* allow TX to run */ BT_DBG("recv event 0x%04x\n", (int)usOpCode); /* flag is cleared. we may resume TX. or later? */ hci_uart_tx_wakeup(hu); } if(usOpCode == 0xFCC1){ BT_DBG("recv host awake command event 0x%04x\n", (int)usOpCode); //mt_bt_enable_irq(); } break; } } if(!iDiscard){ hci_recv_frame(h4->rx_skb); } else{ kfree_skb(h4->rx_skb); } h4->rx_state = H4_W4_PACKET_TYPE; h4->rx_skb = NULL; continue; case H4_W4_EVENT_HDR: eh = hci_event_hdr(h4->rx_skb); BT_DBG("Event header: evt 0x%2.2x plen %d", eh->evt, eh->plen); h4_check_data_len(h4, eh->plen); continue; case H4_W4_ACL_HDR: ah = hci_acl_hdr(h4->rx_skb); dlen = __le16_to_cpu(ah->dlen); BT_DBG("ACL header: dlen %d", dlen); h4_check_data_len(h4, dlen); continue; case H4_W4_SCO_HDR: sh = hci_sco_hdr(h4->rx_skb); BT_DBG("SCO header: dlen %d", sh->dlen); h4_check_data_len(h4, sh->dlen); continue; } } /* H4_W4_PACKET_TYPE */ switch (*ptr) { case HCI_EVENT_PKT: BT_DBG("Event packet"); h4->rx_state = H4_W4_EVENT_HDR; h4->rx_count = HCI_EVENT_HDR_SIZE; type = HCI_EVENT_PKT; break; case HCI_ACLDATA_PKT: BT_DBG("ACL packet"); h4->rx_state = H4_W4_ACL_HDR; h4->rx_count = HCI_ACL_HDR_SIZE; type = HCI_ACLDATA_PKT; break; case HCI_SCODATA_PKT: BT_DBG("SCO packet"); h4->rx_state = H4_W4_SCO_HDR; h4->rx_count = HCI_SCO_HDR_SIZE; type = HCI_SCODATA_PKT; break; default: BT_ERR("Unknown HCI packet type %2.2x", (__u8)*ptr); hu->hdev->stat.err_rx++; ptr++; count--; continue; }; ptr++; count--; /* Allocate packet */ h4->rx_skb = bt_skb_alloc(HCI_MAX_FRAME_SIZE, GFP_ATOMIC); if (!h4->rx_skb) { BT_ERR("Can't allocate mem for new packet"); h4->rx_state = H4_W4_PACKET_TYPE; h4->rx_count = 0; return 0; } h4->rx_skb->dev = (void *) hu->hdev; bt_cb(h4->rx_skb)->pkt_type = type; } return count; }
/* Recv data */ static int h4_recv(struct hci_uart *hu, void *data, int count) { struct h4_struct *h4 = hu->priv; register char *ptr; struct hci_event_hdr *eh; struct hci_acl_hdr *ah; struct hci_sco_hdr *sh; register int len, type, dlen; BT_DBG("hu %p count %d rx_state %ld rx_count %ld", hu, count, h4->rx_state, h4->rx_count); ptr = data; while (count) { if (h4->rx_count) { len = min_t(unsigned int, h4->rx_count, count); memcpy(skb_put(h4->rx_skb, len), ptr, len); h4->rx_count -= len; count -= len; ptr += len; if (h4->rx_count) continue; switch (h4->rx_state) { case H4_W4_DATA: BT_DBG("Complete data"); hci_recv_frame(h4->rx_skb); h4->rx_state = H4_W4_PACKET_TYPE; h4->rx_skb = NULL; continue; case H4_W4_EVENT_HDR: eh = (struct hci_event_hdr *) h4->rx_skb->data; BT_DBG("Event header: evt 0x%2.2x plen %d", eh->evt, eh->plen); h4_check_data_len(h4, eh->plen); continue; case H4_W4_ACL_HDR: ah = (struct hci_acl_hdr *) h4->rx_skb->data; dlen = __le16_to_cpu(ah->dlen); BT_DBG("ACL header: dlen %d", dlen); h4_check_data_len(h4, dlen); continue; case H4_W4_SCO_HDR: sh = (struct hci_sco_hdr *) h4->rx_skb->data; BT_DBG("SCO header: dlen %d", sh->dlen); h4_check_data_len(h4, sh->dlen); continue; } } /* H4_W4_PACKET_TYPE */ switch (*ptr) { case HCI_EVENT_PKT: BT_DBG("Event packet"); h4->rx_state = H4_W4_EVENT_HDR; h4->rx_count = HCI_EVENT_HDR_SIZE; type = HCI_EVENT_PKT; break; case HCI_ACLDATA_PKT: BT_DBG("ACL packet"); h4->rx_state = H4_W4_ACL_HDR; h4->rx_count = HCI_ACL_HDR_SIZE; type = HCI_ACLDATA_PKT; break; case HCI_SCODATA_PKT: BT_DBG("SCO packet"); h4->rx_state = H4_W4_SCO_HDR; h4->rx_count = HCI_SCO_HDR_SIZE; type = HCI_SCODATA_PKT; break; default: BT_ERR("Unknown HCI packet type %2.2x", (__u8)*ptr); hu->hdev->stat.err_rx++; ptr++; count--; continue; }; ptr++; count--; /* Allocate packet */ h4->rx_skb = bt_skb_alloc(HCI_MAX_FRAME_SIZE, GFP_ATOMIC); if (!h4->rx_skb) { BT_ERR("Can't allocate mem for new packet"); h4->rx_state = H4_W4_PACKET_TYPE; h4->rx_count = 0; return 0; } h4->rx_skb->dev = (void *) hu->hdev; bt_cb(h4->rx_skb)->pkt_type = type; }
/* Recv data */ static int h4_recv(struct hci_uart *hu, void *data, int count) { #ifdef CONFIG_RADIO_BCM4343S struct h4_struct *h4 = hu->priv; register char *ptr; struct hci_event_hdr *eh; struct hci_acl_hdr *ah; struct hci_sco_hdr *sh; struct fm_event_hdr *fm; register int len, type, dlen; static enum proto_type protoid = PROTO_SH_MAX; BT_DBG("hu %p count %d rx_state %ld rx_count %ld", hu, count, h4->rx_state, h4->rx_count); ptr = (char *)data; while (count) { if (h4->rx_count) { len = min_t(unsigned int, h4->rx_count, count); memcpy(skb_put(h4->rx_skb, len), ptr, len); h4->rx_count -= len; count -= len; ptr += len; if (h4->rx_count) continue; switch (h4->rx_state) { case H4_W4_DATA: BT_DBG("%2x %2x %2x %2x",h4->rx_skb->data[0], h4->rx_skb->data[1], h4->rx_skb->data[2], h4->rx_skb->data[3]); BT_DBG("%2x %2x %2x %2x",h4->rx_skb->data[4], h4->rx_skb->data[5], h4->rx_skb->data[6], h4->rx_skb->data[7]); BT_DBG("Complete data"); if ( ( h4->rx_skb->data[3] == 0x15 && h4->rx_skb->data[4] == 0xfc ) || ( h4->rx_skb->data[0] == 0xff && h4->rx_skb->data[1] == 0x01 && h4->rx_skb->data[2] == 0x08 ) ) { BT_DBG("FM Event change to FM CH8 packet"); type = FM_CH8_PKT; h4->rx_skb->cb[0] = FM_CH8_PKT; h4->rx_state = FM_W4_EVENT_HDR; protoid = PROTO_SH_FM; } hci_uart_route_frame(protoid, hu, h4->rx_skb); h4->rx_state = H4_W4_PACKET_TYPE; h4->rx_skb = NULL; protoid = PROTO_SH_MAX; continue; case H4_W4_EVENT_HDR: eh = hci_event_hdr(h4->rx_skb); BT_DBG("Event header: evt 0x%2.2x plen %d", eh->evt, eh->plen); h4_check_data_len(h4, hu, protoid, eh->plen); continue; case H4_W4_ACL_HDR: ah = hci_acl_hdr(h4->rx_skb); dlen = __le16_to_cpu(ah->dlen); BT_DBG("ACL header: dlen %d", dlen); h4_check_data_len(h4, hu, protoid, dlen); continue; case H4_W4_SCO_HDR: sh = hci_sco_hdr(h4->rx_skb); BT_DBG("SCO header: dlen %d", sh->dlen); h4_check_data_len(h4, hu, protoid, sh->dlen); continue; case FM_W4_EVENT_HDR: fm = (struct fm_event_hdr *)h4->rx_skb->data; BT_DBG("FM Header: evt 0x%2.2x plen %d", fm->event, fm->plen); h4_check_data_len(h4, hu, PROTO_SH_FM, fm->plen); continue; } } /* H4_W4_PACKET_TYPE */ switch (*ptr) { case HCI_EVENT_PKT: BT_DBG("Event packet"); BT_DBG("%2x %2x %2x %2x",ptr[0], ptr[1], ptr[2], ptr[3]); BT_DBG("%2x %2x %2x %2x",ptr[4], ptr[5], ptr[6], ptr[7]); if ( ptr[4] == 0x15 && ptr[5] == 0xfc ) { BT_DBG("FM Event change to FM CH8 packet"); type = FM_CH8_PKT; h4->rx_state = FM_W4_EVENT_HDR; h4->rx_count = FM_EVENT_HDR_SIZE; protoid = PROTO_SH_FM; } else { BT_DBG("FM Event is not detected"); h4->rx_state = H4_W4_EVENT_HDR; h4->rx_count = HCI_EVENT_HDR_SIZE; type = HCI_EVENT_PKT; protoid = PROTO_SH_BT; } break; case HCI_ACLDATA_PKT: BT_DBG("ACL packet"); h4->rx_state = H4_W4_ACL_HDR; h4->rx_count = HCI_ACL_HDR_SIZE; type = HCI_ACLDATA_PKT; protoid = PROTO_SH_BT; break; case HCI_SCODATA_PKT: BT_DBG("SCO packet"); h4->rx_state = H4_W4_SCO_HDR; h4->rx_count = HCI_SCO_HDR_SIZE; type = HCI_SCODATA_PKT; protoid = PROTO_SH_BT; break; /* Channel 8(FM) packet */ case FM_CH8_PKT: BT_DBG("FM CH8 packet"); type = FM_CH8_PKT; h4->rx_state = FM_W4_EVENT_HDR; h4->rx_count = FM_EVENT_HDR_SIZE; protoid = PROTO_SH_FM; break; default: BT_ERR("Unknown HCI packet type %2.2x", (__u8)*ptr); hu->hdev->stat.err_rx++; ptr++; count--; continue; }; ptr++; count--; switch (protoid) { case PROTO_SH_BT: case PROTO_SH_FM: /* Allocate new packet to hold received data */ h4->rx_skb = bt_skb_alloc(HCI_MAX_FRAME_SIZE, GFP_ATOMIC); if (!h4->rx_skb) { BT_ERR("Can't allocate mem for new packet"); h4->rx_state = H4_W4_PACKET_TYPE; h4->rx_count = 0; return -ENOMEM; } h4->rx_skb->dev = (void *) hu->hdev; sh_ldisc_cb(h4->rx_skb)->pkt_type = type; break; #if 0 case PROTO_SH_FM: /* for FM */ h4->rx_skb = bt_skb_alloc(FM_MAX_FRAME_SIZE, GFP_ATOMIC); if (!h4->rx_skb) { BT_ERR("Can't allocate mem for new packet"); h4->rx_state = H4_W4_PACKET_TYPE; h4->rx_count = 0; return -ENOMEM; } /* place holder 0x08 */ /* skb_reserve(h4->rx_skb, 1); */ sh_ldisc_cb(h4->rx_skb)->pkt_type = FM_CH8_PKT; break; #endif case PROTO_SH_MAX: case PROTO_SH_GPS: break; } }