@@ -558,6 +558,9 @@ struct fec_enet_private {
unsigned int num_tx_queues;
unsigned int num_rx_queues;
+ struct icc_path *bus_path;
+ unsigned int bus_rate;
+
/* The saved address of a sent-in-place packet/buffer, for skfree(). */
struct fec_enet_priv_tx_q *tx_queue[FEC_ENET_MAX_TX_QS];
struct fec_enet_priv_rx_q *rx_queue[FEC_ENET_MAX_RX_QS];
@@ -48,6 +48,7 @@
#include <linux/bitops.h>
#include <linux/io.h>
#include <linux/irq.h>
+#include <linux/interconnect.h>
#include <linux/clk.h>
#include <linux/crc32.h>
#include <linux/platform_device.h>
@@ -3805,6 +3806,18 @@ fec_probe(struct platform_device *pdev)
fep->pdev = pdev;
fep->dev_id = dev_id++;
+ fep->bus_path = devm_of_icc_get(&pdev->dev, "path");
+ if (IS_ERR(fep->bus_path)) {
+ return PTR_ERR(fep->bus_path);
+ } else if (fep->bus_path) {
+ if (of_property_read_u32(np, "fsl,icc-rate", &fep->bus_rate)) {
+ dev_err(&pdev->dev, "icc-rate missing\n");
+ return -EINVAL;
+ }
+
+ icc_set_bw(fep->bus_path, 0, fep->bus_rate);
+ }
+
platform_set_drvdata(pdev, ndev);
if ((of_machine_is_compatible("fsl,imx6q") ||
@@ -4075,6 +4088,8 @@ static int __maybe_unused fec_suspend(struct device *dev)
if (fep->clk_enet_out || fep->reg_phy)
fep->link = 0;
+ icc_disable(fep->bus_path);
+
return 0;
}
@@ -4085,6 +4100,8 @@ static int __maybe_unused fec_resume(struct device *dev)
int ret;
int val;
+ icc_enable(fep->bus_path);
+
if (fep->reg_phy && !(fep->wol_flag & FEC_WOL_FLAG_ENABLE)) {
ret = regulator_enable(fep->reg_phy);
if (ret)
@@ -4134,6 +4151,7 @@ static int __maybe_unused fec_runtime_suspend(struct device *dev)
clk_disable_unprepare(fep->clk_ahb);
clk_disable_unprepare(fep->clk_ipg);
+ icc_disable(fep->bus_path);
return 0;
}
@@ -4143,6 +4161,7 @@ static int __maybe_unused fec_runtime_resume(struct device *dev)
struct fec_enet_private *fep = netdev_priv(ndev);
int ret;
+ icc_enable(fep->bus_path);
ret = clk_prepare_enable(fep->clk_ahb);
if (ret)
return ret;
On probe, if the dts node contains a valid icc path, then look for the fsl,icc-rate property and get the rate. Also set the icc bandwidth for that path to the nominal rate needed for fec to function right. Then enable and disable the path every time the fec is used or not. This will result in reducing the clock speeds along the icc path for each pl301 and NoC, but still meet the requirements for all the other icc consumers. Signed-off-by: Abel Vesa <abel.vesa@nxp.com> --- drivers/net/ethernet/freescale/fec.h | 3 +++ drivers/net/ethernet/freescale/fec_main.c | 19 +++++++++++++++++++ 2 files changed, 22 insertions(+)