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 #include "stdio.h"
  25
  26 #define PHY_ADDR 1
  27
  28 void
  29 eth_mac_set_addr(const u2_mac_addr_t *src)
  30 {
  31   eth_mac->ucast_hi =
  32     (((unsigned int)src->addr[0])<<8) +
  33     ((unsigned int)src->addr[1]);
  34   eth_mac->ucast_lo =
  35     (((unsigned int)src->addr[2])<<24) +
  36     (((unsigned int)src->addr[3])<<16) +
  37     (((unsigned int)src->addr[4])<<8) +
  38     (((unsigned int)src->addr[5]));
  39   printf("RDBK %x:%x\n",eth_mac->ucast_hi,eth_mac->ucast_lo);
  40 }
  41
  42
  43 void
  44 eth_mac_init(const u2_mac_addr_t *src)
  45 {
  46   eth_mac->miimoder = 25;       // divider from CPU clock (50MHz/25 = 2MHz)
  47
  48   eth_mac_set_addr(src);
  49   eth_mac->settings = MAC_SET_PAUSE_EN | MAC_SET_PASS_BCAST | MAC_SET_PASS_UCAST;  // 0x39;
  50
  51   // set rx flow control high and low water marks
  52   // unsigned int lwmark = (2*2048 + 64)/4; // 2 * 2048-byte frames + 1 * 64-byte pause frame
  53   // eth_mac->fc_hwmark = lwmark + 2048/4;  // plus a 2048-byte frame
  54
  55   //  eth_mac->fc_lwmark = 600;         // there are currently 2047 lines in the fifo
  56   // eth_mac->fc_hwmark = 1200;
  57   //eth_mac->fc_padtime = 1700;           // how long before flow control runs out do we
  58                                         // request a re-pause.  Units of 8ns (bytes)
  59
  60   //eth_mac->tx_pause_en = 0;           // pay attn to pause frames sent to us
  61   //eth_mac->pause_quanta_set = 38;     // a bit more than 1 max frame 16kb/512 + fudge
  62   //eth_mac->pause_frame_send_en = 0;   // enable sending pause frames
  63 }
  64
  65 int
  66 eth_mac_read_rmon(int addr)
  67 {
  68   int t = 0;
  69   /*
  70   eth_mac->rmon_rd_addr = addr;
  71   eth_mac->rmon_rd_apply = 1;
  72   while(eth_mac->rmon_rd_grant == 0)
  73     ;
  74
  75   t = eth_mac->rmon_rd_dout;
  76   eth_mac->rmon_rd_apply = 0;
  77   */
  78   return t;
  79 }
  80
  81 int
  82 eth_mac_miim_read(int addr)
  83 {
  84   if (hwconfig_simulation_p()){
  85     switch(addr){
  86     case PHY_LINK_AN:
  87       return LANSR_MASTER | LANSR_LINK_GOOD | LANSR_SPEED_1000;
  88     default:
  89       return 0;
  90     }
  91   }
  92
  93   int phy_addr = PHY_ADDR;
  94   eth_mac->miiaddress = ((addr & 0x1f) << 8) | phy_addr;
  95   eth_mac->miicommand = MIIC_RSTAT;
  96
  97   while((eth_mac->miistatus & MIIS_BUSY) != 0)
  98     ;
  99
 100   int r = eth_mac->miirx_data;
 101   //printf("MIIM-READ ADDR 0x%x DATA 0x%x\n",addr, r);
 102   return r;
 103 }
 104
 105 void
 106 eth_mac_miim_write(int addr, int value)
 107 {
 108   int phy_addr = PHY_ADDR;
 109   eth_mac->miiaddress = ((addr & 0x1f) << 8) | phy_addr;
 110   eth_mac->miitx_data = value;
 111   eth_mac->miicommand = MIIC_WCTRLDATA;
 112
 113   //printf("MIIM-WRITE ADDR 0x%x VAL 0x%x\n",addr,value);
 114   while((eth_mac->miistatus & MIIS_BUSY) != 0)
 115     ;
 116 }
 117
 118 int
 119 eth_mac_miim_read_status(void)
 120 {
 121   if (hwconfig_simulation_p())
 122     return 0;
 123
 124   return eth_mac->miistatus;
 125 }