1
2
3
4
5
6
7
8
9
10
11
12
13
14
15
16
17
18
19
20
21
22
23
24
25
26
27
28
29
30
31
32
33
34
35
36
37
38
39
40
41
42
43
44
45
46
47
48
49
50
51
52
53
54
55
56
57
58
59
60
61
62
63
64
65
66
67
68
69
70
71
72
73
74
75
76
77
78
79
80
81
82
83
84
85
86
87
88
89
90
91
92
93
94
95
96
97
98
99
100
101
102
103
104
105
106
107
108
109
110
111
112
113
114
115
116
117
118
119
120
121
122
123
124
125
126
127
128
129
130
131
132
133
134
135
136
137
138
139
140
141
142
143
144
145
146
147
148
149
150
151
152
153
154
155
156
157
158
159
160
161
162
163
164
165
166
167
168
169
170
171
172
173
174
175
176
177
178
179
180
181
182
183
184
185
186
187
188
189
190
191
192
193
194
195
196
197
198
199
200
201
202
203
204
205
206
207
208
209
210
211
212
213
214
215
216
217
218
219
220
221
222
223
224
225
226
227
228
229
230
231
232
233
234
235
236
237
238
239
240
241
242
243
244
245
246
247
248
249
250
251
252
253
254
255
256
257
258
259
260
261
262
263
264
265
266
267
268
269
270
271
272
273
274
275
276
277
278
279
280
281
282
283
284
285
286
287
288
289
290
291
292
293
294
295
296
297
298
299
300
301
302
303
304
305
306
307
308
309
310
311
312
313
314
315
316
317
318
319
320
321
322
323
324
325
326
327
328
329
330
331
332
333
334
335
336
337
338
339
340
341
342
343
344
345
346
347
348
349
350
351
352
353
354
355
356
357
358
359
360
361
362
363
364
365
366
367
368
369
370
371
372
373
374
375
376
377
378
379
380
381
382
383
384
385
386
387
388
389
390
391
392
393
394
395
396
397
398
399
400
401
402
403
404
405
406
407
408
409
410
411
412
413
414
415
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
442
443
444
445
446
447
448
449
450
451
452
453
454
455
456
457
458
459
460
461
462
463
464
465
466
467
468
469
470
471
472
473
474
475
476
477
478
479
480
481
482
483
484
485
486
487
488
489
490
491
492
493
494
495
496
497
498
499
500
501
502
503
504
505
506
507
508
509
510
511
512
513
514
515
516
517
518
519
520
521
522
523
524
525
526
527
528
529
530
531
532
533
534
535
536
537
538
539
540
541
542
543
544
545
546
547
548
549
550
551
552
553
554
555
556
557
558
559
560
561
562
563
564
565
566
567
568
569
570
571
572
573
574
575
576
577
578
579
580
581
582
583
584
585
586
587
588
589
590
591
592
593
594
595
596
597
598
599
600
601
602
603
604
605
606
607
608
609
610
611
612
613
614
615
616
617
618
619
620
621
622
623
624
625
626
627
628
629
630
631
632
633
634
635
636
637
638
639
640
641
642
643
644
645
646
647
648
649
650
651
652
653
654
655
656
657
658
659
660
661
662
663
664
665
666
667
668
669
670
671
672
673
674
675
676
677
678
679
680
681
682
683
684
685
686
687
688
689
690
691
692
693
694
695
696
697
698
699
700
701
702
703
704
705
706
707
708
709
710
711
712
713
714
715
716
717
718
719
720
721
722
723
724
725
726
727
728
729
730
731
732
733
734
735
736
737
738
739
740
741
742
743
744
745
746
747
748
749
750
751
752
753
754
755
756
757
758
759
760
761
762
763
764
765
766
767
768
769
770
771
772
773
774
775
776
777
778
779
780
781
782
783
784
785
786
787
788
789
790
791
792
793
794
795
796
797
798
799
800
801
802
803
804
805
806
807
808
809
810
811
812
813
814
815
816
817
818
819
820
821
822
823
824
825
826
827
828
829
830
831
832
833
834
835
836
837
838
839
840
841
842
843
844
845
846
847
848
849
850
851
852
853
854
855
856
857
858
859
860
861
862
863
864
865
866
867
868
869
870
871
872
873
874
875
876
877
878
879
880
881
882
883
884
885
886
887
888
889
890
891
892
893
894
895
896
897
898
899
900
901
902
903
904
905
906
907
908
909
910
911
912
913
914
915
916
917
918
919
920
921
922
923
924
925
926
927
928
929
930
931
932
933
934
935
936
937
938
939
940
941
942
943
944
945
946
947
948
949
950
951
952
953
954
955
956
957
958
959
960
961
962
963
964
965
966
967
968
969
970
971
972
973
974
975
976
977
978
979
980
981
982
983
984
985
986
987
988
989
990
991
992
993
994
995
996
997
998
999
1000
1001
1002
1003
1004
1005
1006
1007
1008
1009
1010
1011
1012
1013
1014
1015
1016
1017
1018
1019
1020
1021
1022
1023
1024
1025
1026
1027
1028
1029
1030
1031
1032
1033
1034
1035
1036
1037
1038
1039
1040
1041
1042
1043
1044
1045
1046
1047
1048
1049
1050
1051
1052
1053
1054
1055
1056
1057
1058
1059
1060
1061
1062
1063
1064
1065
1066
1067
1068
1069
1070
1071
1072
1073
1074
1075
1076
1077
1078
1079
1080
1081
1082
1083
1084
1085
1086
1087
1088
1089
1090
1091
1092
1093
1094
1095
1096
1097
1098
1099
1100
1101
1102
1103
1104
1105
1106
1107
1108
1109
1110
1111
1112
1113
1114
1115
1116
1117
1118
1119
1120
1121
1122
1123
1124
1125
1126
1127
1128
1129
1130
1131
1132
1133
1134
1135
1136
1137
1138
1139
1140
1141
1142
1143
1144
1145
1146
1147
1148
1149
1150
1151
1152
1153
1154
1155
1156
1157
1158
1159
1160
1161
1162
1163
1164
1165
1166
1167
1168
1169
1170
1171
1172
1173
1174
1175
1176
1177
1178
1179
1180
1181
1182
1183
1184
1185
1186
1187
1188
1189
1190
1191
1192
1193
1194
1195
1196
1197
1198
1199
1200
1201
1202
1203
1204
1205
1206
1207
1208
1209
1210
1211
1212
1213
1214
1215
1216
1217
1218
1219
1220
1221
1222
1223
1224
1225
1226
1227
1228
1229
1230
1231
1232
1233
1234
1235
1236
1237
1238
1239
1240
1241
1242
1243
1244
1245
1246
1247
1248
1249
1250
1251
1252
1253
1254
1255
1256
1257
1258
1259
1260
1261
1262
1263
1264
1265
1266
1267
1268
1269
1270
1271
1272
1273
1274
1275
1276
1277
1278
1279
1280
1281
1282
1283
1284
1285
1286
1287
1288
1289
1290
1291
1292
1293
1294
1295
1296
1297
1298
1299
1300
1301
1302
1303
1304
1305
1306
1307
1308
1309
1310
1311
1312
1313
1314
1315
1316
1317
1318
1319
1320
1321
1322
1323
1324
1325
1326
1327
1328
1329
1330
1331
1332
1333
1334
1335
1336
1337
1338
1339
1340
1341
1342
1343
1344
1345
1346
1347
1348
1349
1350
1351
1352
1353
1354
1355
1356
1357
1358
1359
1360
1361
1362
1363
1364
1365
1366
1367
1368
1369
1370
1371
1372
1373
1374
1375
1376
1377
1378
1379
1380
1381
1382
1383
1384
1385
1386
1387
1388
1389
1390
1391
1392
1393
1394
1395
1396
1397
1398
1399
1400
1401
1402
1403
1404
1405
1406
1407
1408
1409
1410
1411
1412
1413
1414
1415
1416
1417
1418
1419
1420
1421
1422
1423
1424
1425
1426
1427
1428
1429
1430
1431
1432
1433
1434
1435
1436
1437
1438
1439
1440
1441
1442
1443
1444
1445
1446
1447
1448
1449
1450
1451
1452
1453
1454
1455
1456
1457
1458
1459
1460
1461
1462
1463
1464
1465
1466
1467
1468
1469
1470
1471
1472
1473
1474
1475
1476
1477
1478
1479
1480
1481
1482
1483
1484
1485
1486
1487
1488
1489
1490
1491
1492
1493
1494
1495
1496
1497
1498
1499
1500
1501
1502
1503
1504
1505
1506
1507
1508
1509
1510
1511
1512
1513
1514
1515
1516
1517
1518
1519
1520
1521
1522
1523
1524
1525
1526
1527
1528
1529
1530
1531
1532
1533
1534
1535
1536
1537
1538
1539
1540
1541
1542
1543
1544
1545
1546
1547
1548
1549
1550
1551
1552
1553
1554
1555
1556
1557
1558
1559
1560
1561
1562
1563
1564
1565
1566
1567
1568
1569
1570
1571
1572
1573
1574
1575
1576
1577
1578
1579
1580
1581
1582
1583
1584
1585
1586
1587
1588
1589
1590
1591
1592
1593
1594
1595
1596
1597
1598
1599
1600
1601
1602
1603
1604
1605
1606
1607
1608
1609
1610
1611
1612
1613
1614
1615
1616
1617
1618
1619
1620
1621
1622
1623
1624
1625
1626
1627
1628
1629
1630
1631
1632
1633
1634
1635
1636
1637
1638
1639
1640
1641
1642
1643
1644
1645
1646
1647
1648
1649
1650
1651
1652
1653
1654
1655
1656
1657
1658
1659
1660
1661
1662
1663
1664
1665
1666
1667
1668
1669
|
/*
* Open Host Controller Interface driver for USB.
*
* (C) Copyright 1999 Gregory P. Smith <greg@electricrain.com>
*
* This is the "other" host controller interface for USB. You will
* find this on many non-Intel based motherboards, and of course the
* Mac. As Linus hacked his UHCI driver together first, I modeled
* this after his.. (it should be obvious)
*
* From the programming standpoint the OHCI interface seems a little
* prettier and potentially less CPU intensive. This remains to be
* proven. In reality, I don't believe it'll make one darn bit of
* difference. USB v1.1 is a slow bus by today's standards.
*
* OHCI hardware takes care of most of the scheduling of different
* transfer types with the correct prioritization for us.
*
* To get started in USB, I used the "Universal Serial Bus System
* Architecture" book by Mindshare, Inc. It was a reasonable introduction
* and overview of USB and the two dominant host controller interfaces
* however you're better off just reading the real specs available
* from www.usb.org as you'll need them to get enough detailt to
* actually implement a HCD. The book has many typos and omissions
* Beware, the specs are the victim of a committee.
*
* This code was written with Guinness on the brain, xsnow on the desktop
* and Orbital, Orb, Enya & Massive Attack on the CD player. What a life! ;)
*
* No filesystems were harmed in the development of this code.
*
* $Id: ohci.c,v 1.26 1999/05/11 07:34:47 greg Exp $
*/
#include <linux/config.h>
#include <linux/module.h>
#include <linux/pci.h>
#include <linux/kernel.h>
#include <linux/delay.h>
#include <linux/ioport.h>
#include <linux/sched.h>
#include <linux/malloc.h>
#include <linux/smp_lock.h>
#include <linux/errno.h>
#include <asm/spinlock.h>
#include <asm/io.h>
#include <asm/irq.h>
#include <asm/system.h>
#include "ohci.h"
#include "inits.h"
#ifdef CONFIG_APM
#include <linux/apm_bios.h>
static int handle_apm_event(apm_event_t event);
static int apm_resume = 0;
#endif
static struct wait_queue *ohci_configure = NULL;
#ifdef OHCI_TIMER
static struct timer_list ohci_timer; /* timer for root hub polling */
#endif
static int ohci_td_result(struct ohci_device *dev, struct ohci_td *td)
{
unsigned int status;
status = td->info & OHCI_TD_CC;
/* TODO Debugging code for TD failures goes here */
return status;
} /* ohci_td_result() */
static spinlock_t ohci_edtd_lock = SPIN_LOCK_UNLOCKED;
/*
* Add a TD to the end of the TD list on a given ED. If td->next_td
* points to any more TDs, they will be added as well (naturally).
* Otherwise td->next_td must be 0.
*
* The SKIP flag will be cleared after this function.
*
* Important! This function needs locking and atomicity as it works
* in parallel with the HC's DMA. Locking ohci_edtd_lock while using
* the function is a must.
*
* This function can be called by the interrupt handler.
*/
static void ohci_add_td_to_ed(struct ohci_td *td, struct ohci_ed *ed)
{
/* don't let the HC pull anything from underneath us */
ed->status |= OHCI_ED_SKIP;
if (ed_head_td(ed) == 0) { /* empty list, put it on the head */
set_ed_head_td(ed, virt_to_bus(td));
ed->tail_td = 0;
} else {
struct ohci_td *tail, *head;
head = (ed_head_td(ed) == 0) ? NULL : bus_to_virt(ed_head_td(ed));
tail = (ed->tail_td == 0) ? NULL : bus_to_virt(ed->tail_td);
if (!tail) { /* no tail, single element list */
td->next_td = head->next_td;
head->next_td = virt_to_bus(td);
ed->tail_td = virt_to_bus(td);
} else { /* append to the list */
td->next_td = tail->next_td;
tail->next_td = virt_to_bus(td);
ed->tail_td = virt_to_bus(td);
}
}
/* save the ED link in each of the TDs added */
td->ed = ed;
while (td->next_td != 0) {
td = bus_to_virt(td->next_td);
td->ed = ed;
}
/* turn off the SKIP flag */
ed->status &= ~OHCI_ED_SKIP;
} /* ohci_add_td_to_ed() */
inline void ohci_start_control(struct ohci *ohci)
{
/* tell the HC to start processing the control list */
writel(OHCI_CMDSTAT_CLF, &ohci->regs->cmdstatus);
}
inline void ohci_start_bulk(struct ohci *ohci)
{
/* tell the HC to start processing the bulk list */
writel(OHCI_CMDSTAT_BLF, &ohci->regs->cmdstatus);
}
inline void ohci_start_periodic(struct ohci *ohci)
{
/* enable processing periodc transfers starting next frame */
writel_set(OHCI_USB_PLE, &ohci->regs->control);
}
inline void ohci_start_isoc(struct ohci *ohci)
{
/* enable processing isoc. transfers starting next frame */
writel_set(OHCI_USB_IE, &ohci->regs->control);
}
/*
* Add an ED to the hardware register ED list pointed to by hw_listhead_p
*/
static void ohci_add_ed_to_hw(struct ohci_ed *ed, void* hw_listhead_p)
{
__u32 listhead;
unsigned long flags;
spin_lock_irqsave(&ohci_edtd_lock, flags);
listhead = readl(hw_listhead_p);
/* if the list is not empty, insert this ED at the front */
/* XXX should they go on the end? */
if (listhead) {
ed->next_ed = listhead;
}
/* update the hardware listhead pointer */
writel(virt_to_bus(ed), hw_listhead_p);
spin_unlock_irqrestore(&ohci_edtd_lock, flags);
} /* ohci_add_ed() */
/*
* Put another control ED on the controller's list
*/
void ohci_add_control_ed(struct ohci *ohci, struct ohci_ed *ed)
{
ohci_add_ed_to_hw(ed, &ohci->regs->ed_controlhead);
ohci_start_control(ohci);
} /* ohci_add_control_ed() */
#if 0
/*
* Put another control ED on the controller's list
*/
void ohci_add_periodic_ed(struct ohci *ohci, struct ohci_ed *ed, int period)
{
ohci_add_ed_to_hw(ed, /* XXX */);
ohci_start_periodic(ohci);
} /* ohci_add_control_ed() */
#endif
/*
* Remove an ED from the HC list whos bus headpointer is pointed to
* by hw_listhead_p
*
* Note that the SKIP bit is left on in the removed ED.
*/
void ohci_remove_ed_from_hw(struct ohci_ed *ed, __u32* hw_listhead_p)
{
unsigned long flags;
struct ohci_ed *cur;
__u32 bus_ed = virt_to_bus(ed);
__u32 bus_cur;
if (ed == NULL || !bus_ed)
return;
/* tell the controller this skip ED */
ed->status |= OHCI_ED_SKIP;
bus_cur = readl(hw_listhead_p);
if (bus_cur == 0)
return; /* the list is already empty */
cur = bus_to_virt(bus_cur);
spin_lock_irqsave(&ohci_edtd_lock, flags);
/* if its the head ED, move the head */
if (bus_cur == bus_ed) {
writel(cur->next_ed, hw_listhead_p);
} else if (cur->next_ed != 0) {
struct ohci_ed *prev;
/* walk the list and unlink the ED if found */
for (;;) {
prev = cur;
cur = bus_to_virt(cur->next_ed);
if (virt_to_bus(cur) == bus_ed) {
/* unlink from the list */
prev->next_ed = cur->next_ed;
break;
}
if (cur->next_ed == 0)
break;
}
}
/* clear any links from the ED for safety */
ed->next_ed = 0;
spin_unlock_irqrestore(&ohci_edtd_lock, flags);
} /* ohci_remove_ed_from_hw() */
/*
* Remove an ED from the controller's control list. Note that the SKIP bit
* is left on in the removed ED.
*/
inline void ohci_remove_control_ed(struct ohci *ohci, struct ohci_ed *ed)
{
ohci_remove_ed_from_hw(ed, &ohci->regs->ed_controlhead);
}
/*
* Remove an ED from the controller's bulk list. Note that the SKIP bit
* is left on in the removed ED.
*/
inline void ohci_remove_bulk_ed(struct ohci *ohci, struct ohci_ed *ed)
{
ohci_remove_ed_from_hw(ed, &ohci->regs->ed_bulkhead);
}
/*
* Remove a TD from the given EDs TD list.
*/
static void ohci_remove_td_from_ed(struct ohci_td *td, struct ohci_ed *ed)
{
unsigned long flags;
struct ohci_td *head_td;
if ((td == NULL) || (ed == NULL))
return;
spin_lock_irqsave(&ohci_edtd_lock, flags);
if (ed_head_td(ed) == 0)
return;
/* set the "skip me bit" in this ED */
ed->status |= OHCI_ED_SKIP;
/* XXX Assuming this list will never be circular */
head_td = bus_to_virt(ed_head_td(ed));
if (virt_to_bus(td) == ed_head_td(ed)) {
/* It's the first TD, remove it. */
set_ed_head_td(ed, head_td->next_td);
} else {
struct ohci_td *prev_td, *cur_td;
/* FIXME: collapse this into a nice simple loop :) */
if (head_td->next_td != 0) {
prev_td = head_td;
cur_td = bus_to_virt(head_td->next_td);
for (;;) {
if (td == cur_td) {
/* remove it */
prev_td->next_td = cur_td->next_td;
break;
}
if (cur_td->next_td == 0)
break;
prev_td = cur_td;
cur_td = bus_to_virt(cur_td->next_td);
}
}
}
td->next_td = 0; /* remove the TDs links */
td->ed = NULL;
/* TODO return this TD to the pool of free TDs */
/* unset the "skip me bit" in this ED */
ed->status &= ~OHCI_ED_SKIP;
spin_unlock_irqrestore(&ohci_edtd_lock, flags);
} /* ohci_remove_td_from_ed() */
/*
* Get a pointer (virtual) to an available TD from the given device's
* pool.
*
* Return NULL if none are left.
*/
static struct ohci_td *ohci_get_free_td(struct ohci_device *dev)
{
int idx;
for (idx=0; idx < NUM_TDS; idx++) {
if (!td_allocated(dev->td[idx])) {
struct ohci_td *new_td = &dev->td[idx];
/* zero out the TD */
memset(new_td, 0, sizeof(*new_td));
/* mark the new TDs as unaccessed */
new_td->info = OHCI_TD_CC_NEW;
/* mark it as allocated */
allocate_td(new_td);
return new_td;
}
}
printk("usb-ohci error: unable to allocate a TD\n");
return NULL;
} /* ohci_get_free_td() */
/*
* Initialize a TD
*
* dir = OHCI_TD_D_IN, OHCI_TD_D_OUT, or OHCI_TD_D_SETUP
* toggle = TOGGLE_AUTO, TOGGLE_DATA0, TOGGLE_DATA1
*/
inline struct ohci_td *ohci_fill_new_td(struct ohci_td *td, int dir, int toggle, __u32 flags, void *data, __u32 len, void *dev_id, usb_device_irq completed)
{
/* hardware fields */
td->info = OHCI_TD_CC_NEW |
(dir & OHCI_TD_D) |
(toggle & OHCI_TD_DT) |
flags;
td->cur_buf = (data == NULL) ? 0 : virt_to_bus(data);
td->buf_end = (len == 0) ? 0 : td->cur_buf + len - 1;
/* driver fields */
td->data = data;
td->dev_id = dev_id;
td->completed = completed;
return td;
} /* ohci_fill_new_td() */
/**********************************
* OHCI interrupt list operations *
**********************************/
/*
* Request an interrupt handler for one "pipe" of a USB device.
* (this function is pretty minimal right now)
*
* At the moment this is only good for input interrupts. (ie: for a
* mouse or keyboard)
*
* Period is desired polling interval in ms. The closest, shorter
* match will be used. Powers of two from 1-32 are supported by OHCI.
*/
static int ohci_request_irq(struct usb_device *usb, unsigned int pipe,
usb_device_irq handler, int period, void *dev_id)
{
struct ohci_device *dev = usb_to_ohci(usb);
struct ohci_td *td;
struct ohci_ed *interrupt_ed; /* endpoint descriptor for this irq */
/*
* Pick a good frequency endpoint based on the requested period
*/
interrupt_ed = &dev->ohci->root_hub->ed[ms_to_ed_int(period)];
/*
* Set the max packet size, device speed, endpoint number, usb
* device number (function address), and type of TD.
*
* FIXME: Isochronous transfers need a pool of special 32 byte
* TDs (32 byte aligned) in order to be supported.
*/
interrupt_ed->status = \
ed_set_maxpacket(usb_maxpacket(pipe)) |
ed_set_speed(usb_pipeslow(pipe)) |
usb_pipe_endpdev(pipe) |
OHCI_ED_F_NORM;
td = ohci_get_free_td(dev);
/* FIXME: check for NULL */
/* Fill in the TD */
ohci_fill_new_td(td, td_set_dir_out(usb_pipeout(pipe)),
TOGGLE_AUTO,
OHCI_TD_ROUND,
dev->data, DATA_BUF_LEN,
dev_id, handler);
/*
* TODO: be aware that OHCI won't advance out of the 4kb
* page cur_buf started in. It'll wrap around to the start
* of the page... annoying or useful? you decide.
*
* We should make sure dev->data doesn't cross a page...
*/
/* FIXME: this just guarantees that its the end of the list */
td->next_td = 0;
/* Linus did this. see asm/system.h; scary concept... I don't
* know if its needed here or not but it won't hurt. */
wmb();
/*
* Put the TD onto our ED
*/
{
unsigned long flags;
spin_lock_irqsave(&ohci_edtd_lock, flags);
ohci_add_td_to_ed(td, interrupt_ed);
spin_unlock_irqrestore(&ohci_edtd_lock, flags);
}
#if 0
/* Assimilate the new ED into the collective */
/*
* When dynamic ED allocation is done, this call will be
* useful. For now, the correct ED already on the
* controller's proper periodic ED lists was chosen above.
*/
ohci_add_periodic_ed(dev->ohci, interrupt_ed, period);
#else
/* enable periodic (interrupt) transfers on the HC */
ohci_start_periodic(dev->ohci);
#endif
return 0;
} /* ohci_request_irq() */
/*
* Control thread operations:
*/
static struct wait_queue *control_wakeup;
/*
* This is the handler that gets called when a control transaction
* completes.
*
* This function is called from the interrupt handler.
*/
static int ohci_control_completed(int stats, void *buffer, void *dev_id)
{
wake_up(&control_wakeup);
return 0;
} /* ohci_control_completed() */
/*
* Send or receive a control message on a "pipe"
*
* The cmd parameter is a pointer to the 8 byte setup command to be
* sent. FIXME: This is a devrequest in usb.h. The function
* should be updated to accept a devrequest* instead of void*..
*
* A control message contains:
* - The command itself
* - An optional data phase (if len > 0)
* - Status complete phase
*/
static int ohci_control_msg(struct usb_device *usb, unsigned int pipe, void *cmd, void *data, int len)
{
struct ohci_device *dev = usb_to_ohci(usb);
/*
* ideally dev->ed should be linked into the root hub's
* control_ed list and used instead of just using it directly.
* This could present a problem as is with more than one
* device. (but who wants to use a keyboard AND a mouse
* anyways? ;)
*/
struct ohci_ed *control_ed = &dev->ohci->root_hub->ed[ED_CONTROL];
struct ohci_td *setup_td, *data_td, *status_td;
struct wait_queue wait = { current, NULL };
#if 0
printk(KERN_DEBUG "entering ohci_control_msg %p (ohci_dev: %p) pipe 0x%x, cmd %p, data %p, len %d\n", usb, dev, pipe, cmd, data, len);
#endif
/*
* Set the max packet size, device speed, endpoint number, usb
* device number (function address), and type of TD.
*
*/
control_ed->status = \
ed_set_maxpacket(usb_maxpacket(pipe)) |
ed_set_speed(usb_pipeslow(pipe)) |
usb_pipe_endpdev(pipe) |
OHCI_ED_F_NORM;
/*
* Build the control TD
*/
/* get a TD to send this control message with */
setup_td = ohci_get_free_td(dev);
/* TODO check for NULL */
/*
* Set the not accessed condition code, allow odd sized data,
* and set the data transfer type to SETUP. Setup DATA always
* uses a DATA0 packet.
*
* The setup packet contains a devrequest (usb.h) which
* will always be 8 bytes long. FIXME: the cmd parameter
* should be a pointer to one of these instead of a void* !!!
*/
ohci_fill_new_td(setup_td, OHCI_TD_D_SETUP, TOGGLE_DATA0,
OHCI_TD_IOC_OFF,
cmd, 8, /* cmd is always 8 bytes long */
NULL, NULL);
/* allocate the next TD */
data_td = ohci_get_free_td(dev); /* TODO check for NULL */
/* link to the next TD */
setup_td->next_td = virt_to_bus(data_td);
if (len > 0) {
/* build the Control DATA TD, it starts with a DATA1. */
ohci_fill_new_td(data_td, td_set_dir_out(usb_pipeout(pipe)),
TOGGLE_DATA1,
OHCI_TD_ROUND | OHCI_TD_IOC_OFF,
data, len,
NULL, NULL);
/*
* XXX we should check that the data buffer doesn't
* cross a 4096 byte boundary. If so, it needs to be
* copied into a single 4096 byte aligned area for the
* OHCI's TD logic to see it all, or multiple TDs need
* to be made for each page.
*
* It's not likely a control transfer will run into
* this problem.. (famous last words)
*/
status_td = ohci_get_free_td(dev); /* TODO check for NULL */
data_td->next_td = virt_to_bus(status_td);
} else {
status_td = data_td; /* no data_td, use it for status */
}
/* The control status packet always uses a DATA1 */
ohci_fill_new_td(status_td,
td_set_dir_in(usb_pipeout(pipe) | (len == 0)),
TOGGLE_DATA1,
0,
NULL, 0,
NULL, ohci_control_completed);
status_td->next_td = 0; /* end of TDs */
/*
* Start the control transaction..
*/
current->state = TASK_UNINTERRUPTIBLE;
add_wait_queue(&control_wakeup, &wait);
/*
* Add the chain of 2-3 control TDs to the control ED's TD list
*/
{
unsigned long flags;
spin_lock_irqsave(&ohci_edtd_lock, flags);
ohci_add_td_to_ed(setup_td, control_ed);
spin_unlock_irqrestore(&ohci_edtd_lock, flags);
}
#if 0
/* complete transaction debugging output (before) */
printk(KERN_DEBUG " Control ED %lx:\n", virt_to_bus(control_ed));
show_ohci_ed(control_ed);
printk(KERN_DEBUG " Setup TD %lx:\n", virt_to_bus(setup_td));
show_ohci_td(setup_td);
if (data_td != status_td) {
printk(KERN_DEBUG " Data TD %lx:\n", virt_to_bus(data_td));
show_ohci_td(data_td);
}
printk(KERN_DEBUG " Status TD %lx:\n", virt_to_bus(status_td));
show_ohci_td(status_td);
#endif
/* Give the ED to the HC */
ohci_add_control_ed(dev->ohci, control_ed);
/* FIXME:
* this should really check to see that the transaction completed.
*/
schedule_timeout(HZ/10);
remove_wait_queue(&control_wakeup, &wait);
#if 0
/* complete transaction debugging output (after) */
printk(KERN_DEBUG " (after) Control ED:\n");
show_ohci_ed(control_ed);
printk(KERN_DEBUG " (after) Setup TD:\n");
show_ohci_td(setup_td);
if (data_td != status_td) {
printk(KERN_DEBUG " (after) Data TD:\n");
show_ohci_td(data_td);
}
printk(KERN_DEBUG " (after) Status TD:\n");
show_ohci_td(status_td);
#endif
/* clean up incase it failed */
/* XXX only do this if their ed pointer still points to control_ed
* incase they've been reclaimed and used by something else
* already. -greg */
ohci_remove_td_from_ed(setup_td, control_ed);
ohci_remove_td_from_ed(data_td, control_ed);
ohci_remove_td_from_ed(status_td, control_ed);
/* remove the control ED */
ohci_remove_control_ed(dev->ohci, control_ed);
#if 0
printk(KERN_DEBUG "leaving ohci_control_msg\n");
#endif
return ohci_td_result(dev, status_td);
} /* ohci_control_msg() */
/*
* Allocate a new USB device to be attached to an OHCI controller
*/
static struct usb_device *ohci_usb_allocate(struct usb_device *parent)
{
struct usb_device *usb_dev;
struct ohci_device *dev;
/*
* Allocate the generic USB device
*/
usb_dev = kmalloc(sizeof(*usb_dev), GFP_KERNEL);
if (!usb_dev)
return NULL;
memset(usb_dev, 0, sizeof(*usb_dev));
/*
* Allocate an OHCI device (EDs and TDs for this device)
*/
dev = kmalloc(sizeof(*dev), GFP_KERNEL);
if (!dev) {
kfree(usb_dev);
return NULL;
}
memset(dev, 0, sizeof(*dev));
/*
* Link them together
*/
usb_dev->hcpriv = dev;
dev->usb = usb_dev;
/*
* Link the device to its parent (hub, etc..) if any.
*/
usb_dev->parent = parent;
if (parent) {
usb_dev->bus = parent->bus;
dev->ohci = usb_to_ohci(parent)->ohci;
}
return usb_dev;
} /* ohci_usb_allocate() */
/*
* Free a usb device.
*
* TODO This function needs to take better care of the EDs and TDs, etc.
*/
static int ohci_usb_deallocate(struct usb_device *usb_dev)
{
kfree(usb_to_ohci(usb_dev));
kfree(usb_dev);
return 0;
}
/*
* functions for the generic USB driver
*/
struct usb_operations ohci_device_operations = {
ohci_usb_allocate,
ohci_usb_deallocate,
ohci_control_msg,
ohci_request_irq,
};
/*
* Reset an OHCI controller. Returns >= 0 on success.
*
* Afterwards the HC will be in the "suspend" state which prevents you
* from writing to some registers. Bring it to the operational state
* ASAP.
*/
static int reset_hc(struct ohci *ohci)
{
int timeout = 1000; /* prevent an infinite loop */
#if 0
printk(KERN_DEBUG "usb-ohci: resetting HC %p\n", ohci);
#endif
writel(~0x0, &ohci->regs->intrdisable); /* Disable HC interrupts */
writel(1, &ohci->regs->cmdstatus); /* HC Reset */
writel_mask(0x3f, &ohci->regs->control); /* move to UsbReset state */
while ((readl(&ohci->regs->cmdstatus) & OHCI_CMDSTAT_HCR) != 0) {
if (!--timeout) {
printk("usb-ohci: USB HC reset timed out!\n");
return -1;
}
udelay(1);
}
printk(KERN_DEBUG "usb-ohci: HC %p reset.\n", ohci);
return 0;
} /* reset_hc() */
/*
* Reset and start an OHCI controller. Returns >= 0 on success.
*/
static int start_hc(struct ohci *ohci)
{
int ret = 0;
int fminterval;
fminterval = readl(&ohci->regs->fminterval) & 0x3fff;
#if 0
printk(KERN_DEBUG "entering start_hc %p\n", ohci);
#endif
if (reset_hc(ohci) < 0)
return -1;
/* restore registers cleared by the reset */
writel(virt_to_bus(ohci->root_hub->hcca), &ohci->regs->hcca);
/*
* XXX Should fminterval also be set here?
* The spec suggests 0x2edf [11,999]. (FIXME: make this a constant)
*/
fminterval |= (0x2edf << 16);
writel(fminterval, &ohci->regs->fminterval);
/* Start periodic transfers at 90% of fminterval (fmremaining
* counts down; this will put them in the first 10% of the
* frame). */
writel((0x2edf*9)/10, &ohci->regs->periodicstart);
/*
* FNO (frame number overflow) could be enabled... they
* occur every 32768 frames (every 32-33 seconds). This is
* useful for debugging and as a bus heartbeat. -greg
*/
/* Choose the interrupts we care about */
writel( OHCI_INTR_MIE | /* OHCI_INTR_RHSC | */
OHCI_INTR_WDH | OHCI_INTR_FNO,
&ohci->regs->intrenable);
/* Enter the USB Operational state & start the frames a flowing.. */
writel_set(OHCI_USB_OPER, &ohci->regs->control);
/* Enable control lists */
writel_set(OHCI_USB_IE | OHCI_USB_CLE | OHCI_USB_BLE, &ohci->regs->control);
/* Turn on power to the root hub ports (thanks Roman!) */
writel( OHCI_ROOT_LPSC, &ohci->regs->roothub.status );
printk("usb-ohci: host controller operational\n");
return ret;
} /* start_hc() */
/*
* Reset a root hub port
*/
static void ohci_reset_port(struct ohci *ohci, unsigned int port)
{
int status;
/* Don't allow overflows. */
if (port >= MAX_ROOT_PORTS) {
printk("usb-ohci: bad port #%d in ohci_reset_port\n", port);
port = MAX_ROOT_PORTS-1;
}
writel(PORT_PRS, &ohci->regs->roothub.portstatus[port]); /* Reset */
/*
* Wait for the reset to complete.
*/
wait_ms(10);
/* check port status to see that the reset completed */
status = readl(&ohci->regs->roothub.portstatus[port]);
if (status & PORT_PRS) {
/* reset failed, try harder? */
printk("usb-ohci: port %d reset failed, retrying\n", port);
writel(PORT_PRS, &ohci->regs->roothub.portstatus[port]);
wait_ms(50);
}
/* TODO we might need to re-enable the port here or is that
* done elsewhere? */
} /* ohci_reset_port */
/*
* This gets called if the connect status on the root hub changes.
*/
static void ohci_connect_change(struct ohci * ohci, int port)
{
struct usb_device *usb_dev;
struct ohci_device *dev;
/* memory I/O address of the port status register */
void *portaddr = &ohci->regs->roothub.portstatus[port];
int portstatus;
printk(KERN_DEBUG "ohci_connect_change(%p, %d)\n", ohci, port);
/*
* Because of the status change we have to forget
* everything we think we know about the device
* on this root hub port. It may have changed.
*/
usb_disconnect(ohci->root_hub->usb->children + port);
portstatus = readl(portaddr);
/* disable the port if nothing is connected */
if (!(portstatus & PORT_CCS)) {
writel(PORT_CCS, portaddr);
return;
}
/*
* Allocate a device for the new thingy that's been attached
*/
usb_dev = ohci_usb_allocate(ohci->root_hub->usb);
dev = usb_dev->hcpriv;
dev->ohci = ohci;
usb_connect(dev->usb);
/* link it into the bus's device tree */
ohci->root_hub->usb->children[port] = usb_dev;
wait_ms(200); /* wait for powerup; XXX is this needed? */
ohci_reset_port(ohci, port);
/* Get information on speed by using LSD */
usb_dev->slow = readl(portaddr) & PORT_LSDA ? 1 : 0;
/*
* Do generic USB device tree processing on the new device.
*/
usb_new_device(usb_dev);
} /* ohci_connect_change() */
/*
* This gets called when the root hub configuration
* has changed. Just go through each port, seeing if
* there is something interesting happening.
*/
static void ohci_check_configuration(struct ohci *ohci)
{
struct ohci_regs *regs = ohci->regs;
int num = 0;
int maxport = readl(&ohci->regs->roothub) & 0xff;
#if 1
printk(KERN_DEBUG "entering ohci_check_configuration %p\n", ohci);
#endif
do {
if (readl(®s->roothub.portstatus[num]) & PORT_CSC) {
/* reset the connect status change bit */
writel(PORT_CSC, ®s->roothub.portstatus[num]);
/* check the port for a nifty device */
ohci_connect_change(ohci, num);
}
} while (++num < maxport);
#if 0
printk(KERN_DEBUG "leaving ohci_check_configuration %p\n", ohci);
#endif
} /* ohci_check_configuration() */
/*
* Check root hub port status and wake the control thread up if
* anything has changed.
*
* This function is called from the interrupt handler.
*/
static void ohci_root_hub_events(struct ohci *ohci)
{
if (waitqueue_active(&ohci_configure)) {
int num = 0;
int maxport = ohci->root_hub->usb->maxchild;
do {
if (readl(&ohci->regs->roothub.portstatus[num]) &
PORT_CSC) {
if (waitqueue_active(&ohci_configure))
wake_up(&ohci_configure);
return;
}
} while (++num < maxport);
}
} /* ohci_root_hub_events() */
/*
* The done list is in reverse order; we need to process TDs in the
* order they were finished (FIFO). This function builds the FIFO
* list using the next_dl_td pointer.
*
* This function originally by Roman Weissgaerber (weissg@vienna.at)
*
* This function is called from the interrupt handler.
*/
static struct ohci_td * ohci_reverse_donelist(struct ohci * ohci)
{
__u32 td_list_hc;
struct ohci_hcca *hcca = ohci->root_hub->hcca;
struct ohci_td *td_list = NULL;
struct ohci_td *td_rev = NULL;
td_list_hc = hcca->donehead & 0xfffffff0;
hcca->donehead = 0;
while(td_list_hc) {
td_list = (struct ohci_td *) bus_to_virt(td_list_hc);
td_list->next_dl_td = td_rev;
td_rev = td_list;
td_list_hc = td_list->next_td & 0xfffffff0;
}
return td_list;
} /* ohci_reverse_donelist() */
/*
* Collect this interrupt's goodies off of the list of finished TDs
* that the OHCI controller is kind enough to setup for us.
*
* This function is called from the interrupt handler.
*/
static void ohci_reap_donelist(struct ohci *ohci)
{
struct ohci_td *td; /* used for walking the list */
spin_lock(&ohci_edtd_lock);
/* create the FIFO ordered donelist */
td = ohci_reverse_donelist(ohci);
while (td != NULL) {
struct ohci_td *next_td = td->next_dl_td;
/* FIXME: munge td->info into a future standard status format */
/* Check if TD should be re-queued */
if ((td->completed != NULL) &&
(td->completed(OHCI_TD_CC_GET(td->info), td->data, td->dev_id)))
{
/* Mark the TD as active again:
* Set the not accessed condition code
* FIXME: should this reset OHCI_TD_ERRCNT?
*/
td->info |= OHCI_TD_CC_NEW;
/* point it back to the start of the data buffer */
td->cur_buf = virt_to_bus(td->data);
/* XXX disabled for debugging reasons right now.. */
/* insert it back on its ED */
ohci_add_td_to_ed(td, td->ed);
} else {
/* return it to the pool of free TDs */
ohci_free_td(td);
}
td = next_td;
}
spin_unlock(&ohci_edtd_lock);
} /* ohci_reap_donelist() */
#if 0
static int in_int = 0;
#endif
/*
* Get annoyed at the controller for bothering us.
* This pretty much follows the OHCI v1.0a spec, section 5.3.
*/
static void ohci_interrupt(int irq, void *__ohci, struct pt_regs *r)
{
struct ohci *ohci = __ohci;
struct ohci_regs *regs = ohci->regs;
struct ohci_hcca *hcca = ohci->root_hub->hcca;
__u32 status, context;
#if 0
/* for debugging to keep IRQs from running away. */
if (in_int >= 2)
return;
++in_int;
return;
#endif
/* Save the status of the interrupts that are enabled */
status = readl(®s->intrstatus);
status &= readl(®s->intrenable);
/* make context = the interrupt status bits that we care about */
if (hcca->donehead != 0) {
context = OHCI_INTR_WDH; /* hcca donehead needs processing */
if (hcca->donehead & 1) {
context |= status; /* other status change to check */
}
} else {
context = status;
if (!context) {
/* TODO increment a useless interrupt counter here */
return;
}
}
/* Disable HC interrupts */
writel(OHCI_INTR_MIE, ®s->intrdisable);
/* Process the done list */
if (context & OHCI_INTR_WDH) {
/* See which TD's completed.. */
ohci_reap_donelist(ohci);
/* reset the done queue and tell the controller */
hcca->donehead = 0;
writel(OHCI_INTR_WDH, ®s->intrstatus);
context &= ~OHCI_INTR_WDH; /* mark this as checked */
}
/* Process any root hub status changes */
if (context & OHCI_INTR_RHSC) {
/* Wake the thread to process root hub events */
if (waitqueue_active(&ohci_configure))
wake_up(&ohci_configure);
writel(OHCI_INTR_RHSC, ®s->intrstatus);
/*
* Don't unset RHSC in context; it should be disabled.
* The control thread will re-enable it after it has
* checked the root hub status.
*/
} else {
/* check the root hub status anyways. Some controllers
* might not generate the interrupt properly. (?) */
ohci_root_hub_events(ohci);
}
/* Check those "other" pesky bits */
if (context & (OHCI_INTR_FNO)) {
writel(OHCI_INTR_FNO, ®s->intrstatus);
context &= ~OHCI_INTR_FNO; /* mark this as checked */
}
if (context & OHCI_INTR_SO) {
writel(OHCI_INTR_SO, ®s->intrstatus);
context &= ~OHCI_INTR_SO; /* mark this as checked */
}
if (context & OHCI_INTR_RD) {
writel(OHCI_INTR_RD, ®s->intrstatus);
context &= ~OHCI_INTR_RD; /* mark this as checked */
}
if (context & OHCI_INTR_UE) {
/* FIXME: need to have the control thread reset the
* controller now and keep a count of unrecoverable
* errors. If there are too many, it should just shut
* the broken controller down entirely. */
writel(OHCI_INTR_UE, ®s->intrstatus);
context &= ~OHCI_INTR_UE; /* mark this as checked */
}
if (context & OHCI_INTR_OC) {
writel(OHCI_INTR_OC, ®s->intrstatus);
context &= ~OHCI_INTR_OC; /* mark this as checked */
}
/* Mask out any remaining unprocessed interrupts so we don't
* get any more of them. */
if (context & ~OHCI_INTR_MIE) {
writel(context, ®s->intrdisable);
}
/* Re-enable HC interrupts */
writel(OHCI_INTR_MIE, ®s->intrenable);
} /* ohci_interrupt() */
/*
* Allocate the resources required for running an OHCI controller.
* Host controller interrupts must not be running while calling this
* function or the penguins will get angry.
*
* The mem_base parameter must be the usable -virtual- address of the
* host controller's memory mapped I/O registers.
*/
static struct ohci *alloc_ohci(void* mem_base)
{
int i;
struct ohci *ohci;
struct usb_bus *bus;
struct ohci_device *dev;
struct usb_device *usb;
#if 0
printk(KERN_DEBUG "entering alloc_ohci %p\n", mem_base);
#endif
ohci = kmalloc(sizeof(*ohci), GFP_KERNEL);
if (!ohci)
return NULL;
memset(ohci, 0, sizeof(*ohci));
ohci->irq = -1;
ohci->regs = mem_base;
INIT_LIST_HEAD(&ohci->interrupt_list);
bus = kmalloc(sizeof(*bus), GFP_KERNEL);
if (!bus)
return NULL;
memset(bus, 0, sizeof(*bus));
ohci->bus = bus;
bus->hcpriv = ohci;
bus->op = &ohci_device_operations;
/*
* Allocate the USB device structure and root hub.
*
* Here we allocate our own root hub and TDs as well as the
* OHCI host controller communications area. The HCCA is just
* a nice pool of memory with pointers to endpoint descriptors
* for the different interrupts.
*/
usb = ohci_usb_allocate(NULL);
if (!usb)
return NULL;
dev = ohci->root_hub = usb_to_ohci(usb);
usb->bus = bus;
/* Initialize the root hub */
dev->ohci = ohci; /* link back to the controller */
/*
* Allocate the Host Controller Communications Area on a 256
* byte boundary. XXX take the easy way out and just grab a
* page as that's guaranteed to have a nice boundary.
*/
dev->hcca = (struct ohci_hcca *) __get_free_page(GFP_KERNEL);
/* Tell the controller where the HCCA is */
writel(virt_to_bus(dev->hcca), &ohci->regs->hcca);
#if 0
printk(KERN_DEBUG "usb-ohci: HCCA allocated at %p (bus %p)\n", dev->hcca, (void*)virt_to_bus(dev->hcca));
#endif
/* Get the number of ports on the root hub */
usb->maxchild = readl(&ohci->regs->roothub.a) & 0xff;
if (usb->maxchild > MAX_ROOT_PORTS) {
printk("usb-ohci: Limited to %d ports\n", MAX_ROOT_PORTS);
usb->maxchild = MAX_ROOT_PORTS;
}
if (usb->maxchild < 1) {
printk("usb-ohci: Less than one root hub port? Impossible!\n");
usb->maxchild = 1;
}
printk("usb-ohci: %d root hub ports found\n", usb->maxchild);
/*
* Initialize the ED polling "tree" (for simplicity's sake in
* this driver many nodes in the tree will be identical)
*/
dev->ed[ED_INT_32].next_ed = virt_to_bus(&dev->ed[ED_INT_16]);
dev->ed[ED_INT_16].next_ed = virt_to_bus(&dev->ed[ED_INT_8]);
dev->ed[ED_INT_8].next_ed = virt_to_bus(&dev->ed[ED_INT_4]);
dev->ed[ED_INT_4].next_ed = virt_to_bus(&dev->ed[ED_INT_2]);
dev->ed[ED_INT_2].next_ed = virt_to_bus(&dev->ed[ED_INT_1]);
/*
* Initialize the polling table to call interrupts at the
* intended intervals.
*/
dev->hcca->int_table[0] = virt_to_bus(&dev->ed[ED_INT_32]);
for (i = 1; i < NUM_INTS; i++) {
if (i & 1)
dev->hcca->int_table[i] =
virt_to_bus(&dev->ed[ED_INT_16]);
else if (i & 2)
dev->hcca->int_table[i] =
virt_to_bus(&dev->ed[ED_INT_8]);
else if (i & 4)
dev->hcca->int_table[i] =
virt_to_bus(&dev->ed[ED_INT_4]);
else if (i & 8)
dev->hcca->int_table[i] =
virt_to_bus(&dev->ed[ED_INT_2]);
else if (i & 16)
dev->hcca->int_table[i] =
virt_to_bus(&dev->ed[ED_INT_1]);
}
/*
* Tell the controller where the control and bulk lists are
* The lists start out empty.
*/
writel(0, &ohci->regs->ed_controlhead);
writel(0, &ohci->regs->ed_bulkhead);
/*
writel(virt_to_bus(&dev->ed[ED_CONTROL]), &ohci->regs->ed_controlhead);
writel(virt_to_bus(&dev->ed[ED_BULK]), &ohci->regs->ed_bulkhead);
*/
#if 0
printk(KERN_DEBUG "alloc_ohci(): controller\n");
show_ohci_status(ohci);
#endif
#if 0
printk(KERN_DEBUG "leaving alloc_ohci %p\n", ohci);
#endif
return ohci;
} /* alloc_ohci() */
/*
* De-allocate all resoueces..
*/
static void release_ohci(struct ohci *ohci)
{
printk(KERN_DEBUG "entering release_ohci %p\n", ohci);
#ifdef OHCI_TIMER
/* stop our timer */
del_timer(&ohci_timer);
#endif
if (ohci->irq >= 0) {
free_irq(ohci->irq, ohci);
ohci->irq = -1;
}
/* stop all OHCI interrupts */
writel(~0x0, &ohci->regs->intrdisable);
if (ohci->root_hub) {
/* ensure that HC is stopped before releasing the HCCA */
writel(OHCI_USB_SUSPEND, &ohci->regs->control);
free_page((unsigned long) ohci->root_hub->hcca);
kfree(ohci->root_hub);
ohci->root_hub->hcca = NULL;
ohci->root_hub = NULL;
}
/* unmap the IO address space */
iounmap(ohci->regs);
kfree(ohci);
MOD_DEC_USE_COUNT;
/* If the ohci itself were dynamic we'd free it here */
printk(KERN_DEBUG "usb-ohci: HC resources released.\n");
} /* release_ohci() */
/*
* USB OHCI control thread
*/
static int ohci_control_thread(void * __ohci)
{
struct ohci *ohci = (struct ohci *)__ohci;
/*
* I'm unfamiliar with the SMP kernel locking.. where should
* this be released and what does it do? -greg
*/
lock_kernel();
/*
* This thread doesn't need any user-level access,
* so get rid of all of our resources..
*/
printk("ohci_control_thread code at %p\n", &ohci_control_thread);
exit_mm(current);
exit_files(current);
exit_fs(current);
strcpy(current->comm, "ohci-control");
/*
* Damn the torpedoes, full speed ahead
*/
if (start_hc(ohci) < 0) {
printk("usb-ohci: failed to start the controller\n");
release_ohci(ohci);
printk(KERN_DEBUG "leaving ohci_control_thread %p\n", __ohci);
return 0;
}
for(;;) {
siginfo_t info;
int unsigned long signr;
wait_ms(200);
/* check the root hub configuration for changes. */
ohci_check_configuration(ohci);
/* re-enable root hub status change interrupts. */
#if 0
writel(OHCI_INTR_RHSC, &ohci->regs->intrenable);
#endif
printk(KERN_DEBUG "ohci-control thread sleeping\n");
interruptible_sleep_on(&ohci_configure);
#ifdef CONFIG_APM
if (apm_resume) {
apm_resume = 0;
if (start_hc(ohci) < 0)
break;
continue;
}
#endif
/*
* If we were woken up by a signal, see if its useful,
* otherwise exit.
*/
if (signal_pending(current)) {
/* sending SIGUSR1 makes us print out some info */
spin_lock_irq(¤t->sigmask_lock);
signr = dequeue_signal(¤t->blocked, &info);
spin_unlock_irq(¤t->sigmask_lock);
if(signr == SIGUSR1) {
/* FIXME: have it do a full ed/td queue dump */
printk(KERN_DEBUG "OHCI status dump:\n");
show_ohci_status(ohci);
} else {
/* unknown signal, exit the thread */
break;
}
}
} /* for (;;) */
reset_hc(ohci);
release_ohci(ohci);
printk(KERN_DEBUG "leaving ohci_control_thread %p\n", __ohci);
return 0;
} /* ohci_control_thread() */
#ifdef CONFIG_APM
static int handle_apm_event(apm_event_t event)
{
static int down = 0;
switch (event) {
case APM_SYS_SUSPEND:
case APM_USER_SUSPEND:
if (down) {
printk(KERN_DEBUG "usb-ohci: received extra suspend event\n");
break;
}
down = 1;
break;
case APM_NORMAL_RESUME:
case APM_CRITICAL_RESUME:
if (!down) {
printk(KERN_DEBUG "usb-ohci: received bogus resume event\n");
break;
}
down = 0;
if (waitqueue_active(&ohci_configure)) {
apm_resume = 1;
wake_up(&ohci_configure);
}
break;
}
return 0;
} /* handle_apm_event() */
#endif
#ifdef OHCI_TIMER
/*
* Inspired by Iñaky's driver. This function is a timer routine that
* is called OHCI_TIMER_FREQ times per second. It polls the root hub
* for status changes as on my system things are acting a bit odd at
* the moment..
*/
static void ohci_timer_func (unsigned long ohci_ptr)
{
struct ohci *ohci = (struct ohci*)ohci_ptr;
ohci_root_hub_events(ohci);
/* press the snooze button... */
mod_timer(&ohci_timer, jiffies + (OHCI_TIMER_FREQ*HZ));
} /* ohci_timer_func() */
#endif
/*
* Increment the module usage count, start the control thread and
* return success if the controller is good.
*/
static int found_ohci(int irq, void* mem_base)
{
int retval;
struct ohci *ohci;
#if 0
printk(KERN_DEBUG "entering found_ohci %d %p\n", irq, mem_base);
#endif
/* Allocate the running OHCI structures */
ohci = alloc_ohci(mem_base);
if (!ohci) {
return -ENOMEM;
}
#ifdef OHCI_TIMER
init_timer(&ohci_timer);
ohci_timer.expires = jiffies + (OHCI_TIMER_FREQ*HZ);
ohci_timer.data = (unsigned long)ohci;
ohci_timer.function = ohci_timer_func;
#endif
retval = -EBUSY;
if (request_irq(irq, ohci_interrupt, SA_SHIRQ, "usb-ohci", ohci) == 0) {
int pid;
ohci->irq = irq;
#if 0
printk(KERN_DEBUG "usb-ohci: starting ohci-control thread\n");
#endif
/* fork off the handler */
pid = kernel_thread(ohci_control_thread, ohci,
CLONE_FS | CLONE_FILES | CLONE_SIGHAND);
if (pid >= 0) {
return 0;
}
retval = pid;
} else {
printk("usb-ohci: Couldn't allocate interrupt %d\n", irq);
}
release_ohci(ohci);
#if 0
printk(KERN_DEBUG "leaving found_ohci %d %p\n", irq, mem_base);
#endif
return retval;
} /* found_ohci() */
/*
* If this controller is for real, map the IO memory and proceed
*/
static int init_ohci(struct pci_dev *dev)
{
unsigned long mem_base = dev->base_address[0];
/* If its OHCI, its memory */
if (mem_base & PCI_BASE_ADDRESS_SPACE_IO)
return -ENODEV;
/* Get the memory address and map it for IO */
mem_base &= PCI_BASE_ADDRESS_MEM_MASK;
/* no interrupt won't work... */
if (dev->irq == 0) {
printk("usb-ohci: no irq assigned? check your BIOS settings.\n");
return -ENODEV;
}
/*
* FIXME ioremap_nocache isn't implemented on all CPUs (such
* as the Alpha) [?] What should I use instead...
*
* The iounmap() is done on in release_ohci.
*/
mem_base = (unsigned long) ioremap_nocache(mem_base, 4096);
if (!mem_base) {
printk("Error mapping OHCI memory\n");
return -EFAULT;
}
MOD_INC_USE_COUNT;
if (found_ohci(dev->irq, (void *) mem_base) < 0) {
MOD_DEC_USE_COUNT;
return -1;
}
return 0;
} /* init_ohci() */
#ifdef MODULE
/*
* Clean up when unloading the module
*/
void cleanup_module(void)
{
#ifdef CONFIG_APM
apm_unregister_callback(&handle_apm_event);
#endif
#ifdef CONFIG_USB_MOUSE
usb_mouse_cleanup();
#endif
printk("usb-ohci: module unloaded\n");
}
#define ohci_init init_module
#endif
/* TODO this should be named following Linux convention and go in pci.h */
#define PCI_CLASS_SERIAL_USB_OHCI ((PCI_CLASS_SERIAL_USB << 8) | 0x0010)
/*
* Search the PCI bus for an OHCI USB controller and set it up
*
* If anyone wants multiple controllers this will need to be
* updated.. Right now, it just picks the first one it finds.
*/
int ohci_init(void)
{
int retval;
struct pci_dev *dev = NULL;
/*u8 type;*/
if (sizeof(struct ohci_device) > 4096) {
printk("usb-ohci: struct ohci_device to large\n");
return -ENODEV;
}
printk("OHCI USB Driver loading\n");
retval = -ENODEV;
for (;;) {
/* Find an OHCI USB controller */
dev = pci_find_class(PCI_CLASS_SERIAL_USB_OHCI, dev);
if (!dev)
break;
/* Verify that its OpenHCI by checking for MMIO */
/* pci_read_config_byte(dev, PCI_CLASS_PROG, &type);
if (!type)
continue; */
/* Ok, set it up */
retval = init_ohci(dev);
if (retval < 0)
continue;
/* TODO check module params here to determine what to load */
#ifdef CONFIG_USB_MOUSE
usb_mouse_init();
#endif
#ifdef CONFIG_USB_KBD
usb_kbd_init();
#endif
hub_init();
#ifdef CONFIG_USB_AUDIO
usb_audio_init();
#endif
#ifdef CONFIG_APM
apm_register_callback(&handle_apm_event);
#endif
return 0; /* no error */
}
return retval;
} /* ohci_init */
/* vim:sw=8
*/
|