|
@@ -26,7 +26,7 @@
|
|
#include <linux/i2c.h>
|
|
#include <linux/i2c.h>
|
|
#include <linux/slab.h>
|
|
#include <linux/slab.h>
|
|
#include <linux/interrupt.h>
|
|
#include <linux/interrupt.h>
|
|
-#include <linux/gpio.h>
|
|
|
|
|
|
+#include <linux/gpio/consumer.h>
|
|
#include <linux/of.h>
|
|
#include <linux/of.h>
|
|
#include <linux/stat.h>
|
|
#include <linux/stat.h>
|
|
|
|
|
|
@@ -165,7 +165,7 @@ struct sbs_info {
|
|
struct power_supply *power_supply;
|
|
struct power_supply *power_supply;
|
|
struct sbs_platform_data *pdata;
|
|
struct sbs_platform_data *pdata;
|
|
bool is_present;
|
|
bool is_present;
|
|
- bool gpio_detect;
|
|
|
|
|
|
+ struct gpio_desc *gpio_detect;
|
|
bool enable_detection;
|
|
bool enable_detection;
|
|
int last_state;
|
|
int last_state;
|
|
int poll_time;
|
|
int poll_time;
|
|
@@ -306,13 +306,11 @@ static int sbs_get_battery_presence_and_health(
|
|
s32 ret;
|
|
s32 ret;
|
|
struct sbs_info *chip = i2c_get_clientdata(client);
|
|
struct sbs_info *chip = i2c_get_clientdata(client);
|
|
|
|
|
|
- if (psp == POWER_SUPPLY_PROP_PRESENT &&
|
|
|
|
- chip->gpio_detect) {
|
|
|
|
- ret = gpio_get_value(chip->pdata->battery_detect);
|
|
|
|
- if (ret == chip->pdata->battery_detect_present)
|
|
|
|
- val->intval = 1;
|
|
|
|
- else
|
|
|
|
- val->intval = 0;
|
|
|
|
|
|
+ if (psp == POWER_SUPPLY_PROP_PRESENT && chip->gpio_detect) {
|
|
|
|
+ ret = gpiod_get_value_cansleep(chip->gpio_detect);
|
|
|
|
+ if (ret < 0)
|
|
|
|
+ return ret;
|
|
|
|
+ val->intval = ret;
|
|
chip->is_present = val->intval;
|
|
chip->is_present = val->intval;
|
|
return ret;
|
|
return ret;
|
|
}
|
|
}
|
|
@@ -683,7 +681,12 @@ static irqreturn_t sbs_irq(int irq, void *devid)
|
|
{
|
|
{
|
|
struct sbs_info *chip = devid;
|
|
struct sbs_info *chip = devid;
|
|
struct power_supply *battery = chip->power_supply;
|
|
struct power_supply *battery = chip->power_supply;
|
|
|
|
+ int ret;
|
|
|
|
|
|
|
|
+ ret = gpiod_get_value_cansleep(chip->gpio_detect);
|
|
|
|
+ if (ret < 0)
|
|
|
|
+ return ret;
|
|
|
|
+ chip->is_present = ret;
|
|
power_supply_changed(battery);
|
|
power_supply_changed(battery);
|
|
|
|
|
|
return IRQ_HANDLED;
|
|
return IRQ_HANDLED;
|
|
@@ -750,12 +753,11 @@ static const struct of_device_id sbs_dt_ids[] = {
|
|
};
|
|
};
|
|
MODULE_DEVICE_TABLE(of, sbs_dt_ids);
|
|
MODULE_DEVICE_TABLE(of, sbs_dt_ids);
|
|
|
|
|
|
-static struct sbs_platform_data *sbs_of_populate_pdata(
|
|
|
|
- struct i2c_client *client)
|
|
|
|
|
|
+static struct sbs_platform_data *sbs_of_populate_pdata(struct sbs_info *chip)
|
|
{
|
|
{
|
|
|
|
+ struct i2c_client *client = chip->client;
|
|
struct device_node *of_node = client->dev.of_node;
|
|
struct device_node *of_node = client->dev.of_node;
|
|
- struct sbs_platform_data *pdata = client->dev.platform_data;
|
|
|
|
- enum of_gpio_flags gpio_flags;
|
|
|
|
|
|
+ struct sbs_platform_data *pdata;
|
|
int rc;
|
|
int rc;
|
|
u32 prop;
|
|
u32 prop;
|
|
|
|
|
|
@@ -763,22 +765,17 @@ static struct sbs_platform_data *sbs_of_populate_pdata(
|
|
if (!of_node)
|
|
if (!of_node)
|
|
return NULL;
|
|
return NULL;
|
|
|
|
|
|
- /* if platform data is set, honor it */
|
|
|
|
- if (pdata)
|
|
|
|
- return pdata;
|
|
|
|
-
|
|
|
|
/* first make sure at least one property is set, otherwise
|
|
/* first make sure at least one property is set, otherwise
|
|
* it won't change behavior from running without pdata.
|
|
* it won't change behavior from running without pdata.
|
|
*/
|
|
*/
|
|
if (!of_get_property(of_node, "sbs,i2c-retry-count", NULL) &&
|
|
if (!of_get_property(of_node, "sbs,i2c-retry-count", NULL) &&
|
|
- !of_get_property(of_node, "sbs,poll-retry-count", NULL) &&
|
|
|
|
- !of_get_property(of_node, "sbs,battery-detect-gpios", NULL))
|
|
|
|
|
|
+ !of_get_property(of_node, "sbs,poll-retry-count", NULL))
|
|
goto of_out;
|
|
goto of_out;
|
|
|
|
|
|
pdata = devm_kzalloc(&client->dev, sizeof(struct sbs_platform_data),
|
|
pdata = devm_kzalloc(&client->dev, sizeof(struct sbs_platform_data),
|
|
GFP_KERNEL);
|
|
GFP_KERNEL);
|
|
if (!pdata)
|
|
if (!pdata)
|
|
- goto of_out;
|
|
|
|
|
|
+ return ERR_PTR(-ENOMEM);
|
|
|
|
|
|
rc = of_property_read_u32(of_node, "sbs,i2c-retry-count", &prop);
|
|
rc = of_property_read_u32(of_node, "sbs,i2c-retry-count", &prop);
|
|
if (!rc)
|
|
if (!rc)
|
|
@@ -788,27 +785,14 @@ static struct sbs_platform_data *sbs_of_populate_pdata(
|
|
if (!rc)
|
|
if (!rc)
|
|
pdata->poll_retry_count = prop;
|
|
pdata->poll_retry_count = prop;
|
|
|
|
|
|
- if (!of_get_property(of_node, "sbs,battery-detect-gpios", NULL)) {
|
|
|
|
- pdata->battery_detect = -1;
|
|
|
|
- goto of_out;
|
|
|
|
- }
|
|
|
|
-
|
|
|
|
- pdata->battery_detect = of_get_named_gpio_flags(of_node,
|
|
|
|
- "sbs,battery-detect-gpios", 0, &gpio_flags);
|
|
|
|
-
|
|
|
|
- if (gpio_flags & OF_GPIO_ACTIVE_LOW)
|
|
|
|
- pdata->battery_detect_present = 0;
|
|
|
|
- else
|
|
|
|
- pdata->battery_detect_present = 1;
|
|
|
|
-
|
|
|
|
of_out:
|
|
of_out:
|
|
return pdata;
|
|
return pdata;
|
|
}
|
|
}
|
|
#else
|
|
#else
|
|
static struct sbs_platform_data *sbs_of_populate_pdata(
|
|
static struct sbs_platform_data *sbs_of_populate_pdata(
|
|
- struct i2c_client *client)
|
|
|
|
|
|
+ struct sbs_info *client)
|
|
{
|
|
{
|
|
- return client->dev.platform_data;
|
|
|
|
|
|
+ return ERR_PTR(-ENOSYS);
|
|
}
|
|
}
|
|
#endif
|
|
#endif
|
|
|
|
|
|
@@ -846,7 +830,6 @@ static int sbs_probe(struct i2c_client *client,
|
|
|
|
|
|
chip->client = client;
|
|
chip->client = client;
|
|
chip->enable_detection = false;
|
|
chip->enable_detection = false;
|
|
- chip->gpio_detect = false;
|
|
|
|
psy_cfg.of_node = client->dev.of_node;
|
|
psy_cfg.of_node = client->dev.of_node;
|
|
psy_cfg.drv_data = chip;
|
|
psy_cfg.drv_data = chip;
|
|
/* ignore first notification of external change, it is generated
|
|
/* ignore first notification of external change, it is generated
|
|
@@ -855,11 +838,20 @@ static int sbs_probe(struct i2c_client *client,
|
|
chip->ignore_changes = 1;
|
|
chip->ignore_changes = 1;
|
|
chip->last_state = POWER_SUPPLY_STATUS_UNKNOWN;
|
|
chip->last_state = POWER_SUPPLY_STATUS_UNKNOWN;
|
|
|
|
|
|
- pdata = sbs_of_populate_pdata(client);
|
|
|
|
|
|
+ if (!pdata)
|
|
|
|
+ pdata = sbs_of_populate_pdata(chip);
|
|
|
|
+
|
|
|
|
+ if (IS_ERR(pdata))
|
|
|
|
+ return PTR_ERR(pdata);
|
|
|
|
+
|
|
|
|
+ chip->pdata = pdata;
|
|
|
|
|
|
- if (pdata) {
|
|
|
|
- chip->gpio_detect = gpio_is_valid(pdata->battery_detect);
|
|
|
|
- chip->pdata = pdata;
|
|
|
|
|
|
+ chip->gpio_detect = devm_gpiod_get_optional(&client->dev,
|
|
|
|
+ "sbs,battery-detect", GPIOD_IN);
|
|
|
|
+ if (IS_ERR(chip->gpio_detect)) {
|
|
|
|
+ dev_err(&client->dev, "Failed to get gpio: %ld\n",
|
|
|
|
+ PTR_ERR(chip->gpio_detect));
|
|
|
|
+ return PTR_ERR(chip->gpio_detect);
|
|
}
|
|
}
|
|
|
|
|
|
i2c_set_clientdata(client, chip);
|
|
i2c_set_clientdata(client, chip);
|
|
@@ -867,26 +859,9 @@ static int sbs_probe(struct i2c_client *client,
|
|
if (!chip->gpio_detect)
|
|
if (!chip->gpio_detect)
|
|
goto skip_gpio;
|
|
goto skip_gpio;
|
|
|
|
|
|
- rc = gpio_request(pdata->battery_detect, dev_name(&client->dev));
|
|
|
|
- if (rc) {
|
|
|
|
- dev_warn(&client->dev, "Failed to request gpio: %d\n", rc);
|
|
|
|
- chip->gpio_detect = false;
|
|
|
|
- goto skip_gpio;
|
|
|
|
- }
|
|
|
|
-
|
|
|
|
- rc = gpio_direction_input(pdata->battery_detect);
|
|
|
|
- if (rc) {
|
|
|
|
- dev_warn(&client->dev, "Failed to get gpio as input: %d\n", rc);
|
|
|
|
- gpio_free(pdata->battery_detect);
|
|
|
|
- chip->gpio_detect = false;
|
|
|
|
- goto skip_gpio;
|
|
|
|
- }
|
|
|
|
-
|
|
|
|
- irq = gpio_to_irq(pdata->battery_detect);
|
|
|
|
|
|
+ irq = gpiod_to_irq(chip->gpio_detect);
|
|
if (irq <= 0) {
|
|
if (irq <= 0) {
|
|
dev_warn(&client->dev, "Failed to get gpio as irq: %d\n", irq);
|
|
dev_warn(&client->dev, "Failed to get gpio as irq: %d\n", irq);
|
|
- gpio_free(pdata->battery_detect);
|
|
|
|
- chip->gpio_detect = false;
|
|
|
|
goto skip_gpio;
|
|
goto skip_gpio;
|
|
}
|
|
}
|
|
|
|
|
|
@@ -895,8 +870,6 @@ static int sbs_probe(struct i2c_client *client,
|
|
dev_name(&client->dev), chip);
|
|
dev_name(&client->dev), chip);
|
|
if (rc) {
|
|
if (rc) {
|
|
dev_warn(&client->dev, "Failed to request irq: %d\n", rc);
|
|
dev_warn(&client->dev, "Failed to request irq: %d\n", rc);
|
|
- gpio_free(pdata->battery_detect);
|
|
|
|
- chip->gpio_detect = false;
|
|
|
|
goto skip_gpio;
|
|
goto skip_gpio;
|
|
}
|
|
}
|
|
|
|
|
|
@@ -905,7 +878,7 @@ skip_gpio:
|
|
* Before we register, we might need to make sure we can actually talk
|
|
* Before we register, we might need to make sure we can actually talk
|
|
* to the battery.
|
|
* to the battery.
|
|
*/
|
|
*/
|
|
- if (!force_load) {
|
|
|
|
|
|
+ if (!(force_load || chip->gpio_detect)) {
|
|
rc = sbs_read_word_data(client, sbs_data[REG_STATUS].addr);
|
|
rc = sbs_read_word_data(client, sbs_data[REG_STATUS].addr);
|
|
|
|
|
|
if (rc < 0) {
|
|
if (rc < 0) {
|
|
@@ -934,9 +907,6 @@ skip_gpio:
|
|
return 0;
|
|
return 0;
|
|
|
|
|
|
exit_psupply:
|
|
exit_psupply:
|
|
- if (chip->gpio_detect)
|
|
|
|
- gpio_free(pdata->battery_detect);
|
|
|
|
-
|
|
|
|
return rc;
|
|
return rc;
|
|
}
|
|
}
|
|
|
|
|
|
@@ -944,9 +914,6 @@ static int sbs_remove(struct i2c_client *client)
|
|
{
|
|
{
|
|
struct sbs_info *chip = i2c_get_clientdata(client);
|
|
struct sbs_info *chip = i2c_get_clientdata(client);
|
|
|
|
|
|
- if (chip->gpio_detect)
|
|
|
|
- gpio_free(chip->pdata->battery_detect);
|
|
|
|
-
|
|
|
|
cancel_delayed_work_sync(&chip->work);
|
|
cancel_delayed_work_sync(&chip->work);
|
|
|
|
|
|
return 0;
|
|
return 0;
|