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    ;;
 ;;                                                              ;;
 ;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;
 ; standard driver stuff
 format MS COFF
 DEBUG = 1
 DEBUG = 1
+__DEBUG__ = 1
+__DEBUG_LEVEL__ = 1
 ; this is for DEBUGF macro from 'fdo.inc'
-__DEBUG__ = 1
+node equ ftdi_context
-__DEBUG_LEVEL__ = 1
+node.next equ ftdi_context.next_context
 interface               dd      ?
 index                   dd      ?
 inEP                    dd      ?
 outEP                   dd      ?
 nullP                   dd      ?
+lockPID                 dd      ?
 next_context            dd      ?
 ends
 struct IOCTL
 .nothing:
         ret
 endp
+proc AddDevice stdcall uses ebx esi, .config_pipe:DWORD, .config_descr:DWORD, .interface:DWORD
 proc AddDevice stdcall uses ebx, .config_pipe:DWORD, .config_descr:DWORD, .interface:DWORD
         stdcall USBGetParam, [.config_pipe], 0
-        stdcall USBGetParam, [.config_pipe], 0
+        mov     edx, eax
         DEBUGF 1,'K : Device detected 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
+        jnz     @f
-        call    SysMsgBoardStr
+        mov     esi, nomemory_msg
-        xor     eax, eax
+        call    SysMsgBoardStr
         jmp     .nothing
-@@:
+  @@:
         DEBUGF 1,'K : Adding struct to list %x\n', eax
-        call    linkedlist.add
+        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
+        cmp     [edx+usb_descr.bcdDevice], 0x400
+        jnz     @f
+        mov     [eax + ftdi_context.chipType], TYPE_BM
+  @@:
+        cmp     [edx+usb_descr.bcdDevice], 0x200
+        jnz     @f
+        mov     [eax + ftdi_context.chipType], TYPE_AM
+  @@:
+        cmp     [edx+usb_descr.bcdDevice], 0x500
+        jnz     @f
+        mov     [eax + ftdi_context.chipType], TYPE_2232C
+  @@:
+        cmp     [edx+usb_descr.bcdDevice], 0x600
+        jnz     @f
+        mov     [eax + ftdi_context.chipType], TYPE_R
+  @@:
+        cmp     [edx+usb_descr.bcdDevice], 0x700
+        jnz     @f
+        mov     [eax + ftdi_context.chipType], TYPE_2232H
+  @@:
+        cmp     [edx+usb_descr.bcdDevice], 0x900
+        jnz     @f
+        mov     [eax + ftdi_context.chipType], TYPE_232H
+  @@:
         cmp     [edx+usb_descr.bcdDevice], 0x1000
-        mov     ebx, [.config_pipe]
+        jnz     @f
-        mov     [eax + ftdi_context.nullP], ebx
+        mov     [eax + ftdi_context.chipType], TYPE_BM
-        mov     [eax + ftdi_context.index], 0
+  @@:
         DEBUGF 1,'K : Open first pipe\n'
         mov     ebx, eax
-        stdcall USBOpenPipe, [.config_pipe],  0x81,  0x40,  BULK_PIPE, 0
-        mov     [ebx + ftdi_context.inEP], eax
-        DEBUGF 1,'K : Open second pipe\n'
+        stdcall USBOpenPipe, [.config_pipe],  0x81,  0x40,  BULK_PIPE, 0
-        stdcall USBOpenPipe, [.config_pipe],  0x02,  0x40,  BULK_PIPE, 0
+        mov     [ebx + ftdi_context.inEP], eax
+        DEBUGF 1,'K : Open second pipe\n'
-        mov     [ebx + ftdi_context.outEP], eax
+        stdcall USBOpenPipe, [.config_pipe],  0x02,  0x40,  BULK_PIPE, 0
         mov     [ebx + ftdi_context.outEP], eax
   .nothing:
         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:
         push    eax edi
         xor     ecx, ecx
         xor     esi, esi
         call    CreateEvent
         mov     [EventData], eax
         mov     [EventData+4], edx
         pop     edi eax
-        dec     eax                 ;2
+        dec     eax                 ;4
         jz      .ftdi_set_bitmode
-        dec     eax                 ;3
+        dec     eax                 ;5
         jz      .ftdi_setrtshigh
+        dec     eax                 ;6
+        jz      .ftdi_setrtslow
+        dec     eax
+        jz      .ftdi_setdtrhigh
+        dec     eax
+        jz      .ftdi_setdtrlow
+        dec     eax
+        jz      .ftdi_usb_reset
+        dec     eax
+        jz      .ftdi_setflowctrl
+        dec     eax
+        jz      .ftdi_set_event_char
+        dec     eax
+        jz      .ftdi_set_error_char
+        dec     eax
+        jz      .ftdi_set_latency_timer
+        dec     eax
+        jz      .ftdi_get_latency_timer
+        dec     eax
+        jz      .ftdi_read_pins
+        dec     eax
+        jz      .ftdi_poll_modem_status
+        dec     eax
+        jz      .ftdi_write_data
+        dec     eax
+        jz      .ftdi_set_baudrate
+        dec     eax
+        jz      .ftdi_set_line_property
+        dec     eax
+        jz      .ftdi_purge_rx_buf
-        dec     eax                 ;4
+        dec     eax
-        jz      .ftdi_setrtslow
+        jz      .ftdi_purge_tx_buf
   .version:
         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]
+        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
   .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+4]
+        mov     dx, word[edi+8]
         mov     word[ConfPacket+2], dx
         jmp     .ftdi_out_control_transfer
   .ftdi_set_baudrate:
         mov     edi, [edi+input]
         mov     ebx, [edi]
         cmp     [ebx + ftdi_context.chipType], TYPE_2232H
         jl      .c_clk
-        imul    eax, [edi+4], 10
+        imul    eax, [edi+8], 10
         cmp     eax, H_CLK / 0x3FFF
         jle     .c_clk
   .h_clk:
-        cmp     dword[edi+4], H_CLK/10
+        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+4], C_CLK/10
+        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+4], H_CLK/(10 + 10/2)
+        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+4], C_CLK/(10 + 10/2)
+        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+4], H_CLK/(2*10)
+        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+4], C_CLK/(2*10)
+        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
         inc     ecx
         jmp     .rounddownbaud
   .c_nextbaud3:
         mov     eax, C_CLK*16/10  ; eax - best_divisor
-        div     dword[edi+4]      ; [edi+4] - baudrate
+        div     dword[edi+8]      ; [edi+8] - baudrate
         push    eax
         and     eax, 1
         pop     eax
         shr     eax, 1
         jmp     .own_index
   .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+4]
+        mov     dx, word[edi+8]
         mov     word[ConfPacket+2], dx
         jmp     .ftdi_out_control_transfer
   .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+4]
+        mov     dx, word[edi+8]
         mov     word[ConfPacket+2], dx
         jmp     .ftdi_out_control_transfer
   .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+4]
+        mov     dx, word[edi+8]
         mov     word[ConfPacket+2], dx
         jmp     .ftdi_out_control_transfer
   .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+4]
+        mov     dx, word[edi+8]
         mov     word[ConfPacket+2], dx
         jmp     .ftdi_out_control_transfer
   .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     cx, word[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
+        xor     cx, cx
         mov     word[ConfPacket+6], cx
+        jmp     .own_index
+  .ftdi_read_pins:
+        DEBUGF 1,'K : FTDI Reading pins\n'
-  .ftdi_read_pins:
+        mov     edi, [edi+input]
-        DEBUGF 1,'K : FTDI Reading pins\n'
+        mov     ebx, [edi]
         mov     dword[ConfPacket], FTDI_DEVICE_IN_REQTYPE + (SIO_READ_PINS_REQUEST shl 8) + (0 shl 16)
-        mov     dword[ConfPacket+4], 0x00000001
+        mov     ecx, [ebx + ftdi_context.index]
-        mov     edi, [edi+input]
+        mov     word[ConfPacket+4], cx
         mov     eax, [EventData]
         mov     ebx, [EventData+4]
         call    WaitEvent
         jmp     .endswitch
+  .ftdi_write_data:
+        mov     edi, [edi+input]
+        mov     ebx, [edi+4]
+        mov     eax, [edi+8]
+        xor     ecx, ecx        ; ecx - offset
+  .dataleft:
+        mov     edx, [ebx + ftdi_context.writeBufChunkSize] ; edx - write_size
+        push    ecx
+        add     ecx, edx
+        cmp     ecx, [edi+8]
+        pop     ecx
+        jle     .morethanchunk
+        mov     edx, [edi+8]
+        sub     edx, ecx
-   .ftdi_read_data:
+  .morethanchunk:
+        stdcall USBNormalTransferAsync, [ebx + ftdi_context.inEP], [edi+12+ecx], edx, bulk_callback, edx, 1
+        mov     eax, [EventData]
+        mov     ebx, [EventData+4]
+        call    WaitEvent
+        add     ecx, [EventData]
+        cmp     ecx, [edi+8]
+        jl      .dataleft
+        jmp     .endswitch
+  .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
-        ;stdcall USBNormalTransferAsync, [ebx + ftdi_context.inEP], [ebx + ftdi_context.readBufPtr], [ebx + 1]
+        jmp     .endswitch
+  .ftdi_get_list:
+        call    linkedlist_gethead
+        mov     edi, [edi+output]
+  .nextdev:
+        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
+        jmp     .endswitch
+  .ftdi_lock:
+        mov     esi, [edi+input]
+        mov     ebx, [esi+4]
+        mov     eax, [ebx + ftdi_context.lockPID]
+        test    eax, eax
+        jnz     .lockedby
+        mov     eax, [esi]
-   .ftdi_get_list:
+        mov     [ebx + ftdi_context.lockPID], eax
-        call    linkedlist.gethead
+  .lockedby:
+        mov     edi, [edi+output]
+        mov     [edi], eax
+        jmp     .endswitch
+  .ftdi_unlock:
+        mov     esi, [edi+input]
         mov     edi, [edi+output]
-        mov     [edi], eax
+        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
-        DEBUGF 1, 'K : FTDI Device pointer %x\n', [edi]
+        jmp     .endswitch
-        mov     eax, 4
+  .unlockimp:
-        mov     [edi+out_size], eax
+        mov     [edi], eax
         jmp     .endswitch
         DEBUGF 1, 'K : status is %d\n', [.status]
         mov     ecx, [.calldata]
         mov     eax, [ecx]
+        mov     ebx, [ecx+4]
-        mov     ebx, [ecx+4]
+        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]
+        mov     edx, [.length]
+        mov     edx, [edx]
+        mov     [ecx], edx
+        xor     esi, esi
+        xor     edx, edx
+        call    RaiseEvent
         ret
 endp
 endp
 proc DeviceDisconnected stdcall uses  ebx esi edi, .device_data:DWORD
         DEBUGF 1, 'K : FTDI deleting device data\n'

Subversion Repositories Kolibri OS

(root)/drivers/usb/usbftdi/usbftdi.asm – Rev 4992 → 4997