1// SPDX-License-Identifier: GPL-2.0
2/*
3 * Xilinx Versal NET SOC driver
4 *
5 * Copyright (C) 2022, Advanced Micro Devices, Inc.
6 */
7
8#include <common.h>
9#include <dm.h>
10#include <soc.h>
11#include <zynqmp_firmware.h>
12#include <asm/io.h>
13#include <asm/arch/hardware.h>
14
15#include <linux/bitfield.h>
16
17/*
18 * v1 -> 0x10 - ES1
19 * v2 -> 0x20 - Production
20 */
21static const char versal_family[] = "Versal NET";
22
23struct soc_xilinx_versal_net_priv {
24	const char *family;
25	char revision;
26};
27
28static int soc_xilinx_versal_net_get_family(struct udevice *dev, char *buf, int size)
29{
30	struct soc_xilinx_versal_net_priv *priv = dev_get_priv(dev);
31
32	return snprintf(buf, size, "%s", priv->family);
33}
34
35static int soc_xilinx_versal_net_get_revision(struct udevice *dev, char *buf, int size)
36{
37	struct soc_xilinx_versal_net_priv *priv = dev_get_priv(dev);
38
39	return snprintf(buf, size, "v%d", priv->revision);
40}
41
42static const struct soc_ops soc_xilinx_versal_net_ops = {
43	.get_family = soc_xilinx_versal_net_get_family,
44	.get_revision = soc_xilinx_versal_net_get_revision,
45};
46
47static int soc_xilinx_versal_net_probe(struct udevice *dev)
48{
49	struct soc_xilinx_versal_net_priv *priv = dev_get_priv(dev);
50	u32 ret_payload[PAYLOAD_ARG_CNT];
51	int ret;
52
53	priv->family = versal_family;
54
55	if (IS_ENABLED(CONFIG_ZYNQMP_FIRMWARE)) {
56		ret = xilinx_pm_request(PM_GET_CHIPID, 0, 0, 0, 0,
57					ret_payload);
58		if (ret)
59			return ret;
60	} else {
61		ret_payload[2] = readl(PMC_TAP_VERSION);
62		if (!ret_payload[2])
63			return -EINVAL;
64	}
65
66	priv->revision = FIELD_GET(PS_VERSION_MASK, ret_payload[2]);
67
68	return 0;
69}
70
71U_BOOT_DRIVER(soc_xilinx_versal_net) = {
72	.name		= "soc_xilinx_versal_net",
73	.id		= UCLASS_SOC,
74	.ops		= &soc_xilinx_versal_net_ops,
75	.probe		= soc_xilinx_versal_net_probe,
76	.priv_auto	= sizeof(struct soc_xilinx_versal_net_priv),
77	.flags		= DM_FLAG_PRE_RELOC,
78};
79