Subversion Repositories Kolibri OS

Rev

Rev 3205 | Go to most recent revision | Blame | Last modification | View Log | Download | RSS feed

  1. ;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;
  2. ;;                                                                 ;;
  3. ;; Copyright (C) KolibriOS team 2004-2013. All rights reserved.    ;;
  4. ;; Distributed under terms of the GNU General Public License       ;;
  5. ;;                                                                 ;;
  6. ;;  RTL8029/ne2000 driver for KolibriOS                            ;;
  7. ;;                                                                 ;;
  8. ;;  based on RTL8029.asm driver for menuetos                       ;;
  9. ;;  and realtek8029.asm for SolarOS by Eugen Brasoveanu            ;;
  10. ;;                                                                 ;;
  11. ;;    Written by hidnplayr@kolibrios.org                           ;;
  12. ;;     with help from CleverMouse                                  ;;
  13. ;;                                                                 ;;
  14. ;;          GNU GENERAL PUBLIC LICENSE                             ;;
  15. ;;             Version 2, June 1991                                ;;
  16. ;;                                                                 ;;
  17. ;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;
  18.  
  19. format MS COFF
  20.  
  21.         API_VERSION             = 0x01000100
  22.         DRIVER_VERSION          = 5
  23.  
  24.         MAX_DEVICES             = 16
  25.  
  26.         DEBUG                   = 1
  27.         __DEBUG__               = 1
  28.         __DEBUG_LEVEL__         = 1
  29.  
  30. include 'proc32.inc'
  31. include 'imports.inc'
  32. include 'fdo.inc'
  33. include 'netdrv.inc'
  34.  
  35. virtual at ebx
  36.  
  37.         device:
  38.  
  39.         ETH_DEVICE
  40.  
  41.         .io_addr        dd ?
  42.         .irq_line       db ?
  43.         .pci_bus        dd ?
  44.         .pci_dev        dd ?
  45.  
  46.         .flags          db ?
  47.         .vendor         db ?
  48.  
  49.         .memsize        db ?
  50.         .rx_start       db ?
  51.         .tx_start       db ?
  52.         .bmem           dd ?
  53.         .rmem           dd ?
  54.  
  55.         .size = $ - device
  56.  
  57. end virtual
  58.  
  59.  
  60. public START
  61. public service_proc
  62. public version
  63.  
  64.         P0_COMMAND              = 0x00
  65.         P0_PSTART               = 0x01
  66.         P0_PSTOP                = 0x02
  67.         P0_BOUND                = 0x03
  68.         P0_TSR                  = 0x04
  69.         P0_TPSR                 = 0x04
  70.         P0_TBCR0                = 0x05
  71.         P0_TBCR1                = 0x06
  72.         P0_ISR                  = 0x07
  73.         P0_RSAR0                = 0x08
  74.         P0_RSAR1                = 0x09
  75.         P0_RBCR0                = 0x0A
  76.         P0_RBCR1                = 0x0B
  77.         P0_RSR                  = 0x0C
  78.         P0_RCR                  = 0x0C
  79.         P0_TCR                  = 0x0D
  80.         P0_DCR                  = 0x0E
  81.         P0_IMR                  = 0x0F
  82.  
  83.         P1_COMMAND              = 0x00
  84.         P1_PAR0                 = 0x01
  85.         P1_PAR1                 = 0x02
  86.         P1_PAR2                 = 0x03
  87.         P1_PAR3                 = 0x04
  88.         P1_PAR4                 = 0x05
  89.         P1_PAR5                 = 0x06
  90.         P1_CURR                 = 0x07
  91.         P1_MAR0                 = 0x08
  92.  
  93.         CMD_PS0                 = 0x00          ; Page 0 select
  94.         CMD_PS1                 = 0x40          ; Page 1 select
  95.         CMD_PS2                 = 0x80          ; Page 2 select
  96.         CMD_RD2                 = 0x20          ; Remote DMA control
  97.         CMD_RD1                 = 0x10
  98.         CMD_RD0                 = 0x08
  99.         CMD_TXP                 = 0x04          ; transmit packet
  100.         CMD_STA                 = 0x02          ; start
  101.         CMD_STP                 = 0x01          ; stop
  102.  
  103.         CMD_RDMA_READ           = 001b shl 3
  104.         CMD_RDMA_WRITE          = 010b shl 3
  105.         CMD_RDMA_SEND_PACKET    = 011b shl 3
  106.         CMD_RDMA_ABORT          = 100b shl 3    ; really is 1xx, Abort/Complete Remote DMA
  107. ;        RDMA_MASK               = 111b shl 3    ; internal, mask
  108.  
  109.         RCR_MON                 = 0x20          ; monitor mode
  110.  
  111.         DCR_FT1                 = 0x40
  112.         DCR_LS                  = 0x08          ; Loopback select
  113.         DCR_WTS                 = 0x01          ; Word transfer select
  114.  
  115.         ISR_PRX                 = 0x01          ; successful recv
  116.         ISR_PTX                 = 0x02          ; successful xmit
  117.         ISR_RXE                 = 0x04          ; receive error
  118.         ISR_TXE                 = 0x08          ; transmit error
  119.         ISR_OVW                 = 0x10          ; Overflow
  120.         ISR_CNT                 = 0x20          ; Counter overflow
  121.         ISR_RDC                 = 0x40          ; Remote DMA complete
  122.         ISR_RST                 = 0x80          ; reset
  123.  
  124.         IRQ_MASK                = ISR_PRX ;+ ISR_PTX ;+ ISR_RDC + ISR_PTX + ISR_TXE
  125.  
  126.         RSTAT_PRX               = 1 shl 0       ; successful recv
  127.         RSTAT_CRC               = 1 shl 1       ; CRC error
  128.         RSTAT_FAE               = 1 shl 2       ; Frame alignment error
  129.         RSTAT_OVER              = 1 shl 3       ; FIFO overrun
  130.  
  131.         TXBUF_SIZE              = 6
  132.         RXBUF_END               = 32
  133.         PAGE_SIZE               = 256
  134.  
  135.         ETH_ZLEN                = 60
  136.         ETH_FRAME_LEN           = 1514
  137.  
  138.         FLAG_PIO                = 1 shl 0
  139.         FLAG_16BIT              = 1 shl 1
  140.  
  141.         VENDOR_NONE             = 0
  142.         VENDOR_WD               = 1
  143.         VENDOR_NOVELL           = 2
  144.         VENDOR_3COM             = 3
  145.  
  146.         NE_ASIC                 = 0x10
  147.         NE_RESET                = 0x0F          ; Used to reset card
  148.         NE_DATA                 = 0x00          ; Used to read/write NIC mem
  149.  
  150.         MEM_8k                  = 32
  151.         MEM_16k                 = 64
  152.         MEM_32k                 = 128
  153.  
  154.         ISA_MAX_ADDR            = 0x400
  155.  
  156.  
  157.  
  158. section '.flat' code readable align 16
  159.  
  160. ;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;
  161. ;;
  162. ;; proc START
  163. ;;
  164. ;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;
  165.  
  166. align 4
  167. proc START stdcall, state:dword
  168.  
  169.         cmp     [state], 1
  170.         jne     .exit
  171.   .entry:
  172.         DEBUGF  2,"Registering %s driver\n", my_service
  173.         stdcall RegService, my_service, service_proc
  174.         ret
  175.   .fail:
  176.   .exit:
  177.         xor     eax, eax
  178.         ret
  179.  
  180. endp
  181.  
  182.  
  183. ;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;
  184. ;;
  185. ;; proc SERVICE_PROC
  186. ;;
  187. ;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;
  188.  
  189. align 4
  190. proc service_proc stdcall, ioctl:dword
  191.  
  192.         mov     edx, [ioctl]
  193.         mov     eax, [IOCTL.io_code]
  194.  
  195. ;------------------------------------------------------
  196.                        ;---------------
  197.         cmp     eax, 0 ;SRV_GETVERSION
  198.         jne     @F     ;---------------
  199.  
  200.         cmp     [IOCTL.out_size], 4
  201.         jb      .fail
  202.         mov     eax, [IOCTL.output]
  203.         mov     [eax], dword API_VERSION
  204.  
  205.         xor     eax, eax
  206.         ret
  207.  
  208. ;------------------------------------------------------
  209.   @@:                  ;---------
  210.         cmp     eax, 1 ;SRV_HOOK
  211.         jne     @F     ;---------
  212.  
  213.         DEBUGF  2,"Checking if device is already listed..\n"
  214.  
  215.         mov     eax, [IOCTL.input]
  216.  
  217.         cmp     [IOCTL.inp_size], 3
  218.         jb      .fail
  219.         cmp     byte [eax], 1
  220.         je      .pci
  221.  
  222.         cmp     [IOCTL.inp_size], 4
  223.         jb      .fail
  224.         cmp     byte [eax], 0
  225.         je      .isa
  226.  
  227.         jmp     .fail
  228.  
  229.   .pci:
  230.  
  231. ; check if the device is already listed
  232.  
  233.         mov     esi, device_list
  234.         mov     ecx, [devices]
  235.         test    ecx, ecx
  236.         jz      .firstdevice_pci
  237.  
  238.         mov     ax, [eax+1]                             ; get the pci bus and device numbers
  239.   .nextdevice:
  240.         mov     ebx, [esi]
  241.         cmp     al, byte[device.pci_bus]
  242.         jne     @f
  243.         cmp     ah, byte[device.pci_dev]
  244.         je      .find_devicenum                         ; Device is already loaded, let's find it's device number
  245.        @@:
  246.         add     esi, 4
  247.         loop    .nextdevice
  248.  
  249.   .firstdevice_pci:
  250.         call    create_new_struct
  251.  
  252.         mov     eax, [IOCTL.input]
  253.         movzx   ecx, byte[eax+1]
  254.         mov     [device.pci_bus], ecx
  255.         movzx   ecx, byte[eax+2]
  256.         mov     [device.pci_dev], ecx
  257.  
  258. ; Now, it's time to find the base io addres of the PCI device
  259.  
  260.         PCI_find_io
  261.  
  262. ; We've found the io address, find IRQ now
  263.  
  264.         PCI_find_irq
  265.  
  266.         jmp     .hook
  267.  
  268.   .isa:
  269.  
  270.         mov     esi, device_list
  271.         mov     ecx, [devices]
  272.         test    ecx, ecx
  273.         jz      .firstdevice_isa
  274.         mov     al, [eax+3]
  275.         movzx   edi, word [eax+1]
  276.   .nextdevice_isa:
  277.         mov     ebx, [esi]
  278.         cmp     edi, [device.io_addr]
  279.         jne     .maybenext
  280.         cmp     al, [device.irq_line]
  281.         je      find_device_num
  282.   .maybenext:
  283.         add     esi, 4
  284.         loop    .nextdevice_isa
  285.  
  286.  
  287.  
  288.   .firstdevice_isa:
  289.         call    create_new_struct
  290.  
  291.         mov     eax, [IOCTL.input]
  292.         movzx   ecx, word [eax+1]
  293.         mov     [device.io_addr], ecx
  294.         mov     cl, [eax+3]
  295.         mov     [device.irq_line], cl
  296.  
  297.   .hook:
  298.  
  299.         DEBUGF  2,"Hooking into device, dev:%x, bus:%x, irq:%x, addr:%x\n",\
  300.         [device.pci_dev]:1,[device.pci_bus]:1,[device.irq_line]:1,[device.io_addr]:4
  301.  
  302.         call    probe                                                   ; this function will output in eax
  303.         test    eax, eax
  304.         jnz     .err                                                    ; If an error occured, exit
  305.  
  306.         mov     eax, [devices]
  307.         mov     [device_list+4*eax], ebx
  308.         inc     [devices]
  309.  
  310.         mov     [device.type], NET_TYPE_ETH
  311.         call    NetRegDev
  312.  
  313.         cmp     eax, -1
  314.         jz      .err
  315.         ret
  316.  
  317.  
  318. ; If the device was already loaded, find the device number and return it in eax
  319.  
  320.   .find_devicenum:
  321.         DEBUGF  1,"Trying to find device number of already registered device\n"
  322.         call    NetPtrToNum                                             ; This kernel procedure converts a pointer to device struct in ebx
  323.                                                                         ; into a device number in edi
  324.         mov     eax, edi                                                ; Application wants it in eax instead
  325.         DEBUGF  1,"Kernel says: %u\n", eax
  326.         ret
  327.  
  328.   .err:
  329.         DEBUGF  1,"Failed, removing device structure\n"
  330.         stdcall KernelFree, ebx
  331.  
  332.         jmp     .fail
  333.  
  334. ;------------------------------------------------------
  335.   @@:
  336. .fail:
  337.         or      eax, -1
  338.         ret
  339.  
  340. ;------------------------------------------------------
  341. endp
  342.  
  343.  
  344. create_new_struct:
  345.  
  346.         cmp     [devices], MAX_DEVICES
  347.         jae     .fail
  348.  
  349.         allocate_and_clear ebx, device.size, .fail      ; Allocate the buffer for device structure
  350.  
  351.         mov     [device.reset], reset
  352.         mov     [device.transmit], transmit
  353.         mov     [device.unload], unload
  354.         mov     [device.name], my_service
  355.  
  356.         ret
  357.  
  358.   .fail:
  359.         add     esp, 4                                  ; return to caller of 'hook'
  360.         or      eax, -1
  361.         ret
  362.  
  363. find_device_num:
  364.  
  365.         DEBUGF  1,"Trying to find device number of already registered device\n"
  366.         mov     ebx, eax
  367.         call    NetPtrToNum                                             ; This kernel procedure converts a pointer to device struct in ebx
  368.                                                                         ; into a device number in edi
  369.         mov     eax, edi                                                ; Application wants it in eax instead
  370.         DEBUGF  1,"Kernel says: %u\n", eax
  371.         ret
  372.  
  373.  
  374. ;;/\/\/\/\/\/\/\/\/\/\/\/\/\/\/\/\/\/\/\/\/\/\/\/\/\/\/\/\/\/\/\/\/\/\/\/\;;
  375. ;;                                                                        ;;
  376. ;;        Actual Hardware dependent code starts here                      ;;
  377. ;;                                                                        ;;
  378. ;;/\/\/\/\/\/\/\/\/\/\/\/\/\/\/\/\/\/\/\/\/\/\/\/\/\/\/\/\/\/\/\/\/\/\/\/\;;
  379.  
  380.  
  381. unload:   ; TODO
  382.         or      eax, -1
  383.         ret
  384.  
  385.  
  386.  
  387. ;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;
  388. ;;
  389. ;;  probe: enables the device and clears the rx buffer
  390. ;;
  391. ;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;
  392.  
  393. probe:
  394.         mov     [device.vendor], VENDOR_NONE
  395.         mov     [device.bmem], 0
  396.  
  397.         DEBUGF  2,"Trying 16-bit mode\n"
  398.  
  399.         mov     [device.flags], FLAG_16BIT + FLAG_PIO
  400.         mov     [device.memsize], MEM_32k
  401.         mov     [device.tx_start], 64
  402.         mov     [device.rx_start], TXBUF_SIZE + 64
  403.  
  404.         set_io  0
  405.         set_io  P0_DCR
  406.         mov     al, DCR_WTS + DCR_FT1 + DCR_LS  ; word transfer select +
  407.         out     dx, al
  408.  
  409.         set_io  P0_PSTART
  410.         mov     al, MEM_16k
  411.         out     dx, al
  412.  
  413.         set_io  P0_PSTOP
  414.         mov     al, MEM_32k
  415.         out     dx, al
  416.  
  417.         mov     esi, my_service
  418.         mov     di, 16384
  419.         mov     cx, 14
  420.         call    PIO_write
  421.  
  422.         mov     si, 16384
  423.         mov     cx, 14
  424.         sub     esp, 16
  425.         mov     edi, esp
  426.         call    PIO_read
  427.  
  428.         mov     esi, esp
  429.         add     esp, 16
  430.         mov     edi, my_service
  431.         mov     ecx, 13
  432.         repe    cmpsb
  433.         je      ep_set_vendor
  434.  
  435.         DEBUGF  2,"16-bit mode failed\n"
  436.         DEBUGF  2,"Trying 8-bit mode\n"
  437.  
  438.         mov     [device.flags], FLAG_PIO
  439.         mov     [device.memsize], MEM_16k
  440.         mov     [device.tx_start], 32
  441.         mov     [device.rx_start], TXBUF_SIZE + 32
  442.  
  443.         set_io  NE_ASIC + NE_RESET
  444.         in      al, dx
  445.         out     dx, al
  446.  
  447.         in      al, 0x84
  448.  
  449.         set_io  P0_COMMAND
  450.         mov     al, CMD_RD2 + CMD_STP
  451.         out     dx, al
  452.  
  453.         set_io  P0_RCR
  454.         mov     al, RCR_MON
  455.         out     dx, al
  456.  
  457.         set_io  P0_DCR
  458.         mov     al, DCR_FT1 + DCR_LS
  459.         out     dx, al
  460.  
  461.         set_io  P0_PSTART
  462.         mov     al, MEM_8k
  463.         out     dx, al
  464.  
  465.         set_io  P0_PSTOP
  466.         mov     al, MEM_16k
  467.         out     dx, al
  468.  
  469.         mov     esi, my_service
  470.         mov     di, 8192
  471.         mov     cx, 14
  472.         call    PIO_write
  473.  
  474.         mov     si, 8192
  475.         mov     cx, 14
  476.         sub     esp, 16
  477.         mov     edi, esp
  478.         call    PIO_read
  479.  
  480.         mov     esi, my_service
  481.         mov     edi, esp
  482.         add     esp, 16
  483.         mov     ecx, 13
  484.         repe    cmpsb
  485.         je      ep_set_vendor
  486.  
  487.         DEBUGF  2,"This is not a valid ne2000 device!\n"
  488.         or      eax, -1
  489.         ret
  490.  
  491.  
  492. ep_set_vendor:
  493.  
  494.         DEBUGF  2,"Mode ok\n"
  495.  
  496.         cmp     [device.io_addr], ISA_MAX_ADDR
  497.         jbe     .isa
  498.  
  499.         DEBUGF  2,"Card is using PCI bus\n"
  500.  
  501.         mov     [device.vendor], VENDOR_NOVELL  ;;; FIXME
  502.         jmp     ep_check_have_vendor
  503.  
  504.   .isa:
  505.         DEBUGF  2,"Card is using ISA bus\n"
  506.  
  507.         mov     [device.vendor], VENDOR_NOVELL
  508.  
  509. ep_check_have_vendor:
  510.  
  511.  
  512.         mov     al, [device.vendor]
  513.         cmp     al, VENDOR_NONE
  514. ;        je      exit
  515.  
  516.         cmp     al, VENDOR_3COM
  517.         je      reset
  518.  
  519.         mov     eax, [device.bmem]
  520.         mov     [device.rmem], eax
  521.  
  522. ;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;
  523. ;;
  524. ;;   reset: Place the chip into a virgin state
  525. ;;
  526. ;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;
  527.  
  528. reset:
  529.         DEBUGF  2,"Resetting device\n"
  530.  
  531. ; attach int handler
  532.         movzx   eax, [device.irq_line]
  533.         DEBUGF  1,"Attaching int handler to irq %x\n", eax:1
  534.         stdcall AttachIntHandler, eax, int_handler, dword 0
  535.  
  536. ; Stop card + DMA
  537.         set_io  0
  538. ;        set_io  P0_COMMAND
  539.         mov     al, CMD_PS0 + CMD_RDMA_ABORT + CMD_STP
  540.         out     dx, al
  541.  
  542. ; initialize DCR
  543.         set_io  P0_DCR
  544.         mov     al, DCR_FT1 + DCR_LS
  545.         test    [device.flags], FLAG_16BIT
  546.         jz      @f
  547.         or      al, DCR_WTS                     ; word transfer select
  548.       @@:
  549.         out     dx, al
  550.  
  551. ; clear remote bytes count
  552.         set_io  P0_RBCR0
  553.         xor     al, al
  554.         out     dx, al
  555.  
  556.         set_io  P0_RBCR1
  557.         out     dx, al
  558.  
  559. ; initialize Receive configuration register (until all init is done)
  560.         set_io  P0_RCR
  561.         mov     al, 0x20        ; monitor mode
  562.         out     dx, al
  563.  
  564. ; transmit configuration register to monitor mode (until all ini is done)
  565.         set_io  P0_TCR
  566.         mov     al, 2           ; internal loopback
  567.         out     dx, al
  568.  
  569. ; clear interupt status
  570.         set_io  P0_ISR
  571.         mov     al, 0xff
  572.         out     dx, al
  573.  
  574. ; clear IRQ mask                        ;;;;; CHECKME ;;;;;
  575.         set_io  P0_IMR
  576.         xor     al, al
  577.         out     dx, al
  578.  
  579. ; set transmit pointer
  580.         set_io  P0_TPSR
  581.         mov     al, [device.tx_start]
  582.         out     dx, al
  583.  
  584. ; set pagestart pointer
  585.         set_io  P0_PSTART
  586.         mov     al, [device.rx_start]
  587.         out     dx, al
  588.  
  589. ; set pagestop pointer
  590.         set_io  P0_PSTOP
  591.         mov     al, [device.memsize]
  592.         out     dx, al
  593.  
  594. ; set boundary pointer
  595.         set_io  P0_BOUND
  596.         mov     al, [device.memsize]
  597.         dec     al
  598.         out     dx, al
  599.  
  600. ; set curr pointer
  601.         set_io  P0_COMMAND
  602.         mov     al, CMD_PS1 ;+ CMD_RD2 + CMD_STP ; page 1, stop mode
  603.         out     dx, al
  604.  
  605.         set_io  P1_CURR
  606.         mov     al, [device.rx_start]
  607.         out     dx, al
  608.  
  609.         set_io  P0_COMMAND
  610.         mov     al, CMD_PS0 ;+ CMD_RD2 + CMD_STA ; go to page 0, start mode
  611.         out     dx, al
  612.  
  613. ; Read MAC address and set it to registers
  614.         call    read_mac
  615.         push    .macret
  616.         sub     esp, 6
  617.         lea     esi, [device.mac]
  618.         mov     edi, esp
  619.         movsd
  620.         movsw
  621.         jmp     write_mac
  622.   .macret:
  623.  
  624. ; set IRQ mask
  625.         set_io  0
  626.         set_io  P0_IMR
  627.         mov     al, IRQ_MASK
  628.         out     dx, al
  629.  
  630. ; start mode
  631.         set_io  P0_COMMAND
  632.         mov     al, CMD_STA
  633.         out     dx, al
  634.  
  635. ; clear transmit control register
  636.         set_io  P0_TCR
  637.         xor     al, al                  ; no loopback
  638.         out     dx, al
  639.  
  640. ; set receive control register ;;;;
  641.         set_io  P0_RCR
  642.         mov     al, 4                   ; accept broadcast
  643.         out     dx, al
  644.  
  645. ; clear packet/byte counters
  646.         xor     eax, eax
  647.         lea     edi, [device.bytes_tx]
  648.         mov     ecx, 6
  649.         rep     stosd
  650.  
  651. ; Set the mtu, kernel will be able to send now
  652.         mov     [device.mtu], ETH_FRAME_LEN
  653.  
  654. ; Set link state to unknown
  655.         mov     [device.state], ETH_LINK_UNKOWN
  656.  
  657. ; Indicate that we have successfully reset the card
  658.         xor     eax, eax
  659.         DEBUGF  2,"Done!\n"
  660.  
  661.         ret
  662.  
  663.  
  664.  
  665. ;***************************************************************************
  666. ;   Function
  667. ;      transmit
  668. ; buffer in [esp+4], size in [esp+8], pointer to device struct in ebx
  669. ;***************************************************************************
  670.  
  671. align 4
  672. transmit:
  673.  
  674.         mov     esi, [esp + 4]
  675.         mov     ecx, [esp + 8]
  676.         DEBUGF  2,"Transmitting packet, buffer:%x, size:%u\n",esi, ecx
  677.         DEBUGF  2,"To: %x-%x-%x-%x-%x-%x From: %x-%x-%x-%x-%x-%x Type:%x%x\n",\
  678.         [esi+0]:2,[esi+1]:2,[esi+2]:2,[esi+3]:2,[esi+4]:2,[esi+5]:2,[esi+6]:2,[esi+7]:2,[esi+8]:2,[esi+9]:2,[esi+10]:2,[esi+11]:2,[esi+13]:2,[esi+12]:2
  679.  
  680.         cmp     ecx, ETH_FRAME_LEN
  681.         ja      .err ; packet is too long
  682.         cmp     ecx, ETH_ZLEN
  683.         jb      .err ; packet is too short
  684.  
  685.         movzx   edi, [device.tx_start]
  686.         shl     edi, 8
  687.         push    cx
  688.         call    PIO_write
  689.         pop     cx
  690.  
  691.         set_io  0
  692. ;        set_io  P0_COMMAND
  693.         mov     al, CMD_PS0 + CMD_RD2 + CMD_STA
  694.         out     dx, al
  695.  
  696.         set_io  P0_TPSR
  697.         mov     al, [device.tx_start]
  698.         out     dx, al
  699.  
  700.         set_io  P0_TBCR0
  701.         mov     al, cl
  702.         out     dx, al
  703.  
  704.         set_io  P0_TBCR1
  705.         mov     al, ch
  706.         out     dx, al
  707.  
  708.         set_io  P0_COMMAND
  709.         mov     al, CMD_PS0 + CMD_TXP + CMD_RD2 + CMD_STA
  710.         out     dx, al
  711.  
  712.         DEBUGF  2," - Packet Sent!\n"
  713.  
  714.         inc     [device.packets_tx]
  715.         mov     eax, [esp + 8]                   ; Get packet size in eax
  716.  
  717.         add     dword [device.bytes_tx], eax
  718.         adc     dword [device.bytes_tx + 4], 0
  719.  
  720.         stdcall KernelFree, [esp+4]
  721.         xor     eax, eax
  722.         ret     8
  723.  
  724. .err:
  725.         DEBUGF  2," - Error!\n"
  726.  
  727.         or      eax, -1
  728.         stdcall KernelFree, [esp+4]
  729.         ret     8
  730.  
  731.  
  732.  
  733. ;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;
  734. ;
  735. ; Interrupt handler
  736. ;
  737. ;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;;
  738.  
  739. align 4
  740. int_handler:
  741.  
  742.         DEBUGF  1,"\n%s int\n", my_service
  743.  
  744. ; find pointer of device wich made INT occur
  745.  
  746.         mov     ecx, [devices]
  747.         test    ecx, ecx
  748.         jz      .nothing
  749.         mov     esi, device_list
  750.   .nextdevice:
  751.         mov     ebx, [esi]
  752.  
  753.         set_io  0
  754. ;        set_io  P0_COMMAND
  755.         mov     al, CMD_PS0
  756.         out     dx, al
  757.  
  758.         set_io  P0_ISR
  759.         in      al, dx
  760.         test    al, al
  761.         jnz     .got_it
  762.   .continue:
  763.         add     esi, 4
  764.         dec     ecx
  765.         jnz     .nextdevice
  766.   .nothing:
  767.         ret
  768.  
  769.   .got_it:
  770.  
  771.         DEBUGF  1,"Device=%x status=%x\n", ebx, eax:2
  772.  
  773.         push    ebx
  774.  
  775.         test    al, ISR_PRX     ; packet received ok ?
  776.         jz      .no_rx
  777.  
  778.         test    [device.flags], FLAG_PIO
  779.         jz      .no_rx          ; FIXME: Only PIO mode supported for now
  780.  
  781. ;
  782.  
  783.         pushd   .no_rx
  784.  
  785. ; allocate a buffer
  786.  
  787.         stdcall KernelAlloc, ETH_FRAME_LEN
  788.         test    eax, eax
  789.         jz      .fail_2
  790.         pushd   0
  791.         push    eax
  792.  
  793. ; read offset for current packet from device
  794.  
  795.         set_io  0
  796.         set_io  P0_BOUND        ; boundary ptr is offset to next packet we need to read.
  797.         in      al, dx
  798.         inc     al
  799.  
  800.         cmp     al, [device.memsize]
  801.         jb      @f
  802.         mov     al, [device.rx_start]
  803.        @@:
  804.         mov     ch, al
  805.  
  806.         set_io  P0_COMMAND
  807.         mov     al, CMD_PS1
  808.         out     dx, al
  809.  
  810.         set_io  P1_CURR
  811.         in      al, dx          ; get current page in cl
  812.         mov     cl, al
  813.  
  814.         set_io  P1_COMMAND
  815.         mov     al, CMD_PS0
  816.         out     dx, al
  817.  
  818.         cmp     cl, [device.memsize]
  819.         jb      @f
  820.         mov     cl, [device.rx_start]
  821.        @@:
  822.  
  823.         cmp     cl, ch
  824.         je      .fail
  825.  
  826.         movzx   esi, ch                         ; we are using 256 byte pages
  827.         shl     esi, 8                          ; esi now holds the offset for current packet
  828.  
  829. ; Get packet header in eax
  830.  
  831.         sub     esp, 4                          ; reserve 4 bytes on stack to put packet header in
  832.         mov     edi, esp
  833.         mov     cx, 4
  834.         call    PIO_read
  835.  
  836.         mov     ecx, [esp]                      ; ecx now contains packet header
  837.  
  838. ; check if packet is ok
  839.  
  840.         test    ecx, RSTAT_PRX
  841.         jz      .fail_3
  842.  
  843. ; calculate packet length in ecx
  844.  
  845.         shr     ecx, 16
  846.         sub     ecx, 4                          ; CRC doesnt count as data byte
  847.         mov     [esp + 4 + 4], ecx
  848.  
  849. ; check if packet size is ok
  850.  
  851.         cmp     ecx, ETH_ZLEN
  852.         jb      .fail_3
  853.         cmp     ecx, ETH_FRAME_LEN
  854.         ja      .fail_3
  855.  
  856. ; update stats
  857.  
  858.         DEBUGF  2,"Received %u bytes\n", ecx
  859.  
  860.         add     dword[device.bytes_rx], ecx
  861.         adc     dword[device.bytes_rx + 4], 0
  862.         inc     [device.packets_rx]
  863.  
  864. ; update read and write pointers
  865.  
  866.         add     esi, 4
  867.         mov     edi, [esp + 4]
  868.  
  869. ; now check if we can read all data at once (if we cross the end boundary, we need to wrap back to the beginning)
  870.  
  871.         xor     eax, eax
  872.         mov     ah, [device.memsize]
  873.         sub     eax, esi
  874.         cmp     ecx, eax                ; eax = number of bytes till end of buffer, ecx = bytes we need to read
  875.         jbe     .no_wrap
  876.  
  877.         DEBUGF  2,"WRAP!\n"
  878.  
  879. ; Read first part
  880.  
  881.         sub     ecx, eax
  882.         push    ecx
  883.         mov     ecx, eax
  884.  
  885.         call    PIO_read                ; Read the data
  886.  
  887. ; update pointers
  888.  
  889.         add     edi, ecx
  890.         pop     ecx
  891.  
  892.         movzx   esi, [device.rx_start]
  893.         shl     esi, 8
  894.  
  895. ; now read second part (or only part)
  896.  
  897.   .no_wrap:
  898.         call    PIO_read                ; Read the data
  899.  
  900. ; update boundary pointer
  901.  
  902.         pop     eax
  903.         mov     al, ah
  904.         cmp     al, [device.rx_start]
  905.         jne     @f
  906.         mov     al, [device.memsize]
  907.        @@:
  908.  
  909.         set_io  0
  910.         set_io  P0_BOUND
  911.         dec     al
  912.         out     dx, al
  913.  
  914. ; now send the data to the kernel
  915.  
  916.         jmp     Eth_input
  917.  
  918.   .fail_3:
  919.         add     esp, 4
  920.   .fail:
  921.         add     esp, 8
  922.   .fail_2:
  923.  
  924.  
  925.   .no_rx:
  926.         pop     ebx
  927.         DEBUGF  2,"done\n"
  928.  
  929.         set_io  0
  930.         set_io  P0_ISR
  931.         mov     al, 0xff
  932.         out     dx, al
  933.  
  934.         ret
  935.  
  936.  
  937.  
  938.  
  939.  
  940. ;;;;;;;;;;;;;;;;;;;;;;;
  941. ;;                   ;;
  942. ;; Write MAC address ;;
  943. ;;                   ;;
  944. ;;;;;;;;;;;;;;;;;;;;;;;
  945.  
  946. align 4
  947. write_mac:      ; in: mac on stack (6 bytes)
  948.  
  949.         DEBUGF  1,"Writing MAC\n"
  950.  
  951.         set_io  0
  952.         mov     al, CMD_PS1; + CMD_RD2 + CMD_STP
  953.         out     dx, al
  954.  
  955.         set_io  P1_PAR0
  956.         mov     esi, esp
  957.         mov     cx, 6
  958.  @@:
  959.         lodsb
  960.         out     dx, al
  961.         inc     dx
  962.         loopw   @r
  963.  
  964.         add     esp, 6
  965.  
  966. ; Notice this procedure does not ret, but continues to read_mac instead.
  967.  
  968. ;;;;;;;;;;;;;;;;;;;;;;
  969. ;;                  ;;
  970. ;; Read MAC address ;;
  971. ;;                  ;;
  972. ;;;;;;;;;;;;;;;;;;;;;;
  973.  
  974. read_mac:
  975.  
  976.         DEBUGF  1,"Reading MAC\n"
  977.  
  978.         xor     esi, esi
  979.         mov     cx, 16
  980.         sub     esp, 16
  981.         mov     edi, esp
  982.         call    PIO_read
  983.  
  984.         mov     esi, esp
  985.         add     esp, 16
  986.         lea     edi, [device.mac]
  987.         mov     ecx, 6
  988.   .loop:
  989.         movsb
  990.         test    [device.flags], FLAG_16BIT
  991.         jz      .8bit
  992.         inc     esi
  993.   .8bit:
  994.         loop    .loop
  995.  
  996.         DEBUGF  1,"MAC=%x-%x-%x-%x-%x-%x\n",\
  997.         [device.mac]:2,[device.mac+1]:2,[device.mac+2]:2,[device.mac+3]:2,[device.mac+4]:2,[device.mac+5]:2
  998.  
  999.         ret
  1000.  
  1001.  
  1002. ;***************************************************************************
  1003. ;
  1004. ;   PIO_read
  1005. ;
  1006. ;   Description
  1007. ;       Read a frame from the ethernet card via Programmed I/O
  1008. ;      src in si
  1009. ;      cnt in cx
  1010. ;       dst in edi
  1011. ;***************************************************************************
  1012. PIO_read:
  1013.  
  1014.         DEBUGF  1,"PIO Read from %x to %x, %u bytes ", si, edi, cx
  1015.  
  1016. ; start DMA
  1017.         set_io  0
  1018. ;        set_io  P0_COMMAND
  1019.         mov     al, CMD_RD2 + CMD_STA
  1020.         out     dx, al
  1021.  
  1022. ; set length of data we're interested in
  1023.         set_io  P0_RBCR0
  1024.         mov     al, cl
  1025.         out     dx, al
  1026.  
  1027.         set_io  P0_RBCR1
  1028.         mov     al, ch
  1029.         out     dx, al
  1030.  
  1031. ; set offset of what we want to read
  1032.         set_io  P0_RSAR0
  1033.         mov     ax, si
  1034.         out     dx, al
  1035.  
  1036.         set_io  P0_RSAR1
  1037.         shr     ax, 8
  1038.         out     dx, al
  1039.  
  1040. ; start DMA read
  1041.         set_io  P0_COMMAND
  1042.         mov     al, CMD_RD0 + CMD_STA
  1043.         out     dx, al
  1044.  
  1045.         set_io  NE_ASIC
  1046.  
  1047.         test    [device.flags], FLAG_16BIT
  1048.         jz      .8bits
  1049.  
  1050.         DEBUGF  1,"(16-bit mode)\n"
  1051.  
  1052.         shr     cx, 1   ; note that if the number was odd, carry flag will be set
  1053.         pushf
  1054.  
  1055.   .16bits:
  1056.         in      ax, dx
  1057.         stosw
  1058.         loopw   .16bits
  1059.  
  1060.         inc     cx
  1061.         popf
  1062.         jnc     .done
  1063.         jmp     .8bits_
  1064.  
  1065.   .8bits:
  1066.         DEBUGF  1,"(8-bit mode)\n"
  1067.  
  1068.   .8bits_:
  1069.         in      al, dx
  1070.         stosb
  1071.         loopw   .8bits_
  1072.  
  1073.  
  1074.   .done:
  1075. ;        set_io  0
  1076. ;        set_io  P0_ISR
  1077. ;
  1078. ;  .dmawait:                             ; Wait for Remote DMA Complete
  1079. ;        in      al, dx
  1080. ;        test    al, ISR_RDC
  1081. ;        jz      .dmawait
  1082. ;        and     al, not ISR_RDC
  1083. ;        out     dx, al                  ; clear the bit
  1084.  
  1085.         ret
  1086.  
  1087.  
  1088.  
  1089.  
  1090. ;***************************************************************************
  1091. ;
  1092. ;   PIO_write
  1093. ;
  1094. ;   Description
  1095. ;       writes a frame to the ethernet card via Programmed I/O
  1096. ;      dst in di
  1097. ;      cnt in cx
  1098. ;       src in esi
  1099. ;***************************************************************************
  1100. PIO_write:
  1101.  
  1102.         DEBUGF  1,"Eth PIO Write from %x to %x, %u bytes ", esi, di, cx
  1103.  
  1104.         set_io  0
  1105. ;        set_io  P0_COMMAND
  1106.         mov     al, CMD_RD2 + CMD_STA
  1107.         out     dx, al
  1108.  
  1109.         set_io  P0_ISR
  1110.         mov     al, ISR_RDC
  1111.         out     dx, al
  1112.  
  1113.         set_io  P0_RBCR0
  1114.         mov     al, cl
  1115.         out     dx, al
  1116.  
  1117.         set_io  P0_RBCR1
  1118.         mov     al, ch
  1119.         out     dx, al
  1120.  
  1121.         mov     ax, di
  1122.         set_io  P0_RSAR0
  1123.         out     dx, al
  1124.         shr     ax, 8
  1125.         set_io  P0_RSAR1
  1126.         out     dx, al
  1127.  
  1128.         set_io  P0_COMMAND
  1129.         mov     al, CMD_RD1 + CMD_STA
  1130.         out     dx, al
  1131.  
  1132.         set_io  NE_ASIC
  1133.         test    [device.flags], FLAG_16BIT
  1134.         jz      .8_bit
  1135.  
  1136.         DEBUGF  1,"(16-bit mode)\n"
  1137.  
  1138.         shr     cx, 1   ; note that if the number was odd, carry flag will be set
  1139.         pushf           ; save the flags for later
  1140.  
  1141.   .16bit:
  1142.         lodsw
  1143.         out     dx, ax
  1144.         loopw   .16bit
  1145.  
  1146.         popf
  1147.         jnc     .done
  1148.         inc     cx
  1149.         jmp     .8_bit_
  1150.  
  1151.   .8_bit:
  1152.  
  1153.         DEBUGF  1,"(8-bit mode)\n"
  1154.  
  1155.   .8_bit_:
  1156.         lodsb
  1157.         out     dx, al
  1158.         loopw   .8_bit_
  1159.  
  1160.   .done:
  1161. ;        set_io  0
  1162. ;        set_io  P0_ISR
  1163. ;  .dmawait:                             ; Wait for Remote DMA Complete
  1164. ;        in      al, dx
  1165. ;        test    al, ISR_RDC
  1166. ;        jz      .dmawait
  1167. ;        and     al, not ISR_RDC
  1168. ;        out     dx, al                  ; clear the bit
  1169.  
  1170.         ret
  1171.  
  1172.  
  1173.  
  1174. ;all initialized data place here
  1175. align 4
  1176.  
  1177. devices         dd 0
  1178. version         dd (DRIVER_VERSION shl 16) or (API_VERSION and 0xFFFF)
  1179. my_service      db 'RTL8029/ne2000',0  ;max 16 chars include zero
  1180.  
  1181. ;device_1        db 'Realtek 8029',0
  1182. ;device_2        db 'Realtek 8019',0
  1183. ;device_3        db 'Realtek 8019AS',0
  1184. ;device_4        db 'ne2000',0
  1185. ;device_5        db 'DP8390',0
  1186.  
  1187. include_debug_strings
  1188.  
  1189. section '.data' data readable writable align 16  ;place all uninitialized data place here
  1190.  
  1191. device_list     rd MAX_DEVICES
  1192.  
  1193.  
  1194.  
  1195.  
  1196.  
  1197.