1
2
3
4
5
6
7
8
9
10
11
12
13
14
15
16
17
18
19
20
21#include <linux/kernel.h>
22#include <linux/device.h>
23#include <linux/init.h>
24#include <linux/cache.h>
25#include <linux/mutex.h>
26#include <linux/spi/spi.h>
27
28
29
30
31
32
33static void spidev_release(struct device *dev)
34{
35 struct spi_device *spi = to_spi_device(dev);
36
37
38 if (spi->master->cleanup)
39 spi->master->cleanup(spi);
40
41 spi_master_put(spi->master);
42 kfree(dev);
43}
44
45static ssize_t
46modalias_show(struct device *dev, struct device_attribute *a, char *buf)
47{
48 const struct spi_device *spi = to_spi_device(dev);
49
50 return snprintf(buf, BUS_ID_SIZE + 1, "%s\n", spi->modalias);
51}
52
53static struct device_attribute spi_dev_attrs[] = {
54 __ATTR_RO(modalias),
55 __ATTR_NULL,
56};
57
58
59
60
61
62static int spi_match_device(struct device *dev, struct device_driver *drv)
63{
64 const struct spi_device *spi = to_spi_device(dev);
65
66 return strncmp(spi->modalias, drv->name, BUS_ID_SIZE) == 0;
67}
68
69static int spi_uevent(struct device *dev, struct kobj_uevent_env *env)
70{
71 const struct spi_device *spi = to_spi_device(dev);
72
73 add_uevent_var(env, "MODALIAS=%s", spi->modalias);
74 return 0;
75}
76
77#ifdef CONFIG_PM
78
79static int spi_suspend(struct device *dev, pm_message_t message)
80{
81 int value = 0;
82 struct spi_driver *drv = to_spi_driver(dev->driver);
83
84
85 if (drv) {
86 if (drv->suspend)
87 value = drv->suspend(to_spi_device(dev), message);
88 else
89 dev_dbg(dev, "... can't suspend\n");
90 }
91 return value;
92}
93
94static int spi_resume(struct device *dev)
95{
96 int value = 0;
97 struct spi_driver *drv = to_spi_driver(dev->driver);
98
99
100 if (drv) {
101 if (drv->resume)
102 value = drv->resume(to_spi_device(dev));
103 else
104 dev_dbg(dev, "... can't resume\n");
105 }
106 return value;
107}
108
109#else
110#define spi_suspend NULL
111#define spi_resume NULL
112#endif
113
114struct bus_type spi_bus_type = {
115 .name = "spi",
116 .dev_attrs = spi_dev_attrs,
117 .match = spi_match_device,
118 .uevent = spi_uevent,
119 .suspend = spi_suspend,
120 .resume = spi_resume,
121};
122EXPORT_SYMBOL_GPL(spi_bus_type);
123
124
125static int spi_drv_probe(struct device *dev)
126{
127 const struct spi_driver *sdrv = to_spi_driver(dev->driver);
128
129 return sdrv->probe(to_spi_device(dev));
130}
131
132static int spi_drv_remove(struct device *dev)
133{
134 const struct spi_driver *sdrv = to_spi_driver(dev->driver);
135
136 return sdrv->remove(to_spi_device(dev));
137}
138
139static void spi_drv_shutdown(struct device *dev)
140{
141 const struct spi_driver *sdrv = to_spi_driver(dev->driver);
142
143 sdrv->shutdown(to_spi_device(dev));
144}
145
146
147
148
149
150
151int spi_register_driver(struct spi_driver *sdrv)
152{
153 sdrv->driver.bus = &spi_bus_type;
154 if (sdrv->probe)
155 sdrv->driver.probe = spi_drv_probe;
156 if (sdrv->remove)
157 sdrv->driver.remove = spi_drv_remove;
158 if (sdrv->shutdown)
159 sdrv->driver.shutdown = spi_drv_shutdown;
160 return driver_register(&sdrv->driver);
161}
162EXPORT_SYMBOL_GPL(spi_register_driver);
163
164
165
166
167
168
169
170
171
172struct boardinfo {
173 struct list_head list;
174 unsigned n_board_info;
175 struct spi_board_info board_info[0];
176};
177
178static LIST_HEAD(board_list);
179static DEFINE_MUTEX(board_lock);
180
181
182
183
184
185
186
187
188
189
190
191
192
193
194
195
196struct spi_device *spi_new_device(struct spi_master *master,
197 struct spi_board_info *chip)
198{
199 struct spi_device *proxy;
200 struct device *dev = master->dev.parent;
201 int status;
202
203
204
205
206
207
208
209
210
211 if (chip->chip_select >= master->num_chipselect) {
212 dev_err(dev, "cs%d > max %d\n",
213 chip->chip_select,
214 master->num_chipselect);
215 return NULL;
216 }
217
218 if (!spi_master_get(master))
219 return NULL;
220
221 proxy = kzalloc(sizeof *proxy, GFP_KERNEL);
222 if (!proxy) {
223 dev_err(dev, "can't alloc dev for cs%d\n",
224 chip->chip_select);
225 goto fail;
226 }
227 proxy->master = master;
228 proxy->chip_select = chip->chip_select;
229 proxy->max_speed_hz = chip->max_speed_hz;
230 proxy->mode = chip->mode;
231 proxy->irq = chip->irq;
232 proxy->modalias = chip->modalias;
233
234 snprintf(proxy->dev.bus_id, sizeof proxy->dev.bus_id,
235 "%s.%u", master->dev.bus_id,
236 chip->chip_select);
237 proxy->dev.parent = dev;
238 proxy->dev.bus = &spi_bus_type;
239 proxy->dev.platform_data = (void *) chip->platform_data;
240 proxy->controller_data = chip->controller_data;
241 proxy->controller_state = NULL;
242 proxy->dev.release = spidev_release;
243
244
245 status = master->setup(proxy);
246 if (status < 0) {
247 dev_err(dev, "can't %s %s, status %d\n",
248 "setup", proxy->dev.bus_id, status);
249 goto fail;
250 }
251
252
253
254
255 status = device_register(&proxy->dev);
256 if (status < 0) {
257 dev_err(dev, "can't %s %s, status %d\n",
258 "add", proxy->dev.bus_id, status);
259 goto fail;
260 }
261 dev_dbg(dev, "registered child %s\n", proxy->dev.bus_id);
262 return proxy;
263
264fail:
265 spi_master_put(master);
266 kfree(proxy);
267 return NULL;
268}
269EXPORT_SYMBOL_GPL(spi_new_device);
270
271
272
273
274
275
276
277
278
279
280
281
282
283
284
285
286
287
288
289
290int __init
291spi_register_board_info(struct spi_board_info const *info, unsigned n)
292{
293 struct boardinfo *bi;
294
295 bi = kmalloc(sizeof(*bi) + n * sizeof *info, GFP_KERNEL);
296 if (!bi)
297 return -ENOMEM;
298 bi->n_board_info = n;
299 memcpy(bi->board_info, info, n * sizeof *info);
300
301 mutex_lock(&board_lock);
302 list_add_tail(&bi->list, &board_list);
303 mutex_unlock(&board_lock);
304 return 0;
305}
306
307
308
309
310
311static void scan_boardinfo(struct spi_master *master)
312{
313 struct boardinfo *bi;
314
315 mutex_lock(&board_lock);
316 list_for_each_entry(bi, &board_list, list) {
317 struct spi_board_info *chip = bi->board_info;
318 unsigned n;
319
320 for (n = bi->n_board_info; n > 0; n--, chip++) {
321 if (chip->bus_num != master->bus_num)
322 continue;
323
324
325
326 (void) spi_new_device(master, chip);
327 }
328 }
329 mutex_unlock(&board_lock);
330}
331
332
333
334static void spi_master_release(struct device *dev)
335{
336 struct spi_master *master;
337
338 master = container_of(dev, struct spi_master, dev);
339 kfree(master);
340}
341
342static struct class spi_master_class = {
343 .name = "spi_master",
344 .owner = THIS_MODULE,
345 .dev_release = spi_master_release,
346};
347
348
349
350
351
352
353
354
355
356
357
358
359
360
361
362
363
364
365
366
367
368struct spi_master *spi_alloc_master(struct device *dev, unsigned size)
369{
370 struct spi_master *master;
371
372 if (!dev)
373 return NULL;
374
375 master = kzalloc(size + sizeof *master, GFP_KERNEL);
376 if (!master)
377 return NULL;
378
379 device_initialize(&master->dev);
380 master->dev.class = &spi_master_class;
381 master->dev.parent = get_device(dev);
382 spi_master_set_devdata(master, &master[1]);
383
384 return master;
385}
386EXPORT_SYMBOL_GPL(spi_alloc_master);
387
388
389
390
391
392
393
394
395
396
397
398
399
400
401
402
403
404
405
406
407
408int spi_register_master(struct spi_master *master)
409{
410 static atomic_t dyn_bus_id = ATOMIC_INIT((1<<15) - 1);
411 struct device *dev = master->dev.parent;
412 int status = -ENODEV;
413 int dynamic = 0;
414
415 if (!dev)
416 return -ENODEV;
417
418
419
420
421 if (master->num_chipselect == 0)
422 return -EINVAL;
423
424
425 if (master->bus_num < 0) {
426
427
428
429 master->bus_num = atomic_dec_return(&dyn_bus_id);
430 dynamic = 1;
431 }
432
433
434
435
436 snprintf(master->dev.bus_id, sizeof master->dev.bus_id,
437 "spi%u", master->bus_num);
438 status = device_add(&master->dev);
439 if (status < 0)
440 goto done;
441 dev_dbg(dev, "registered master %s%s\n", master->dev.bus_id,
442 dynamic ? " (dynamic)" : "");
443
444
445 scan_boardinfo(master);
446 status = 0;
447done:
448 return status;
449}
450EXPORT_SYMBOL_GPL(spi_register_master);
451
452
453static int __unregister(struct device *dev, void *master_dev)
454{
455
456 if (dev != master_dev)
457 spi_unregister_device(to_spi_device(dev));
458 return 0;
459}
460
461
462
463
464
465
466
467
468
469
470
471void spi_unregister_master(struct spi_master *master)
472{
473 int dummy;
474
475 dummy = device_for_each_child(master->dev.parent, &master->dev,
476 __unregister);
477 device_unregister(&master->dev);
478}
479EXPORT_SYMBOL_GPL(spi_unregister_master);
480
481static int __spi_master_match(struct device *dev, void *data)
482{
483 struct spi_master *m;
484 u16 *bus_num = data;
485
486 m = container_of(dev, struct spi_master, dev);
487 return m->bus_num == *bus_num;
488}
489
490
491
492
493
494
495
496
497
498
499
500struct spi_master *spi_busnum_to_master(u16 bus_num)
501{
502 struct device *dev;
503 struct spi_master *master = NULL;
504
505 dev = class_find_device(&spi_master_class, &bus_num,
506 __spi_master_match);
507 if (dev)
508 master = container_of(dev, struct spi_master, dev);
509
510 return master;
511}
512EXPORT_SYMBOL_GPL(spi_busnum_to_master);
513
514
515
516
517static void spi_complete(void *arg)
518{
519 complete(arg);
520}
521
522
523
524
525
526
527
528
529
530
531
532
533
534
535
536
537
538
539
540
541
542
543int spi_sync(struct spi_device *spi, struct spi_message *message)
544{
545 DECLARE_COMPLETION_ONSTACK(done);
546 int status;
547
548 message->complete = spi_complete;
549 message->context = &done;
550 status = spi_async(spi, message);
551 if (status == 0) {
552 wait_for_completion(&done);
553 status = message->status;
554 }
555 message->context = NULL;
556 return status;
557}
558EXPORT_SYMBOL_GPL(spi_sync);
559
560
561#define SPI_BUFSIZ max(32,SMP_CACHE_BYTES)
562
563static u8 *buf;
564
565
566
567
568
569
570
571
572
573
574
575
576
577
578
579
580
581
582
583
584int spi_write_then_read(struct spi_device *spi,
585 const u8 *txbuf, unsigned n_tx,
586 u8 *rxbuf, unsigned n_rx)
587{
588 static DEFINE_MUTEX(lock);
589
590 int status;
591 struct spi_message message;
592 struct spi_transfer x[2];
593 u8 *local_buf;
594
595
596
597
598
599 if ((n_tx + n_rx) > SPI_BUFSIZ)
600 return -EINVAL;
601
602 spi_message_init(&message);
603 memset(x, 0, sizeof x);
604 if (n_tx) {
605 x[0].len = n_tx;
606 spi_message_add_tail(&x[0], &message);
607 }
608 if (n_rx) {
609 x[1].len = n_rx;
610 spi_message_add_tail(&x[1], &message);
611 }
612
613
614 if (!mutex_trylock(&lock)) {
615 local_buf = kmalloc(SPI_BUFSIZ, GFP_KERNEL);
616 if (!local_buf)
617 return -ENOMEM;
618 } else
619 local_buf = buf;
620
621 memcpy(local_buf, txbuf, n_tx);
622 x[0].tx_buf = local_buf;
623 x[1].rx_buf = local_buf + n_tx;
624
625
626 status = spi_sync(spi, &message);
627 if (status == 0)
628 memcpy(rxbuf, x[1].rx_buf, n_rx);
629
630 if (x[0].tx_buf == buf)
631 mutex_unlock(&lock);
632 else
633 kfree(local_buf);
634
635 return status;
636}
637EXPORT_SYMBOL_GPL(spi_write_then_read);
638
639
640
641static int __init spi_init(void)
642{
643 int status;
644
645 buf = kmalloc(SPI_BUFSIZ, GFP_KERNEL);
646 if (!buf) {
647 status = -ENOMEM;
648 goto err0;
649 }
650
651 status = bus_register(&spi_bus_type);
652 if (status < 0)
653 goto err1;
654
655 status = class_register(&spi_master_class);
656 if (status < 0)
657 goto err2;
658 return 0;
659
660err2:
661 bus_unregister(&spi_bus_type);
662err1:
663 kfree(buf);
664 buf = NULL;
665err0:
666 return status;
667}
668
669
670
671
672
673
674
675
676subsys_initcall(spi_init);
677
678