|
@@ -1782,33 +1782,6 @@ fec_probe(struct platform_device *pdev)
|
|
|
fep->phy_interface = ret;
|
|
|
}
|
|
|
|
|
|
- fep->bufdesc_ex =
|
|
|
- pdev->id_entry->driver_data & FEC_QUIRK_HAS_BUFDESC_EX;
|
|
|
- if (fep->bufdesc_ex)
|
|
|
- fec_ptp_init(ndev, pdev);
|
|
|
-
|
|
|
- ret = fec_enet_init(ndev);
|
|
|
- if (ret)
|
|
|
- goto failed_init;
|
|
|
-
|
|
|
- for (i = 0; i < FEC_IRQ_NUM; i++) {
|
|
|
- irq = platform_get_irq(pdev, i);
|
|
|
- if (irq < 0) {
|
|
|
- if (i)
|
|
|
- break;
|
|
|
- ret = irq;
|
|
|
- goto failed_irq;
|
|
|
- }
|
|
|
- ret = request_irq(irq, fec_enet_interrupt, IRQF_DISABLED, pdev->name, ndev);
|
|
|
- if (ret) {
|
|
|
- while (--i >= 0) {
|
|
|
- irq = platform_get_irq(pdev, i);
|
|
|
- free_irq(irq, ndev);
|
|
|
- }
|
|
|
- goto failed_irq;
|
|
|
- }
|
|
|
- }
|
|
|
-
|
|
|
pinctrl = devm_pinctrl_get_select_default(&pdev->dev);
|
|
|
if (IS_ERR(pinctrl)) {
|
|
|
ret = PTR_ERR(pinctrl);
|
|
@@ -1828,6 +1801,8 @@ fec_probe(struct platform_device *pdev)
|
|
|
}
|
|
|
|
|
|
fep->clk_ptp = devm_clk_get(&pdev->dev, "ptp");
|
|
|
+ fep->bufdesc_ex =
|
|
|
+ pdev->id_entry->driver_data & FEC_QUIRK_HAS_BUFDESC_EX;
|
|
|
if (IS_ERR(fep->clk_ptp)) {
|
|
|
ret = PTR_ERR(fep->clk_ptp);
|
|
|
fep->bufdesc_ex = 0;
|
|
@@ -1850,6 +1825,31 @@ fec_probe(struct platform_device *pdev)
|
|
|
|
|
|
fec_reset_phy(pdev);
|
|
|
|
|
|
+ if (fep->bufdesc_ex)
|
|
|
+ fec_ptp_init(ndev, pdev);
|
|
|
+
|
|
|
+ ret = fec_enet_init(ndev);
|
|
|
+ if (ret)
|
|
|
+ goto failed_init;
|
|
|
+
|
|
|
+ for (i = 0; i < FEC_IRQ_NUM; i++) {
|
|
|
+ irq = platform_get_irq(pdev, i);
|
|
|
+ if (irq < 0) {
|
|
|
+ if (i)
|
|
|
+ break;
|
|
|
+ ret = irq;
|
|
|
+ goto failed_irq;
|
|
|
+ }
|
|
|
+ ret = request_irq(irq, fec_enet_interrupt, IRQF_DISABLED, pdev->name, ndev);
|
|
|
+ if (ret) {
|
|
|
+ while (--i >= 0) {
|
|
|
+ irq = platform_get_irq(pdev, i);
|
|
|
+ free_irq(irq, ndev);
|
|
|
+ }
|
|
|
+ goto failed_irq;
|
|
|
+ }
|
|
|
+ }
|
|
|
+
|
|
|
ret = fec_enet_mii_init(pdev);
|
|
|
if (ret)
|
|
|
goto failed_mii_init;
|
|
@@ -1866,6 +1866,13 @@ fec_probe(struct platform_device *pdev)
|
|
|
failed_register:
|
|
|
fec_enet_mii_remove(fep);
|
|
|
failed_mii_init:
|
|
|
+failed_init:
|
|
|
+ for (i = 0; i < FEC_IRQ_NUM; i++) {
|
|
|
+ irq = platform_get_irq(pdev, i);
|
|
|
+ if (irq > 0)
|
|
|
+ free_irq(irq, ndev);
|
|
|
+ }
|
|
|
+failed_irq:
|
|
|
failed_regulator:
|
|
|
clk_disable_unprepare(fep->clk_ahb);
|
|
|
clk_disable_unprepare(fep->clk_ipg);
|
|
@@ -1873,14 +1880,7 @@ failed_regulator:
|
|
|
clk_disable_unprepare(fep->clk_ptp);
|
|
|
failed_pin:
|
|
|
failed_clk:
|
|
|
- for (i = 0; i < FEC_IRQ_NUM; i++) {
|
|
|
- irq = platform_get_irq(pdev, i);
|
|
|
- if (irq > 0)
|
|
|
- free_irq(irq, ndev);
|
|
|
- }
|
|
|
-failed_irq:
|
|
|
iounmap(fep->hwp);
|
|
|
-failed_init:
|
|
|
failed_ioremap:
|
|
|
free_netdev(ndev);
|
|
|
failed_alloc_etherdev:
|