3dc9275fe3
library: o) Increase inline unit / large function growth limits for MIPS to accommodate the needs of the Simple Executive, which uses a shocking amount of inlining. o) Remove TARGET_OCTEON and use CPU_CNMIPS to do things required by cnMIPS and the Octeon SoC. o) Add OCTEON_VENDOR_LANNER to use Lanner's allocation of vendor-specific board numbers, specifically to support the MR320. o) Add OCTEON_BOARD_CAPK_0100ND to hard-wire configuration for the CAPK-0100nd, which improperly uses an evaluation board's board number and breaks board detection at runtime. This board is sold by Portwell as the CAM-0100. o) Add support for the RTC available on some Octeon boards. o) Add support for the Octeon PCI bus. Note that rman_[sg]et_virtual for IO ports can not work unless building for n64. o) Clean up the CompactFlash driver to use Simple Executive macros and structures where possible (it would be advisable to use the Simple Executive API to set the PIO mode, too, but that is not done presently.) Also use structures from FreeBSD's ATA layer rather than structures copied from Linux. o) Print available Octeon SoC features on boot. o) Add support for the Octeon timecounter. o) Use the Simple Executive's routines rather than local copies for doing reads and writes to 64-bit addresses and use its macros for various device addresses rather than using local copies. o) Rename octeon_board_real to octeon_is_simulation to reduce differences with Cavium-provided code originally written for Linux. Also make it use the same simplified test that the Simple Executive and Linux both use rather than our complex one. o) Add support for the Octeon CIU, which is the main interrupt unit, as a bus to use normal interrupt allocation and setup routines. o) Use the Simple Executive's bootmem facility to allocate physical memory for the kernel, rather than assuming we know which addresses we can steal. NB: This may reduce the amount of RAM the kernel reports you as having if you are leaving large temporary allocations made by U-Boot allocated when starting FreeBSD. o) Add a port of the Cavium-provided Ethernet driver for Linux. This changes Ethernet interface naming from rgmxN to octeN. The new driver has vast improvements over the old one, both in performance and functionality, but does still have some features which have not been ported entirely and there may be unimplemented code that can be hit in everyday use. I will make every effort to correct those as they are reported. o) Support loading the kernel on non-contiguous cores. o) Add very conservative support for harvesting randomness from the Octeon random number device. o) Turn SMP on by default. o) Clean up the style of the Octeon kernel configurations a little and make them compile with -march=octeon. o) Add support for the Lanner MR320 and the CAPK-0100nd to the Simple Executive. o) Modify the Simple Executive to build on FreeBSD and to build without executive-config.h or cvmx-config.h. In the future we may want to revert part of these changes and supply executive-config.h and cvmx-config.h and access to the options contained in those files via kernel configuration files. o) Modify the Simple Executive USB routines to support getting and setting of the USB PID.
520 lines
18 KiB
C
520 lines
18 KiB
C
/***********************license start***************
|
|
* Copyright (c) 2003-2008 Cavium Networks (support@cavium.com). All rights
|
|
* reserved.
|
|
*
|
|
*
|
|
* Redistribution and use in source and binary forms, with or without
|
|
* modification, are permitted provided that the following conditions are
|
|
* met:
|
|
*
|
|
* * Redistributions of source code must retain the above copyright
|
|
* notice, this list of conditions and the following disclaimer.
|
|
*
|
|
* * Redistributions in binary form must reproduce the above
|
|
* copyright notice, this list of conditions and the following
|
|
* disclaimer in the documentation and/or other materials provided
|
|
* with the distribution.
|
|
*
|
|
* * Neither the name of Cavium Networks nor the names of
|
|
* its contributors may be used to endorse or promote products
|
|
* derived from this software without specific prior written
|
|
* permission.
|
|
*
|
|
* TO THE MAXIMUM EXTENT PERMITTED BY LAW, THE SOFTWARE IS PROVIDED "AS IS"
|
|
* AND WITH ALL FAULTS AND CAVIUM NETWORKS MAKES NO PROMISES, REPRESENTATIONS
|
|
* OR WARRANTIES, EITHER EXPRESS, IMPLIED, STATUTORY, OR OTHERWISE, WITH
|
|
* RESPECT TO THE SOFTWARE, INCLUDING ITS CONDITION, ITS CONFORMITY TO ANY
|
|
* REPRESENTATION OR DESCRIPTION, OR THE EXISTENCE OF ANY LATENT OR PATENT
|
|
* DEFECTS, AND CAVIUM SPECIFICALLY DISCLAIMS ALL IMPLIED (IF ANY) WARRANTIES
|
|
* OF TITLE, MERCHANTABILITY, NONINFRINGEMENT, FITNESS FOR A PARTICULAR
|
|
* PURPOSE, LACK OF VIRUSES, ACCURACY OR COMPLETENESS, QUIET ENJOYMENT, QUIET
|
|
* POSSESSION OR CORRESPONDENCE TO DESCRIPTION. THE ENTIRE RISK ARISING OUT
|
|
* OF USE OR PERFORMANCE OF THE SOFTWARE LIES WITH YOU.
|
|
*
|
|
*
|
|
* For any questions regarding licensing please contact marketing@caviumnetworks.com
|
|
*
|
|
***********************license end**************************************/
|
|
|
|
|
|
|
|
|
|
|
|
|
|
/**
|
|
* @file
|
|
*
|
|
* Functions for SGMII initialization, configuration,
|
|
* and monitoring.
|
|
*
|
|
* <hr>$Revision: 42417 $<hr>
|
|
*/
|
|
#include "cvmx.h"
|
|
#include "cvmx-sysinfo.h"
|
|
#include "cvmx-mdio.h"
|
|
#include "cvmx-helper.h"
|
|
#include "cvmx-helper-board.h"
|
|
|
|
#ifdef CVMX_ENABLE_PKO_FUNCTIONS
|
|
/**
|
|
* @INTERNAL
|
|
* Perform initialization required only once for an SGMII port.
|
|
*
|
|
* @param interface Interface to init
|
|
* @param index Index of prot on the interface
|
|
*
|
|
* @return Zero on success, negative on failure
|
|
*/
|
|
static int __cvmx_helper_sgmii_hardware_init_one_time(int interface, int index)
|
|
{
|
|
const uint64_t clock_mhz = cvmx_sysinfo_get()->cpu_clock_hz / 1000000;
|
|
cvmx_pcsx_miscx_ctl_reg_t pcs_misc_ctl_reg;
|
|
cvmx_pcsx_linkx_timer_count_reg_t pcsx_linkx_timer_count_reg;
|
|
cvmx_gmxx_prtx_cfg_t gmxx_prtx_cfg;
|
|
|
|
/* Disable GMX */
|
|
gmxx_prtx_cfg.u64 = cvmx_read_csr(CVMX_GMXX_PRTX_CFG(index, interface));
|
|
gmxx_prtx_cfg.s.en = 0;
|
|
cvmx_write_csr(CVMX_GMXX_PRTX_CFG(index, interface), gmxx_prtx_cfg.u64);
|
|
|
|
/* Write PCS*_LINK*_TIMER_COUNT_REG[COUNT] with the appropriate
|
|
value. 1000BASE-X specifies a 10ms interval. SGMII specifies a 1.6ms
|
|
interval. */
|
|
pcs_misc_ctl_reg.u64 = cvmx_read_csr(CVMX_PCSX_MISCX_CTL_REG(index, interface));
|
|
pcsx_linkx_timer_count_reg.u64 = cvmx_read_csr(CVMX_PCSX_LINKX_TIMER_COUNT_REG(index, interface));
|
|
if (pcs_misc_ctl_reg.s.mode)
|
|
{
|
|
/* 1000BASE-X */
|
|
pcsx_linkx_timer_count_reg.s.count = (10000ull * clock_mhz) >> 10;
|
|
}
|
|
else
|
|
{
|
|
/* SGMII */
|
|
pcsx_linkx_timer_count_reg.s.count = (1600ull * clock_mhz) >> 10;
|
|
}
|
|
cvmx_write_csr(CVMX_PCSX_LINKX_TIMER_COUNT_REG(index, interface), pcsx_linkx_timer_count_reg.u64);
|
|
|
|
/* Write the advertisement register to be used as the
|
|
tx_Config_Reg<D15:D0> of the autonegotiation.
|
|
In 1000BASE-X mode, tx_Config_Reg<D15:D0> is PCS*_AN*_ADV_REG.
|
|
In SGMII PHY mode, tx_Config_Reg<D15:D0> is PCS*_SGM*_AN_ADV_REG.
|
|
In SGMII MAC mode, tx_Config_Reg<D15:D0> is the fixed value 0x4001, so
|
|
this step can be skipped. */
|
|
if (pcs_misc_ctl_reg.s.mode)
|
|
{
|
|
/* 1000BASE-X */
|
|
cvmx_pcsx_anx_adv_reg_t pcsx_anx_adv_reg;
|
|
pcsx_anx_adv_reg.u64 = cvmx_read_csr(CVMX_PCSX_ANX_ADV_REG(index, interface));
|
|
pcsx_anx_adv_reg.s.rem_flt = 0;
|
|
pcsx_anx_adv_reg.s.pause = 3;
|
|
pcsx_anx_adv_reg.s.hfd = 1;
|
|
pcsx_anx_adv_reg.s.fd = 1;
|
|
cvmx_write_csr(CVMX_PCSX_ANX_ADV_REG(index, interface), pcsx_anx_adv_reg.u64);
|
|
}
|
|
else
|
|
{
|
|
cvmx_pcsx_miscx_ctl_reg_t pcsx_miscx_ctl_reg;
|
|
pcsx_miscx_ctl_reg.u64 = cvmx_read_csr(CVMX_PCSX_MISCX_CTL_REG(index, interface));
|
|
if (pcsx_miscx_ctl_reg.s.mac_phy)
|
|
{
|
|
/* PHY Mode */
|
|
cvmx_pcsx_sgmx_an_adv_reg_t pcsx_sgmx_an_adv_reg;
|
|
pcsx_sgmx_an_adv_reg.u64 = cvmx_read_csr(CVMX_PCSX_SGMX_AN_ADV_REG(index, interface));
|
|
pcsx_sgmx_an_adv_reg.s.link = 1;
|
|
pcsx_sgmx_an_adv_reg.s.dup = 1;
|
|
pcsx_sgmx_an_adv_reg.s.speed= 2;
|
|
cvmx_write_csr(CVMX_PCSX_SGMX_AN_ADV_REG(index, interface), pcsx_sgmx_an_adv_reg.u64);
|
|
}
|
|
else
|
|
{
|
|
/* MAC Mode - Nothing to do */
|
|
}
|
|
}
|
|
return 0;
|
|
}
|
|
|
|
|
|
/**
|
|
* @INTERNAL
|
|
* Initialize the SERTES link for the first time or after a loss
|
|
* of link.
|
|
*
|
|
* @param interface Interface to init
|
|
* @param index Index of prot on the interface
|
|
*
|
|
* @return Zero on success, negative on failure
|
|
*/
|
|
static int __cvmx_helper_sgmii_hardware_init_link(int interface, int index)
|
|
{
|
|
cvmx_pcsx_mrx_control_reg_t control_reg;
|
|
|
|
/* Take PCS through a reset sequence.
|
|
PCS*_MR*_CONTROL_REG[PWR_DN] should be cleared to zero.
|
|
Write PCS*_MR*_CONTROL_REG[RESET]=1 (while not changing the value of
|
|
the other PCS*_MR*_CONTROL_REG bits).
|
|
Read PCS*_MR*_CONTROL_REG[RESET] until it changes value to zero. */
|
|
control_reg.u64 = cvmx_read_csr(CVMX_PCSX_MRX_CONTROL_REG(index, interface));
|
|
if (cvmx_sysinfo_get()->board_type != CVMX_BOARD_TYPE_SIM)
|
|
{
|
|
control_reg.s.reset = 1;
|
|
cvmx_write_csr(CVMX_PCSX_MRX_CONTROL_REG(index, interface), control_reg.u64);
|
|
if (CVMX_WAIT_FOR_FIELD64(CVMX_PCSX_MRX_CONTROL_REG(index, interface), cvmx_pcsx_mrx_control_reg_t, reset, ==, 0, 10000))
|
|
{
|
|
cvmx_dprintf("SGMII%d: Timeout waiting for port %d to finish reset\n", interface, index);
|
|
return -1;
|
|
}
|
|
}
|
|
|
|
/* Write PCS*_MR*_CONTROL_REG[RST_AN]=1 to ensure a fresh sgmii negotiation starts. */
|
|
control_reg.s.rst_an = 1;
|
|
control_reg.s.an_en = 1;
|
|
control_reg.s.pwr_dn = 0;
|
|
cvmx_write_csr(CVMX_PCSX_MRX_CONTROL_REG(index, interface), control_reg.u64);
|
|
|
|
/* Wait for PCS*_MR*_STATUS_REG[AN_CPT] to be set, indicating that
|
|
sgmii autonegotiation is complete. In MAC mode this isn't an ethernet
|
|
link, but a link between Octeon and the PHY */
|
|
if ((cvmx_sysinfo_get()->board_type != CVMX_BOARD_TYPE_SIM) &&
|
|
CVMX_WAIT_FOR_FIELD64(CVMX_PCSX_MRX_STATUS_REG(index, interface), cvmx_pcsx_mrx_status_reg_t, an_cpt, ==, 1, 10000))
|
|
{
|
|
//cvmx_dprintf("SGMII%d: Port %d link timeout\n", interface, index);
|
|
return -1;
|
|
}
|
|
return 0;
|
|
}
|
|
|
|
|
|
/**
|
|
* @INTERNAL
|
|
* Configure an SGMII link to the specified speed after the SERTES
|
|
* link is up.
|
|
*
|
|
* @param interface Interface to init
|
|
* @param index Index of prot on the interface
|
|
* @param link_info Link state to configure
|
|
*
|
|
* @return Zero on success, negative on failure
|
|
*/
|
|
static int __cvmx_helper_sgmii_hardware_init_link_speed(int interface, int index, cvmx_helper_link_info_t link_info)
|
|
{
|
|
int is_enabled;
|
|
cvmx_gmxx_prtx_cfg_t gmxx_prtx_cfg;
|
|
cvmx_pcsx_miscx_ctl_reg_t pcsx_miscx_ctl_reg;
|
|
|
|
/* Disable GMX before we make any changes. Remember the enable state */
|
|
gmxx_prtx_cfg.u64 = cvmx_read_csr(CVMX_GMXX_PRTX_CFG(index, interface));
|
|
is_enabled = gmxx_prtx_cfg.s.en;
|
|
gmxx_prtx_cfg.s.en = 0;
|
|
cvmx_write_csr(CVMX_GMXX_PRTX_CFG(index, interface), gmxx_prtx_cfg.u64);
|
|
|
|
/* Wait for GMX to be idle */
|
|
if (CVMX_WAIT_FOR_FIELD64(CVMX_GMXX_PRTX_CFG(index, interface), cvmx_gmxx_prtx_cfg_t, rx_idle, ==, 1, 10000) ||
|
|
CVMX_WAIT_FOR_FIELD64(CVMX_GMXX_PRTX_CFG(index, interface), cvmx_gmxx_prtx_cfg_t, tx_idle, ==, 1, 10000))
|
|
{
|
|
cvmx_dprintf("SGMII%d: Timeout waiting for port %d to be idle\n", interface, index);
|
|
return -1;
|
|
}
|
|
|
|
/* Read GMX CFG again to make sure the disable completed */
|
|
gmxx_prtx_cfg.u64 = cvmx_read_csr(CVMX_GMXX_PRTX_CFG(index, interface));
|
|
|
|
/* Get the misc control for PCS. We will need to set the duplication amount */
|
|
pcsx_miscx_ctl_reg.u64 = cvmx_read_csr(CVMX_PCSX_MISCX_CTL_REG(index, interface));
|
|
|
|
/* Use GMXENO to force the link down if the status we get says it should be down */
|
|
pcsx_miscx_ctl_reg.s.gmxeno = !link_info.s.link_up;
|
|
|
|
/* Only change the duplex setting if the link is up */
|
|
if (link_info.s.link_up)
|
|
gmxx_prtx_cfg.s.duplex = link_info.s.full_duplex;
|
|
|
|
/* Do speed based setting for GMX */
|
|
switch (link_info.s.speed)
|
|
{
|
|
case 10:
|
|
gmxx_prtx_cfg.s.speed = 0;
|
|
gmxx_prtx_cfg.s.speed_msb = 1;
|
|
gmxx_prtx_cfg.s.slottime = 0;
|
|
pcsx_miscx_ctl_reg.s.samp_pt = 25; /* Setting from GMX-603 */
|
|
cvmx_write_csr(CVMX_GMXX_TXX_SLOT(index, interface), 64);
|
|
cvmx_write_csr(CVMX_GMXX_TXX_BURST(index, interface), 0);
|
|
break;
|
|
case 100:
|
|
gmxx_prtx_cfg.s.speed = 0;
|
|
gmxx_prtx_cfg.s.speed_msb = 0;
|
|
gmxx_prtx_cfg.s.slottime = 0;
|
|
pcsx_miscx_ctl_reg.s.samp_pt = 0x5;
|
|
cvmx_write_csr(CVMX_GMXX_TXX_SLOT(index, interface), 64);
|
|
cvmx_write_csr(CVMX_GMXX_TXX_BURST(index, interface), 0);
|
|
break;
|
|
case 1000:
|
|
gmxx_prtx_cfg.s.speed = 1;
|
|
gmxx_prtx_cfg.s.speed_msb = 0;
|
|
gmxx_prtx_cfg.s.slottime = 1;
|
|
pcsx_miscx_ctl_reg.s.samp_pt = 1;
|
|
cvmx_write_csr(CVMX_GMXX_TXX_SLOT(index, interface), 512);
|
|
cvmx_write_csr(CVMX_GMXX_TXX_BURST(index, interface), 8192);
|
|
break;
|
|
default:
|
|
break;
|
|
}
|
|
|
|
/* Write the new misc control for PCS */
|
|
cvmx_write_csr(CVMX_PCSX_MISCX_CTL_REG(index, interface), pcsx_miscx_ctl_reg.u64);
|
|
|
|
/* Write the new GMX settings with the port still disabled */
|
|
cvmx_write_csr(CVMX_GMXX_PRTX_CFG(index, interface), gmxx_prtx_cfg.u64);
|
|
|
|
/* Read GMX CFG again to make sure the config completed */
|
|
gmxx_prtx_cfg.u64 = cvmx_read_csr(CVMX_GMXX_PRTX_CFG(index, interface));
|
|
|
|
/* Restore the enabled / disabled state */
|
|
gmxx_prtx_cfg.s.en = is_enabled;
|
|
cvmx_write_csr(CVMX_GMXX_PRTX_CFG(index, interface), gmxx_prtx_cfg.u64);
|
|
|
|
return 0;
|
|
}
|
|
|
|
|
|
/**
|
|
* @INTERNAL
|
|
* Bring up the SGMII interface to be ready for packet I/O but
|
|
* leave I/O disabled using the GMX override. This function
|
|
* follows the bringup documented in 10.6.3 of the manual.
|
|
*
|
|
* @param interface Interface to bringup
|
|
* @param num_ports Number of ports on the interface
|
|
*
|
|
* @return Zero on success, negative on failure
|
|
*/
|
|
static int __cvmx_helper_sgmii_hardware_init(int interface, int num_ports)
|
|
{
|
|
int index;
|
|
|
|
__cvmx_helper_setup_gmx(interface, num_ports);
|
|
|
|
for (index=0; index<num_ports; index++)
|
|
{
|
|
int ipd_port = cvmx_helper_get_ipd_port(interface, index);
|
|
__cvmx_helper_sgmii_hardware_init_one_time(interface, index);
|
|
__cvmx_helper_sgmii_link_set(ipd_port, __cvmx_helper_sgmii_link_get(ipd_port));
|
|
|
|
}
|
|
|
|
return 0;
|
|
}
|
|
|
|
|
|
/**
|
|
* @INTERNAL
|
|
* Probe a SGMII interface and determine the number of ports
|
|
* connected to it. The SGMII interface should still be down after
|
|
* this call.
|
|
*
|
|
* @param interface Interface to probe
|
|
*
|
|
* @return Number of ports on the interface. Zero to disable.
|
|
*/
|
|
int __cvmx_helper_sgmii_probe(int interface)
|
|
{
|
|
cvmx_gmxx_inf_mode_t mode;
|
|
|
|
/* Due to errata GMX-700 on CN56XXp1.x and CN52XXp1.x, the interface
|
|
needs to be enabled before IPD otherwise per port backpressure
|
|
may not work properly */
|
|
mode.u64 = cvmx_read_csr(CVMX_GMXX_INF_MODE(interface));
|
|
mode.s.en = 1;
|
|
cvmx_write_csr(CVMX_GMXX_INF_MODE(interface), mode.u64);
|
|
return 4;
|
|
}
|
|
|
|
|
|
/**
|
|
* @INTERNAL
|
|
* Bringup and enable a SGMII interface. After this call packet
|
|
* I/O should be fully functional. This is called with IPD
|
|
* enabled but PKO disabled.
|
|
*
|
|
* @param interface Interface to bring up
|
|
*
|
|
* @return Zero on success, negative on failure
|
|
*/
|
|
int __cvmx_helper_sgmii_enable(int interface)
|
|
{
|
|
int num_ports = cvmx_helper_ports_on_interface(interface);
|
|
int index;
|
|
|
|
__cvmx_helper_sgmii_hardware_init(interface, num_ports);
|
|
|
|
for (index=0; index<num_ports; index++)
|
|
{
|
|
cvmx_gmxx_prtx_cfg_t gmxx_prtx_cfg;
|
|
gmxx_prtx_cfg.u64 = cvmx_read_csr(CVMX_GMXX_PRTX_CFG(index, interface));
|
|
gmxx_prtx_cfg.s.en = 1;
|
|
cvmx_write_csr(CVMX_GMXX_PRTX_CFG(index, interface), gmxx_prtx_cfg.u64);
|
|
}
|
|
return 0;
|
|
}
|
|
|
|
|
|
/**
|
|
* @INTERNAL
|
|
* Return the link state of an IPD/PKO port as returned by
|
|
* auto negotiation. The result of this function may not match
|
|
* Octeon's link config if auto negotiation has changed since
|
|
* the last call to cvmx_helper_link_set().
|
|
*
|
|
* @param ipd_port IPD/PKO port to query
|
|
*
|
|
* @return Link state
|
|
*/
|
|
cvmx_helper_link_info_t __cvmx_helper_sgmii_link_get(int ipd_port)
|
|
{
|
|
cvmx_helper_link_info_t result;
|
|
cvmx_pcsx_miscx_ctl_reg_t pcs_misc_ctl_reg;
|
|
int interface = cvmx_helper_get_interface_num(ipd_port);
|
|
int index = cvmx_helper_get_interface_index_num(ipd_port);
|
|
cvmx_pcsx_mrx_control_reg_t pcsx_mrx_control_reg;
|
|
|
|
result.u64 = 0;
|
|
|
|
if (cvmx_sysinfo_get()->board_type == CVMX_BOARD_TYPE_SIM)
|
|
{
|
|
/* The simulator gives you a simulated 1Gbps full duplex link */
|
|
result.s.link_up = 1;
|
|
result.s.full_duplex = 1;
|
|
result.s.speed = 1000;
|
|
return result;
|
|
}
|
|
|
|
pcsx_mrx_control_reg.u64 = cvmx_read_csr(CVMX_PCSX_MRX_CONTROL_REG(index, interface));
|
|
if (pcsx_mrx_control_reg.s.loopbck1)
|
|
{
|
|
/* Force 1Gbps full duplex link for internal loopback */
|
|
result.s.link_up = 1;
|
|
result.s.full_duplex = 1;
|
|
result.s.speed = 1000;
|
|
return result;
|
|
}
|
|
|
|
|
|
pcs_misc_ctl_reg.u64 = cvmx_read_csr(CVMX_PCSX_MISCX_CTL_REG(index, interface));
|
|
if (pcs_misc_ctl_reg.s.mode)
|
|
{
|
|
/* 1000BASE-X */
|
|
// FIXME
|
|
}
|
|
else
|
|
{
|
|
cvmx_pcsx_miscx_ctl_reg_t pcsx_miscx_ctl_reg;
|
|
pcsx_miscx_ctl_reg.u64 = cvmx_read_csr(CVMX_PCSX_MISCX_CTL_REG(index, interface));
|
|
if (pcsx_miscx_ctl_reg.s.mac_phy)
|
|
{
|
|
/* PHY Mode */
|
|
cvmx_pcsx_mrx_status_reg_t pcsx_mrx_status_reg;
|
|
cvmx_pcsx_anx_results_reg_t pcsx_anx_results_reg;
|
|
|
|
/* Don't bother continuing if the SERTES low level link is down */
|
|
pcsx_mrx_status_reg.u64 = cvmx_read_csr(CVMX_PCSX_MRX_STATUS_REG(index, interface));
|
|
if (pcsx_mrx_status_reg.s.lnk_st == 0)
|
|
{
|
|
if (__cvmx_helper_sgmii_hardware_init_link(interface, index) != 0)
|
|
return result;
|
|
}
|
|
|
|
/* Read the autoneg results */
|
|
pcsx_anx_results_reg.u64 = cvmx_read_csr(CVMX_PCSX_ANX_RESULTS_REG(index, interface));
|
|
if (pcsx_anx_results_reg.s.an_cpt)
|
|
{
|
|
/* Auto negotiation is complete. Set status accordingly */
|
|
result.s.full_duplex = pcsx_anx_results_reg.s.dup;
|
|
result.s.link_up = pcsx_anx_results_reg.s.link_ok;
|
|
switch (pcsx_anx_results_reg.s.spd)
|
|
{
|
|
case 0:
|
|
result.s.speed = 10;
|
|
break;
|
|
case 1:
|
|
result.s.speed = 100;
|
|
break;
|
|
case 2:
|
|
result.s.speed = 1000;
|
|
break;
|
|
default:
|
|
result.s.speed = 0;
|
|
result.s.link_up = 0;
|
|
break;
|
|
}
|
|
}
|
|
else
|
|
{
|
|
/* Auto negotiation isn't complete. Return link down */
|
|
result.s.speed = 0;
|
|
result.s.link_up = 0;
|
|
}
|
|
}
|
|
else /* MAC Mode */
|
|
{
|
|
result = __cvmx_helper_board_link_get(ipd_port);
|
|
}
|
|
}
|
|
return result;
|
|
}
|
|
|
|
|
|
/**
|
|
* @INTERNAL
|
|
* Configure an IPD/PKO port for the specified link state. This
|
|
* function does not influence auto negotiation at the PHY level.
|
|
* The passed link state must always match the link state returned
|
|
* by cvmx_helper_link_get(). It is normally best to use
|
|
* cvmx_helper_link_autoconf() instead.
|
|
*
|
|
* @param ipd_port IPD/PKO port to configure
|
|
* @param link_info The new link state
|
|
*
|
|
* @return Zero on success, negative on failure
|
|
*/
|
|
int __cvmx_helper_sgmii_link_set(int ipd_port, cvmx_helper_link_info_t link_info)
|
|
{
|
|
int interface = cvmx_helper_get_interface_num(ipd_port);
|
|
int index = cvmx_helper_get_interface_index_num(ipd_port);
|
|
__cvmx_helper_sgmii_hardware_init_link(interface, index);
|
|
return __cvmx_helper_sgmii_hardware_init_link_speed(interface, index, link_info);
|
|
}
|
|
|
|
/**
|
|
* @INTERNAL
|
|
* Configure a port for internal and/or external loopback. Internal loopback
|
|
* causes packets sent by the port to be received by Octeon. External loopback
|
|
* causes packets received from the wire to sent out again.
|
|
*
|
|
* @param ipd_port IPD/PKO port to loopback.
|
|
* @param enable_internal
|
|
* Non zero if you want internal loopback
|
|
* @param enable_external
|
|
* Non zero if you want external loopback
|
|
*
|
|
* @return Zero on success, negative on failure.
|
|
*/
|
|
int __cvmx_helper_sgmii_configure_loopback(int ipd_port, int enable_internal, int enable_external)
|
|
{
|
|
int interface = cvmx_helper_get_interface_num(ipd_port);
|
|
int index = cvmx_helper_get_interface_index_num(ipd_port);
|
|
cvmx_pcsx_mrx_control_reg_t pcsx_mrx_control_reg;
|
|
cvmx_pcsx_miscx_ctl_reg_t pcsx_miscx_ctl_reg;
|
|
|
|
pcsx_mrx_control_reg.u64 = cvmx_read_csr(CVMX_PCSX_MRX_CONTROL_REG(index, interface));
|
|
pcsx_mrx_control_reg.s.loopbck1 = enable_internal;
|
|
cvmx_write_csr(CVMX_PCSX_MRX_CONTROL_REG(index, interface), pcsx_mrx_control_reg.u64);
|
|
|
|
pcsx_miscx_ctl_reg.u64 = cvmx_read_csr(CVMX_PCSX_MISCX_CTL_REG(index, interface));
|
|
pcsx_miscx_ctl_reg.s.loopbck2 = enable_external;
|
|
cvmx_write_csr(CVMX_PCSX_MISCX_CTL_REG(index, interface), pcsx_miscx_ctl_reg.u64);
|
|
|
|
__cvmx_helper_sgmii_hardware_init_link(interface, index);
|
|
return 0;
|
|
}
|
|
|
|
#endif /* CVMX_ENABLE_PKO_FUNCTIONS */
|