|
@@ -0,0 +1,63 @@
|
|
|
+#include <linux/device.h>
|
|
|
+#include <linux/kernel.h>
|
|
|
+#include <linux/module.h>
|
|
|
+#include <linux/slab.h>
|
|
|
+#include <linux/i2c.h>
|
|
|
+#include <linux/delay.h>
|
|
|
+#include <linux/regmap.h>
|
|
|
+
|
|
|
+#include "kxsd9.h"
|
|
|
+
|
|
|
+static int kxsd9_i2c_probe(struct i2c_client *i2c,
|
|
|
+ const struct i2c_device_id *id)
|
|
|
+{
|
|
|
+ static const struct regmap_config config = {
|
|
|
+ .reg_bits = 8,
|
|
|
+ .val_bits = 8,
|
|
|
+ .max_register = 0x0e,
|
|
|
+ };
|
|
|
+ struct regmap *regmap;
|
|
|
+
|
|
|
+ regmap = devm_regmap_init_i2c(i2c, &config);
|
|
|
+ if (IS_ERR(regmap)) {
|
|
|
+ dev_err(&i2c->dev, "Failed to register i2c regmap %d\n",
|
|
|
+ (int)PTR_ERR(regmap));
|
|
|
+ return PTR_ERR(regmap);
|
|
|
+ }
|
|
|
+
|
|
|
+ return kxsd9_common_probe(&i2c->dev,
|
|
|
+ regmap,
|
|
|
+ i2c->name);
|
|
|
+}
|
|
|
+
|
|
|
+static int kxsd9_i2c_remove(struct i2c_client *client)
|
|
|
+{
|
|
|
+ return kxsd9_common_remove(&client->dev);
|
|
|
+}
|
|
|
+
|
|
|
+#ifdef CONFIG_OF
|
|
|
+static const struct of_device_id kxsd9_of_match[] = {
|
|
|
+ { .compatible = "kionix,kxsd9", },
|
|
|
+ { },
|
|
|
+};
|
|
|
+MODULE_DEVICE_TABLE(of, kxsd9_of_match);
|
|
|
+#else
|
|
|
+#define kxsd9_of_match NULL
|
|
|
+#endif
|
|
|
+
|
|
|
+static const struct i2c_device_id kxsd9_i2c_id[] = {
|
|
|
+ {"kxsd9", 0},
|
|
|
+ { },
|
|
|
+};
|
|
|
+MODULE_DEVICE_TABLE(i2c, kxsd9_i2c_id);
|
|
|
+
|
|
|
+static struct i2c_driver kxsd9_i2c_driver = {
|
|
|
+ .driver = {
|
|
|
+ .name = "kxsd9",
|
|
|
+ .of_match_table = of_match_ptr(kxsd9_of_match),
|
|
|
+ },
|
|
|
+ .probe = kxsd9_i2c_probe,
|
|
|
+ .remove = kxsd9_i2c_remove,
|
|
|
+ .id_table = kxsd9_i2c_id,
|
|
|
+};
|
|
|
+module_i2c_driver(kxsd9_i2c_driver);
|