kxsd9-i2c.c 1.4 KB

1234567891011121314151617181920212223242526272829303132333435363738394041424344454647484950515253545556575859606162636465
  1. // SPDX-License-Identifier: GPL-2.0
  2. #include <linux/device.h>
  3. #include <linux/kernel.h>
  4. #include <linux/module.h>
  5. #include <linux/mod_devicetable.h>
  6. #include <linux/slab.h>
  7. #include <linux/i2c.h>
  8. #include <linux/delay.h>
  9. #include <linux/regmap.h>
  10. #include "kxsd9.h"
  11. static int kxsd9_i2c_probe(struct i2c_client *i2c)
  12. {
  13. static const struct regmap_config config = {
  14. .reg_bits = 8,
  15. .val_bits = 8,
  16. .max_register = 0x0e,
  17. };
  18. struct regmap *regmap;
  19. regmap = devm_regmap_init_i2c(i2c, &config);
  20. if (IS_ERR(regmap)) {
  21. dev_err(&i2c->dev, "Failed to register i2c regmap: %pe\n",
  22. regmap);
  23. return PTR_ERR(regmap);
  24. }
  25. return kxsd9_common_probe(&i2c->dev,
  26. regmap,
  27. i2c->name);
  28. }
  29. static void kxsd9_i2c_remove(struct i2c_client *client)
  30. {
  31. kxsd9_common_remove(&client->dev);
  32. }
  33. static const struct of_device_id kxsd9_of_match[] = {
  34. { .compatible = "kionix,kxsd9", },
  35. { },
  36. };
  37. MODULE_DEVICE_TABLE(of, kxsd9_of_match);
  38. static const struct i2c_device_id kxsd9_i2c_id[] = {
  39. { "kxsd9" },
  40. { }
  41. };
  42. MODULE_DEVICE_TABLE(i2c, kxsd9_i2c_id);
  43. static struct i2c_driver kxsd9_i2c_driver = {
  44. .driver = {
  45. .name = "kxsd9",
  46. .of_match_table = kxsd9_of_match,
  47. .pm = pm_ptr(&kxsd9_dev_pm_ops),
  48. },
  49. .probe = kxsd9_i2c_probe,
  50. .remove = kxsd9_i2c_remove,
  51. .id_table = kxsd9_i2c_id,
  52. };
  53. module_i2c_driver(kxsd9_i2c_driver);
  54. MODULE_LICENSE("GPL v2");
  55. MODULE_DESCRIPTION("KXSD9 accelerometer I2C interface");
  56. MODULE_IMPORT_NS(IIO_KXSD9);