Subversion Repositories Kolibri OS

;new_app_base    equ 0x60400000

;PROC_BASE       equ OS_BASE+0x0080000

{  .handle      dd ?

   .io_code     dd ?

   .input       dd ?

   .inp_size    dd ?

   .output      dd ?

   .out_size    dd ?

}

;public service_proc

;public version

DRV_EXIT         equ  -1

LCR_6BIT         equ  0x01

LCR_7BIT         equ  0x02

LCR_8BIT         equ  0x03

LCR_STOP_1       equ  0x00

LCR_STOP_2       equ  0x04

LCR_PARITY       equ  0x08

LCR_EVEN         equ  0x10

LCR_STICK        equ  0x20

LCR_BREAK        equ  0x40

LCR_DLAB         equ  0x80

LSR_OE           equ  0x02     ;overrun error

LSR_PE           equ  0x04     ;parity error

LSR_FE           equ  0x08     ;framing error

LSR_BI           equ  0x10     ;break interrupt

LSR_THRE         equ  0x20     ;transmitter holding empty

LSR_TEMT         equ  0x40     ;transmitter empty

LSR_FER          equ  0x80     ;FIFO error

FCR_CRB          equ  0x02     ;clear reciever FIFO

FCR_CXMIT        equ  0x04     ;clear transmitter FIFO

FCR_RDY          equ  0x08     ;set RXRDY and TXRDY pins

FCR_FIFO_1       equ  0x00     ;1  byte trigger

FCR_FIFO_4       equ  0x40     ;4  bytes trigger

FCR_FIFO_8       equ  0x80     ;8  bytes trigger

FCR_FIFO_14      equ  0xC0     ;14 bytes trigger

IER_THRI         equ  0x02     ;transmitter empty interrupt

IER_LSI          equ  0x04     ;line status interrupt

IER_MSI          equ  0x08     ;modem status interrupt

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_LOOP         equ  0x10     ;lopback mode

MSR_DDSR         equ  0x02     ;delta data set redy

MSR_TERI         equ  0x04     ;trailinh edge of ring

MSR_DDCD         equ  0x08     ;delta carrier detect

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

COM_MSR          equ 0x3FE     ;modem status

RATE_75          equ  1

RATE_110         equ  2

RATE_134         equ  3

RATE_150         equ  4

RATE_300         equ  5

RATE_600         equ  6

RATE_1200        equ  7

RATE_1800        equ  8

RATE_2000        equ  9

RATE_2400        equ 10

RATE_3600        equ 11

RATE_4800        equ 12

RATE_7200        equ 13

RATE_9600        equ 14

RATE_19200       equ 15

RATE_38400       equ 16

RATE_57600       equ 17

RATE_115200      equ 18

COM_2            equ  1

COM_3            equ  2

COM_4            equ  3

COM_2_IRQ        equ  3

TRANSMIT         equ  1

{

   .base         dd ?

   .lcr_reg      dd ?

   .mcr_reg      dd ?

   .rate         dd ?

   .mode         dd ?

   .state        dd ?

   .connection   dd ?

   .rcvr_wp      dd ?

   .rcvr_free    dd ?

   .rcvr_count   dd ?

   .xmit_wp      dd ?

   .xmit_free    dd ?

   .xmit_count   dd ?

   .xmit_buffer  rb 128

   .rcvr_buffer  rb 128

}

virtual at 0

  COMPORT COMPORT

end virtual

           mov eax, COMPORT_SIZE

           call malloc

           test eax, eax

           jz .fail

           mov edi, eax

           mov ecx, COMPORT_SIZE/4

           xor eax, eax

           cld

           rep stosd

           stdcall reg_service, sz_uart_srv, uart_proc

           ret

.fail:

           xor eax, eax

           ret

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

PORT_OPEN       equ 1

PORT_CLOSE      equ 2

PORT_RESET      equ 3

PORT_SETMODE    equ 4

PORT_GETMODE    equ 5

PORT_SETMCR     equ 6

PORT_GETMCR     equ 7

PORT_READ       equ 8

PORT_WRITE      equ 9

proc uart_proc stdcall, ioctl:dword

           mov eax, [ebx+io_code]

           cmp eax, PORT_WRITE

           ja .fail

           jne @F

           mov eax, [eax]

           mov [eax], dword UART_VERSION

           xor eax, eax

           ret

@@:

           cmp eax, PORT_OPEN

           jne @F

           call open_port

           ret

           mov ecx, [esi]

           mov edx, [com1]

           cmp [edx+COMPORT.connection], ecx

           je @F

           mov edx, [com2]

           cmp [edx+COMPORT.connection], ecx

           jne .fail

           call [uart_func+eax*4]  ;edx, esi, edi

           ret

           or eax, -1

           ret

restore   io_code

restore   input

restore   inp_size

restore   output

restore   out_size

           ret

;  edx= port

;  esi= input data

;  edi= output data

;

; retval

;  eax=0 success

;  eax <>0 error

close_port:

           mov [edx+COMPORT.connection], 0

           xor eax, eax

           ret

; clear FIFO

; clear pending interrupts

reset:

           mov eax, RATE_2400

           mov ebx, LCR_8BIT+LCR_STOP_1

           call set_mode

           mov edx, COM_IIR

           out dx, al

           mov edx, COM_LSR

           in al, dx

           test eax, LSR_DR

           jz @F

           in al, dx

           jmp .clear_RB

@@:

           mov eax,IER_RDAI+IER_THRI+IER_LSI

           mov edx, COM_IER

           out dx, al

           mov edx, COM_IIR

           in al, dx

           test al, IIR_INTR

           jnz .done

           and eax, 3

           jnz @F

           in al, dx

           jmp .clear_IIR

@@:

           cmp eax, 1

           je .clear_IIR

           jne @F

           in al, dx

           jmp .clear_IIR

@@:

           mov edx, COM_LSR

           in al, dx

           jmp .clear_IIR

           mov edi, rcvr_buff

           xor eax, eax

           mov ecx, 256/4

           mov [rcvr_wp], edi

           mov [rcvr_free], 128

;;           mov [rcvr_count], 16

           mov [xmit_wp], xmit_buff

           mov [xmit_free], 128

           mov [xmit_count], 16       ;FIFO free

           rep stosd

           ret

;  eax= rate constant

;  ebx= mode bits

set_mode:

           cmp eax, RATE_115200

           ja .fail

           jae .fail

           mov [mode], ebx

           in al, dx

           or al, 0x80

           out dx, al

           mov al, cl

           out dx, al

           mov al, ch

           out dx, al

           mov eax, ebx

           out dx, al

.fail:

           ret

;  eax= rate constant

set_rate:

           cmp eax, RATE_115200

           ja .fail

           mov bx, [divisor+eax*2]

           in al, dx

           or al, 0x80

           out dx, al

           mov al, bl

           out dx, al

           mov al, bh

           out dx, al

           mov eax, [lcr_reg]

           out dx, al

.fail:

           ret

transmit:

           push esi

           mov edx, COM_THR

           cli

           mov ecx, [xmit_free]

           je .exit

@@:

           and esi, 127

           mov al, [xmit_buff+esi]

           inc esi

           inc ecx

           dec [xmit_count]

           jz .done

           jne @B

.done:

           add esi, xmit_buff

           mov [xmit_rp], esi

           mov [xmit_free], ecx

           mov [com_state], TRANSMIT

.exit:

           popfd

           pop esi

           ret

; ebx= count

comm_send:

           mov edi, [xmit_wp]

           mov esi, eax

.write:

           test ebx, ebx

           jz .done

.wait:

           cmp [xmit_free], 0

           jne .fill

           je .wait

           jmp .write

.fill:

           mov ecx, xmit_buff+128

           sub ecx, edi

           cmp ecx, [xmit_free]

           jb @F

@@:

           cmp ecx, ebx

           jb @F

           mov ecx, ebx

@@:

           sub [xmit_free], ecx

           sub ebx, ecx

           rep movsb

           jb .write

           sub edi, 128

           jmp .write

           cmp [com_state], TRANSMIT

           je @F

           call transmit

@@:

           ret

com_isr:

           mov dx, COM_IIR

           in  al, dx

           jnz .done

           and eax, 3

           jmp .get_info

.done:

           ret

isr_line:

           mov edx, COM_LSR

           in al, dx

           ret

isr_recieve:

           mov edx, COM_THR

           in al, dx

           ret

isr_modem:

            mov edx, COM_MSR

            in al, dx

            ret

uart_func   dd 0            ;get version

            dd 0            ;open port

            dd close_port

            dd transmit

            dd isr_recieve

            dd isr_line

            dw  192,   96,   64,  58,  48,  32

            dw   24,   16,   12,   6,   3,   2, 1

com2        dd ?

rcvr_wp     dd ?

rcvr_free   dd ?

rcvr_count  dd ?

xmit_wp     dd ?

xmit_free   dd ?

xmit_count  dd ?

mcr_reg     dd ?

rate        dd ?

mode        dd ?

com_state   dd ?

rcvr_buff   rb 128

xmit_buff   rb 128