Subversion Repositories Kolibri OS

        RBLEN                   = 3 ; Receive buffer size: 0==8K 1==16k 2==32k 3==64k

        RBLEN                   = 3 ; Receive buffer size: 0==8K 1==16k 2==32k 3==64k

        NUM_TX_DESC             = 4

        NUM_TX_DESC             = 4

        DEBUG                   = 1

        DEBUG                   = 1

        __DEBUG_LEVEL__         = 2

        __DEBUG_LEVEL__         = 2             ; 1 = verbose, 2 = errors only

include '../proc32.inc'

include '../proc32.inc'

include '../imports.inc'

include '../imports.inc'

        cmp     [state], 1

        cmp     [state], 1

        jne     .exit

        jne     .exit

        DEBUGF  2, "Loading %s driver\n", my_service

        DEBUGF  1, "Loading driver\n"

        stdcall RegService, my_service, service_proc

        stdcall RegService, my_service, service_proc

        ret

        ret

; We've found the io address, find IRQ now

; We've found the io address, find IRQ now

        PCI_find_irq

        PCI_find_irq

        DEBUGF  2, "Hooking into device, dev:%x, bus:%x, irq:%x, I/O addr:%x\n",\

        DEBUGF  1, "Hooking into device, dev:%x, bus:%x, irq:%x, I/O addr:%x\n",\

        ret

        ret

; If the device was already loaded, find the device number and return it in eax

; If the device was already loaded, find the device number and return it in eax

  .find_devicenum:

  .find_devicenum:

        DEBUGF  2, "Trying to find device number of already registered device\n"

        DEBUGF  1, "Trying to find device number of already registered device\n"

        call    NetPtrToNum                                             ; This kernel procedure converts a pointer to device struct in ebx

        call    NetPtrToNum                                             ; This kernel procedure converts a pointer to device struct in ebx

        mov     eax, edi                                                ; Application wants it in eax instead

        mov     eax, edi                                                ; Application wants it in eax instead

        DEBUGF  2, "Kernel says: %u\n", eax

        DEBUGF  1, "Kernel says: %u\n", eax

        ret

        ret

; If an error occured, remove all allocated data and exit (returning -1 in eax)

; If an error occured, remove all allocated data and exit (returning -1 in eax)

  .destroy:

        ; todo: unregister device from device_list

        ; todo: unregister device from device_list

        ; todo: reset device into virgin state

        ; todo: reset device into virgin state

  .err:

;;

;;

;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;

;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;

align 4

align 4

        DEBUGF  2, "Probing %s device\n", my_service

        DEBUGF  1, "Probing\n"

        PCI_make_bus_master

        PCI_make_bus_master

        mov     [device.hw_ver_id], cl

        mov     [device.hw_ver_id], cl

        mov     ecx, [crosslist+ecx*4]

        mov     ecx, [crosslist+ecx*4]

        DEBUGF  2, "Chip version: %s\n", ecx

        DEBUGF  1, "Chip version: %s\n", ecx

; wake up the chip

; wake up the chip

  .finish_wake_up:

  .finish_wake_up:

        xor     al, al

        xor     al, al

        set_io  0

        set_io  0

        set_io  REG_9346CR

        set_io  REG_9346CR

        out     dx, al

        out     dx, al

        xor     eax, eax

        xor     eax, eax

;;   reset: Set up all registers and descriptors, clear some values

;;   reset: Set up all registers and descriptors, clear some values

;;

;;

;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;

;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;

        DEBUGF  2, "Reset\n"

        DEBUGF  1, "Reset\n"

; attach int handler

; attach int handler

        movzx   eax, [device.irq_line]

        movzx   eax, [device.irq_line]

        DEBUGF  1, "Attaching int handler to irq %x\n", eax:1

        DEBUGF  1, "Attaching int handler to irq %x\n", eax:1

        stdcall AttachIntHandler, eax, int_handler, dword 0

        stdcall AttachIntHandler, eax, int_handler, dword 0

        jnz     @f

        jnz     @f

        DEBUGF  1, "\nCould not attach int handler!\n"

        DEBUGF  2, "Could not attach int handler!\n"

;        or      eax, -1

;        or      eax, -1

;        ret

;        ret

        in      al, dx

        in      al, dx

        test    al, 1 shl BIT_RST

        test    al, 1 shl BIT_RST

        jz      .reset_completed        ; RST remains 1 during reset

        jz      .reset_completed        ; RST remains 1 during reset

        dec     cx

        dec     cx

        jns     .wait_for_reset

        jns     .wait_for_reset

  .reset_completed:

  .reset_completed:

; unlock config and BMCR registers

; unlock config and BMCR registers

        set_io  REG_9346CR

        set_io  REG_9346CR

;;     pointer to device structure in ebx  ;;

;;     pointer to device structure in ebx  ;;

;;                                         ;;

;;                                         ;;

;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;

;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;

align 4

align 4

transmit:

transmit:

        mov     eax, [esp+4]

        mov     eax, [esp+4]

        DEBUGF  1, "To: %x-%x-%x-%x-%x-%x From: %x-%x-%x-%x-%x-%x Type:%x%x\n",\

        DEBUGF  1, "To: %x-%x-%x-%x-%x-%x From: %x-%x-%x-%x-%x-%x Type:%x%x\n",\

        [eax+00]:2,[eax+01]:2,[eax+02]:2,[eax+03]:2,[eax+04]:2,[eax+05]:2,\

        [eax+00]:2,[eax+01]:2,[eax+02]:2,[eax+03]:2,[eax+04]:2,[eax+05]:2,\

        [eax+06]:2,[eax+07]:2,[eax+08]:2,[eax+09]:2,[eax+10]:2,[eax+11]:2,\

        [eax+06]:2,[eax+07]:2,[eax+08]:2,[eax+09]:2,[eax+10]:2,[eax+11]:2,\

        [eax+13]:2,[eax+12]:2

        [eax+13]:2,[eax+12]:2

        popa

        popa

        jmp     .send_packet

        jmp     .send_packet

  .fail:

  .fail:

        DEBUGF  1, "failed!\n"

        DEBUGF  2, "transmit failed!\n"

        stdcall KernelFree, [esp+4]

        stdcall KernelFree, [esp+4]

align 4

align 4

int_handler:

int_handler:

        DEBUGF  1, "\n%s int\n", my_service

        DEBUGF  1, "INT\n"

; find pointer of device wich made IRQ occur

; find pointer of device wich made IRQ occur

        set_io  REG_COMMAND

        set_io  REG_COMMAND

        in      al, dx

        in      al, dx

        test    al, BUFE                        ; test if RX buffer is empty

        test    al, BUFE                        ; test if RX buffer is empty

        jnz     .finish

        jnz     .finish

        DEBUGF  1, "RX: "

        DEBUGF  1, "RX:\n"

        mov     eax, [device.rx_buffer]

        mov     eax, [device.rx_buffer]

        add     eax, [device.rx_data_offset]

        add     eax, [device.rx_data_offset]

        add     eax, 4+3                        ; packet header is 4 bytes long + dword alignment

        add     eax, 4+3                        ; packet header is 4 bytes long + dword alignment

        and     eax, not 3                      ; dword alignment

        and     eax, not 3                      ; dword alignment

        cmp     eax, RX_BUFFER_SIZE

        cmp     eax, RX_BUFFER_SIZE

        DEBUGF  1, "Wrapping"

        DEBUGF  1, "Wrapping\n"

        sub     eax, RX_BUFFER_SIZE

        sub     eax, RX_BUFFER_SIZE

  .no_wrap:

  .no_wrap:

        mov     [device.rx_data_offset], eax

        mov     [device.rx_data_offset], eax

        jmp     .receive                        ; check for multiple packets

        jmp     .receive                        ; check for multiple packets

  .reset_rx:

  .reset_rx:

        test    byte [eax], (1 shl BIT_CRC)

        test    byte [eax], (1 shl BIT_CRC)

        DEBUGF  2, "\nCRC error!\n"

        DEBUGF  2, "RX: CRC error!\n"

  .no_crc_error:

  .no_crc_error:

        jz      .no_fae_error

        jz      .no_fae_error

        DEBUGF  1, "\nFrame alignment error!\n"

        DEBUGF  2, "RX: Frame alignment error!\n"

  .no_fae_error:

  .no_fae_error:

  @@:

  @@:

        test    ax, ISR_RXOVW

        test    ax, ISR_RXOVW

        jz      @f

        jz      @f

        DEBUGF  2, "RX-buffer overflow!\n"

        DEBUGF  2, "RX:buffer overflow!\n"

        set_io  0

        set_io  0

        set_io  REG_ISR

        set_io  REG_ISR

; Packet underrun?

; Packet underrun?

  @@:

  @@:

        test    ax, ISR_PUN

        test    ax, ISR_PUN

        jz      @f

        jz      @f

        DEBUGF  2, "Packet underrun!\n"

        DEBUGF  2, "RX:Packet underrun!\n"

;----------------------------------------------------

;----------------------------------------------------

; Receive FIFO overflow ?

; Receive FIFO overflow ?

  @@:

  @@:

        test    ax, ISR_FIFOOVW

        test    ax, ISR_FIFOOVW

        push    ax

        push    ax

        DEBUGF  2, "RX fifo overflow!\n"

        DEBUGF  2, "RX:fifo overflow!\n"

        jz      .fail

        jz      .fail

        call    cable

        call    cable

  .fail:

        DEBUGF  1, "\n"

  .fail:

        pop     edi esi ebx

        pop     edi esi ebx

        xor     eax, eax

        xor     eax, eax

;;;;;;;;;;;;;;;;;;;;;;;

;;;;;;;;;;;;;;;;;;;;;;;

align 4

align 4

        DEBUGF  2, "Writing MAC: "

        DEBUGF  1, "Writing MAC\n"

; disable all in command registers

; disable all in command registers

; disable writing

; disable writing

        set_io  REG_9346CR

        set_io  REG_9346CR

        xor     eax, eax

        xor     eax, eax

        out     dx, al

        out     dx, al

        DEBUGF  2, "ok!\n"

        DEBUGF  1, "MAC write ok!\n"

;; Read MAC address ;;

;; Read MAC address ;;

;;                  ;;

;;                  ;;

;;;;;;;;;;;;;;;;;;;;;;

;;;;;;;;;;;;;;;;;;;;;;

        DEBUGF  2, "Reading MAC: "

        DEBUGF  2, "Reading MAC:\n"

        set_io  0

        set_io  0

        lea     edi, [device.mac]

        lea     edi, [device.mac]