mirror of https://github.com/Qortal/Brooklyn
You can not select more than 25 topics
Topics must start with a letter or number, can include dashes ('-') and can be up to 35 characters long.
280 lines
6.9 KiB
280 lines
6.9 KiB
// SPDX-License-Identifier: GPL-2.0-or-later |
|
/* |
|
* emac-rockchip.c - Rockchip EMAC specific glue layer |
|
* |
|
* Copyright (C) 2014 Romain Perier <[email protected]> |
|
*/ |
|
|
|
#include <linux/etherdevice.h> |
|
#include <linux/mfd/syscon.h> |
|
#include <linux/module.h> |
|
#include <linux/of_net.h> |
|
#include <linux/platform_device.h> |
|
#include <linux/regmap.h> |
|
#include <linux/regulator/consumer.h> |
|
|
|
#include "emac.h" |
|
|
|
#define DRV_NAME "rockchip_emac" |
|
|
|
struct emac_rockchip_soc_data { |
|
unsigned int grf_offset; |
|
unsigned int grf_mode_offset; |
|
unsigned int grf_speed_offset; |
|
bool need_div_macclk; |
|
}; |
|
|
|
struct rockchip_priv_data { |
|
struct arc_emac_priv emac; |
|
struct regmap *grf; |
|
const struct emac_rockchip_soc_data *soc_data; |
|
struct regulator *regulator; |
|
struct clk *refclk; |
|
struct clk *macclk; |
|
}; |
|
|
|
static void emac_rockchip_set_mac_speed(void *priv, unsigned int speed) |
|
{ |
|
struct rockchip_priv_data *emac = priv; |
|
u32 speed_offset = emac->soc_data->grf_speed_offset; |
|
u32 data; |
|
int err = 0; |
|
|
|
switch (speed) { |
|
case 10: |
|
data = (1 << (speed_offset + 16)) | (0 << speed_offset); |
|
break; |
|
case 100: |
|
data = (1 << (speed_offset + 16)) | (1 << speed_offset); |
|
break; |
|
default: |
|
pr_err("speed %u not supported\n", speed); |
|
return; |
|
} |
|
|
|
err = regmap_write(emac->grf, emac->soc_data->grf_offset, data); |
|
if (err) |
|
pr_err("unable to apply speed %u to grf (%d)\n", speed, err); |
|
} |
|
|
|
static const struct emac_rockchip_soc_data emac_rk3036_emac_data = { |
|
.grf_offset = 0x140, .grf_mode_offset = 8, |
|
.grf_speed_offset = 9, .need_div_macclk = 1, |
|
}; |
|
|
|
static const struct emac_rockchip_soc_data emac_rk3066_emac_data = { |
|
.grf_offset = 0x154, .grf_mode_offset = 0, |
|
.grf_speed_offset = 1, .need_div_macclk = 0, |
|
}; |
|
|
|
static const struct emac_rockchip_soc_data emac_rk3188_emac_data = { |
|
.grf_offset = 0x0a4, .grf_mode_offset = 0, |
|
.grf_speed_offset = 1, .need_div_macclk = 0, |
|
}; |
|
|
|
static const struct of_device_id emac_rockchip_dt_ids[] = { |
|
{ |
|
.compatible = "rockchip,rk3036-emac", |
|
.data = &emac_rk3036_emac_data, |
|
}, |
|
{ |
|
.compatible = "rockchip,rk3066-emac", |
|
.data = &emac_rk3066_emac_data, |
|
}, |
|
{ |
|
.compatible = "rockchip,rk3188-emac", |
|
.data = &emac_rk3188_emac_data, |
|
}, |
|
{ /* Sentinel */ } |
|
}; |
|
|
|
MODULE_DEVICE_TABLE(of, emac_rockchip_dt_ids); |
|
|
|
static int emac_rockchip_probe(struct platform_device *pdev) |
|
{ |
|
struct device *dev = &pdev->dev; |
|
struct net_device *ndev; |
|
struct rockchip_priv_data *priv; |
|
const struct of_device_id *match; |
|
phy_interface_t interface; |
|
u32 data; |
|
int err; |
|
|
|
if (!pdev->dev.of_node) |
|
return -ENODEV; |
|
|
|
ndev = alloc_etherdev(sizeof(struct rockchip_priv_data)); |
|
if (!ndev) |
|
return -ENOMEM; |
|
platform_set_drvdata(pdev, ndev); |
|
SET_NETDEV_DEV(ndev, dev); |
|
|
|
priv = netdev_priv(ndev); |
|
priv->emac.drv_name = DRV_NAME; |
|
priv->emac.set_mac_speed = emac_rockchip_set_mac_speed; |
|
|
|
err = of_get_phy_mode(dev->of_node, &interface); |
|
if (err) |
|
goto out_netdev; |
|
|
|
/* RK3036/RK3066/RK3188 SoCs only support RMII */ |
|
if (interface != PHY_INTERFACE_MODE_RMII) { |
|
dev_err(dev, "unsupported phy interface mode %d\n", interface); |
|
err = -ENOTSUPP; |
|
goto out_netdev; |
|
} |
|
|
|
priv->grf = syscon_regmap_lookup_by_phandle(dev->of_node, |
|
"rockchip,grf"); |
|
if (IS_ERR(priv->grf)) { |
|
dev_err(dev, "failed to retrieve global register file (%ld)\n", |
|
PTR_ERR(priv->grf)); |
|
err = PTR_ERR(priv->grf); |
|
goto out_netdev; |
|
} |
|
|
|
match = of_match_node(emac_rockchip_dt_ids, dev->of_node); |
|
priv->soc_data = match->data; |
|
|
|
priv->emac.clk = devm_clk_get(dev, "hclk"); |
|
if (IS_ERR(priv->emac.clk)) { |
|
dev_err(dev, "failed to retrieve host clock (%ld)\n", |
|
PTR_ERR(priv->emac.clk)); |
|
err = PTR_ERR(priv->emac.clk); |
|
goto out_netdev; |
|
} |
|
|
|
priv->refclk = devm_clk_get(dev, "macref"); |
|
if (IS_ERR(priv->refclk)) { |
|
dev_err(dev, "failed to retrieve reference clock (%ld)\n", |
|
PTR_ERR(priv->refclk)); |
|
err = PTR_ERR(priv->refclk); |
|
goto out_netdev; |
|
} |
|
|
|
err = clk_prepare_enable(priv->refclk); |
|
if (err) { |
|
dev_err(dev, "failed to enable reference clock (%d)\n", err); |
|
goto out_netdev; |
|
} |
|
|
|
/* Optional regulator for PHY */ |
|
priv->regulator = devm_regulator_get_optional(dev, "phy"); |
|
if (IS_ERR(priv->regulator)) { |
|
if (PTR_ERR(priv->regulator) == -EPROBE_DEFER) { |
|
err = -EPROBE_DEFER; |
|
goto out_clk_disable; |
|
} |
|
dev_err(dev, "no regulator found\n"); |
|
priv->regulator = NULL; |
|
} |
|
|
|
if (priv->regulator) { |
|
err = regulator_enable(priv->regulator); |
|
if (err) { |
|
dev_err(dev, "failed to enable phy-supply (%d)\n", err); |
|
goto out_clk_disable; |
|
} |
|
} |
|
|
|
/* Set speed 100M */ |
|
data = (1 << (priv->soc_data->grf_speed_offset + 16)) | |
|
(1 << priv->soc_data->grf_speed_offset); |
|
/* Set RMII mode */ |
|
data |= (1 << (priv->soc_data->grf_mode_offset + 16)) | |
|
(0 << priv->soc_data->grf_mode_offset); |
|
|
|
err = regmap_write(priv->grf, priv->soc_data->grf_offset, data); |
|
if (err) { |
|
dev_err(dev, "unable to apply initial settings to grf (%d)\n", |
|
err); |
|
goto out_regulator_disable; |
|
} |
|
|
|
/* RMII interface needs always a rate of 50MHz */ |
|
err = clk_set_rate(priv->refclk, 50000000); |
|
if (err) { |
|
dev_err(dev, |
|
"failed to change reference clock rate (%d)\n", err); |
|
goto out_regulator_disable; |
|
} |
|
|
|
if (priv->soc_data->need_div_macclk) { |
|
priv->macclk = devm_clk_get(dev, "macclk"); |
|
if (IS_ERR(priv->macclk)) { |
|
dev_err(dev, "failed to retrieve mac clock (%ld)\n", |
|
PTR_ERR(priv->macclk)); |
|
err = PTR_ERR(priv->macclk); |
|
goto out_regulator_disable; |
|
} |
|
|
|
err = clk_prepare_enable(priv->macclk); |
|
if (err) { |
|
dev_err(dev, "failed to enable mac clock (%d)\n", err); |
|
goto out_regulator_disable; |
|
} |
|
|
|
/* RMII TX/RX needs always a rate of 25MHz */ |
|
err = clk_set_rate(priv->macclk, 25000000); |
|
if (err) { |
|
dev_err(dev, |
|
"failed to change mac clock rate (%d)\n", err); |
|
goto out_clk_disable_macclk; |
|
} |
|
} |
|
|
|
err = arc_emac_probe(ndev, interface); |
|
if (err) { |
|
dev_err(dev, "failed to probe arc emac (%d)\n", err); |
|
goto out_clk_disable_macclk; |
|
} |
|
|
|
return 0; |
|
|
|
out_clk_disable_macclk: |
|
if (priv->soc_data->need_div_macclk) |
|
clk_disable_unprepare(priv->macclk); |
|
out_regulator_disable: |
|
if (priv->regulator) |
|
regulator_disable(priv->regulator); |
|
out_clk_disable: |
|
clk_disable_unprepare(priv->refclk); |
|
out_netdev: |
|
free_netdev(ndev); |
|
return err; |
|
} |
|
|
|
static int emac_rockchip_remove(struct platform_device *pdev) |
|
{ |
|
struct net_device *ndev = platform_get_drvdata(pdev); |
|
struct rockchip_priv_data *priv = netdev_priv(ndev); |
|
int err; |
|
|
|
err = arc_emac_remove(ndev); |
|
|
|
clk_disable_unprepare(priv->refclk); |
|
|
|
if (priv->regulator) |
|
regulator_disable(priv->regulator); |
|
|
|
if (priv->soc_data->need_div_macclk) |
|
clk_disable_unprepare(priv->macclk); |
|
|
|
free_netdev(ndev); |
|
return err; |
|
} |
|
|
|
static struct platform_driver emac_rockchip_driver = { |
|
.probe = emac_rockchip_probe, |
|
.remove = emac_rockchip_remove, |
|
.driver = { |
|
.name = DRV_NAME, |
|
.of_match_table = emac_rockchip_dt_ids, |
|
}, |
|
}; |
|
|
|
module_platform_driver(emac_rockchip_driver); |
|
|
|
MODULE_AUTHOR("Romain Perier <[email protected]>"); |
|
MODULE_DESCRIPTION("Rockchip EMAC platform driver"); |
|
MODULE_LICENSE("GPL");
|
|
|