WebSVN – Kolibri OS – Diff – /drivers/usb/usbftdi/usbftdi.asm

 ;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;
 ;;                                                              ;;
 ;; Copyright (C) KolibriOS team 2004-2014. All rights reserved. ;;
 ;; Distributed under terms of the GNU General Public License    ;;
 ;;                                                              ;;
 ;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;
 format MS COFF
 DEBUG = 1
 __DEBUG__ = 1
 __DEBUG_LEVEL__ = 1
 node equ ftdi_context
 node.next equ ftdi_context.next_context
 include '../../proc32.inc'
 include '../../imports.inc'
 include '../../fdo.inc'
 include '../../struct.inc'
 public START
 public version
 ; USB constants
 DEVICE_DESCR_TYPE           = 1
 CONFIG_DESCR_TYPE           = 2
 STRING_DESCR_TYPE           = 3
 INTERFACE_DESCR_TYPE        = 4
 ENDPOINT_DESCR_TYPE         = 5
 DEVICE_QUALIFIER_DESCR_TYPE = 6
 CONTROL_PIPE     = 0
 ISOCHRONOUS_PIPE = 1
 BULK_PIPE        = 2
 INTERRUPT_PIPE   = 3
 ; USB HID constants
 HID_DESCR_TYPE      = 21h
 REPORT_DESCR_TYPE   = 22h
 PHYSICAL_DESCR_TYPE = 23h
 ; LibUSB constatnts
 LIBUSB_REQUEST_TYPE_STANDARD = (0x00 shl 5)
 LIBUSB_REQUEST_TYPE_CLASS = (0x01 shl 5)
 LIBUSB_REQUEST_TYPE_VENDOR = (0x02 shl 5)
 LIBUSB_REQUEST_TYPE_RESERVED = (0x03 shl 5)
 LIBUSB_RECIPIENT_DEVICE = 0x00
 LIBUSB_RECIPIENT_INTERFACE = 0x01
 LIBUSB_RECIPIENT_ENDPOINT = 0x02
 LIBUSB_RECIPIENT_OTHER = 0x03
 LIBUSB_ENDPOINT_IN = 0x80
 LIBUSB_ENDPOINT_OUT = 0x00
 ; FTDI Constants
 FTDI_DEVICE_OUT_REQTYPE = (LIBUSB_REQUEST_TYPE_VENDOR or LIBUSB_RECIPIENT_DEVICE or LIBUSB_ENDPOINT_OUT)
 FTDI_DEVICE_IN_REQTYPE = (LIBUSB_REQUEST_TYPE_VENDOR or LIBUSB_RECIPIENT_DEVICE or LIBUSB_ENDPOINT_IN)
 ; Requests
 ;Definitions for flow control
 SIO_RESET         =0  ;Reset the port
 SIO_MODEM_CTRL    =1  ;Set the modem control register
 SIO_SET_FLOW_CTRL =2  ;Set flow control register
 SIO_SET_BAUD_RATE =3  ;Set baud rate
 SIO_SET_DATA      =4  ;Set the data characteristics of the port
 SIO_RESET_REQUEST            =SIO_RESET
 SIO_SET_BAUDRATE_REQUEST     =SIO_SET_BAUD_RATE
 SIO_SET_DATA_REQUEST         =SIO_SET_DATA
 SIO_SET_FLOW_CTRL_REQUEST    =SIO_SET_FLOW_CTRL
 SIO_SET_MODEM_CTRL_REQUEST   =SIO_MODEM_CTRL
 SIO_POLL_MODEM_STATUS_REQUEST=0x05
 SIO_SET_EVENT_CHAR_REQUEST   =0x06
 SIO_SET_ERROR_CHAR_REQUEST   =0x07
 SIO_SET_LATENCY_TIMER_REQUEST=0x09
 SIO_GET_LATENCY_TIMER_REQUEST=0x0A
 SIO_SET_BITMODE_REQUEST      =0x0B
 SIO_READ_PINS_REQUEST        =0x0C
 SIO_READ_EEPROM_REQUEST      =0x90
 SIO_WRITE_EEPROM_REQUEST     =0x91
 SIO_ERASE_EEPROM_REQUEST     =0x92
 SIO_RESET_SIO=0
 SIO_RESET_PURGE_RX=1
 SIO_RESET_PURGE_TX=2
 SIO_DISABLE_FLOW_CTRL=0x0
 SIO_RTS_CTS_HS =(0x1 shl 8)
 SIO_DTR_DSR_HS =(0x2 shl 8)
 SIO_XON_XOFF_HS=(0x4 shl 8)
 SIO_SET_DTR_MASK=0x1
 SIO_SET_DTR_HIGH=( 1 or ( SIO_SET_DTR_MASK  shl 8))
 SIO_SET_DTR_LOW =( 0 or ( SIO_SET_DTR_MASK  shl 8))
 SIO_SET_RTS_MASK=0x2
 SIO_SET_RTS_HIGH=( 2 or ( SIO_SET_RTS_MASK shl 8 ))
 SIO_SET_RTS_LOW =( 0 or ( SIO_SET_RTS_MASK shl 8 ))
 SIO_RTS_CTS_HS =(0x1 shl 8)
 ;FTDI chip type
 TYPE_AM=0
 TYPE_BM=1
 TYPE_2232C=2
 TYPE_R=3
 TYPE_2232H=4
 TYPE_4232H=5
 TYPE_232H=6
 TYPE_230X=7
 ;strings
 my_driver       db      'usbother',0
 nomemory_msg    db      'K : no memory',13,10,0
 ; Structures
 struct ftdi_context
 chipType                db      ?
 baudrate                dd      ?
 bitbangEnabled          db      ?
 readBufChunkSize        dd      ?
 writeBufChunkSize       dd      ?
+maxPacketSize           dd      ?
 interface               dd      ?
 index                   dd      ?
 inEP                    dd      ?
 outEP                   dd      ?
 nullP                   dd      ?
 lockPID                 dd      ?
 next_context            dd      ?
 ends
 struct IOCTL
 handle                  dd      ?
 io_code                 dd      ?
 input                   dd      ?
 inp_size                dd      ?
 output                  dd      ?
 out_size                dd      ?
 ends
 struct usb_descr
 bLength                 db      ?
 bDescriptorType         db      ?
 bcdUSB                  dw      ?
 bDeviceClass            db      ?
 bDeviceSubClass         db      ?
 bDeviceProtocol         db      ?
 bMaxPacketSize0         db      ?
 idVendor                dw      ?
 idProduct               dw      ?
 bcdDevice               dw      ?
 iManufacturer           db      ?
 iProduct                db      ?
 iSerialNumber           db      ?
 bNumConfigurations      db      ?
 ends
 struct conf_packet
 bmRequestType           db      ?
 bRequest                db      ?
 wValue                  dw      ?
 wIndex                  dw      ?
 wLength                 dw      ?
 ends
 section '.flat' code readable align 16
 ; The start procedure.
 proc START stdcall, .reason:DWORD
         xor     eax, eax        ; initialize return value
         cmp     [.reason], 1    ; compare the argument
         jnz     .nothing
         stdcall RegUSBDriver, my_driver, service_proc, usb_functions
 .nothing:
         ret
 endp
-proc AddDevice stdcall uses ebx esi, .config_pipe:DWORD, .config_descr:DWORD, .interface:DWORD
+proc AddDevice stdcall uses ebx esi edi, .config_pipe:DWORD, .config_descr:DWORD, .interface:DWORD
         stdcall USBGetParam, [.config_pipe], 0
         mov     edx, eax
-        DEBUGF 1,'K : Device detected Vendor: %x\n', [eax+usb_descr.idVendor]
+        DEBUGF 1,'K : Detected device vendor: %x\n', [eax+usb_descr.idVendor]
         cmp     word[eax+usb_descr.idVendor], 0x0403
         jnz     .notftdi
-        DEBUGF 1,'K : FTDI USB device detected\n'
         movi    eax, sizeof.ftdi_context
         call    Kmalloc
         test    eax, eax
         jnz     @f
         mov     esi, nomemory_msg
         call    SysMsgBoardStr
         jmp     .nothing
   @@:
         DEBUGF 1,'K : Adding struct to list %x\n', eax
         call    linkedlist_add
         mov     ebx, [.config_pipe]
         mov     [eax + ftdi_context.nullP], ebx
         mov     [eax + ftdi_context.index], 0
         mov     [eax + ftdi_context.lockPID], 0
+        mov     [eax + ftdi_context.maxPacketSize], 64
         mov     [eax + ftdi_context.readBufChunkSize], 64
         mov     [eax + ftdi_context.writeBufChunkSize], 64
+        mov     cx, [edx+usb_descr.bcdDevice]
-        cmp     [edx+usb_descr.bcdDevice], 0x400
+        cmp     cx, 0x400
         jnz     @f
+        mov     [eax + ftdi_context.chipType], TYPE_BM
-        mov     [eax + ftdi_context.chipType], TYPE_BM
+        jmp     .slow
   @@:
-        cmp     [edx+usb_descr.bcdDevice], 0x200
+        cmp     cx, 0x200
         jnz     @f
+        mov     [eax + ftdi_context.chipType], TYPE_AM
-        mov     [eax + ftdi_context.chipType], TYPE_AM
+        jmp     .slow
   @@:
-        cmp     [edx+usb_descr.bcdDevice], 0x500
+        cmp     cx, 0x500
         jnz     @f
+        mov     [eax + ftdi_context.chipType], TYPE_2232C
-        mov     [eax + ftdi_context.chipType], TYPE_2232C
+        jmp     .slow
   @@:
-        cmp     [edx+usb_descr.bcdDevice], 0x600
+        cmp     cx, 0x600
         jnz     @f
+        mov     [eax + ftdi_context.chipType], TYPE_R
-        mov     [eax + ftdi_context.chipType], TYPE_R
+        jmp     .slow
   @@:
-        cmp     [edx+usb_descr.bcdDevice], 0x700
+        cmp     cx, 0x700
         jnz     @f
+        mov     [eax + ftdi_context.chipType], TYPE_2232H
-        mov     [eax + ftdi_context.chipType], TYPE_2232H
+        jmp     .fast
   @@:
-        cmp     [edx+usb_descr.bcdDevice], 0x900
+        cmp     cx, 0x900
         jnz     @f
+        mov     [eax + ftdi_context.chipType], TYPE_232H
-        mov     [eax + ftdi_context.chipType], TYPE_232H
+        jmp     .fast
   @@:
-        cmp     [edx+usb_descr.bcdDevice], 0x1000
+        cmp     cx, 0x1000
-        jnz     @f
+        jnz     .slow
-        mov     [eax + ftdi_context.chipType], TYPE_BM
+        mov     [eax + ftdi_context.chipType], TYPE_230X
-  @@:
+        jmp     .fast
+  .fast:
+        add     [eax + ftdi_context.maxPacketSize], 512-64
-        DEBUGF 1,'K : Open first pipe\n'
+  .slow:
         mov     ebx, eax
+        stdcall USBOpenPipe, [.config_pipe],  0x81,  [ebx + ftdi_context.maxPacketSize],  BULK_PIPE, 0
+        test    eax, eax
-        stdcall USBOpenPipe, [.config_pipe],  0x81,  0x40,  BULK_PIPE, 0
+        jz      .nothing
+        mov     [ebx + ftdi_context.inEP], eax
-        mov     [ebx + ftdi_context.inEP], eax
+        stdcall USBOpenPipe, [.config_pipe],  0x02,  [ebx + ftdi_context.maxPacketSize],  BULK_PIPE, 0
-        DEBUGF 1,'K : Open second pipe\n'
+        test    eax, eax
-        stdcall USBOpenPipe, [.config_pipe],  0x02,  0x40,  BULK_PIPE, 0
+        jz      .nothing
         mov     [ebx + ftdi_context.outEP], eax
         mov     eax, ebx
         ret
   .notftdi:
         DEBUGF 1,'K : Skipping not FTDI device\n'
   .nothing:
         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 uses ebx esi edi, ioctl:DWORD
 locals
 ConfPacket  rb  8
 EventData   rd  3
 endl
         mov     edi, [ioctl]
         mov     eax, [edi+io_code]
         DEBUGF 1,'K : FTDI got the request: %d\n', eax
         test    eax, eax           ;0
         jz      .version
         dec     eax                 ;1
         jz      .ftdi_get_list
         push    eax
         mov     esi, [edi+input]
         mov     eax, [esi+4]
         call    linkedlist_isvalid
         test    eax, eax
         pop     eax
         jnz     .endswitch
         dec     eax
         jz      .ftdi_lock      ;2
         dec     eax
         jz      .ftdi_unlock    ;3
         mov     ebx, [esi+4]
         mov     ecx, [ebx + ftdi_context.lockPID]
         cmp     ecx, [esi]
         jz      .pid_ok
         mov     esi, [edi+output]
         mov     dword[esi], 'LCKD'
         jmp     .endswitch
   .pid_ok:
+        dec     eax
+        jz      .ftdi_get_wchunksize    ;5
+        dec     eax
+        jz      .ftdi_get_rchunksize    ;7
+        mov     edi, [edi+input]
+        dec     eax
+        jz      .ftdi_set_rchunksize    ;6
+        dec     eax
+        jz      .ftdi_set_wchunksize    ;4
         push    eax edi
         mov     ecx, 0x80000000
         cmp     eax, 17
-        je     .bulkevent
+        je      .bulkevent
         cmp     eax, 18
         je      .bulkevent
         xor     ecx, ecx
   .bulkevent:
         xor     esi, esi
         call    CreateEvent
         mov     [EventData], eax
         mov     [EventData+4], edx
         pop     edi eax
-        dec     eax                 ;4
+        dec     eax                 ;8
         jz      .ftdi_set_bitmode
-        dec     eax                 ;5
+        dec     eax                 ;9
         jz      .ftdi_setrtshigh
-        dec     eax                 ;6
+        dec     eax                 ;10
         jz      .ftdi_setrtslow
-        dec     eax                 ;7
+        dec     eax                 ;11
         jz      .ftdi_setdtrhigh
-        dec     eax                 ;8
+        dec     eax                 ;12
         jz      .ftdi_setdtrlow
-        dec     eax                 ;9
+        dec     eax                 ;13
         jz      .ftdi_usb_reset
-        dec     eax                 ;10
+        dec     eax                 ;14
         jz      .ftdi_setflowctrl
-        dec     eax                 ;11
+        dec     eax                 ;15
         jz      .ftdi_set_event_char
-        dec     eax                 ;12
+        dec     eax                 ;16
         jz      .ftdi_set_error_char
-        dec     eax                 ;13
+        dec     eax                 ;17
         jz      .ftdi_set_latency_timer
-        dec     eax                 ;14
+        dec     eax                 ;18
         jz      .ftdi_get_latency_timer
-        dec     eax                 ;15
+        dec     eax                 ;19
         jz      .ftdi_read_pins
-        dec     eax                 ;16
+        dec     eax                 ;20
         jz      .ftdi_poll_modem_status
-        dec     eax                 ;17
+        dec     eax                 ;21
         jz      .ftdi_write_data
-        dec     eax                 ;18
+        dec     eax                 ;22
         jz      .ftdi_read_data
-        dec     eax                 ;19
+        dec     eax                 ;23
         jz      .ftdi_set_baudrate
-        dec     eax                 ;20
+        dec     eax                 ;24
         jz      .ftdi_set_line_property
-        dec     eax                 ;21
+        dec     eax                 ;25
         jz      .ftdi_purge_rx_buf
-        dec     eax                 ;22
+        dec     eax                 ;26
+        jz      .ftdi_purge_tx_buf
-        jz      .ftdi_purge_tx_buf
+        jmp     .error
+  .version:
+        jmp     .endswitch
+  .error:
+        mov     esi, [edi+output]
         mov     [esi], dword 'ERR0'
-  .version:
+        or      [esi], eax
   .endswitch:
         xor     eax, eax
 	    ret
+  .eventdestroy:
+        mov     eax, [EventData]
+        mov     ebx, [EventData+4]
+        call    DestroyEvent
+        jmp     .endswitch
+  .ftdi_out_control_transfer_withinp:
+        mov     dx, word[edi+8]
+        mov     word[ConfPacket+2], dx
-  .ftdi_out_control_transfer:
+  .ftdi_out_control_transfer_noinp:
-        mov     ebx, [edi]
+        mov     ebx, [edi+4]
         mov     cx, word[ebx + ftdi_context.index]
         mov     word[ConfPacket+4], cx
         xor     cx, cx
         mov     word[ConfPacket+6], cx
   .own_index:
-        mov    ebx, [edi+4]
+        mov     ebx, [edi+4]
         DEBUGF 1,'K : ConfPacket %x %x\n', [ConfPacket], [ConfPacket+4]
         lea     esi, [ConfPacket]
         lea     edi, [EventData]
         stdcall USBControlTransferAsync, [ebx + ftdi_context.nullP],  esi, 0, 0, control_callback, edi, 0
-        DEBUGF 1, 'K : Returned value is %d\n', eax
+        test    eax, eax
+        jz      .error
         mov     eax, [EventData]
         mov     ebx, [EventData+4]
         call    WaitEvent
         jmp     .endswitch
-  .ftdi_set_bitmode:
-        DEBUGF 1,'K : FTDI Seting bitmode\n'
-        mov     word[ConfPacket], (FTDI_DEVICE_OUT_REQTYPE) + (SIO_SET_BITMODE_REQUEST shl 8)
-        mov     edi, [edi+input]
-        mov     dx, word[edi+8]
-        mov     word[ConfPacket+2], dx
-        jmp     .ftdi_out_control_transfer
   .ftdi_setrtshigh:
         DEBUGF 1,'K : FTDI Setting RTS pin HIGH\n'
         mov     dword[ConfPacket], (FTDI_DEVICE_OUT_REQTYPE) + (SIO_SET_MODEM_CTRL_REQUEST shl 8) + (SIO_SET_RTS_HIGH shl 16)
-        jmp     .ftdi_out_control_transfer
+        jmp     .ftdi_out_control_transfer_noinp
   .ftdi_setrtslow:
         DEBUGF 1,'K : FTDI Setting RTS pin LOW\n'
         mov     dword[ConfPacket], (FTDI_DEVICE_OUT_REQTYPE) + (SIO_SET_MODEM_CTRL_REQUEST shl 8) + (SIO_SET_RTS_LOW shl 16)
-        jmp     .ftdi_out_control_transfer
+        jmp     .ftdi_out_control_transfer_noinp
   .ftdi_setdtrhigh:
         DEBUGF 1,'K : FTDI Setting DTR pin HIGH\n'
         mov     dword[ConfPacket], (FTDI_DEVICE_OUT_REQTYPE) + (SIO_SET_MODEM_CTRL_REQUEST shl 8) + (SIO_SET_DTR_HIGH shl 16)
-        jmp     .ftdi_out_control_transfer
+        jmp     .ftdi_out_control_transfer_noinp
   .ftdi_setdtrlow:
         DEBUGF 1,'K : FTDI Setting DTR pin LOW\n'
         mov     dword[ConfPacket], (FTDI_DEVICE_OUT_REQTYPE) + (SIO_SET_MODEM_CTRL_REQUEST shl 8) + (SIO_SET_DTR_LOW shl 16)
-        jmp     .ftdi_out_control_transfer
+        jmp     .ftdi_out_control_transfer_noinp
   .ftdi_usb_reset:
         DEBUGF 1,'K : FTDI Reseting\n'
         mov     dword[ConfPacket], (FTDI_DEVICE_OUT_REQTYPE) + (SIO_RESET_REQUEST shl 8) + (SIO_RESET_SIO shl 16)
-        jmp     .ftdi_out_control_transfer
+        jmp     .ftdi_out_control_transfer_noinp
   .ftdi_purge_rx_buf:
         mov     dword[ConfPacket], (FTDI_DEVICE_OUT_REQTYPE) + (SIO_RESET_REQUEST shl 8) + (SIO_RESET_PURGE_RX shl 16)
-        jmp     .ftdi_out_control_transfer
+        jmp     .ftdi_out_control_transfer_noinp
   .ftdi_purge_tx_buf:
         mov     dword[ConfPacket], (FTDI_DEVICE_OUT_REQTYPE) + (SIO_RESET_REQUEST shl 8) + (SIO_RESET_PURGE_TX shl 16)
-        jmp     .ftdi_out_control_transfer
+        jmp     .ftdi_out_control_transfer_noinp
-H_CLK = 120000000
-C_CLK = 48000000
-  .ftdi_set_baudrate:
-        mov     edi, [edi+input]
-        mov     ebx, [edi]
-        cmp     [ebx + ftdi_context.chipType], TYPE_2232H
-        jl      .c_clk
-        imul    eax, [edi+8], 10
-        cmp     eax, H_CLK / 0x3FFF
-        jle     .c_clk
-  .h_clk:
-        cmp     dword[edi+8], H_CLK/10
-        jl      .h_nextbaud1
-        xor     edx, edx
-        mov     ecx, H_CLK/10
-        jmp     .calcend
-  .c_clk:
-        cmp     dword[edi+8], C_CLK/10
-        jl      .c_nextbaud1
-        xor     edx, edx
-        mov     ecx, C_CLK/10
-        jmp     .calcend
-  .h_nextbaud1:
-        cmp     dword[edi+8], H_CLK/(10 + 10/2)
-        jl      .h_nextbaud2
-        mov     edx, 1
-        mov     ecx, H_CLK/(10 + 10/2)
-        jmp     .calcend
-  .c_nextbaud1:
-        cmp     dword[edi+8], C_CLK/(10 + 10/2)
-        jl      .c_nextbaud2
-        mov     edx, 1
-        mov     ecx, C_CLK/(10 + 10/2)
-        jmp     .calcend
-  .h_nextbaud2:
-        cmp     dword[edi+8], H_CLK/(2*10)
-        jl      .h_nextbaud3
-        mov     edx, 2
-        mov     ecx, H_CLK/(2*10)
-        jmp     .calcend
-  .c_nextbaud2:
-        cmp     dword[edi+8], C_CLK/(2*10)
-        jl      .c_nextbaud3
-        mov     edx, 2
-        mov     ecx, C_CLK/(2*10)
-        jmp     .calcend
-  .h_nextbaud3:
-        mov     eax, H_CLK*16/10  ; eax - best_divisor
-        div     dword[edi+8]      ; [edi+8] - baudrate
-        push    eax
-        and     eax, 1
-        pop     eax
-        shr     eax, 1
-        jz      .h_rounddowndiv     ; jump by result of and eax, 1
-        inc     eax
-  .h_rounddowndiv:
-        cmp     eax, 0x20000
-        jle     .h_best_divok
-        mov     eax, 0x1FFFF
-  .h_best_divok:
-        mov     ecx, eax
-        mov     eax, H_CLK*16/10
-        div     ecx
-        xchg    ecx, eax            ; ecx - best_baud
-        push    ecx
-        and     ecx, 1
-        pop     ecx
-        shr     ecx, 1
-        jz      .rounddownbaud
-        inc     ecx
-        jmp     .rounddownbaud
-  .c_nextbaud3:
-        mov     eax, C_CLK*16/10  ; eax - best_divisor
-        div     dword[edi+8]      ; [edi+8] - baudrate
-        push    eax
-        and     eax, 1
-        pop     eax
-        shr     eax, 1
-        jz      .c_rounddowndiv     ; jump by result of and eax, 1
-        inc     eax
-  .c_rounddowndiv:
-        cmp     eax, 0x20000
-        jle     .c_best_divok
-        mov     eax, 0x1FFFF
-  .c_best_divok:
-        mov     ecx, eax
-        mov     eax, C_CLK*16/10
-        div     ecx
-        xchg    ecx, eax            ; ecx - best_baud
-        push    ecx
-        and     ecx, 1
-        pop     ecx
-        shr     ecx, 1
-        jz      .rounddownbaud
-        inc     ecx
-  .rounddownbaud:
-        mov     edx, eax            ; edx - encoded_divisor
-        shr     edx, 3
-        and     eax, 0x7
-        push    esp
-        push    7 6 5 1 4 2 3 0
-        mov     eax, [esp+eax*4]
-        shl     eax, 14
-        or      edx, eax
-        mov     esp, [esp+36]
-  .calcend:
-        mov     eax, edx        ; eax - *value
-        mov     ecx, edx        ; ecx - *index
-        and     eax, 0xFFFF
-        cmp     [ebx + ftdi_context.chipType], TYPE_2232H
-        jge     .foxyindex
-        shr     ecx, 16
-        jmp     .preparepacket
-  .foxyindex:
-        shr     ecx, 8
-        and     ecx, 0xFF00
-        or      ecx, [ebx + ftdi_context.index]
-  .preparepacket:
-        mov     word[ConfPacket], (FTDI_DEVICE_OUT_REQTYPE) + (SIO_SET_BAUDRATE_REQUEST shl 8)
+  .ftdi_set_bitmode:
-        mov     word[ConfPacket+2], ax
+        DEBUGF 1,'K : FTDI Seting bitmode\n'
-        mov     word[ConfPacket+4], cx
-        mov     word[ConfPacket+6], 0
+        mov     word[ConfPacket], (FTDI_DEVICE_OUT_REQTYPE) + (SIO_SET_BITMODE_REQUEST shl 8)
-        jmp     .own_index
+        jmp     .ftdi_out_control_transfer_withinp
   .ftdi_set_line_property:
         mov     word[ConfPacket], (FTDI_DEVICE_OUT_REQTYPE) + (SIO_SET_DATA_REQUEST shl 8)
-        mov     edi, [edi+input]
-        mov     dx, word[edi+8]
-        mov     word[ConfPacket+2], dx
-        jmp     .ftdi_out_control_transfer
+        jmp     .ftdi_out_control_transfer_withinp
   .ftdi_set_latency_timer:
         mov     word[ConfPacket], (FTDI_DEVICE_OUT_REQTYPE) + (SIO_SET_LATENCY_TIMER_REQUEST shl 8)
-        mov     edi, [edi+input]
-        mov     dx, word[edi+8]
-        mov     word[ConfPacket+2], dx
-        jmp     .ftdi_out_control_transfer
+        jmp     .ftdi_out_control_transfer_withinp
   .ftdi_set_event_char:
         mov     word[ConfPacket], (FTDI_DEVICE_OUT_REQTYPE) + (SIO_SET_EVENT_CHAR_REQUEST shl 8)
-        mov     edi, [edi+input]
-        mov     dx, word[edi+8]
-        mov     word[ConfPacket+2], dx
-        jmp     .ftdi_out_control_transfer
+        jmp     .ftdi_out_control_transfer_withinp
   .ftdi_set_error_char:
         mov     word[ConfPacket], (FTDI_DEVICE_OUT_REQTYPE) + (SIO_SET_ERROR_CHAR_REQUEST shl 8)
-        mov     edi, [edi+input]
-        mov     dx, word[edi+8]
-        mov     word[ConfPacket+2], dx
-        jmp     .ftdi_out_control_transfer
+        jmp     .ftdi_out_control_transfer_withinp
   .ftdi_setflowctrl:
         mov     dword[ConfPacket], (FTDI_DEVICE_OUT_REQTYPE) + (SIO_SET_FLOW_CTRL_REQUEST shl 8) + (0 shl 16)
-        mov     edi, [edi+input]
-        mov     ebx, [edi]
+        mov     ebx, [edi+4]
         mov     cx, word[edi+8]
         or      ecx, [ebx + ftdi_context.index]
         mov     word[ConfPacket+4], cx
         xor     cx, cx
         mov     word[ConfPacket+6], cx
         jmp     .own_index
   .ftdi_read_pins:
-        DEBUGF 1,'K : FTDI Reading pins\n'
-        mov     edi, [edi+input]
         mov     ebx, [edi]
         mov     dword[ConfPacket], FTDI_DEVICE_IN_REQTYPE + (SIO_READ_PINS_REQUEST shl 8) + (0 shl 16)
         mov     ecx, [ebx + ftdi_context.index]
         mov     word[ConfPacket+4], cx
         mov     word[ConfPacket+6], 1
         lea     esi, [ConfPacket]
         lea     edi, [EventData]
         mov     ecx, [ioctl]
         mov     ecx, [ecx+output]
         stdcall USBControlTransferAsync, [ebx + ftdi_context.nullP],  esi, ecx, 1, control_callback, edi, 0
-        DEBUGF 1, 'K : Returned value is %d\n', eax
         mov     eax, [EventData]
         mov     ebx, [EventData+4]
         call    WaitEvent
         jmp     .endswitch
+  .ftdi_set_wchunksize:
+        mov     ebx, [edi+4]
+        mov     ecx, [edi+8]
+        cmp     [ebx + ftdi_context.maxPacketSize], ecx
+        jg      .error
+        mov     [ebx + ftdi_context.writeBufChunkSize], ecx
+        jmp     .endswitch
+  .ftdi_get_wchunksize:
+        mov     esi, [edi+output]
+        mov     edi, [edi+input]
+        mov     ebx, [edi+4]
+        mov     ecx, [ebx + ftdi_context.writeBufChunkSize]
+        mov     [esi], ecx
+        jmp     .endswitch
+  .ftdi_set_rchunksize:
+        mov     ebx, [edi+4]
+        mov     ecx, [edi+8]
+        cmp     [ebx + ftdi_context.maxPacketSize], ecx
+        jg      .error
+        mov     [ebx + ftdi_context.readBufChunkSize], ecx
+        jmp     .endswitch
+  .ftdi_get_rchunksize:
-  .ftdi_write_data:
+        mov     esi, [edi+output]
         mov     edi, [edi+input]
+        mov     ebx, [edi+4]
+        mov     ecx, [ebx + ftdi_context.readBufChunkSize]
+        mov     [esi], ecx
+        jmp     .endswitch
+  .ftdi_write_data:
+        mov     esi, edi
+        add     esi, 12
         mov     ebx, [edi+4]
         xor     ecx, ecx        ; ecx - offset
-  .dataleft:
-        mov     edx, [ebx + ftdi_context.writeBufChunkSize] ; edx - write_size
-        push    ecx
-        add     ecx, edx
+  .write_loop:
-        cmp     ecx, [edi+8]    ; [edi+8] - size
-        pop     ecx
-        jle     .morethanchunk_write
-        mov     edx, [edi+8]
+        mov     edx, [edi+8]    ; edx - write_size
+        sub     edx, ecx
+        cmp     edx, [ebx + ftdi_context.writeBufChunkSize]
+        jle     .lessthanchunk_write
-        sub     edx, ecx
+        mov     edx, [ebx + ftdi_context.writeBufChunkSize]
+  .lessthanchunk_write:
-  .morethanchunk_write:
+        add     esi, ecx
+        lea     eax, [EventData]
-        lea     eax, [EventData]
+        push    ecx ebx esi edi
-        stdcall USBNormalTransferAsync, [ebx + ftdi_context.inEP], [edi+12+ecx], edx, bulk_callback, eax, 1
-        push    ebx edi edx ecx
+        stdcall USBNormalTransferAsync, [ebx + ftdi_context.inEP], esi, edx, bulk_callback, eax, 1
         mov     eax, [EventData]
         mov     ebx, [EventData+4]
         call    WaitEvent
+        mov     eax, [EventData]
+        mov     ebx, [EventData+4]
+        call    ClearEvent
-        pop     ecx edx edi ebx
+        pop     edi esi ebx ecx
         cmp     [EventData+8], -1
-        jz      .endswitch;jz      .error
+        jz .error
         add     ecx, [EventData+8]
         cmp     ecx, [edi+8]
-        jl      .dataleft
+        jge     .eventdestroy
-        jmp     .endswitch
+        jmp     .write_loop
+  .ftdi_read_data:
-  .ftdi_read_data:
+        mov     edi, [ioctl]
         mov     esi, [edi+input]
         mov     edi, [edi+output]
         mov     ebx, [esi+4]
         xor     ecx, ecx
   .read_loop:
         mov     edx, [esi+8]
+        cmp     ecx, edx
+        jge     .eventdestroy ;!!!
         sub     edx, ecx
-        test    edx, edx
-        jz      .endswitch
         cmp     edx, [ebx + ftdi_context.readBufChunkSize]
         jl      .lessthanchunk_read
         mov     edx, [ebx + ftdi_context.readBufChunkSize]
   .lessthanchunk_read:
         lea     eax, [EventData]
-        stdcall USBNormalTransferAsync, [ebx + ftdi_context.outEP], [edi+ecx], edx, bulk_callback, eax, 1
+        add     edi, ecx
         push    esi edi ecx ebx
+        stdcall USBNormalTransferAsync, [ebx + ftdi_context.outEP], edi, edx, bulk_callback, eax, 1
         mov     eax, [EventData]
         mov     ebx, [EventData+4]
         call    WaitEvent
+        mov     eax, [EventData]
+        mov     ebx, [EventData+4]
+        call    ClearEvent
         pop     ebx ecx edi esi
         cmp     [EventData+8], -1
-        jz      .endswitch;jz      .error
+        jz      .error
         add     ecx, [EventData+8]
         jmp     .read_loop
   .ftdi_poll_modem_status:
-        mov     edi, [edi+input]
         mov     ebx, [edi+4]
         mov     dword[ConfPacket], FTDI_DEVICE_IN_REQTYPE + (SIO_POLL_MODEM_STATUS_REQUEST shl 8) + (0 shl 16)
         mov     ecx, [ebx + ftdi_context.index]
         mov     word[ConfPacket+4], cx
         mov     word[ConfPacket+6], 1
         lea     esi, [ConfPacket]
         lea     edi, [EventData]
         mov     ecx, [ioctl]
         mov     ecx, [ecx+output]
         stdcall USBControlTransferAsync, [ebx + ftdi_context.nullP],  esi, ecx, 2, control_callback, edi, 0
-        DEBUGF 1, 'K : Returned value is %d\n', eax
         mov     eax, [EventData]
         mov     ebx, [EventData+4]
         call    WaitEvent
         mov     ax, word[ecx]
         xchg    ah, al
         and     ah, 0xFF
         mov     word[ecx], ax
         jmp     .endswitch
   .ftdi_get_latency_timer:
-        mov     edi, [edi+input]
         mov     ebx, [edi+4]
         mov     dword[ConfPacket], FTDI_DEVICE_IN_REQTYPE + (SIO_GET_LATENCY_TIMER_REQUEST shl 8) + (0 shl 16)
         mov     ecx, [ebx + ftdi_context.index]
         mov     word[ConfPacket+4], cx
         mov     word[ConfPacket+6], 1
         lea     esi, [ConfPacket]
         lea     edi, [EventData]
         mov     ecx, [ioctl]
         mov     ecx, [ecx+output]
         stdcall USBControlTransferAsync, [ebx + ftdi_context.nullP],  esi, ecx, 2, control_callback, edi, 0
-        DEBUGF 1, 'K : Returned value is %d\n', eax
         mov     eax, [EventData]
         mov     ebx, [EventData+4]
         call    WaitEvent
         jmp     .endswitch
   .ftdi_get_list:
         call    linkedlist_gethead
+        test    eax, eax
+        jz      .endswitch
         mov     edi, [edi+output]
         push    edi
         add     edi, 4
         xor     ecx, ecx
   .nextdev:
         inc     ecx
         cmp     [eax + ftdi_context.lockPID], 0
         jnz      .dev_is_locked
         mov     dword[edi], 'NLKD'
         jmp     .nextfields
   .dev_is_locked:
         mov     dword[edi], 'LCKD'
   .nextfields:
         mov     bl, [eax + ftdi_context.chipType]
         mov     [edi+4], ebx
         mov     [edi+8], eax
         add     edi, 12
         mov     eax, [eax + ftdi_context.next_context]
         test    eax, eax
         jnz     .nextdev
         pop     edi
         mov     [edi], ecx
         jmp     .endswitch
   .ftdi_lock:
         DEBUGF 1, 'K : FTDI lock attempt\n'
         mov     esi, [edi+input]
         mov     ebx, [esi+4]
         mov     eax, [ebx + ftdi_context.lockPID]
         test    eax, eax
         jnz     .lockedby
         DEBUGF 1, 'K : Lock success\n'
         mov     eax, [esi]
         mov     [ebx + ftdi_context.lockPID], eax
   .lockedby:
         mov     edi, [edi+output]
         mov     [edi], eax
         jmp     .endswitch
   .ftdi_unlock:
         mov     esi, [edi+input]
         mov     edi, [edi+output]
         mov     ebx, [esi+4]
         mov     eax, [ebx + ftdi_context.lockPID]
         cmp     eax, [esi]
         jnz     .unlockimp
         mov     [ebx + ftdi_context.lockPID], 0
         mov     dword[edi], 0
         jmp     .endswitch
   .unlockimp:
         mov     [edi], eax
         jmp     .endswitch
+H_CLK = 120000000
+C_CLK = 48000000
+  .ftdi_set_baudrate:
+        mov     ebx, [edi+4]
+        cmp     [ebx + ftdi_context.chipType], TYPE_2232H
+        jl      .c_clk
+        imul    eax, [edi+8], 10
+        cmp     eax, H_CLK / 0x3FFF
+        jle     .c_clk
+  .h_clk:
+        cmp     dword[edi+8], H_CLK/10
+        jl      .h_nextbaud1
+        xor     edx, edx
+        mov     ecx, H_CLK/10
+        jmp     .calcend
+  .c_clk:
+        cmp     dword[edi+8], C_CLK/10
+        jl      .c_nextbaud1
+        xor     edx, edx
+        mov     ecx, C_CLK/10
+        jmp     .calcend
+  .h_nextbaud1:
+        cmp     dword[edi+8], H_CLK/(10 + 10/2)
+        jl      .h_nextbaud2
+        mov     edx, 1
+        mov     ecx, H_CLK/(10 + 10/2)
+        jmp     .calcend
+  .c_nextbaud1:
+        cmp     dword[edi+8], C_CLK/(10 + 10/2)
+        jl      .c_nextbaud2
+        mov     edx, 1
+        mov     ecx, C_CLK/(10 + 10/2)
+        jmp     .calcend
+  .h_nextbaud2:
+        cmp     dword[edi+8], H_CLK/(2*10)
+        jl      .h_nextbaud3
+        mov     edx, 2
+        mov     ecx, H_CLK/(2*10)
+        jmp     .calcend
+  .c_nextbaud2:
+        cmp     dword[edi+8], C_CLK/(2*10)
+        jl      .c_nextbaud3
+        mov     edx, 2
+        mov     ecx, C_CLK/(2*10)
+        jmp     .calcend
+  .h_nextbaud3:
+        mov     eax, H_CLK*16/10  ; eax - best_divisor
+        div     dword[edi+8]      ; [edi+8] - baudrate
+        push    eax
+        and     eax, 1
+        pop     eax
+        shr     eax, 1
+        jz      .h_rounddowndiv     ; jump by result of and eax, 1
+        inc     eax
+  .h_rounddowndiv:
+        cmp     eax, 0x20000
+        jle     .h_best_divok
+        mov     eax, 0x1FFFF
+  .h_best_divok:
+        mov     ecx, eax
+        mov     eax, H_CLK*16/10
+        div     ecx
+        xchg    ecx, eax            ; ecx - best_baud
+        push    ecx
+        and     ecx, 1
+        pop     ecx
+        shr     ecx, 1
+        jz      .rounddownbaud
+        inc     ecx
+        jmp     .rounddownbaud
+  .c_nextbaud3:
+        mov     eax, C_CLK*16/10  ; eax - best_divisor
+        div     dword[edi+8]      ; [edi+8] - baudrate
+        push    eax
+        and     eax, 1
+        pop     eax
+        shr     eax, 1
+        jz      .c_rounddowndiv     ; jump by result of and eax, 1
+        inc     eax
+  .c_rounddowndiv:
+        cmp     eax, 0x20000
+        jle     .c_best_divok
+        mov     eax, 0x1FFFF
+  .c_best_divok:
+        mov     ecx, eax
+        mov     eax, C_CLK*16/10
+        div     ecx
+        xchg    ecx, eax            ; ecx - best_baud
+        push    ecx
+        and     ecx, 1
+        pop     ecx
+        shr     ecx, 1
+        jz      .rounddownbaud
+        inc     ecx
+  .rounddownbaud:
+        mov     edx, eax            ; edx - encoded_divisor
+        shr     edx, 3
+        and     eax, 0x7
+        push    esp
+        push    7 6 5 1 4 2 3 0
+        mov     eax, [esp+eax*4]
+        shl     eax, 14
+        or      edx, eax
+        mov     esp, [esp+36]
+  .calcend:
+        mov     eax, edx        ; eax - *value
+        mov     ecx, edx        ; ecx - *index
+        and     eax, 0xFFFF
+        cmp     [ebx + ftdi_context.chipType], TYPE_2232H
+        jge     .foxyindex
+        shr     ecx, 16
+        jmp     .preparepacket
+  .foxyindex:
+        shr     ecx, 8
+        and     ecx, 0xFF00
+        or      ecx, [ebx + ftdi_context.index]
+  .preparepacket:
+        mov     word[ConfPacket], (FTDI_DEVICE_OUT_REQTYPE) + (SIO_SET_BAUDRATE_REQUEST shl 8)
+        mov     word[ConfPacket+2], ax
+        mov     word[ConfPacket+4], cx
+        mov     word[ConfPacket+6], 0
+        jmp     .own_index
 endp
 restore   handle
 restore   io_code
 restore   input
 restore   inp_size
 restore   output
 restore   out_size
 align 4
 proc control_callback stdcall uses ebx edi esi, .pipe:DWORD, .status:DWORD, .buffer:DWORD, .length:DWORD, .calldata:DWORD
         DEBUGF 1, 'K : status is %d\n', [.status]
         mov     ecx, [.calldata]
         mov     eax, [ecx]
         mov     ebx, [ecx+4]
         mov     edx, [.status]
         mov     [ecx+8], edx
         xor     esi, esi
         xor     edx, edx
         call    RaiseEvent
         ret
 endp
 proc bulk_callback stdcall uses ebx edi esi, .pipe:DWORD, .status:DWORD, .buffer:DWORD, .length:DWORD, .calldata:DWORD
         DEBUGF 1, 'K : status is %d\n', [.status]
         mov     ecx, [.calldata]
         mov     eax, [ecx]
         mov     ebx, [ecx+4]
         cmp     [.status], 0
-        jg      .error?
+        jz      .normal
-  .error?:
         cmp     [.status], 9
         jne     .error
+  .normal:
         mov     edx, [.length]
         mov     [ecx+8], edx
         jmp     .ok
   .error:
         mov     [ecx+8], dword -1
   .ok:
         xor     esi, esi
         xor     edx, edx
-        ;mov     edx, 0x80000000
         call    RaiseEvent
         ret
 endp
 proc DeviceDisconnected stdcall uses  ebx esi edi, .device_data:DWORD
         DEBUGF 1, 'K : FTDI deleting device data %x\n', [.device_data]
         mov     eax, [.device_data]
         call    linkedlist_delete
         ret
 endp
 include 'linkedlist.inc'
 ; Exported variable: kernel API version.
 align 4
 version dd      50005h
 ; Structure with callback functions.
 usb_functions:
         dd      12
         dd      AddDevice
         dd      DeviceDisconnected
 ;for DEBUGF macro
 include_debug_strings
 ; for uninitialized data
 ;section '.data' data readable writable align 16

Subversion Repositories Kolibri OS

(root)/drivers/usb/usbftdi/usbftdi.asm – Rev 5014 → 5018