Subversion Repositories Kolibri OS

Rev

Rev 3619 | Go to most recent revision | Blame | Compare with Previous | 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__         = 2
  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.         push    ebx esi edi
  743.  
  744.         DEBUGF  1,"\n%s int\n", my_service
  745.  
  746. ; find pointer of device wich made INT occur
  747.  
  748.         mov     ecx, [devices]
  749.         test    ecx, ecx
  750.         jz      .nothing
  751.         mov     esi, device_list
  752.   .nextdevice:
  753.         mov     ebx, [esi]
  754.  
  755.         set_io  0
  756. ;        set_io  P0_COMMAND
  757.         mov     al, CMD_PS0
  758.         out     dx, al
  759.  
  760.         set_io  P0_ISR
  761.         in      al, dx
  762.         test    al, al
  763.         jnz     .got_it
  764.   .continue:
  765.         add     esi, 4
  766.         dec     ecx
  767.         jnz     .nextdevice
  768.   .nothing:
  769.         pop     edi esi ebx
  770.         xor     eax, eax
  771.  
  772.         ret
  773.  
  774.   .got_it:
  775.  
  776.         DEBUGF  1,"Device=%x status=%x\n", ebx, eax:2
  777.  
  778.         push    ebx
  779.  
  780.         test    al, ISR_PRX     ; packet received ok ?
  781.         jz      .no_rx
  782.  
  783.         test    [device.flags], FLAG_PIO
  784.         jz      .no_rx          ; FIXME: Only PIO mode supported for now
  785.  
  786. ;
  787.  
  788.         pushd   .no_rx
  789.  
  790. ; allocate a buffer
  791.  
  792.         stdcall KernelAlloc, ETH_FRAME_LEN
  793.         test    eax, eax
  794.         jz      .fail_2
  795.         pushd   0
  796.         push    eax
  797.  
  798. ; read offset for current packet from device
  799.  
  800.         set_io  0
  801.         set_io  P0_BOUND        ; boundary ptr is offset to next packet we need to read.
  802.         in      al, dx
  803.         inc     al
  804.  
  805.         cmp     al, [device.memsize]
  806.         jb      @f
  807.         mov     al, [device.rx_start]
  808.        @@:
  809.         mov     ch, al
  810.  
  811.         set_io  P0_COMMAND
  812.         mov     al, CMD_PS1
  813.         out     dx, al
  814.  
  815.         set_io  P1_CURR
  816.         in      al, dx          ; get current page in cl
  817.         mov     cl, al
  818.  
  819.         set_io  P1_COMMAND
  820.         mov     al, CMD_PS0
  821.         out     dx, al
  822.  
  823.         cmp     cl, [device.memsize]
  824.         jb      @f
  825.         mov     cl, [device.rx_start]
  826.        @@:
  827.  
  828.         cmp     cl, ch
  829.         je      .fail
  830.  
  831.         movzx   esi, ch                         ; we are using 256 byte pages
  832.         shl     esi, 8                          ; esi now holds the offset for current packet
  833.  
  834. ; Get packet header in eax
  835.  
  836.         sub     esp, 4                          ; reserve 4 bytes on stack to put packet header in
  837.         mov     edi, esp
  838.         mov     cx, 4
  839.         call    PIO_read
  840.  
  841.         mov     ecx, [esp]                      ; ecx now contains packet header
  842.  
  843. ; check if packet is ok
  844.  
  845.         test    ecx, RSTAT_PRX
  846.         jz      .fail_3
  847.  
  848. ; calculate packet length in ecx
  849.  
  850.         shr     ecx, 16
  851.         sub     ecx, 4                          ; CRC doesnt count as data byte
  852.         mov     [esp + 4 + 4], ecx
  853.  
  854. ; check if packet size is ok
  855.  
  856.         cmp     ecx, ETH_ZLEN
  857.         jb      .fail_3
  858.         cmp     ecx, ETH_FRAME_LEN
  859.         ja      .fail_3
  860.  
  861. ; update stats
  862.  
  863.         DEBUGF  2,"Received %u bytes\n", ecx
  864.  
  865.         add     dword[device.bytes_rx], ecx
  866.         adc     dword[device.bytes_rx + 4], 0
  867.         inc     [device.packets_rx]
  868.  
  869. ; update read and write pointers
  870.  
  871.         add     esi, 4
  872.         mov     edi, [esp + 4]
  873.  
  874. ; now check if we can read all data at once (if we cross the end boundary, we need to wrap back to the beginning)
  875.  
  876.         xor     eax, eax
  877.         mov     ah, [device.memsize]
  878.         sub     eax, esi
  879.         cmp     ecx, eax                ; eax = number of bytes till end of buffer, ecx = bytes we need to read
  880.         jbe     .no_wrap
  881.  
  882.         DEBUGF  2,"WRAP!\n"
  883.  
  884. ; Read first part
  885.  
  886.         sub     ecx, eax
  887.         push    ecx
  888.         mov     ecx, eax
  889.  
  890.         call    PIO_read                ; Read the data
  891.  
  892. ; update pointers
  893.  
  894.         add     edi, ecx
  895.         pop     ecx
  896.  
  897.         movzx   esi, [device.rx_start]
  898.         shl     esi, 8
  899.  
  900. ; now read second part (or only part)
  901.  
  902.   .no_wrap:
  903.         call    PIO_read                ; Read the data
  904.  
  905. ; update boundary pointer
  906.  
  907.         pop     eax
  908.         mov     al, ah
  909.         cmp     al, [device.rx_start]
  910.         jne     @f
  911.         mov     al, [device.memsize]
  912.        @@:
  913.  
  914.         set_io  0
  915.         set_io  P0_BOUND
  916.         dec     al
  917.         out     dx, al
  918.  
  919. ; now send the data to the kernel
  920.  
  921.         jmp     Eth_input
  922.  
  923.   .fail_3:
  924.         add     esp, 4
  925.   .fail:
  926.         add     esp, 8
  927.   .fail_2:
  928.  
  929.  
  930.   .no_rx:
  931.         pop     ebx
  932.         DEBUGF  2,"done\n"
  933.  
  934.         set_io  0
  935.         set_io  P0_ISR
  936.         mov     al, 0xff
  937.         out     dx, al
  938.  
  939.         pop     edi esi ebx
  940.  
  941.         ret
  942.  
  943.  
  944.  
  945.  
  946.  
  947. ;;;;;;;;;;;;;;;;;;;;;;;
  948. ;;                   ;;
  949. ;; Write MAC address ;;
  950. ;;                   ;;
  951. ;;;;;;;;;;;;;;;;;;;;;;;
  952.  
  953. align 4
  954. write_mac:      ; in: mac on stack (6 bytes)
  955.  
  956.         DEBUGF  1,"Writing MAC\n"
  957.  
  958.         set_io  0
  959.         mov     al, CMD_PS1; + CMD_RD2 + CMD_STP
  960.         out     dx, al
  961.  
  962.         set_io  P1_PAR0
  963.         mov     esi, esp
  964.         mov     cx, 6
  965.  @@:
  966.         lodsb
  967.         out     dx, al
  968.         inc     dx
  969.         loopw   @r
  970.  
  971.         add     esp, 6
  972.  
  973. ; Notice this procedure does not ret, but continues to read_mac instead.
  974.  
  975. ;;;;;;;;;;;;;;;;;;;;;;
  976. ;;                  ;;
  977. ;; Read MAC address ;;
  978. ;;                  ;;
  979. ;;;;;;;;;;;;;;;;;;;;;;
  980.  
  981. read_mac:
  982.  
  983.         DEBUGF  1,"Reading MAC\n"
  984.  
  985.         xor     esi, esi
  986.         mov     cx, 16
  987.         sub     esp, 16
  988.         mov     edi, esp
  989.         call    PIO_read
  990.  
  991.         mov     esi, esp
  992.         add     esp, 16
  993.         lea     edi, [device.mac]
  994.         mov     ecx, 6
  995.   .loop:
  996.         movsb
  997.         test    [device.flags], FLAG_16BIT
  998.         jz      .8bit
  999.         inc     esi
  1000.   .8bit:
  1001.         loop    .loop
  1002.  
  1003.         DEBUGF  1,"MAC=%x-%x-%x-%x-%x-%x\n",\
  1004.         [device.mac]:2,[device.mac+1]:2,[device.mac+2]:2,[device.mac+3]:2,[device.mac+4]:2,[device.mac+5]:2
  1005.  
  1006.         ret
  1007.  
  1008.  
  1009. ;***************************************************************************
  1010. ;
  1011. ;   PIO_read
  1012. ;
  1013. ;   Description
  1014. ;       Read a frame from the ethernet card via Programmed I/O
  1015. ;      src in si
  1016. ;      cnt in cx
  1017. ;       dst in edi
  1018. ;***************************************************************************
  1019. PIO_read:
  1020.  
  1021.         DEBUGF  1,"PIO Read from %x to %x, %u bytes ", si, edi, cx
  1022.  
  1023. ; start DMA
  1024.         set_io  0
  1025. ;        set_io  P0_COMMAND
  1026.         mov     al, CMD_RD2 + CMD_STA
  1027.         out     dx, al
  1028.  
  1029. ; set length of data we're interested in
  1030.         set_io  P0_RBCR0
  1031.         mov     al, cl
  1032.         out     dx, al
  1033.  
  1034.         set_io  P0_RBCR1
  1035.         mov     al, ch
  1036.         out     dx, al
  1037.  
  1038. ; set offset of what we want to read
  1039.         set_io  P0_RSAR0
  1040.         mov     ax, si
  1041.         out     dx, al
  1042.  
  1043.         set_io  P0_RSAR1
  1044.         shr     ax, 8
  1045.         out     dx, al
  1046.  
  1047. ; start DMA read
  1048.         set_io  P0_COMMAND
  1049.         mov     al, CMD_RD0 + CMD_STA
  1050.         out     dx, al
  1051.  
  1052.         set_io  NE_ASIC
  1053.  
  1054.         test    [device.flags], FLAG_16BIT
  1055.         jz      .8bits
  1056.  
  1057.         DEBUGF  1,"(16-bit mode)\n"
  1058.  
  1059.         shr     cx, 1   ; note that if the number was odd, carry flag will be set
  1060.         pushf
  1061.  
  1062.   .16bits:
  1063.         in      ax, dx
  1064.         stosw
  1065.         loopw   .16bits
  1066.  
  1067.         inc     cx
  1068.         popf
  1069.         jnc     .done
  1070.         jmp     .8bits_
  1071.  
  1072.   .8bits:
  1073.         DEBUGF  1,"(8-bit mode)\n"
  1074.  
  1075.   .8bits_:
  1076.         in      al, dx
  1077.         stosb
  1078.         loopw   .8bits_
  1079.  
  1080.  
  1081.   .done:
  1082. ;        set_io  0
  1083. ;        set_io  P0_ISR
  1084. ;
  1085. ;  .dmawait:                             ; Wait for Remote DMA Complete
  1086. ;        in      al, dx
  1087. ;        test    al, ISR_RDC
  1088. ;        jz      .dmawait
  1089. ;        and     al, not ISR_RDC
  1090. ;        out     dx, al                  ; clear the bit
  1091.  
  1092.         ret
  1093.  
  1094.  
  1095.  
  1096.  
  1097. ;***************************************************************************
  1098. ;
  1099. ;   PIO_write
  1100. ;
  1101. ;   Description
  1102. ;       writes a frame to the ethernet card via Programmed I/O
  1103. ;      dst in di
  1104. ;      cnt in cx
  1105. ;       src in esi
  1106. ;***************************************************************************
  1107. PIO_write:
  1108.  
  1109.         DEBUGF  1,"Eth PIO Write from %x to %x, %u bytes ", esi, di, cx
  1110.  
  1111.         set_io  0
  1112. ;        set_io  P0_COMMAND
  1113.         mov     al, CMD_RD2 + CMD_STA
  1114.         out     dx, al
  1115.  
  1116.         set_io  P0_ISR
  1117.         mov     al, ISR_RDC
  1118.         out     dx, al
  1119.  
  1120.         set_io  P0_RBCR0
  1121.         mov     al, cl
  1122.         out     dx, al
  1123.  
  1124.         set_io  P0_RBCR1
  1125.         mov     al, ch
  1126.         out     dx, al
  1127.  
  1128.         mov     ax, di
  1129.         set_io  P0_RSAR0
  1130.         out     dx, al
  1131.         shr     ax, 8
  1132.         set_io  P0_RSAR1
  1133.         out     dx, al
  1134.  
  1135.         set_io  P0_COMMAND
  1136.         mov     al, CMD_RD1 + CMD_STA
  1137.         out     dx, al
  1138.  
  1139.         set_io  NE_ASIC
  1140.         test    [device.flags], FLAG_16BIT
  1141.         jz      .8_bit
  1142.  
  1143.         DEBUGF  1,"(16-bit mode)\n"
  1144.  
  1145.         shr     cx, 1   ; note that if the number was odd, carry flag will be set
  1146.         pushf           ; save the flags for later
  1147.  
  1148.   .16bit:
  1149.         lodsw
  1150.         out     dx, ax
  1151.         loopw   .16bit
  1152.  
  1153.         popf
  1154.         jnc     .done
  1155.         inc     cx
  1156.         jmp     .8_bit_
  1157.  
  1158.   .8_bit:
  1159.  
  1160.         DEBUGF  1,"(8-bit mode)\n"
  1161.  
  1162.   .8_bit_:
  1163.         lodsb
  1164.         out     dx, al
  1165.         loopw   .8_bit_
  1166.  
  1167.   .done:
  1168. ;        set_io  0
  1169. ;        set_io  P0_ISR
  1170. ;  .dmawait:                             ; Wait for Remote DMA Complete
  1171. ;        in      al, dx
  1172. ;        test    al, ISR_RDC
  1173. ;        jz      .dmawait
  1174. ;        and     al, not ISR_RDC
  1175. ;        out     dx, al                  ; clear the bit
  1176.  
  1177.         ret
  1178.  
  1179.  
  1180.  
  1181. ;all initialized data place here
  1182. align 4
  1183.  
  1184. devices         dd 0
  1185. version         dd (DRIVER_VERSION shl 16) or (API_VERSION and 0xFFFF)
  1186. my_service      db 'RTL8029/ne2000',0  ;max 16 chars include zero
  1187.  
  1188. ;device_1        db 'Realtek 8029',0
  1189. ;device_2        db 'Realtek 8019',0
  1190. ;device_3        db 'Realtek 8019AS',0
  1191. ;device_4        db 'ne2000',0
  1192. ;device_5        db 'DP8390',0
  1193.  
  1194. include_debug_strings
  1195.  
  1196. section '.data' data readable writable align 16  ;place all uninitialized data place here
  1197.  
  1198. device_list     rd MAX_DEVICES
  1199.  
  1200.  
  1201.  
  1202.  
  1203.  
  1204.