1
2
3
4
5
6
7
8
9
10
11
12
13
14
15
16
17
18
19#include <linux/init.h>
20#include <linux/spinlock.h>
21#include <linux/workqueue.h>
22#include <linux/interrupt.h>
23#include <linux/delay.h>
24#include <linux/errno.h>
25#include <linux/platform_device.h>
26
27#include <linux/spi/spi.h>
28#include <linux/spi/spi_bitbang.h>
29
30
31
32
33
34
35
36
37
38
39
40
41
42
43
44
45
46
47
48
49
50struct spi_bitbang_cs {
51 unsigned nsecs;
52 u32 (*txrx_word)(struct spi_device *spi, unsigned nsecs,
53 u32 word, u8 bits);
54 unsigned (*txrx_bufs)(struct spi_device *,
55 u32 (*txrx_word)(
56 struct spi_device *spi,
57 unsigned nsecs,
58 u32 word, u8 bits),
59 unsigned, struct spi_transfer *);
60};
61
62static unsigned bitbang_txrx_8(
63 struct spi_device *spi,
64 u32 (*txrx_word)(struct spi_device *spi,
65 unsigned nsecs,
66 u32 word, u8 bits),
67 unsigned ns,
68 struct spi_transfer *t
69) {
70 unsigned bits = spi->bits_per_word;
71 unsigned count = t->len;
72 const u8 *tx = t->tx_buf;
73 u8 *rx = t->rx_buf;
74
75 while (likely(count > 0)) {
76 u8 word = 0;
77
78 if (tx)
79 word = *tx++;
80 word = txrx_word(spi, ns, word, bits);
81 if (rx)
82 *rx++ = word;
83 count -= 1;
84 }
85 return t->len - count;
86}
87
88static unsigned bitbang_txrx_16(
89 struct spi_device *spi,
90 u32 (*txrx_word)(struct spi_device *spi,
91 unsigned nsecs,
92 u32 word, u8 bits),
93 unsigned ns,
94 struct spi_transfer *t
95) {
96 unsigned bits = spi->bits_per_word;
97 unsigned count = t->len;
98 const u16 *tx = t->tx_buf;
99 u16 *rx = t->rx_buf;
100
101 while (likely(count > 1)) {
102 u16 word = 0;
103
104 if (tx)
105 word = *tx++;
106 word = txrx_word(spi, ns, word, bits);
107 if (rx)
108 *rx++ = word;
109 count -= 2;
110 }
111 return t->len - count;
112}
113
114static unsigned bitbang_txrx_32(
115 struct spi_device *spi,
116 u32 (*txrx_word)(struct spi_device *spi,
117 unsigned nsecs,
118 u32 word, u8 bits),
119 unsigned ns,
120 struct spi_transfer *t
121) {
122 unsigned bits = spi->bits_per_word;
123 unsigned count = t->len;
124 const u32 *tx = t->tx_buf;
125 u32 *rx = t->rx_buf;
126
127 while (likely(count > 3)) {
128 u32 word = 0;
129
130 if (tx)
131 word = *tx++;
132 word = txrx_word(spi, ns, word, bits);
133 if (rx)
134 *rx++ = word;
135 count -= 4;
136 }
137 return t->len - count;
138}
139
140int spi_bitbang_setup_transfer(struct spi_device *spi, struct spi_transfer *t)
141{
142 struct spi_bitbang_cs *cs = spi->controller_state;
143 u8 bits_per_word;
144 u32 hz;
145
146 if (t) {
147 bits_per_word = t->bits_per_word;
148 hz = t->speed_hz;
149 } else {
150 bits_per_word = 0;
151 hz = 0;
152 }
153
154
155 if (!bits_per_word)
156 bits_per_word = spi->bits_per_word;
157 if (bits_per_word <= 8)
158 cs->txrx_bufs = bitbang_txrx_8;
159 else if (bits_per_word <= 16)
160 cs->txrx_bufs = bitbang_txrx_16;
161 else if (bits_per_word <= 32)
162 cs->txrx_bufs = bitbang_txrx_32;
163 else
164 return -EINVAL;
165
166
167 if (!hz)
168 hz = spi->max_speed_hz;
169 if (hz) {
170 cs->nsecs = (1000000000/2) / hz;
171 if (cs->nsecs > (MAX_UDELAY_MS * 1000 * 1000))
172 return -EINVAL;
173 }
174
175 return 0;
176}
177EXPORT_SYMBOL_GPL(spi_bitbang_setup_transfer);
178
179
180
181
182int spi_bitbang_setup(struct spi_device *spi)
183{
184 struct spi_bitbang_cs *cs = spi->controller_state;
185 struct spi_bitbang *bitbang;
186 int retval;
187 unsigned long flags;
188
189 bitbang = spi_master_get_devdata(spi->master);
190
191 if (!cs) {
192 cs = kzalloc(sizeof *cs, GFP_KERNEL);
193 if (!cs)
194 return -ENOMEM;
195 spi->controller_state = cs;
196 }
197
198
199 cs->txrx_word = bitbang->txrx_word[spi->mode & (SPI_CPOL|SPI_CPHA)];
200 if (!cs->txrx_word)
201 return -EINVAL;
202
203 retval = bitbang->setup_transfer(spi, NULL);
204 if (retval < 0)
205 return retval;
206
207 dev_dbg(&spi->dev, "%s, %u nsec/bit\n", __func__, 2 * cs->nsecs);
208
209
210
211
212
213
214
215 spin_lock_irqsave(&bitbang->lock, flags);
216 if (!bitbang->busy) {
217 bitbang->chipselect(spi, BITBANG_CS_INACTIVE);
218 ndelay(cs->nsecs);
219 }
220 spin_unlock_irqrestore(&bitbang->lock, flags);
221
222 return 0;
223}
224EXPORT_SYMBOL_GPL(spi_bitbang_setup);
225
226
227
228
229void spi_bitbang_cleanup(struct spi_device *spi)
230{
231 kfree(spi->controller_state);
232}
233EXPORT_SYMBOL_GPL(spi_bitbang_cleanup);
234
235static int spi_bitbang_bufs(struct spi_device *spi, struct spi_transfer *t)
236{
237 struct spi_bitbang_cs *cs = spi->controller_state;
238 unsigned nsecs = cs->nsecs;
239
240 return cs->txrx_bufs(spi, cs->txrx_word, nsecs, t);
241}
242
243
244
245
246
247
248
249
250
251
252
253
254
255
256static void bitbang_work(struct work_struct *work)
257{
258 struct spi_bitbang *bitbang =
259 container_of(work, struct spi_bitbang, work);
260 unsigned long flags;
261 int do_setup = -1;
262 int (*setup_transfer)(struct spi_device *,
263 struct spi_transfer *);
264
265 setup_transfer = bitbang->setup_transfer;
266
267 spin_lock_irqsave(&bitbang->lock, flags);
268 bitbang->busy = 1;
269 while (!list_empty(&bitbang->queue)) {
270 struct spi_message *m;
271 struct spi_device *spi;
272 unsigned nsecs;
273 struct spi_transfer *t = NULL;
274 unsigned tmp;
275 unsigned cs_change;
276 int status;
277
278 m = container_of(bitbang->queue.next, struct spi_message,
279 queue);
280 list_del_init(&m->queue);
281 spin_unlock_irqrestore(&bitbang->lock, flags);
282
283
284
285
286
287 nsecs = 100;
288
289 spi = m->spi;
290 tmp = 0;
291 cs_change = 1;
292 status = 0;
293
294 list_for_each_entry (t, &m->transfers, transfer_list) {
295
296
297 if (t->speed_hz || t->bits_per_word)
298 do_setup = 1;
299
300
301 if (do_setup != 0) {
302 if (!setup_transfer) {
303 status = -ENOPROTOOPT;
304 break;
305 }
306 status = setup_transfer(spi, t);
307 if (status < 0)
308 break;
309 }
310
311
312
313
314
315
316
317 if (cs_change) {
318 bitbang->chipselect(spi, BITBANG_CS_ACTIVE);
319 ndelay(nsecs);
320 }
321 cs_change = t->cs_change;
322 if (!t->tx_buf && !t->rx_buf && t->len) {
323 status = -EINVAL;
324 break;
325 }
326
327
328
329
330
331 if (t->len) {
332
333
334
335 if (!m->is_dma_mapped)
336 t->rx_dma = t->tx_dma = 0;
337 status = bitbang->txrx_bufs(spi, t);
338 }
339 if (status > 0)
340 m->actual_length += status;
341 if (status != t->len) {
342
343 if (status >= 0)
344 status = -EREMOTEIO;
345 break;
346 }
347 status = 0;
348
349
350 if (t->delay_usecs)
351 udelay(t->delay_usecs);
352
353 if (!cs_change)
354 continue;
355 if (t->transfer_list.next == &m->transfers)
356 break;
357
358
359
360
361 ndelay(nsecs);
362 bitbang->chipselect(spi, BITBANG_CS_INACTIVE);
363 ndelay(nsecs);
364 }
365
366 m->status = status;
367 m->complete(m->context);
368
369
370 if (do_setup == 1)
371 setup_transfer(spi, NULL);
372 do_setup = 0;
373
374
375
376
377
378 if (!(status == 0 && cs_change)) {
379 ndelay(nsecs);
380 bitbang->chipselect(spi, BITBANG_CS_INACTIVE);
381 ndelay(nsecs);
382 }
383
384 spin_lock_irqsave(&bitbang->lock, flags);
385 }
386 bitbang->busy = 0;
387 spin_unlock_irqrestore(&bitbang->lock, flags);
388}
389
390
391
392
393int spi_bitbang_transfer(struct spi_device *spi, struct spi_message *m)
394{
395 struct spi_bitbang *bitbang;
396 unsigned long flags;
397 int status = 0;
398
399 m->actual_length = 0;
400 m->status = -EINPROGRESS;
401
402 bitbang = spi_master_get_devdata(spi->master);
403
404 spin_lock_irqsave(&bitbang->lock, flags);
405 if (!spi->max_speed_hz)
406 status = -ENETDOWN;
407 else {
408 list_add_tail(&m->queue, &bitbang->queue);
409 queue_work(bitbang->workqueue, &bitbang->work);
410 }
411 spin_unlock_irqrestore(&bitbang->lock, flags);
412
413 return status;
414}
415EXPORT_SYMBOL_GPL(spi_bitbang_transfer);
416
417
418
419
420
421
422
423
424
425
426
427
428
429
430
431
432
433
434
435
436
437
438
439
440
441
442int spi_bitbang_start(struct spi_bitbang *bitbang)
443{
444 int status;
445
446 if (!bitbang->master || !bitbang->chipselect)
447 return -EINVAL;
448
449 INIT_WORK(&bitbang->work, bitbang_work);
450 spin_lock_init(&bitbang->lock);
451 INIT_LIST_HEAD(&bitbang->queue);
452
453 if (!bitbang->master->mode_bits)
454 bitbang->master->mode_bits = SPI_CPOL | SPI_CPHA | bitbang->flags;
455
456 if (!bitbang->master->transfer)
457 bitbang->master->transfer = spi_bitbang_transfer;
458 if (!bitbang->txrx_bufs) {
459 bitbang->use_dma = 0;
460 bitbang->txrx_bufs = spi_bitbang_bufs;
461 if (!bitbang->master->setup) {
462 if (!bitbang->setup_transfer)
463 bitbang->setup_transfer =
464 spi_bitbang_setup_transfer;
465 bitbang->master->setup = spi_bitbang_setup;
466 bitbang->master->cleanup = spi_bitbang_cleanup;
467 }
468 } else if (!bitbang->master->setup)
469 return -EINVAL;
470
471
472 bitbang->busy = 0;
473 bitbang->workqueue = create_singlethread_workqueue(
474 dev_name(bitbang->master->dev.parent));
475 if (bitbang->workqueue == NULL) {
476 status = -EBUSY;
477 goto err1;
478 }
479
480
481
482
483 status = spi_register_master(bitbang->master);
484 if (status < 0)
485 goto err2;
486
487 return status;
488
489err2:
490 destroy_workqueue(bitbang->workqueue);
491err1:
492 return status;
493}
494EXPORT_SYMBOL_GPL(spi_bitbang_start);
495
496
497
498
499int spi_bitbang_stop(struct spi_bitbang *bitbang)
500{
501 spi_unregister_master(bitbang->master);
502
503 WARN_ON(!list_empty(&bitbang->queue));
504
505 destroy_workqueue(bitbang->workqueue);
506
507 return 0;
508}
509EXPORT_SYMBOL_GPL(spi_bitbang_stop);
510
511MODULE_LICENSE("GPL");
512
513