1 // SPDX-License-Identifier: GPL-2.0+
3 * Copyright (C) 2018 Stefan Roese <sr@denx.de>
8 #include <env_internal.h>
15 #include <spi_flash.h>
16 #include <u-boot/crc.h>
18 #include <linux/ctype.h>
21 #define MT76XX_AGPIO_CFG 0x1000003c
23 #define FACTORY_DATA_OFFS 0xc0000
24 #define FACTORY_DATA_SECT_SIZE 0x10000
25 #if ((CONFIG_ENV_OFFSET_REDUND + CONFIG_ENV_SIZE) > FACTORY_DATA_OFFS)
26 #error "U-Boot image with environment too big (overlapping with factory-data)!"
28 #define FACTORY_DATA_USER_OFFS 0x140
29 #define FACTORY_DATA_SIZE 0x1f0
30 #define FACTORY_DATA_CRC_LEN (FACTORY_DATA_SIZE - \
31 FACTORY_DATA_USER_OFFS - sizeof(u32))
33 #define FACTORY_DATA_MAGIC 0xCAFEBABE
35 struct factory_data_values {
37 u8 wifi_mac[6]; /* offs: 0x004: binary value */
39 u8 eth_mac[6]; /* offs: 0x028: binary value */
40 u8 pad_3[FACTORY_DATA_USER_OFFS - 4 - 6 - 30 - 6];
41 /* User values start here at offset 0x140 */
45 char ipr_id[UUID_STR_LEN]; /* UUID as string w/o ending \0 */
46 char hqv_id[UUID_STR_LEN]; /* UUID as string w/o ending \0 */
47 char unielec_id[UUID_STR_LEN]; /* UUID as string w/o ending \0 */
50 int board_early_init_f(void)
52 void __iomem *gpio_mode;
54 /* Configure digital vs analog GPIOs */
55 gpio_mode = ioremap_nocache(MT76XX_AGPIO_CFG, 0x100);
56 iowrite32(0x00fe01ff, gpio_mode);
61 static bool prepare_uuid_var(const char *fd_ptr, const char *env_var_name,
64 char str[UUID_STR_LEN + 1] = { 0 }; /* Enough for UUID stuff */
65 bool env_updated = false;
69 memcpy(str, fd_ptr, UUID_STR_LEN);
71 /* Convert non-ascii character to 'X' */
72 for (i = 0; i < UUID_STR_LEN; i++) {
73 if (!(isascii(str[i]) && isprint(str[i])))
77 env = env_get(env_var_name);
78 if (strcmp(env, str)) {
79 env_set(env_var_name, str);
86 static void factory_data_env_config(void)
88 struct factory_data_values *fd;
91 char str[UUID_STR_LEN + 1]; /* Enough for UUID stuff */
98 buf = malloc(FACTORY_DATA_SIZE);
100 printf("F-Data:Unable to allocate buffer\n");
105 * Get values from factory-data area in SPI NOR
107 sf = spi_flash_probe(CONFIG_SF_DEFAULT_BUS,
108 CONFIG_SF_DEFAULT_CS,
109 CONFIG_SF_DEFAULT_SPEED,
110 CONFIG_SF_DEFAULT_MODE);
112 printf("F-Data:Unable to access SPI NOR flash\n");
116 ret = spi_flash_read(sf, FACTORY_DATA_OFFS, FACTORY_DATA_SIZE,
119 printf("F-Data:Unable to read factory-data from SPI NOR\n");
123 fd = (struct factory_data_values *)buf;
125 if (fd->magic != FACTORY_DATA_MAGIC)
126 printf("F-Data:Magic value not correct\n");
128 crc = crc32(0, (u8 *)&fd->magic, FACTORY_DATA_CRC_LEN);
130 printf("F-Data:CRC not correct\n");
132 printf("F-Data:factory-data version %x detected\n",
135 /* Handle wifi_mac env variable */
137 sprintf(str, "%pM", ptr);
138 if (!is_valid_ethaddr(ptr))
139 printf("F-Data:Invalid MAC addr: wifi_mac %s\n", str);
141 env = env_get("wifiaddr");
142 if (strcmp(env, str)) {
143 env_set("wifiaddr", str);
147 /* Handle eth_mac env variable */
149 sprintf(str, "%pM", ptr);
150 if (!is_valid_ethaddr(ptr))
151 printf("F-Data:Invalid MAC addr: eth_mac %s\n", str);
153 env = env_get("ethaddr");
154 if (strcmp(env, str)) {
155 env_set("ethaddr", str);
159 /* Handle UUID env variables */
160 env_updated |= prepare_uuid_var(fd->ipr_id, "linuxmoduleid", 'X');
161 env_updated |= prepare_uuid_var(fd->hqv_id, "linuxmodulehqvid", '\0');
162 env_updated |= prepare_uuid_var(fd->unielec_id,
163 "linuxmoduleunielecid", '\0');
165 /* Check if the environment was updated and needs to get stored */
166 if (env_updated != 0) {
167 printf("F-Data:Values don't match env values -> saving\n");
170 debug("F-Data:Values match current env values\n");
180 int board_late_init(void)
182 if (IS_ENABLED(CONFIG_LED))
185 factory_data_env_config();
190 static void copy_or_generate_uuid(char *fd_ptr, const char *env_var_name)
192 char str[UUID_STR_LEN + 1] = { 0 }; /* Enough for UUID stuff */
195 /* Don't use the UUID dest place, as the \0 char won't fit */
196 env = env_get(env_var_name);
198 strncpy(str, env, UUID_STR_LEN);
200 gen_rand_uuid_str(str, UUID_STR_FORMAT_STD);
202 memcpy(fd_ptr, str, UUID_STR_LEN);
206 * Helper function to provide some sane factory-data values for testing
207 * purpose, when these values are not programmed correctly
209 int do_fd_write(cmd_tbl_t *cmdtp, int flag, int argc, char * const argv[])
211 struct factory_data_values *fd;
212 struct spi_flash *sf;
214 int ret = CMD_RET_FAILURE;
216 buf = malloc(FACTORY_DATA_SECT_SIZE);
218 printf("F-Data:Unable to allocate buffer\n");
219 return CMD_RET_FAILURE;
222 sf = spi_flash_probe(CONFIG_SF_DEFAULT_BUS,
223 CONFIG_SF_DEFAULT_CS,
224 CONFIG_SF_DEFAULT_SPEED,
225 CONFIG_SF_DEFAULT_MODE);
227 printf("F-Data:Unable to access SPI NOR flash\n");
231 /* Generate the factory-data struct */
233 /* Fist read complete sector into buffer */
234 ret = spi_flash_read(sf, FACTORY_DATA_OFFS, FACTORY_DATA_SECT_SIZE,
237 printf("F-Data:spi_flash_read failed (%d)\n", ret);
241 fd = (struct factory_data_values *)buf;
242 fd->magic = FACTORY_DATA_MAGIC;
245 /* Use existing MAC and UUID values or generate some random ones */
246 if (!eth_env_get_enetaddr("wifiaddr", fd->wifi_mac)) {
247 net_random_ethaddr(fd->wifi_mac);
248 /* to get a different seed value for the MAC address */
252 if (!eth_env_get_enetaddr("ethaddr", fd->eth_mac))
253 net_random_ethaddr(fd->eth_mac);
255 copy_or_generate_uuid(fd->ipr_id, "linuxmoduleid");
256 copy_or_generate_uuid(fd->hqv_id, "linuxmodulehqvid");
257 copy_or_generate_uuid(fd->unielec_id, "linuxmoduleunielecid");
259 printf("New factory-data values:\n");
260 printf("wifiaddr=%pM\n", fd->wifi_mac);
261 printf("ethaddr=%pM\n", fd->eth_mac);
264 * We don't have the \0 char at the end, so we need to specify the
265 * length in the printf format instead
267 printf("linuxmoduleid=%." __stringify(UUID_STR_LEN) "s\n", fd->ipr_id);
268 printf("linuxmodulehqvid=%." __stringify(UUID_STR_LEN) "s\n",
270 printf("linuxmoduleunielecid=%." __stringify(UUID_STR_LEN) "s\n",
273 fd->crc = crc32(0, (u8 *)&fd->magic, FACTORY_DATA_CRC_LEN);
275 ret = spi_flash_erase(sf, FACTORY_DATA_OFFS, FACTORY_DATA_SECT_SIZE);
277 printf("F-Data:spi_flash_erase failed (%d)\n", ret);
281 ret = spi_flash_write(sf, FACTORY_DATA_OFFS, FACTORY_DATA_SECT_SIZE,
284 printf("F-Data:spi_flash_write failed (%d)\n", ret);
288 printf("F-Data:factory-data values written to SPI NOR flash\n");
299 #ifndef CONFIG_SPL_BUILD
301 fd_write, 1, 0, do_fd_write,
302 "Write test factory-data values to SPI NOR",