WebSVN – Kolibri OS – Diff – /drivers/ethernet/i8255x.asm


;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;
;;                                                                 ;;
;; Copyright (C) KolibriOS team 2004-2015. All rights reserved.    ;;
;; Distributed under terms of the GNU General Public License       ;;
;;                                                                 ;;
;; i8255x (Intel eepro 100) driver for KolibriOS                   ;;
;;                                                                 ;;
;;    Written by hidnplayr@kolibrios.org                           ;;
;;                                                                 ;;
;;          GNU GENERAL PUBLIC LICENSE                             ;;
;;             Version 2, June 1991                                ;;
;;                                                                 ;;
;; Some parts of this driver are based on the code of eepro100.c   ;;
;;  from linux.                                                    ;;
;;                                                                 ;;
;; Intel's programming manual for i8255x:                          ;;
;; http://www.intel.com/design/network/manuals/8255x_opensdm.htm   ;;
;;                                                                 ;;
;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;
 
;TODO: use more RX buffers
 
format PE DLL native
entry START
 
        CURRENT_API             = 0x0200
        COMPATIBLE_API          = 0x0100
        API_VERSION             = (COMPATIBLE_API shl 16) + CURRENT_API
 
        MAX_DEVICES             = 16
 
        TX_RING_SIZE            = 16
 
        DEBUG                   = 1
        __DEBUG__               = 1
        __DEBUG_LEVEL__         = 2             ; 1 = verbose, 2 = errors only
 
section '.flat' readable writable executable
 
include '../proc32.inc'
include '../struct.inc'
include '../macros.inc'
include '../fdo.inc'
include '../netdrv.inc'
 
; Serial EEPROM
 
EE_SK           = 1 shl 0      ; serial clock
EE_CS           = 1 shl 1      ; chip select
EE_DI           = 1 shl 2      ; data in
EE_DO           = 1 shl 3      ; data out
EE_MASK         = EE_SK + EE_CS + EE_DI + EE_DO
 
; opcodes, first bit is start bit and must be 1
EE_READ         = 110b
EE_WRITE        = 101b
EE_ERASE        = 111b
 
; The SCB accepts the following controls for the Tx and Rx units:
 
CU_START        = 0x0010
CU_RESUME       = 0x0020
CU_STATSADDR    = 0x0040
CU_SHOWSTATS    = 0x0050        ; Dump statistics counters.
CU_CMD_BASE     = 0x0060        ; Base address to add CU commands.
CU_DUMPSTATS    = 0x0070        ; Dump then reset stats counters.
 
RX_START        = 0x0001
RX_RESUME       = 0x0002
RX_ABORT        = 0x0004
RX_ADDR_LOAD    = 0x0006
RX_RESUMENR     = 0x0007
INT_MASK        = 0x0100
DRVR_INT        = 0x0200        ; Driver generated interrupt
 
CmdIASetup      = 0x0001
CmdConfigure    = 0x0002
CmdTx           = 0x0004
CmdTxFlex       = 0x0008
Cmdsuspend      = 0x4000
 
CmdRxFlex       = 0x0008
 
reg_scb_status  = 0
reg_scb_cmd     = 2
reg_scb_ptr     = 4
reg_port        = 8
reg_eeprom      = 14
reg_mdi_ctrl    = 16
 
phy_100a        = 0x000003E0
phy_100c        = 0x035002A8
phy_82555_tx    = 0x015002A8
phy_nsc_tx      = 0x5C002000
phy_82562_et    = 0x033002A8
phy_82562_em    = 0x032002A8
phy_82562_ek    = 0x031002A8
phy_82562_eh    = 0x017002A8
phy_82552_v     = 0xd061004d
phy_unknown     = 0xFFFFFFFF
 
mac_82557_D100_A        = 0
mac_82557_D100_B        = 1     
mac_82557_D100_C        = 2     
mac_82558_D101_A4       = 4     
mac_82558_D101_B0       = 5     
mac_82559_D101M         = 8     
mac_82559_D101S         = 9     
mac_82550_D102          = 12    
mac_82550_D102_C        = 13    
mac_82551_E             = 14    
mac_82551_F             = 15    
mac_82551_10            = 16    
mac_unknown             = 0xFF
 
struct  rxfd
 
        status          dw ?
        command         dw ?
        link            dd ?
        rx_buf_addr     dd ?
        count           dw ?
        size            dw ?
        packet          rb 1500
 
ends
 
struct  txfd
 
        status          dw ?
        command         dw ?
        link            dd ?
        desc_addr       dd ?
        count           dd ?
 
        buf_addr        dd ?
        buf_size        dd ?
        virt_addr       dd ?
                        dd ?            ; alignment
 
ends
 
struc   confcmd {
 
        .status         dw ?
        .command        dw ?
        .link           dd ?
        .data           rb 64
 
}
 
struc   lstats {
 
        .tx_good_frames         dd ?
        .tx_coll16_errs         dd ?
        .tx_late_colls          dd ?
        .tx_underruns           dd ?
        .tx_lost_carrier        dd ?
        .tx_deferred            dd ?
        .tx_one_colls           dd ?
        .tx_multi_colls         dd ?
        .tx_total_colls         dd ?
 
        .rx_good_frames         dd ?
        .rx_crc_errs            dd ?
        .rx_align_errs          dd ?
        .rx_resource_errs       dd ?
        .rx_overrun_errs        dd ?
        .rx_colls_errs          dd ?
        .rx_runt_errs           dd ?
 
}
 
struct  device          ETH_DEVICE
 
        io_addr         dd ?
        pci_bus         dd ?
        pci_dev         dd ?
        rx_desc         dd ?
        cur_tx          dd ?
        last_tx         dd ?
        ee_bus_width    db ?
        irq_line        db ?
 
        rb 0x100 - ($ and 0xff) ; align 256
        tx_ring         rb TX_RING_SIZE*sizeof.txfd
 
        rb 0x100 - ($ and 0xff) ; align 256
        confcmd         confcmd
 
        rb 0x100 - ($ and 0xff) ; align 256
        lstats          lstats
 
ends
 
;;;;;;;;;;;;;;;;;;;;;;;;;;;;
;;                        ;;
;; proc START             ;;
;;                        ;;
;; (standard driver proc) ;;
;;;;;;;;;;;;;;;;;;;;;;;;;;;;
 
proc START c, state:dword
 
        cmp [state], 1
        jne .exit
 
  .entry:
 
        DEBUGF 1,"Loading driver\n"
        invoke  RegService, my_service, service_proc
        ret
 
  .fail:
  .exit:
        xor eax, eax
        ret
 
endp
 
 
;;;;;;;;;;;;;;;;;;;;;;;;;;;;
;;                        ;;
;; proc SERVICE_PROC      ;;
;;                        ;;
;; (standard driver proc) ;;
;;;;;;;;;;;;;;;;;;;;;;;;;;;;
 
align 4
proc service_proc stdcall, ioctl:dword
 
        mov     edx, [ioctl]
        mov     eax, [edx + IOCTL.io_code]
 
;------------------------------------------------------
 
        cmp     eax, 0 ;SRV_GETVERSION
        jne     @F
 
        cmp     [edx + IOCTL.out_size], 4
        jb      .fail
        mov     eax, [edx + IOCTL.output]
        mov     [eax], dword API_VERSION
 
        xor     eax, eax
        ret
 
;------------------------------------------------------
  @@:
        cmp     eax, 1 ;SRV_HOOK
        jne     .fail
 
        cmp     [edx + IOCTL.inp_size], 3               ; Data input must be at least 3 bytes
        jb      .fail
 
        mov     eax, [edx + IOCTL.input]
        cmp     byte [eax], 1                           ; 1 means device number and bus number (pci) are given
        jne     .fail                                   ; other types arent supported for this card yet
 
; check if the device is already listed
 
        mov     esi, device_list
        mov     ecx, [devices]
        test    ecx, ecx
        jz      .firstdevice
 
;        mov     eax, [edx + IOCTL.input]                ; get the pci bus and device numbers
        mov     ax , [eax+1]                            ;
  .nextdevice:
        mov     ebx, [esi]
        cmp     al, byte[ebx + device.pci_bus]
        jne     @f
        cmp     ah, byte[ebx + device.pci_dev]
        je      .find_devicenum                         ; Device is already loaded, let's find it's device number
       @@:
        add     esi, 4
        loop    .nextdevice
 
 
; This device doesnt have its own eth_device structure yet, lets create one
  .firstdevice:
        cmp     [devices], MAX_DEVICES                  ; First check if the driver can handle one more card
        jae     .fail
 
        allocate_and_clear ebx, sizeof.device, .fail      ; Allocate the buffer for device structure
 
; Fill in the direct call addresses into the struct
 
        mov     [ebx + device.reset], reset
        mov     [ebx + device.transmit], transmit
        mov     [ebx + device.unload], unload
        mov     [ebx + device.name], my_service
 
; save the pci bus and device numbers
 
        mov     eax, [edx + IOCTL.input]
        movzx   ecx, byte[eax+1]
        mov     [ebx + device.pci_bus], ecx
        movzx   ecx, byte[eax+2]
        mov     [ebx + device.pci_dev], ecx
 
; Now, it's time to find the base io addres of the PCI device
 
        stdcall PCI_find_io, [ebx + device.pci_bus], [ebx + device.pci_dev]
        mov     [ebx + device.io_addr], eax
 
; We've found the io address, find IRQ now
 
        invoke  PciRead8, [ebx + device.pci_bus], [ebx + device.pci_dev], PCI_header00.interrupt_line
        mov     [ebx + device.irq_line], al
 
        DEBUGF  1,"Hooking into device, dev:%x, bus:%x, irq:%x, addr:%x\n",\
        [ebx + device.pci_dev]:1,[ebx + device.pci_bus]:1,[ebx + device.irq_line]:1,[ebx + device.io_addr]:4
 
; Ok, the eth_device structure is ready, let's probe the device
 
        pushf
        cli                     ; disable ints untilm initialisation is done
 
        call    probe                                                   ; this function will output in eax
        test    eax, eax
        jnz     .err                                                    ; If an error occured, exit
 
        mov     eax, [devices]                                          ; Add the device structure to our device list
        mov     [device_list+4*eax], ebx                                ; (IRQ handler uses this list to find device)
        inc     [devices]                                               ;
 
        popf
 
        mov     [ebx + device.type], NET_TYPE_ETH
        invoke  NetRegDev
 
        cmp     eax, -1
        je      .err
 
        ret
 
; If the device was already loaded, find the device number and return it in eax
 
  .find_devicenum:
        DEBUGF  2,"Trying to find device number of already registered device\n"
        invoke  NetPtrToNum                                             ; This kernel procedure converts a pointer to device struct in ebx
                                                                        ; into a device number in edi
        mov     eax, edi                                                ; Application wants it in eax instead
        DEBUGF  2,"Kernel says: %u\n", eax
        ret
 
; If an error occured, remove all allocated data and exit (returning -1 in eax)
 
  .err:
        invoke  KernelFree, ebx
 
  .fail:
        or      eax, -1
        ret
 
;------------------------------------------------------
endp
 
 
 
 
 
;;/\/\/\/\/\/\/\/\/\/\/\/\/\/\/\/\/\/\/\/\/\/\/\/\/\/\/\/\/\/\/\/\/\/\/\/\;;
;;                                                                        ;;
;;        Actual Hardware dependent code starts here                      ;;
;;                                                                        ;;
;;/\/\/\/\/\/\/\/\/\/\/\/\/\/\/\/\/\/\/\/\/\/\/\/\/\/\/\/\/\/\/\/\/\/\/\/\;;
 
 
unload:
        ; TODO: (in this particular order)
        ;
        ; - Stop the device
        ; - Detach int handler
        ; - Remove device from local list (device_list)
        ; - call unregister function in kernel
        ; - Remove all allocated structures and buffers the card used
 
        or      eax, -1
 
        ret
 
 
;-------------
;
; Probe
;
;-------------
 
align 4
probe:
 
        DEBUGF  1,"Probing\n"
 
; Make the device a bus master
        invoke  PciRead32, [ebx + device.pci_bus], [ebx + device.pci_dev], PCI_header00.command
        or      al, PCI_CMD_MASTER
        invoke  PciWrite32, [ebx + device.pci_bus], [ebx + device.pci_dev], PCI_header00.command, eax
 
;---------------------------
; First, identify the device
 
        invoke  PciRead32, [ebx + device.pci_bus], [ebx + device.pci_dev], PCI_header.vendor_id ; get device/vendor id
 
        DEBUGF  1,"Vendor_id=0x%x\n", ax
 
        cmp     ax, 0x8086
        jne     .notfound
        shr     eax, 16
 
        DEBUGF  1,"Device_id=0x%x\n", ax
 
        mov     ecx, DEVICE_IDs
        mov     edi, device_id_list
        repne   scasw
        jne     .notfound
        jmp     .found
 
  .notfound:
        DEBUGF  2,"Unsupported device!\n"
        or      eax, -1
        ret
 
  .found:
 
        call    ee_get_width
        call    MAC_read_eeprom
 
        ;;; TODO: detect phy
 
 
 
;----------
;
;  Reset
;
;----------
 
align 4
reset:
 
        movzx   eax, [ebx + device.irq_line]
        DEBUGF  1,"Attaching int handler to irq %x\n", eax:1
        invoke  AttachIntHandler, eax, int_handler, ebx
        test    eax, eax
        jnz     @f
        DEBUGF  2,"Could not attach int handler!\n"
        or      eax, -1
        ret
  @@:
 
        DEBUGF  1,"Resetting\n"
 
;---------------
; reset the card
 
        set_io  [ebx + device.io_addr], 0
        set_io  [ebx + device.io_addr], reg_port
        xor     eax, eax        ; Software Reset
        out     dx, eax
 
        mov     esi, 10
        invoke  Sleep           ; Give the card time to warm up.
 
;---------------------------------
; Tell device where to store stats
 
        lea     eax, [ebx + device.lstats.tx_good_frames]      ; lstats
        invoke  GetPhysAddr
        set_io  [ebx + device.io_addr], 0
        set_io  [ebx + device.io_addr], reg_scb_ptr
        out     dx, eax
 
        set_io  [ebx + device.io_addr], reg_scb_cmd
        mov     ax, CU_STATSADDR or INT_MASK
        out     dx, ax
        call    cmd_wait
 
;------------------------
; setup RX base addr to 0
 
        set_io  [ebx + device.io_addr], reg_scb_ptr
        xor     eax, eax
        out     dx, eax
 
        set_io  [ebx + device.io_addr], reg_scb_cmd
        mov     ax, RX_ADDR_LOAD or INT_MASK
        out     dx, ax
        call    cmd_wait
 
;-----------------------------
; Create RX and TX descriptors
 
        call    init_rx_ring
        test    eax, eax
        jz      .error
 
        call    init_tx_ring
 
 
;---------
; Start RX
 
        DEBUGF  1, "Starting RX"
 
        set_io  [ebx + device.io_addr], 0
        set_io  [ebx + device.io_addr], reg_scb_ptr
        mov     eax, [ebx + device.rx_desc]
        invoke  GetPhysAddr
        add     eax, NET_BUFF.data
        out     dx, eax
 
        set_io  [ebx + device.io_addr], reg_scb_cmd
        mov     ax, RX_START or INT_MASK
        out     dx, ax
        call    cmd_wait
 
;----------
; Set-up TX
 
        set_io  [ebx + device.io_addr], reg_scb_ptr
        xor     eax, eax
        out     dx, eax
 
        set_io  [ebx + device.io_addr], reg_scb_cmd
        mov     ax, CU_CMD_BASE or INT_MASK
        out     dx, ax
        call    cmd_wait
 
;-------------------------
; Individual address setup
 
        mov     [ebx + device.confcmd.command], CmdIASetup + Cmdsuspend
        mov     [ebx + device.confcmd.status], 0
        lea     eax, [ebx + device.tx_ring]
        invoke  GetPhysAddr
        mov     [ebx + device.confcmd.link], eax
        lea     edi, [ebx + device.confcmd.data]
        lea     esi, [ebx + device.mac]
        movsd
        movsw
 
        set_io  [ebx + device.io_addr], reg_scb_ptr
        lea     eax, [ebx + device.confcmd.status]
        invoke  GetPhysAddr
        out     dx, eax
 
        set_io  [ebx + device.io_addr], reg_scb_cmd
        mov     ax, CU_START or INT_MASK
        out     dx, ax
        call    cmd_wait
 
;-------------
; Configure CU
 
        mov     [ebx + device.confcmd.command], CmdConfigure + Cmdsuspend
        mov     [ebx + device.confcmd.status], 0
        lea     eax, [ebx + device.confcmd.status]
        invoke  GetPhysAddr
        mov     [ebx + device.confcmd.link], eax
 
        mov     esi, confcmd_data
        lea     edi, [ebx + device.confcmd.data]
        mov     ecx, 22
        rep     movsb
 
        mov     byte[ebx + device.confcmd.data + 1], 0x88  ; fifo of 8 each
        mov     byte[ebx + device.confcmd.data + 4], 0
        mov     byte[ebx + device.confcmd.data + 5], 0x80
        mov     byte[ebx + device.confcmd.data + 15], 0x48
        mov     byte[ebx + device.confcmd.data + 19], 0x80
        mov     byte[ebx + device.confcmd.data + 21], 0x05
 
        set_io  [ebx + device.io_addr], reg_scb_ptr
        lea     eax, [ebx + device.confcmd.status]
        invoke  GetPhysAddr
        out     dx, eax
 
        set_io  [ebx + device.io_addr], reg_scb_cmd
        mov     ax, CU_START                            ; expect Interrupts from now on
        out     dx, ax
        call    cmd_wait
 
        DEBUGF  1,"Reset complete\n"
        mov     [ebx + device.mtu], 1514
 
; Set link state to unknown
        mov     [ebx + device.state], ETH_LINK_UNKNOWN
 
        xor     eax, eax        ; indicate that we have successfully reset the card
        ret
 
  .error:
        or      eax, -1
        ret
 
 
align 4
init_rx_ring:
 
        DEBUGF  1,"Creating ring\n"
 
;---------------------
; build rxfd structure
 
        invoke  NetAlloc, 2000
        test    eax, eax
        jz      .out_of_mem
        mov     [ebx + device.rx_desc], eax
        mov     esi, eax
        invoke  GetPhysAddr
        add     eax, NET_BUFF.data
        mov     [esi + sizeof.NET_BUFF + rxfd.status], 0x0000
        mov     [esi + sizeof.NET_BUFF + rxfd.command], 0xc000    ; End of list + Suspend
        mov     [esi + sizeof.NET_BUFF + rxfd.link], eax
        mov     [esi + sizeof.NET_BUFF + rxfd.count], 0
        mov     [esi + sizeof.NET_BUFF + rxfd.size], 1528
 
        ret
 
  .out_of_mem:
 
        ret
 
 
 
 
align 4
init_tx_ring:
 
        DEBUGF  1,"Creating TX ring\n"
 
        lea     esi, [ebx + device.tx_ring]
        mov     eax, esi
        invoke  GetPhysAddr
        mov     ecx, TX_RING_SIZE
  .next_desc:
        mov     [esi + txfd.status], 0
        mov     [esi + txfd.command], 0
        lea     edx, [eax + txfd.buf_addr]
        mov     [esi + txfd.desc_addr], edx
        add     eax, sizeof.txfd
        mov     [esi + txfd.link], eax
        mov     [esi + txfd.count], 0x01208000          ; One buffer, 0x20 bytes of transmit threshold, end of frame
        add     esi, sizeof.txfd
        dec     ecx
        jnz     .next_desc
 
        lea     eax, [ebx + device.tx_ring]
        invoke  GetPhysAddr
        mov     dword[ebx + device.tx_ring + sizeof.txfd*(TX_RING_SIZE-1) + txfd.link], eax
 
        mov     [ebx + device.cur_tx], 0
        mov     [ebx + device.last_tx], 0
 
        ret
 
 
;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;
;;                                         ;;
;; Transmit                                ;;
;;                                         ;;
;; In: pointer to device structure in ebx  ;;
;;                                         ;;
;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;
 
proc transmit stdcall bufferptr
 
        pushf
        cli
 
        mov     esi, [bufferptr]
        DEBUGF  1,"Transmitting packet, buffer:%x, size:%u\n", [bufferptr], [esi + NET_BUFF.length]
        lea     eax, [esi + NET_BUFF.data]
        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+06]:2,[eax+07]:2,[eax+08]:2,[eax+09]:2,[eax+10]:2,[eax+11]:2,\
        [eax+13]:2,[eax+12]:2
 
        cmp     [esi + NET_BUFF.length], 1514
        ja      .fail
        cmp     [esi + NET_BUFF.length], 60
        jb      .fail
 
        ; Get current TX descriptor
        mov     edi, [ebx + device.cur_tx]
        mov     eax, sizeof.txfd
        mul     edi
        lea     edi, [ebx + device.tx_ring + eax]
 
        ; Check if current descriptor is free or still in use
        cmp     [edi + txfd.status], 0
        jne     .fail
 
        ; Fill in status and command values
        mov     [edi + txfd.status], 0
        mov     [edi + txfd.command], Cmdsuspend + CmdTx + CmdTxFlex ;;;+ 1 shl 15 ;;; EL bit
        mov     [edi + txfd.count], 0x01208000
 
        ; Fill in buffer address and size
        mov     [edi + txfd.virt_addr], esi
        mov     eax, esi
        add     eax, [esi + NET_BUFF.offset]
        push    edi
        invoke  GetPhysAddr
        pop     edi
        mov     [edi + txfd.buf_addr], eax
        mov     ecx, [esi + NET_BUFF.length]
        mov     [edi + txfd.buf_size], ecx
 
        ; Inform device of the new/updated transmit descriptor
        mov     eax, edi
        invoke  GetPhysAddr
        set_io  [ebx + device.io_addr], 0
        set_io  [ebx + device.io_addr], reg_scb_ptr
        out     dx, eax
 
        ; Start the transmit
        set_io  [ebx + device.io_addr], reg_scb_cmd
        mov     ax, CU_START
        out     dx, ax
 
        ; Update stats
        inc     [ebx + device.packets_tx]
        add     dword[ebx + device.bytes_tx], ecx
        adc     dword[ebx + device.bytes_tx + 4], 0
 
        ; Wait for command to complete
        call    cmd_wait
 
        inc     [ebx + device.cur_tx]
        and     [ebx + device.cur_tx], TX_RING_SIZE - 1
 
        DEBUGF  1,"Transmit OK\n"
        popf
        xor     eax, eax
        ret
 
  .fail:
        DEBUGF  2,"Transmit failed!\n"
        invoke  NetFree, [bufferptr]
        popf
        or      eax, -1
        ret
 
endp
 
 
;;;;;;;;;;;;;;;;;;;;;;;
;;                   ;;
;; Interrupt handler ;;
;;                   ;;
;;;;;;;;;;;;;;;;;;;;;;;
 
align 4
int_handler:
 
        push    ebx esi edi
 
        DEBUGF  1,"INT\n"
 
; find pointer of device wich made IRQ occur
 
        mov     ecx, [devices]
        test    ecx, ecx
        jz      .nothing
        mov     esi, device_list
  .nextdevice:
        mov     ebx, [esi]
 
;        set_io  [ebx + device.io_addr], 0              ; reg_scb_status = 0
        set_io  [ebx + device.io_addr], reg_scb_status
        in      ax, dx
        out     dx, ax                              ; send it back to ACK
        test    ax, ax
        jnz     .got_it
  .continue:
        add     esi, 4
        dec     ecx
        jnz     .nextdevice
  .nothing:
        pop     edi esi ebx
        xor     eax, eax
 
        ret                                         ; If no device was found, abort (The irq was probably for a device, not registered to this driver)
 
  .got_it:
 
        DEBUGF  1,"Device: %x Status: %x\n", ebx, ax
 
        test    ax, 1 shl 14    ; did we receive a frame?
        jz      .no_rx
 
        push    ax
 
        DEBUGF  1,"Receiving\n"
 
        push    ebx
  .rx_loop:
        pop     ebx
 
        mov     esi, [ebx + device.rx_desc]
        cmp     [esi + sizeof.NET_BUFF + rxfd.status], 0        ; we could also check bits C and OK (bit 15 and 13)
        je      .nodata
 
        DEBUGF  1,"rxfd status=0x%x\n", [esi + sizeof.NET_BUFF + rxfd.status]:4
 
        movzx   ecx, [esi + sizeof.NET_BUFF + rxfd.count]
        and     ecx, 0x3fff
 
        push    ebx
        push    .rx_loop
        push    esi
        mov     [esi + NET_BUFF.length], ecx
        mov     [esi + NET_BUFF.device], ebx
        mov     [esi + NET_BUFF.offset], NET_BUFF.data + rxfd.packet
 
; Update stats
        add     dword [ebx + device.bytes_rx], ecx
        adc     dword [ebx + device.bytes_rx + 4], 0
        inc     dword [ebx + device.packets_rx]
 
; allocate new descriptor
 
        invoke  NetAlloc, 2000
        mov     [ebx + device.rx_desc], eax
        mov     esi, eax
        invoke  GetPhysAddr
        add     eax, NET_BUFF.data
        mov     [esi + sizeof.NET_BUFF + rxfd.status], 0x0000
        mov     [esi + sizeof.NET_BUFF + rxfd.command], 0xc000    ; End of list + Suspend
        mov     [esi + sizeof.NET_BUFF + rxfd.link], eax
        mov     [esi + sizeof.NET_BUFF + rxfd.count], 0
        mov     [esi + sizeof.NET_BUFF + rxfd.size], 1528
 
; restart RX
 
        set_io  [ebx + device.io_addr], 0
        set_io  [ebx + device.io_addr], reg_scb_ptr
;        mov     eax, [ebx + device.rx_desc]
;        invoke  GetPhysAddr
;        add     eax, NET_BUFF.data
        out     dx, eax
 
        set_io  [ebx + device.io_addr], reg_scb_cmd
        mov     ax, RX_START
        out     dx, ax
        call    cmd_wait
 
; And give packet to kernel
        jmp     [EthInput]
 
  .nodata:
        DEBUGF  1, "no more data\n"
        pop     ax
 
  .no_rx:
 
        test    ax, 1 shl 13
        jz      .no_tx
        DEBUGF  1, "Command completed\n"
 
        push    eax
  .loop_tx:
        mov     edi, [ebx + device.last_tx]
        mov     eax, sizeof.txfd
        mul     eax
        lea     edi, [ebx + device.tx_ring + eax]
 
        cmp     [edi + txfd.status], 0
        je      .tx_done
 
        cmp     [edi + txfd.virt_addr], 0
        je      .tx_done
 
        DEBUGF  1,"Freeing buffer 0x%x\n", [edi + txfd.virt_addr]
 
        push    [edi + txfd.virt_addr]
        mov     [edi + txfd.virt_addr], 0
        invoke  NetFree
 
        inc     [ebx + device.last_tx]
        and     [ebx + device.last_tx], TX_RING_SIZE - 1
 
        jmp     .loop_tx
  .tx_done:
        pop     eax
  .no_tx:
 
        and     ax, 00111100b
        cmp     ax, 00001000b
        jne     .fail
 
 
 
 
        DEBUGF  2, "Out of resources!\n"
 
 
;        call    init_rx_ring
 
 
 
 
 
;        test    eax, eax
 
;        jz      .fail
 
; restart RX
        set_io  [ebx + device.io_addr], 0
        set_io  [ebx + device.io_addr], reg_scb_ptr
        mov     eax, [ebx + device.rx_desc]
        invoke  GetPhysAddr
        add     eax, NET_BUFF.data
        out     dx, eax
 
        set_io  [ebx + device.io_addr], reg_scb_cmd
        mov     ax, RX_START
        out     dx, ax
        call    cmd_wait
 
  .fail:
        pop     edi esi ebx
        xor     eax, eax
        inc     eax
 
        ret
 
 
 
 
align 4
cmd_wait:
 
        in      al, dx
        test    al, al
        jnz     cmd_wait
 
        ret
 
 
 
 
 
 
align 4
ee_read:        ; esi = address to read
 
        DEBUGF  1,"Eeprom read from 0x%x\n", esi
 
        set_io  [ebx + device.io_addr], 0
        set_io  [ebx + device.io_addr], reg_eeprom
 
;-----------------------------------------------------
; Prepend start bit + read opcode to the address field
; and shift it to the very left bits of esi
 
        mov     cl, 29
        sub     cl, [ebx + device.ee_bus_width]
        shl     esi, cl
        or      esi, EE_READ shl 29
 
        movzx   ecx, [ebx + device.ee_bus_width]
        add     ecx, 3
 
        mov     al, EE_CS
        out     dx, al
        call    udelay
 
;-----------------------
; Write this to the chip
 
  .loop:
        mov     al, EE_CS + EE_SK
        shl     esi, 1
        jnc     @f
        or      al, EE_DI
       @@:
        out     dx, al
        call    udelay
 
        and     al, not EE_SK
        out     dx, al
        call    udelay
 
        loop    .loop
 
;------------------------------
; Now read the data from eeprom
 
        xor     esi, esi
        mov     ecx, 16
 
  .loop2:
        shl     esi, 1
        mov     al, EE_CS + EE_SK
        out     dx, al
        call    udelay
 
        in      al, dx
        test    al, EE_DO
        jz      @f
        inc     esi
       @@:
 
        mov     al, EE_CS
        out     dx, al
        call    udelay
 
        loop    .loop2
 
;-----------------------
; de-activate the eeprom
 
        xor     ax, ax
        out     dx, ax
 
 
        DEBUGF  1,"0x%x\n", esi:4
        ret
 
 
 
align 4
ee_write:       ; esi = address to write to, di = data
 
        DEBUGF  1,"Eeprom write 0x%x to 0x%x\n", di, esi
 
        set_io  [ebx + device.io_addr], 0
        set_io  [ebx + device.io_addr], reg_eeprom
 
;-----------------------------------------------------
; Prepend start bit + write opcode to the address field
; and shift it to the very left bits of esi
 
        mov     cl, 29
        sub     cl, [ebx + device.ee_bus_width]
        shl     esi, cl
        or      esi, EE_WRITE shl 29
 
        movzx   ecx, [ebx + device.ee_bus_width]
        add     ecx, 3
 
        mov     al, EE_CS       ; enable chip
        out     dx, al
 
;-----------------------
; Write this to the chip
 
  .loop:
        mov     al, EE_CS + EE_SK
        shl     esi, 1
        jnc     @f
        or      al, EE_DI
       @@:
        out     dx, al
        call    udelay
 
        and     al, not EE_SK
        out     dx, al
        call    udelay
 
        loop    .loop
 
;-----------------------------
; Now write the data to eeprom
 
        mov     ecx, 16
 
  .loop2:
        mov     al, EE_CS + EE_SK
        shl     di, 1
        jnc     @f
        or      al, EE_DI
       @@:
        out     dx, al
        call    udelay
 
        and     al, not EE_SK
        out     dx, al
        call    udelay
 
        loop    .loop2
 
;-----------------------
; de-activate the eeprom
 
        xor     al, al
        out     dx, al
 
 
        ret
 
 
 
align 4
ee_get_width:
 
        set_io  [ebx + device.io_addr], 0
        set_io  [ebx + device.io_addr], reg_eeprom
 
        mov     al, EE_CS      ; activate eeprom
        out     dx, al
        call    udelay
 
        mov     si, EE_READ shl 13
        xor     ecx, ecx
  .loop:
        mov     al, EE_CS + EE_SK
        shl     si, 1
        jnc     @f
        or      al, EE_DI
       @@:
        out     dx, al
        call    udelay
 
        and     al, not EE_SK
        out     dx, al
        call    udelay
 
        inc     ecx
 
        cmp     ecx, 15
        jae     .give_up
 
        in      al, dx
        test    al, EE_DO
        jnz     .loop
 
        xor     al, al
        out     dx, al          ; de-activate eeprom
 
        sub     cl, 3           ; dont count the opcode bits
        mov     [ebx + device.ee_bus_width], cl
        DEBUGF  1, "Eeprom width=%u bit\n", ecx
 
        ret
 
  .give_up:
        DEBUGF  2, "Eeprom not found!\n"
 
        xor     al, al
        out     dx, al          ; de-activate eeprom
 
        ret
 
 
; Wait a minimum of 2µs
udelay:
        pusha
        mov     esi, 1
        invoke  Sleep
        popa
 
        ret
 
 
 
; cx = phy addr
; dx = phy reg addr
 
; ax = data
 
align 4
mdio_read:
 
        DEBUGF  1,"MDIO read\n"
 
        shl     ecx, 21                 ; PHY addr
        shl     edx, 16                 ; PHY reg addr
 
        mov     eax, ecx
        or      eax, edx
        or      eax, 10b shl 26         ; read opcode
 
        set_io  [ebx + device.io_addr], 0
        set_io  [ebx + device.io_addr], reg_mdi_ctrl
        out     dx, eax
 
  .wait:
        call    udelay
        in      eax, dx
        test    eax, 1 shl 28           ; ready bit
        jz      .wait
 
        ret
 
; ax = data
; cx = phy addr
; dx = phy reg addr
 
; ax = data
 
align 4
mdio_write:
 
        DEBUGF  1,"MDIO write\n"
 
        and     eax, 0xffff
 
        shl     ecx, 21                 ; PHY addr
        shl     edx, 16                 ; PHY reg addr
 
        or      eax, ecx
        or      eax, edx
        or      eax, 01b shl 26         ; write opcode
 
        set_io  [ebx + device.io_addr], 0
        set_io  [ebx + device.io_addr], reg_mdi_ctrl
        out     dx, eax
 
  .wait:
        call    udelay
        in      eax, dx
        test    eax, 1 shl 28           ; ready bit
        jz      .wait
 
        ret
 
read_mac:
 
        ret
 
 
 
align 4
MAC_read_eeprom:
 
        mov     esi, 0
        call    ee_read
        mov     word[ebx + device.mac], si
 
        mov     esi, 1
        call    ee_read
        mov     word[ebx + device.mac+2], si
 
        mov     esi, 2
        call    ee_read
        mov     word[ebx + device.mac+4], si
 
 
        ret
 
 
align 4
MAC_write:
 
;;;;
 
        ret
 
 
 
 
; End of code
 
 
data fixups
end data
 
include '../peimport.inc'
 
my_service      db 'I8255X', 0                    ; max 16 chars include zero
devicename      db 'Intel Etherexpress pro/100', 0
 
confcmd_data    db 22, 0x08, 0, 0, 0, 0x80, 0x32, 0x03, 1
                db 0, 0x2e, 0, 0x60, 0, 0xf2, 0x48, 0, 0x40, 0xf2
                db 0x80, 0x3f, 0x05                                     ; 22 bytes total
 
 
device_id_list:
 
        dw 0x1029
        dw 0x1030
        dw 0x1031
        dw 0x1032
        dw 0x1033
        dw 0x1034
        dw 0x1038
        dw 0x1039
        dw 0x103A
        dw 0x103B
        dw 0x103C
        dw 0x103D
        dw 0x103E
        dw 0x1050
        dw 0x1051
        dw 0x1052
        dw 0x1053
        dw 0x1054
        dw 0x1055
        dw 0x1056
        dw 0x1057
        dw 0x1059
        dw 0x1064
        dw 0x1065
        dw 0x1066
        dw 0x1067
        dw 0x1068
        dw 0x1069
        dw 0x106A
        dw 0x106B
        dw 0x1091
        dw 0x1092
        dw 0x1093
        dw 0x1094
        dw 0x1095
        dw 0x10fe
        dw 0x1209
        dw 0x1229
        dw 0x2449
        dw 0x2459
        dw 0x245D
        dw 0x27DC
 
DEVICE_IDs = ($ - device_id_list) / 2
 
include_debug_strings                           ; All data wich FDO uses will be included here
 
align 4
devices         dd 0                              ; number of currently running devices
device_list     rd MAX_DEVICES                    ; This list contains all pointers to device structures the driver is handling

Rev 5525	Rev 5560
1	;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;	1	;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;
2	;; ;;	2	;; ;;
3	;; Copyright (C) KolibriOS team 2004-2015. All rights reserved. ;;	3	;; Copyright (C) KolibriOS team 2004-2015. All rights reserved. ;;
4	;; Distributed under terms of the GNU General Public License ;;	4	;; Distributed under terms of the GNU General Public License ;;
5	;; ;;	5	;; ;;
6	;; i8255x (Intel eepro 100) driver for KolibriOS ;;	6	;; i8255x (Intel eepro 100) driver for KolibriOS ;;
7	;; ;;	7	;; ;;
8	;; Written by hidnplayr@kolibrios.org ;;	8	;; Written by hidnplayr@kolibrios.org ;;
9	;; ;;	9	;; ;;
10	;; GNU GENERAL PUBLIC LICENSE ;;	10	;; GNU GENERAL PUBLIC LICENSE ;;
11	;; Version 2, June 1991 ;;	11	;; Version 2, June 1991 ;;
12	;; ;;	12	;; ;;
13	;; Some parts of this driver are based on the code of eepro100.c ;;	13	;; Some parts of this driver are based on the code of eepro100.c ;;
14	;; from linux. ;;	14	;; from linux. ;;
15	;; ;;	15	;; ;;
16	;; Intel's programming manual for i8255x: ;;	16	;; Intel's programming manual for i8255x: ;;
17	;; http://www.intel.com/design/network/manuals/8255x_opensdm.htm ;;	17	;; http://www.intel.com/design/network/manuals/8255x_opensdm.htm ;;
18	;; ;;	18	;; ;;
19	;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;	19	;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;
-		20
20		21	;TODO: use more RX buffers
21		22
22	format PE DLL native	23	format PE DLL native
23	entry START	24	entry START
24		25
25	CURRENT_API = 0x0200	26	CURRENT_API = 0x0200
26	COMPATIBLE_API = 0x0100	27	COMPATIBLE_API = 0x0100
27	API_VERSION = (COMPATIBLE_API shl 16) + CURRENT_API	28	API_VERSION = (COMPATIBLE_API shl 16) + CURRENT_API
28		29
29	MAX_DEVICES = 16	30	MAX_DEVICES = 16
30		31
31	TX_RING_SIZE = 16	32	TX_RING_SIZE = 16
32		33
33	DEBUG = 1	34	DEBUG = 1
34	__DEBUG__ = 1	35	__DEBUG__ = 1
35	__DEBUG_LEVEL__ = 2 ; 1 = verbose, 2 = errors only	36	__DEBUG_LEVEL__ = 2 ; 1 = verbose, 2 = errors only
36		37
37	section '.flat' readable writable executable	38	section '.flat' readable writable executable
38		39
39	include '../proc32.inc'	40	include '../proc32.inc'
40	include '../struct.inc'	41	include '../struct.inc'
41	include '../macros.inc'	42	include '../macros.inc'
42	include '../fdo.inc'	43	include '../fdo.inc'
43	include '../netdrv.inc'	44	include '../netdrv.inc'
44		45
45	; Serial EEPROM	46	; Serial EEPROM
46		47
47	EE_SK = 1 shl 0 ; serial clock	48	EE_SK = 1 shl 0 ; serial clock
48	EE_CS = 1 shl 1 ; chip select	49	EE_CS = 1 shl 1 ; chip select
49	EE_DI = 1 shl 2 ; data in	50	EE_DI = 1 shl 2 ; data in
50	EE_DO = 1 shl 3 ; data out	51	EE_DO = 1 shl 3 ; data out
51	EE_MASK = EE_SK + EE_CS + EE_DI + EE_DO	52	EE_MASK = EE_SK + EE_CS + EE_DI + EE_DO
52		53
53	; opcodes, first bit is start bit and must be 1	54	; opcodes, first bit is start bit and must be 1
54	EE_READ = 110b	55	EE_READ = 110b
55	EE_WRITE = 101b	56	EE_WRITE = 101b
56	EE_ERASE = 111b	57	EE_ERASE = 111b
57		58
58	; The SCB accepts the following controls for the Tx and Rx units:	59	; The SCB accepts the following controls for the Tx and Rx units:
59		60
60	CU_START = 0x0010	61	CU_START = 0x0010
61	CU_RESUME = 0x0020	62	CU_RESUME = 0x0020
62	CU_STATSADDR = 0x0040	63	CU_STATSADDR = 0x0040
63	CU_SHOWSTATS = 0x0050 ; Dump statistics counters.	64	CU_SHOWSTATS = 0x0050 ; Dump statistics counters.
64	CU_CMD_BASE = 0x0060 ; Base address to add CU commands.	65	CU_CMD_BASE = 0x0060 ; Base address to add CU commands.
65	CU_DUMPSTATS = 0x0070 ; Dump then reset stats counters.	66	CU_DUMPSTATS = 0x0070 ; Dump then reset stats counters.
66		67
67	RX_START = 0x0001	68	RX_START = 0x0001
68	RX_RESUME = 0x0002	69	RX_RESUME = 0x0002
69	RX_ABORT = 0x0004	70	RX_ABORT = 0x0004
70	RX_ADDR_LOAD = 0x0006	71	RX_ADDR_LOAD = 0x0006
71	RX_RESUMENR = 0x0007	72	RX_RESUMENR = 0x0007
72	INT_MASK = 0x0100	73	INT_MASK = 0x0100
73	DRVR_INT = 0x0200 ; Driver generated interrupt	74	DRVR_INT = 0x0200 ; Driver generated interrupt
74		75
75	CmdIASetup = 0x0001	76	CmdIASetup = 0x0001
76	CmdConfigure = 0x0002	77	CmdConfigure = 0x0002
77	CmdTx = 0x0004	78	CmdTx = 0x0004
78	CmdTxFlex = 0x0008	79	CmdTxFlex = 0x0008
79	Cmdsuspend = 0x4000	80	Cmdsuspend = 0x4000
80		81
81	CmdRxFlex = 0x0008	82	CmdRxFlex = 0x0008
82		83
83	reg_scb_status = 0	84	reg_scb_status = 0
84	reg_scb_cmd = 2	85	reg_scb_cmd = 2
85	reg_scb_ptr = 4	86	reg_scb_ptr = 4
86	reg_port = 8	87	reg_port = 8
87	reg_eeprom = 14	88	reg_eeprom = 14
88	reg_mdi_ctrl = 16	89	reg_mdi_ctrl = 16
89		90
90	phy_100a = 0x000003E0	91	phy_100a = 0x000003E0
91	phy_100c = 0x035002A8	92	phy_100c = 0x035002A8
92	phy_82555_tx = 0x015002A8	93	phy_82555_tx = 0x015002A8
93	phy_nsc_tx = 0x5C002000	94	phy_nsc_tx = 0x5C002000
94	phy_82562_et = 0x033002A8	95	phy_82562_et = 0x033002A8
95	phy_82562_em = 0x032002A8	96	phy_82562_em = 0x032002A8
96	phy_82562_ek = 0x031002A8	97	phy_82562_ek = 0x031002A8
97	phy_82562_eh = 0x017002A8	98	phy_82562_eh = 0x017002A8
98	phy_82552_v = 0xd061004d	99	phy_82552_v = 0xd061004d
99	phy_unknown = 0xFFFFFFFF	100	phy_unknown = 0xFFFFFFFF
100		101
101	mac_82557_D100_A = 0	102	mac_82557_D100_A = 0
102	mac_82557_D100_B = 1	103	mac_82557_D100_B = 1
103	mac_82557_D100_C = 2	104	mac_82557_D100_C = 2
104	mac_82558_D101_A4 = 4	105	mac_82558_D101_A4 = 4
105	mac_82558_D101_B0 = 5	106	mac_82558_D101_B0 = 5
106	mac_82559_D101M = 8	107	mac_82559_D101M = 8
107	mac_82559_D101S = 9	108	mac_82559_D101S = 9
108	mac_82550_D102 = 12	109	mac_82550_D102 = 12
109	mac_82550_D102_C = 13	110	mac_82550_D102_C = 13
110	mac_82551_E = 14	111	mac_82551_E = 14
111	mac_82551_F = 15	112	mac_82551_F = 15
112	mac_82551_10 = 16	113	mac_82551_10 = 16
113	mac_unknown = 0xFF	114	mac_unknown = 0xFF
114		115
115	struct rxfd	116	struct rxfd
116		117
117	status dw ?	118	status dw ?
118	command dw ?	119	command dw ?
119	link dd ?	120	link dd ?
120	rx_buf_addr dd ?	121	rx_buf_addr dd ?
121	count dw ?	122	count dw ?
122	size dw ?	123	size dw ?
123	packet rb 1500	124	packet rb 1500
124		125
125	ends	126	ends
126		127
127	struct txfd	128	struct txfd
128		129
129	status dw ?	130	status dw ?
130	command dw ?	131	command dw ?
131	link dd ?	132	link dd ?
132	desc_addr dd ?	133	desc_addr dd ?
133	count dd ?	134	count dd ?
134		135
135	buf_addr dd ?	136	buf_addr dd ?
136	buf_size dd ?	137	buf_size dd ?
137	virt_addr dd ?	138	virt_addr dd ?
138	dd ? ; alignment	139	dd ? ; alignment
139		140
140	ends	141	ends
141		142
142	struc confcmd {	143	struc confcmd {
143		144
144	.status dw ?	145	.status dw ?
145	.command dw ?	146	.command dw ?
146	.link dd ?	147	.link dd ?
147	.data rb 64	148	.data rb 64
148		149
149	}	150	}
150		151
151	struc lstats {	152	struc lstats {
152		153
153	.tx_good_frames dd ?	154	.tx_good_frames dd ?
154	.tx_coll16_errs dd ?	155	.tx_coll16_errs dd ?
155	.tx_late_colls dd ?	156	.tx_late_colls dd ?
156	.tx_underruns dd ?	157	.tx_underruns dd ?
157	.tx_lost_carrier dd ?	158	.tx_lost_carrier dd ?
158	.tx_deferred dd ?	159	.tx_deferred dd ?
159	.tx_one_colls dd ?	160	.tx_one_colls dd ?
160	.tx_multi_colls dd ?	161	.tx_multi_colls dd ?
161	.tx_total_colls dd ?	162	.tx_total_colls dd ?
162		163
163	.rx_good_frames dd ?	164	.rx_good_frames dd ?
164	.rx_crc_errs dd ?	165	.rx_crc_errs dd ?
165	.rx_align_errs dd ?	166	.rx_align_errs dd ?
166	.rx_resource_errs dd ?	167	.rx_resource_errs dd ?
167	.rx_overrun_errs dd ?	168	.rx_overrun_errs dd ?
168	.rx_colls_errs dd ?	169	.rx_colls_errs dd ?
169	.rx_runt_errs dd ?	170	.rx_runt_errs dd ?
170		171
171	}	172	}
172		173
173	struct device ETH_DEVICE	174	struct device ETH_DEVICE
174		175
175	io_addr dd ?	176	io_addr dd ?
176	pci_bus dd ?	177	pci_bus dd ?
177	pci_dev dd ?	178	pci_dev dd ?
178	rx_desc dd ?	179	rx_desc dd ?
179	cur_tx dd ?	180	cur_tx dd ?
180	last_tx dd ?	181	last_tx dd ?
181	ee_bus_width db ?	182	ee_bus_width db ?
182	irq_line db ?	183	irq_line db ?
183		184
184	rb 0x100 - ($ and 0xff) ; align 256	185	rb 0x100 - ($ and 0xff) ; align 256
185	tx_ring rb TX_RING_SIZE*sizeof.txfd	186	tx_ring rb TX_RING_SIZE*sizeof.txfd
186		187
187	rb 0x100 - ($ and 0xff) ; align 256	188	rb 0x100 - ($ and 0xff) ; align 256
188	confcmd confcmd	189	confcmd confcmd
189		190
190	rb 0x100 - ($ and 0xff) ; align 256	191	rb 0x100 - ($ and 0xff) ; align 256
191	lstats lstats	192	lstats lstats
192		193
193	ends	194	ends
194		195
195	;;;;;;;;;;;;;;;;;;;;;;;;;;;;	196	;;;;;;;;;;;;;;;;;;;;;;;;;;;;
196	;; ;;	197	;; ;;
197	;; proc START ;;	198	;; proc START ;;
198	;; ;;	199	;; ;;
199	;; (standard driver proc) ;;	200	;; (standard driver proc) ;;
200	;;;;;;;;;;;;;;;;;;;;;;;;;;;;	201	;;;;;;;;;;;;;;;;;;;;;;;;;;;;
201		202
202	proc START c, state:dword	203	proc START c, state:dword
203		204
204	cmp [state], 1	205	cmp [state], 1
205	jne .exit	206	jne .exit
206		207
207	.entry:	208	.entry:
208		209
209	DEBUGF 1,"Loading driver\n"	210	DEBUGF 1,"Loading driver\n"
210	invoke RegService, my_service, service_proc	211	invoke RegService, my_service, service_proc
211	ret	212	ret
212		213
213	.fail:	214	.fail:
214	.exit:	215	.exit:
215	xor eax, eax	216	xor eax, eax
216	ret	217	ret
217		218
218	endp	219	endp
219		220
220		221
221	;;;;;;;;;;;;;;;;;;;;;;;;;;;;	222	;;;;;;;;;;;;;;;;;;;;;;;;;;;;
222	;; ;;	223	;; ;;
223	;; proc SERVICE_PROC ;;	224	;; proc SERVICE_PROC ;;
224	;; ;;	225	;; ;;
225	;; (standard driver proc) ;;	226	;; (standard driver proc) ;;
226	;;;;;;;;;;;;;;;;;;;;;;;;;;;;	227	;;;;;;;;;;;;;;;;;;;;;;;;;;;;
227		228
228	align 4	229	align 4
229	proc service_proc stdcall, ioctl:dword	230	proc service_proc stdcall, ioctl:dword
230		231
231	mov edx, [ioctl]	232	mov edx, [ioctl]
232	mov eax, [edx + IOCTL.io_code]	233	mov eax, [edx + IOCTL.io_code]
233		234
234	;------------------------------------------------------	235	;------------------------------------------------------
235		236
236	cmp eax, 0 ;SRV_GETVERSION	237	cmp eax, 0 ;SRV_GETVERSION
237	jne @F	238	jne @F
238		239
239	cmp [edx + IOCTL.out_size], 4	240	cmp [edx + IOCTL.out_size], 4
240	jb .fail	241	jb .fail
241	mov eax, [edx + IOCTL.output]	242	mov eax, [edx + IOCTL.output]
242	mov [eax], dword API_VERSION	243	mov [eax], dword API_VERSION
243		244
244	xor eax, eax	245	xor eax, eax
245	ret	246	ret
246		247
247	;------------------------------------------------------	248	;------------------------------------------------------
248	@@:	249	@@:
249	cmp eax, 1 ;SRV_HOOK	250	cmp eax, 1 ;SRV_HOOK
250	jne .fail	251	jne .fail
251		252
252	cmp [edx + IOCTL.inp_size], 3 ; Data input must be at least 3 bytes	253	cmp [edx + IOCTL.inp_size], 3 ; Data input must be at least 3 bytes
253	jb .fail	254	jb .fail
254		255
255	mov eax, [edx + IOCTL.input]	256	mov eax, [edx + IOCTL.input]
256	cmp byte [eax], 1 ; 1 means device number and bus number (pci) are given	257	cmp byte [eax], 1 ; 1 means device number and bus number (pci) are given
257	jne .fail ; other types arent supported for this card yet	258	jne .fail ; other types arent supported for this card yet
258		259
259	; check if the device is already listed	260	; check if the device is already listed
260		261
261	mov esi, device_list	262	mov esi, device_list
262	mov ecx, [devices]	263	mov ecx, [devices]
263	test ecx, ecx	264	test ecx, ecx
264	jz .firstdevice	265	jz .firstdevice
265		266
266	; mov eax, [edx + IOCTL.input] ; get the pci bus and device numbers	267	; mov eax, [edx + IOCTL.input] ; get the pci bus and device numbers
267	mov ax , [eax+1] ;	268	mov ax , [eax+1] ;
268	.nextdevice:	269	.nextdevice:
269	mov ebx, [esi]	270	mov ebx, [esi]
270	cmp al, byte[ebx + device.pci_bus]	271	cmp al, byte[ebx + device.pci_bus]
271	jne @f	272	jne @f
272	cmp ah, byte[ebx + device.pci_dev]	273	cmp ah, byte[ebx + device.pci_dev]
273	je .find_devicenum ; Device is already loaded, let's find it's device number	274	je .find_devicenum ; Device is already loaded, let's find it's device number
274	@@:	275	@@:
275	add esi, 4	276	add esi, 4
276	loop .nextdevice	277	loop .nextdevice
277		278
278		279
279	; This device doesnt have its own eth_device structure yet, lets create one	280	; This device doesnt have its own eth_device structure yet, lets create one
280	.firstdevice:	281	.firstdevice:
281	cmp [devices], MAX_DEVICES ; First check if the driver can handle one more card	282	cmp [devices], MAX_DEVICES ; First check if the driver can handle one more card
282	jae .fail	283	jae .fail
283		284
284	allocate_and_clear ebx, sizeof.device, .fail ; Allocate the buffer for device structure	285	allocate_and_clear ebx, sizeof.device, .fail ; Allocate the buffer for device structure
285		286
286	; Fill in the direct call addresses into the struct	287	; Fill in the direct call addresses into the struct
287		288
288	mov [ebx + device.reset], reset	289	mov [ebx + device.reset], reset
289	mov [ebx + device.transmit], transmit	290	mov [ebx + device.transmit], transmit
290	mov [ebx + device.unload], unload	291	mov [ebx + device.unload], unload
291	mov [ebx + device.name], my_service	292	mov [ebx + device.name], my_service
292		293
293	; save the pci bus and device numbers	294	; save the pci bus and device numbers
294		295
295	mov eax, [edx + IOCTL.input]	296	mov eax, [edx + IOCTL.input]
296	movzx ecx, byte[eax+1]	297	movzx ecx, byte[eax+1]
297	mov [ebx + device.pci_bus], ecx	298	mov [ebx + device.pci_bus], ecx
298	movzx ecx, byte[eax+2]	299	movzx ecx, byte[eax+2]
299	mov [ebx + device.pci_dev], ecx	300	mov [ebx + device.pci_dev], ecx
300		301
301	; Now, it's time to find the base io addres of the PCI device	302	; Now, it's time to find the base io addres of the PCI device
302		303
303	stdcall PCI_find_io, [ebx + device.pci_bus], [ebx + device.pci_dev]	304	stdcall PCI_find_io, [ebx + device.pci_bus], [ebx + device.pci_dev]
304	mov [ebx + device.io_addr], eax	305	mov [ebx + device.io_addr], eax
305		306
306	; We've found the io address, find IRQ now	307	; We've found the io address, find IRQ now
307		308
308	invoke PciRead8, [ebx + device.pci_bus], [ebx + device.pci_dev], PCI_header00.interrupt_line	309	invoke PciRead8, [ebx + device.pci_bus], [ebx + device.pci_dev], PCI_header00.interrupt_line
309	mov [ebx + device.irq_line], al	310	mov [ebx + device.irq_line], al
310		311
311	DEBUGF 1,"Hooking into device, dev:%x, bus:%x, irq:%x, addr:%x\n",\	312	DEBUGF 1,"Hooking into device, dev:%x, bus:%x, irq:%x, addr:%x\n",\
312	[ebx + device.pci_dev]:1,[ebx + device.pci_bus]:1,[ebx + device.irq_line]:1,[ebx + device.io_addr]:4	313	[ebx + device.pci_dev]:1,[ebx + device.pci_bus]:1,[ebx + device.irq_line]:1,[ebx + device.io_addr]:4
313		314
314	; Ok, the eth_device structure is ready, let's probe the device	315	; Ok, the eth_device structure is ready, let's probe the device
315		316
316	pushf	317	pushf
317	cli ; disable ints untilm initialisation is done	318	cli ; disable ints untilm initialisation is done
318		319
319	call probe ; this function will output in eax	320	call probe ; this function will output in eax
320	test eax, eax	321	test eax, eax
321	jnz .err ; If an error occured, exit	322	jnz .err ; If an error occured, exit
322		323
323	mov eax, [devices] ; Add the device structure to our device list	324	mov eax, [devices] ; Add the device structure to our device list
324	mov [device_list+4*eax], ebx ; (IRQ handler uses this list to find device)	325	mov [device_list+4*eax], ebx ; (IRQ handler uses this list to find device)
325	inc [devices] ;	326	inc [devices] ;
326		327
327	popf	328	popf
328		329
329	mov [ebx + device.type], NET_TYPE_ETH	330	mov [ebx + device.type], NET_TYPE_ETH
330	invoke NetRegDev	331	invoke NetRegDev
331		332
332	cmp eax, -1	333	cmp eax, -1
333	je .err	334	je .err
334		335
335	ret	336	ret
336		337
337	; If the device was already loaded, find the device number and return it in eax	338	; If the device was already loaded, find the device number and return it in eax
338		339
339	.find_devicenum:	340	.find_devicenum:
340	DEBUGF 2,"Trying to find device number of already registered device\n"	341	DEBUGF 2,"Trying to find device number of already registered device\n"
341	invoke NetPtrToNum ; This kernel procedure converts a pointer to device struct in ebx	342	invoke NetPtrToNum ; This kernel procedure converts a pointer to device struct in ebx
342	; into a device number in edi	343	; into a device number in edi
343	mov eax, edi ; Application wants it in eax instead	344	mov eax, edi ; Application wants it in eax instead
344	DEBUGF 2,"Kernel says: %u\n", eax	345	DEBUGF 2,"Kernel says: %u\n", eax
345	ret	346	ret
346		347
347	; If an error occured, remove all allocated data and exit (returning -1 in eax)	348	; If an error occured, remove all allocated data and exit (returning -1 in eax)
348		349
349	.err:	350	.err:
350	invoke KernelFree, ebx	351	invoke KernelFree, ebx
351		352
352	.fail:	353	.fail:
353	or eax, -1	354	or eax, -1
354	ret	355	ret
355		356
356	;------------------------------------------------------	357	;------------------------------------------------------
357	endp	358	endp
358		359
359		360
360		361
361		362
362		363
363	;;/\/\/\/\/\/\/\/\/\/\/\/\/\/\/\/\/\/\/\/\/\/\/\/\/\/\/\/\/\/\/\/\/\/\/\/\;;	364	;;/\/\/\/\/\/\/\/\/\/\/\/\/\/\/\/\/\/\/\/\/\/\/\/\/\/\/\/\/\/\/\/\/\/\/\/\;;
364	;; ;;	365	;; ;;
365	;; Actual Hardware dependent code starts here ;;	366	;; Actual Hardware dependent code starts here ;;
366	;; ;;	367	;; ;;
367	;;/\/\/\/\/\/\/\/\/\/\/\/\/\/\/\/\/\/\/\/\/\/\/\/\/\/\/\/\/\/\/\/\/\/\/\/\;;	368	;;/\/\/\/\/\/\/\/\/\/\/\/\/\/\/\/\/\/\/\/\/\/\/\/\/\/\/\/\/\/\/\/\/\/\/\/\;;
368		369
369		370
370	unload:	371	unload:
371	; TODO: (in this particular order)	372	; TODO: (in this particular order)
372	;	373	;
373	; - Stop the device	374	; - Stop the device
374	; - Detach int handler	375	; - Detach int handler
375	; - Remove device from local list (device_list)	376	; - Remove device from local list (device_list)
376	; - call unregister function in kernel	377	; - call unregister function in kernel
377	; - Remove all allocated structures and buffers the card used	378	; - Remove all allocated structures and buffers the card used
378		379
379	or eax,-1	380	or eax, -1
380		-
381	ret	381	ret
382		382
383		383
384	;-------------	384	;-------------
385	;	385	;
386	; Probe	386	; Probe
387	;	387	;
388	;-------------	388	;-------------
389		389
390	align 4	390	align 4
391	probe:	391	probe:
392		392
393	DEBUGF 1,"Probing\n"	393	DEBUGF 1,"Probing\n"
394		394
395	; Make the device a bus master	395	; Make the device a bus master
396	invoke PciRead32, [ebx + device.pci_bus], [ebx + device.pci_dev], PCI_header00.command	396	invoke PciRead32, [ebx + device.pci_bus], [ebx + device.pci_dev], PCI_header00.command
397	or al, PCI_CMD_MASTER	397	or al, PCI_CMD_MASTER
398	invoke PciWrite32, [ebx + device.pci_bus], [ebx + device.pci_dev], PCI_header00.command, eax	398	invoke PciWrite32, [ebx + device.pci_bus], [ebx + device.pci_dev], PCI_header00.command, eax
399		399
400	;---------------------------	400	;---------------------------
401	; First, identify the device	401	; First, identify the device
402		402
403	invoke PciRead32, [ebx + device.pci_bus], [ebx + device.pci_dev], PCI_header.vendor_id ; get device/vendor id	403	invoke PciRead32, [ebx + device.pci_bus], [ebx + device.pci_dev], PCI_header.vendor_id ; get device/vendor id
404		404
405	DEBUGF 1,"Vendor_id=0x%x\n", ax	405	DEBUGF 1,"Vendor_id=0x%x\n", ax
406		406
407	cmp ax, 0x8086	407	cmp ax, 0x8086
408	jne .notfound	408	jne .notfound
409	shr eax, 16	409	shr eax, 16
410		410
411	DEBUGF 1,"Device_id=0x%x\n", ax	411	DEBUGF 1,"Device_id=0x%x\n", ax
412		412
413	mov ecx, DEVICE_IDs	413	mov ecx, DEVICE_IDs
414	mov edi, device_id_list	414	mov edi, device_id_list
415	repne scasw	415	repne scasw
416	jne .notfound	416	jne .notfound
417	jmp .found	417	jmp .found
418		418
419	.notfound:	419	.notfound:
420	DEBUGF 2,"Unsupported device!\n"	420	DEBUGF 2,"Unsupported device!\n"
421	or eax, -1	421	or eax, -1
422	ret	422	ret
423		423
424	.found:	424	.found:
425		425
426	call ee_get_width	426	call ee_get_width
427	call MAC_read_eeprom	427	call MAC_read_eeprom
428		428
429	;;; TODO: detect phy	429	;;; TODO: detect phy
430		430
431		431
432		432
433	;----------	433	;----------
434	;	434	;
435	; Reset	435	; Reset
436	;	436	;
437	;----------	437	;----------
438		438
439	align 4	439	align 4
440	reset:	440	reset:
441		441
442	movzx eax, [ebx + device.irq_line]	442	movzx eax, [ebx + device.irq_line]
443	DEBUGF 1,"Attaching int handler to irq %x\n", eax:1	443	DEBUGF 1,"Attaching int handler to irq %x\n", eax:1
444	invoke AttachIntHandler, eax, int_handler, ebx	444	invoke AttachIntHandler, eax, int_handler, ebx
445	test eax, eax	445	test eax, eax
446	jnz @f	446	jnz @f
447	DEBUGF 2,"Could not attach int handler!\n"	447	DEBUGF 2,"Could not attach int handler!\n"
448	or eax, -1	448	or eax, -1
449	ret	449	ret
450	@@:	450	@@:
451		451
452	DEBUGF 1,"Resetting\n"	452	DEBUGF 1,"Resetting\n"
453		453
454	;---------------	454	;---------------
455	; reset the card	455	; reset the card
456		456
457	set_io [ebx + device.io_addr], 0	457	set_io [ebx + device.io_addr], 0
458	set_io [ebx + device.io_addr], reg_port	458	set_io [ebx + device.io_addr], reg_port
459	xor eax, eax ; Software Reset	459	xor eax, eax ; Software Reset
460	out dx, eax	460	out dx, eax
461		461
462	mov esi, 10	462	mov esi, 10
463	invoke Sleep ; Give the card time to warm up.	463	invoke Sleep ; Give the card time to warm up.
464		464
465	;---------------------------------	465	;---------------------------------
466	; Tell device where to store stats	466	; Tell device where to store stats
467		467
468	lea eax, [ebx + device.lstats.tx_good_frames] ; lstats	468	lea eax, [ebx + device.lstats.tx_good_frames] ; lstats
469	invoke GetPhysAddr	469	invoke GetPhysAddr
470	set_io [ebx + device.io_addr], 0	470	set_io [ebx + device.io_addr], 0
471	set_io [ebx + device.io_addr], reg_scb_ptr	471	set_io [ebx + device.io_addr], reg_scb_ptr
472	out dx, eax	472	out dx, eax
473		473
474	set_io [ebx + device.io_addr], reg_scb_cmd	474	set_io [ebx + device.io_addr], reg_scb_cmd
475	mov ax, CU_STATSADDR or INT_MASK	475	mov ax, CU_STATSADDR or INT_MASK
476	out dx, ax	476	out dx, ax
477	call cmd_wait	477	call cmd_wait
478		478
479	;------------------------	479	;------------------------
480	; setup RX base addr to 0	480	; setup RX base addr to 0
481		481
482	set_io [ebx + device.io_addr], reg_scb_ptr	482	set_io [ebx + device.io_addr], reg_scb_ptr
483	xor eax, eax	483	xor eax, eax
484	out dx, eax	484	out dx, eax
485		485
486	set_io [ebx + device.io_addr], reg_scb_cmd	486	set_io [ebx + device.io_addr], reg_scb_cmd
487	mov ax, RX_ADDR_LOAD or INT_MASK	487	mov ax, RX_ADDR_LOAD or INT_MASK
488	out dx, ax	488	out dx, ax
489	call cmd_wait	489	call cmd_wait
490		490
491	;-----------------------------	491	;-----------------------------
492	; Create RX and TX descriptors	492	; Create RX and TX descriptors
493		493
494	call init_rx_ring	494	call init_rx_ring
495	test eax, eax	495	test eax, eax
496	jz .error	496	jz .error
497		497
498	call init_tx_ring	498	call init_tx_ring
499		499

Subversion Repositories Kolibri OS

(root)/drivers/ethernet/i8255x.asm – Rev 5525 → 5560