ARM: imx: add FEC sleep mode callback function
i.MX6q/dl, i.MX6SX SOCs enet support sleep mode that magic packet can wake up system in suspend status. For different SOCs, there have some SOC specifical GPR register to set sleep on/off mode. So add these to callback function for driver. Signed-off-by: Fugang Duan <B38611@freescale.com> Signed-off-by: David S. Miller <davem@davemloft.net>
This commit is contained in:
parent
de40ed31b3
commit
456062b3ec
|
@ -31,6 +31,8 @@
|
||||||
#include <linux/micrel_phy.h>
|
#include <linux/micrel_phy.h>
|
||||||
#include <linux/mfd/syscon.h>
|
#include <linux/mfd/syscon.h>
|
||||||
#include <linux/mfd/syscon/imx6q-iomuxc-gpr.h>
|
#include <linux/mfd/syscon/imx6q-iomuxc-gpr.h>
|
||||||
|
#include <linux/fec.h>
|
||||||
|
#include <linux/netdevice.h>
|
||||||
#include <asm/mach/arch.h>
|
#include <asm/mach/arch.h>
|
||||||
#include <asm/mach/map.h>
|
#include <asm/mach/map.h>
|
||||||
#include <asm/system_misc.h>
|
#include <asm/system_misc.h>
|
||||||
|
@ -39,6 +41,35 @@
|
||||||
#include "cpuidle.h"
|
#include "cpuidle.h"
|
||||||
#include "hardware.h"
|
#include "hardware.h"
|
||||||
|
|
||||||
|
static struct fec_platform_data fec_pdata;
|
||||||
|
|
||||||
|
static void imx6q_fec_sleep_enable(int enabled)
|
||||||
|
{
|
||||||
|
struct regmap *gpr;
|
||||||
|
|
||||||
|
gpr = syscon_regmap_lookup_by_compatible("fsl,imx6q-iomuxc-gpr");
|
||||||
|
if (!IS_ERR(gpr)) {
|
||||||
|
if (enabled)
|
||||||
|
regmap_update_bits(gpr, IOMUXC_GPR13,
|
||||||
|
IMX6Q_GPR13_ENET_STOP_REQ,
|
||||||
|
IMX6Q_GPR13_ENET_STOP_REQ);
|
||||||
|
|
||||||
|
else
|
||||||
|
regmap_update_bits(gpr, IOMUXC_GPR13,
|
||||||
|
IMX6Q_GPR13_ENET_STOP_REQ, 0);
|
||||||
|
} else
|
||||||
|
pr_err("failed to find fsl,imx6q-iomux-gpr regmap\n");
|
||||||
|
}
|
||||||
|
|
||||||
|
static void __init imx6q_enet_plt_init(void)
|
||||||
|
{
|
||||||
|
struct device_node *np;
|
||||||
|
|
||||||
|
np = of_find_node_by_path("/soc/aips-bus@02100000/ethernet@02188000");
|
||||||
|
if (np && of_get_property(np, "fsl,magic-packet", NULL))
|
||||||
|
fec_pdata.sleep_mode_enable = imx6q_fec_sleep_enable;
|
||||||
|
}
|
||||||
|
|
||||||
/* For imx6q sabrelite board: set KSZ9021RN RGMII pad skew */
|
/* For imx6q sabrelite board: set KSZ9021RN RGMII pad skew */
|
||||||
static int ksz9021rn_phy_fixup(struct phy_device *phydev)
|
static int ksz9021rn_phy_fixup(struct phy_device *phydev)
|
||||||
{
|
{
|
||||||
|
@ -261,6 +292,12 @@ static void __init imx6q_axi_init(void)
|
||||||
}
|
}
|
||||||
}
|
}
|
||||||
|
|
||||||
|
/* Add auxdata to pass platform data */
|
||||||
|
static const struct of_dev_auxdata imx6q_auxdata_lookup[] __initconst = {
|
||||||
|
OF_DEV_AUXDATA("fsl,imx6q-fec", 0x02188000, NULL, &fec_pdata),
|
||||||
|
{ /* sentinel */ }
|
||||||
|
};
|
||||||
|
|
||||||
static void __init imx6q_init_machine(void)
|
static void __init imx6q_init_machine(void)
|
||||||
{
|
{
|
||||||
struct device *parent;
|
struct device *parent;
|
||||||
|
@ -274,11 +311,13 @@ static void __init imx6q_init_machine(void)
|
||||||
|
|
||||||
imx6q_enet_phy_init();
|
imx6q_enet_phy_init();
|
||||||
|
|
||||||
of_platform_populate(NULL, of_default_bus_match_table, NULL, parent);
|
of_platform_populate(NULL, of_default_bus_match_table,
|
||||||
|
imx6q_auxdata_lookup, parent);
|
||||||
|
|
||||||
imx_anatop_init();
|
imx_anatop_init();
|
||||||
cpu_is_imx6q() ? imx6q_pm_init() : imx6dl_pm_init();
|
cpu_is_imx6q() ? imx6q_pm_init() : imx6dl_pm_init();
|
||||||
imx6q_1588_init();
|
imx6q_1588_init();
|
||||||
|
imx6q_enet_plt_init();
|
||||||
imx6q_axi_init();
|
imx6q_axi_init();
|
||||||
}
|
}
|
||||||
|
|
||||||
|
|
|
@ -12,12 +12,62 @@
|
||||||
#include <linux/regmap.h>
|
#include <linux/regmap.h>
|
||||||
#include <linux/mfd/syscon.h>
|
#include <linux/mfd/syscon.h>
|
||||||
#include <linux/mfd/syscon/imx6q-iomuxc-gpr.h>
|
#include <linux/mfd/syscon/imx6q-iomuxc-gpr.h>
|
||||||
|
#include <linux/fec.h>
|
||||||
|
#include <linux/netdevice.h>
|
||||||
#include <asm/mach/arch.h>
|
#include <asm/mach/arch.h>
|
||||||
#include <asm/mach/map.h>
|
#include <asm/mach/map.h>
|
||||||
|
|
||||||
#include "common.h"
|
#include "common.h"
|
||||||
#include "cpuidle.h"
|
#include "cpuidle.h"
|
||||||
|
|
||||||
|
static struct fec_platform_data fec_pdata[2];
|
||||||
|
|
||||||
|
static void imx6sx_fec1_sleep_enable(int enabled)
|
||||||
|
{
|
||||||
|
struct regmap *gpr;
|
||||||
|
|
||||||
|
gpr = syscon_regmap_lookup_by_compatible("fsl,imx6sx-iomuxc-gpr");
|
||||||
|
if (!IS_ERR(gpr)) {
|
||||||
|
if (enabled)
|
||||||
|
regmap_update_bits(gpr, IOMUXC_GPR4,
|
||||||
|
IMX6SX_GPR4_FEC_ENET1_STOP_REQ,
|
||||||
|
IMX6SX_GPR4_FEC_ENET1_STOP_REQ);
|
||||||
|
else
|
||||||
|
regmap_update_bits(gpr, IOMUXC_GPR4,
|
||||||
|
IMX6SX_GPR4_FEC_ENET1_STOP_REQ, 0);
|
||||||
|
} else
|
||||||
|
pr_err("failed to find fsl,imx6sx-iomux-gpr regmap\n");
|
||||||
|
}
|
||||||
|
|
||||||
|
static void imx6sx_fec2_sleep_enable(int enabled)
|
||||||
|
{
|
||||||
|
struct regmap *gpr;
|
||||||
|
|
||||||
|
gpr = syscon_regmap_lookup_by_compatible("fsl,imx6sx-iomuxc-gpr");
|
||||||
|
if (!IS_ERR(gpr)) {
|
||||||
|
if (enabled)
|
||||||
|
regmap_update_bits(gpr, IOMUXC_GPR4,
|
||||||
|
IMX6SX_GPR4_FEC_ENET2_STOP_REQ,
|
||||||
|
IMX6SX_GPR4_FEC_ENET2_STOP_REQ);
|
||||||
|
else
|
||||||
|
regmap_update_bits(gpr, IOMUXC_GPR4,
|
||||||
|
IMX6SX_GPR4_FEC_ENET2_STOP_REQ, 0);
|
||||||
|
} else
|
||||||
|
pr_err("failed to find fsl,imx6sx-iomux-gpr regmap\n");
|
||||||
|
}
|
||||||
|
|
||||||
|
static void __init imx6sx_enet_plt_init(void)
|
||||||
|
{
|
||||||
|
struct device_node *np;
|
||||||
|
|
||||||
|
np = of_find_node_by_path("/soc/aips-bus@02100000/ethernet@02188000");
|
||||||
|
if (np && of_get_property(np, "fsl,magic-packet", NULL))
|
||||||
|
fec_pdata[0].sleep_mode_enable = imx6sx_fec1_sleep_enable;
|
||||||
|
np = of_find_node_by_path("/soc/aips-bus@02100000/ethernet@021b4000");
|
||||||
|
if (np && of_get_property(np, "fsl,magic-packet", NULL))
|
||||||
|
fec_pdata[1].sleep_mode_enable = imx6sx_fec2_sleep_enable;
|
||||||
|
}
|
||||||
|
|
||||||
static int ar8031_phy_fixup(struct phy_device *dev)
|
static int ar8031_phy_fixup(struct phy_device *dev)
|
||||||
{
|
{
|
||||||
u16 val;
|
u16 val;
|
||||||
|
|
Loading…
Reference in a new issue