kxsd9-spi.c 1.2 KB

1234567891011121314151617181920212223242526272829303132333435363738394041424344454647484950515253545556
  1. #include <linux/device.h>
  2. #include <linux/kernel.h>
  3. #include <linux/spi/spi.h>
  4. #include <linux/module.h>
  5. #include <linux/slab.h>
  6. #include <linux/regmap.h>
  7. #include "kxsd9.h"
  8. static int kxsd9_spi_probe(struct spi_device *spi)
  9. {
  10. static const struct regmap_config config = {
  11. .reg_bits = 8,
  12. .val_bits = 8,
  13. .max_register = 0x0e,
  14. };
  15. struct regmap *regmap;
  16. spi->mode = SPI_MODE_0;
  17. regmap = devm_regmap_init_spi(spi, &config);
  18. if (IS_ERR(regmap)) {
  19. dev_err(&spi->dev, "%s: regmap allocation failed: %ld\n",
  20. __func__, PTR_ERR(regmap));
  21. return PTR_ERR(regmap);
  22. }
  23. return kxsd9_common_probe(&spi->dev,
  24. regmap,
  25. spi_get_device_id(spi)->name);
  26. }
  27. static int kxsd9_spi_remove(struct spi_device *spi)
  28. {
  29. return kxsd9_common_remove(&spi->dev);
  30. }
  31. static const struct spi_device_id kxsd9_spi_id[] = {
  32. {"kxsd9", 0},
  33. { },
  34. };
  35. MODULE_DEVICE_TABLE(spi, kxsd9_spi_id);
  36. static struct spi_driver kxsd9_spi_driver = {
  37. .driver = {
  38. .name = "kxsd9",
  39. .pm = &kxsd9_dev_pm_ops,
  40. },
  41. .probe = kxsd9_spi_probe,
  42. .remove = kxsd9_spi_remove,
  43. .id_table = kxsd9_spi_id,
  44. };
  45. module_spi_driver(kxsd9_spi_driver);
  46. MODULE_AUTHOR("Jonathan Cameron <jic23@kernel.org>");
  47. MODULE_DESCRIPTION("Kionix KXSD9 SPI driver");
  48. MODULE_LICENSE("GPL v2");