Loading drivers/bluetooth/Kconfig +12 −0 Original line number Diff line number Diff line Loading @@ -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 Loading @@ -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 Loading 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 */ Loading
drivers/bluetooth/Kconfig +12 −0 Original line number Diff line number Diff line Loading @@ -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 Loading @@ -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 Loading
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 */
