360 lines
11 KiB
C
360 lines
11 KiB
C
/*************************************************************************
|
|
Copyright (c) 2003-2007 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.
|
|
|
|
This Software, including technical data, may be subject to U.S. export control laws, including the U.S. Export Administration Act and its associated regulations, and may be subject to export or import regulations in other countries.
|
|
|
|
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.
|
|
|
|
*************************************************************************/
|
|
|
|
#include <sys/cdefs.h>
|
|
__FBSDID("$FreeBSD$");
|
|
|
|
#include <sys/param.h>
|
|
#include <sys/systm.h>
|
|
#include <sys/bus.h>
|
|
#include <sys/endian.h>
|
|
#include <sys/kernel.h>
|
|
#include <sys/mbuf.h>
|
|
#include <sys/socket.h>
|
|
|
|
#include <net/ethernet.h>
|
|
#include <net/if.h>
|
|
|
|
#include "wrapper-cvmx-includes.h"
|
|
#include "ethernet-headers.h"
|
|
|
|
static uint64_t cvm_oct_mac_addr = 0;
|
|
static uint32_t cvm_oct_mac_addr_offset = 0;
|
|
|
|
/**
|
|
* Set the multicast list. Currently unimplemented.
|
|
*
|
|
* @param dev Device to work on
|
|
*/
|
|
void cvm_oct_common_set_multicast_list(struct ifnet *ifp)
|
|
{
|
|
cvmx_gmxx_prtx_cfg_t gmx_cfg;
|
|
cvm_oct_private_t *priv = (cvm_oct_private_t *)ifp->if_softc;
|
|
int interface = INTERFACE(priv->port);
|
|
int index = INDEX(priv->port);
|
|
|
|
if ((interface < 2) && (cvmx_helper_interface_get_mode(interface) != CVMX_HELPER_INTERFACE_MODE_SPI)) {
|
|
cvmx_gmxx_rxx_adr_ctl_t control;
|
|
control.u64 = 0;
|
|
control.s.bcst = 1; /* Allow broadcast MAC addresses */
|
|
|
|
if (/*ifp->mc_list || */(ifp->if_flags&IFF_ALLMULTI) ||
|
|
(ifp->if_flags & IFF_PROMISC))
|
|
control.s.mcst = 2; /* Force accept multicast packets */
|
|
else
|
|
control.s.mcst = 1; /* Force reject multicat packets */
|
|
|
|
if (ifp->if_flags & IFF_PROMISC)
|
|
control.s.cam_mode = 0; /* Reject matches if promisc. Since CAM is shut off, should accept everything */
|
|
else
|
|
control.s.cam_mode = 1; /* Filter packets based on the CAM */
|
|
|
|
gmx_cfg.u64 = cvmx_read_csr(CVMX_GMXX_PRTX_CFG(index, interface));
|
|
cvmx_write_csr(CVMX_GMXX_PRTX_CFG(index, interface), gmx_cfg.u64 & ~1ull);
|
|
|
|
cvmx_write_csr(CVMX_GMXX_RXX_ADR_CTL(index, interface), control.u64);
|
|
if (ifp->if_flags&IFF_PROMISC)
|
|
cvmx_write_csr(CVMX_GMXX_RXX_ADR_CAM_EN(index, interface), 0);
|
|
else
|
|
cvmx_write_csr(CVMX_GMXX_RXX_ADR_CAM_EN(index, interface), 1);
|
|
|
|
cvmx_write_csr(CVMX_GMXX_PRTX_CFG(index, interface), gmx_cfg.u64);
|
|
}
|
|
}
|
|
|
|
|
|
/**
|
|
* Assign a MAC addres from the pool of available MAC addresses
|
|
* Can return as either a 64-bit value and/or 6 octets.
|
|
*
|
|
* @param macp Filled in with the assigned address if non-NULL
|
|
* @param octets Filled in with the assigned address if non-NULL
|
|
* @return Zero on success
|
|
*/
|
|
int cvm_assign_mac_address(uint64_t *macp, uint8_t *octets)
|
|
{
|
|
/* Initialize from global MAC address base; fail if not set */
|
|
if (cvm_oct_mac_addr == 0) {
|
|
memcpy((uint8_t *)&cvm_oct_mac_addr + 2,
|
|
cvmx_sysinfo_get()->mac_addr_base, 6);
|
|
|
|
if (cvm_oct_mac_addr == 0)
|
|
return ENXIO;
|
|
|
|
/*
|
|
* The offset from mac_addr_base that should be used for the next port
|
|
* that is configured. By convention, if any mgmt ports exist on the
|
|
* chip, they get the first mac addresses. The ports controlled by
|
|
* driver that use this function are numbered sequencially following
|
|
* any mgmt addresses that may exist.
|
|
*
|
|
* XXX Would be nice if __cvmx_mgmt_port_num_ports() were
|
|
* not static to cvmx-mgmt-port.c.
|
|
*/
|
|
if (OCTEON_IS_MODEL(OCTEON_CN56XX))
|
|
cvm_oct_mac_addr_offset = 1;
|
|
else if (OCTEON_IS_MODEL(OCTEON_CN52XX) || OCTEON_IS_MODEL(OCTEON_CN63XX))
|
|
cvm_oct_mac_addr_offset = 2;
|
|
else
|
|
cvm_oct_mac_addr_offset = 0;
|
|
cvm_oct_mac_addr += cvm_oct_mac_addr_offset;
|
|
}
|
|
|
|
if (cvm_oct_mac_addr_offset >= cvmx_sysinfo_get()->mac_addr_count)
|
|
return ENXIO; /* Out of addresses to assign */
|
|
|
|
if (macp)
|
|
*macp = cvm_oct_mac_addr;
|
|
if (octets)
|
|
memcpy(octets, (u_int8_t *)&cvm_oct_mac_addr + 2, 6);
|
|
|
|
cvm_oct_mac_addr++;
|
|
cvm_oct_mac_addr_offset++;
|
|
|
|
return 0;
|
|
}
|
|
|
|
/**
|
|
* Set the hardware MAC address for a device
|
|
*
|
|
* @param dev Device to change the MAC address for
|
|
* @param addr Address structure to change it too.
|
|
*/
|
|
void cvm_oct_common_set_mac_address(struct ifnet *ifp, const void *addr)
|
|
{
|
|
cvm_oct_private_t *priv = (cvm_oct_private_t *)ifp->if_softc;
|
|
cvmx_gmxx_prtx_cfg_t gmx_cfg;
|
|
int interface = INTERFACE(priv->port);
|
|
int index = INDEX(priv->port);
|
|
|
|
memcpy(priv->mac, addr, 6);
|
|
|
|
if ((interface < 2) && (cvmx_helper_interface_get_mode(interface) != CVMX_HELPER_INTERFACE_MODE_SPI)) {
|
|
int i;
|
|
const uint8_t *ptr = addr;
|
|
uint64_t mac = 0;
|
|
for (i = 0; i < 6; i++)
|
|
mac = (mac<<8) | (uint64_t)(ptr[i]);
|
|
|
|
gmx_cfg.u64 = cvmx_read_csr(CVMX_GMXX_PRTX_CFG(index, interface));
|
|
cvmx_write_csr(CVMX_GMXX_PRTX_CFG(index, interface), gmx_cfg.u64 & ~1ull);
|
|
|
|
cvmx_write_csr(CVMX_GMXX_SMACX(index, interface), mac);
|
|
cvmx_write_csr(CVMX_GMXX_RXX_ADR_CAM0(index, interface), ptr[0]);
|
|
cvmx_write_csr(CVMX_GMXX_RXX_ADR_CAM1(index, interface), ptr[1]);
|
|
cvmx_write_csr(CVMX_GMXX_RXX_ADR_CAM2(index, interface), ptr[2]);
|
|
cvmx_write_csr(CVMX_GMXX_RXX_ADR_CAM3(index, interface), ptr[3]);
|
|
cvmx_write_csr(CVMX_GMXX_RXX_ADR_CAM4(index, interface), ptr[4]);
|
|
cvmx_write_csr(CVMX_GMXX_RXX_ADR_CAM5(index, interface), ptr[5]);
|
|
cvm_oct_common_set_multicast_list(ifp);
|
|
cvmx_write_csr(CVMX_GMXX_PRTX_CFG(index, interface), gmx_cfg.u64);
|
|
}
|
|
}
|
|
|
|
|
|
/**
|
|
* Change the link MTU. Unimplemented
|
|
*
|
|
* @param dev Device to change
|
|
* @param new_mtu The new MTU
|
|
* @return Zero on success
|
|
*/
|
|
int cvm_oct_common_change_mtu(struct ifnet *ifp, int new_mtu)
|
|
{
|
|
cvm_oct_private_t *priv = (cvm_oct_private_t *)ifp->if_softc;
|
|
int interface = INTERFACE(priv->port);
|
|
int index = INDEX(priv->port);
|
|
int vlan_bytes = 4;
|
|
|
|
/* Limit the MTU to make sure the ethernet packets are between 64 bytes
|
|
and 65535 bytes */
|
|
if ((new_mtu + 14 + 4 + vlan_bytes < 64) || (new_mtu + 14 + 4 + vlan_bytes > 65392)) {
|
|
printf("MTU must be between %d and %d.\n", 64-14-4-vlan_bytes, 65392-14-4-vlan_bytes);
|
|
return -EINVAL;
|
|
}
|
|
ifp->if_mtu = new_mtu;
|
|
|
|
if ((interface < 2) && (cvmx_helper_interface_get_mode(interface) != CVMX_HELPER_INTERFACE_MODE_SPI)) {
|
|
int max_packet = new_mtu + 14 + 4 + vlan_bytes; /* Add ethernet header and FCS, and VLAN if configured. */
|
|
|
|
if (OCTEON_IS_MODEL(OCTEON_CN3XXX) || OCTEON_IS_MODEL(OCTEON_CN58XX)) {
|
|
/* Signal errors on packets larger than the MTU */
|
|
cvmx_write_csr(CVMX_GMXX_RXX_FRM_MAX(index, interface), max_packet);
|
|
} else {
|
|
/* Set the hardware to truncate packets larger than the MTU and
|
|
smaller the 64 bytes */
|
|
cvmx_pip_frm_len_chkx_t frm_len_chk;
|
|
frm_len_chk.u64 = 0;
|
|
frm_len_chk.s.minlen = 64;
|
|
frm_len_chk.s.maxlen = max_packet;
|
|
cvmx_write_csr(CVMX_PIP_FRM_LEN_CHKX(interface), frm_len_chk.u64);
|
|
}
|
|
/* Set the hardware to truncate packets larger than the MTU. The
|
|
jabber register must be set to a multiple of 8 bytes, so round up */
|
|
cvmx_write_csr(CVMX_GMXX_RXX_JABBER(index, interface), (max_packet + 7) & ~7u);
|
|
}
|
|
return 0;
|
|
}
|
|
|
|
|
|
/**
|
|
* Enable port.
|
|
*/
|
|
int cvm_oct_common_open(struct ifnet *ifp)
|
|
{
|
|
cvmx_gmxx_prtx_cfg_t gmx_cfg;
|
|
cvm_oct_private_t *priv = (cvm_oct_private_t *)ifp->if_softc;
|
|
int interface = INTERFACE(priv->port);
|
|
int index = INDEX(priv->port);
|
|
cvmx_helper_link_info_t link_info;
|
|
|
|
gmx_cfg.u64 = cvmx_read_csr(CVMX_GMXX_PRTX_CFG(index, interface));
|
|
gmx_cfg.s.en = 1;
|
|
cvmx_write_csr(CVMX_GMXX_PRTX_CFG(index, interface), gmx_cfg.u64);
|
|
|
|
/*
|
|
* Set the link state unless we are using MII.
|
|
*/
|
|
if (cvmx_sysinfo_get()->board_type != CVMX_BOARD_TYPE_SIM && priv->miibus == NULL) {
|
|
link_info = cvmx_helper_link_get(priv->port);
|
|
if (!link_info.s.link_up)
|
|
if_link_state_change(ifp, LINK_STATE_DOWN);
|
|
else
|
|
if_link_state_change(ifp, LINK_STATE_UP);
|
|
}
|
|
|
|
return 0;
|
|
}
|
|
|
|
|
|
/**
|
|
* Disable port.
|
|
*/
|
|
int cvm_oct_common_stop(struct ifnet *ifp)
|
|
{
|
|
cvmx_gmxx_prtx_cfg_t gmx_cfg;
|
|
cvm_oct_private_t *priv = (cvm_oct_private_t *)ifp->if_softc;
|
|
int interface = INTERFACE(priv->port);
|
|
int index = INDEX(priv->port);
|
|
|
|
gmx_cfg.u64 = cvmx_read_csr(CVMX_GMXX_PRTX_CFG(index, interface));
|
|
gmx_cfg.s.en = 0;
|
|
cvmx_write_csr(CVMX_GMXX_PRTX_CFG(index, interface), gmx_cfg.u64);
|
|
return 0;
|
|
}
|
|
|
|
/**
|
|
* Poll for link status change.
|
|
*/
|
|
void cvm_oct_common_poll(struct ifnet *ifp)
|
|
{
|
|
cvm_oct_private_t *priv = (cvm_oct_private_t *)ifp->if_softc;
|
|
cvmx_helper_link_info_t link_info;
|
|
|
|
/*
|
|
* If this is a simulation, do nothing.
|
|
*/
|
|
if (cvmx_sysinfo_get()->board_type == CVMX_BOARD_TYPE_SIM)
|
|
return;
|
|
|
|
/*
|
|
* If there is a device-specific poll method, use it.
|
|
*/
|
|
if (priv->poll != NULL) {
|
|
priv->poll(ifp);
|
|
return;
|
|
}
|
|
|
|
/*
|
|
* If an MII bus is attached, don't use the Simple Executive's link
|
|
* state routines.
|
|
*/
|
|
if (priv->miibus != NULL)
|
|
return;
|
|
|
|
/*
|
|
* Use the Simple Executive's link state routines.
|
|
*/
|
|
link_info = cvmx_helper_link_get(priv->port);
|
|
if (link_info.u64 == priv->link_info)
|
|
return;
|
|
|
|
link_info = cvmx_helper_link_autoconf(priv->port);
|
|
priv->link_info = link_info.u64;
|
|
priv->need_link_update = 1;
|
|
}
|
|
|
|
|
|
/**
|
|
* Per network device initialization
|
|
*
|
|
* @param dev Device to initialize
|
|
* @return Zero on success
|
|
*/
|
|
int cvm_oct_common_init(struct ifnet *ifp)
|
|
{
|
|
uint8_t mac[6];
|
|
cvm_oct_private_t *priv = (cvm_oct_private_t *)ifp->if_softc;
|
|
|
|
if (cvm_assign_mac_address(NULL, mac) != 0)
|
|
return ENXIO;
|
|
|
|
ifp->if_mtu = ETHERMTU;
|
|
|
|
cvm_oct_mdio_setup_device(ifp);
|
|
|
|
cvm_oct_common_set_mac_address(ifp, mac);
|
|
cvm_oct_common_change_mtu(ifp, ifp->if_mtu);
|
|
|
|
/*
|
|
* Do any last-minute board-specific initialization.
|
|
*/
|
|
switch (cvmx_sysinfo_get()->board_type) {
|
|
#if defined(OCTEON_VENDOR_LANNER)
|
|
case CVMX_BOARD_TYPE_CUST_LANNER_MR320:
|
|
case CVMX_BOARD_TYPE_CUST_LANNER_MR321X:
|
|
if (priv->phy_id == 16)
|
|
cvm_oct_mv88e61xx_setup_device(ifp);
|
|
break;
|
|
#endif
|
|
default:
|
|
break;
|
|
}
|
|
|
|
device_attach(priv->dev);
|
|
|
|
return 0;
|
|
}
|
|
|
|
void cvm_oct_common_uninit(struct ifnet *ifp)
|
|
{
|
|
/* Currently nothing to do */
|
|
}
|
|
|