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 
planetcore_prepare_table(char * table)26 void 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 
planetcore_get_key(const char * table,const char * key)38 const 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 
planetcore_get_decimal(const char * table,const char * key,u64 * val)52 int 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 
planetcore_get_hex(const char * table,const char * key,u64 * val)62 int 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 
72 static u64 mac_table[4] = {
73 	0x000000000000,
74 	0x000000800000,
75 	0x000000400000,
76 	0x000000c00000,
77 };
78 
planetcore_set_mac_addrs(const char * table)79 void 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 
102 static char prop_buf[MAX_PROP_LEN];
103 
planetcore_set_stdout_path(const char * table)104 void 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