git.gag.com Git - debian/gnuradio/blob - usrp2/firmware/lib/eth_mac.c

   1 /* -*- c++ -*- */
   2 /*
   3  * Copyright 2007 Free Software Foundation, Inc.
   4  *
   5  * This program is free software: you can redistribute it and/or modify
   6  * it under the terms of the GNU General Public License as published by
   7  * the Free Software Foundation, either version 3 of the License, or
   8  * (at your option) any later version.
   9  *
  10  * This program is distributed in the hope that it will be useful,
  11  * but WITHOUT ANY WARRANTY; without even the implied warranty of
  12  * MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE.  See the
  13  * GNU General Public License for more details.
  14  *
  15  * You should have received a copy of the GNU General Public License
  16  * along with this program.  If not, see <http://www.gnu.org/licenses/>.
  17  */
  18
  19 #include "eth_mac.h"
  20 #include "memory_map.h"
  21 #include "bool.h"
  22 #include "eth_phy.h"    // for simulation constants
  23 #include "mdelay.h"
  24
  25
  26 #define PHY_ADDR 1
  27
  28 void
  29 eth_mac_set_addr(const u2_mac_addr_t *src)
  30 {
  31   int i;
  32
  33   // tell mac our source address and enable automatic insertion on Tx.
  34   eth_mac->mac_tx_add_prom_wr = 0;      // just in case
  35   for (i = 0; i < 6; i++){
  36     eth_mac->mac_tx_add_prom_add = i;
  37     eth_mac->mac_tx_add_prom_data = src->addr[i];
  38     eth_mac->mac_tx_add_prom_wr = 1;
  39     mdelay(1);
  40     eth_mac->mac_tx_add_prom_wr = 0;
  41     mdelay(1);
  42   }
  43   eth_mac->mac_tx_add_en = 1;  // overwrite pkt src addr field with this stuff
  44
  45   // set up receive destination address filter
  46   eth_mac->mac_rx_add_prom_wr = 0;      // just in case
  47   for (i = 0; i < 6; i++){
  48     eth_mac->mac_rx_add_prom_add = i;
  49     eth_mac->mac_rx_add_prom_data = src->addr[i];
  50     eth_mac->mac_rx_add_prom_wr = 1;
  51     mdelay(1);
  52     eth_mac->mac_rx_add_prom_wr = 0;
  53     mdelay(1);
  54   }
  55   // eth_mac->mac_rx_add_chk_en = 1;  // FIXME enable when everything's working
  56 }
  57
  58
  59 void
  60 eth_mac_init(const u2_mac_addr_t *src)
  61 {
  62   eth_mac->miimoder = 25;       // divider from CPU clock (50MHz/25 = 2MHz)
  63
  64   eth_mac_set_addr(src);
  65
  66   // set rx flow control high and low water marks
  67   // unsigned int lwmark = (2*2048 + 64)/4; // 2 * 2048-byte frames + 1 * 64-byte pause frame
  68   // eth_mac->fc_hwmark = lwmark + 2048/4;  // plus a 2048-byte frame
  69
  70   eth_mac->fc_lwmark = 600;             // there are currently 2047 lines in the fifo
  71   eth_mac->fc_hwmark = 1200;
  72   eth_mac->fc_padtime = 1700;           // how long before flow control runs out do we
  73                                         // request a re-pause.  Units of 8ns (bytes)
  74
  75   //eth_mac->tx_pause_en = 0;           // pay attn to pause frames sent to us
  76   //eth_mac->pause_quanta_set = 38;     // a bit more than 1 max frame 16kb/512 + fudge
  77   //eth_mac->pause_frame_send_en = 0;   // enable sending pause frames
  78 }
  79
  80 int
  81 eth_mac_read_rmon(int addr)
  82 {
  83   int t;
  84
  85   eth_mac->rmon_rd_addr = addr;
  86   eth_mac->rmon_rd_apply = 1;
  87   while(eth_mac->rmon_rd_grant == 0)
  88     ;
  89
  90   t = eth_mac->rmon_rd_dout;
  91   eth_mac->rmon_rd_apply = 0;
  92   return t;
  93 }
  94
  95 int
  96 eth_mac_miim_read(int addr)
  97 {
  98   if (hwconfig_simulation_p()){
  99     switch(addr){
 100     case PHY_LINK_AN:
 101       return LANSR_MASTER | LANSR_LINK_GOOD | LANSR_SPEED_1000;
 102     default:
 103       return 0;
 104     }
 105   }
 106
 107   int phy_addr = PHY_ADDR;
 108   eth_mac->miiaddress = ((addr & 0x1f) << 8) | phy_addr;
 109   eth_mac->miicommand = MIIC_RSTAT;
 110
 111   while((eth_mac->miistatus & MIIS_BUSY) != 0)
 112     ;
 113
 114   return eth_mac->miirx_data;
 115 }
 116
 117 void
 118 eth_mac_miim_write(int addr, int value)
 119 {
 120   int phy_addr = PHY_ADDR;
 121   eth_mac->miiaddress = ((addr & 0x1f) << 8) | phy_addr;
 122   eth_mac->miitx_data = value;
 123   eth_mac->miicommand = MIIC_WCTRLDATA;
 124
 125   while((eth_mac->miistatus & MIIS_BUSY) != 0)
 126     ;
 127 }
 128
 129 int
 130 eth_mac_miim_read_status(void)
 131 {
 132   if (hwconfig_simulation_p())
 133     return 0;
 134
 135   return eth_mac->miistatus;
 136 }