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    ;;
 ;;                                                              ;;
+;;  FTDI chips driver for KolibriOS                             ;;
+;;                                                              ;;
+;;   Written by gtament@gmail.com                               ;;
+;;                                                              ;;
+;;         GNU GENERAL PUBLIC LICENSE                           ;;
+;;          Version 2, June 1991                                ;;
+;;                                                              ;;
 ;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;
 format MS COFF
 __DEBUG_LEVEL__ = 1
 node equ ftdi_context
 node.next equ ftdi_context.next_context
-include '../../proc32.inc'
+include '../proc32.inc'
-include '../../imports.inc'
+include '../imports.inc'
-include '../../fdo.inc'
+include '../fdo.inc'
-include '../../struct.inc'
+include '../struct.inc'
         jz      .ftdi_lock      ;2
         dec     eax
         jz      .ftdi_unlock    ;3
         mov     ebx, [esi+4]
+        mov     ecx, [ebx + ftdi_context.lockPID]
+        cmp     dword[esi], 0
-        mov     ecx, [ebx + ftdi_context.lockPID]
+        jz      .error
         cmp     ecx, [esi]
         jz      .pid_ok
         mov     esi, [edi+output]
         mov     dword[esi], 'LCKD'
         jmp     .endswitch
   .error:
         mov     esi, [edi+output]
         mov     [esi], dword 'ERR0'
         or      [esi], eax
+        ret
   .endswitch:
         xor     eax, eax
 	    ret
         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_noinp:
         mov     ebx, [edi+4]
         mov     cx, word[ebx + ftdi_context.index]
         mov     ebx, [EventData+4]
         call    WaitEvent
         jmp     .endswitch
   .ftdi_setrtshigh:
-        DEBUGF 1,'K : FTDI Setting RTS pin HIGH\n'
+        ;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_noinp
   .ftdi_setrtslow:
-        DEBUGF 1,'K : FTDI Setting RTS pin LOW\n'
+        ;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_noinp
   .ftdi_setdtrhigh:
-        DEBUGF 1,'K : FTDI Setting DTR pin HIGH\n'
+        ;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_noinp
   .ftdi_setdtrlow:
-        DEBUGF 1,'K : FTDI Setting DTR pin LOW\n'
+        ;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_noinp
   .ftdi_usb_reset:
   .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_noinp
-  .ftdi_set_bitmode:
-        DEBUGF 1,'K : FTDI Seting bitmode\n'
+  .ftdi_set_bitmode:
         mov     word[ConfPacket], (FTDI_DEVICE_OUT_REQTYPE) + (SIO_SET_BITMODE_REQUEST shl 8)
         jmp     .ftdi_out_control_transfer_withinp
   .ftdi_read_data:
         mov     edi, [ioctl]
         mov     esi, [edi+input]
         mov     edi, [edi+output]
         mov     ebx, [esi+4]
         ;---Dirty hack begin
         mov     eax, [esi+8]
         call    Kmalloc
         test    eax, eax
         jnz     @f
         mov     esi, nomemory_msg
         call    SysMsgBoardStr
         jmp     .eventdestroy
   @@:
         mov     edi, eax
-        mov     dword[ConfPacket], eax
+        mov     dword[ConfPacket], eax ; Store in ConfPAcket ptr to allocated memory
         ;---Dirty hack end
         xor     ecx, ecx
   .read_loop:
         mov     edx, [esi+8]
         call    ClearEvent
         pop     ebx ecx edi esi
         cmp     [EventData+8], -1
         jz      .error
         add     ecx, [EventData+8]
+        DEBUGF 1, 'K : In buffer %x\n', [edi]
         jmp     .read_loop
         ;---Dirty hack begin
   .read_end:
         mov     esi, dword[ConfPacket]
         mov     edi, [ioctl]
         pop     edi
         mov     [edi], ecx
         jmp     .endswitch
-  .ftdi_lock:
-        DEBUGF 1, 'K : FTDI lock attempt\n'
+  .ftdi_lock:
         mov     esi, [edi+input]
         mov     ebx, [esi+4]
+        mov     eax, [ebx + ftdi_context.lockPID]
-        mov     eax, [ebx + ftdi_context.lockPID]
+        DEBUGF 1, 'K : to PID %x from PID %x\n', [esi], eax
         test    eax, eax
-        jnz     .lockedby
-        DEBUGF 1, 'K : Lock success\n'
+        jnz     .lockedby
         mov     eax, [esi]
         mov     [ebx + ftdi_context.lockPID], eax
   .lockedby:
         mov     edi, [edi+output]
   .ftdi_unlock:
         mov     esi, [edi+input]
         mov     edi, [edi+output]
         mov     ebx, [esi+4]
         mov     eax, [ebx + ftdi_context.lockPID]
+        DEBUGF 1, 'K : to PID %x from PID %x\n', [esi], eax
         cmp     eax, [esi]
         jnz     .unlockimp
         mov     [ebx + ftdi_context.lockPID], 0
         mov     dword[edi], 0
         jmp     .endswitch
         inc     ecx
   .rounddownbaud:
         mov     edx, eax            ; edx - encoded_divisor
         shr     edx, 3
-        and     eax, 0x7
-        push    esp
+        and     eax, 0x7
         push    7 6 5 1 4 2 3 0
         mov     eax, [esp+eax*4]
         shl     eax, 14
         or      edx, eax
-        mov     esp, [esp+36]
+        add     esp, 32
   .calcend:
         mov     eax, edx        ; eax - *value

Subversion Repositories Kolibri OS

(root)/drivers/usb/usbftdi/usbftdi.asm @ 5087 – Rev 5023 → 5035