|
@@ -52,6 +52,7 @@
|
|
|
#include <linux/dma-mapping.h>
|
|
|
#include <linux/clk.h>
|
|
|
#include <linux/platform_device.h>
|
|
|
+#include <linux/regmap.h>
|
|
|
#include <linux/semaphore.h>
|
|
|
#include <linux/phy.h>
|
|
|
#include <linux/bitops.h>
|
|
@@ -65,10 +66,12 @@
|
|
|
#include <linux/of_mdio.h>
|
|
|
#include <linux/of_irq.h>
|
|
|
#include <linux/of_net.h>
|
|
|
+#include <linux/mfd/syscon.h>
|
|
|
|
|
|
#include <asm/irq.h>
|
|
|
#include <asm/page.h>
|
|
|
|
|
|
+#include "cpsw.h"
|
|
|
#include "davinci_cpdma.h"
|
|
|
|
|
|
static int debug_level;
|
|
@@ -1838,7 +1841,7 @@ davinci_emac_of_get_pdata(struct platform_device *pdev, struct emac_priv *priv)
|
|
|
if (!is_valid_ether_addr(pdata->mac_addr)) {
|
|
|
mac_addr = of_get_mac_address(np);
|
|
|
if (mac_addr)
|
|
|
- memcpy(pdata->mac_addr, mac_addr, ETH_ALEN);
|
|
|
+ ether_addr_copy(pdata->mac_addr, mac_addr);
|
|
|
}
|
|
|
|
|
|
of_property_read_u32(np, "ti,davinci-ctrl-reg-offset",
|
|
@@ -1879,6 +1882,53 @@ davinci_emac_of_get_pdata(struct platform_device *pdev, struct emac_priv *priv)
|
|
|
return pdata;
|
|
|
}
|
|
|
|
|
|
+static int davinci_emac_3517_get_macid(struct device *dev, u16 offset,
|
|
|
+ int slave, u8 *mac_addr)
|
|
|
+{
|
|
|
+ u32 macid_lsb;
|
|
|
+ u32 macid_msb;
|
|
|
+ struct regmap *syscon;
|
|
|
+
|
|
|
+ syscon = syscon_regmap_lookup_by_phandle(dev->of_node, "syscon");
|
|
|
+ if (IS_ERR(syscon)) {
|
|
|
+ if (PTR_ERR(syscon) == -ENODEV)
|
|
|
+ return 0;
|
|
|
+ return PTR_ERR(syscon);
|
|
|
+ }
|
|
|
+
|
|
|
+ regmap_read(syscon, offset, &macid_lsb);
|
|
|
+ regmap_read(syscon, offset + 4, &macid_msb);
|
|
|
+
|
|
|
+ mac_addr[0] = (macid_msb >> 16) & 0xff;
|
|
|
+ mac_addr[1] = (macid_msb >> 8) & 0xff;
|
|
|
+ mac_addr[2] = macid_msb & 0xff;
|
|
|
+ mac_addr[3] = (macid_lsb >> 16) & 0xff;
|
|
|
+ mac_addr[4] = (macid_lsb >> 8) & 0xff;
|
|
|
+ mac_addr[5] = macid_lsb & 0xff;
|
|
|
+
|
|
|
+ return 0;
|
|
|
+}
|
|
|
+
|
|
|
+static int davinci_emac_try_get_mac(struct platform_device *pdev,
|
|
|
+ int instance, u8 *mac_addr)
|
|
|
+{
|
|
|
+ int error = -EINVAL;
|
|
|
+
|
|
|
+ if (!pdev->dev.of_node)
|
|
|
+ return error;
|
|
|
+
|
|
|
+ if (of_device_is_compatible(pdev->dev.of_node, "ti,am3517-emac"))
|
|
|
+ error = davinci_emac_3517_get_macid(&pdev->dev, 0x110,
|
|
|
+ 0, mac_addr);
|
|
|
+ else if (of_device_is_compatible(pdev->dev.of_node,
|
|
|
+ "ti,dm816-emac"))
|
|
|
+ error = cpsw_am33xx_cm_get_macid(&pdev->dev, 0x30,
|
|
|
+ instance,
|
|
|
+ mac_addr);
|
|
|
+
|
|
|
+ return error;
|
|
|
+}
|
|
|
+
|
|
|
/**
|
|
|
* davinci_emac_probe - EMAC device probe
|
|
|
* @pdev: The DaVinci EMAC device that we are removing
|
|
@@ -2009,6 +2059,10 @@ static int davinci_emac_probe(struct platform_device *pdev)
|
|
|
}
|
|
|
ndev->irq = res->start;
|
|
|
|
|
|
+ rc = davinci_emac_try_get_mac(pdev, res_ctrl ? 0 : 1, priv->mac_addr);
|
|
|
+ if (!rc)
|
|
|
+ ether_addr_copy(ndev->dev_addr, priv->mac_addr);
|
|
|
+
|
|
|
if (!is_valid_ether_addr(priv->mac_addr)) {
|
|
|
/* Use random MAC if none passed */
|
|
|
eth_hw_addr_random(ndev);
|