|
@@ -999,6 +999,8 @@ static int fs_enet_probe(struct platform_device *ofdev)
|
|
|
struct fs_enet_private *fep;
|
|
|
struct fs_platform_info *fpi;
|
|
|
const u32 *data;
|
|
|
+ struct clk *clk;
|
|
|
+ int err;
|
|
|
const u8 *mac_addr;
|
|
|
const char *phy_connection_type;
|
|
|
int privsize, len, ret = -ENODEV;
|
|
@@ -1036,6 +1038,20 @@ static int fs_enet_probe(struct platform_device *ofdev)
|
|
|
fpi->use_rmii = 1;
|
|
|
}
|
|
|
|
|
|
+ /* make clock lookup non-fatal (the driver is shared among platforms),
|
|
|
+ * but require enable to succeed when a clock was specified/found,
|
|
|
+ * keep a reference to the clock upon successful acquisition
|
|
|
+ */
|
|
|
+ clk = devm_clk_get(&ofdev->dev, "per");
|
|
|
+ if (!IS_ERR(clk)) {
|
|
|
+ err = clk_prepare_enable(clk);
|
|
|
+ if (err) {
|
|
|
+ ret = err;
|
|
|
+ goto out_free_fpi;
|
|
|
+ }
|
|
|
+ fpi->clk_per = clk;
|
|
|
+ }
|
|
|
+
|
|
|
privsize = sizeof(*fep) +
|
|
|
sizeof(struct sk_buff **) *
|
|
|
(fpi->rx_ring + fpi->tx_ring);
|
|
@@ -1107,6 +1123,8 @@ out_free_dev:
|
|
|
free_netdev(ndev);
|
|
|
out_put:
|
|
|
of_node_put(fpi->phy_node);
|
|
|
+ if (fpi->clk_per)
|
|
|
+ clk_disable_unprepare(fpi->clk_per);
|
|
|
out_free_fpi:
|
|
|
kfree(fpi);
|
|
|
return ret;
|
|
@@ -1123,6 +1141,8 @@ static int fs_enet_remove(struct platform_device *ofdev)
|
|
|
fep->ops->cleanup_data(ndev);
|
|
|
dev_set_drvdata(fep->dev, NULL);
|
|
|
of_node_put(fep->fpi->phy_node);
|
|
|
+ if (fep->fpi->clk_per)
|
|
|
+ clk_disable_unprepare(fep->fpi->clk_per);
|
|
|
free_netdev(ndev);
|
|
|
return 0;
|
|
|
}
|