#include <linux/pm.h>
#include <linux/regmap.h>
+#define BMA220_REG_WDT 0x17
+#define BMA220_WDT_MASK GENMASK(2, 1)
+#define BMA220_WDT_OFF 0x0
+#define BMA220_WDT_1MS 0x2
+#define BMA220_WDT_10MS 0x3
+
struct device;
extern const struct regmap_config bma220_i2c_regmap_config;
#include <linux/cleanup.h>
#include <linux/device.h>
#include <linux/errno.h>
-#include <linux/i2c.h>
#include <linux/mod_devicetable.h>
#include <linux/module.h>
#include <linux/mutex.h>
#define BMA220_FILTER_MASK GENMASK(3, 0)
#define BMA220_REG_RANGE 0x11
#define BMA220_RANGE_MASK GENMASK(1, 0)
-#define BMA220_REG_WDT 0x17
-#define BMA220_WDT_MASK GENMASK(2, 1)
-#define BMA220_WDT_OFF 0x0
-#define BMA220_WDT_1MS 0x2
-#define BMA220_WDT_10MS 0x3
#define BMA220_REG_SUSPEND 0x18
#define BMA220_REG_SOFTRESET 0x19
return -EBUSY;
}
-static int bma220_set_wdt(struct bma220_data *data, const u8 val)
-{
- return regmap_update_bits(data->regmap, BMA220_REG_WDT, BMA220_WDT_MASK,
- FIELD_PREP(BMA220_WDT_MASK, val));
-}
-
static int bma220_init(struct device *dev, struct bma220_data *data)
{
int ret;
if (ret)
return dev_err_probe(dev, ret, "Failed to soft reset chip\n");
- if (i2c_verify_client(dev)) {
- ret = bma220_set_wdt(data, BMA220_WDT_1MS);
- if (ret)
- return dev_err_probe(dev, ret,
- "Failed to set i2c watchdog\n");
- }
-
return 0;
}
* I2C address is either 0x0b or 0x0a depending on CSB (pin 10)
*/
+#include <linux/bitfield.h>
#include <linux/i2c.h>
#include <linux/mod_devicetable.h>
#include <linux/module.h>
#include "bma220.h"
+static int bma220_set_wdt(struct regmap *regmap, const u8 val)
+{
+ return regmap_update_bits(regmap, BMA220_REG_WDT, BMA220_WDT_MASK,
+ FIELD_PREP(BMA220_WDT_MASK, val));
+}
+
static int bma220_i2c_probe(struct i2c_client *client)
{
struct regmap *regmap;
+ int ret;
regmap = devm_regmap_init_i2c(client, &bma220_i2c_regmap_config);
if (IS_ERR(regmap))
return dev_err_probe(&client->dev, PTR_ERR(regmap),
"failed to create regmap\n");
- return bma220_common_probe(&client->dev, regmap, client->irq);
+ ret = bma220_common_probe(&client->dev, regmap, client->irq);
+ if (ret)
+ return ret;
+
+ return bma220_set_wdt(regmap, BMA220_WDT_1MS);
}
static const struct of_device_id bma220_i2c_match[] = {