;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;; ;; ;; ;; Copyright (C) KolibriOS team 2004-2007. All rights reserved. ;; ;; Distributed under terms of the GNU General Public License ;; ;; ;; ;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;; ;driver sceletone format MS COFF API_VERSION equ 0 ;debug include '../proc32.inc' include '../imports.inc' include 'urb.inc' struc UHCI { .bus dd ? .devfn dd ? .io_base dd ? .mm_base dd ? .irq dd ? .flags dd ? .reset dd ? .start dd ? .stop dd ? .port_c_suspend dd ? .resuming_ports dd ? .rh_state dd ? .rh_numports dd ? .is_stopped dd ? .dead dd ? .sizeof: } virtual at 0 UHCI UHCI end virtual struc IOCTL { .handle dd ? .io_code dd ? .input dd ? .inp_size dd ? .output dd ? .out_size dd ? } virtual at 0 IOCTL IOCTL end virtual struc TD ;transfer descriptor { .link dd ? .status dd ? .token dd ? .buffer dd ? .addr dd ? .frame dd ? .fd dd ? .bk dd ? .sizeof: } virtual at 0 TD TD end virtual public START public service_proc public version DEBUG equ 1 DRV_ENTRY equ 1 DRV_EXIT equ -1 STRIDE equ 4 ;size of row in devices table SRV_GETVERSION equ 0 section '.flat' code readable align 16 proc START stdcall, state:dword cmp [state], 1 jne .exit .entry: if DEBUG mov esi, msgInit call SysMsgBoardStr end if call init stdcall RegService, my_service, service_proc ret .fail: .exit: xor eax, eax ret endp handle equ IOCTL.handle io_code equ IOCTL.io_code input equ IOCTL.input inp_size equ IOCTL.inp_size output equ IOCTL.output out_size equ IOCTL.out_size align 4 proc service_proc stdcall, ioctl:dword mov ebx, [ioctl] mov eax, [ebx+io_code] cmp eax, SRV_GETVERSION jne @F mov eax, [ebx+output] cmp [ebx+out_size], 4 jne .fail mov [eax], dword API_VERSION xor eax, eax ret @@: .fail: or eax, -1 ret endp restore handle restore io_code restore input restore inp_size restore output restore out_size align 4 proc detect locals last_bus dd ? bus dd ? devfn dd ? endl xor eax, eax mov [bus], eax inc eax call PciApi cmp eax, -1 je .err mov [last_bus], eax .next_bus: and [devfn], 0 .next_dev: stdcall PciRead32, [bus], [devfn], dword 0 test eax, eax jz .next cmp eax, -1 je .next mov edi, devices @@: mov ebx, [edi] test ebx, ebx jz .next cmp eax, ebx je .found add edi, STRIDE jmp @B .next: inc [devfn] cmp [devfn], 256 jb .next_dev mov eax, [bus] inc eax mov [bus], eax cmp eax, [last_bus] jna .next_bus xor eax, eax ret .found: mov eax, UHCI.sizeof call Kmalloc test eax, eax jz .mem_fail mov ebx, [bus] mov [eax+UHCI.bus], ebx mov ecx, [devfn] mov [eax+UHCI.devfn], ecx ret .mem_fail: if DEBUG mov esi, msgMemFail call SysMsgBoardStr end if .err: xor eax, eax ret endp PCI_BASE equ 0x20 USB_LEGKEY equ 0xC0 align 4 proc init locals uhci dd ? endl call detect test eax, eax jz .fail mov [uhci], eax stdcall PciRead32, [eax+UHCI.bus], [eax+UHCI.devfn], PCI_BASE and eax, 0xFFC0 mov esi, [uhci] mov [esi+UHCI.io_base], eax stdcall uhci_reset, esi stdcall finish_reset, [uhci] .fail: if DEBUG mov esi, msgDevNotFound call SysMsgBoardStr end if ret endp UHCI_USBINTR equ 4 ; interrupt register UHCI_USBLEGSUP_RWC equ 0x8f00 ; the R/WC bits UHCI_USBLEGSUP_RO equ 0x5040 ; R/O and reserved bits UHCI_USBCMD_RUN equ 0x0001 ; RUN/STOP bit UHCI_USBCMD_HCRESET equ 0x0002 ; Host Controller reset UHCI_USBCMD_EGSM equ 0x0008 ; Global Suspend Mode UHCI_USBCMD_CONFIGURE equ 0x0040 ; Config Flag UHCI_USBINTR_RESUME equ 0x0002 ; Resume interrupt enable PORTSC0 equ 0x10 PORTSC1 equ 0x12 UHCI_RH_RESET equ 0 UHCI_RH_SUSPENDED equ 1 UHCI_RH_AUTO_STOPPED equ 2 UHCI_RH_RESUMING equ 3 ; In this state the HC changes from running to halted ; so it can legally appear either way. UHCI_RH_SUSPENDING equ 4 ; In the following states it's an error if the HC is halted. ; These two must come last. UHCI_RH_RUNNING equ 5 ; The normal state UHCI_RH_RUNNING_NODEVS equ 6 ; Running with no devices UHCI_IS_STOPPED equ 9999 align 4 proc uhci_reset stdcall, uhci:dword mov esi, [uhci] stdcall PciRead16, [esi+UHCI.bus], [esi+UHCI.devfn], USB_LEGKEY test eax, not (UHCI_USBLEGSUP_RO or UHCI_USBLEGSUP_RWC) jnz .reset mov edx, [esi+UHCI.io_base] in ax, dx test ax, UHCI_USBCMD_RUN jnz .reset test ax, UHCI_USBCMD_CONFIGURE jz .reset test ax, UHCI_USBCMD_EGSM jz .reset add edx, UHCI_USBINTR in ax, dx test ax, not UHCI_USBINTR_RESUME jnz .reset ret .reset: stdcall PciWrite16, [esi+UHCI.bus], [esi+UHCI.devfn], USB_LEGKEY, UHCI_USBLEGSUP_RWC mov edx, [esi+UHCI.io_base] mov ax, UHCI_USBCMD_HCRESET out dx, ax xor eax, eax out dx, ax add edx, UHCI_USBINTR out dx, ax ret endp proc finish_reset stdcall, uhci:dword mov esi, [uhci] mov edx, [esi+UHCI.io_base] add edx, PORTSC0 xor eax, eax out dx, ax add edx, (PORTSC1-PORTSC0) out dx, ax mov [esi+UHCI.port_c_suspend], eax mov [esi+UHCI.resuming_ports], eax mov [esi+UHCI.rh_state], UHCI_RH_RESET mov [esi+UHCI.rh_numports], 2 mov [esi+UHCI.is_stopped], UHCI_IS_STOPPED ; mov [ uhci_to_hcd(uhci)->state = HC_STATE_HALT; ; uhci_to_hcd(uhci)->poll_rh = 0; mov [esi+UHCI.dead], eax ; Full reset resurrects the controller ret endp proc insert_td stdcall, td:dword, frame:dword mov edi, [td] mov eax, [frame] and eax, -1024 mov [edi+TD.frame], eax mov ebx, [framelist] mov edx, [dma_framelist] shl eax, 5 mov ecx, [eax+ebx] test ecx, ecx jz .empty mov ecx, [ecx+TD.bk] ;last TD mov edx, [ecx+TD.fd] mov [edi+TD.fd], edx mov [edi+TD.bk], ecx mov [ecx+TD.fd], edi mov [edx+TD.bk], edi mov eax, [ecx+TD.link] mov [edi+TD.link], eax mov ebx, [edi+TD.addr] mov [ecx+TD.link], ebx ret .empty: mov ecx, [eax+edx] mov [edi+TD.link], ecx mov [ebx+eax], edi mov ecx, [edi+TD.addr] mov [eax+edx], ecx ret endp align 4 proc usb_get_descriptor stdcall, dev:dword, type:dword, index:dword,\ buf:dword, size:dword locals count dd ? endl mov esi, [buf] mov ecx, [size] xor eax, eax cld rep stosb mov [count], 3 @@: mov eax, [type] shl eax, 8 add eax, [index] stdcall usb_control_msg, [dev],pipe,USB_REQ_GET_DESCRIPTOR,\ USB_DIR_IN, eax,0,[buf], [size],\ USB_CTRL_GET_TIMEOUT test eax, eax jz .next cmp eax, -1 je .next jmp. ok .next: dec [count] jnz @B mov eax, -1 .ok: ret endp DEVICE_ID equ 0x24D2 ; pci device id VENDOR_ID equ 0x8086 ; device vendor id QEMU_USB equ 0x7020 ;all initialized data place here align 4 devices dd (DEVICE_ID shl 16)+VENDOR_ID dd (QEMU_USB shl 16)+VENDOR_ID dd 0 ;terminator version dd (5 shl 16) or (API_VERSION and 0xFFFF) my_service db 'UHCI',0 ;max 16 chars include zero msgInit db 'detect hardware...',13,10,0 msgPCI db 'PCI accsess not supported',13,10,0 msgDevNotFound db 'device not found',13,10,0 msgMemFail db 'Kmalloc failed', 10,10,0 ;msgFail db 'device not found',13,10,0 section '.data' data readable writable align 16 ;all uninitialized data place here