/*	$NetBSD: sam460ex_fdt.c,v 1.2 2026/06/16 23:37:49 rkujawa Exp $	*/

/*
 * Copyright (c) 2012, 2014, 2024, 2026 The NetBSD Foundation, Inc.
 * All rights reserved.
 *
 * This code is derived from software contributed to The NetBSD Foundation
 * by Radoslaw Kujawa.
 *
 * Redistribution and use in source and binary forms, with or without
 * modification, are permitted provided that the following conditions
 * are met:
 * 1. Redistributions of source code must retain the above copyright
 *    notice, this list of conditions and the following disclaimer.
 * 2. Redistributions in binary form must reproduce the above copyright
 *    notice, this list of conditions and the following disclaimer in the
 *    documentation and/or other materials provided with the distribution.
 *
 * THIS SOFTWARE IS PROVIDED BY THE AUTHOR ``AS IS'' AND ANY EXPRESS OR
 * IMPLIED WARRANTIES, INCLUDING, BUT NOT LIMITED TO, THE IMPLIED WARRANTIES
 * OF MERCHANTABILITY AND FITNESS FOR A PARTICULAR PURPOSE ARE DISCLAIMED.
 * IN NO EVENT SHALL THE AUTHOR BE LIABLE FOR ANY DIRECT, INDIRECT,
 * INCIDENTAL, SPECIAL, EXEMPLARY, OR CONSEQUENTIAL DAMAGES (INCLUDING, BUT
 * NOT LIMITED TO, PROCUREMENT OF SUBSTITUTE GOODS OR SERVICES; LOSS OF USE,
 * DATA, OR PROFITS; OR BUSINESS INTERRUPTION) HOWEVER CAUSED AND ON ANY
 * THEORY OF LIABILITY, WHETHER IN CONTRACT, STRICT LIABILITY, OR TORT
 * (INCLUDING NEGLIGENCE OR OTHERWISE) ARISING IN ANY WAY OUT OF THE USE OF
 * THIS SOFTWARE, EVEN IF ADVISED OF THE POSSIBILITY OF SUCH DAMAGE.
 */

/*
 * Flattened-device-tree bootstrap for the Sam460ex.
 */

#include <sys/cdefs.h>
__KERNEL_RCSID(0, "$NetBSD: sam460ex_fdt.c,v 1.2 2026/06/16 23:37:49 rkujawa Exp $");

#include <sys/param.h>
#include <sys/systm.h>
#include <sys/device.h>

#include <machine/sam460ex.h>

#include <dev/ofw/openfirm.h>
#include <dev/fdt/fdtvar.h>
#include <dev/fdt/fdt_console.h>

#include <libfdt.h>

struct sam460ex_fdt_info sam460ex_fdt_info;

/* see consinit() */
static int
sam460ex_fdt_console_nomatch(int phandle)
{
	return 0;
}

static const struct fdt_console sam460ex_fdt_console_none = {
	.match = sam460ex_fdt_console_nomatch,
	.consinit = NULL,
};
FDT_CONSOLE(sam460ex_none, &sam460ex_fdt_console_none);

/*
 * Our own copy of the device tree, kept live for the lifetime of the
 * kernel. 
 */
#define	SAM460EX_FDT_BUFSIZE	(64 * 1024)
static uint64_t fdt_buf[SAM460EX_FDT_BUFSIZE / sizeof(uint64_t)];

static char bootargs_buf[256];

static const struct device_compatible_entry emac_compat[] = {
	{ .compat = "ibm,emac4sync" },
	DEVICE_COMPAT_EOL
};

/*
 * Recursively collect the per-EMAC MAC addresses.
 */
static void
sam460ex_fdt_emac(int node)
{
	int child;

	for (child = OF_child(node); child; child = OF_peer(child)) {
		uint32_t idx;
		uint8_t mac[6];
		int j;

		if (of_compatible_match(child, emac_compat) != 0 &&
		    of_getprop_uint32(child, "cell-index", &idx) == 0 &&
		    idx < SAM460EX_NEMAC &&
		    OF_getprop(child, "local-mac-address", mac, sizeof(mac)) ==
		    (int)sizeof(mac)) {
			for (j = 0; j < 6; j++)
				if (mac[j] != 0)
					break;
			if (j != 6) {
				memcpy(sam460ex_fdt_info.fi_enaddr[idx], mac, 6);
				sam460ex_fdt_info.fi_enaddr_valid[idx] = true;
			}
		}
		sam460ex_fdt_emac(child);
	}
}

/*
 * Parse the device tree at the physical address U-Boot passed in r3.
 */
bool
sam460ex_fdt_parse(paddr_t fdt_pa)
{
	struct sam460ex_fdt_info *info = &sam460ex_fdt_info;
	const void *src = (const void *)fdt_pa;
	uint32_t ac, sc;
	int root, node, len;

	memset(info, 0, sizeof(*info));

	if (fdt_pa == 0 || fdt_pa >= 0x10000000 ||
	    fdt_check_header(src) != 0 ||
	    (size_t)fdt_totalsize(src) > sizeof(fdt_buf))
		return false;

	/*
	 * Copy the blob into our own buf
	 */
	if (fdt_open_into(src, fdt_buf, sizeof(fdt_buf)) != 0 ||
	    !fdtbus_init(fdt_buf))
		return false;

	root = OF_finddevice("/");

	/*
	 * RAM size: /memory "reg" = <address... size...>.  
	 */
	ac = 2;
	sc = 1;
	of_getprop_uint32(root, "#address-cells", &ac);
	of_getprop_uint32(root, "#size-cells", &sc);
	node = OF_finddevice("/memory");
	if (node >= 0 && ac > 0 && sc > 0 && ac + sc <= 4) {
		uint32_t reg[4];

		if (of_getprop_uint32_array(node, "reg", reg, ac + sc) == 0)
			info->fi_memsize = reg[ac + sc - 1];
	}

	/* CPU and timebase clocks (the timebase runs at the CPU clock). */
	node = OF_finddevice("/cpus/cpu@0");
	if (node >= 0) {
		of_getprop_uint32(node, "clock-frequency", &info->fi_cpu_freq);
		of_getprop_uint32(node, "timebase-frequency",
		    &info->fi_timebase_freq);
	}

	/* OPB (peripheral) clock. */
	node = OF_finddevice("/plb/opb");
	if (node >= 0)
		of_getprop_uint32(node, "clock-frequency", &info->fi_opb_freq);

	/* UART input clock: the first ns16550 in the tree. */
	node = of_find_bycompat(root, "ns16550");
	if (node != -1)
		of_getprop_uint32(node, "clock-frequency", &info->fi_uart_freq);

	/* Per-EMAC MAC addresses. */
	sam460ex_fdt_emac(root);

	/* Kernel command line from /chosen. */
	node = OF_finddevice("/chosen");
	if (node >= 0) {
		len = OF_getprop(node, "bootargs", bootargs_buf,
		    sizeof(bootargs_buf));
		if (len > 1)	/* length includes the terminating NUL */
			info->fi_bootargs = bootargs_buf;
	}

	return true;
}