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

 ;;         GNU GENERAL PUBLIC LICENSE                           ;;
 ;;          Version 2, June 1991                                ;;
 ;;                                                              ;;
 ;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;
-format MS COFF
+format PE DLL native 0.05
 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'
+include '../../proc32.inc'
 include '../../peimport.inc'
-public START
+include '../../fdo.inc'
-public version
+include '../../struct.inc'
 wValue                  dw      ?
 wIndex                  dw      ?
 wLength                 dw      ?
 ends
-section '.flat' code readable align 16
+section '.flat' code readable executable
 ; The start procedure.
-proc START stdcall, .reason:DWORD
+proc START c, .reason:DWORD, .cmdline:DWORD
         xor     eax, eax        ; initialize return value
         cmp     [.reason], 1    ; compare the argument
         jnz     .nothing
-        stdcall RegUSBDriver, my_driver, service_proc, usb_functions
+        invoke  RegUSBDriver, my_driver, service_proc, usb_functions
 .nothing:
         ret
 endp
 proc AddDevice stdcall uses ebx esi edi, .config_pipe:DWORD, .config_descr:DWORD, .interface:DWORD
-        stdcall USBGetParam, [.config_pipe], 0
+        invoke  USBGetParam, [.config_pipe], 0
         mov     edx, eax
-        DEBUGF 1,'K : Detected device vendor: %x\n', [eax+usb_descr.idVendor]
+        DEBUGF 2,'K : Detected device vendor: 0x%x\n', [eax+usb_descr.idVendor]
         cmp     word[eax+usb_descr.idVendor], 0x0403
         jnz     .notftdi
         mov     eax, sizeof.ftdi_context
-        call    Kmalloc
+        invoke  Kmalloc
         test    eax, eax
         jnz     @f
         mov     esi, nomemory_msg
-        call    SysMsgBoardStr
+        invoke  SysMsgBoardStr
         jmp     .nothing
         mov     [eax + ftdi_context.chipType], TYPE_R
         jmp     .slow
         mov     cx, [edx+usb_descr.bcdDevice]
-        DEBUGF 1, 'K : Chip type %x\n', ecx
+        DEBUGF 2, 'K : Chip type 0x%x\n', ecx
         cmp     cx, 0x400
         jnz     @f
         mov     [eax + ftdi_context.chipType], TYPE_BM
   .fast:
         add     [eax + ftdi_context.maxPacketSize], 512-64
   .slow:
+        mov     ebx, eax
-        mov     ebx, eax
+        invoke  USBOpenPipe, [.config_pipe], 0x81, \
-        stdcall USBOpenPipe, [.config_pipe],  0x81,  [ebx + ftdi_context.maxPacketSize],  BULK_PIPE, 0
+                            [ebx + ftdi_context.maxPacketSize],  BULK_PIPE, 0
         test    eax, eax
         jz      .nothing
+        mov     [ebx + ftdi_context.outEP], eax
-        mov     [ebx + ftdi_context.outEP], eax
+        invoke  USBOpenPipe, [.config_pipe], 0x02, \
-        stdcall USBOpenPipe, [.config_pipe],  0x02,  [ebx + ftdi_context.maxPacketSize],  BULK_PIPE, 0
+                            [ebx + ftdi_context.maxPacketSize],  BULK_PIPE, 0
         test    eax, eax
         jz      .nothing
         mov     [ebx + ftdi_context.inEP], eax
         mov     eax, ebx
 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  10
 EventData   rd  3
         cmp     eax, 9-7
         je      .bulkevent
         xor     ecx, ecx
   .bulkevent:
         xor     esi, esi
-        call    CreateEvent
+        invoke  CreateEvent
         mov     [EventData], eax
         mov     [EventData+4], edx
         pop     edi eax
   .eventdestroy:
         ;---Dirty hack begin
         test    eax, eax
         jz      @f
         mov     eax, dword[ConfPacket]
-        call    Kfree
+        invoke  Kfree
   @@:
         ;---Dirty hack end
         mov     eax, [EventData]
         mov     ebx, [EventData+4]
-        call    DestroyEvent
+        invoke  DestroyEvent
         jmp     .endswitch
   .ftdi_out_control_transfer_withinp:
         mov     dx, word[edi+8]
         mov     word[ConfPacket+4], cx
         xor     cx, cx
         mov     word[ConfPacket+6], cx
   .own_index:
         mov     ebx, [edi+4]
-        DEBUGF 1,'K : ConfPacket %x %x\n', [ConfPacket], [ConfPacket+4]
+        DEBUGF 2,'K : ConfPacket 0x%x 0x%x\n', [ConfPacket], [ConfPacket+4]
         lea     esi, [ConfPacket]
         lea     edi, [EventData]
-        stdcall USBControlTransferAsync, [ebx + ftdi_context.nullP],  esi, 0, 0, control_callback, edi, 0
+        invoke  USBControlTransferAsync, [ebx + ftdi_context.nullP],  esi, 0,\
+, control_callback, edi, 0
         test    eax, eax
         jz      .error
         mov     eax, [EventData]
         mov     ebx, [EventData+4]
-        call    WaitEvent
+        invoke  WaitEvent
         mov     eax, [EventData+8]
         test    eax, eax
         jz      .endswitch
         jmp     .error
   .ftdi_setrtshigh:
+        DEBUGF 2,'K : FTDI Setting RTS pin HIGH PID: %d Dev handler 0x0x%x\n', [edi],\
-        ;DEBUGF 1,'K : FTDI Setting RTS pin HIGH\n'
+                                                                        [edi+4]
+        mov     dword[ConfPacket], (FTDI_DEVICE_OUT_REQTYPE) \
+                                 + (SIO_SET_MODEM_CTRL_REQUEST shl 8) \
-        mov     dword[ConfPacket], (FTDI_DEVICE_OUT_REQTYPE) + (SIO_SET_MODEM_CTRL_REQUEST shl 8) + (SIO_SET_RTS_HIGH shl 16)
+                                 + (SIO_SET_RTS_HIGH shl 16)
         jmp     .ftdi_out_control_transfer_noinp
+  .ftdi_setrtslow:
-  .ftdi_setrtslow:
+        DEBUGF 2,'K : FTDI Setting RTS pin LOW PID: %d Dev handler 0x0x%x\n', [edi],\
+                                                                        [edi+4]
+        mov     dword[ConfPacket], (FTDI_DEVICE_OUT_REQTYPE) \
-        ;DEBUGF 1,'K : FTDI Setting RTS pin LOW\n'
+                                 + (SIO_SET_MODEM_CTRL_REQUEST shl 8) \
-        mov     dword[ConfPacket], (FTDI_DEVICE_OUT_REQTYPE) + (SIO_SET_MODEM_CTRL_REQUEST shl 8) + (SIO_SET_RTS_LOW shl 16)
+                                 + (SIO_SET_RTS_LOW shl 16)
         jmp     .ftdi_out_control_transfer_noinp
+  .ftdi_setdtrhigh:
+        DEBUGF 2,'K : FTDI Setting DTR pin HIGH PID: %d Dev handler 0x0x%x\n', [edi],\
+                                                                        [edi+4]
-  .ftdi_setdtrhigh:
+        mov     dword[ConfPacket], (FTDI_DEVICE_OUT_REQTYPE) \
-        ;DEBUGF 1,'K : FTDI Setting DTR pin HIGH\n'
+                                 + (SIO_SET_MODEM_CTRL_REQUEST shl 8) \
-        mov     dword[ConfPacket], (FTDI_DEVICE_OUT_REQTYPE) + (SIO_SET_MODEM_CTRL_REQUEST shl 8) + (SIO_SET_DTR_HIGH shl 16)
+                                 + (SIO_SET_DTR_HIGH shl 16)
+        jmp     .ftdi_out_control_transfer_noinp
-        jmp     .ftdi_out_control_transfer_noinp
+  .ftdi_setdtrlow:
+        DEBUGF 2,'K : FTDI Setting DTR pin LOW PID: %d Dev handler 0x0x%x\n', [edi],\
                                                                         [edi+4]
-  .ftdi_setdtrlow:
+        mov     dword[ConfPacket], (FTDI_DEVICE_OUT_REQTYPE) \
-        ;DEBUGF 1,'K : FTDI Setting DTR pin LOW\n'
+                                 + (SIO_SET_MODEM_CTRL_REQUEST shl 8) \
+                                 + (SIO_SET_DTR_LOW shl 16)
-        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_noinp
+  .ftdi_usb_reset:
-        jmp     .ftdi_out_control_transfer_noinp
+        DEBUGF 2,'K : FTDI Reseting PID: %d Dev handler 0x0x%x\n', [edi],\
                                                                         [edi+4]
+        mov     dword[ConfPacket], (FTDI_DEVICE_OUT_REQTYPE) \
+                                 + (SIO_RESET_REQUEST shl 8) \+
-  .ftdi_usb_reset:
+                                   (SIO_RESET_SIO shl 16)
+        jmp     .ftdi_out_control_transfer_noinp
-        ;DEBUGF 1,'K : FTDI Reseting\n'
+  .ftdi_purge_rx_buf:
-        mov     dword[ConfPacket], (FTDI_DEVICE_OUT_REQTYPE) + (SIO_RESET_REQUEST shl 8) + (SIO_RESET_SIO shl 16)
+        DEBUGF 2, 'K : FTDI Purge TX buffer PID: %d Dev handler 0x0x%x\n', [edi],\
+                                                                        [edi+4]
+        mov     dword[ConfPacket], (FTDI_DEVICE_OUT_REQTYPE) \
-        jmp     .ftdi_out_control_transfer_noinp
+                                 + (SIO_RESET_REQUEST shl 8) \
+                                 + (SIO_RESET_PURGE_RX shl 16)
+        jmp     .ftdi_out_control_transfer_noinp
-  .ftdi_purge_rx_buf:
+  .ftdi_purge_tx_buf:
+        DEBUGF 2, 'K : FTDI Purge RX buffer PID: %d Dev handler 0x0x%x\n', [edi],\
+                                                                        [edi+4]
-        mov     dword[ConfPacket], (FTDI_DEVICE_OUT_REQTYPE) + (SIO_RESET_REQUEST shl 8) + (SIO_RESET_PURGE_RX shl 16)
+        mov     dword[ConfPacket], (FTDI_DEVICE_OUT_REQTYPE) \
+                                 + (SIO_RESET_REQUEST shl 8) \
-        jmp     .ftdi_out_control_transfer_noinp
+                                 + (SIO_RESET_PURGE_TX shl 16)
         jmp     .ftdi_out_control_transfer_noinp
+  .ftdi_set_bitmode:
-  .ftdi_purge_tx_buf:
+        DEBUGF 2, 'K : FTDI Set bitmode 0x%x, bitmask 0x%x %d PID: %d Dev handler 0x0x%x\n', \
+                                               [edi+8]:2,[edi+10]:2,[edi],[edi+4]
-        mov     dword[ConfPacket], (FTDI_DEVICE_OUT_REQTYPE) + (SIO_RESET_REQUEST shl 8) + (SIO_RESET_PURGE_TX shl 16)
+        mov     word[ConfPacket], (FTDI_DEVICE_OUT_REQTYPE) \
-        jmp     .ftdi_out_control_transfer_noinp
+                                + (SIO_SET_BITMODE_REQUEST shl 8)
+        jmp     .ftdi_out_control_transfer_withinp
+  .ftdi_set_line_property:
+        DEBUGF 2, 'K : FTDI Set line property 0x%x PID: %d Dev handler 0x0x%x\n', \
-  .ftdi_set_bitmode:
+                                                          [edi+8]:4,[edi],[edi+4]
-        mov     word[ConfPacket], (FTDI_DEVICE_OUT_REQTYPE) + (SIO_SET_BITMODE_REQUEST shl 8)
+        mov     word[ConfPacket], (FTDI_DEVICE_OUT_REQTYPE) \
+                                + (SIO_SET_DATA_REQUEST shl 8)
+        jmp     .ftdi_out_control_transfer_withinp
-        jmp     .ftdi_out_control_transfer_withinp
+  .ftdi_set_latency_timer:
         DEBUGF 2, 'K : FTDI Set latency %d PID: %d Dev handler 0x0x%x\n', \
-  .ftdi_set_line_property:
+                                                          [edi+8],[edi],[edi+4]
+        mov     word[ConfPacket], (FTDI_DEVICE_OUT_REQTYPE) \
+                                + (SIO_SET_LATENCY_TIMER_REQUEST shl 8)
-        mov     word[ConfPacket], (FTDI_DEVICE_OUT_REQTYPE) + (SIO_SET_DATA_REQUEST shl 8)
+        jmp     .ftdi_out_control_transfer_withinp
-        jmp     .ftdi_out_control_transfer_withinp
+  .ftdi_set_event_char:
         DEBUGF 2, 'K : FTDI Set event char %c PID: %d Dev handler 0x0x%x\n', \
+                                                          [edi+8],[edi],[edi+4]
+        mov     word[ConfPacket], (FTDI_DEVICE_OUT_REQTYPE) \
+                                + (SIO_SET_EVENT_CHAR_REQUEST shl 8)
-  .ftdi_set_latency_timer:
+        jmp     .ftdi_out_control_transfer_withinp
         mov     word[ConfPacket], (FTDI_DEVICE_OUT_REQTYPE) + (SIO_SET_LATENCY_TIMER_REQUEST shl 8)
-        jmp     .ftdi_out_control_transfer_withinp
+  .ftdi_set_error_char:
         DEBUGF 2, 'K : FTDI Set error char %c PID: %d Dev handler 0x0x%x\n', \
-  .ftdi_set_event_char:
+                                                          [edi+8],[edi],[edi+4]
-        mov     word[ConfPacket], (FTDI_DEVICE_OUT_REQTYPE) + (SIO_SET_EVENT_CHAR_REQUEST shl 8)
+        mov     word[ConfPacket], (FTDI_DEVICE_OUT_REQTYPE) \
-        jmp     .ftdi_out_control_transfer_withinp
+                                + (SIO_SET_ERROR_CHAR_REQUEST shl 8)
         jmp     .ftdi_out_control_transfer_withinp
   .ftdi_set_error_char:
+  .ftdi_setflowctrl:
+        DEBUGF 2, 'K : FTDI Set flow control PID: %d Dev handler 0x0x%x\n', [edi],\
-        mov     word[ConfPacket], (FTDI_DEVICE_OUT_REQTYPE) + (SIO_SET_ERROR_CHAR_REQUEST shl 8)
+                                                                        [edi+4]
+        mov     dword[ConfPacket], (FTDI_DEVICE_OUT_REQTYPE) \
-        jmp     .ftdi_out_control_transfer_withinp
+                                 + (SIO_SET_FLOW_CTRL_REQUEST shl 8) + (0 shl 16)
         mov     ebx, [edi+4]
-  .ftdi_setflowctrl:
+        mov     cx, word[edi+8]
-        mov     dword[ConfPacket], (FTDI_DEVICE_OUT_REQTYPE) + (SIO_SET_FLOW_CTRL_REQUEST shl 8) + (0 shl 16)
+        or      ecx, [ebx + ftdi_context.index]
-        mov     ebx, [edi+4]
+        mov     word[ConfPacket+4], cx
-        mov     cx, word[edi+8]
+        xor     cx, cx
-        or      ecx, [ebx + ftdi_context.index]
+        mov     word[ConfPacket+6], cx
-        mov     word[ConfPacket+4], cx
+        jmp     .own_index
         xor     cx, cx
-        mov     word[ConfPacket+6], cx
+  .ftdi_read_pins:
+        DEBUGF 2, 'K : FTDI Read pins PID: %d Dev handler 0x0x%x\n', [edi],\
-        jmp     .own_index
+                                                                     [edi+4]
         mov     ebx, [edi+4]
-  .ftdi_read_pins:
+        mov     dword[ConfPacket], (FTDI_DEVICE_IN_REQTYPE) /
-        mov     ebx, [edi+4]
+                                 + (SIO_READ_PINS_REQUEST shl 8) + (0 shl 16)
-        mov     dword[ConfPacket], FTDI_DEVICE_IN_REQTYPE + (SIO_READ_PINS_REQUEST shl 8) + (0 shl 16)
+        mov     ecx, [ebx + ftdi_context.index]
-        mov     ecx, [ebx + ftdi_context.index]
+        mov     word[ConfPacket+4], cx
-        mov     word[ConfPacket+4], cx
+        mov     word[ConfPacket+6], 1
-        mov     word[ConfPacket+6], 1
+        lea     esi, [ConfPacket]
         test    eax, eax
         jz      .endswitch
         jmp     .error
+  .ftdi_set_wchunksize:
+        DEBUGF 2, 'K : FTDI Set write chunksize %d bytes PID: %d Dev handler 0x0x%x\n', \
-  .ftdi_set_wchunksize:
+                                                    [edi+8], [edi], [edi+4]
         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:
         DEBUGF 2, 'K : FTDI Get write chunksize PID: %d Dev handler 0x0x%x\n', [edi],\
-  .ftdi_get_wchunksize:
+                                                                        [edi+4]
         mov     esi, [edi+output]
         mov     edi, [edi+input]
         mov     ebx, [edi+4]
         mov     ecx, [ebx + ftdi_context.writeBufChunkSize]
         mov     [esi], ecx
+        jmp     .endswitch
-        jmp     .endswitch
+  .ftdi_set_rchunksize:
         DEBUGF 2, 'K : FTDI Set read chunksize %d bytes PID: %d Dev handler 0x0x%x\n', \
-  .ftdi_set_rchunksize:
+                                                    [edi+8], [edi], [edi+4]
         mov     ebx, [edi+4]
         mov     ecx, [edi+8]
         cmp     [ebx + ftdi_context.maxPacketSize], ecx
         jg      .error
+        mov     [ebx + ftdi_context.readBufChunkSize], ecx
+        jmp     .endswitch
         mov     [ebx + ftdi_context.readBufChunkSize], ecx
-        jmp     .endswitch
+  .ftdi_get_rchunksize:
         DEBUGF 2, 'K : FTDI Get read chunksize PID: %d Dev handler 0x0x%x\n', [edi],\
-  .ftdi_get_rchunksize:
+                                                                        [edi+4]
         mov     esi, [edi+output]
         mov     edi, [edi+input]
         mov     ebx, [edi+4]
+        mov     ecx, [ebx + ftdi_context.readBufChunkSize]
+        mov     [esi], ecx
-        mov     ecx, [ebx + ftdi_context.readBufChunkSize]
+        jmp     .endswitch
         mov     [esi], ecx
-        jmp     .endswitch
+  .ftdi_write_data:
         DEBUGF 2, 'K : FTDI Write %d bytes PID: %d Dev handler 0x%x\n', [edi+8],\
-  .ftdi_write_data:
+                                                            [edi], [edi+4]
         mov     esi, edi
         add     esi, 12
         mov     ebx, [edi+4]
         ;---Dirty hack begin
         mov     eax, [edi+8]
-        call    Kmalloc
+        invoke  Kmalloc
         test    eax, eax
         jnz     @f
         mov     esi, nomemory_msg
-        call    SysMsgBoardStr
+        invoke  SysMsgBoardStr
         mov     edx, [ebx + ftdi_context.writeBufChunkSize]
   .lessthanchunk_write:
         add     esi, ecx
         lea     eax, [EventData]
         push    ecx ebx esi edi
-        stdcall USBNormalTransferAsync, [ebx + ftdi_context.inEP], esi, edx, bulk_callback, eax, 1
+        invoke USBNormalTransferAsync, [ebx + ftdi_context.inEP], esi, edx, \
+                                            bulk_callback, eax, 1
         mov     eax, [EventData]
         mov     ebx, [EventData+4]
-        call    WaitEvent
+        invoke  WaitEvent
         pop     edi esi ebx ecx
         cmp     [EventData+8], -1
         jz      .error
         add     ecx, [EventData+8]
         cmp     ecx, [edi+8]
         jge     .eventdestroy
         jmp     .write_loop
+  .ftdi_read_data:
+        DEBUGF 2, 'K : FTDI Read %d bytes PID: %d Dev handler 0x%x\n', [edi+8],\
-  .ftdi_read_data:
+                                                            [edi], [edi+4]
         mov     edi, [ioctl]
         mov     esi, [edi+input]
         mov     edi, [edi+output]
         mov     ebx, [esi+4]
         ;---Dirty hack begin
         mov     eax, [esi+8]
-        call    Kmalloc
+        invoke  Kmalloc
         test    eax, eax
         jnz     @f
         mov     esi, nomemory_msg
-        call    SysMsgBoardStr
+        invoke  SysMsgBoardStr
         jmp     .eventdestroy
   @@:
         mov     edi, eax
-        push    edi eax
+        ; push    edi eax
-        mov     ecx, [esi+8]
+        ; mov     ecx, [esi+8]
-        xor     eax, eax
+        ; xor     eax, eax
-        rep     stosb
+        ; rep     stosb
-        pop     eax edi
+        ; pop     eax edi
-        mov     dword[ConfPacket], eax ; Store in ConfPAcket ptr to allocated memory
+        mov     dword[ConfPacket], eax ; Store in ConfPacket ptr to allocated memory
         ;---Dirty hack end
         xor     ecx, ecx
   .read_loop:
         mov     edx, [esi+8]
         mov     edx, [ebx + ftdi_context.readBufChunkSize]
   .lessthanchunk_read:
         lea     eax, [EventData]
         add     edi, ecx
         push    esi edi ecx ebx
-        stdcall USBNormalTransferAsync, [ebx + ftdi_context.outEP], edi, edx, bulk_callback, eax, 1
+        invoke  USBNormalTransferAsync, [ebx + ftdi_context.outEP], edi, edx, \
+                                            bulk_callback, eax, 1
         mov     eax, [EventData]
         mov     ebx, [EventData+4]
-        call    WaitEvent
+        invoke  WaitEvent
         pop     ebx ecx edi esi
         cmp     [EventData+8], -1
         jz      .error
         add     ecx, [EventData+8]
         jmp     .read_loop
         rep     movsb
         jmp     .eventdestroy
         ;---Dirty hack end
+  .ftdi_poll_modem_status:
+        DEBUGF 2, 'K : FTDI Poll modem status PID: %d Dev handler 0x0x%x\n', [edi],\
-  .ftdi_poll_modem_status:
+                                                                        [edi+4]
+        mov     ebx, [edi+4]
-        mov     ebx, [edi+4]
+        mov     dword[ConfPacket], (FTDI_DEVICE_IN_REQTYPE) \
-        mov     dword[ConfPacket], FTDI_DEVICE_IN_REQTYPE + (SIO_POLL_MODEM_STATUS_REQUEST shl 8) + (0 shl 16)
+                                 + (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]
+        invoke  USBControlTransferAsync, [ebx + ftdi_context.nullP],  esi, ecx, \
-        stdcall USBControlTransferAsync, [ebx + ftdi_context.nullP],  esi, ecx, 2, control_callback, edi, 0
+, control_callback, edi, 0
         mov     eax, [EventData]
         mov     ebx, [EventData+4]
-        call    WaitEvent
+        invoke  WaitEvent
         mov     ax, word[ecx]
         xchg    ah, al
         and     ah, 0xFF
         mov     word[ecx], ax
         jmp     .endswitch
+  .ftdi_get_latency_timer:
         DEBUGF 2, 'K : FTDI Get latency timer PID: %d Dev handler 0x0x%x\n', [edi],\
+                                                                        [edi+4]
-  .ftdi_get_latency_timer:
+        mov     ebx, [edi+4]
-        mov     ebx, [edi+4]
+        mov     dword[ConfPacket], FTDI_DEVICE_IN_REQTYPE \
-        mov     dword[ConfPacket], FTDI_DEVICE_IN_REQTYPE + (SIO_GET_LATENCY_TIMER_REQUEST shl 8) + (0 shl 16)
+                                + (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]
-        mov     ecx, [ecx+output]
+        invoke  USBControlTransferAsync, [ebx + ftdi_context.nullP],  esi, ecx, \
-        stdcall USBControlTransferAsync, [ebx + ftdi_context.nullP],  esi, ecx, 2, control_callback, edi, 0
+, control_callback, edi, 0
         mov     eax, [EventData]
         mov     ebx, [EventData+4]
-        call    WaitEvent
+        invoke  WaitEvent
+        jmp     .endswitch
         jmp     .endswitch
   .ftdi_get_list:
-  .ftdi_get_list:
+        DEBUGF 2, 'K : FTDI devices\' list request\n'
         mov     edi, [edi+output]
         xor     ecx, ecx
   .emptylist:
         mov     [edi], ecx
         jmp     .endswitch
+  .ftdi_lock:
-  .ftdi_lock:
+        DEBUGF 2, 'K : FTDI Lock PID: %d Dev handler 0x0x%x\n', [edi], [edi+4]
         mov     esi, [edi+input]
         mov     ebx, [esi+4]
         mov     eax, [ebx + ftdi_context.lockPID]
         test    eax, eax
         mov     edi, [edi+output]
         mov     [edi], eax
         jmp     .endswitch
+  .ftdi_unlock:
-  .ftdi_unlock:
+        DEBUGF 2, 'K : FTDI Unlock PID: %d Dev handler 0x0x%x\n', [edi], [edi+4]
         mov     esi, [edi+input]
         mov     edi, [edi+output]
         mov     ebx, [esi+4]
         mov     eax, [ebx + ftdi_context.lockPID]
         jmp     .endswitch
 H_CLK = 120000000
 C_CLK = 48000000
+  .ftdi_set_baudrate:
+        DEBUGF 2, 'K : FTDI Set baudrate to %d PID: %d Dev handle: 0x%x\n',\
-  .ftdi_set_baudrate:
+                   [edi+8], [edi], [edi+4]
         mov     ebx, [edi+4]
         cmp     [ebx + ftdi_context.chipType], TYPE_2232H
         jl      .c_clk
         imul    eax, [edi+8], 10
         shr     ecx, 8
         and     ecx, 0xFF00
         or      ecx, [ebx + ftdi_context.index]
   .preparepacket:
+        mov     word[ConfPacket], (FTDI_DEVICE_OUT_REQTYPE) \
-        mov     word[ConfPacket], (FTDI_DEVICE_OUT_REQTYPE) + (SIO_SET_BAUDRATE_REQUEST shl 8)
+                                + (SIO_SET_BAUDRATE_REQUEST shl 8)
         mov     word[ConfPacket+2], ax
         mov     word[ConfPacket+4], cx
         mov     word[ConfPacket+6], 0
 restore   inp_size
 restore   output
 restore   out_size
-align 4
+proc control_callback stdcall uses ebx edi esi, .pipe:DWORD, .status:DWORD, \
-proc control_callback stdcall uses ebx edi esi, .pipe:DWORD, .status:DWORD, .buffer:DWORD, .length:DWORD, .calldata: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
+        invoke  RaiseEvent
+        ret
-        ret
+endp
 endp
 proc bulk_callback stdcall uses ebx edi esi, .pipe:DWORD, .status:DWORD, \
-proc bulk_callback stdcall uses ebx edi esi, .pipe:DWORD, .status:DWORD, .buffer:DWORD, .length:DWORD, .calldata:DWORD
+                            .buffer:DWORD, .length:DWORD, .calldata:DWORD
   .error:
         mov     [ecx+8], dword -1
   .ok:
         xor     esi, esi
         xor     edx, edx
-        call    RaiseEvent
+        invoke  RaiseEvent
         ret
 endp
 proc DeviceDisconnected stdcall uses  ebx esi edi, .device_data:DWORD
-        DEBUGF 1, 'K : FTDI deleting device data %x\n', [.device_data]
+        DEBUGF 1, 'K : FTDI deleting device data 0x%x\n', [.device_data]
+        mov     eax, [.device_data]
-        mov     eax, [.device_data]
+        call    linkedlist_unlink
-        call    linkedlist_delete
+        invoke  Kfree
         ret
-endp
 endp
-include 'linkedlist.inc'
 include 'linkedlist.inc'
 ; Exported variable: kernel API version.
 align 4
 version dd      50005h
 ; Structure with callback functions.
+usb_functions:
+        dd      12
+        dd      AddDevice
-usb_functions:
+        dd      DeviceDisconnected
         dd      12
-        dd      AddDevice
-        dd      DeviceDisconnected
-;for DEBUGF macro
-include_debug_strings

Subversion Repositories Kolibri OS

(root)/drivers/usb/usbftdi/usbftdi.asm – Rev 5042 → 5087