1 // SPDX-License-Identifier: GPL-2.0-or-later
2 /*
3 * Copyright (C) 2014, Samsung Electronics Co. Ltd. All Rights Reserved.
4 */
5
6 #include <linux/iio/common/ssp_sensors.h>
7 #include <linux/iio/buffer.h>
8 #include <linux/iio/kfifo_buf.h>
9 #include <linux/module.h>
10 #include <linux/slab.h>
11 #include "ssp_iio_sensor.h"
12
13 /**
14 * ssp_common_buffer_postenable() - generic postenable callback for ssp buffer
15 *
16 * @indio_dev: iio device
17 *
18 * Returns 0 or negative value in case of error
19 */
ssp_common_buffer_postenable(struct iio_dev * indio_dev)20 int ssp_common_buffer_postenable(struct iio_dev *indio_dev)
21 {
22 struct ssp_sensor_data *spd = iio_priv(indio_dev);
23 struct ssp_data *data = dev_get_drvdata(indio_dev->dev.parent->parent);
24
25 /* the allocation is made in post because scan size is known in this
26 * moment
27 * */
28 spd->buffer = kmalloc(indio_dev->scan_bytes, GFP_KERNEL | GFP_DMA);
29 if (!spd->buffer)
30 return -ENOMEM;
31
32 return ssp_enable_sensor(data, spd->type,
33 ssp_get_sensor_delay(data, spd->type));
34 }
35 EXPORT_SYMBOL_NS(ssp_common_buffer_postenable, "IIO_SSP_SENSORS");
36
37 /**
38 * ssp_common_buffer_postdisable() - generic postdisable callback for ssp buffer
39 *
40 * @indio_dev: iio device
41 *
42 * Returns 0 or negative value in case of error
43 */
ssp_common_buffer_postdisable(struct iio_dev * indio_dev)44 int ssp_common_buffer_postdisable(struct iio_dev *indio_dev)
45 {
46 int ret;
47 struct ssp_sensor_data *spd = iio_priv(indio_dev);
48 struct ssp_data *data = dev_get_drvdata(indio_dev->dev.parent->parent);
49
50 ret = ssp_disable_sensor(data, spd->type);
51 if (ret < 0)
52 return ret;
53
54 kfree(spd->buffer);
55
56 return ret;
57 }
58 EXPORT_SYMBOL_NS(ssp_common_buffer_postdisable, "IIO_SSP_SENSORS");
59
60 /**
61 * ssp_common_process_data() - Common process data callback for ssp sensors
62 *
63 * @indio_dev: iio device
64 * @buf: source buffer
65 * @len: sensor data length
66 * @timestamp: system timestamp
67 *
68 * Returns 0 or negative value in case of error
69 */
ssp_common_process_data(struct iio_dev * indio_dev,void * buf,unsigned int len,int64_t timestamp)70 int ssp_common_process_data(struct iio_dev *indio_dev, void *buf,
71 unsigned int len, int64_t timestamp)
72 {
73 __le32 time;
74 int64_t calculated_time = 0;
75 struct ssp_sensor_data *spd = iio_priv(indio_dev);
76
77 if (indio_dev->scan_bytes == 0)
78 return 0;
79
80 /*
81 * it always sends full set of samples, remember about available masks
82 */
83 memcpy(spd->buffer, buf, len);
84
85 if (indio_dev->scan_timestamp) {
86 memcpy(&time, &((char *)buf)[len], SSP_TIME_SIZE);
87 calculated_time =
88 timestamp + (int64_t)le32_to_cpu(time) * 1000000;
89 }
90
91 return iio_push_to_buffers_with_timestamp(indio_dev, spd->buffer,
92 calculated_time);
93 }
94 EXPORT_SYMBOL_NS(ssp_common_process_data, "IIO_SSP_SENSORS");
95
96 MODULE_AUTHOR("Karol Wrona <k.wrona@samsung.com>");
97 MODULE_DESCRIPTION("Samsung sensorhub commons");
98 MODULE_LICENSE("GPL");
99 MODULE_IMPORT_NS("IIO_SSP_SENSORS");
100