Commit 5c5e8c52 authored by Chris Lu's avatar Chris Lu Committed by Luiz Augusto von Dentz
Browse files

Bluetooth: btmtk: move btusb_mtk_[setup, shutdown] to btmtk.c 



Move btusb_mtk_[setup, shutdown] and related function from
btusb.c to btmtk.c which holds vendor specific stuff and
would make btusb.c clean.

Signed-off-by: default avatarSean Wang <sean.wang@mediatek.com>
Signed-off-by: default avatarChris Lu <chris.lu@mediatek.com>
Signed-off-by: default avatarLuiz Augusto von Dentz <luiz.von.dentz@intel.com>
parent d019930b

drivers/bluetooth/btmtk.c

+451 −3
Original line number Diff line number Diff line
@@ -5,6 +5,8 @@ 
#include <linux/module.h>

#include <linux/firmware.h>

#include <linux/usb.h>

#include <linux/iopoll.h>

#include <asm/unaligned.h>



#include <net/bluetooth/bluetooth.h>

#include <net/bluetooth/hci_core.h>
@@ -567,7 +569,7 @@ static int btmtk_usb_submit_wmt_recv_urb(struct hci_dev *hdev) 
	return err;

}



int btmtk_usb_hci_wmt_sync(struct hci_dev *hdev,

static int btmtk_usb_hci_wmt_sync(struct hci_dev *hdev,

				  struct btmtk_hci_wmt_params *wmt_params)

{

	struct btmtk_data *data = hci_get_priv(hdev);
@@ -694,7 +696,453 @@ int btmtk_usb_hci_wmt_sync(struct hci_dev *hdev, 
	kfree(wc);

	return err;

}

EXPORT_SYMBOL_GPL(btmtk_usb_hci_wmt_sync);



static int btmtk_usb_func_query(struct hci_dev *hdev)

{

	struct btmtk_hci_wmt_params wmt_params;

	int status, err;

	u8 param = 0;



	/* Query whether the function is enabled */

	wmt_params.op = BTMTK_WMT_FUNC_CTRL;

	wmt_params.flag = 4;

	wmt_params.dlen = sizeof(param);

	wmt_params.data = &param;

	wmt_params.status = &status;



	err = btmtk_usb_hci_wmt_sync(hdev, &wmt_params);

	if (err < 0) {

		bt_dev_err(hdev, "Failed to query function status (%d)", err);

		return err;

	}



	return status;

}



static int btmtk_usb_uhw_reg_write(struct hci_dev *hdev, u32 reg, u32 val)

{

	struct btmtk_data *data = hci_get_priv(hdev);

	int pipe, err;

	void *buf;



	buf = kzalloc(4, GFP_KERNEL);

	if (!buf)

		return -ENOMEM;



	put_unaligned_le32(val, buf);



	pipe = usb_sndctrlpipe(data->udev, 0);

	err = usb_control_msg(data->udev, pipe, 0x02,

			      0x5E,

			      reg >> 16, reg & 0xffff,

			      buf, 4, USB_CTRL_SET_TIMEOUT);

	if (err < 0)

		bt_dev_err(hdev, "Failed to write uhw reg(%d)", err);



	kfree(buf);



	return err;

}



static int btmtk_usb_uhw_reg_read(struct hci_dev *hdev, u32 reg, u32 *val)

{

	struct btmtk_data *data = hci_get_priv(hdev);

	int pipe, err;

	void *buf;



	buf = kzalloc(4, GFP_KERNEL);

	if (!buf)

		return -ENOMEM;



	pipe = usb_rcvctrlpipe(data->udev, 0);

	err = usb_control_msg(data->udev, pipe, 0x01,

			      0xDE,

			      reg >> 16, reg & 0xffff,

			      buf, 4, USB_CTRL_GET_TIMEOUT);

	if (err < 0) {

		bt_dev_err(hdev, "Failed to read uhw reg(%d)", err);

		goto err_free_buf;

	}



	*val = get_unaligned_le32(buf);

	bt_dev_dbg(hdev, "reg=%x, value=0x%08x", reg, *val);



err_free_buf:

	kfree(buf);



	return err;

}



static int btmtk_usb_reg_read(struct hci_dev *hdev, u32 reg, u32 *val)

{

	struct btmtk_data *data = hci_get_priv(hdev);

	int pipe, err, size = sizeof(u32);

	void *buf;



	buf = kzalloc(size, GFP_KERNEL);

	if (!buf)

		return -ENOMEM;



	pipe = usb_rcvctrlpipe(data->udev, 0);

	err = usb_control_msg(data->udev, pipe, 0x63,

			      USB_TYPE_VENDOR | USB_DIR_IN,

			      reg >> 16, reg & 0xffff,

			      buf, size, USB_CTRL_GET_TIMEOUT);

	if (err < 0)

		goto err_free_buf;



	*val = get_unaligned_le32(buf);



err_free_buf:

	kfree(buf);



	return err;

}



static int btmtk_usb_id_get(struct hci_dev *hdev, u32 reg, u32 *id)

{

	return btmtk_usb_reg_read(hdev, reg, id);

}



static u32 btmtk_usb_reset_done(struct hci_dev *hdev)

{

	u32 val = 0;



	btmtk_usb_uhw_reg_read(hdev, MTK_BT_MISC, &val);



	return val & MTK_BT_RST_DONE;

}



int btmtk_usb_subsys_reset(struct hci_dev *hdev, u32 dev_id)

{

	u32 val;

	int err;



	if (dev_id == 0x7922) {

		err = btmtk_usb_uhw_reg_read(hdev, MTK_BT_SUBSYS_RST, &val);

		if (err < 0)

			return err;

		val |= 0x00002020;

		err = btmtk_usb_uhw_reg_write(hdev, MTK_BT_SUBSYS_RST, val);

		if (err < 0)

			return err;

		err = btmtk_usb_uhw_reg_write(hdev, MTK_EP_RST_OPT, 0x00010001);

		if (err < 0)

			return err;

		err = btmtk_usb_uhw_reg_read(hdev, MTK_BT_SUBSYS_RST, &val);

		if (err < 0)

			return err;

		val |= BIT(0);

		err = btmtk_usb_uhw_reg_write(hdev, MTK_BT_SUBSYS_RST, val);

		if (err < 0)

			return err;

		msleep(100);

	} else if (dev_id == 0x7925) {

		err = btmtk_usb_uhw_reg_read(hdev, MTK_BT_RESET_REG_CONNV3, &val);

		if (err < 0)

			return err;

		val |= (1 << 5);

		err = btmtk_usb_uhw_reg_write(hdev, MTK_BT_RESET_REG_CONNV3, val);

		if (err < 0)

			return err;

		err = btmtk_usb_uhw_reg_read(hdev, MTK_BT_RESET_REG_CONNV3, &val);

		if (err < 0)

			return err;

		val &= 0xFFFF00FF;

		val |= (1 << 13);

		err = btmtk_usb_uhw_reg_write(hdev, MTK_BT_RESET_REG_CONNV3, val);

		if (err < 0)

			return err;

		err = btmtk_usb_uhw_reg_write(hdev, MTK_EP_RST_OPT, 0x00010001);

		if (err < 0)

			return err;

		err = btmtk_usb_uhw_reg_read(hdev, MTK_BT_RESET_REG_CONNV3, &val);

		if (err < 0)

			return err;

		val |= (1 << 0);

		err = btmtk_usb_uhw_reg_write(hdev, MTK_BT_RESET_REG_CONNV3, val);

		if (err < 0)

			return err;

		err = btmtk_usb_uhw_reg_write(hdev, MTK_UDMA_INT_STA_BT, 0x000000FF);

		if (err < 0)

			return err;

		err = btmtk_usb_uhw_reg_read(hdev, MTK_UDMA_INT_STA_BT, &val);

		if (err < 0)

			return err;

		err = btmtk_usb_uhw_reg_write(hdev, MTK_UDMA_INT_STA_BT1, 0x000000FF);

		if (err < 0)

			return err;

		err = btmtk_usb_uhw_reg_read(hdev, MTK_UDMA_INT_STA_BT1, &val);

		if (err < 0)

			return err;

		msleep(100);

	} else {

		/* It's Device EndPoint Reset Option Register */

		bt_dev_dbg(hdev, "Initiating reset mechanism via uhw");

		err = btmtk_usb_uhw_reg_write(hdev, MTK_EP_RST_OPT, MTK_EP_RST_IN_OUT_OPT);

		if (err < 0)

			return err;

		err = btmtk_usb_uhw_reg_read(hdev, MTK_BT_WDT_STATUS, &val);

		if (err < 0)

			return err;

		/* Reset the bluetooth chip via USB interface. */

		err = btmtk_usb_uhw_reg_write(hdev, MTK_BT_SUBSYS_RST, 1);

		if (err < 0)

			return err;

		err = btmtk_usb_uhw_reg_write(hdev, MTK_UDMA_INT_STA_BT, 0x000000FF);

		if (err < 0)

			return err;

		err = btmtk_usb_uhw_reg_read(hdev, MTK_UDMA_INT_STA_BT, &val);

		if (err < 0)

			return err;

		err = btmtk_usb_uhw_reg_write(hdev, MTK_UDMA_INT_STA_BT1, 0x000000FF);

		if (err < 0)

			return err;

		err = btmtk_usb_uhw_reg_read(hdev, MTK_UDMA_INT_STA_BT1, &val);

		if (err < 0)

			return err;

		/* MT7921 need to delay 20ms between toggle reset bit */

		msleep(20);

		err = btmtk_usb_uhw_reg_write(hdev, MTK_BT_SUBSYS_RST, 0);

		if (err < 0)

			return err;

		err = btmtk_usb_uhw_reg_read(hdev, MTK_BT_SUBSYS_RST, &val);

		if (err < 0)

			return err;

	}



	err = readx_poll_timeout(btmtk_usb_reset_done, hdev, val,

				 val & MTK_BT_RST_DONE, 20000, 1000000);

	if (err < 0)

		bt_dev_err(hdev, "Reset timeout");



	if (dev_id == 0x7922) {

		err = btmtk_usb_uhw_reg_write(hdev, MTK_UDMA_INT_STA_BT, 0x000000FF);

		if (err < 0)

			return err;

	}



	err = btmtk_usb_id_get(hdev, 0x70010200, &val);

	if (err < 0 || !val)

		bt_dev_err(hdev, "Can't get device id, subsys reset fail.");



	return err;

}

EXPORT_SYMBOL_GPL(btmtk_usb_subsys_reset);



int btmtk_usb_setup(struct hci_dev *hdev)

{

	struct btmtk_data *btmtk_data = hci_get_priv(hdev);

	struct btmtk_hci_wmt_params wmt_params;

	ktime_t calltime, delta, rettime;

	struct btmtk_tci_sleep tci_sleep;

	unsigned long long duration;

	struct sk_buff *skb;

	const char *fwname;

	int err, status;

	u32 dev_id = 0;

	char fw_bin_name[64];

	u32 fw_version = 0, fw_flavor = 0;

	u8 param;



	calltime = ktime_get();



	err = btmtk_usb_id_get(hdev, 0x80000008, &dev_id);

	if (err < 0) {

		bt_dev_err(hdev, "Failed to get device id (%d)", err);

		return err;

	}



	if (!dev_id || dev_id != 0x7663) {

		err = btmtk_usb_id_get(hdev, 0x70010200, &dev_id);

		if (err < 0) {

			bt_dev_err(hdev, "Failed to get device id (%d)", err);

			return err;

		}

		err = btmtk_usb_id_get(hdev, 0x80021004, &fw_version);

		if (err < 0) {

			bt_dev_err(hdev, "Failed to get fw version (%d)", err);

			return err;

		}

		err = btmtk_usb_id_get(hdev, 0x70010020, &fw_flavor);

		if (err < 0) {

			bt_dev_err(hdev, "Failed to get fw flavor (%d)", err);

			return err;

		}

		fw_flavor = (fw_flavor & 0x00000080) >> 7;

	}



	btmtk_data->dev_id = dev_id;



	err = btmtk_register_coredump(hdev, btmtk_data->drv_name, fw_version);

	if (err < 0)

		bt_dev_err(hdev, "Failed to register coredump (%d)", err);



	switch (dev_id) {

	case 0x7663:

		fwname = FIRMWARE_MT7663;

		break;

	case 0x7668:

		fwname = FIRMWARE_MT7668;

		break;

	case 0x7922:

	case 0x7961:

	case 0x7925:

		/* Reset the device to ensure it's in the initial state before

		 * downloading the firmware to ensure.

		 */



		if (!test_bit(BTMTK_FIRMWARE_LOADED, &btmtk_data->flags))

			btmtk_usb_subsys_reset(hdev, dev_id);



		btmtk_fw_get_filename(fw_bin_name, sizeof(fw_bin_name), dev_id,

				      fw_version, fw_flavor);



		err = btmtk_setup_firmware_79xx(hdev, fw_bin_name,

						btmtk_usb_hci_wmt_sync);

		if (err < 0) {

			bt_dev_err(hdev, "Failed to set up firmware (%d)", err);

			clear_bit(BTMTK_FIRMWARE_LOADED, &btmtk_data->flags);

			return err;

		}



		set_bit(BTMTK_FIRMWARE_LOADED, &btmtk_data->flags);



		/* It's Device EndPoint Reset Option Register */

		err = btmtk_usb_uhw_reg_write(hdev, MTK_EP_RST_OPT,

					      MTK_EP_RST_IN_OUT_OPT);

		if (err < 0)

			return err;



		/* Enable Bluetooth protocol */

		param = 1;

		wmt_params.op = BTMTK_WMT_FUNC_CTRL;

		wmt_params.flag = 0;

		wmt_params.dlen = sizeof(param);

		wmt_params.data = &param;

		wmt_params.status = NULL;



		err = btmtk_usb_hci_wmt_sync(hdev, &wmt_params);

		if (err < 0) {

			bt_dev_err(hdev, "Failed to send wmt func ctrl (%d)", err);

			return err;

		}



		hci_set_msft_opcode(hdev, 0xFD30);

		hci_set_aosp_capable(hdev);



		goto done;

	default:

		bt_dev_err(hdev, "Unsupported hardware variant (%08x)",

			   dev_id);

		return -ENODEV;

	}



	/* Query whether the firmware is already download */

	wmt_params.op = BTMTK_WMT_SEMAPHORE;

	wmt_params.flag = 1;

	wmt_params.dlen = 0;

	wmt_params.data = NULL;

	wmt_params.status = &status;



	err = btmtk_usb_hci_wmt_sync(hdev, &wmt_params);

	if (err < 0) {

		bt_dev_err(hdev, "Failed to query firmware status (%d)", err);

		return err;

	}



	if (status == BTMTK_WMT_PATCH_DONE) {

		bt_dev_info(hdev, "firmware already downloaded");

		goto ignore_setup_fw;

	}



	/* Setup a firmware which the device definitely requires */

	err = btmtk_setup_firmware(hdev, fwname,

				   btmtk_usb_hci_wmt_sync);

	if (err < 0)

		return err;



ignore_setup_fw:

	err = readx_poll_timeout(btmtk_usb_func_query, hdev, status,

				 status < 0 || status != BTMTK_WMT_ON_PROGRESS,

				 2000, 5000000);

	/* -ETIMEDOUT happens */

	if (err < 0)

		return err;



	/* The other errors happen in btmtk_usb_func_query */

	if (status < 0)

		return status;



	if (status == BTMTK_WMT_ON_DONE) {

		bt_dev_info(hdev, "function already on");

		goto ignore_func_on;

	}



	/* Enable Bluetooth protocol */

	param = 1;

	wmt_params.op = BTMTK_WMT_FUNC_CTRL;

	wmt_params.flag = 0;

	wmt_params.dlen = sizeof(param);

	wmt_params.data = &param;

	wmt_params.status = NULL;



	err = btmtk_usb_hci_wmt_sync(hdev, &wmt_params);

	if (err < 0) {

		bt_dev_err(hdev, "Failed to send wmt func ctrl (%d)", err);

		return err;

	}



ignore_func_on:

	/* Apply the low power environment setup */

	tci_sleep.mode = 0x5;

	tci_sleep.duration = cpu_to_le16(0x640);

	tci_sleep.host_duration = cpu_to_le16(0x640);

	tci_sleep.host_wakeup_pin = 0;

	tci_sleep.time_compensation = 0;



	skb = __hci_cmd_sync(hdev, 0xfc7a, sizeof(tci_sleep), &tci_sleep,

			     HCI_INIT_TIMEOUT);

	if (IS_ERR(skb)) {

		err = PTR_ERR(skb);

		bt_dev_err(hdev, "Failed to apply low power setting (%d)", err);

		return err;

	}

	kfree_skb(skb);



done:

	rettime = ktime_get();

	delta = ktime_sub(rettime, calltime);

	duration = (unsigned long long)ktime_to_ns(delta) >> 10;



	bt_dev_info(hdev, "Device setup in %llu usecs", duration);



	return 0;

}

EXPORT_SYMBOL_GPL(btmtk_usb_setup);



int btmtk_usb_shutdown(struct hci_dev *hdev)

{

	struct btmtk_hci_wmt_params wmt_params;

	u8 param = 0;

	int err;



	/* Disable the device */

	wmt_params.op = BTMTK_WMT_FUNC_CTRL;

	wmt_params.flag = 0;

	wmt_params.dlen = sizeof(param);

	wmt_params.data = &param;

	wmt_params.status = NULL;



	err = btmtk_usb_hci_wmt_sync(hdev, &wmt_params);

	if (err < 0) {

		bt_dev_err(hdev, "Failed to send wmt func ctrl (%d)", err);

		return err;

	}



	return 0;

}

EXPORT_SYMBOL_GPL(btmtk_usb_shutdown);



MODULE_AUTHOR("Sean Wang <sean.wang@mediatek.com>");

MODULE_AUTHOR("Mark Chen <mark-yw.chen@mediatek.com>");

drivers/bluetooth/btmtk.h

+19 −4
Original line number Diff line number Diff line
@@ -140,6 +140,8 @@ struct btmtk_hci_wmt_params { 


enum {

	BTMTK_TX_WAIT_VND_EVT,

	BTMTK_FIRMWARE_LOADED,

	BTMTK_HW_RESET_ACTIVE,

};



typedef int (*btmtk_reset_sync_func_t)(struct hci_dev *, void *);
@@ -152,6 +154,7 @@ struct btmtk_coredump_info { 
};



struct btmtk_data {

	const char *drv_name;

	unsigned long flags;

	u32 dev_id;

	btmtk_reset_sync_func_t reset_sync;
@@ -186,8 +189,11 @@ int btmtk_process_coredump(struct hci_dev *hdev, struct sk_buff *skb); 
void btmtk_fw_get_filename(char *buf, size_t size, u32 dev_id, u32 fw_ver,

			   u32 fw_flavor);



int btmtk_usb_hci_wmt_sync(struct hci_dev *hdev,

			   struct btmtk_hci_wmt_params *wmt_params);

int btmtk_usb_subsys_reset(struct hci_dev *hdev, u32 dev_id);



int btmtk_usb_setup(struct hci_dev *hdev);



int btmtk_usb_shutdown(struct hci_dev *hdev);

#else



static inline int btmtk_set_bdaddr(struct hci_dev *hdev,
@@ -228,8 +234,17 @@ static void btmtk_fw_get_filename(char *buf, size_t size, u32 dev_id, 
{

}



static int btmtk_usb_hci_wmt_sync(struct hci_dev *hdev,

				  struct btmtk_hci_wmt_params *wmt_params)

static int btmtk_usb_subsys_reset(struct hci_dev *hdev, u32 dev_id)

{

	return -EOPNOTSUPP;

}



static int btmtk_usb_setup(struct hci_dev *hdev)

{

	return -EOPNOTSUPP;

}



static int btmtk_usb_shutdown(struct hci_dev *hdev)

{

	return -EOPNOTSUPP;

}

drivers/bluetooth/btusb.c

+14 −438

File changed.

Preview size limit exceeded, changes collapsed.