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_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_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_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_dt_parse_vreg_info(struct device *dev, struct bt_power_vreg_data **vreg_data, const char *vreg_name) { int len, ret = 0; const __be32 *prop; char prop_name[MAX_PROP_SIZE]; struct bt_power_vreg_data *vreg; struct device_node *np = dev->of_node; BT_PWR_DBG("vreg dev tree parse for %s", vreg_name); snprintf(prop_name, MAX_PROP_SIZE, "%s-supply", vreg_name); if (of_parse_phandle(np, prop_name, 0)) { vreg = devm_kzalloc(dev, sizeof(*vreg), GFP_KERNEL); if (!vreg) { dev_err(dev, "No memory for vreg: %s\n", vreg_name); ret = -ENOMEM; goto err; } vreg->name = vreg_name; snprintf(prop_name, MAX_PROP_SIZE, "%s-voltage-level", vreg_name); prop = of_get_property(np, prop_name, &len); if (!prop || (len != (2 * sizeof(__be32)))) { dev_warn(dev, "%s %s property\n", prop ? "invalid format" : "no", prop_name); } else { vreg->low_vol_level = be32_to_cpup(&prop[0]); vreg->high_vol_level = be32_to_cpup(&prop[1]); } *vreg_data = vreg; BT_PWR_DBG("%s: vol=[%d %d]uV\n", vreg->name, vreg->low_vol_level, vreg->high_vol_level); } else BT_PWR_INFO("%s: is not provided in device tree", vreg_name); err: return ret; }
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 int bt_configure_vreg(struct bt_power_vreg_data *vreg) { int rc = 0; BT_PWR_DBG("config %s", vreg->name); /* Get the regulator handle for vreg */ if (!(vreg->reg)) { rc = bt_vreg_init(vreg); if (rc < 0) return rc; } rc = bt_vreg_enable(vreg); 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; } /* 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_vreg_init(struct bt_power_vreg_data *vreg) { int rc = 0; struct device *dev = &btpdev->dev; BT_PWR_DBG("vreg_get for : %s", vreg->name); /* Get the regulator handle */ vreg->reg = regulator_get(dev, vreg->name); if (IS_ERR(vreg->reg)) { rc = PTR_ERR(vreg->reg); pr_err("%s: regulator_get(%s) failed. rc=%d\n", __func__, vreg->name, rc); goto out; } if ((regulator_count_voltages(vreg->reg) > 0) && (vreg->low_vol_level) && (vreg->high_vol_level)) vreg->set_voltage_sup = 1; out: return rc; }