| /* |
| * |
| * Bluetooth HCI UART driver for Broadcom devices |
| * |
| * Copyright (C) 2015 Intel Corporation |
| * |
| * |
| * This program is free software; you can redistribute it and/or modify |
| * it under the terms of the GNU General Public License as published by |
| * the Free Software Foundation; either version 2 of the License, or |
| * (at your option) any later version. |
| * |
| * This program is distributed in the hope that it will be useful, |
| * but WITHOUT ANY WARRANTY; without even the implied warranty of |
| * MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE. See the |
| * GNU General Public License for more details. |
| * |
| * You should have received a copy of the GNU General Public License |
| * along with this program; if not, write to the Free Software |
| * Foundation, Inc., 59 Temple Place, Suite 330, Boston, MA 02111-1307 USA |
| * |
| */ |
| |
| #include <linux/kernel.h> |
| #include <linux/errno.h> |
| #include <linux/skbuff.h> |
| |
| #include <net/bluetooth/bluetooth.h> |
| #include <net/bluetooth/hci_core.h> |
| |
| #include "btbcm.h" |
| #include "hci_uart.h" |
| |
| struct bcm_data { |
| struct sk_buff *rx_skb; |
| struct sk_buff_head txq; |
| }; |
| |
| static int bcm_open(struct hci_uart *hu) |
| { |
| struct bcm_data *bcm; |
| |
| BT_DBG("hu %p", hu); |
| |
| bcm = kzalloc(sizeof(*bcm), GFP_KERNEL); |
| if (!bcm) |
| return -ENOMEM; |
| |
| skb_queue_head_init(&bcm->txq); |
| |
| hu->priv = bcm; |
| return 0; |
| } |
| |
| static int bcm_close(struct hci_uart *hu) |
| { |
| struct bcm_data *bcm = hu->priv; |
| |
| BT_DBG("hu %p", hu); |
| |
| skb_queue_purge(&bcm->txq); |
| kfree_skb(bcm->rx_skb); |
| kfree(bcm); |
| |
| hu->priv = NULL; |
| return 0; |
| } |
| |
| static int bcm_flush(struct hci_uart *hu) |
| { |
| struct bcm_data *bcm = hu->priv; |
| |
| BT_DBG("hu %p", hu); |
| |
| skb_queue_purge(&bcm->txq); |
| |
| return 0; |
| } |
| |
| static int bcm_setup(struct hci_uart *hu) |
| { |
| BT_DBG("hu %p", hu); |
| |
| hu->hdev->set_bdaddr = btbcm_set_bdaddr; |
| |
| return btbcm_setup_patchram(hu->hdev); |
| } |
| |
| static const struct h4_recv_pkt bcm_recv_pkts[] = { |
| { H4_RECV_ACL, .recv = hci_recv_frame }, |
| { H4_RECV_SCO, .recv = hci_recv_frame }, |
| { H4_RECV_EVENT, .recv = hci_recv_frame }, |
| }; |
| |
| static int bcm_recv(struct hci_uart *hu, const void *data, int count) |
| { |
| struct bcm_data *bcm = hu->priv; |
| |
| if (!test_bit(HCI_UART_REGISTERED, &hu->flags)) |
| return -EUNATCH; |
| |
| bcm->rx_skb = h4_recv_buf(hu->hdev, bcm->rx_skb, data, count, |
| bcm_recv_pkts, ARRAY_SIZE(bcm_recv_pkts)); |
| if (IS_ERR(bcm->rx_skb)) { |
| int err = PTR_ERR(bcm->rx_skb); |
| BT_ERR("%s: Frame reassembly failed (%d)", hu->hdev->name, err); |
| bcm->rx_skb = NULL; |
| return err; |
| } |
| |
| return count; |
| } |
| |
| static int bcm_enqueue(struct hci_uart *hu, struct sk_buff *skb) |
| { |
| struct bcm_data *bcm = hu->priv; |
| |
| BT_DBG("hu %p skb %p", hu, skb); |
| |
| /* Prepend skb with frame type */ |
| memcpy(skb_push(skb, 1), &bt_cb(skb)->pkt_type, 1); |
| skb_queue_tail(&bcm->txq, skb); |
| |
| return 0; |
| } |
| |
| static struct sk_buff *bcm_dequeue(struct hci_uart *hu) |
| { |
| struct bcm_data *bcm = hu->priv; |
| |
| return skb_dequeue(&bcm->txq); |
| } |
| |
| static const struct hci_uart_proto bcm_proto = { |
| .id = HCI_UART_BCM, |
| .name = "BCM", |
| .open = bcm_open, |
| .close = bcm_close, |
| .flush = bcm_flush, |
| .setup = bcm_setup, |
| .recv = bcm_recv, |
| .enqueue = bcm_enqueue, |
| .dequeue = bcm_dequeue, |
| }; |
| |
| int __init bcm_init(void) |
| { |
| return hci_uart_register_proto(&bcm_proto); |
| } |
| |
| int __exit bcm_deinit(void) |
| { |
| return hci_uart_unregister_proto(&bcm_proto); |
| } |