Commit 44988627 authored by Sean Anderson's avatar Sean Anderson Committed by David S. Miller

net: fman: Inline several functions into initialization

There are several small functions which were only necessary because the
initialization functions didn't have access to the mac private data. Now
that they do, just do things directly.
Signed-off-by: default avatarSean Anderson <sean.anderson@seco.com>
Acked-by: default avatarCamelia Groza <camelia.groza@nxp.com>
Signed-off-by: default avatarDavid S. Miller <davem@davemloft.net>
parent 1257c962
...@@ -814,26 +814,6 @@ static void free_init_resources(struct fman_mac *dtsec) ...@@ -814,26 +814,6 @@ static void free_init_resources(struct fman_mac *dtsec)
dtsec->unicast_addr_hash = NULL; dtsec->unicast_addr_hash = NULL;
} }
static int dtsec_cfg_max_frame_len(struct fman_mac *dtsec, u16 new_val)
{
if (is_init_done(dtsec->dtsec_drv_param))
return -EINVAL;
dtsec->dtsec_drv_param->maximum_frame = new_val;
return 0;
}
static int dtsec_cfg_pad_and_crc(struct fman_mac *dtsec, bool new_val)
{
if (is_init_done(dtsec->dtsec_drv_param))
return -EINVAL;
dtsec->dtsec_drv_param->tx_pad_crc = new_val;
return 0;
}
static void graceful_start(struct fman_mac *dtsec) static void graceful_start(struct fman_mac *dtsec)
{ {
struct dtsec_regs __iomem *regs = dtsec->regs; struct dtsec_regs __iomem *regs = dtsec->regs;
...@@ -1274,18 +1254,6 @@ static void adjust_link_dtsec(struct mac_device *mac_dev) ...@@ -1274,18 +1254,6 @@ static void adjust_link_dtsec(struct mac_device *mac_dev)
err); err);
} }
static int dtsec_get_version(struct fman_mac *dtsec, u32 *mac_version)
{
struct dtsec_regs __iomem *regs = dtsec->regs;
if (!is_init_done(dtsec->dtsec_drv_param))
return -EINVAL;
*mac_version = ioread32be(&regs->tsec_id);
return 0;
}
static int dtsec_set_exception(struct fman_mac *dtsec, static int dtsec_set_exception(struct fman_mac *dtsec,
enum fman_mac_exceptions exception, bool enable) enum fman_mac_exceptions exception, bool enable)
{ {
...@@ -1525,7 +1493,7 @@ int dtsec_initialization(struct mac_device *mac_dev, ...@@ -1525,7 +1493,7 @@ int dtsec_initialization(struct mac_device *mac_dev,
{ {
int err; int err;
struct fman_mac_params params; struct fman_mac_params params;
u32 version; struct fman_mac *dtsec;
mac_dev->set_promisc = dtsec_set_promiscuous; mac_dev->set_promisc = dtsec_set_promiscuous;
mac_dev->change_addr = dtsec_modify_mac_address; mac_dev->change_addr = dtsec_modify_mac_address;
...@@ -1552,34 +1520,25 @@ int dtsec_initialization(struct mac_device *mac_dev, ...@@ -1552,34 +1520,25 @@ int dtsec_initialization(struct mac_device *mac_dev,
goto _return; goto _return;
} }
err = dtsec_cfg_max_frame_len(mac_dev->fman_mac, fman_get_max_frm()); dtsec = mac_dev->fman_mac;
if (err < 0) dtsec->dtsec_drv_param->maximum_frame = fman_get_max_frm();
goto _return_fm_mac_free; dtsec->dtsec_drv_param->tx_pad_crc = true;
err = dtsec_init(dtsec);
err = dtsec_cfg_pad_and_crc(mac_dev->fman_mac, true);
if (err < 0)
goto _return_fm_mac_free;
err = dtsec_init(mac_dev->fman_mac);
if (err < 0) if (err < 0)
goto _return_fm_mac_free; goto _return_fm_mac_free;
/* For 1G MAC, disable by default the MIB counters overflow interrupt */ /* For 1G MAC, disable by default the MIB counters overflow interrupt */
err = mac_dev->set_exception(mac_dev->fman_mac, err = dtsec_set_exception(dtsec, FM_MAC_EX_1G_RX_MIB_CNT_OVFL, false);
FM_MAC_EX_1G_RX_MIB_CNT_OVFL, false);
if (err < 0)
goto _return_fm_mac_free;
err = dtsec_get_version(mac_dev->fman_mac, &version);
if (err < 0) if (err < 0)
goto _return_fm_mac_free; goto _return_fm_mac_free;
dev_info(mac_dev->dev, "FMan dTSEC version: 0x%08x\n", version); dev_info(mac_dev->dev, "FMan dTSEC version: 0x%08x\n",
ioread32be(&dtsec->regs->tsec_id));
goto _return; goto _return;
_return_fm_mac_free: _return_fm_mac_free:
dtsec_free(mac_dev->fman_mac); dtsec_free(dtsec);
_return: _return:
return err; return err;
......
...@@ -792,37 +792,6 @@ static void adjust_link_memac(struct mac_device *mac_dev) ...@@ -792,37 +792,6 @@ static void adjust_link_memac(struct mac_device *mac_dev)
err); err);
} }
static int memac_cfg_max_frame_len(struct fman_mac *memac, u16 new_val)
{
if (is_init_done(memac->memac_drv_param))
return -EINVAL;
memac->memac_drv_param->max_frame_length = new_val;
return 0;
}
static int memac_cfg_reset_on_init(struct fman_mac *memac, bool enable)
{
if (is_init_done(memac->memac_drv_param))
return -EINVAL;
memac->memac_drv_param->reset_on_init = enable;
return 0;
}
static int memac_cfg_fixed_link(struct fman_mac *memac,
struct fixed_phy_status *fixed_link)
{
if (is_init_done(memac->memac_drv_param))
return -EINVAL;
memac->memac_drv_param->fixed_link = fixed_link;
return 0;
}
static int memac_set_tx_pause_frames(struct fman_mac *memac, u8 priority, static int memac_set_tx_pause_frames(struct fman_mac *memac, u8 priority,
u16 pause_time, u16 thresh_time) u16 pause_time, u16 thresh_time)
{ {
...@@ -1206,6 +1175,7 @@ int memac_initialization(struct mac_device *mac_dev, ...@@ -1206,6 +1175,7 @@ int memac_initialization(struct mac_device *mac_dev,
int err; int err;
struct fman_mac_params params; struct fman_mac_params params;
struct fixed_phy_status *fixed_link; struct fixed_phy_status *fixed_link;
struct fman_mac *memac;
mac_dev->set_promisc = memac_set_promiscuous; mac_dev->set_promisc = memac_set_promiscuous;
mac_dev->change_addr = memac_modify_mac_address; mac_dev->change_addr = memac_modify_mac_address;
...@@ -1235,13 +1205,9 @@ int memac_initialization(struct mac_device *mac_dev, ...@@ -1235,13 +1205,9 @@ int memac_initialization(struct mac_device *mac_dev,
goto _return; goto _return;
} }
err = memac_cfg_max_frame_len(mac_dev->fman_mac, fman_get_max_frm()); memac = mac_dev->fman_mac;
if (err < 0) memac->memac_drv_param->max_frame_length = fman_get_max_frm();
goto _return_fm_mac_free; memac->memac_drv_param->reset_on_init = true;
err = memac_cfg_reset_on_init(mac_dev->fman_mac, true);
if (err < 0)
goto _return_fm_mac_free;
if (!mac_dev->phy_node && of_phy_is_fixed_link(mac_node)) { if (!mac_dev->phy_node && of_phy_is_fixed_link(mac_node)) {
struct phy_device *phy; struct phy_device *phy;
...@@ -1271,10 +1237,7 @@ int memac_initialization(struct mac_device *mac_dev, ...@@ -1271,10 +1237,7 @@ int memac_initialization(struct mac_device *mac_dev,
fixed_link->asym_pause = phy->asym_pause; fixed_link->asym_pause = phy->asym_pause;
put_device(&phy->mdio.dev); put_device(&phy->mdio.dev);
memac->memac_drv_param->fixed_link = fixed_link;
err = memac_cfg_fixed_link(mac_dev->fman_mac, fixed_link);
if (err < 0)
goto _return_fixed_link_free;
} }
err = memac_init(mac_dev->fman_mac); err = memac_init(mac_dev->fman_mac);
......
...@@ -441,16 +441,6 @@ static int tgec_set_promiscuous(struct fman_mac *tgec, bool new_val) ...@@ -441,16 +441,6 @@ static int tgec_set_promiscuous(struct fman_mac *tgec, bool new_val)
return 0; return 0;
} }
static int tgec_cfg_max_frame_len(struct fman_mac *tgec, u16 new_val)
{
if (is_init_done(tgec->cfg))
return -EINVAL;
tgec->cfg->max_frame_length = new_val;
return 0;
}
static int tgec_set_tx_pause_frames(struct fman_mac *tgec, static int tgec_set_tx_pause_frames(struct fman_mac *tgec,
u8 __maybe_unused priority, u16 pause_time, u8 __maybe_unused priority, u16 pause_time,
u16 __maybe_unused thresh_time) u16 __maybe_unused thresh_time)
...@@ -618,18 +608,6 @@ static void adjust_link_void(struct mac_device *mac_dev) ...@@ -618,18 +608,6 @@ static void adjust_link_void(struct mac_device *mac_dev)
{ {
} }
static int tgec_get_version(struct fman_mac *tgec, u32 *mac_version)
{
struct tgec_regs __iomem *regs = tgec->regs;
if (!is_init_done(tgec->cfg))
return -EINVAL;
*mac_version = ioread32be(&regs->tgec_id);
return 0;
}
static int tgec_set_exception(struct fman_mac *tgec, static int tgec_set_exception(struct fman_mac *tgec,
enum fman_mac_exceptions exception, bool enable) enum fman_mac_exceptions exception, bool enable)
{ {
...@@ -809,7 +787,7 @@ int tgec_initialization(struct mac_device *mac_dev, ...@@ -809,7 +787,7 @@ int tgec_initialization(struct mac_device *mac_dev,
{ {
int err; int err;
struct fman_mac_params params; struct fman_mac_params params;
u32 version; struct fman_mac *tgec;
mac_dev->set_promisc = tgec_set_promiscuous; mac_dev->set_promisc = tgec_set_promiscuous;
mac_dev->change_addr = tgec_modify_mac_address; mac_dev->change_addr = tgec_modify_mac_address;
...@@ -835,26 +813,19 @@ int tgec_initialization(struct mac_device *mac_dev, ...@@ -835,26 +813,19 @@ int tgec_initialization(struct mac_device *mac_dev,
goto _return; goto _return;
} }
err = tgec_cfg_max_frame_len(mac_dev->fman_mac, fman_get_max_frm()); tgec = mac_dev->fman_mac;
if (err < 0) tgec->cfg->max_frame_length = fman_get_max_frm();
goto _return_fm_mac_free; err = tgec_init(tgec);
err = tgec_init(mac_dev->fman_mac);
if (err < 0) if (err < 0)
goto _return_fm_mac_free; goto _return_fm_mac_free;
/* For 10G MAC, disable Tx ECC exception */ /* For 10G MAC, disable Tx ECC exception */
err = mac_dev->set_exception(mac_dev->fman_mac, err = tgec_set_exception(tgec, FM_MAC_EX_10G_TX_ECC_ER, false);
FM_MAC_EX_10G_TX_ECC_ER, false);
if (err < 0)
goto _return_fm_mac_free;
err = tgec_get_version(mac_dev->fman_mac, &version);
if (err < 0) if (err < 0)
goto _return_fm_mac_free; goto _return_fm_mac_free;
pr_info("FMan XGEC version: 0x%08x\n", version); pr_info("FMan XGEC version: 0x%08x\n",
ioread32be(&tgec->regs->tgec_id));
goto _return; goto _return;
_return_fm_mac_free: _return_fm_mac_free:
......
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