st_pressure_spi.c 1.6 KB

12345678910111213141516171819202122232425262728293031323334353637383940414243444546474849505152535455565758596061626364656667686970717273747576
  1. /*
  2. * STMicroelectronics pressures driver
  3. *
  4. * Copyright 2013 STMicroelectronics Inc.
  5. *
  6. * Denis Ciocca <denis.ciocca@st.com>
  7. *
  8. * Licensed under the GPL-2.
  9. */
  10. #include <linux/kernel.h>
  11. #include <linux/module.h>
  12. #include <linux/slab.h>
  13. #include <linux/spi/spi.h>
  14. #include <linux/iio/iio.h>
  15. #include <linux/iio/common/st_sensors.h>
  16. #include <linux/iio/common/st_sensors_spi.h>
  17. #include "st_pressure.h"
  18. static int st_press_spi_probe(struct spi_device *spi)
  19. {
  20. struct iio_dev *indio_dev;
  21. struct st_sensor_data *pdata;
  22. int err;
  23. indio_dev = iio_device_alloc(sizeof(*pdata));
  24. if (indio_dev == NULL) {
  25. err = -ENOMEM;
  26. goto iio_device_alloc_error;
  27. }
  28. pdata = iio_priv(indio_dev);
  29. pdata->dev = &spi->dev;
  30. st_sensors_spi_configure(indio_dev, spi, pdata);
  31. err = st_press_common_probe(indio_dev);
  32. if (err < 0)
  33. goto st_press_common_probe_error;
  34. return 0;
  35. st_press_common_probe_error:
  36. iio_device_free(indio_dev);
  37. iio_device_alloc_error:
  38. return err;
  39. }
  40. static int st_press_spi_remove(struct spi_device *spi)
  41. {
  42. st_press_common_remove(spi_get_drvdata(spi));
  43. return 0;
  44. }
  45. static const struct spi_device_id st_press_id_table[] = {
  46. { LPS331AP_PRESS_DEV_NAME },
  47. {},
  48. };
  49. MODULE_DEVICE_TABLE(spi, st_press_id_table);
  50. static struct spi_driver st_press_driver = {
  51. .driver = {
  52. .owner = THIS_MODULE,
  53. .name = "st-press-spi",
  54. },
  55. .probe = st_press_spi_probe,
  56. .remove = st_press_spi_remove,
  57. .id_table = st_press_id_table,
  58. };
  59. module_spi_driver(st_press_driver);
  60. MODULE_AUTHOR("Denis Ciocca <denis.ciocca@st.com>");
  61. MODULE_DESCRIPTION("STMicroelectronics pressures spi driver");
  62. MODULE_LICENSE("GPL v2");