![[BACK]](/cvsweb/icons/back.gif){kind=icon}
Return to usb-enumerate.fs CVS log ![[TXT]](/cvsweb/icons/text.gif){kind=icon}
![[DIR]](/cvsweb/icons/dir.gif){kind=icon}
Up to [Qemu by Fabrice Bellard] / qemu / roms / SLOF / slof / fs / usb|
Return to usb-enumerate.fs CVS log | Up to [Qemu by Fabrice Bellard] / qemu / roms / SLOF / slof / fs / usb |
1.1 ! root 1: \ ***************************************************************************** ! 2: \ * Copyright (c) 2004, 2008 IBM Corporation ! 3: \ * All rights reserved. ! 4: \ * This program and the accompanying materials ! 5: \ * are made available under the terms of the BSD License ! 6: \ * which accompanies this distribution, and is available at ! 7: \ * http://www.opensource.org/licenses/bsd-license.php ! 8: \ * ! 9: \ * Contributors: ! 10: \ * IBM Corporation - initial implementation ! 11: \ ****************************************************************************/ ! 12: ! 13: ! 14: \ create the device tree for hub ! 15: ! 16: : (hub-create) ( -- ) ! 17: mps port-number new-device-address port-number ! 18: ( mps port-number usb-address port-number ) ! 19: new-device set-space ( mps port-number usb-address ) ! 20: encode-int s" USB-ADDRESS" property ( mps port-number ) ! 21: s" Address Set" usb-debug-print ! 22: encode-int s" reg" property ( mps ) ! 23: s" Port Number Set" usb-debug-print ! 24: encode-int s" MPS-DCP" property ! 25: s" MPS Set" usb-debug-print ! 26: s" usb-hub.fs" INCLUDED ! 27: s" Driver Included" usb-debug-print ! 28: finish-device ! 29: ; ! 30: ! 31: ! 32: \ encode properties for scsi or atapi device ! 33: ! 34: : (atapi-scsi-property-set) ( -- ) ! 35: dd-buffer @ e + c@ ( Manuf ) ! 36: dd-buffer @ f + c@ ( Manuf Prod ) ! 37: dd-buffer @ 10 + c@ ( Manuf Prod Serial-Num ) ! 38: cd-buffer @ 16 + w@-le ( Manuf Prod Serial-Num ep-mps ) ! 39: cd-buffer @ 14 + c@ ( Manuf Prod Serial-Num ep-mps ep-addr ) ! 40: cd-buffer @ 1d + w@-le ( Manuf Prod Serial-Num ep-mps ep-addr ep-mps ) ! 41: cd-buffer @ 1b + c@ ( Manuf Prod Serial-Num ep-mps ep-addr ep-mps ep-addr ) ! 42: mps port-number new-device-address port-number ! 43: ( Manuf Prod Serial-Num ep-mps ep-addr ep-mps ep-addr ! 44: mps port-num usb-addr port-num ) ! 45: new-device set-space ! 46: ( Manuf Prod Serial-Num ep-mps ep-addr ep-mps ep-addr ! 47: mps port-num usb-addr ) ! 48: encode-int s" USB-ADDRESS" property ! 49: ( Manuf Prod Serial-Num ep-mps ep-addr ep-mps ep-addr ! 50: mps port-num ) ! 51: encode-int s" reg" property ! 52: ( Manuf Prod Serial-Num ep-mps ep-addr ep-mps ep-addr ! 53: mps ) ! 54: encode-int s" MPS-DCP" property ! 55: ( Manuf Prod Serial-Num ep-mps ep-addr ep-mps ep-addr ) ! 56: 2 0 DO ! 57: dup 80 and IF ! 58: 7f and encode-int ! 59: s" BULK-IN-EP-ADDR" property ! 60: encode-int s" MPS-BULKIN" property ! 61: ELSE ! 62: encode-int s" BULK-OUT-EP-ADDR" property ! 63: encode-int s" MPS-BULKOUT" property ! 64: THEN ! 65: LOOP ( Manuf Prod Serial-Num ) ! 66: encode-int s" iSerialNumber" property ( Manuf Prod ) ! 67: encode-int s" iProduct" property ( Manuf ) ! 68: encode-int s" iManufacturer" property ! 69: ; ! 70: ! 71: ! 72: \ To classify device as hub/atapi/scsi/HID device ! 73: ! 74: : (device-classify) ! 75: ( -- Interface-protocol Interface-subclass Interface-class TRUE|FALSE ) ! 76: cd-buffer @ BULK-CONFIG-DESCRIPTOR-LEN erase ! 77: cd-buffer @ BULK-CONFIG-DESCRIPTOR-LEN mps new-device-address ! 78: ( buffer descp-len mps usb-address ) ! 79: control-std-get-configuration-descriptor ! 80: IF ! 81: cd-buffer @ 1+ c@ ( Descriptor-type ) ! 82: 2 = IF ! 83: cd-buffer @ 10 + c@ ( protocol ) ! 84: cd-buffer @ f + c@ ( protocol subclass ) ! 85: cd-buffer @ e + c@ ( protocol subclass class ) ! 86: TRUE ! 87: ELSE ! 88: s" Not a valid configuration descriptor!!" usb-debug-print ! 89: FALSE ! 90: THEN ! 91: ELSE ! 92: s" Unable to read configuration descriptor!!" usb-debug-print ! 93: FALSE ! 94: THEN ! 95: ; ! 96: ! 97: ! 98: \ create device tree for Atapi SFF-8020 device ! 99: ! 100: : (atapi-8020-create) ( -- ) ! 101: (atapi-scsi-property-set) ! 102: s" usb-storage.fs" INCLUDED ! 103: finish-device ! 104: ; ! 105: ! 106: \ create device tree for Atapi SFF-8070 device ! 107: ! 108: : (atapi-8070-create) ( -- ) ! 109: (atapi-scsi-property-set) ! 110: s" usb-storage.fs" INCLUDED ! 111: \ s" storage" device-name ! 112: finish-device ! 113: ; ! 114: ! 115: ! 116: \ create device tree for SCSI device ! 117: ! 118: : (scsi-create) ( -- ) ! 119: s" SCSI-CREATE " usb-debug-print ! 120: ! 121: \ *********************************************************************** ! 122: \ a problem was encountered on Media-Tray (REV-0): ! 123: \ The CDROM is connected to USB via an ATA/USB-Bridge (U38: CYPRESS CY7C68300) ! 124: \ The C-Revision of this chip has an malfunction which results in a ! 125: \ hanging IORD Signal at the ATA-Interface and so prevents from reading. ! 126: \ The B-Revision doesn't have this problem (populated on Media-Tray REV-5) ! 127: \ Two additional Mass-Storage-Resets are necessary to reset the ATA-Interface. ! 128: \ (see CYPRESS Application Notes to CY7C68300) ! 129: \ (see USB-Spec: 'Bulk-Only-Transport') ! 130: \ *********************************************************************** ! 131: \ a mounted ISO image (via USB) doesn't accept this bulk-reset-command! ! 132: \ *********************************************************************** ! 133: ! 134: dd-buffer @ 8 + w@-le 4b4 = \ VendorID = CYPRESS ? ! 135: IF ! 136: dd-buffer @ a + w@-le 6830 = \ Device = CY7C68300 ? ! 137: IF ! 138: \ here a Cypress ATA/USB Bridge is detected ! 139: d# 20 ms ! 140: mps new-device-address 0 0 0 ( MPS fun-addr dir data-buff data-len ) ! 141: control-bulk-reset ( TRUE|FALSE ) ! 142: d# 100 ms ! 143: mps new-device-address 0 0 0 ( TRUE|FALSE MPS fun-addr dir data-buff data-len ) ! 144: control-bulk-reset ( TRUE|FALSE TRUE|FALSE ) ! 145: and invert ! 146: IF ! 147: ." ** BULK-RESET failed **" cr ! 148: THEN ! 149: d# 20 ms ! 150: THEN ! 151: THEN ! 152: ! 153: 0 ch-buffer ! \ preset a clean response ! 154: mps new-device-address 0 ch-buffer 1 control-std-get-maxlun ( TRUE|FALSE ) ! 155: IF ! 156: \ s" GET-MAX-LUN IS WORKING :" usb-debug-print ! 157: \ ch-buffer 5 dump cr \ dump the responsed message ! 158: ELSE ! 159: s" ERROR in GET-MAX-LUN " usb-debug-print ! 160: 0 ch-buffer ! \ clear invalid numbers ! 161: cd-buffer @ 5 + c@ to temp1 ! 162: temp1 new-device-address control-std-set-configuration drop ! 163: THEN ! 164: \ FIXME: an IBM external HDD reported a number of 127 LUNs which could ! 165: \ not be set up. We need to understand how to set up the device ! 166: \ to report the correct number of LUNs. ! 167: \ The USB Massbulk Standard 1.0 defines a maximum of 15 mult. LUNs. ! 168: \ Workaround: Devices that might report a higher number are treated ! 169: \ as having exactly one LUN. Without this workaround the ! 170: \ USB scan hangs during the setup of non-available LUNs. ! 171: \ ! 172: \ Concerns: "FUJITSU MHV2040AT" (VendorID: 0x984 / DeviceID: 0x70) ! 173: \ ! 174: \ MR: This Device reports an invalid MaxLUN number within the first ! 175: \ three seconds after power-on or USB-Reset. The following loop repeats ! 176: \ the MaxLUN request up to 8 times until a valid ( <15 ) value is responded. ! 177: \ This can last up to four seconds as there is a delay of 500ms in every loop ! 178: ! 179: 0 ( counter ) ! 180: begin ! 181: dup 8 < ( counter flag ) \ max 8 * 500 ms ! 182: ch-buffer c@ f > ( counter flag flag ) \ is MuxLUN above limit ? ! 183: AND ( counter flag ) ! 184: while ! 185: d# 500 ms \ this device is not yet ready ! 186: 0 ch-buffer ! \ preset a clean response ! 187: mps new-device-address 0 ch-buffer 1 control-std-get-maxlun ( TRUE|FALSE ) ! 188: not ! 189: IF ! 190: s" ** ERROR in GET-MAX-LUN ** " usb-debug-print ! 191: drop 10 \ replace counter to force loop end ! 192: THEN ! 193: 1+ ( counter+1 ) ! 194: repeat ! 195: drop ! 196: ! 197: \ here is still the workaround to handle invalid MaxLUNs as '0' ! 198: \ ! 199: ch-buffer c@ dup 0= swap f > or IF ! 200: s" + LUN: " ch-buffer c@ usb-debug-print-val ! 201: (atapi-scsi-property-set) ! 202: s" usb-storage.fs" INCLUDED ! 203: finish-device ! 204: ! 205: ELSE ! 206: s" - LUN: " ch-buffer c@ usb-debug-print-val ! 207: (atapi-scsi-property-set) ! 208: s" usb-storage-wrapper.fs" INCLUDED ! 209: finish-device ! 210: ! 211: THEN ! 212: ; ! 213: ! 214: ! 215: \ Classify USB storage device by sub-class code ! 216: ! 217: : (classify-storage) ( interface-protocol interface-subclass -- ) ! 218: s" USB: Mass Storage Device Found!" usb-debug-print ! 219: swap 50 <> IF ! 220: s" USB storage: Protocol is not 50." usb-debug-print ! 221: drop EXIT ! 222: THEN ! 223: ( interface-subclass ) ! 224: CASE ! 225: 02 OF (atapi-8020-create) s" ATAPI Interface " usb-debug-print ENDOF ! 226: 05 OF (atapi-8070-create) s" ATAPI Interface " usb-debug-print ENDOF ! 227: 06 OF (scsi-create) s" SCSI Interface " usb-debug-print ENDOF ! 228: dup OF s" USB storage: Unsupported sub-class code." usb-debug-print ENDOF ! 229: ENDCASE ! 230: ; ! 231: ! 232: ! 233: \ create keyboard device tree ! 234: ! 235: : (keyboard-create) ( -- ) ! 236: cd-buffer @ 1f + c@ ( ep-mps ) ! 237: cd-buffer @ 1d + c@ ( ep-mps ep-addr ) ! 238: mps port-number new-device-address port-number ! 239: ( ep-mps ep-addr mps port-num usb-addr port-num ) ! 240: new-device set-space ( ep-mps ep-addr mps port-num usb-addr ) ! 241: encode-int s" USB-ADDRESS" property ( ep-mps ep-addr mps port-num ) ! 242: encode-int s" reg" property ( ep-mps ep-addr mps ) ! 243: encode-int s" MPS-DCP" property ( ep-mps ep-addr ) ! 244: 7f and encode-int s" INT-IN-EP-ADDR" property ! 245: encode-int s" MPS-INTIN" property ! 246: new-device-address \ device-speed ! 247: s" usb-keyboard.fs" INCLUDED ! 248: finish-device ! 249: ; ! 250: ! 251: : (mouse-create) ( -- ) ! 252: mps port-number new-device-address port-number ! 253: ( mps port-num usb-addr port-num ) ! 254: new-device set-space ( mps port-num usb-addr ) ! 255: encode-int s" USB-ADDRESS" property ( mps port-num ) ! 256: encode-int s" reg" property ( mps ) ! 257: encode-int s" MPS-DCP" property ! 258: s" usb-mouse.fs" INCLUDED ! 259: finish-device ! 260: ; ! 261: ! 262: ! 263: \ Classify by interface class code ! 264: ! 265: : (classify-by-interface) ( -- ) ! 266: (device-classify) IF ! 267: ( Interface-protocol Interface-subclass Interface-class ) ! 268: CASE ! 269: 08 OF ! 270: ( Interface-protocol Interface-subclass ) ! 271: (classify-storage) ! 272: ENDOF ! 273: 03 OF ! 274: ( Interface-protocol Interface-subclass ) ! 275: s" USB: HID Found!" usb-debug-print ! 276: 01 = ! 277: IF ! 278: case ! 279: 01 of ! 280: s" USB keyboard!" usb-debug-print ! 281: (keyboard-create) ! 282: endof ! 283: 02 of ! 284: s" USB mouse!" usb-debug-print ! 285: (mouse-create) ! 286: endof ! 287: dup of ! 288: s" USB: unsupported HID!" usb-debug-print ! 289: endof ! 290: endcase ! 291: ELSE ! 292: s" USB: unsupported HID!" usb-debug-print ! 293: THEN ! 294: ENDOF ! 295: dup OF ! 296: ( Interface-protocol Interface-subclass ) ! 297: s" USB: unsupported interface type." usb-debug-print ! 298: 2drop ! 299: ENDOF ! 300: ENDCASE ! 301: THEN ! 302: ; ! 303: ! 304: ! 305: \ create usb device tree depending upon classification of the device ! 306: \ after encoding apt properties ! 307: ! 308: : create-usb-device-tree ( -- ) ! 309: dd-buffer @ DEVICE-DESCRIPTOR-DEVCLASS-OFFSET + c@ ( Device-class ) ! 310: CASE ! 311: HUB-DEVICE-CLASS OF s" USB: HUB found" usb-debug-print ! 312: (hub-create) ! 313: ENDOF ! 314: NO-CLASS OF ! 315: \ In this case, the INTERFACE descriptor ! 316: \ tells you whats what -- Refer USB spec. ! 317: (classify-by-interface) ! 318: ENDOF ! 319: DUP OF ! 320: s" USB: Unknown device found." usb-debug-print ! 321: ENDOF ! 322: ENDCASE ! 323: uDOC-present 0f and to uDOC-present \ remove uDOC processing flag ! 324: ;
This archive runs on limited infrastructure. Preserving old code on modern bandwidth. Automated agents are requested to crawl responsibly.