#include <sys/cdefs.h>
__FBSDID("$FreeBSD$");
#include <sys/param.h>
#include <sys/bitstring.h>
#include <sys/kernel.h>
#include <sys/socket.h>
#include <net/ethernet.h>
#include <net/if.h>
#include <net/if_media.h>
#include <net/if_var.h>
#include <net/iflib.h>
#include "aq_device.h"
#include "aq_fw.h"
#include "aq_dbg.h"
static const struct aq_media_map {
uint32_t link_bit;
enum aq_fw_link_speed fw_rate;
int ifm;
uint32_t mbps;
} aq_media_types[] = {
{ AQ_LINK_10M, aq_fw_10M, IFM_10_T, 10 },
{ AQ_LINK_100M, aq_fw_100M, IFM_100_TX, 100 },
{ AQ_LINK_1G, aq_fw_1G, IFM_1000_T, 1000 },
{ AQ_LINK_2G5, aq_fw_2G5, IFM_2500_T, 2500 },
{ AQ_LINK_5G, aq_fw_5G, IFM_5000_T, 5000 },
{ AQ_LINK_10G, aq_fw_10G, IFM_10G_T, 10000 },
};
void
aq_mediastatus_update(struct aq_dev *aq_dev, uint32_t link_speed,
const struct aq_hw_fc_info *fc_neg)
{
struct aq_hw *hw = &aq_dev->hw;
u_int i;
aq_dev->media_active = 0;
if (fc_neg->fc_rx)
aq_dev->media_active |= IFM_ETH_RXPAUSE;
if (fc_neg->fc_tx)
aq_dev->media_active |= IFM_ETH_TXPAUSE;
for (i = 0; i < nitems(aq_media_types); i++)
if (link_speed == aq_media_types[i].mbps)
break;
aq_dev->media_active |= i < nitems(aq_media_types) ?
(aq_media_types[i].ifm | IFM_FDX) : IFM_NONE;
if (hw->link_rate == aq_fw_speed_auto)
aq_dev->media_active |= IFM_AUTO;
}
void
aq_mediastatus(if_t ifp, struct ifmediareq *ifmr)
{
struct aq_dev *aq_dev = iflib_get_softc(if_getsoftc(ifp));
ifmr->ifm_active = IFM_ETHER;
ifmr->ifm_status = IFM_AVALID;
if (aq_dev->linkup)
ifmr->ifm_status |= IFM_ACTIVE;
ifmr->ifm_active |= aq_dev->media_active;
}
int
aq_mediachange(if_t ifp)
{
struct aq_dev *aq_dev = iflib_get_softc(if_getsoftc(ifp));
struct aq_hw *hw = &aq_dev->hw;
int old_media_rate = if_getbaudrate(ifp);
int old_link_speed = hw->link_rate;
struct ifmedia *ifm = iflib_get_media(aq_dev->ctx);
int user_media = IFM_SUBTYPE(ifm->ifm_media);
uint64_t media_rate;
u_int i;
AQ_DBG_ENTERA("media 0x%x", user_media);
if (!(ifm->ifm_media & IFM_ETHER)) {
device_printf(aq_dev->dev,
"%s(): aq_dev interface - bad media: 0x%X\n", __FUNCTION__,
ifm->ifm_media);
return (0);
}
switch (user_media) {
case IFM_AUTO:
hw->link_rate = aq_fw_speed_auto;
media_rate = -1;
break;
case IFM_NONE:
media_rate = 0;
hw->link_rate = 0;
iflib_link_state_change(aq_dev->ctx, LINK_STATE_DOWN, 0);
break;
default:
for (i = 0; i < nitems(aq_media_types); i++)
if (user_media == aq_media_types[i].ifm)
break;
if (i == nitems(aq_media_types)) {
device_printf(hw->dev, "unknown media: 0x%X\n",
user_media);
return (0);
}
hw->link_rate = aq_media_types[i].fw_rate;
media_rate = (uint64_t)aq_media_types[i].mbps * 1000;
break;
}
hw->fc.fc_rx = (ifm->ifm_media & IFM_ETH_RXPAUSE) ? 1 : 0;
hw->fc.fc_tx = (ifm->ifm_media & IFM_ETH_TXPAUSE) ? 1 : 0;
if (!(if_getflags(ifp) & IFF_UP))
return (0);
if ((media_rate != old_media_rate) ||
(hw->link_rate != old_link_speed)) {
aq_hw_set_link_speed(hw, hw->link_rate);
}
AQ_DBG_EXIT(0);
return (0);
}
static void
aq_add_media_types(struct aq_dev *aq_dev, int media_link_speed)
{
ifmedia_add(aq_dev->media, IFM_ETHER | media_link_speed | IFM_FDX, 0,
NULL);
ifmedia_add(aq_dev->media, IFM_ETHER | media_link_speed | IFM_FDX |
IFM_ETH_RXPAUSE | IFM_ETH_TXPAUSE, 0, NULL);
ifmedia_add(aq_dev->media, IFM_ETHER | media_link_speed | IFM_FDX |
IFM_ETH_RXPAUSE, 0, NULL);
ifmedia_add(aq_dev->media, IFM_ETHER | media_link_speed | IFM_FDX |
IFM_ETH_TXPAUSE, 0, NULL);
}
void
aq_initmedia(struct aq_dev *aq_dev)
{
u_int i;
AQ_DBG_ENTER();
ifmedia_add(aq_dev->media, IFM_ETHER | IFM_NONE, 0, NULL);
ifmedia_add(aq_dev->media, IFM_ETHER | IFM_AUTO, 0, NULL);
aq_add_media_types(aq_dev, IFM_AUTO);
for (i = 0; i < nitems(aq_media_types); i++)
if (aq_dev->link_speeds & aq_media_types[i].link_bit)
aq_add_media_types(aq_dev, aq_media_types[i].ifm);
ifmedia_set(aq_dev->media,
IFM_ETHER | IFM_AUTO | IFM_FDX | IFM_ETH_RXPAUSE | IFM_ETH_TXPAUSE);
AQ_DBG_EXIT(0);
}