1// SPDX-License-Identifier: GPL-2.0-only
2/*
3 * PlanetCore configuration data support functions
4 *
5 * Author: Scott Wood <scottwood@freescale.com>
6 *
7 * Copyright (c) 2007 Freescale Semiconductor, Inc.
8 */
9
10#include "stdio.h"
11#include "stdlib.h"
12#include "ops.h"
13#include "planetcore.h"
14#include "io.h"
15
16/* PlanetCore passes information to the OS in the form of
17 * a table of key=value strings, separated by newlines.
18 *
19 * The list is terminated by an empty string (i.e. two
20 * consecutive newlines).
21 *
22 * To make it easier to parse, we first convert all the
23 * newlines into null bytes.
24 */
25
26void planetcore_prepare_table(char *table)
27{
28	do {
29		if (*table == '\n')
30			*table = 0;
31
32		table++;
33	} while (*(table - 1) || *table != '\n');
34
35	*table = 0;
36}
37
38const char *planetcore_get_key(const char *table, const char *key)
39{
40	int keylen = strlen(key);
41
42	do {
43		if (!strncmp(table, key, keylen) && table[keylen] == '=')
44			return table + keylen + 1;
45
46		table += strlen(table) + 1;
47	} while (strlen(table) != 0);
48
49	return NULL;
50}
51
52int planetcore_get_decimal(const char *table, const char *key, u64 *val)
53{
54	const char *str = planetcore_get_key(table, key);
55	if (!str)
56		return 0;
57
58	*val = strtoull(str, NULL, 10);
59	return 1;
60}
61
62int planetcore_get_hex(const char *table, const char *key, u64 *val)
63{
64	const char *str = planetcore_get_key(table, key);
65	if (!str)
66		return 0;
67
68	*val = strtoull(str, NULL, 16);
69	return 1;
70}
71
72static u64 mac_table[4] = {
73	0x000000000000,
74	0x000000800000,
75	0x000000400000,
76	0x000000c00000,
77};
78
79void planetcore_set_mac_addrs(const char *table)
80{
81	u8 addr[4][6];
82	u64 int_addr;
83	u32 i;
84	int j;
85
86	if (!planetcore_get_hex(table, PLANETCORE_KEY_MAC_ADDR, &int_addr))
87		return;
88
89	for (i = 0; i < 4; i++) {
90		u64 this_dev_addr = (int_addr & ~0x000000c00000) |
91		                    mac_table[i];
92
93		for (j = 5; j >= 0; j--) {
94			addr[i][j] = this_dev_addr & 0xff;
95			this_dev_addr >>= 8;
96		}
97
98		dt_fixup_mac_address(i, addr[i]);
99	}
100}
101
102static char prop_buf[MAX_PROP_LEN];
103
104void planetcore_set_stdout_path(const char *table)
105{
106	char *path;
107	const char *label;
108	void *node, *chosen;
109
110	label = planetcore_get_key(table, PLANETCORE_KEY_SERIAL_PORT);
111	if (!label)
112		return;
113
114	node = find_node_by_prop_value_str(NULL, "linux,planetcore-label",
115	                                   label);
116	if (!node)
117		return;
118
119	path = get_path(node, prop_buf, MAX_PROP_LEN);
120	if (!path)
121		return;
122
123	chosen = finddevice("/chosen");
124	if (!chosen)
125		chosen = create_node(NULL, "chosen");
126	if (!chosen)
127		return;
128
129	setprop_str(chosen, "linux,stdout-path", path);
130}
131