Orange Pi5 kernel

// SPDX-License-Identifier: GPL-2.0-or-later
/*
 * tsi108/109 device setup code
 *
 * Maintained by Roy Zang < tie-fei.zang@freescale.com >
 */
 
#include <linux/stddef.h>
#include <linux/kernel.h>
#include <linux/init.h>
#include <linux/errno.h>
#include <linux/major.h>
#include <linux/delay.h>
#include <linux/irq.h>
#include <linux/export.h>
#include <linux/device.h>
#include <linux/etherdevice.h>
#include <linux/platform_device.h>
#include <linux/of_net.h>
#include <asm/tsi108.h>
 
#include <linux/atomic.h>
#include <asm/io.h>
#include <asm/irq.h>
#include <asm/prom.h>
#include <mm/mmu_decl.h>
 
#undef DEBUG
 
#ifdef DEBUG
#define DBG(fmt...) do { printk(fmt); } while(0)
#else
#define DBG(fmt...) do { } while(0)
#endif
 
static phys_addr_t tsi108_csr_base = -1;
 
phys_addr_t get_csrbase(void)
{
<------>struct device_node *tsi;
 
<------>if (tsi108_csr_base != -1)
<------><------>return tsi108_csr_base;
 
<------>tsi = of_find_node_by_type(NULL, "tsi-bridge");
<------>if (tsi) {
<------><------>unsigned int size;
<------><------>const void *prop = of_get_property(tsi, "reg", &size);
<------><------>tsi108_csr_base = of_translate_address(tsi, prop);
<------><------>of_node_put(tsi);
<------>}
<------>return tsi108_csr_base;
}
 
u32 get_vir_csrbase(void)
{
<------>return (u32) (ioremap(get_csrbase(), 0x10000));
}
 
EXPORT_SYMBOL(get_csrbase);
EXPORT_SYMBOL(get_vir_csrbase);
 
static int __init tsi108_eth_of_init(void)
{
<------>struct device_node *np;
<------>unsigned int i = 0;
<------>struct platform_device *tsi_eth_dev;
<------>struct resource res;
<------>int ret;
 
<------>for_each_compatible_node(np, "network", "tsi108-ethernet") {
<------><------>struct resource r[2];
<------><------>struct device_node *phy, *mdio;
<------><------>hw_info tsi_eth_data;
<------><------>const unsigned int *phy_id;
<------><------>const void *mac_addr;
<------><------>const phandle *ph;
 
<------><------>memset(r, 0, sizeof(r));
<------><------>memset(&tsi_eth_data, 0, sizeof(tsi_eth_data));
 
<------><------>ret = of_address_to_resource(np, 0, &r[0]);
<------><------>DBG("%s: name:start->end = %s:%pR\n",
<------><------>    __func__, r[0].name, &r[0]);
<------><------>if (ret)
<------><------><------>goto err;
 
<------><------>r[1].name = "tx";
<------><------>r[1].start = irq_of_parse_and_map(np, 0);
<------><------>r[1].end = irq_of_parse_and_map(np, 0);
<------><------>r[1].flags = IORESOURCE_IRQ;
<------><------>DBG("%s: name:start->end = %s:%pR\n",
<------><------><------>__func__, r[1].name, &r[1]);
 
<------><------>tsi_eth_dev =
<------><------>    platform_device_register_simple("tsi-ethernet", i++, &r[0],
<------><------><------><------><------><------>    1);
 
<------><------>if (IS_ERR(tsi_eth_dev)) {
<------><------><------>ret = PTR_ERR(tsi_eth_dev);
<------><------><------>goto err;
<------><------>}
 
<------><------>mac_addr = of_get_mac_address(np);
<------><------>if (!IS_ERR(mac_addr))
<------><------><------>ether_addr_copy(tsi_eth_data.mac_addr, mac_addr);
 
<------><------>ph = of_get_property(np, "mdio-handle", NULL);
<------><------>mdio = of_find_node_by_phandle(*ph);
<------><------>ret = of_address_to_resource(mdio, 0, &res);
<------><------>of_node_put(mdio);
<------><------>if (ret)
<------><------><------>goto unreg;
 
<------><------>ph = of_get_property(np, "phy-handle", NULL);
<------><------>phy = of_find_node_by_phandle(*ph);
 
<------><------>if (phy == NULL) {
<------><------><------>ret = -ENODEV;
<------><------><------>goto unreg;
<------><------>}
 
<------><------>phy_id = of_get_property(phy, "reg", NULL);
 
<------><------>tsi_eth_data.regs = r[0].start;
<------><------>tsi_eth_data.phyregs = res.start;
<------><------>tsi_eth_data.phy = *phy_id;
<------><------>tsi_eth_data.irq_num = irq_of_parse_and_map(np, 0);
 
<------><------>/* Some boards with the TSI108 bridge (e.g. Holly)
<------><------> * have a miswiring of the ethernet PHYs which
<------><------> * requires a workaround.  The special
<------><------> * "txc-rxc-delay-disable" property enables this
<------><------> * workaround.  FIXME: Need to port the tsi108_eth
<------><------> * driver itself to phylib and use a non-misleading
<------><------> * name for the workaround flag - it's not actually to
<------><------> * do with the model of PHY in use */
<------><------>if (of_get_property(phy, "txc-rxc-delay-disable", NULL))
<------><------><------>tsi_eth_data.phy_type = TSI108_PHY_BCM54XX;
<------><------>of_node_put(phy);
 
<------><------>ret =
<------><------>    platform_device_add_data(tsi_eth_dev, &tsi_eth_data,
<------><------><------><------><------>     sizeof(hw_info));
<------><------>if (ret)
<------><------><------>goto unreg;
<------>}
<------>return 0;
unreg:
<------>platform_device_unregister(tsi_eth_dev);
err:
<------>of_node_put(np);
<------>return ret;
}
 
arch_initcall(tsi108_eth_of_init);