From patchwork Wed Nov 29 12:45:10 2017 Content-Type: text/plain; charset="utf-8" MIME-Version: 1.0 Content-Transfer-Encoding: 7bit X-Patchwork-Submitter: Amitkumar Karwar X-Patchwork-Id: 10082101 X-Patchwork-Delegate: kvalo@adurom.com Return-Path: Received: from mail.wl.linuxfoundation.org (pdx-wl-mail.web.codeaurora.org [172.30.200.125]) by pdx-korg-patchwork.web.codeaurora.org (Postfix) with ESMTP id 039FD6020B for ; Wed, 29 Nov 2017 12:54:01 +0000 (UTC) Received: from mail.wl.linuxfoundation.org (localhost [127.0.0.1]) by mail.wl.linuxfoundation.org (Postfix) with ESMTP id E861529778 for ; Wed, 29 Nov 2017 12:54:00 +0000 (UTC) Received: by mail.wl.linuxfoundation.org (Postfix, from userid 486) id C965029780; Wed, 29 Nov 2017 12:54:00 +0000 (UTC) X-Spam-Checker-Version: SpamAssassin 3.3.1 (2010-03-16) on pdx-wl-mail.web.codeaurora.org X-Spam-Level: X-Spam-Status: No, score=-7.0 required=2.0 tests=BAYES_00,DKIM_SIGNED, DKIM_VALID, DKIM_VALID_AU, FREEMAIL_FROM, RCVD_IN_DNSWL_HI autolearn=ham version=3.3.1 Received: from vger.kernel.org (vger.kernel.org [209.132.180.67]) by mail.wl.linuxfoundation.org (Postfix) with ESMTP id 0A1F929768 for ; Wed, 29 Nov 2017 12:54:00 +0000 (UTC) Received: (majordomo@vger.kernel.org) by vger.kernel.org via listexpand id S932166AbdK2Mxk (ORCPT ); Wed, 29 Nov 2017 07:53:40 -0500 Received: from mail-pf0-f193.google.com ([209.85.192.193]:41700 "EHLO mail-pf0-f193.google.com" rhost-flags-OK-OK-OK-OK) by vger.kernel.org with ESMTP id S1753478AbdK2Mxh (ORCPT ); Wed, 29 Nov 2017 07:53:37 -0500 Received: by mail-pf0-f193.google.com with SMTP id j28so1513143pfk.8; Wed, 29 Nov 2017 04:53:37 -0800 (PST) DKIM-Signature: v=1; a=rsa-sha256; c=relaxed/relaxed; d=gmail.com; s=20161025; h=from:to:cc:subject:date:message-id:in-reply-to:references; bh=On1kWTO0ir+x3untiXxg1ZAbZS83j/HssUwB/r9jphE=; b=L5X6asO5p68PA8rZ1D4F+CqCEQ6nlgTy6Wh25zQUYeHHVL07mw2zAgg3q1JC8obsUO QhxCDa7wqypd6nSYXSO9b9/Dmmcc7N7VKpZM1G47bzgTnyoSUZ5w4s/cggK/WdVHxDFo XFtxmJIv1sWXwbojhkBbFfmoupqzqyS5X2xtb9k6tV61TD7Qu5TQxXYDOI1KtwuKO6Y6 SVFPCOoaa1AxKpO5zaRnPGyHvjt/DC4/zxInoIWV9K447uZM8btuyVOxrEJeOHixGXK2 +WAemb7+BPiZYSvPC2Hywe25RnVkH3ewRiJEJAuS/Na2PJSf9PFLv24Plv02OGAj3Y4a JEfg== X-Google-DKIM-Signature: v=1; a=rsa-sha256; c=relaxed/relaxed; d=1e100.net; s=20161025; h=x-gm-message-state:from:to:cc:subject:date:message-id:in-reply-to :references; bh=On1kWTO0ir+x3untiXxg1ZAbZS83j/HssUwB/r9jphE=; b=Q9kmiTd0oJXR6yseB1ms41sCYdtEPC2SNVNpLxkGdwKOLIVIVi3NUbFR1KwOIX5M/n YN6no/sYp9D3SMdaOO1dmqOeJE3xb9z3Q0x3vucrSGFB2uFmM0/5haMM9uAV+t/7vk7r ZwsqqBf3rDjScrW8zIjakDYvlzcF874WOwrdPQbxLqSzBJ6TlpnogYOlQok+JVejUBy0 IF1kSwhuXNrEOmt2hpcoSPAjGY45Bou5jqzhsoeStfIEPpudgbiBSlO3iADIRLIvCc5Q zuBBfPgI4HPb0h4NqNOCOOL1shgckucwEyrdrG6LD26ZJETkV2Mdm0Zt2pqTMxJgDZD9 ajcA== X-Gm-Message-State: AJaThX5wtrGXFc+hK5RONU2ToDwaHtj8pgVQ1OE2T3mZ3m8my+8nmArp zai1C9IzV9GX2dte0E3Iagg= X-Google-Smtp-Source: AGs4zMaS+BaZ02MX5cjHV+zLaHiMCkMeLJEo6nk+BCH+D8lyJ3Xs6kmfwwvBDldvs34A4h2geJuCJQ== X-Received: by 10.101.75.12 with SMTP id r12mr2688236pgq.435.1511960016995; Wed, 29 Nov 2017 04:53:36 -0800 (PST) Received: from cpu185.redpinesignals.com ([203.196.161.90]) by smtp.gmail.com with ESMTPSA id p126sm3179100pga.58.2017.11.29.04.53.34 (version=TLS1_2 cipher=ECDHE-RSA-AES128-SHA bits=128/128); Wed, 29 Nov 2017 04:53:36 -0800 (PST) From: Amitkumar Karwar To: Kalle Valo , marcel@holtmann.org Cc: linux-wireless@vger.kernel.org, Amitkumar Karwar , Prameela Rani Garnepudi , linux-bluetooth@vger.kernel.org, Siva Rebbagondla Subject: [v2 5/8] Bluetooth: btrsi: add new rsi bluetooth driver Date: Wed, 29 Nov 2017 18:15:10 +0530 Message-Id: <1511959513-3902-6-git-send-email-amitkarwar@gmail.com> X-Mailer: git-send-email 2.7.4 In-Reply-To: <1511959513-3902-1-git-send-email-amitkarwar@gmail.com> References: <1511959513-3902-1-git-send-email-amitkarwar@gmail.com> Sender: linux-wireless-owner@vger.kernel.org Precedence: bulk List-ID: X-Mailing-List: linux-wireless@vger.kernel.org X-Virus-Scanned: ClamAV using ClamSMTP From: Prameela Rani Garnepudi Redpine bluetooth driver is a thin driver which depends on 'rsi_91x' driver for transmitting and receiving packets to/from device. It creates hci interface when attach() is called from 'rsi_91x' module. Signed-off-by: Prameela Rani Garnepudi Signed-off-by: Siva Rebbagondla Signed-off-by: Amitkumar Karwar --- v2: Addressed review comments from Marcel Removed unnecessary 'depends on BT && BT_RFOMM' line in Kconfig Removed redundant BT_INFO messages h_adapter initialization and declaration in a single line. Removed unnecessary error checks for HCI_RUNNING and fsm_state Allocated new skb with skb_realloc_headroom() API if headroom is not sufficient Used get_unaligned_le16 helpers Moved a structure and union from header file to btrsi.c file --- drivers/bluetooth/Kconfig | 11 +++ drivers/bluetooth/Makefile | 2 + drivers/bluetooth/btrsi.c | 216 ++++++++++++++++++++++++++++++++++++++++++++ drivers/bluetooth/rsi_hci.h | 40 ++++++++ 4 files changed, 269 insertions(+) create mode 100644 drivers/bluetooth/btrsi.c create mode 100644 drivers/bluetooth/rsi_hci.h diff --git a/drivers/bluetooth/Kconfig b/drivers/bluetooth/Kconfig index 60e1c7d..56c0e16 100644 --- a/drivers/bluetooth/Kconfig +++ b/drivers/bluetooth/Kconfig @@ -378,4 +378,15 @@ config BT_QCOMSMD Say Y here to compile support for HCI over Qualcomm SMD into the kernel or say M to compile as a module. +config BT_RSI + tristate "Redpine HCI support" + default m + help + Redpine BT driver. + This driver handles BT traffic from upper layers and pass + to the RSI_91x coex module for further scheduling to device + + Say Y here to compile support for HCI over Redpine into the + kernel or say M to compile as a module. + endmenu diff --git a/drivers/bluetooth/Makefile b/drivers/bluetooth/Makefile index 4e4e44d..712af83a 100644 --- a/drivers/bluetooth/Makefile +++ b/drivers/bluetooth/Makefile @@ -28,6 +28,8 @@ obj-$(CONFIG_BT_QCA) += btqca.o obj-$(CONFIG_BT_HCIUART_NOKIA) += hci_nokia.o +obj-$(CONFIG_BT_RSI) += btrsi.o + btmrvl-y := btmrvl_main.o btmrvl-$(CONFIG_DEBUG_FS) += btmrvl_debugfs.o diff --git a/drivers/bluetooth/btrsi.c b/drivers/bluetooth/btrsi.c new file mode 100644 index 0000000..db33482 --- /dev/null +++ b/drivers/bluetooth/btrsi.c @@ -0,0 +1,216 @@ +/** + * Copyright (c) 2017 Redpine Signals Inc. + * + * Permission to use, copy, modify, and/or distribute this software for any + * purpose with or without fee is hereby granted, provided that the above + * copyright notice and this permission notice appear in all copies. + * + * THE SOFTWARE IS PROVIDED "AS IS" AND THE AUTHOR DISCLAIMS ALL WARRANTIES + * WITH REGARD TO THIS SOFTWARE INCLUDING ALL IMPLIED WARRANTIES OF + * MERCHANTABILITY AND FITNESS. IN NO EVENT SHALL THE AUTHOR BE LIABLE FOR +e* ANY SPECIAL, DIRECT, INDIRECT, OR CONSEQUENTIAL DAMAGES OR ANY DAMAGES + * WHATSOEVER RESULTING FROM LOSS OF USE, DATA OR PROFITS, WHETHER IN AN + * ACTION OF CONTRACT, NEGLIGENCE OR OTHER TORTIOUS ACTION, ARISING OUT OF + * OR IN CONNECTION WITH THE USE OR PERFORMANCE OF THIS SOFTWARE. + */ +#include +#include +#include +#include "rsi_hci.h" + +struct rsi_hci_adapter { + void *priv; + struct rsi_proto_ops *proto_ops; + struct hci_dev *hdev; +}; + +static struct rsi_mod_ops rsi_bt_ops = { + .attach = rsi_hci_attach, + .detach = rsi_hci_detach, + .recv_pkt = rsi_hci_recv_pkt, +}; + +static int rsi_hci_open(struct hci_dev *hdev) +{ + return 0; +} + +static int rsi_hci_close(struct hci_dev *hdev) +{ + return 0; +} + +static int rsi_hci_flush(struct hci_dev *hdev) +{ + return 0; +} + +static int rsi_hci_send_pkt(struct hci_dev *hdev, struct sk_buff *skb) +{ + struct rsi_hci_adapter *h_adapter = hci_get_drvdata(hdev); + struct sk_buff *new_skb = NULL; + + switch (bt_cb(skb)->pkt_type) { + case HCI_COMMAND_PKT: + hdev->stat.cmd_tx++; + break; + + case HCI_ACLDATA_PKT: + hdev->stat.acl_tx++; + break; + + case HCI_SCODATA_PKT: + hdev->stat.sco_tx++; + break; + } + + if (skb_headroom(skb) < RSI_HEADROOM_FOR_BT_HAL) { + /* Insufficient skb headroom - allocate a new skb */ + new_skb = skb_realloc_headroom(skb, RSI_HEADROOM_FOR_BT_HAL); + if (unlikely(!new_skb)) + return -ENOMEM; + bt_cb(new_skb)->pkt_type = bt_cb(skb)->pkt_type; + kfree_skb(skb); + skb = new_skb; + } + + return h_adapter->proto_ops->coex_send_pkt(h_adapter->priv, skb, + RSI_BT_Q); +} + +int rsi_hci_recv_pkt(void *priv, u8 *pkt) +{ + struct rsi_hci_adapter *h_adapter = (struct rsi_hci_adapter *)priv; + struct hci_dev *hdev = h_adapter->hdev; + struct sk_buff *skb; + + int pkt_len = get_unaligned_le16(pkt) & 0x0fff; + u8 queue_no = (get_unaligned_le16(pkt) & 0x7000) >> 12; + + if (queue_no == RSI_BT_MGMT_Q) { + u8 msg_type = pkt[14] & 0xFF; + + switch (msg_type) { + case RSI_RESULT_CONFIRM: + bt_dev_info(hdev, "BT Result Confirm"); + return 0; + case RSI_BT_BER: + bt_dev_info(hdev, "BT Ber"); + return 0; + case RSI_BT_CW: + bt_dev_info(hdev, "BT CW"); + return 0; + default: + break; + } + } + + skb = dev_alloc_skb(pkt_len); + if (!skb) + return -ENOMEM; + + memcpy(skb->data, pkt + RSI_FRAME_DESC_SIZE, pkt_len); + skb_put(skb, pkt_len); + h_adapter->hdev->stat.byte_rx += skb->len; + + skb->dev = (void *)hdev; + bt_cb(skb)->pkt_type = pkt[14]; + + return hci_recv_frame(hdev, skb); +} + +int rsi_hci_attach(void *priv, struct rsi_proto_ops *ops) +{ + struct rsi_hci_adapter *h_adapter = NULL; + struct hci_dev *hdev; + int status = 0; + + h_adapter = kzalloc(sizeof(*h_adapter), GFP_KERNEL); + if (!h_adapter) + return -ENOMEM; + + h_adapter->priv = priv; + ops->set_bt_context(priv, h_adapter); + h_adapter->proto_ops = ops; + + hdev = hci_alloc_dev(); + if (!hdev) { + BT_ERR("Failed to alloc HCI device\n"); + goto err; + } + + h_adapter->hdev = hdev; + + if (ops->get_host_intf(priv) == RSI_HOST_INTF_SDIO) + hdev->bus = HCI_SDIO; + else + hdev->bus = HCI_USB; + + hci_set_drvdata(hdev, h_adapter); + hdev->dev_type = HCI_PRIMARY; + hdev->open = rsi_hci_open; + hdev->close = rsi_hci_close; + hdev->flush = rsi_hci_flush; + hdev->send = rsi_hci_send_pkt; + + status = hci_register_dev(hdev); + if (status < 0) { + BT_ERR("%s: HCI registration failed with errcode %d\n", + __func__, status); + goto err; + } + + return 0; +err: + if (hdev) { + hci_unregister_dev(hdev); + hci_free_dev(hdev); + h_adapter->hdev = NULL; + } + kfree(h_adapter); + + return -EINVAL; +} + +void rsi_hci_detach(void *priv) +{ + struct rsi_hci_adapter *h_adapter = (struct rsi_hci_adapter *)priv; + struct hci_dev *hdev; + + if (!h_adapter) + return; + + hdev = h_adapter->hdev; + if (hdev) { + hci_unregister_dev(hdev); + hci_free_dev(hdev); + h_adapter->hdev = NULL; + } + + kfree(h_adapter); +} + +struct rsi_mod_ops *rsi_get_hci_ops(void) +{ + return &rsi_bt_ops; +}; +EXPORT_SYMBOL_GPL(rsi_get_hci_ops); + +static int rsi_91x_bt_module_init(void) +{ + BT_INFO("%s: BT Module init called\n", __func__); + + return 0; +} + +static void rsi_91x_bt_module_exit(void) +{ + BT_INFO("%s: BT Module exit called\n", __func__); +} + +module_init(rsi_91x_bt_module_init); +module_exit(rsi_91x_bt_module_exit); +MODULE_AUTHOR("Redpine Signals Inc"); +MODULE_DESCRIPTION("RSI BT driver"); +MODULE_SUPPORTED_DEVICE("RSI-BT"); +MODULE_LICENSE("Dual BSD/GPL"); diff --git a/drivers/bluetooth/rsi_hci.h b/drivers/bluetooth/rsi_hci.h new file mode 100644 index 0000000..6fc7757 --- /dev/null +++ b/drivers/bluetooth/rsi_hci.h @@ -0,0 +1,40 @@ +/** + * Copyright (c) 2017 Redpine Signals Inc. + * + * Permission to use, copy, modify, and/or distribute this software for any + * purpose with or without fee is hereby granted, provided that the above + * copyright notice and this permission notice appear in all copies. + * + * THE SOFTWARE IS PROVIDED "AS IS" AND THE AUTHOR DISCLAIMS ALL WARRANTIES + * WITH REGARD TO THIS SOFTWARE INCLUDING ALL IMPLIED WARRANTIES OF + * MERCHANTABILITY AND FITNESS. IN NO EVENT SHALL THE AUTHOR BE LIABLE FOR + * ANY SPECIAL, DIRECT, INDIRECT, OR CONSEQUENTIAL DAMAGES OR ANY DAMAGES + * WHATSOEVER RESULTING FROM LOSS OF USE, DATA OR PROFITS, WHETHER IN AN + * ACTION OF CONTRACT, NEGLIGENCE OR OTHER TORTIOUS ACTION, ARISING OUT OF + * OR IN CONNECTION WITH THE USE OR PERFORMANCE OF THIS SOFTWARE. + */ + +#ifndef __RSI_HCI_H__ +#define __RSI_HCI_H__ + +#include +#include +#include +#include +#include + +/* RX frame types */ +#define RSI_RESULT_CONFIRM 0x80 +#define RSI_BT_PER 0x10 +#define RSI_BT_BER 0x11 +#define RSI_BT_CW 0x12 + +#define RSI_HEADROOM_FOR_BT_HAL 16 + +#define RSI_FRAME_DESC_SIZE 16 + +int rsi_hci_attach(void *priv, struct rsi_proto_ops *ops); +void rsi_hci_detach(void *priv); +int rsi_hci_recv_pkt(void *data, u8 *pkt); + +#endif