WebSVN – Kolibri OS – Diff – /kernel/branches/flat_kernel/drivers/comport.asm

 DRV_ENTRY        equ   1
 DRV_EXIT         equ  -1
+THR_REG          equ  0;  x3f8   ;transtitter/reciever
+IER_REG          equ  1;  x3f9   ;interrupt enable
+IIR_REG          equ  2;  x3fA   ;interrupt info
+LCR_REG          equ  3;  x3FB   ;line control
+MCR_REG          equ  4;  x3FC   ;modem control
+LSR_REG          equ  5;  x3FD   ;line status
 MSR_REG          equ  6;  x3FE   ;modem status
 LCR_5BIT         equ  0x00
 LCR_6BIT         equ  0x01
 MCR_DTR          equ  0x01     ;0-> DTR=1, 1-> DTR=0
 MCR_RTS          equ  0x02     ;0-> RTS=1, 1-> RTS=0
 MCR_OUT_1        equ  0x04     ;0-> OUT1=1, 1-> OUT1=0
-MCR_OUT_2        equ  0x08     ;0-> OUT2=1, 1-> OUT2=0
+MCR_OUT_2        equ  0x08     ;0-> OUT2=1, 1-> OUT2=0  enable intr
 MCR_LOOP         equ  0x10     ;lopback mode
 MSR_DCTS         equ  0x01     ;delta clear to send
 MSR_DDSR         equ  0x02     ;delta data set redy
 MSR_TERI         equ  0x04     ;trailinh edge of ring
-MSR_DDCD         equ  0x08     ;delta carrier detect
-COM_THR          equ 0x3f8     ;transtitter/reciever
-COM_IER          equ 0x3f9     ;interrupt enable
-COM_IIR          equ 0x3fA     ;interrupt info
-COM_LCR          equ 0x3FB     ;line control
-COM_MCR          equ 0x3FC     ;modem control
-COM_LSR          equ 0x3FD     ;line status
+MSR_DDCD         equ  0x08     ;delta carrier detect
 COM_MSR          equ 0x3FE     ;modem status
 RATE_50          equ  0
 RATE_38400       equ 16
 RATE_57600       equ 17
 RATE_115200      equ 18
-COM_1            equ  0
+COM_1            equ  1
-COM_2            equ  1
+COM_2            equ  2
-COM_3            equ  2
+COM_3            equ  3
-COM_4            equ  3
+COM_4            equ  4
+COM_MAX          equ  2    ;only two port supported
+COM_1_BASE       equ 0x3F8
+COM_2_BASE       equ 0x2F8
 COM_1_IRQ        equ  4
-COM_2_IRQ        equ  3
+COM_2_IRQ        equ  3
-TRANSMIT         equ  1
+UART_CLOSED      equ  0
 UART_TRANSMIT    equ  1
+struc UART
+{
-struc COMPORT
+  ; .owner        dd ?   unused
    .lock         dd ?
    .base         dd ?
    .lcr_reg      dd ?
    .mcr_reg      dd ?
-   .rate         dd ?
-   .mode         dd ?
+   .rate         dd ?
-   .state        dd ?
+   .mode         dd ?
-   .connection   dd ?
+   .state        dd ?
    .rcvr_rp      dd ?
-   .rcvr_wp      dd ?
+   .rcvr_rp      dd ?
-   .rcvr_free    dd ?
+   .rcvr_wp      dd ?
-   .rcvr_count   dd ?
-   .xmit_rp      dd ?
+   .rcvr_free    dd ?
+   .xmit_rp      dd ?
+   .xmit_wp      dd ?
+   .xmit_free    dd ?
+   .rcvr_buffer  rb 128
+   .xmit_buffer  rb 128
+}
+virtual at 0
+  UART UART
+end virtual
+RCVR_OFFSET   equ 14*4
+XMIT_OFFSET   equ (13*4*128)
+UART_SIZE     equ (256+13*4)
+struc CONNECTION
+{
+   .magic       dd ?   ;'CNCT'
+   .destroy     dd ?   ;internal destructor
+   .fd          dd ?   ;next object in list
-   .xmit_wp      dd ?
+   .bk          dd ?   ;prev object in list
+   .pid         dd ?   ;owner id
    .xmit_free    dd ?
-   .xmit_count   dd ?
+   .id          dd ?   ;reserved
-   .xmit_buffer  rb 128
+   .uart        dd ?   ;uart pointer
-   .rcvr_buffer  rb 128
+}
-}
 virtual at 0
-  COMPORT COMPORT
+  CONNECTION CONNECTION
 end virtual
-COMPORT_SIZE  equ 256+15*4
+CONNECTION_SIZE equ 7*4
-UART_VERSION  equ 0x00000000
+UART_VERSION  equ 0x12345678        ;debug
-init_com:
+init_uart_service:
-           mov eax, COMPORT_SIZE
+           mov eax, UART_SIZE
            call malloc
            test eax, eax
+           jz .fail
+           mov [com1], eax
-           jz .fail
+           mov edi, eax
            mov ecx, UART_SIZE/4
-           mov [com1], eax
+           xor eax, eax
-           mov edi, eax
+           cld
-           mov ecx, COMPORT_SIZE/4
+           rep stosd
            xor eax, eax
            cmp eax, SRV_GETVERSION
            jne @F
-           mov eax, [ebx+output]
-           mov eax, [eax]
+           mov eax, [ebx+output]
            mov [eax], dword UART_VERSION
            xor eax, eax
            ret
 @@:
            cmp eax, PORT_OPEN
-           jne @F
-           call open_port
-           ret
-           mov esi, [ebx+input]
-           mov ecx, [esi]
-           mov edx, [com1]
-           cmp [edx+COMPORT.connection], ecx
-           je @F
-           mov edx, [com2]
-           cmp [edx+COMPORT.connection], ecx
+           jne @F
+           mov ebx, [ebx+input]
+           mov eax, [ebx]
-           jne .fail
+           call uart_open
+           mov ebx, [ioctl]
+           mov ebx, [ebx+output]
+           mov [ebx], ecx
+           ret
+@@:
-           mov edi, [ebx+output]
+           mov esi, [ebx+input]     ;input buffer
-           call [uart_func+eax*4]  ;edx, esi, edi
-           ret
+           call [uart_func+eax*4]
            ret
 .fail:
            or eax, -1
 restore   output
 restore   out_size
-open_port:
-           ret
-; param
-;  edx= port
-;  esi= input data
-;  edi= output data
-;
-; retval
-;  eax=0 success
-;  eax <>0 error
-align 4
-close_port:
-           call reset
-           mov [edx+COMPORT.connection], 0
-           xor eax, eax
-           ret
+; set mode 2400 bod 8-bit
-; set mode 2400 bod 8-bit
+; disable DTR & RTS
 ; clear FIFO
+; clear pending interrupts
+;
+; param
-; clear pending interrupts
+;  eax= uart
+align 4
+uart_reset:
+           mov esi, eax
+           mov [eax+UART.state], UART_CLOSED
+           mov edx, [eax+UART.base]
+           add edx, MCR_REG
+           xor eax, eax
+           out dx, al        ;clear DTR & RTS
-align 4
-reset:
+           mov eax, esi
-           mov eax, RATE_2400
+           mov ebx, RATE_2400
+           mov ecx, LCR_8BIT+LCR_STOP_1
+           call uart_set_mode.internal
            mov ebx, LCR_8BIT+LCR_STOP_1
-           call set_mode
            mov edx, [esi+UART.base]
-           mov eax,FCR_EFIFO+FCR_CRB+FCR_CXMIT+FCR_FIFO_14
-           mov edx, COM_IIR
+           add edx, IIR_REG
+           mov eax,FCR_EFIFO+FCR_CRB+FCR_CXMIT+FCR_FIFO_14
            out dx, al
 .clear_RB:
-.clear_RB:
+           mov edx, [esi+UART.base]
-           mov edx, COM_LSR
+           add edx, LSR_REG
            in al, dx
            test eax, LSR_DR
            jz @F
+           mov edx, [esi+UART.base]
+           in al, dx
-           mov edx, COM_THR
+           jmp .clear_RB
-           in al, dx
-           jmp .clear_RB
+@@:
-@@:
-           mov eax,IER_RDAI+IER_THRI+IER_LSI
+           mov edx, [esi+UART.base]
+           add edx, IER_REG
-           mov edx, COM_IER
+           mov eax,IER_RDAI+IER_THRI+IER_LSI
            out dx, al
 .clear_IIR:
-.clear_IIR:
+           mov edx, [esi+UART.base]
-           mov edx, COM_IIR
+           add edx, IIR_REG
            in al, dx
            test al, IIR_INTR
+           jnz .done
-           jnz .done
            shr eax, 1
-           shr eax, 1
+           and eax, 3
-           and eax, 3
+           jnz @F
            jnz @F
            mov edx, [esi+UART.base]
-           mov edx, COM_MSR
+           add edx, MSR_REG
            in al, dx
            jmp .clear_IIR
 @@:
            cmp eax, 1
            je .clear_IIR
+           cmp eax, 2
-           cmp eax, 2
+           jne @F
            jne @F
-           mov edx, COM_THR
+           mov edx, [esi+UART.base]
            in al, dx
-           jmp .clear_IIR
-@@:
+           jmp .clear_IIR
+@@:
-           mov edx, COM_LSR
+           mov edx, [esi+UART.base]
-           in al, dx
+           add edx, LSR_REG
-           jmp .clear_IIR
+           in al, dx
-.done:
-           mov edi, rcvr_buff
+           jmp .clear_IIR
-           xor eax, eax
+.done:
-           mov ecx, 256/4
+           lea edi, [esi+UART.rcvr_buffer]
-           mov [rcvr_rp], edi
+           mov ecx, 256/4
-           mov [rcvr_wp], edi
+           xor eax, eax
            mov [rcvr_free], 128
+           mov [esi+UART.rcvr_rp], eax
-;;           mov [rcvr_count], 16
+           mov [esi+UART.rcvr_wp], eax
+           mov [esi+UART.rcvr_free], 128
+           mov [esi+UART.xmit_rp], eax
+           mov [esi+UART.xmit_wp], eax
+           mov [esi+UART.xmit_free], 128
+           cld
-           mov [xmit_rp], xmit_buff
+           rep stosd
-           mov [xmit_wp], xmit_buff
+           ret
-           mov [xmit_free], 128
+; param
+;  esi=  input buffer
+;        +0 connection
+;        +4 rate
+;        +8 mode
+;
+; retval
+;  eax= error code
+align 4
+uart_set_mode:
+           mov eax, [esi]
+           cmp [eax+APPOBJ.magic], 'CNCT'
+           jne .fail
+           cmp [eax+APPOBJ.destroy], uart_close.destroy
+           jne .fail
+           mov eax, [eax+CONNECTION.uart]
+           test eax, eax
-           mov [xmit_count], 16       ;FIFO free
+           jz .fail
-           cld
+           mov ebx, [esi+4]
-           rep stosd
+           mov ecx, [esi+8]
-           ret
+; param
+;  eax= uart
-; param
+;  ebx= baud rate
+;  ecx= mode
-;  eax= rate constant
+align 4
-;  ebx= mode bits
+.internal:
            cmp ebx, RATE_115200
-align 4
+           ja .fail
-set_mode:
-           cmp eax, RATE_115200
+           cmp ecx, LCR_BREAK
-           ja .fail
+           jae .fail
-           cmp ebx, LCR_BREAK
+           mov [eax+UART.rate], ebx
-           jae .fail
+           mov [eax+UART.mode], ecx
-           mov [rate], eax
+           mov esi, eax
+           mov bx, [divisor+ebx*2]
+           mov edx, [esi+UART.base]
+           push edx
+           add edx, LCR_REG
+           in al, dx
+           or al, 0x80
+           out dx, al
+           pop edx
+           mov al, bl
+           out dx, al
+           inc dx
+           mov al, bh
-           mov [mode], ebx
+           out dx, al
+           add edx, LCR_REG-1
+           mov eax, ecx
+           out dx, al
+           xor eax, eax
+           ret
+.fail:
+           or eax, -1
+           ret
+align 4
+uart_set_modem:
+           mov [eax+UART.mcr_reg], ebx
+           mov edx, [eax+UART.base]
+           add edx, MCR_REG
+           mov al, bl
+           out dx, al
+           ret
+; param
+;  eax= port
+;
+; retval
+;  ecx= connection
+;  eax= error code
+align 4
+uart_open:
+           dec eax
+           cmp eax, COM_MAX
+           jae .fail
+           mov esi, [com1+eax*4]             ;uart
+           push esi
+.do_wait:
+           cmp dword [esi+UART.lock],0
+           je .get_lock
+           call change_task
+           jmp .do_wait
+.get_lock:
+           mov eax, 1
+           xchg eax, [esi+UART.lock]
+           test eax, eax
+           jnz .do_wait
+           mov eax, esi                  ;uart
-           mov cx, [divisor+eax*2]
+           call uart_reset
            mov ebx, [CURRENT_TASK]
+           shl ebx, 5
+           mov ebx, [CURRENT_TASK+ebx+4]
+           mov eax, CONNECTION_SIZE
+           call create_kernel_object
+           pop esi                       ;uart
+           test eax, eax
+           jz .fail
+           mov [eax+APPOBJ.magic], 'CNCT'
+           mov [eax+APPOBJ.destroy], uart_close.destroy
+           mov [eax+CONNECTION.uart], esi
+           mov ecx, eax
+           xor eax, eax
+           ret
+.fail:
+           or eax, -1
+           ret
+restore .uart
+; param
+;  esi= input buffer
+align 4
+uart_close:
+           mov eax, [esi]
+           cmp [eax+APPOBJ.magic], 'CNCT'
+           jne .fail
-           mov dx, COM_LCR
+           cmp [eax+APPOBJ.destroy], uart_close.destroy
-           in al, dx
+           jne .fail
-           or al, 0x80
+.destroy:
-           out dx, al
+           push [eax+CONNECTION.uart]
            call destroy_kernel_object   ;eax= object
-           mov dx, COM_THR
+           pop eax                      ;eax= uart
-           mov al, cl
+           test eax, eax
+           jz .fail
-           out dx, al
            mov [eax+UART.state], UART_CLOSED
+           mov [eax+UART.lock], 0 ;release port
-           inc dx
+           xor eax, eax
-           mov al, ch
+           ret
-           out dx, al
+.fail:
            or eax, -1
-           mov dx, COM_LCR
+           ret
-           mov eax, ebx
            out dx, al
-.fail:
+; param
-           ret
+;  eax= uart
+;  ebx= baud rate
 ; param
-;  eax= rate constant
+align 4
 set_rate:
+           cmp ebx, RATE_115200
+           ja .fail
+           mov [eax+UART.rate], ebx
-align 4
+           mov bx, [divisor+ebx*2]
 set_rate:
-           cmp eax, RATE_115200
+           mov edx, [eax+UART.base]
-           ja .fail
+           add edx, LCR_REG
+           in al, dx
+           push eax
-           mov [rate], eax
+           or al, 0x80
-           mov bx, [divisor+eax*2]
+           out dx, al
+           sub edx, LCR_REG
+           mov al, bl
-           mov dx, COM_LCR
+           out dx, al
            in al, dx
-           or al, 0x80
+           inc edx
-           out dx, al
+           mov al, bh
            out dx, al
-           mov dx, COM_THR
-           mov al, bl
+           pop eax
-           out dx, al
+           add edx, LCR_REG-1
            out dx, al
-           inc dx
+.fail:
-           mov al, bh
+           ret
            out dx, al
-           mov dx, COM_LCR
+; param
-           mov eax, [lcr_reg]
-           out dx, al
+;   ebx= uart
-.fail:
-           ret
+align 4
 transmit:
-align 4
+           push esi
+           push edi
+           push ebp
 transmit:
-           push esi
+           mov edx, [ebx+UART.base]
-           mov edx, COM_THR
+           pushfd
+           cli
-           mov [xmit_count], 16
            mov ebp, 16
-           pushfd
+           mov esi, [ebx+UART.xmit_rp]
-           cli
+           lea edi, [ebx+UART.xmit_buffer]
+           mov ecx, [ebx+UART.xmit_free]
-           mov esi, [xmit_rp]
+           cmp ecx, 128
-           mov ecx, [xmit_free]
+           je .exit
 @@:
-           cmp ecx, 128
+           and esi, 127
-           je .exit
+           mov al, [esi+edi]
-@@:
+           inc esi
-           and esi, 127
-           mov al, [xmit_buff+esi]
+           out dx, al
+           inc ecx
+           dec ebp
-           inc esi
+           jz .done
+           cmp ecx, 128
+           jne @B
 .done:
-           out dx, al
+           mov [ebx+UART.xmit_rp], esi
-           inc ecx
+           mov [ebx+UART.xmit_free], ecx
-           dec [xmit_count]
+           mov [ebx+UART.state], UART_TRANSMIT
+.exit:
-           jz .done
+           popfd
+           pop ebp
-           cmp ecx, 128
+           pop edi
-           jne @B
+           pop esi
-.done:
+           ret
-           add esi, xmit_buff
-           mov [xmit_rp], esi
+; param
-           mov [xmit_free], ecx
+;  eax= uart
-           mov [com_state], TRANSMIT
+;  ebx= src
-.exit:
+;  edx= count
-           popfd
+align 4
-           pop esi
+uart_write:
-           ret
+           mov esi, ebx
+           mov edi, [eax+UART.xmit_wp]
+           lea ebx, [eax+UART.xmit_buffer]
-; eax= src
+.write:
-; ebx= count
            test edx, edx
+           jz .done
-align 4
+.wait:
-comm_send:
+           cmp [eax+UART.xmit_free], 0
+           jne .fill
            mov edi, [xmit_wp]
-           mov esi, eax
+           cmp [eax+UART.state], UART_TRANSMIT
-.write:
+           je .wait
            test ebx, ebx
-           jz .done
+           mov ebx, eax
+           push edx
+           call transmit
+           pop edx
+           mov eax, ebx
+           lea ebx, [ebx+UART.xmit_buffer]
-.wait:
+           jmp .write
+.fill:
-           cmp [xmit_free], 0
+           mov ecx, 128
-           jne .fill
+           sub ecx, edi
            jz .clip
-           cmp [com_state], TRANSMIT
+           cmp ecx, [eax+UART.xmit_free]
            ret
 align 4
 isr_line:
+           mov edx, [ebx+UART.base]
-           mov edx, COM_LSR
+           add edx, LSR_REG
            in al, dx
            ret
 align 4
 isr_recieve:
-           mov edx, COM_THR
+           mov edx, [ebx+UART.base]
            in al, dx
            ret
+align 4
-align 4
+isr_modem:
-isr_modem:
+           mov edx, [ebx+UART.base]
-            mov edx, COM_MSR
+           add edx, MSR_REG
+           in al, dx
+           ret
             in al, dx
-            ret
+align 4
+com1        dd 0
+com2        dd 0
+align 4
+uart_func   dd 0                ;SRV_GETVERSION
+            dd 0                ;PORT_OPEN
+            dd uart_close       ;PORT_CLOSE
+            dd 0                ;PORT_RESET
+            dd uart_set_mode    ;PORT_SETMODE
+;            dd uart.get_mode    ;PORT_GETMODE
+;            dd uart.set_mcr     ;PORT_SETMCR
 ;PORT_GETMCR     equ 7
-align 4
+;PORT_READ       equ 8
-uart_func   dd 0            ;get version
+;PORT_WRITE      equ 9
             dd 0            ;open port
             dd close_port
 isr_action  dd isr_modem
-isr_action  dd isr_modem
+            dd transmit
-            dd transmit
-            dd isr_recieve
-            dd isr_line
-divisor     dw 2304, 1536, 1047, 857, 768, 384
-            dw  192,   96,   64,  58,  48,  32
-            dw   24,   16,   12,   6,   3,   2, 1
-sz_uart_srv db 'UART',0
-;version      dd 0x00040000
-align 4
-com1        dd ?
-com2        dd ?
-rcvr_rp     dd ?
-rcvr_wp     dd ?
-rcvr_free   dd ?
-rcvr_count  dd ?
-xmit_rp     dd ?
-xmit_wp     dd ?

Subversion Repositories Kolibri OS

(root)/kernel/branches/flat_kernel/drivers/comport.asm – Rev 405 → 413