Bluetooth: btpower: Add snapshot of BT power driver (8e932359) · Commits · e / devices / android_kernel_fairphone_FP5

drivers/bluetooth/Kconfig

+12 −0

Original line number	Diff line number	Diff line
		@@ -436,4 +436,16 @@ config BT_HCIRSI
		Say Y here to compile support for HCI over Redpine into the
		kernel or say M to compile as a module.

		config MSM_BT_POWER
		tristate "MSM Bluetooth Power Control"
		depends on ARCH_QCOM
		help
		MSM Bluetooth Power control driver.
		This provides a parameter to switch on/off power from PMIC
		to Bluetooth device. This will control LDOs/Clock/GPIOs to
		control Bluetooth Chipset based on power on/off sequence.

		Say Y here to compile support for Bluetooth Power driver
		into the kernel or say M to compile as a module.

		endmenu

drivers/bluetooth/Makefile

+2 −0

Original line number	Diff line number	Diff line
		@@ -31,6 +31,8 @@ obj-$(CONFIG_BT_HCIUART_NOKIA) += hci_nokia.o

		obj-$(CONFIG_BT_HCIRSI) += btrsi.o

		obj-$(CONFIG_MSM_BT_POWER) += btpower.o

		btmrvl-y := btmrvl_main.o
		btmrvl-$(CONFIG_DEBUG_FS) += btmrvl_debugfs.o

drivers/bluetooth/btpower.c

0 → 100644

+780 −0

Original line number	Diff line number	Diff line
		// SPDX-License-Identifier: GPL-2.0-only
		/*
		* Copyright (c) 2016-2019, The Linux Foundation. All rights reserved.
		*/

		/*
		* Bluetooth Power Switch Module
		* controls power to external Bluetooth device
		* with interface to power management device
		*/

		#include <linux/init.h>
		#include <linux/module.h>
		#include <linux/kernel.h>
		#include <linux/platform_device.h>
		#include <linux/rfkill.h>
		#include <linux/gpio.h>
		#include <linux/of_gpio.h>
		#include <linux/delay.h>
		#include <linux/slab.h>
		#include <linux/regulator/consumer.h>
		#include <linux/clk.h>
		#include <linux/btpower.h>

		#if defined CONFIG_BT_SLIM_QCA6390 \|\| \
		defined CONFIG_BT_SLIM_QCA6490 \|\| \
		defined CONFIG_BTFM_SLIM_WCN3990
		#include "btfm_slim.h"
		#endif
		#include <linux/fs.h>

		static const struct of_device_id bt_power_match_table[] = {
		{ .compatible = "qcom,qca6174" },
		{ .compatible = "qcom,wcn3990" },
		{ .compatible = "qcom,qca6390" },
		{ .compatible = "qcom,qca6490" },
		{},
		};

		static struct bt_power_vreg_data bt_power_vreg_info[] = {
		{NULL, "qcom,bt-vdd-vl", 0, 0, 0, false, false},
		{NULL, "qcom,bt-vdd-vm", 0, 0, 0, false, false},
		{NULL, "qcom,bt-vdd-5c", 0, 0, 0, false, false},
		{NULL, "qcom,bt-vdd-vh", 0, 0, 0, false, false},
		{NULL, "qcom,bt-vdd-io", 0, 0, 0, false, false},
		{NULL, "qcom,bt-vdd-xtal", 0, 0, 0, false, false},
		{NULL, "qcom,bt-vdd-core", 0, 0, 0, false, false},
		{NULL, "qcom,bt-vdd-pa", 0, 0, 0, false, false},
		{NULL, "qcom,bt-vdd-ldo", 0, 0, 0, false, false},
		{NULL, "qcom,bt-vdd-aon", 950000, 950000, 0, false, true},
		{NULL, "qcom,bt-vdd-dig", 950000, 952000, 0, false, true},
		{NULL, "qcom,bt-vdd-rfa1", 1900000, 1900000, 0, false, true},
		{NULL, "qcom,bt-vdd-rfa2", 1900000, 1900000, 0, false, true},
		{NULL, "qcom,bt-vdd-asd", 3024000, 3304000, 10000, false, false},
		};

		#define BT_VREG_INFO_SIZE ARRAY_SIZE(bt_power_vreg_info)

		static int bt_power_vreg_get(struct platform_device *pdev);
		static int bt_power_vreg_set(enum bt_power_modes mode);
		static void bt_power_vreg_put(void);

		static struct bluetooth_power_platform_data *bt_power_pdata;
		static struct platform_device *btpdev;
		static bool previous;
		static int pwr_state;
		static struct class *bt_class;
		static int bt_major;
		static int soc_id;

		static int bt_vreg_enable(struct bt_power_vreg_data *vreg)
		{
		int rc = 0;

		pr_debug("%s: vreg_en for : %s\n", __func__, vreg->name);

		if (!vreg->is_enabled) {
		if ((vreg->min_vol != 0) && (vreg->max_vol != 0)) {
		rc = regulator_set_voltage(vreg->reg,
		vreg->min_vol,
		vreg->max_vol);
		if (rc < 0) {
		pr_err("%s: regulator_set_voltage(%s) failed rc=%d\n",
		__func__, vreg->name, rc);
		goto out;
		}
		}

		if (vreg->load_curr >= 0) {
		rc = regulator_set_load(vreg->reg,
		vreg->load_curr);
		if (rc < 0) {
		pr_err("%s: regulator_set_load(%s) failed rc=%d\n",
		__func__, vreg->name, rc);
		goto out;
		}
		}

		rc = regulator_enable(vreg->reg);
		if (rc < 0) {
		pr_err("regulator_enable(%s) failed. rc=%d\n",
		__func__, vreg->name, rc);
		goto out;
		}
		vreg->is_enabled = true;
		}
		out:
		return rc;
		}

		static int bt_vreg_enable_retention(struct bt_power_vreg_data *vreg)
		{
		int rc = 0;

		if (!vreg)
		return rc;

		pr_debug("%s: enable_retention for : %s\n", __func__, vreg->name);

		if ((vreg->is_enabled) && (vreg->is_retention_supp)) {
		if ((vreg->min_vol != 0) && (vreg->max_vol != 0)) {
		/* Set the min voltage to 0 */
		rc = regulator_set_voltage(vreg->reg, 0, vreg->max_vol);
		if (rc < 0) {
		pr_err("%s: regulator_set_voltage(%s) failed rc=%d\n",
		__func__, vreg->name, rc);
		goto out;
		}
		}
		if (vreg->load_curr >= 0) {
		rc = regulator_set_load(vreg->reg, 0);
		if (rc < 0) {
		pr_err("%s: regulator_set_load(%s) failed rc=%d\n",
		__func__, vreg->name, rc);
		}
		}
		}
		out:
		return rc;
		}

		static int bt_vreg_disable(struct bt_power_vreg_data *vreg)
		{
		int rc = 0;

		if (!vreg)
		return rc;

		pr_debug("vreg_disable for : %s\n", __func__, vreg->name);

		if (vreg->is_enabled) {
		rc = regulator_disable(vreg->reg);
		if (rc < 0) {
		pr_err("%s, regulator_disable(%s) failed. rc=%d\n",
		__func__, vreg->name, rc);
		goto out;
		}
		vreg->is_enabled = false;

		if ((vreg->min_vol != 0) && (vreg->max_vol != 0)) {
		/* Set the min voltage to 0 */
		rc = regulator_set_voltage(vreg->reg, 0,
		vreg->max_vol);
		if (rc < 0) {
		pr_err("%s: regulator_set_voltage(%s) failed rc=%d\n",
		__func__, vreg->name, rc);
		goto out;
		}
		}
		if (vreg->load_curr >= 0) {
		rc = regulator_set_load(vreg->reg, 0);
		if (rc < 0) {
		pr_err("%s: regulator_set_load(%s) failed rc=%d\n",
		__func__, vreg->name, rc);
		}
		}
		}
		out:
		return rc;
		}

		static int bt_clk_enable(struct bt_power_clk_data *clk)
		{
		int rc = 0;

		pr_debug("%s: %s\n", __func__, clk->name);

		/* Get the clock handle for vreg */
		if (!clk->clk \|\| clk->is_enabled) {
		pr_err("%s: error - node: %p, clk->is_enabled:%d\n",
		__func__, clk->clk, clk->is_enabled);
		return -EINVAL;
		}

		rc = clk_prepare_enable(clk->clk);
		if (rc) {
		pr_err("%s: failed to enable %s, rc(%d)\n",
		__func__, clk->name, rc);
		return rc;
		}

		clk->is_enabled = true;
		return rc;
		}

		static int bt_clk_disable(struct bt_power_clk_data *clk)
		{
		int rc = 0;

		pr_debug("%s: %s\n", __func__, clk->name);

		/* Get the clock handle for vreg */
		if (!clk->clk \|\| !clk->is_enabled) {
		pr_err("%s: error - node: %p, clk->is_enabled:%d\n",
		__func__, clk->clk, clk->is_enabled);
		return -EINVAL;
		}
		clk_disable_unprepare(clk->clk);

		clk->is_enabled = false;
		return rc;
		}

		static int bt_configure_gpios(int on)
		{
		int rc = 0;
		int bt_reset_gpio = bt_power_pdata->bt_gpio_sys_rst;

		pr_debug("%s: bt_gpio= %d on: %d\n", __func__, bt_reset_gpio, on);

		if (on) {
		rc = gpio_request(bt_reset_gpio, "bt_sys_rst_n");
		if (rc) {
		pr_err("%s: unable to request gpio %d (%d)\n",
		__func__, bt_reset_gpio, rc);
		return rc;
		}

		rc = gpio_direction_output(bt_reset_gpio, 0);
		if (rc) {
		pr_err("%s: Unable to set direction\n", __func__);
		return rc;
		}
		msleep(50);
		rc = gpio_direction_output(bt_reset_gpio, 1);
		if (rc) {
		pr_err("%s: Unable to set direction\n", __func__);
		return rc;
		}
		msleep(50);
		} else {
		gpio_set_value(bt_reset_gpio, 0);
		msleep(100);
		}
		return rc;
		}

		static int bluetooth_power(int on)
		{
		int rc = 0;

		pr_debug("%s: on: %d\n", __func__, on);

		if (on == 1) {
		rc = bt_power_vreg_set(BT_POWER_ENABLE);
		if (rc < 0) {
		pr_err("%s: bt_power regulators config failed\n",
		__func__);
		goto regulator_fail;
		}
		/* Parse dt_info and check if a target requires clock voting.
		* Enable BT clock when BT is on and disable it when BT is off
		*/
		if (bt_power_pdata->bt_chip_clk) {
		rc = bt_clk_enable(bt_power_pdata->bt_chip_clk);
		if (rc < 0) {
		pr_err("%s: bt_power gpio config failed\n",
		__func__);
		goto clk_fail;
		}
		}
		if (bt_power_pdata->bt_gpio_sys_rst > 0) {
		rc = bt_configure_gpios(on);
		if (rc < 0) {
		pr_err("%s: bt_power gpio config failed\n",
		__func__);
		goto gpio_fail;
		}
		}
		} else if (on == 0) {
		// Power Off
		if (bt_power_pdata->bt_gpio_sys_rst > 0)
		bt_configure_gpios(on);
		gpio_fail:
		if (bt_power_pdata->bt_gpio_sys_rst > 0)
		gpio_free(bt_power_pdata->bt_gpio_sys_rst);
		if (bt_power_pdata->bt_chip_clk)
		bt_clk_disable(bt_power_pdata->bt_chip_clk);
		clk_fail:
		regulator_fail:
		bt_power_vreg_set(BT_POWER_DISABLE);
		} else if (on == 2) {
		/* Retention mode */
		bt_power_vreg_set(BT_POWER_RETENTION);
		} else {
		pr_err("%s: Invalid power mode: %d\n", __func__, on);
		rc = -1;
		}
		return rc;
		}

		static int bluetooth_toggle_radio(void *data, bool blocked)
		{
		int ret = 0;
		int (*power_control)(int enable);

		power_control =
		((struct bluetooth_power_platform_data *)data)->bt_power_setup;

		if (previous != blocked)
		ret = (*power_control)(!blocked);
		if (!ret)
		previous = blocked;
		return ret;
		}

		static const struct rfkill_ops bluetooth_power_rfkill_ops = {
		.set_block = bluetooth_toggle_radio,
		};

		static ssize_t extldo_show(struct device dev, struct device_attribute attr,
		char *buf)
		{
		return scnprintf(buf, 6, "false\n");
		}

		static DEVICE_ATTR_RO(extldo);

		static int bluetooth_power_rfkill_probe(struct platform_device *pdev)
		{
		struct rfkill *rfkill;
		int ret;

		rfkill = rfkill_alloc("bt_power", &pdev->dev, RFKILL_TYPE_BLUETOOTH,
		&bluetooth_power_rfkill_ops,
		pdev->dev.platform_data);

		if (!rfkill) {
		dev_err(&pdev->dev, "rfkill allocate failed\n");
		return -ENOMEM;
		}

		/* add file into rfkill0 to handle LDO27 */
		ret = device_create_file(&pdev->dev, &dev_attr_extldo);
		if (ret < 0)
		pr_err("%s: device create file error\n", __func__);

		/* force Bluetooth off during init to allow for user control */
		rfkill_init_sw_state(rfkill, 1);
		previous = true;

		ret = rfkill_register(rfkill);
		if (ret) {
		dev_err(&pdev->dev, "rfkill register failed=%d\n", ret);
		rfkill_destroy(rfkill);
		return ret;
		}

		platform_set_drvdata(pdev, rfkill);

		return 0;
		}

		static void bluetooth_power_rfkill_remove(struct platform_device *pdev)
		{
		struct rfkill *rfkill;

		pr_debug("%s\n", __func__);

		rfkill = platform_get_drvdata(pdev);
		if (rfkill)
		rfkill_unregister(rfkill);
		rfkill_destroy(rfkill);
		platform_set_drvdata(pdev, NULL);
		}

		#define MAX_PROP_SIZE 32
		static int bt_dt_parse_vreg_info(struct device *dev,
		struct bt_power_vreg_data *vreg_data, const char vreg_name)
		{
		int len;
		const __be32 *prop;
		char prop_name[MAX_PROP_SIZE];
		struct bt_power_vreg_data vreg = vreg_data;
		struct device_node *np = dev->of_node;

		pr_debug("%s: vreg dev tree parse for %s\n", __func__, vreg_name);

		snprintf(prop_name, sizeof(prop_name), "%s-supply", vreg_name);
		if (of_parse_phandle(np, prop_name, 0)) {
		snprintf(prop_name, sizeof(prop_name), "%s-config", vreg->name);

		prop = of_get_property(dev->of_node, prop_name, &len);
		if (!prop \|\| len != (4 * sizeof(__be32))) {
		pr_debug("%s: Property %s %s, use default\n",
		__func__, prop_name,
		prop ? "invalid format" : "doesn't exist");
		} else {
		vreg->min_vol = be32_to_cpup(&prop[0]);
		vreg->max_vol = be32_to_cpup(&prop[1]);
		vreg->load_curr = be32_to_cpup(&prop[2]);
		vreg->is_retention_supp = be32_to_cpup(&prop[4]);
		}

		pr_debug("%s: Got regulator: %s, min_vol: %u, max_vol: %u, load_curr: %u,is_retention_supp: %u\n",
		__func__, vreg->name, vreg->min_vol, vreg->max_vol,
		vreg->load_curr, vreg->is_retention_supp);
		} else
		pr_info("%s: %s is not provided in device tree\n",
		__func__, vreg_name);

		return 0;
		}

		static int bt_dt_parse_clk_info(struct device *dev,
		struct bt_power_clk_data **clk_data)
		{
		int ret = -EINVAL;
		struct bt_power_clk_data *clk = NULL;
		struct device_node *np = dev->of_node;

		pr_debug("%s\n", __func__);

		*clk_data = NULL;
		if (of_parse_phandle(np, "clocks", 0)) {
		clk = devm_kzalloc(dev, sizeof(*clk), GFP_KERNEL);
		if (!clk) {
		ret = -ENOMEM;
		goto err;
		}

		/* Allocated 20 bytes size buffer for clock name string */
		clk->name = devm_kzalloc(dev, 20, GFP_KERNEL);

		/* Parse clock name from node */
		ret = of_property_read_string_index(np, "clock-names", 0,
		&(clk->name));
		if (ret < 0) {
		pr_err("%s: reading \"clock-names\" failed\n",
		__func__);
		return ret;
		}

		clk->clk = devm_clk_get(dev, clk->name);
		if (IS_ERR(clk->clk)) {
		ret = PTR_ERR(clk->clk);
		pr_err("%s: failed to get %s, ret (%d)\n",
		__func__, clk->name, ret);
		clk->clk = NULL;
		return ret;
		}

		*clk_data = clk;
		} else {
		pr_err("%s: clocks is not provided in device tree\n", __func__);
		}

		err:
		return ret;
		}

		static int bt_power_vreg_get(struct platform_device *pdev)
		{
		struct bt_power_vreg_data *vreg_info;
		int i = 0, ret = 0;

		bt_power_pdata->vreg_info =
		devm_kzalloc(&(pdev->dev),
		sizeof(*bt_power_pdata->vreg_info),
		GFP_KERNEL);
		if (!bt_power_pdata->vreg_info) {
		ret = -ENOMEM;
		goto out;
		}
		memcpy(bt_power_pdata->vreg_info, bt_power_vreg_info,
		sizeof(bt_power_vreg_info));

		for (; i < BT_VREG_INFO_SIZE; i++) {
		vreg_info = &bt_power_pdata->vreg_info[i];
		ret = bt_dt_parse_vreg_info(&(pdev->dev), &vreg_info,
		vreg_info->name);
		}

		out:
		return ret;
		}

		static int bt_power_vreg_set(enum bt_power_modes mode)
		{
		int i = 0, ret = 0;
		struct bt_power_vreg_data *vreg_info = NULL;
		struct device *dev = &btpdev->dev;

		if (mode == BT_POWER_ENABLE) {
		for (; i < BT_VREG_INFO_SIZE; i++) {
		vreg_info = &bt_power_pdata->vreg_info[i];

		/* set vreg handle if not already set */
		if (!(vreg_info->reg)) {
		vreg_info->reg = regulator_get(dev,
		vreg_info->name);
		if (IS_ERR(vreg_info->reg)) {
		ret = PTR_ERR(vreg_info->reg);
		pr_err("%s: regulator_get(%s) failed. rc=%d\n",
		__func__, vreg_info->name, ret);
		goto out;
		}
		}
		ret = bt_vreg_enable(vreg_info);
		if (ret < 0)
		goto out;
		}
		} else if (mode == BT_POWER_DISABLE) {
		for (; i < BT_VREG_INFO_SIZE; i++) {
		vreg_info = &bt_power_pdata->vreg_info[i];
		ret = bt_vreg_disable(vreg_info);
		}
		} else if (mode == BT_POWER_RETENTION) {
		for (; i < BT_VREG_INFO_SIZE; i++) {
		vreg_info = &bt_power_pdata->vreg_info[i];
		ret = bt_vreg_enable_retention(vreg_info);
		}
		} else {
		pr_err("%s: Invalid power mode: %d\n", __func__, mode);
		ret = -1;
		}

		out:
		return ret;
		}

		static void bt_power_vreg_put(void)
		{
		int i = 0;
		struct bt_power_vreg_data *vreg_info = NULL;

		for (; i < BT_VREG_INFO_SIZE; i++) {
		vreg_info = &bt_power_pdata->vreg_info[i];
		if (vreg_info->reg)
		regulator_put(vreg_info->reg);
		}
		}


		static int bt_power_populate_dt_pinfo(struct platform_device *pdev)
		{
		int rc;

		pr_debug("%s\n", __func__);

		if (!bt_power_pdata)
		return -ENOMEM;

		if (pdev->dev.of_node) {
		bt_power_vreg_get(pdev);

		bt_power_pdata->bt_gpio_sys_rst =
		of_get_named_gpio(pdev->dev.of_node,
		"qcom,bt-reset-gpio", 0);
		if (bt_power_pdata->bt_gpio_sys_rst < 0)
		pr_err("%s: bt-reset-gpio not provided in device tree\n",
		__func__);

		rc = bt_dt_parse_clk_info(&pdev->dev,
		&bt_power_pdata->bt_chip_clk);
		if (rc < 0)
		pr_err("%s: clock not provided in device tree\n",
		__func__);
		}

		bt_power_pdata->bt_power_setup = bluetooth_power;

		return 0;
		}

		static int bt_power_probe(struct platform_device *pdev)
		{
		int ret = 0;

		pr_debug("%s\n", __func__);

		bt_power_pdata = kzalloc(sizeof(*bt_power_pdata), GFP_KERNEL);

		if (!bt_power_pdata)
		return -ENOMEM;

		if (pdev->dev.of_node) {
		ret = bt_power_populate_dt_pinfo(pdev);
		if (ret < 0) {
		pr_err("%s, Failed to populate device tree info\n",
		__func__);
		goto free_pdata;
		}
		pdev->dev.platform_data = bt_power_pdata;
		} else if (pdev->dev.platform_data) {
		/* Optional data set to default if not provided */
		if (!((struct bluetooth_power_platform_data *)
		(pdev->dev.platform_data))->bt_power_setup)
		((struct bluetooth_power_platform_data *)
		(pdev->dev.platform_data))->bt_power_setup =
		bluetooth_power;

		memcpy(bt_power_pdata, pdev->dev.platform_data,
		sizeof(struct bluetooth_power_platform_data));
		pwr_state = 0;
		} else {
		pr_err("%s: Failed to get platform data\n", __func__);
		goto free_pdata;
		}

		if (bluetooth_power_rfkill_probe(pdev) < 0)
		goto free_pdata;

		btpdev = pdev;

		return 0;

		free_pdata:
		kfree(bt_power_pdata);
		return ret;
		}

		static int bt_power_remove(struct platform_device *pdev)
		{
		dev_dbg(&pdev->dev, "%s\n", __func__);

		bluetooth_power_rfkill_remove(pdev);
		bt_power_vreg_put();

		kfree(bt_power_pdata);

		return 0;
		}

		int btpower_register_slimdev(struct device *dev)
		{
		pr_debug("%s\n", __func__);
		if (!bt_power_pdata \|\| (dev == NULL)) {
		pr_err("%s: Failed to allocate memory\n", __func__);
		return -EINVAL;
		}
		bt_power_pdata->slim_dev = dev;
		return 0;
		}
		EXPORT_SYMBOL(btpower_register_slimdev);

		int btpower_get_chipset_version(void)
		{
		pr_debug("%s\n", __func__);
		return soc_id;
		}
		EXPORT_SYMBOL(btpower_get_chipset_version);

		static long bt_ioctl(struct file *file, unsigned int cmd, unsigned long arg)
		{
		int ret = 0, pwr_cntrl = 0;
		int chipset_version = 0;

		switch (cmd) {
		case BT_CMD_SLIM_TEST:
		#if (defined CONFIG_BT_SLIM_QCA6390 \|\| \
		defined CONFIG_BT_SLIM_QCA6490 \|\| \
		defined CONFIG_BTFM_SLIM_WCN3990)
		if (!bt_power_pdata->slim_dev) {
		pr_err("%s: slim_dev is null\n", __func__);
		return -EINVAL;
		}
		ret = btfm_slim_hw_init(
		bt_power_pdata->slim_dev->platform_data
		);
		#endif
		break;
		case BT_CMD_PWR_CTRL:
		pwr_cntrl = (int)arg;
		pr_err("%s: BT_CMD_PWR_CTRL pwr_cntrl: %d\n",
		__func__, pwr_cntrl);
		if (pwr_state != pwr_cntrl) {
		ret = bluetooth_power(pwr_cntrl);
		if (!ret)
		pwr_state = pwr_cntrl;
		} else {
		pr_err("%s: BT chip state is already: %d no change\n",
		__func__, pwr_state);
		ret = 0;
		}
		break;
		case BT_CMD_CHIPSET_VERS:
		chipset_version = (int)arg;
		pr_err("%s: BT_CMD_CHIP_VERS soc_version:%x\n", __func__,
		chipset_version);
		if (chipset_version) {
		soc_id = chipset_version;
		} else {
		pr_err("%s: got invalid soc version\n");
		soc_id = 0;
		}
		break;
		default:
		return -ENOIOCTLCMD;
		}
		return ret;
		}

		static struct platform_driver bt_power_driver = {
		.probe = bt_power_probe,
		.remove = bt_power_remove,
		.driver = {
		.name = "bt_power",
		.of_match_table = bt_power_match_table,
		},
		};

		static const struct file_operations bt_dev_fops = {
		.unlocked_ioctl = bt_ioctl,
		.compat_ioctl = bt_ioctl,
		};

		static int __init bluetooth_power_init(void)
		{
		int ret = 0;

		ret = platform_driver_register(&bt_power_driver);
		if (ret) {
		pr_err("%s: platform_driver_register error: %d\n",
		__func__, ret);
		goto driver_err;
		}

		bt_major = register_chrdev(0, "bt", &bt_dev_fops);
		if (bt_major < 0) {
		pr_err("%s: failed to allocate char dev\n", __func__);
		ret = -1;
		goto chrdev_err;
		}

		bt_class = class_create(THIS_MODULE, "bt-dev");
		if (IS_ERR(bt_class)) {
		pr_err("%s: coudn't create class\n", __func__);
		ret = -1;
		goto class_err;
		}


		if (device_create(bt_class, NULL, MKDEV(bt_major, 0),
		NULL, "btpower") == NULL) {
		pr_err("%s: failed to allocate char dev\n", __func__);
		goto device_err;
		}
		return 0;

		device_err:
		class_destroy(bt_class);
		class_err:
		unregister_chrdev(bt_major, "bt");
		chrdev_err:
		platform_driver_unregister(&bt_power_driver);
		driver_err:
		return ret;
		}

		static void __exit bluetooth_power_exit(void)
		{
		platform_driver_unregister(&bt_power_driver);
		}

		MODULE_LICENSE("GPL v2");
		MODULE_DESCRIPTION("MSM Bluetooth power control driver");

		module_init(bluetooth_power_init);
		module_exit(bluetooth_power_exit);

include/linux/btpower.h

0 → 100644

+52 −0

Original line number	Diff line number	Diff line
		/* SPDX-License-Identifier: GPL-2.0-only */
		/*
		* Copyright (c) 2016-2019, The Linux Foundation. All rights reserved.
		*/

		#ifndef __LINUX_BLUETOOTH_POWER_H
		#define __LINUX_BLUETOOTH_POWER_H

		/*
		* voltage regulator information required for configuring the
		* bluetooth chipset
		*/
		enum bt_power_modes {
		BT_POWER_DISABLE = 0,
		BT_POWER_ENABLE,
		BT_POWER_RETENTION
		};

		struct bt_power_vreg_data {
		struct regulator reg; / voltage regulator handle */
		const char name; / regulator name */
		u32 min_vol; /* min voltage level */
		u32 max_vol; /* max voltage level */
		u32 load_curr; /* current */
		bool is_enabled; /* is this regulator enabled? */
		bool is_retention_supp; /* does this regulator support retention mode */
		};

		struct bt_power_clk_data {
		struct clk clk; / clock regulator handle */
		const char name; / clock name */
		bool is_enabled; /* is this clock enabled? */
		};

		/*
		* Platform data for the bluetooth power driver.
		*/
		struct bluetooth_power_platform_data {
		int bt_gpio_sys_rst; /* Bluetooth reset gpio */
		struct device *slim_dev;
		struct bt_power_vreg_data vreg_info; / VDDIO voltage regulator */
		struct bt_power_clk_data bt_chip_clk; / bluetooth reference clock */
		int (bt_power_setup)(int id); / Bluetooth power setup function */
		};

		int bt_register_slimdev(struct device *dev);
		int get_chipset_version(void);

		#define BT_CMD_SLIM_TEST 0xbfac
		#define BT_CMD_PWR_CTRL 0xbfad
		#define BT_CMD_CHIPSET_VERS 0xbfae
		#endif /* __LINUX_BLUETOOTH_POWER_H */