|
@@ -58,6 +58,12 @@
|
|
|
#include <linux/io.h>
|
|
|
#include <linux/uaccess.h>
|
|
|
#include <linux/davinci_emac.h>
|
|
|
+#include <linux/of.h>
|
|
|
+#include <linux/of_address.h>
|
|
|
+#include <linux/of_irq.h>
|
|
|
+#include <linux/of_net.h>
|
|
|
+
|
|
|
+#include <mach/mux.h>
|
|
|
|
|
|
#include <asm/irq.h>
|
|
|
#include <asm/page.h>
|
|
@@ -339,6 +345,9 @@ struct emac_priv {
|
|
|
u32 rx_addr_type;
|
|
|
atomic_t cur_tx;
|
|
|
const char *phy_id;
|
|
|
+#ifdef CONFIG_OF
|
|
|
+ struct device_node *phy_node;
|
|
|
+#endif
|
|
|
struct phy_device *phydev;
|
|
|
spinlock_t lock;
|
|
|
/*platform specific members*/
|
|
@@ -1760,6 +1769,77 @@ static const struct net_device_ops emac_netdev_ops = {
|
|
|
#endif
|
|
|
};
|
|
|
|
|
|
+#ifdef CONFIG_OF
|
|
|
+static struct emac_platform_data
|
|
|
+ *davinci_emac_of_get_pdata(struct platform_device *pdev,
|
|
|
+ struct emac_priv *priv)
|
|
|
+{
|
|
|
+ struct device_node *np;
|
|
|
+ struct emac_platform_data *pdata = NULL;
|
|
|
+ const u8 *mac_addr;
|
|
|
+ u32 data;
|
|
|
+ int ret;
|
|
|
+
|
|
|
+ pdata = pdev->dev.platform_data;
|
|
|
+ if (!pdata) {
|
|
|
+ pdata = devm_kzalloc(&pdev->dev, sizeof(*pdata), GFP_KERNEL);
|
|
|
+ if (!pdata)
|
|
|
+ goto nodata;
|
|
|
+ }
|
|
|
+
|
|
|
+ np = pdev->dev.of_node;
|
|
|
+ if (!np)
|
|
|
+ goto nodata;
|
|
|
+ else
|
|
|
+ pdata->version = EMAC_VERSION_2;
|
|
|
+
|
|
|
+ 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);
|
|
|
+ }
|
|
|
+
|
|
|
+ ret = of_property_read_u32(np, "ti,davinci-ctrl-reg-offset", &data);
|
|
|
+ if (!ret)
|
|
|
+ pdata->ctrl_reg_offset = data;
|
|
|
+
|
|
|
+ ret = of_property_read_u32(np, "ti,davinci-ctrl-mod-reg-offset",
|
|
|
+ &data);
|
|
|
+ if (!ret)
|
|
|
+ pdata->ctrl_mod_reg_offset = data;
|
|
|
+
|
|
|
+ ret = of_property_read_u32(np, "ti,davinci-ctrl-ram-offset", &data);
|
|
|
+ if (!ret)
|
|
|
+ pdata->ctrl_ram_offset = data;
|
|
|
+
|
|
|
+ ret = of_property_read_u32(np, "ti,davinci-ctrl-ram-size", &data);
|
|
|
+ if (!ret)
|
|
|
+ pdata->ctrl_ram_size = data;
|
|
|
+
|
|
|
+ ret = of_property_read_u32(np, "ti,davinci-rmii-en", &data);
|
|
|
+ if (!ret)
|
|
|
+ pdata->rmii_en = data;
|
|
|
+
|
|
|
+ ret = of_property_read_u32(np, "ti,davinci-no-bd-ram", &data);
|
|
|
+ if (!ret)
|
|
|
+ pdata->no_bd_ram = data;
|
|
|
+
|
|
|
+ priv->phy_node = of_parse_phandle(np, "phy-handle", 0);
|
|
|
+ if (!priv->phy_node)
|
|
|
+ pdata->phy_id = "";
|
|
|
+
|
|
|
+ pdev->dev.platform_data = pdata;
|
|
|
+nodata:
|
|
|
+ return pdata;
|
|
|
+}
|
|
|
+#else
|
|
|
+static struct emac_platform_data
|
|
|
+ *davinci_emac_of_get_pdata(struct platform_device *pdev,
|
|
|
+ struct emac_priv *priv)
|
|
|
+{
|
|
|
+ return pdev->dev.platform_data;
|
|
|
+}
|
|
|
+#endif
|
|
|
/**
|
|
|
* davinci_emac_probe - EMAC device probe
|
|
|
* @pdev: The DaVinci EMAC device that we are removing
|
|
@@ -1802,7 +1882,7 @@ static int __devinit davinci_emac_probe(struct platform_device *pdev)
|
|
|
|
|
|
spin_lock_init(&priv->lock);
|
|
|
|
|
|
- pdata = pdev->dev.platform_data;
|
|
|
+ pdata = davinci_emac_of_get_pdata(pdev, priv);
|
|
|
if (!pdata) {
|
|
|
dev_err(&pdev->dev, "no platform data\n");
|
|
|
rc = -ENODEV;
|
|
@@ -2013,12 +2093,19 @@ static const struct dev_pm_ops davinci_emac_pm_ops = {
|
|
|
.resume = davinci_emac_resume,
|
|
|
};
|
|
|
|
|
|
+static const struct of_device_id davinci_emac_of_match[] = {
|
|
|
+ {.compatible = "ti,davinci-dm6467-emac", },
|
|
|
+ {},
|
|
|
+};
|
|
|
+MODULE_DEVICE_TABLE(of, davinci_emac_of_match);
|
|
|
+
|
|
|
/* davinci_emac_driver: EMAC platform driver structure */
|
|
|
static struct platform_driver davinci_emac_driver = {
|
|
|
.driver = {
|
|
|
.name = "davinci_emac",
|
|
|
.owner = THIS_MODULE,
|
|
|
.pm = &davinci_emac_pm_ops,
|
|
|
+ .of_match_table = of_match_ptr(davinci_emac_of_match),
|
|
|
},
|
|
|
.probe = davinci_emac_probe,
|
|
|
.remove = __devexit_p(davinci_emac_remove),
|