This source file includes following definitions.
- adis_write_reg
- adis_read_reg
- adis_debugfs_reg_access
- adis_enable_irq
- adis_check_status
- adis_reset
- adis_self_test
- adis_initial_startup
- adis_single_conversion
- adis_init
1
2
3
4
5
6
7
8
9 #include <linux/delay.h>
10 #include <linux/mutex.h>
11 #include <linux/device.h>
12 #include <linux/kernel.h>
13 #include <linux/spi/spi.h>
14 #include <linux/slab.h>
15 #include <linux/sysfs.h>
16 #include <linux/module.h>
17 #include <asm/unaligned.h>
18
19 #include <linux/iio/iio.h>
20 #include <linux/iio/sysfs.h>
21 #include <linux/iio/buffer.h>
22 #include <linux/iio/imu/adis.h>
23
24 #define ADIS_MSC_CTRL_DATA_RDY_EN BIT(2)
25 #define ADIS_MSC_CTRL_DATA_RDY_POL_HIGH BIT(1)
26 #define ADIS_MSC_CTRL_DATA_RDY_DIO2 BIT(0)
27 #define ADIS_GLOB_CMD_SW_RESET BIT(7)
28
29 int adis_write_reg(struct adis *adis, unsigned int reg,
30 unsigned int value, unsigned int size)
31 {
32 unsigned int page = reg / ADIS_PAGE_SIZE;
33 int ret, i;
34 struct spi_message msg;
35 struct spi_transfer xfers[] = {
36 {
37 .tx_buf = adis->tx,
38 .bits_per_word = 8,
39 .len = 2,
40 .cs_change = 1,
41 .delay_usecs = adis->data->write_delay,
42 .cs_change_delay = adis->data->cs_change_delay,
43 .cs_change_delay_unit = SPI_DELAY_UNIT_USECS,
44 }, {
45 .tx_buf = adis->tx + 2,
46 .bits_per_word = 8,
47 .len = 2,
48 .cs_change = 1,
49 .delay_usecs = adis->data->write_delay,
50 .cs_change_delay = adis->data->cs_change_delay,
51 .cs_change_delay_unit = SPI_DELAY_UNIT_USECS,
52 }, {
53 .tx_buf = adis->tx + 4,
54 .bits_per_word = 8,
55 .len = 2,
56 .cs_change = 1,
57 .delay_usecs = adis->data->write_delay,
58 .cs_change_delay = adis->data->cs_change_delay,
59 .cs_change_delay_unit = SPI_DELAY_UNIT_USECS,
60 }, {
61 .tx_buf = adis->tx + 6,
62 .bits_per_word = 8,
63 .len = 2,
64 .delay_usecs = adis->data->write_delay,
65 }, {
66 .tx_buf = adis->tx + 8,
67 .bits_per_word = 8,
68 .len = 2,
69 .delay_usecs = adis->data->write_delay,
70 },
71 };
72
73 mutex_lock(&adis->txrx_lock);
74
75 spi_message_init(&msg);
76
77 if (adis->current_page != page) {
78 adis->tx[0] = ADIS_WRITE_REG(ADIS_REG_PAGE_ID);
79 adis->tx[1] = page;
80 spi_message_add_tail(&xfers[0], &msg);
81 }
82
83 switch (size) {
84 case 4:
85 adis->tx[8] = ADIS_WRITE_REG(reg + 3);
86 adis->tx[9] = (value >> 24) & 0xff;
87 adis->tx[6] = ADIS_WRITE_REG(reg + 2);
88 adis->tx[7] = (value >> 16) & 0xff;
89
90 case 2:
91 adis->tx[4] = ADIS_WRITE_REG(reg + 1);
92 adis->tx[5] = (value >> 8) & 0xff;
93
94 case 1:
95 adis->tx[2] = ADIS_WRITE_REG(reg);
96 adis->tx[3] = value & 0xff;
97 break;
98 default:
99 ret = -EINVAL;
100 goto out_unlock;
101 }
102
103 xfers[size].cs_change = 0;
104
105 for (i = 1; i <= size; i++)
106 spi_message_add_tail(&xfers[i], &msg);
107
108 ret = spi_sync(adis->spi, &msg);
109 if (ret) {
110 dev_err(&adis->spi->dev, "Failed to write register 0x%02X: %d\n",
111 reg, ret);
112 } else {
113 adis->current_page = page;
114 }
115
116 out_unlock:
117 mutex_unlock(&adis->txrx_lock);
118
119 return ret;
120 }
121 EXPORT_SYMBOL_GPL(adis_write_reg);
122
123
124
125
126
127
128
129 int adis_read_reg(struct adis *adis, unsigned int reg,
130 unsigned int *val, unsigned int size)
131 {
132 unsigned int page = reg / ADIS_PAGE_SIZE;
133 struct spi_message msg;
134 int ret;
135 struct spi_transfer xfers[] = {
136 {
137 .tx_buf = adis->tx,
138 .bits_per_word = 8,
139 .len = 2,
140 .cs_change = 1,
141 .delay_usecs = adis->data->write_delay,
142 .cs_change_delay = adis->data->cs_change_delay,
143 .cs_change_delay_unit = SPI_DELAY_UNIT_USECS,
144 }, {
145 .tx_buf = adis->tx + 2,
146 .bits_per_word = 8,
147 .len = 2,
148 .cs_change = 1,
149 .delay_usecs = adis->data->read_delay,
150 .cs_change_delay = adis->data->cs_change_delay,
151 .cs_change_delay_unit = SPI_DELAY_UNIT_USECS,
152 }, {
153 .tx_buf = adis->tx + 4,
154 .rx_buf = adis->rx,
155 .bits_per_word = 8,
156 .len = 2,
157 .cs_change = 1,
158 .delay_usecs = adis->data->read_delay,
159 .cs_change_delay = adis->data->cs_change_delay,
160 .cs_change_delay_unit = SPI_DELAY_UNIT_USECS,
161 }, {
162 .rx_buf = adis->rx + 2,
163 .bits_per_word = 8,
164 .len = 2,
165 .delay_usecs = adis->data->read_delay,
166 },
167 };
168
169 mutex_lock(&adis->txrx_lock);
170 spi_message_init(&msg);
171
172 if (adis->current_page != page) {
173 adis->tx[0] = ADIS_WRITE_REG(ADIS_REG_PAGE_ID);
174 adis->tx[1] = page;
175 spi_message_add_tail(&xfers[0], &msg);
176 }
177
178 switch (size) {
179 case 4:
180 adis->tx[2] = ADIS_READ_REG(reg + 2);
181 adis->tx[3] = 0;
182 spi_message_add_tail(&xfers[1], &msg);
183
184 case 2:
185 adis->tx[4] = ADIS_READ_REG(reg);
186 adis->tx[5] = 0;
187 spi_message_add_tail(&xfers[2], &msg);
188 spi_message_add_tail(&xfers[3], &msg);
189 break;
190 default:
191 ret = -EINVAL;
192 goto out_unlock;
193 }
194
195 ret = spi_sync(adis->spi, &msg);
196 if (ret) {
197 dev_err(&adis->spi->dev, "Failed to read register 0x%02X: %d\n",
198 reg, ret);
199 goto out_unlock;
200 } else {
201 adis->current_page = page;
202 }
203
204 switch (size) {
205 case 4:
206 *val = get_unaligned_be32(adis->rx);
207 break;
208 case 2:
209 *val = get_unaligned_be16(adis->rx + 2);
210 break;
211 }
212
213 out_unlock:
214 mutex_unlock(&adis->txrx_lock);
215
216 return ret;
217 }
218 EXPORT_SYMBOL_GPL(adis_read_reg);
219
220 #ifdef CONFIG_DEBUG_FS
221
222 int adis_debugfs_reg_access(struct iio_dev *indio_dev,
223 unsigned int reg, unsigned int writeval, unsigned int *readval)
224 {
225 struct adis *adis = iio_device_get_drvdata(indio_dev);
226
227 if (readval) {
228 uint16_t val16;
229 int ret;
230
231 ret = adis_read_reg_16(adis, reg, &val16);
232 *readval = val16;
233
234 return ret;
235 } else {
236 return adis_write_reg_16(adis, reg, writeval);
237 }
238 }
239 EXPORT_SYMBOL(adis_debugfs_reg_access);
240
241 #endif
242
243
244
245
246
247
248
249
250 int adis_enable_irq(struct adis *adis, bool enable)
251 {
252 int ret = 0;
253 uint16_t msc;
254
255 if (adis->data->enable_irq)
256 return adis->data->enable_irq(adis, enable);
257
258 ret = adis_read_reg_16(adis, adis->data->msc_ctrl_reg, &msc);
259 if (ret)
260 goto error_ret;
261
262 msc |= ADIS_MSC_CTRL_DATA_RDY_POL_HIGH;
263 msc &= ~ADIS_MSC_CTRL_DATA_RDY_DIO2;
264 if (enable)
265 msc |= ADIS_MSC_CTRL_DATA_RDY_EN;
266 else
267 msc &= ~ADIS_MSC_CTRL_DATA_RDY_EN;
268
269 ret = adis_write_reg_16(adis, adis->data->msc_ctrl_reg, msc);
270
271 error_ret:
272 return ret;
273 }
274 EXPORT_SYMBOL(adis_enable_irq);
275
276
277
278
279
280
281
282 int adis_check_status(struct adis *adis)
283 {
284 uint16_t status;
285 int ret;
286 int i;
287
288 ret = adis_read_reg_16(adis, adis->data->diag_stat_reg, &status);
289 if (ret < 0)
290 return ret;
291
292 status &= adis->data->status_error_mask;
293
294 if (status == 0)
295 return 0;
296
297 for (i = 0; i < 16; ++i) {
298 if (status & BIT(i)) {
299 dev_err(&adis->spi->dev, "%s.\n",
300 adis->data->status_error_msgs[i]);
301 }
302 }
303
304 return -EIO;
305 }
306 EXPORT_SYMBOL_GPL(adis_check_status);
307
308
309
310
311
312
313
314 int adis_reset(struct adis *adis)
315 {
316 int ret;
317
318 ret = adis_write_reg_8(adis, adis->data->glob_cmd_reg,
319 ADIS_GLOB_CMD_SW_RESET);
320 if (ret)
321 dev_err(&adis->spi->dev, "Failed to reset device: %d\n", ret);
322
323 return ret;
324 }
325 EXPORT_SYMBOL_GPL(adis_reset);
326
327 static int adis_self_test(struct adis *adis)
328 {
329 int ret;
330
331 ret = adis_write_reg_16(adis, adis->data->msc_ctrl_reg,
332 adis->data->self_test_mask);
333 if (ret) {
334 dev_err(&adis->spi->dev, "Failed to initiate self test: %d\n",
335 ret);
336 return ret;
337 }
338
339 msleep(adis->data->startup_delay);
340
341 ret = adis_check_status(adis);
342
343 if (adis->data->self_test_no_autoclear)
344 adis_write_reg_16(adis, adis->data->msc_ctrl_reg, 0x00);
345
346 return ret;
347 }
348
349
350
351
352
353
354
355
356
357
358 int adis_initial_startup(struct adis *adis)
359 {
360 int ret;
361
362 ret = adis_self_test(adis);
363 if (ret) {
364 dev_err(&adis->spi->dev, "Self-test failed, trying reset.\n");
365 adis_reset(adis);
366 msleep(adis->data->startup_delay);
367 ret = adis_self_test(adis);
368 if (ret) {
369 dev_err(&adis->spi->dev, "Second self-test failed, giving up.\n");
370 return ret;
371 }
372 }
373
374 return 0;
375 }
376 EXPORT_SYMBOL_GPL(adis_initial_startup);
377
378
379
380
381
382
383
384
385
386
387
388
389
390
391
392
393 int adis_single_conversion(struct iio_dev *indio_dev,
394 const struct iio_chan_spec *chan, unsigned int error_mask, int *val)
395 {
396 struct adis *adis = iio_device_get_drvdata(indio_dev);
397 unsigned int uval;
398 int ret;
399
400 mutex_lock(&indio_dev->mlock);
401
402 ret = adis_read_reg(adis, chan->address, &uval,
403 chan->scan_type.storagebits / 8);
404 if (ret)
405 goto err_unlock;
406
407 if (uval & error_mask) {
408 ret = adis_check_status(adis);
409 if (ret)
410 goto err_unlock;
411 }
412
413 if (chan->scan_type.sign == 's')
414 *val = sign_extend32(uval, chan->scan_type.realbits - 1);
415 else
416 *val = uval & ((1 << chan->scan_type.realbits) - 1);
417
418 ret = IIO_VAL_INT;
419 err_unlock:
420 mutex_unlock(&indio_dev->mlock);
421 return ret;
422 }
423 EXPORT_SYMBOL_GPL(adis_single_conversion);
424
425
426
427
428
429
430
431
432
433
434
435
436
437 int adis_init(struct adis *adis, struct iio_dev *indio_dev,
438 struct spi_device *spi, const struct adis_data *data)
439 {
440 mutex_init(&adis->txrx_lock);
441 adis->spi = spi;
442 adis->data = data;
443 iio_device_set_drvdata(indio_dev, adis);
444
445 if (data->has_paging) {
446
447 adis->current_page = -1;
448 } else {
449
450 adis->current_page = 0;
451 }
452
453 return adis_enable_irq(adis, false);
454 }
455 EXPORT_SYMBOL_GPL(adis_init);
456
457 MODULE_LICENSE("GPL");
458 MODULE_AUTHOR("Lars-Peter Clausen <lars@metafoo.de>");
459 MODULE_DESCRIPTION("Common library code for ADIS16XXX devices");