Return-Path: X-Spam-Checker-Version: SpamAssassin 3.4.0 (2014-02-07) on aws-us-west-2-korg-lkml-1.web.codeaurora.org Received: from vger.kernel.org (vger.kernel.org [23.128.96.18]) by smtp.lore.kernel.org (Postfix) with ESMTP id 94CF9C433F5 for ; Sat, 18 Dec 2021 10:30:12 +0000 (UTC) Received: (majordomo@vger.kernel.org) by vger.kernel.org via listexpand id S231592AbhLRKaJ (ORCPT ); Sat, 18 Dec 2021 05:30:09 -0500 Received: from mx3.molgen.mpg.de ([141.14.17.11]:57477 "EHLO mx1.molgen.mpg.de" rhost-flags-OK-OK-OK-FAIL) by vger.kernel.org with ESMTP id S229536AbhLRKaF (ORCPT ); Sat, 18 Dec 2021 05:30:05 -0500 Received: from [192.168.0.3] (ip5f5aecf3.dynamic.kabel-deutschland.de [95.90.236.243]) (using TLSv1.3 with cipher TLS_AES_128_GCM_SHA256 (128/128 bits) key-exchange X25519 server-signature RSA-PSS (2048 bits)) (No client certificate requested) (Authenticated sender: pmenzel) by mx.molgen.mpg.de (Postfix) with ESMTPSA id 6A60661E5FE00; Sat, 18 Dec 2021 11:30:03 +0100 (CET) Message-ID: <638a2506-c410-d98c-b704-6f16f72e0bc6@molgen.mpg.de> Date: Sat, 18 Dec 2021 11:30:03 +0100 MIME-Version: 1.0 User-Agent: Mozilla/5.0 (X11; Linux x86_64; rv:91.0) Gecko/20100101 Thunderbird/91.4.0 Subject: Re: [PATCH 2/3] Bluetooth: btmtksdio: Enable SCO over I2S function Content-Language: en-US To: Sean Wang , Mark Chen Cc: Marcel Holtmann , Johan Hedberg , Soul.Huang@mediatek.com, YN.Chen@mediatek.com, Leon.Yen@mediatek.com, Eric-SY.Chang@mediatek.com, Deren.Wu@mediatek.com, km.lin@mediatek.com, robin.chiu@mediatek.com, Eddie.Chen@mediatek.com, ch.yeh@mediatek.com, posh.sun@mediatek.com, ted.huang@mediatek.com, Eric.Liang@mediatek.com, Stella.Chang@mediatek.com, Tom.Chou@mediatek.com, steve.lee@mediatek.com, jsiuda@google.com, frankgor@google.com, jemele@google.com, abhishekpandit@google.com, michaelfsun@google.com, mcchou@chromium.org, shawnku@google.com, linux-bluetooth@vger.kernel.org, linux-mediatek@lists.infradead.org, linux-kernel@vger.kernel.org References: <632534014b9b8a38e81dfb5749dcd75e2088adb1.1639787634.git.objelf@gmail.com> From: Paul Menzel In-Reply-To: Content-Type: text/plain; charset=UTF-8; format=flowed Content-Transfer-Encoding: 7bit Precedence: bulk List-ID: X-Mailing-List: linux-bluetooth@vger.kernel.org Dear Sean, dear Mark, Am 18.12.21 um 02:08 schrieb sean.wang@mediatek.com: > From: Mark Chen > > For MediaTek chipset, the driver has to issue the specific command to > enable Bluetooth SCO support over the I2S/PCM interface. Please document the datasheet name, revision and section, where this is described. Please add how SCO support can be tested. Are all Mediatek chipsets supported? > Co-developed-by: Sean Wang > Signed-off-by: Sean Wang > Signed-off-by: Mark Chen > --- > drivers/bluetooth/btmtk.h | 20 +++++++++ > drivers/bluetooth/btmtksdio.c | 76 +++++++++++++++++++++++++++++++++++ > 2 files changed, 96 insertions(+) > > diff --git a/drivers/bluetooth/btmtk.h b/drivers/bluetooth/btmtk.h > index 2be1d2680ad8..fc57ef09d132 100644 > --- a/drivers/bluetooth/btmtk.h > +++ b/drivers/bluetooth/btmtk.h > @@ -7,8 +7,12 @@ > > #define HCI_WMT_MAX_EVENT_SIZE 64 > > +#define BTMTK_WMT_REG_WRITE 0x1 > #define BTMTK_WMT_REG_READ 0x2 > > +#define MT7921_PINMUX_0 0x70005050 > +#define MT7921_PINMUX_1 0x70005054 > + > enum { > BTMTK_WMT_PATCH_DWNLD = 0x1, > BTMTK_WMT_TEST = 0x2, > @@ -76,6 +80,22 @@ struct btmtk_wakeon { > __le16 wakeup_delay; > } __packed; > > +struct btmtk_sco { > + u8 clock_config; > + u8 transmit_format_config; > + u8 channel_format_config; > + u8 channel_select_config; > +} __packed; > + > +struct reg_write_cmd { > + u8 type; > + u8 rsv; > + u8 num; > + __le32 addr; > + __le32 data; > + __le32 mask; > +} __packed; > + > struct btmtk_hci_wmt_params { > u8 op; > u8 flag; > diff --git a/drivers/bluetooth/btmtksdio.c b/drivers/bluetooth/btmtksdio.c > index 771733ce362b..8e4d8c2da824 100644 > --- a/drivers/bluetooth/btmtksdio.c > +++ b/drivers/bluetooth/btmtksdio.c > @@ -830,6 +830,74 @@ static int btsdio_mtk_reg_read(struct hci_dev *hdev, u32 reg, u32 *val) > return err; > } > > +static int btsdio_mtk_reg_write(struct hci_dev *hdev, u32 reg, u32 val, u32 mask) > +{ > + struct btmtk_hci_wmt_params wmt_params; > + struct reg_write_cmd reg_write = { > + .type = 1, > + .num = 1, > + .addr = cpu_to_le32(reg), > + .data = cpu_to_le32(val), > + .mask = cpu_to_le32(mask), > + }; > + int err, status; > + > + wmt_params.op = BTMTK_WMT_REGISTER; > + wmt_params.flag = BTMTK_WMT_REG_WRITE; > + wmt_params.dlen = sizeof(reg_write); > + wmt_params.data = ®_write; > + wmt_params.status = &status; > + > + err = mtk_hci_wmt_sync(hdev, &wmt_params); > + if (err < 0) > + bt_dev_err(hdev, "Failed to write reg(%d)", err); > + > + return err; > +} > + > +static int btsdio_mtk_sco_setting(struct hci_dev *hdev) > +{ > + struct btmtk_sco sco_setting = { > + .clock_config = 0x49, > + .channel_format_config = 0x80, > + }; > + struct sk_buff *skb; > + u32 val; > + int err; > + > + /* Enable SCO over i2s/pcm for Mediatek Chipset */ s/Chipset/chipset/ > + skb = __hci_cmd_sync(hdev, 0xfc72, sizeof(sco_setting), > + &sco_setting, HCI_CMD_TIMEOUT); > + if (IS_ERR(skb)) > + return PTR_ERR(skb); > + > + err = btsdio_mtk_reg_read(hdev, MT7921_PINMUX_0, &val); > + if (err < 0) { > + bt_dev_err(hdev, "Failed to read register (%d)", err); > + return err; > + } > + > + val |= 0x11000000; > + err = btsdio_mtk_reg_write(hdev, MT7921_PINMUX_0, val, ~0); > + if (err < 0) { > + bt_dev_err(hdev, "Failed to write register (%d)", err); > + return err; > + } > + > + err = btsdio_mtk_reg_read(hdev, MT7921_PINMUX_1, &val); > + if (err < 0) { > + bt_dev_err(hdev, "Failed to read register (%d)", err); > + return err; > + } > + > + val |= 0x00000101; > + err = btsdio_mtk_reg_write(hdev, MT7921_PINMUX_1, val, ~0); > + if (err < 0) > + bt_dev_err(hdev, "Failed to write register (%d)", err); > + > + return err; > +} > + > static int btmtksdio_setup(struct hci_dev *hdev) > { > struct btmtksdio_dev *bdev = hci_get_drvdata(hdev); > @@ -862,6 +930,14 @@ static int btmtksdio_setup(struct hci_dev *hdev) > err = mt79xx_setup(hdev, fwname); > if (err < 0) > return err; > + > + /* Enable sco over i2s/pcm */ s/sco/SCO/ > + err = btsdio_mtk_sco_setting(hdev); > + if (err < 0) { > + bt_dev_err(hdev, "Failed to enable sco setting (%d)", err); s/sco/SCO/ > + return err; > + } > + > break; > case 0x7663: > case 0x7668: Kind regards, Paul