mirror of
https://github.com/brain-hackers/u-boot-brain
synced 2024-06-09 23:36:03 +09:00
41575d8e4c
This construct is quite long-winded. In earlier days it made some sense since auto-allocation was a strange concept. But with driver model now used pretty universally, we can shorten this to 'auto'. This reduces verbosity and makes it easier to read. Coincidentally it also ensures that every declaration is on one line, thus making dtoc's job easier. Signed-off-by: Simon Glass <sjg@chromium.org>
125 lines
2.8 KiB
C
125 lines
2.8 KiB
C
// SPDX-License-Identifier: GPL-2.0+
|
|
/*
|
|
* Copyright (C) 2018 Marek Vasut <marex@denx.de>
|
|
*
|
|
* Altera SoCFPGA EMAC extras
|
|
*/
|
|
|
|
#include <common.h>
|
|
#include <asm/io.h>
|
|
#include <dm.h>
|
|
#include <clk.h>
|
|
#include <phy.h>
|
|
#include <regmap.h>
|
|
#include <reset.h>
|
|
#include <syscon.h>
|
|
#include "designware.h"
|
|
#include <dm/device_compat.h>
|
|
#include <linux/err.h>
|
|
|
|
#include <asm/arch/system_manager.h>
|
|
|
|
struct dwmac_socfpga_platdata {
|
|
struct dw_eth_pdata dw_eth_pdata;
|
|
void *phy_intf;
|
|
u32 reg_shift;
|
|
};
|
|
|
|
static int dwmac_socfpga_ofdata_to_platdata(struct udevice *dev)
|
|
{
|
|
struct dwmac_socfpga_platdata *pdata = dev_get_platdata(dev);
|
|
struct regmap *regmap;
|
|
struct ofnode_phandle_args args;
|
|
void *range;
|
|
int ret;
|
|
|
|
ret = dev_read_phandle_with_args(dev, "altr,sysmgr-syscon", NULL,
|
|
2, 0, &args);
|
|
if (ret) {
|
|
dev_err(dev, "Failed to get syscon: %d\n", ret);
|
|
return ret;
|
|
}
|
|
|
|
if (args.args_count != 2) {
|
|
dev_err(dev, "Invalid number of syscon args\n");
|
|
return -EINVAL;
|
|
}
|
|
|
|
regmap = syscon_node_to_regmap(args.node);
|
|
if (IS_ERR(regmap)) {
|
|
ret = PTR_ERR(regmap);
|
|
dev_err(dev, "Failed to get regmap: %d\n", ret);
|
|
return ret;
|
|
}
|
|
|
|
range = regmap_get_range(regmap, 0);
|
|
if (!range) {
|
|
dev_err(dev, "Failed to get regmap range\n");
|
|
return -ENOMEM;
|
|
}
|
|
|
|
pdata->phy_intf = range + args.args[0];
|
|
pdata->reg_shift = args.args[1];
|
|
|
|
return designware_eth_ofdata_to_platdata(dev);
|
|
}
|
|
|
|
static int dwmac_socfpga_probe(struct udevice *dev)
|
|
{
|
|
struct dwmac_socfpga_platdata *pdata = dev_get_platdata(dev);
|
|
struct eth_pdata *edata = &pdata->dw_eth_pdata.eth_pdata;
|
|
struct reset_ctl_bulk reset_bulk;
|
|
int ret;
|
|
u32 modereg;
|
|
u32 modemask;
|
|
|
|
switch (edata->phy_interface) {
|
|
case PHY_INTERFACE_MODE_MII:
|
|
case PHY_INTERFACE_MODE_GMII:
|
|
modereg = SYSMGR_EMACGRP_CTRL_PHYSEL_ENUM_GMII_MII;
|
|
break;
|
|
case PHY_INTERFACE_MODE_RMII:
|
|
modereg = SYSMGR_EMACGRP_CTRL_PHYSEL_ENUM_RMII;
|
|
break;
|
|
case PHY_INTERFACE_MODE_RGMII:
|
|
modereg = SYSMGR_EMACGRP_CTRL_PHYSEL_ENUM_RGMII;
|
|
break;
|
|
default:
|
|
dev_err(dev, "Unsupported PHY mode\n");
|
|
return -EINVAL;
|
|
}
|
|
|
|
ret = reset_get_bulk(dev, &reset_bulk);
|
|
if (ret) {
|
|
dev_err(dev, "Failed to get reset: %d\n", ret);
|
|
return ret;
|
|
}
|
|
|
|
reset_assert_bulk(&reset_bulk);
|
|
|
|
modemask = SYSMGR_EMACGRP_CTRL_PHYSEL_MASK << pdata->reg_shift;
|
|
clrsetbits_le32(pdata->phy_intf, modemask,
|
|
modereg << pdata->reg_shift);
|
|
|
|
reset_release_bulk(&reset_bulk);
|
|
|
|
return designware_eth_probe(dev);
|
|
}
|
|
|
|
static const struct udevice_id dwmac_socfpga_ids[] = {
|
|
{ .compatible = "altr,socfpga-stmmac" },
|
|
{ }
|
|
};
|
|
|
|
U_BOOT_DRIVER(dwmac_socfpga) = {
|
|
.name = "dwmac_socfpga",
|
|
.id = UCLASS_ETH,
|
|
.of_match = dwmac_socfpga_ids,
|
|
.ofdata_to_platdata = dwmac_socfpga_ofdata_to_platdata,
|
|
.probe = dwmac_socfpga_probe,
|
|
.ops = &designware_eth_ops,
|
|
.priv_auto = sizeof(struct dw_eth_dev),
|
|
.platdata_auto = sizeof(struct dwmac_socfpga_platdata),
|
|
.flags = DM_FLAG_ALLOC_PRIV_DMA,
|
|
};
|