123456789101112131415161718192021222324252627282930313233343536373839404142434445464748495051525354555657585960616263646566676869707172737475767778798081828384858687888990919293949596979899100101102103104105106107108109110111112113114115116117118119120121122123124125126127128129130131132133134135136137138139140141142143144145146147148149150151152153154155156157158159160161162163164165166167168169170171172173174175176177178179180181182183184185186187188189190191192193194195196197198199200201202203204205206207208209210211212213214215216217218219220221222223224225226227228229230231232233234235236237238239240241242243244245246247248249250251252253254255256257258259260261262263264265266267268269270271272273274275276277278279280281282283284285286287288289290291292293294295296297298299300301302303304305 |
- // SPDX-License-Identifier: GPL-2.0+
- /*
- * Copyright (C) 2018 Stefan Roese <sr@denx.de>
- */
- #include <common.h>
- #include <env.h>
- #include <env_internal.h>
- #include <flash.h>
- #include <init.h>
- #include <led.h>
- #include <malloc.h>
- #include <net.h>
- #include <spi.h>
- #include <spi_flash.h>
- #include <u-boot/crc.h>
- #include <uuid.h>
- #include <linux/ctype.h>
- #include <linux/io.h>
- #define MT76XX_AGPIO_CFG 0x1000003c
- #define FACTORY_DATA_OFFS 0xc0000
- #define FACTORY_DATA_SECT_SIZE 0x10000
- #if ((CONFIG_ENV_OFFSET_REDUND + CONFIG_ENV_SIZE) > FACTORY_DATA_OFFS)
- #error "U-Boot image with environment too big (overlapping with factory-data)!"
- #endif
- #define FACTORY_DATA_USER_OFFS 0x140
- #define FACTORY_DATA_SIZE 0x1f0
- #define FACTORY_DATA_CRC_LEN (FACTORY_DATA_SIZE - \
- FACTORY_DATA_USER_OFFS - sizeof(u32))
- #define FACTORY_DATA_MAGIC 0xCAFEBABE
- struct factory_data_values {
- u8 pad_1[4];
- u8 wifi_mac[6]; /* offs: 0x004: binary value */
- u8 pad_2[30];
- u8 eth_mac[6]; /* offs: 0x028: binary value */
- u8 pad_3[FACTORY_DATA_USER_OFFS - 4 - 6 - 30 - 6];
- /* User values start here at offset 0x140 */
- u32 crc;
- u32 magic;
- u32 version;
- char ipr_id[UUID_STR_LEN]; /* UUID as string w/o ending \0 */
- char hqv_id[UUID_STR_LEN]; /* UUID as string w/o ending \0 */
- char unielec_id[UUID_STR_LEN]; /* UUID as string w/o ending \0 */
- };
- int board_early_init_f(void)
- {
- void __iomem *gpio_mode;
- /* Configure digital vs analog GPIOs */
- gpio_mode = ioremap_nocache(MT76XX_AGPIO_CFG, 0x100);
- iowrite32(0x00fe01ff, gpio_mode);
- return 0;
- }
- static bool prepare_uuid_var(const char *fd_ptr, const char *env_var_name,
- char errorchar)
- {
- char str[UUID_STR_LEN + 1] = { 0 }; /* Enough for UUID stuff */
- bool env_updated = false;
- char *env;
- int i;
- memcpy(str, fd_ptr, UUID_STR_LEN);
- /* Convert non-ascii character to 'X' */
- for (i = 0; i < UUID_STR_LEN; i++) {
- if (!(isascii(str[i]) && isprint(str[i])))
- str[i] = errorchar;
- }
- env = env_get(env_var_name);
- if (strcmp(env, str)) {
- env_set(env_var_name, str);
- env_updated = true;
- }
- return env_updated;
- }
- static void factory_data_env_config(void)
- {
- struct factory_data_values *fd;
- struct spi_flash *sf;
- int env_updated = 0;
- char str[UUID_STR_LEN + 1]; /* Enough for UUID stuff */
- char *env;
- u8 *buf;
- u32 crc;
- int ret;
- u8 *ptr;
- buf = malloc(FACTORY_DATA_SIZE);
- if (!buf) {
- printf("F-Data:Unable to allocate buffer\n");
- return;
- }
- /*
- * Get values from factory-data area in SPI NOR
- */
- sf = spi_flash_probe(CONFIG_SF_DEFAULT_BUS,
- CONFIG_SF_DEFAULT_CS,
- CONFIG_SF_DEFAULT_SPEED,
- CONFIG_SF_DEFAULT_MODE);
- if (!sf) {
- printf("F-Data:Unable to access SPI NOR flash\n");
- goto err_free;
- }
- ret = spi_flash_read(sf, FACTORY_DATA_OFFS, FACTORY_DATA_SIZE,
- (void *)buf);
- if (ret) {
- printf("F-Data:Unable to read factory-data from SPI NOR\n");
- goto err_spi_flash;
- }
- fd = (struct factory_data_values *)buf;
- if (fd->magic != FACTORY_DATA_MAGIC)
- printf("F-Data:Magic value not correct\n");
- crc = crc32(0, (u8 *)&fd->magic, FACTORY_DATA_CRC_LEN);
- if (crc != fd->crc)
- printf("F-Data:CRC not correct\n");
- else
- printf("F-Data:factory-data version %x detected\n",
- fd->version);
- /* Handle wifi_mac env variable */
- ptr = fd->wifi_mac;
- sprintf(str, "%pM", ptr);
- if (!is_valid_ethaddr(ptr))
- printf("F-Data:Invalid MAC addr: wifi_mac %s\n", str);
- env = env_get("wifiaddr");
- if (strcmp(env, str)) {
- env_set("wifiaddr", str);
- env_updated = 1;
- }
- /* Handle eth_mac env variable */
- ptr = fd->eth_mac;
- sprintf(str, "%pM", ptr);
- if (!is_valid_ethaddr(ptr))
- printf("F-Data:Invalid MAC addr: eth_mac %s\n", str);
- env = env_get("ethaddr");
- if (strcmp(env, str)) {
- env_set("ethaddr", str);
- env_updated = 1;
- }
- /* Handle UUID env variables */
- env_updated |= prepare_uuid_var(fd->ipr_id, "linuxmoduleid", 'X');
- env_updated |= prepare_uuid_var(fd->hqv_id, "linuxmodulehqvid", '\0');
- env_updated |= prepare_uuid_var(fd->unielec_id,
- "linuxmoduleunielecid", '\0');
- /* Check if the environment was updated and needs to get stored */
- if (env_updated != 0) {
- printf("F-Data:Values don't match env values -> saving\n");
- env_save();
- } else {
- debug("F-Data:Values match current env values\n");
- }
- err_spi_flash:
- spi_flash_free(sf);
- err_free:
- free(buf);
- }
- int board_late_init(void)
- {
- if (IS_ENABLED(CONFIG_LED))
- led_default_state();
- factory_data_env_config();
- return 0;
- }
- static void copy_or_generate_uuid(char *fd_ptr, const char *env_var_name)
- {
- char str[UUID_STR_LEN + 1] = { 0 }; /* Enough for UUID stuff */
- char *env;
- /* Don't use the UUID dest place, as the \0 char won't fit */
- env = env_get(env_var_name);
- if (env)
- strncpy(str, env, UUID_STR_LEN);
- else
- gen_rand_uuid_str(str, UUID_STR_FORMAT_STD);
- memcpy(fd_ptr, str, UUID_STR_LEN);
- }
- /*
- * Helper function to provide some sane factory-data values for testing
- * purpose, when these values are not programmed correctly
- */
- int do_fd_write(cmd_tbl_t *cmdtp, int flag, int argc, char * const argv[])
- {
- struct factory_data_values *fd;
- struct spi_flash *sf;
- u8 *buf;
- int ret = CMD_RET_FAILURE;
- buf = malloc(FACTORY_DATA_SECT_SIZE);
- if (!buf) {
- printf("F-Data:Unable to allocate buffer\n");
- return CMD_RET_FAILURE;
- }
- sf = spi_flash_probe(CONFIG_SF_DEFAULT_BUS,
- CONFIG_SF_DEFAULT_CS,
- CONFIG_SF_DEFAULT_SPEED,
- CONFIG_SF_DEFAULT_MODE);
- if (!sf) {
- printf("F-Data:Unable to access SPI NOR flash\n");
- goto err_free;
- }
- /* Generate the factory-data struct */
- /* Fist read complete sector into buffer */
- ret = spi_flash_read(sf, FACTORY_DATA_OFFS, FACTORY_DATA_SECT_SIZE,
- (void *)buf);
- if (ret) {
- printf("F-Data:spi_flash_read failed (%d)\n", ret);
- goto err_spi_flash;
- }
- fd = (struct factory_data_values *)buf;
- fd->magic = FACTORY_DATA_MAGIC;
- fd->version = 0x1;
- /* Use existing MAC and UUID values or generate some random ones */
- if (!eth_env_get_enetaddr("wifiaddr", fd->wifi_mac)) {
- net_random_ethaddr(fd->wifi_mac);
- /* to get a different seed value for the MAC address */
- mdelay(10);
- }
- if (!eth_env_get_enetaddr("ethaddr", fd->eth_mac))
- net_random_ethaddr(fd->eth_mac);
- copy_or_generate_uuid(fd->ipr_id, "linuxmoduleid");
- copy_or_generate_uuid(fd->hqv_id, "linuxmodulehqvid");
- copy_or_generate_uuid(fd->unielec_id, "linuxmoduleunielecid");
- printf("New factory-data values:\n");
- printf("wifiaddr=%pM\n", fd->wifi_mac);
- printf("ethaddr=%pM\n", fd->eth_mac);
- /*
- * We don't have the \0 char at the end, so we need to specify the
- * length in the printf format instead
- */
- printf("linuxmoduleid=%." __stringify(UUID_STR_LEN) "s\n", fd->ipr_id);
- printf("linuxmodulehqvid=%." __stringify(UUID_STR_LEN) "s\n",
- fd->hqv_id);
- printf("linuxmoduleunielecid=%." __stringify(UUID_STR_LEN) "s\n",
- fd->unielec_id);
- fd->crc = crc32(0, (u8 *)&fd->magic, FACTORY_DATA_CRC_LEN);
- ret = spi_flash_erase(sf, FACTORY_DATA_OFFS, FACTORY_DATA_SECT_SIZE);
- if (ret) {
- printf("F-Data:spi_flash_erase failed (%d)\n", ret);
- goto err_spi_flash;
- }
- ret = spi_flash_write(sf, FACTORY_DATA_OFFS, FACTORY_DATA_SECT_SIZE,
- buf);
- if (ret) {
- printf("F-Data:spi_flash_write failed (%d)\n", ret);
- goto err_spi_flash;
- }
- printf("F-Data:factory-data values written to SPI NOR flash\n");
- err_spi_flash:
- spi_flash_free(sf);
- err_free:
- free(buf);
- return ret;
- }
- #ifndef CONFIG_SPL_BUILD
- U_BOOT_CMD(
- fd_write, 1, 0, do_fd_write,
- "Write test factory-data values to SPI NOR",
- "\n"
- );
- #endif
|