2 * Copyright 2011 Analog Devices Inc.
4 * Licensed under the GPL-2.
8 #include <linux/interrupt.h>
9 #include <linux/gpio.h>
10 #include <linux/workqueue.h>
11 #include <linux/device.h>
12 #include <linux/kernel.h>
13 #include <linux/slab.h>
14 #include <linux/sysfs.h>
17 #include "../ring_generic.h"
18 #include "../ring_sw.h"
19 #include "../trigger.h"
24 int ad7606_scan_from_ring(struct ad7606_state
*st
, unsigned ch
)
26 struct iio_ring_buffer
*ring
= iio_priv_to_dev(st
)->ring
;
30 ring_data
= kmalloc(ring
->access
.get_bytes_per_datum(ring
),
32 if (ring_data
== NULL
) {
36 ret
= ring
->access
.read_last(ring
, (u8
*) ring_data
);
38 goto error_free_ring_data
;
49 * ad7606_ring_preenable() setup the parameters of the ring before enabling
51 * The complex nature of the setting of the nuber of bytes per datum is due
52 * to this driver currently ensuring that the timestamp is stored at an 8
55 static int ad7606_ring_preenable(struct iio_dev
*indio_dev
)
57 struct ad7606_state
*st
= indio_dev
->dev_data
;
58 struct iio_ring_buffer
*ring
= indio_dev
->ring
;
61 d_size
= st
->chip_info
->num_channels
*
62 st
->chip_info
->channels
[0].scan_type
.storagebits
/ 8;
64 if (ring
->scan_timestamp
) {
65 d_size
+= sizeof(s64
);
67 if (d_size
% sizeof(s64
))
68 d_size
+= sizeof(s64
) - (d_size
% sizeof(s64
));
71 if (ring
->access
.set_bytes_per_datum
)
72 ring
->access
.set_bytes_per_datum(ring
, d_size
);
80 * ad7606_trigger_handler_th() th/bh of trigger launched polling to ring buffer
83 static irqreturn_t
ad7606_trigger_handler_th_bh(int irq
, void *p
)
85 struct iio_poll_func
*pf
= p
;
86 struct iio_dev
*indio_dev
= pf
->private_data
;
87 struct ad7606_state
*st
= indio_dev
->dev_data
;
89 gpio_set_value(st
->pdata
->gpio_convst
, 1);
95 * ad7606_poll_bh_to_ring() bh of trigger launched polling to ring buffer
96 * @work_s: the work struct through which this was scheduled
98 * Currently there is no option in this driver to disable the saving of
99 * timestamps within the ring.
100 * I think the one copy of this at a time was to avoid problems if the
101 * trigger was set far too high and the reads then locked up the computer.
103 static void ad7606_poll_bh_to_ring(struct work_struct
*work_s
)
105 struct ad7606_state
*st
= container_of(work_s
, struct ad7606_state
,
107 struct iio_dev
*indio_dev
= iio_priv_to_dev(st
);
108 struct iio_sw_ring_buffer
*sw_ring
= iio_to_sw_ring(indio_dev
->ring
);
109 struct iio_ring_buffer
*ring
= indio_dev
->ring
;
114 buf
= kzalloc(st
->d_size
, GFP_KERNEL
);
118 if (st
->have_frstdata
) {
119 ret
= st
->bops
->read_block(st
->dev
, 1, buf
);
122 if (!gpio_get_value(st
->pdata
->gpio_frstdata
)) {
123 /* This should never happen. However
124 * some signal glitch caused by bad PCB desgin or
125 * electrostatic discharge, could cause an extra read
126 * or clock. This allows recovery.
131 ret
= st
->bops
->read_block(st
->dev
,
132 st
->chip_info
->num_channels
- 1, buf
+ 2);
136 ret
= st
->bops
->read_block(st
->dev
,
137 st
->chip_info
->num_channels
, buf
);
142 time_ns
= iio_get_time_ns();
144 if (ring
->scan_timestamp
)
145 memcpy(buf
+ st
->d_size
- sizeof(s64
),
146 &time_ns
, sizeof(time_ns
));
148 ring
->access
.store_to(&sw_ring
->buf
, buf
, time_ns
);
150 gpio_set_value(st
->pdata
->gpio_convst
, 0);
151 iio_trigger_notify_done(indio_dev
->trig
);
155 int ad7606_register_ring_funcs_and_init(struct iio_dev
*indio_dev
)
157 struct ad7606_state
*st
= indio_dev
->dev_data
;
160 indio_dev
->ring
= iio_sw_rb_allocate(indio_dev
);
161 if (!indio_dev
->ring
) {
166 /* Effectively select the ring buffer implementation */
167 iio_ring_sw_register_funcs(&indio_dev
->ring
->access
);
168 indio_dev
->pollfunc
= kzalloc(sizeof(*indio_dev
->pollfunc
), GFP_KERNEL
);
169 if (indio_dev
->pollfunc
== NULL
) {
171 goto error_deallocate_sw_rb
;
174 indio_dev
->pollfunc
->private_data
= indio_dev
;
175 indio_dev
->pollfunc
->h
= &ad7606_trigger_handler_th_bh
;
176 indio_dev
->pollfunc
->thread
= &ad7606_trigger_handler_th_bh
;
177 indio_dev
->pollfunc
->name
=
178 kasprintf(GFP_KERNEL
, "%s_consumer%d", indio_dev
->name
,
180 if (indio_dev
->pollfunc
->name
== NULL
) {
182 goto error_free_poll_func
;
184 /* Ring buffer functions - here trigger setup related */
186 indio_dev
->ring
->preenable
= &ad7606_ring_preenable
;
187 indio_dev
->ring
->postenable
= &iio_triggered_ring_postenable
;
188 indio_dev
->ring
->predisable
= &iio_triggered_ring_predisable
;
189 indio_dev
->ring
->scan_timestamp
= true ;
191 INIT_WORK(&st
->poll_work
, &ad7606_poll_bh_to_ring
);
193 /* Flag that polled ring buffering is possible */
194 indio_dev
->modes
|= INDIO_RING_TRIGGERED
;
196 error_free_poll_func
:
197 kfree(indio_dev
->pollfunc
);
198 error_deallocate_sw_rb
:
199 iio_sw_rb_free(indio_dev
->ring
);
204 void ad7606_ring_cleanup(struct iio_dev
*indio_dev
)
206 if (indio_dev
->trig
) {
207 iio_put_trigger(indio_dev
->trig
);
208 iio_trigger_dettach_poll_func(indio_dev
->trig
,
209 indio_dev
->pollfunc
);
211 kfree(indio_dev
->pollfunc
->name
);
212 kfree(indio_dev
->pollfunc
);
213 iio_sw_rb_free(indio_dev
->ring
);