1 #include <linux/interrupt.h>
2 #include <linux/mutex.h>
3 #include <linux/kernel.h>
4 #include <linux/spi/spi.h>
5 #include <linux/slab.h>
6 #include <linux/bitops.h>
7 #include <linux/export.h>
9 #include <linux/iio/iio.h>
10 #include <linux/iio/buffer.h>
11 #include <linux/iio/triggered_buffer.h>
12 #include <linux/iio/trigger_consumer.h>
14 #include "adis16400.h"
16 int adis16400_update_scan_mode(struct iio_dev
*indio_dev
,
17 const unsigned long *scan_mask
)
19 struct adis16400_state
*st
= iio_priv(indio_dev
);
20 struct adis
*adis
= &st
->adis
;
23 if (st
->variant
->flags
& ADIS16400_NO_BURST
)
24 return adis_update_scan_mode(indio_dev
, scan_mask
);
29 adis
->xfer
= kcalloc(2, sizeof(*adis
->xfer
), GFP_KERNEL
);
33 adis
->buffer
= kzalloc(indio_dev
->scan_bytes
+ sizeof(u16
),
39 tx
= adis
->buffer
+ indio_dev
->scan_bytes
;
41 tx
[0] = ADIS_READ_REG(ADIS16400_GLOB_CMD
);
44 adis
->xfer
[0].tx_buf
= tx
;
45 adis
->xfer
[0].bits_per_word
= 8;
46 adis
->xfer
[0].len
= 2;
47 adis
->xfer
[1].tx_buf
= tx
;
48 adis
->xfer
[1].bits_per_word
= 8;
49 adis
->xfer
[1].len
= indio_dev
->scan_bytes
;
51 spi_message_init(&adis
->msg
);
52 spi_message_add_tail(&adis
->xfer
[0], &adis
->msg
);
53 spi_message_add_tail(&adis
->xfer
[1], &adis
->msg
);
58 irqreturn_t
adis16400_trigger_handler(int irq
, void *p
)
60 struct iio_poll_func
*pf
= p
;
61 struct iio_dev
*indio_dev
= pf
->indio_dev
;
62 struct adis16400_state
*st
= iio_priv(indio_dev
);
63 struct adis
*adis
= &st
->adis
;
64 u32 old_speed_hz
= st
->adis
.spi
->max_speed_hz
;
70 if (!(st
->variant
->flags
& ADIS16400_NO_BURST
) &&
71 st
->adis
.spi
->max_speed_hz
> ADIS16400_SPI_BURST
) {
72 st
->adis
.spi
->max_speed_hz
= ADIS16400_SPI_BURST
;
73 spi_setup(st
->adis
.spi
);
76 ret
= spi_sync(adis
->spi
, &adis
->msg
);
78 dev_err(&adis
->spi
->dev
, "Failed to read data: %d\n", ret
);
80 if (!(st
->variant
->flags
& ADIS16400_NO_BURST
)) {
81 st
->adis
.spi
->max_speed_hz
= old_speed_hz
;
82 spi_setup(st
->adis
.spi
);
85 /* Guaranteed to be aligned with 8 byte boundary */
86 if (indio_dev
->scan_timestamp
) {
87 void *b
= adis
->buffer
+ indio_dev
->scan_bytes
- sizeof(s64
);
88 *(s64
*)b
= pf
->timestamp
;
91 iio_push_to_buffers(indio_dev
, adis
->buffer
);
93 iio_trigger_notify_done(indio_dev
->trig
);
This page took 0.032211 seconds and 5 git commands to generate.