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