static int bt_vreg_disable(struct bt_power_vreg_data *vreg) { int rc = 0; if (!vreg) return rc; BT_PWR_DBG("vreg_disable for : %s", vreg->name); if (vreg->is_enabled) { rc = regulator_disable(vreg->reg); if (rc < 0) { BT_PWR_ERR("regulator_disable(%s) failed. rc=%d\n", vreg->name, rc); goto out; } vreg->is_enabled = false; if (vreg->set_voltage_sup) { /* Set the min voltage to 0 */ rc = regulator_set_voltage(vreg->reg, 0, vreg->high_vol_level); if (rc < 0) { BT_PWR_ERR("vreg_set_vol(%s) failed rc=%d\n", vreg->name, rc); goto out; } } } out: return rc; }
static int bt_vreg_enable(struct bt_power_vreg_data *vreg) { int rc = 0; BT_PWR_DBG("vreg_en for : %s", vreg->name); if (!vreg->is_enabled) { if (vreg->set_voltage_sup) { rc = regulator_set_voltage(vreg->reg, vreg->low_vol_level, vreg->high_vol_level); if (rc < 0) { BT_PWR_ERR("vreg_set_vol(%s) failed rc=%d\n", vreg->name, rc); goto out; } } rc = regulator_enable(vreg->reg); if (rc < 0) { BT_PWR_ERR("regulator_enable(%s) failed. rc=%d\n", vreg->name, rc); goto out; } vreg->is_enabled = true; } out: return rc; }
static int bt_configure_gpios(int on) { int rc = 0; int bt_reset_gpio = bt_power_pdata->bt_gpio_sys_rst; BT_PWR_DBG("%s bt_gpio= %d on: %d", __func__, bt_reset_gpio, on); if (on) { rc = gpio_request(bt_reset_gpio, "bt_sys_rst_n"); if (rc) { BT_PWR_ERR("unable to request gpio %d (%d)\n", bt_reset_gpio, rc); return rc; } rc = gpio_direction_output(bt_reset_gpio, 0); if (rc) { BT_PWR_ERR("Unable to set direction\n"); return rc; } rc = gpio_direction_output(bt_reset_gpio, 1); if (rc) { BT_PWR_ERR("Unable to set direction\n"); return rc; } msleep(100); } else { gpio_set_value(bt_reset_gpio, 0); msleep(100); } return rc; }
static int bluetooth_power(int on) { int rc = 0; BT_PWR_DBG("on: %d", on); if (on) { if (bt_power_pdata->bt_vdd_io) { rc = bt_configure_vreg(bt_power_pdata->bt_vdd_io); if (rc < 0) { BT_PWR_ERR("bt_power vddio config failed"); goto out; } } if (bt_power_pdata->bt_vdd_ldo) { rc = bt_configure_vreg(bt_power_pdata->bt_vdd_ldo); if (rc < 0) { BT_PWR_ERR("bt_power vddldo config failed"); goto vdd_ldo_fail; } } if (bt_power_pdata->bt_vdd_pa) { rc = bt_configure_vreg(bt_power_pdata->bt_vdd_pa); if (rc < 0) { BT_PWR_ERR("bt_power vddpa config failed"); goto vdd_pa_fail; } } if (bt_power_pdata->bt_chip_pwd) { rc = bt_configure_vreg(bt_power_pdata->bt_chip_pwd); if (rc < 0) { BT_PWR_ERR("bt_power vddldo config failed"); goto chip_pwd_fail; } } if (bt_power_pdata->bt_gpio_sys_rst) { rc = bt_configure_gpios(on); if (rc < 0) { BT_PWR_ERR("bt_power gpio config failed"); goto gpio_fail; } } } else { bt_configure_gpios(on); gpio_fail: if (bt_power_pdata->bt_gpio_sys_rst) gpio_free(bt_power_pdata->bt_gpio_sys_rst); bt_vreg_disable(bt_power_pdata->bt_chip_pwd); chip_pwd_fail: bt_vreg_disable(bt_power_pdata->bt_vdd_pa); vdd_pa_fail: bt_vreg_disable(bt_power_pdata->bt_vdd_ldo); vdd_ldo_fail: bt_vreg_disable(bt_power_pdata->bt_vdd_io); } out: return rc; }
static int bt_power_probe(struct platform_device *pdev) { int ret = 0; dev_dbg(&pdev->dev, "%s\n", __func__); bt_power_pdata = kzalloc(sizeof(struct bluetooth_power_platform_data), GFP_KERNEL); if (!bt_power_pdata) { BT_PWR_ERR("Failed to allocate memory"); return -ENOMEM; } if (pdev->dev.of_node) { ret = bt_power_populate_dt_pinfo(pdev); if (ret < 0) { BT_PWR_ERR("Failed to populate device tree info"); goto free_pdata; } pdev->dev.platform_data = bt_power_pdata; } else if (pdev->dev.platform_data) { /* Optional data set to default if not provided */ memcpy(bt_power_pdata, pdev->dev.platform_data, sizeof(struct bluetooth_power_platform_data)); 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; } } else { BT_PWR_ERR("Failed to get platform data"); 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 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) BT_PWR_ERR("device create file error!"); /* force Bluetooth off during init to allow for user control */ rfkill_init_sw_state(rfkill, 1); previous = 1; 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 int bt_power_populate_dt_pinfo(struct platform_device *pdev) { int rc; BT_PWR_DBG(""); if (!bt_power_pdata) return -ENOMEM; if (pdev->dev.of_node) { #ifdef USE_GPIO_EXPANDER_BT_EN rc = of_property_read_u32(pdev->dev.of_node, "qca,bt-reset-gpio", &bt_power_pdata->bt_gpio_sys_rst); BT_PWR_DBG("GPIO_EXPANDER rc : %d", rc); #else bt_power_pdata->bt_gpio_sys_rst = of_get_named_gpio(pdev->dev.of_node, "qca,bt-reset-gpio", 0); #endif if (bt_power_pdata->bt_gpio_sys_rst < 0) { BT_PWR_ERR("bt-reset-gpio not provided in device tree"); return bt_power_pdata->bt_gpio_sys_rst; } rc = bt_dt_parse_vreg_info(&pdev->dev, &bt_power_pdata->bt_vdd_io, "qca,bt-vdd-io"); if (rc < 0) return rc; rc = bt_dt_parse_vreg_info(&pdev->dev, &bt_power_pdata->bt_vdd_pa, "qca,bt-vdd-pa"); if (rc < 0) return rc; rc = bt_dt_parse_vreg_info(&pdev->dev, &bt_power_pdata->bt_vdd_ldo, "qca,bt-vdd-ldo"); if (rc < 0) return rc; rc = bt_dt_parse_vreg_info(&pdev->dev, &bt_power_pdata->bt_chip_pwd, "qca,bt-chip-pwd"); if (rc < 0) return rc; } bt_power_pdata->bt_power_setup = bluetooth_power; return 0; }
static int bt_configure_gpios(int on) { int rc = 0; int bt_reset_gpio = bt_power_pdata->bt_gpio_sys_rst; BT_PWR_DBG("%s bt_gpio= %d on: %d", __func__, bt_reset_gpio, on); if (on) { rc = gpio_request(bt_reset_gpio, "bt_sys_rst_n"); if (rc) { BT_PWR_ERR("unable to request gpio %d (%d)\n", bt_reset_gpio, rc); return rc; } rc = gpio_direction_output(bt_reset_gpio, 0); if (rc) { BT_PWR_ERR("Unable to set direction\n"); return rc; } /* Add 50msec delay between BT_EN gpio line toggle from 0 to 1 during BT turn on process to allow settling time for the controller to recongnize the BT_EN pin toggle. */ msleep(50); rc = gpio_direction_output(bt_reset_gpio, 1); if (rc) { BT_PWR_ERR("Unable to set direction\n"); return rc; } msleep(50); } else { gpio_set_value(bt_reset_gpio, 0); msleep(100); } return rc; }
static int bt_power_populate_dt_pinfo(struct platform_device *pdev) { int rc; BT_PWR_DBG(""); if (!bt_power_pdata) return -ENOMEM; if (pdev->dev.of_node) { bt_power_pdata->bt_gpio_sys_rst = of_get_named_gpio(pdev->dev.of_node, "qca,bt-reset-gpio", 0); if (bt_power_pdata->bt_gpio_sys_rst < 0) { BT_PWR_ERR("bt-reset-gpio not provided in device tree"); return bt_power_pdata->bt_gpio_sys_rst; } rc = bt_dt_parse_vreg_info(&pdev->dev, &bt_power_pdata->bt_vdd_io, "qca,bt-vdd-io"); if (rc < 0) return rc; rc = bt_dt_parse_vreg_info(&pdev->dev, &bt_power_pdata->bt_vdd_pa, "qca,bt-vdd-pa"); if (rc < 0) return rc; rc = bt_dt_parse_vreg_info(&pdev->dev, &bt_power_pdata->bt_vdd_ldo, "qca,bt-vdd-ldo"); if (rc < 0) return rc; rc = bt_dt_parse_vreg_info(&pdev->dev, &bt_power_pdata->bt_chip_pwd, "qca,bt-chip-pwd"); if (rc < 0) return rc; } bt_power_pdata->bt_power_setup = bluetooth_power; return 0; }
static ssize_t enable_extldo(struct device *dev, struct device_attribute *attr, char *buf) { int ret; bool enable = false; struct cnss_platform_cap cap; ret = cnss_get_platform_cap(&cap); if (ret) { BT_PWR_ERR("Platform capability info from CNSS not available!"); enable = false; } else if (!ret && (cap.cap_flag & CNSS_HAS_EXTERNAL_SWREG)) { enable = true; } return snprintf(buf, 6, "%s", (enable ? "true" : "false")); }
static int bluetooth_power(int on) { int rc = 0; BT_PWR_INFO("on: %d", on); if (on) { if (bt_power_pdata->bt_vdd_io) { rc = bt_configure_vreg(bt_power_pdata->bt_vdd_io); if (rc < 0) { BT_PWR_ERR("bt_power vddio config failed"); goto out; } } if (bt_power_pdata->bt_vdd_pa) { rc = bt_configure_vreg(bt_power_pdata->bt_vdd_pa); if (rc < 0) { BT_PWR_ERR("bt_power vddpa config failed"); goto vdd_pa_fail; } } if (bt_power_pdata->bt_vdd_ldo) { #ifdef CONFIG_SEC_LENTIS_PROJECT pr_err("%s: system_rev=%d\n", __func__, system_rev); if(system_rev == 7) { bt_power_pdata->bt_vdd_ldo->low_vol_level = EXT_LDO_1_20_V_MIN; bt_power_pdata->bt_vdd_ldo->high_vol_level = EXT_LDO_1_20_V_MAX; } else if(system_rev > 7) { bt_power_pdata->bt_vdd_ldo->low_vol_level = EXT_LDO_1_18_V_MIN; bt_power_pdata->bt_vdd_ldo->high_vol_level = EXT_LDO_1_18_V_MAX; } else { BT_PWR_ERR("bt_power HW rev under 0x06"); } #endif rc = bt_configure_vreg(bt_power_pdata->bt_vdd_ldo); if (rc < 0) { BT_PWR_ERR("bt_power vddldo config failed"); goto vdd_ldo_fail; } } if (bt_power_pdata->bt_chip_pwd) { rc = bt_configure_vreg(bt_power_pdata->bt_chip_pwd); if (rc < 0) { BT_PWR_ERR("bt_power vddldo config failed"); goto chip_pwd_fail; } } if (bt_power_pdata->bt_gpio_sys_rst) { rc = bt_configure_gpios(on); if (rc < 0) { BT_PWR_ERR("bt_power gpio config failed"); goto gpio_fail; } } } else { bt_configure_gpios(on); gpio_fail: if (bt_power_pdata->bt_gpio_sys_rst) gpio_free(bt_power_pdata->bt_gpio_sys_rst); bt_vreg_disable(bt_power_pdata->bt_chip_pwd); chip_pwd_fail: bt_vreg_disable(bt_power_pdata->bt_vdd_pa); vdd_pa_fail: bt_vreg_disable(bt_power_pdata->bt_vdd_ldo); vdd_ldo_fail: bt_vreg_disable(bt_power_pdata->bt_vdd_io); } out: return rc; }