net: ethernet: ti: am65-cpsw: Fix hardware switch mode on suspend/resume

On low power during system suspend the ALE table context is lost.
Save the ALE contect before suspend and restore it after resume.

Signed-off-by: Roger Quadros <rogerq@kernel.org>
Signed-off-by: David S. Miller <davem@davemloft.net>

diff --git a/drivers/net/ethernet/ti/am65-cpsw-nuss.c b/drivers/net/ethernet/ti/am65-cpsw-nuss.c
index beff21da0514cddcdd60c7875bf4ba77baadbf54..c785e01d025fc96202c72dca45ba54bea3f95f7f 100644 (file)
--- a/drivers/net/ethernet/ti/am65-cpsw-nuss.c
+++ b/drivers/net/ethernet/ti/am65-cpsw-nuss.c
@@ -2715,6 +2715,7 @@ static int am65_cpsw_nuss_probe(struct platform_device *pdev)
        struct clk *clk;
        u64 id_temp;
        int ret, i;
+       int ale_entries;
 
        common = devm_kzalloc(dev, sizeof(struct am65_cpsw_common), GFP_KERNEL);
        if (!common)
@@ -2809,6 +2810,10 @@ static int am65_cpsw_nuss_probe(struct platform_device *pdev)
                goto err_of_clear;
        }
 
+       ale_entries = common->ale->params.ale_entries;
+       common->ale_context = devm_kzalloc(dev,
+                                          ale_entries * ALE_ENTRY_WORDS * sizeof(u32),
+                                          GFP_KERNEL);
        ret = am65_cpsw_init_cpts(common);
        if (ret)
                goto err_of_clear;
@@ -2879,6 +2884,7 @@ static int am65_cpsw_nuss_suspend(struct device *dev)
        int i, ret;
        struct am65_cpsw_host *host_p = am65_common_get_host(common);
 
+       cpsw_ale_dump(common->ale, common->ale_context);
        host_p->vid_context = readl(host_p->port_base + AM65_CPSW_PORT_VLAN_REG_OFFSET);
        for (i = 0; i < common->port_num; i++) {
                port = &common->ports[i];
@@ -2937,6 +2943,7 @@ static int am65_cpsw_nuss_resume(struct device *dev)
        }
 
        writel(host_p->vid_context, host_p->port_base + AM65_CPSW_PORT_VLAN_REG_OFFSET);
+       cpsw_ale_restore(common->ale, common->ale_context);
 
        return 0;
 }

diff --git a/drivers/net/ethernet/ti/am65-cpsw-nuss.h b/drivers/net/ethernet/ti/am65-cpsw-nuss.h
index e95cc37a72864b94deba270748ceeee7c3e0cc4e..4b75620f8d28d5786709adb8bf41de264507b82e 100644 (file)
--- a/drivers/net/ethernet/ti/am65-cpsw-nuss.h
+++ b/drivers/net/ethernet/ti/am65-cpsw-nuss.h
@@ -149,6 +149,8 @@ struct am65_cpsw_common {
        struct net_device *hw_bridge_dev;
        struct notifier_block am65_cpsw_netdevice_nb;
        unsigned char switch_id[MAX_PHYS_ITEM_ID_LEN];
+       /* only for suspend/resume context restore */
+       u32                     *ale_context;
 };
 
 struct am65_cpsw_ndev_stats {