190075Sobrien/*	$NetBSD: dtbs_equal_ordered.c,v 1.1.1.3 2019/12/22 12:34:06 skrll Exp $	*/
290075Sobrien
390075Sobrien// SPDX-License-Identifier: LGPL-2.1-or-later
490075Sobrien/*
590075Sobrien * libfdt - Flat Device Tree manipulation
690075Sobrien *	Tests if two given dtbs are structurally equal (including order)
790075Sobrien * Copyright (C) 2007 David Gibson, IBM Corporation.
890075Sobrien */
990075Sobrien
1090075Sobrien#include <stdlib.h>
1190075Sobrien#include <stdio.h>
1290075Sobrien#include <string.h>
1390075Sobrien#include <stdint.h>
1490075Sobrien
1590075Sobrien#include <libfdt.h>
1690075Sobrien
1790075Sobrien#include "tests.h"
1890075Sobrien#include "testdata.h"
1990075Sobrien
2090075Sobrienstatic int notequal; /* = 0 */
2190075Sobrien
2290075Sobrien#define MISMATCH(fmt, ...)			\
2390075Sobrien	do { \
2490075Sobrien		if (notequal) \
2590075Sobrien			PASS(); \
2690075Sobrien		else \
2790075Sobrien			FAIL(fmt, ##__VA_ARGS__);	\
2890075Sobrien	} while (0)
2990075Sobrien
3090075Sobrien#define MATCH()			\
3190075Sobrien	do { \
3290075Sobrien		if (!notequal) \
3390075Sobrien			PASS(); \
3490075Sobrien		else \
3590075Sobrien			FAIL("Trees match which shouldn't");	\
3690075Sobrien	} while (0)
3790075Sobrien
3890075Sobrien#define CHECK(code) \
3990075Sobrien	{ \
4090075Sobrien		err = (code); \
4190075Sobrien		if (err) \
4290075Sobrien			FAIL(#code ": %s", fdt_strerror(err)); \
4390075Sobrien	}
4490075Sobrien
4590075Sobrienstatic void compare_mem_rsv(const void *fdt1, const void *fdt2)
4690075Sobrien{
4790075Sobrien	int i;
4890075Sobrien	uint64_t addr1, size1, addr2, size2;
4990075Sobrien	int err;
5090075Sobrien
5190075Sobrien	if (fdt_num_mem_rsv(fdt1) != fdt_num_mem_rsv(fdt2))
5290075Sobrien		MISMATCH("Trees have different number of reserve entries");
5390075Sobrien	for (i = 0; i < fdt_num_mem_rsv(fdt1); i++) {
5490075Sobrien		CHECK(fdt_get_mem_rsv(fdt1, i, &addr1, &size1));
5590075Sobrien		CHECK(fdt_get_mem_rsv(fdt2, i, &addr2, &size2));
5690075Sobrien
5790075Sobrien		if ((addr1 != addr2) || (size1 != size2))
5890075Sobrien			MISMATCH("Mismatch in reserve entry %d: "
5990075Sobrien				 "(0x%llx, 0x%llx) != (0x%llx, 0x%llx)", i,
6090075Sobrien				 (unsigned long long)addr1,
6190075Sobrien				 (unsigned long long)size1,
6290075Sobrien				 (unsigned long long)addr2,
6390075Sobrien				 (unsigned long long)size2);
6490075Sobrien	}
6590075Sobrien}
6690075Sobrien
6790075Sobrienstatic void compare_structure(const void *fdt1, const void *fdt2)
6890075Sobrien{
6990075Sobrien	int nextoffset1 = 0, nextoffset2 = 0;
7090075Sobrien	int offset1, offset2;
7190075Sobrien	uint32_t tag1, tag2;
7290075Sobrien	const char *name1, *name2;
7390075Sobrien	int err;
7490075Sobrien	const struct fdt_property *prop1, *prop2;
7590075Sobrien	int len1, len2;
7690075Sobrien
7790075Sobrien	while (1) {
7890075Sobrien		do {
7990075Sobrien			offset1 = nextoffset1;
8090075Sobrien			tag1 = fdt_next_tag(fdt1, offset1, &nextoffset1);
8190075Sobrien		} while (tag1 == FDT_NOP);
8290075Sobrien		do {
8390075Sobrien			offset2 = nextoffset2;
8490075Sobrien			tag2 = fdt_next_tag(fdt2, offset2, &nextoffset2);
8590075Sobrien		} while (tag2 == FDT_NOP);
8690075Sobrien
8790075Sobrien		if (tag1 != tag2)
8890075Sobrien			MISMATCH("Tag mismatch (%d != %d) at (%d, %d)",
8990075Sobrien			     tag1, tag2, offset1, offset2);
9090075Sobrien
9190075Sobrien		switch (tag1) {
9290075Sobrien		case FDT_BEGIN_NODE:
9390075Sobrien			name1 = fdt_get_name(fdt1, offset1, &err);
9490075Sobrien			if (!name1)
9590075Sobrien				FAIL("fdt_get_name(fdt1, %d, ..): %s",
9690075Sobrien				     offset1, fdt_strerror(err));
9790075Sobrien			name2 = fdt_get_name(fdt2, offset2, NULL);
9890075Sobrien			if (!name2)
9990075Sobrien				FAIL("fdt_get_name(fdt2, %d, ..): %s",
10090075Sobrien				     offset2, fdt_strerror(err));
10190075Sobrien
10290075Sobrien			if (!streq(name1, name2))
10390075Sobrien			    MISMATCH("Name mismatch (\"%s\" != \"%s\") at (%d, %d)",
10490075Sobrien				     name1, name2, offset1, offset2);
10590075Sobrien			break;
10690075Sobrien
10790075Sobrien		case FDT_PROP:
10890075Sobrien			prop1 = fdt_offset_ptr(fdt1, offset1, sizeof(*prop1));
10990075Sobrien			if (!prop1)
11090075Sobrien				FAIL("Could get fdt1 property at %d", offset1);
11190075Sobrien			prop2 = fdt_offset_ptr(fdt2, offset2, sizeof(*prop2));
11290075Sobrien			if (!prop2)
11390075Sobrien				FAIL("Could get fdt2 property at %d", offset2);
11490075Sobrien
11590075Sobrien			name1 = fdt_string(fdt1, fdt32_to_cpu(prop1->nameoff));
11690075Sobrien			name2 = fdt_string(fdt2, fdt32_to_cpu(prop2->nameoff));
11790075Sobrien			if (!streq(name1, name2))
11890075Sobrien				MISMATCH("Property name mismatch \"%s\" != \"%s\" "
11990075Sobrien					 "at (%d, %d)", name1, name2, offset1, offset2);
12090075Sobrien			len1 = fdt32_to_cpu(prop1->len);
12190075Sobrien			len2 = fdt32_to_cpu(prop2->len);
12290075Sobrien			if (len1 != len2)
12390075Sobrien				MISMATCH("Property length mismatch %u != %u "
12490075Sobrien					 "at (%d, %d)", len1, len2, offset1, offset2);
12590075Sobrien
12690075Sobrien			if (memcmp(prop1->data, prop2->data, len1) != 0)
12790075Sobrien				MISMATCH("Property value mismatch at (%d, %d)",
12890075Sobrien					 offset1, offset2);
12990075Sobrien			break;
13090075Sobrien
13190075Sobrien		case FDT_END:
13290075Sobrien			return;
13390075Sobrien		}
13490075Sobrien	}
13590075Sobrien}
13690075Sobrien
13790075Sobrienint main(int argc, char *argv[])
13890075Sobrien{
13990075Sobrien	void *fdt1, *fdt2;
14090075Sobrien	uint32_t cpuid1, cpuid2;
14190075Sobrien
14290075Sobrien	test_init(argc, argv);
14390075Sobrien	if ((argc != 3)
14490075Sobrien	    && ((argc != 4) || !streq(argv[1], "-n")))
14590075Sobrien		CONFIG("Usage: %s [-n] <dtb file> <dtb file>", argv[0]);
14690075Sobrien	if (argc == 4)
14790075Sobrien		notequal = 1;
14890075Sobrien
14990075Sobrien	fdt1 = load_blob(argv[argc-2]);
15090075Sobrien	fdt2 = load_blob(argv[argc-1]);
15190075Sobrien
15290075Sobrien	compare_mem_rsv(fdt1, fdt2);
15390075Sobrien	compare_structure(fdt1, fdt2);
15490075Sobrien
15590075Sobrien	cpuid1 = fdt_boot_cpuid_phys(fdt1);
15690075Sobrien	cpuid2 = fdt_boot_cpuid_phys(fdt2);
15790075Sobrien	if (cpuid1 != cpuid2)
15890075Sobrien		MISMATCH("boot_cpuid_phys mismatch 0x%x != 0x%x",
15990075Sobrien			 cpuid1, cpuid2);
16090075Sobrien
16190075Sobrien	MATCH();
16290075Sobrien}
16390075Sobrien