Commit f270dbfa authored by Vladimir Oltean's avatar Vladimir Oltean Committed by David S. Miller

net: mscc: ocelot: refactor struct ocelot_port out of function prototypes

The ocelot_port structure has a net_device embedded in it, which makes
it unsuitable for leaving it in the driver implementation functions.

Leave ocelot_flower.c untouched. In that file, ocelot_port is used as an
interface to the tc shared blocks. That will be addressed in the next
patch.
Signed-off-by: default avatarVladimir Oltean <vladimir.oltean@nxp.com>
Signed-off-by: default avatarDavid S. Miller <davem@davemloft.net>
parent 4bda1415
...@@ -133,11 +133,11 @@ static void ocelot_mact_init(struct ocelot *ocelot) ...@@ -133,11 +133,11 @@ static void ocelot_mact_init(struct ocelot *ocelot)
ocelot_write(ocelot, MACACCESS_CMD_INIT, ANA_TABLES_MACACCESS); ocelot_write(ocelot, MACACCESS_CMD_INIT, ANA_TABLES_MACACCESS);
} }
static void ocelot_vcap_enable(struct ocelot *ocelot, struct ocelot_port *port) static void ocelot_vcap_enable(struct ocelot *ocelot, int port)
{ {
ocelot_write_gix(ocelot, ANA_PORT_VCAP_S2_CFG_S2_ENA | ocelot_write_gix(ocelot, ANA_PORT_VCAP_S2_CFG_S2_ENA |
ANA_PORT_VCAP_S2_CFG_S2_IP6_CFG(0xa), ANA_PORT_VCAP_S2_CFG_S2_IP6_CFG(0xa),
ANA_PORT_VCAP_S2_CFG, port->chip_port); ANA_PORT_VCAP_S2_CFG, port);
} }
static inline u32 ocelot_vlant_read_vlanaccess(struct ocelot *ocelot) static inline u32 ocelot_vlant_read_vlanaccess(struct ocelot *ocelot)
...@@ -170,19 +170,17 @@ static int ocelot_vlant_set_mask(struct ocelot *ocelot, u16 vid, u32 mask) ...@@ -170,19 +170,17 @@ static int ocelot_vlant_set_mask(struct ocelot *ocelot, u16 vid, u32 mask)
return ocelot_vlant_wait_for_completion(ocelot); return ocelot_vlant_wait_for_completion(ocelot);
} }
static void ocelot_vlan_mode(struct ocelot_port *port, static void ocelot_vlan_mode(struct ocelot *ocelot, int port,
netdev_features_t features) netdev_features_t features)
{ {
struct ocelot *ocelot = port->ocelot;
u8 p = port->chip_port;
u32 val; u32 val;
/* Filtering */ /* Filtering */
val = ocelot_read(ocelot, ANA_VLANMASK); val = ocelot_read(ocelot, ANA_VLANMASK);
if (features & NETIF_F_HW_VLAN_CTAG_FILTER) if (features & NETIF_F_HW_VLAN_CTAG_FILTER)
val |= BIT(p); val |= BIT(port);
else else
val &= ~BIT(p); val &= ~BIT(port);
ocelot_write(ocelot, val, ANA_VLANMASK); ocelot_write(ocelot, val, ANA_VLANMASK);
} }
...@@ -1034,18 +1032,20 @@ static int ocelot_vlan_rx_kill_vid(struct net_device *dev, __be16 proto, ...@@ -1034,18 +1032,20 @@ static int ocelot_vlan_rx_kill_vid(struct net_device *dev, __be16 proto,
static int ocelot_set_features(struct net_device *dev, static int ocelot_set_features(struct net_device *dev,
netdev_features_t features) netdev_features_t features)
{ {
struct ocelot_port *port = netdev_priv(dev);
netdev_features_t changed = dev->features ^ features; netdev_features_t changed = dev->features ^ features;
struct ocelot_port *ocelot_port = netdev_priv(dev);
struct ocelot *ocelot = ocelot_port->ocelot;
int port = ocelot_port->chip_port;
if ((dev->features & NETIF_F_HW_TC) > (features & NETIF_F_HW_TC) && if ((dev->features & NETIF_F_HW_TC) > (features & NETIF_F_HW_TC) &&
port->tc.offload_cnt) { ocelot_port->tc.offload_cnt) {
netdev_err(dev, netdev_err(dev,
"Cannot disable HW TC offload while offloads active\n"); "Cannot disable HW TC offload while offloads active\n");
return -EBUSY; return -EBUSY;
} }
if (changed & NETIF_F_HW_VLAN_CTAG_FILTER) if (changed & NETIF_F_HW_VLAN_CTAG_FILTER)
ocelot_vlan_mode(port, features); ocelot_vlan_mode(ocelot, port, features);
return 0; return 0;
} }
...@@ -1586,11 +1586,9 @@ static int ocelot_port_obj_del(struct net_device *dev, ...@@ -1586,11 +1586,9 @@ static int ocelot_port_obj_del(struct net_device *dev,
return ret; return ret;
} }
static int ocelot_port_bridge_join(struct ocelot_port *ocelot_port, static int ocelot_port_bridge_join(struct ocelot *ocelot, int port,
struct net_device *bridge) struct net_device *bridge)
{ {
struct ocelot *ocelot = ocelot_port->ocelot;
if (!ocelot->bridge_mask) { if (!ocelot->bridge_mask) {
ocelot->hw_bridge_dev = bridge; ocelot->hw_bridge_dev = bridge;
} else { } else {
...@@ -1600,17 +1598,14 @@ static int ocelot_port_bridge_join(struct ocelot_port *ocelot_port, ...@@ -1600,17 +1598,14 @@ static int ocelot_port_bridge_join(struct ocelot_port *ocelot_port,
return -ENODEV; return -ENODEV;
} }
ocelot->bridge_mask |= BIT(ocelot_port->chip_port); ocelot->bridge_mask |= BIT(port);
return 0; return 0;
} }
static int ocelot_port_bridge_leave(struct ocelot_port *ocelot_port, static int ocelot_port_bridge_leave(struct ocelot *ocelot, int port,
struct net_device *bridge) struct net_device *bridge)
{ {
struct ocelot *ocelot = ocelot_port->ocelot;
int port = ocelot_port->chip_port;
ocelot->bridge_mask &= ~BIT(port); ocelot->bridge_mask &= ~BIT(port);
if (!ocelot->bridge_mask) if (!ocelot->bridge_mask)
...@@ -1679,14 +1674,12 @@ static void ocelot_setup_lag(struct ocelot *ocelot, int lag) ...@@ -1679,14 +1674,12 @@ static void ocelot_setup_lag(struct ocelot *ocelot, int lag)
} }
} }
static int ocelot_port_lag_join(struct ocelot_port *ocelot_port, static int ocelot_port_lag_join(struct ocelot *ocelot, int port,
struct net_device *bond) struct net_device *bond)
{ {
struct ocelot *ocelot = ocelot_port->ocelot;
int p = ocelot_port->chip_port;
int lag, lp;
struct net_device *ndev; struct net_device *ndev;
u32 bond_mask = 0; u32 bond_mask = 0;
int lag, lp;
rcu_read_lock(); rcu_read_lock();
for_each_netdev_in_bond_rcu(bond, ndev) { for_each_netdev_in_bond_rcu(bond, ndev) {
...@@ -1701,17 +1694,17 @@ static int ocelot_port_lag_join(struct ocelot_port *ocelot_port, ...@@ -1701,17 +1694,17 @@ static int ocelot_port_lag_join(struct ocelot_port *ocelot_port,
/* If the new port is the lowest one, use it as the logical port from /* If the new port is the lowest one, use it as the logical port from
* now on * now on
*/ */
if (p == lp) { if (port == lp) {
lag = p; lag = port;
ocelot->lags[p] = bond_mask; ocelot->lags[port] = bond_mask;
bond_mask &= ~BIT(p); bond_mask &= ~BIT(port);
if (bond_mask) { if (bond_mask) {
lp = __ffs(bond_mask); lp = __ffs(bond_mask);
ocelot->lags[lp] = 0; ocelot->lags[lp] = 0;
} }
} else { } else {
lag = lp; lag = lp;
ocelot->lags[lp] |= BIT(p); ocelot->lags[lp] |= BIT(port);
} }
ocelot_setup_lag(ocelot, lag); ocelot_setup_lag(ocelot, lag);
...@@ -1720,34 +1713,32 @@ static int ocelot_port_lag_join(struct ocelot_port *ocelot_port, ...@@ -1720,34 +1713,32 @@ static int ocelot_port_lag_join(struct ocelot_port *ocelot_port,
return 0; return 0;
} }
static void ocelot_port_lag_leave(struct ocelot_port *ocelot_port, static void ocelot_port_lag_leave(struct ocelot *ocelot, int port,
struct net_device *bond) struct net_device *bond)
{ {
struct ocelot *ocelot = ocelot_port->ocelot;
int p = ocelot_port->chip_port;
u32 port_cfg; u32 port_cfg;
int i; int i;
/* Remove port from any lag */ /* Remove port from any lag */
for (i = 0; i < ocelot->num_phys_ports; i++) for (i = 0; i < ocelot->num_phys_ports; i++)
ocelot->lags[i] &= ~BIT(ocelot_port->chip_port); ocelot->lags[i] &= ~BIT(port);
/* if it was the logical port of the lag, move the lag config to the /* if it was the logical port of the lag, move the lag config to the
* next port * next port
*/ */
if (ocelot->lags[p]) { if (ocelot->lags[port]) {
int n = __ffs(ocelot->lags[p]); int n = __ffs(ocelot->lags[port]);
ocelot->lags[n] = ocelot->lags[p]; ocelot->lags[n] = ocelot->lags[port];
ocelot->lags[p] = 0; ocelot->lags[port] = 0;
ocelot_setup_lag(ocelot, n); ocelot_setup_lag(ocelot, n);
} }
port_cfg = ocelot_read_gix(ocelot, ANA_PORT_PORT_CFG, p); port_cfg = ocelot_read_gix(ocelot, ANA_PORT_PORT_CFG, port);
port_cfg &= ~ANA_PORT_PORT_CFG_PORTID_VAL_M; port_cfg &= ~ANA_PORT_PORT_CFG_PORTID_VAL_M;
ocelot_write_gix(ocelot, port_cfg | ANA_PORT_PORT_CFG_PORTID_VAL(p), ocelot_write_gix(ocelot, port_cfg | ANA_PORT_PORT_CFG_PORTID_VAL(port),
ANA_PORT_PORT_CFG, p); ANA_PORT_PORT_CFG, port);
ocelot_set_aggr_pgids(ocelot); ocelot_set_aggr_pgids(ocelot);
} }
...@@ -1763,24 +1754,26 @@ static int ocelot_netdevice_port_event(struct net_device *dev, ...@@ -1763,24 +1754,26 @@ static int ocelot_netdevice_port_event(struct net_device *dev,
struct netdev_notifier_changeupper_info *info) struct netdev_notifier_changeupper_info *info)
{ {
struct ocelot_port *ocelot_port = netdev_priv(dev); struct ocelot_port *ocelot_port = netdev_priv(dev);
struct ocelot *ocelot = ocelot_port->ocelot;
int port = ocelot_port->chip_port;
int err = 0; int err = 0;
switch (event) { switch (event) {
case NETDEV_CHANGEUPPER: case NETDEV_CHANGEUPPER:
if (netif_is_bridge_master(info->upper_dev)) { if (netif_is_bridge_master(info->upper_dev)) {
if (info->linking) if (info->linking)
err = ocelot_port_bridge_join(ocelot_port, err = ocelot_port_bridge_join(ocelot, port,
info->upper_dev); info->upper_dev);
else else
err = ocelot_port_bridge_leave(ocelot_port, err = ocelot_port_bridge_leave(ocelot, port,
info->upper_dev); info->upper_dev);
} }
if (netif_is_lag_master(info->upper_dev)) { if (netif_is_lag_master(info->upper_dev)) {
if (info->linking) if (info->linking)
err = ocelot_port_lag_join(ocelot_port, err = ocelot_port_lag_join(ocelot, port,
info->upper_dev); info->upper_dev);
else else
ocelot_port_lag_leave(ocelot_port, ocelot_port_lag_leave(ocelot, port,
info->upper_dev); info->upper_dev);
} }
break; break;
...@@ -2136,7 +2129,7 @@ int ocelot_probe_port(struct ocelot *ocelot, u8 port, ...@@ -2136,7 +2129,7 @@ int ocelot_probe_port(struct ocelot *ocelot, u8 port,
REW_PORT_VLAN_CFG, port); REW_PORT_VLAN_CFG, port);
/* Enable vcap lookups */ /* Enable vcap lookups */
ocelot_vcap_enable(ocelot, ocelot_port); ocelot_vcap_enable(ocelot, port);
return 0; return 0;
......
...@@ -40,13 +40,12 @@ struct qos_policer_conf { ...@@ -40,13 +40,12 @@ struct qos_policer_conf {
u8 ipg; /* Size of IPG when MSCC_QOS_RATE_MODE_LINE is chosen */ u8 ipg; /* Size of IPG when MSCC_QOS_RATE_MODE_LINE is chosen */
}; };
static int qos_policer_conf_set(struct ocelot_port *port, u32 pol_ix, static int qos_policer_conf_set(struct ocelot *ocelot, int port, u32 pol_ix,
struct qos_policer_conf *conf) struct qos_policer_conf *conf)
{ {
u32 cf = 0, cir_ena = 0, frm_mode = POL_MODE_LINERATE; u32 cf = 0, cir_ena = 0, frm_mode = POL_MODE_LINERATE;
u32 cir = 0, cbs = 0, pir = 0, pbs = 0; u32 cir = 0, cbs = 0, pir = 0, pbs = 0;
bool cir_discard = 0, pir_discard = 0; bool cir_discard = 0, pir_discard = 0;
struct ocelot *ocelot = port->ocelot;
u32 pbs_max = 0, cbs_max = 0; u32 pbs_max = 0, cbs_max = 0;
u8 ipg = 20; u8 ipg = 20;
u32 value; u32 value;
...@@ -123,22 +122,26 @@ static int qos_policer_conf_set(struct ocelot_port *port, u32 pol_ix, ...@@ -123,22 +122,26 @@ static int qos_policer_conf_set(struct ocelot_port *port, u32 pol_ix,
/* Check limits */ /* Check limits */
if (pir > GENMASK(15, 0)) { if (pir > GENMASK(15, 0)) {
netdev_err(port->dev, "Invalid pir\n"); dev_err(ocelot->dev, "Invalid pir for port %d: %u (max %lu)\n",
port, pir, GENMASK(15, 0));
return -EINVAL; return -EINVAL;
} }
if (cir > GENMASK(15, 0)) { if (cir > GENMASK(15, 0)) {
netdev_err(port->dev, "Invalid cir\n"); dev_err(ocelot->dev, "Invalid cir for port %d: %u (max %lu)\n",
port, cir, GENMASK(15, 0));
return -EINVAL; return -EINVAL;
} }
if (pbs > pbs_max) { if (pbs > pbs_max) {
netdev_err(port->dev, "Invalid pbs\n"); dev_err(ocelot->dev, "Invalid pbs for port %d: %u (max %u)\n",
port, pbs, pbs_max);
return -EINVAL; return -EINVAL;
} }
if (cbs > cbs_max) { if (cbs > cbs_max) {
netdev_err(port->dev, "Invalid cbs\n"); dev_err(ocelot->dev, "Invalid cbs for port %d: %u (max %u)\n",
port, cbs, cbs_max);
return -EINVAL; return -EINVAL;
} }
...@@ -171,10 +174,9 @@ static int qos_policer_conf_set(struct ocelot_port *port, u32 pol_ix, ...@@ -171,10 +174,9 @@ static int qos_policer_conf_set(struct ocelot_port *port, u32 pol_ix,
return 0; return 0;
} }
int ocelot_port_policer_add(struct ocelot_port *port, int ocelot_port_policer_add(struct ocelot *ocelot, int port,
struct ocelot_policer *pol) struct ocelot_policer *pol)
{ {
struct ocelot *ocelot = port->ocelot;
struct qos_policer_conf pp = { 0 }; struct qos_policer_conf pp = { 0 };
int err; int err;
...@@ -185,11 +187,10 @@ int ocelot_port_policer_add(struct ocelot_port *port, ...@@ -185,11 +187,10 @@ int ocelot_port_policer_add(struct ocelot_port *port,
pp.pir = pol->rate; pp.pir = pol->rate;
pp.pbs = pol->burst; pp.pbs = pol->burst;
netdev_dbg(port->dev, dev_dbg(ocelot->dev, "%s: port %u pir %u kbps, pbs %u bytes\n",
"%s: port %u pir %u kbps, pbs %u bytes\n", __func__, port, pp.pir, pp.pbs);
__func__, port->chip_port, pp.pir, pp.pbs);
err = qos_policer_conf_set(port, POL_IX_PORT + port->chip_port, &pp); err = qos_policer_conf_set(ocelot, port, POL_IX_PORT + port, &pp);
if (err) if (err)
return err; return err;
...@@ -198,22 +199,21 @@ int ocelot_port_policer_add(struct ocelot_port *port, ...@@ -198,22 +199,21 @@ int ocelot_port_policer_add(struct ocelot_port *port,
ANA_PORT_POL_CFG_POL_ORDER(POL_ORDER), ANA_PORT_POL_CFG_POL_ORDER(POL_ORDER),
ANA_PORT_POL_CFG_PORT_POL_ENA | ANA_PORT_POL_CFG_PORT_POL_ENA |
ANA_PORT_POL_CFG_POL_ORDER_M, ANA_PORT_POL_CFG_POL_ORDER_M,
ANA_PORT_POL_CFG, port->chip_port); ANA_PORT_POL_CFG, port);
return 0; return 0;
} }
int ocelot_port_policer_del(struct ocelot_port *port) int ocelot_port_policer_del(struct ocelot *ocelot, int port)
{ {
struct ocelot *ocelot = port->ocelot;
struct qos_policer_conf pp = { 0 }; struct qos_policer_conf pp = { 0 };
int err; int err;
netdev_dbg(port->dev, "%s: port %u\n", __func__, port->chip_port); dev_dbg(ocelot->dev, "%s: port %u\n", __func__, port);
pp.mode = MSCC_QOS_RATE_MODE_DISABLED; pp.mode = MSCC_QOS_RATE_MODE_DISABLED;
err = qos_policer_conf_set(port, POL_IX_PORT + port->chip_port, &pp); err = qos_policer_conf_set(ocelot, port, POL_IX_PORT + port, &pp);
if (err) if (err)
return err; return err;
...@@ -221,7 +221,7 @@ int ocelot_port_policer_del(struct ocelot_port *port) ...@@ -221,7 +221,7 @@ int ocelot_port_policer_del(struct ocelot_port *port)
ANA_PORT_POL_CFG_POL_ORDER(POL_ORDER), ANA_PORT_POL_CFG_POL_ORDER(POL_ORDER),
ANA_PORT_POL_CFG_PORT_POL_ENA | ANA_PORT_POL_CFG_PORT_POL_ENA |
ANA_PORT_POL_CFG_POL_ORDER_M, ANA_PORT_POL_CFG_POL_ORDER_M,
ANA_PORT_POL_CFG, port->chip_port); ANA_PORT_POL_CFG, port);
return 0; return 0;
} }
...@@ -14,9 +14,9 @@ struct ocelot_policer { ...@@ -14,9 +14,9 @@ struct ocelot_policer {
u32 burst; /* bytes */ u32 burst; /* bytes */
}; };
int ocelot_port_policer_add(struct ocelot_port *port, int ocelot_port_policer_add(struct ocelot *ocelot, int port,
struct ocelot_policer *pol); struct ocelot_policer *pol);
int ocelot_port_policer_del(struct ocelot_port *port); int ocelot_port_policer_del(struct ocelot *ocelot, int port);
#endif /* _MSCC_OCELOT_POLICE_H_ */ #endif /* _MSCC_OCELOT_POLICE_H_ */
...@@ -58,7 +58,8 @@ static int ocelot_setup_tc_cls_matchall(struct ocelot_port *port, ...@@ -58,7 +58,8 @@ static int ocelot_setup_tc_cls_matchall(struct ocelot_port *port,
PSCHED_NS2TICKS(action->police.burst), PSCHED_NS2TICKS(action->police.burst),
PSCHED_TICKS_PER_SEC); PSCHED_TICKS_PER_SEC);
err = ocelot_port_policer_add(port, &pol); err = ocelot_port_policer_add(port->ocelot, port->chip_port,
&pol);
if (err) { if (err) {
NL_SET_ERR_MSG_MOD(extack, "Could not add policer\n"); NL_SET_ERR_MSG_MOD(extack, "Could not add policer\n");
return err; return err;
...@@ -71,7 +72,7 @@ static int ocelot_setup_tc_cls_matchall(struct ocelot_port *port, ...@@ -71,7 +72,7 @@ static int ocelot_setup_tc_cls_matchall(struct ocelot_port *port,
if (port->tc.police_id != f->cookie) if (port->tc.police_id != f->cookie)
return -ENOENT; return -ENOENT;
err = ocelot_port_policer_del(port); err = ocelot_port_policer_del(port->ocelot, port->chip_port);
if (err) { if (err) {
NL_SET_ERR_MSG_MOD(extack, NL_SET_ERR_MSG_MOD(extack,
"Could not delete policer\n"); "Could not delete policer\n");
......
Markdown is supported
0%
or
You are about to add 0 people to the discussion. Proceed with caution.
Finish editing this message first!
Please register or to comment