- cmd: tlv_eeprom: Misc cleanups & improvements (Josua)
This commit is contained in:
Tom Rini 2023-05-08 09:10:39 -04:00
commit fbfe7fb5ae
2 changed files with 64 additions and 46 deletions

View File

@ -29,26 +29,23 @@ DECLARE_GLOBAL_DATA_PTR;
/* File scope function prototypes */ /* File scope function prototypes */
static bool is_checksum_valid(u8 *eeprom); static bool is_checksum_valid(u8 *eeprom);
static int read_eeprom(u8 *eeprom); static int read_eeprom(int devnum, u8 *eeprom);
static void show_eeprom(u8 *eeprom); static void show_eeprom(int devnum, u8 *eeprom);
static void decode_tlv(struct tlvinfo_tlv *tlv); static void decode_tlv(struct tlvinfo_tlv *tlv);
static void update_crc(u8 *eeprom); static void update_crc(u8 *eeprom);
static int prog_eeprom(u8 *eeprom); static int prog_eeprom(int devnum, u8 *eeprom);
static bool tlvinfo_find_tlv(u8 *eeprom, u8 tcode, int *eeprom_index); static bool tlvinfo_find_tlv(u8 *eeprom, u8 tcode, int *eeprom_index);
static bool tlvinfo_delete_tlv(u8 *eeprom, u8 code); static bool tlvinfo_delete_tlv(u8 *eeprom, u8 code);
static bool tlvinfo_add_tlv(u8 *eeprom, int tcode, char *strval); static bool tlvinfo_add_tlv(u8 *eeprom, int tcode, char *strval);
static int set_mac(char *buf, const char *string); static int set_mac(char *buf, const char *string);
static int set_date(char *buf, const char *string); static int set_date(char *buf, const char *string);
static int set_bytes(char *buf, const char *string, int *converted_accum); static int set_bytes(char *buf, const char *string, int *converted_accum);
static void show_tlv_devices(void); static void show_tlv_devices(int current_dev);
/* Set to 1 if we've read EEPROM into memory */
static int has_been_read;
/* The EERPOM contents after being read into memory */ /* The EERPOM contents after being read into memory */
static u8 eeprom[TLV_INFO_MAX_LEN]; static u8 eeprom[TLV_INFO_MAX_LEN];
static struct udevice *tlv_devices[MAX_TLV_DEVICES]; static struct udevice *tlv_devices[MAX_TLV_DEVICES];
static unsigned int current_dev;
#define to_header(p) ((struct tlvinfo_header *)p) #define to_header(p) ((struct tlvinfo_header *)p)
#define to_entry(p) ((struct tlvinfo_tlv *)p) #define to_entry(p) ((struct tlvinfo_tlv *)p)
@ -125,22 +122,20 @@ static bool is_checksum_valid(u8 *eeprom)
* *
* Read the EEPROM into memory, if it hasn't already been read. * Read the EEPROM into memory, if it hasn't already been read.
*/ */
static int read_eeprom(u8 *eeprom) static int read_eeprom(int devnum, u8 *eeprom)
{ {
int ret; int ret;
struct tlvinfo_header *eeprom_hdr = to_header(eeprom); struct tlvinfo_header *eeprom_hdr = to_header(eeprom);
struct tlvinfo_tlv *eeprom_tlv = to_entry(&eeprom[HDR_SIZE]); struct tlvinfo_tlv *eeprom_tlv = to_entry(&eeprom[HDR_SIZE]);
if (has_been_read)
return 0;
/* Read the header */ /* Read the header */
ret = read_tlv_eeprom((void *)eeprom_hdr, 0, HDR_SIZE, current_dev); ret = read_tlv_eeprom((void *)eeprom_hdr, 0, HDR_SIZE, devnum);
/* If the header was successfully read, read the TLVs */ /* If the header was successfully read, read the TLVs */
if (ret == 0 && is_valid_tlvinfo_header(eeprom_hdr)) if (ret == 0 && is_valid_tlvinfo_header(eeprom_hdr))
ret = read_tlv_eeprom((void *)eeprom_tlv, HDR_SIZE, ret = read_tlv_eeprom((void *)eeprom_tlv, HDR_SIZE,
be16_to_cpu(eeprom_hdr->totallen), be16_to_cpu(eeprom_hdr->totallen), devnum);
current_dev); else if (ret == -ENODEV)
return ret;
// If the contents are invalid, start over with default contents // If the contents are invalid, start over with default contents
if (!is_valid_tlvinfo_header(eeprom_hdr) || if (!is_valid_tlvinfo_header(eeprom_hdr) ||
@ -151,10 +146,8 @@ static int read_eeprom(u8 *eeprom)
update_crc(eeprom); update_crc(eeprom);
} }
has_been_read = 1;
#ifdef DEBUG #ifdef DEBUG
show_eeprom(eeprom); show_eeprom(devnum, eeprom);
#endif #endif
return ret; return ret;
@ -165,7 +158,7 @@ static int read_eeprom(u8 *eeprom)
* *
* Display the contents of the EEPROM * Display the contents of the EEPROM
*/ */
static void show_eeprom(u8 *eeprom) static void show_eeprom(int devnum, u8 *eeprom)
{ {
int tlv_end; int tlv_end;
int curr_tlv; int curr_tlv;
@ -180,7 +173,7 @@ static void show_eeprom(u8 *eeprom)
return; return;
} }
printf("TLV: %u\n", current_dev); printf("TLV: %u\n", devnum);
printf("TlvInfo Header:\n"); printf("TlvInfo Header:\n");
printf(" Id String: %s\n", eeprom_hdr->signature); printf(" Id String: %s\n", eeprom_hdr->signature);
printf(" Version: %d\n", eeprom_hdr->version); printf(" Version: %d\n", eeprom_hdr->version);
@ -389,7 +382,7 @@ static void update_crc(u8 *eeprom)
* *
* Write the EEPROM data from CPU memory to the hardware. * Write the EEPROM data from CPU memory to the hardware.
*/ */
static int prog_eeprom(u8 *eeprom) static int prog_eeprom(int devnum, u8 *eeprom)
{ {
int ret = 0; int ret = 0;
struct tlvinfo_header *eeprom_hdr = to_header(eeprom); struct tlvinfo_header *eeprom_hdr = to_header(eeprom);
@ -398,7 +391,7 @@ static int prog_eeprom(u8 *eeprom)
update_crc(eeprom); update_crc(eeprom);
eeprom_len = HDR_SIZE + be16_to_cpu(eeprom_hdr->totallen); eeprom_len = HDR_SIZE + be16_to_cpu(eeprom_hdr->totallen);
ret = write_tlv_eeprom(eeprom, eeprom_len); ret = write_tlv_eeprom(eeprom, eeprom_len, devnum);
if (ret) { if (ret) {
printf("Programming failed.\n"); printf("Programming failed.\n");
return -1; return -1;
@ -433,11 +426,23 @@ int do_tlv_eeprom(struct cmd_tbl *cmdtp, int flag, int argc, char *const argv[])
{ {
char cmd; char cmd;
struct tlvinfo_header *eeprom_hdr = to_header(eeprom); struct tlvinfo_header *eeprom_hdr = to_header(eeprom);
static unsigned int current_dev;
/* Set to 1 if we've read EEPROM into memory */
static int has_been_read;
int ret;
// If no arguments, read the EERPOM and display its contents // If no arguments, read the EERPOM and display its contents
if (argc == 1) { if (argc == 1) {
read_eeprom(eeprom); if (!has_been_read) {
show_eeprom(eeprom); ret = read_eeprom(current_dev, eeprom);
if (ret) {
printf("Failed to read EEPROM data from device.\n");
return 0;
}
has_been_read = 1;
}
show_eeprom(current_dev, eeprom);
return 0; return 0;
} }
@ -445,12 +450,33 @@ int do_tlv_eeprom(struct cmd_tbl *cmdtp, int flag, int argc, char *const argv[])
// "reset" will both be treated as "read". // "reset" will both be treated as "read".
cmd = argv[1][0]; cmd = argv[1][0];
// select device
if (cmd == 'd') {
/* 'dev' command */
unsigned int devnum;
devnum = simple_strtoul(argv[2], NULL, 0);
if (devnum >= MAX_TLV_DEVICES) {
printf("Invalid device number\n");
return 0;
}
current_dev = devnum;
has_been_read = 0;
return 0;
}
// Read the EEPROM contents // Read the EEPROM contents
if (cmd == 'r') { if (cmd == 'r') {
has_been_read = 0; has_been_read = 0;
if (!read_eeprom(eeprom)) ret = read_eeprom(current_dev, eeprom);
printf("EEPROM data loaded from device to memory.\n"); if (ret) {
return 0; printf("Failed to read EEPROM data from device.\n");
return 0;
}
printf("EEPROM data loaded from device to memory.\n");
has_been_read = 1;
} }
// Subsequent commands require that the EEPROM has already been read. // Subsequent commands require that the EEPROM has already been read.
@ -463,7 +489,7 @@ int do_tlv_eeprom(struct cmd_tbl *cmdtp, int flag, int argc, char *const argv[])
if (argc == 2) { if (argc == 2) {
switch (cmd) { switch (cmd) {
case 'w': /* write */ case 'w': /* write */
prog_eeprom(eeprom); prog_eeprom(current_dev, eeprom);
break; break;
case 'e': /* erase */ case 'e': /* erase */
strcpy(eeprom_hdr->signature, TLV_INFO_ID_STRING); strcpy(eeprom_hdr->signature, TLV_INFO_ID_STRING);
@ -476,7 +502,7 @@ int do_tlv_eeprom(struct cmd_tbl *cmdtp, int flag, int argc, char *const argv[])
show_tlv_code_list(); show_tlv_code_list();
break; break;
case 'd': /* dev */ case 'd': /* dev */
show_tlv_devices(); show_tlv_devices(current_dev);
break; break;
default: default:
return CMD_RET_USAGE; return CMD_RET_USAGE;
@ -498,16 +524,6 @@ int do_tlv_eeprom(struct cmd_tbl *cmdtp, int flag, int argc, char *const argv[])
tlvinfo_delete_tlv(eeprom, tcode); tlvinfo_delete_tlv(eeprom, tcode);
if (argc == 4) if (argc == 4)
tlvinfo_add_tlv(eeprom, tcode, argv[3]); tlvinfo_add_tlv(eeprom, tcode, argv[3]);
} else if (cmd == 'd') { /* 'dev' command */
unsigned int devnum;
devnum = simple_strtoul(argv[2], NULL, 0);
if (devnum > MAX_TLV_DEVICES || !tlv_devices[devnum]) {
printf("Invalid device number\n");
return 0;
}
current_dev = devnum;
has_been_read = 0;
} else { } else {
return CMD_RET_USAGE; return CMD_RET_USAGE;
} }
@ -883,7 +899,7 @@ static int set_bytes(char *buf, const char *string, int *converted_accum)
return 0; return 0;
} }
static void show_tlv_devices(void) static void show_tlv_devices(int current_dev)
{ {
unsigned int dev; unsigned int dev;
@ -953,14 +969,14 @@ int read_tlv_eeprom(void *eeprom, int offset, int len, int dev_num)
/** /**
* write_tlv_eeprom - write the hwinfo to i2c EEPROM * write_tlv_eeprom - write the hwinfo to i2c EEPROM
*/ */
int write_tlv_eeprom(void *eeprom, int len) int write_tlv_eeprom(void *eeprom, int len, int dev)
{ {
if (!(gd->flags & GD_FLG_RELOC)) if (!(gd->flags & GD_FLG_RELOC))
return -ENODEV; return -ENODEV;
if (!tlv_devices[current_dev]) if (!tlv_devices[dev])
return -ENODEV; return -ENODEV;
return i2c_eeprom_write(tlv_devices[current_dev], 0, eeprom, len); return i2c_eeprom_write(tlv_devices[dev], 0, eeprom, len);
} }
int read_tlvinfo_tlv_eeprom(void *eeprom, struct tlvinfo_header **hdr, int read_tlvinfo_tlv_eeprom(void *eeprom, struct tlvinfo_header **hdr,
@ -1015,10 +1031,11 @@ int mac_read_from_eeprom(void)
int maccount; int maccount;
u8 macbase[6]; u8 macbase[6];
struct tlvinfo_header *eeprom_hdr = to_header(eeprom); struct tlvinfo_header *eeprom_hdr = to_header(eeprom);
int devnum = 0; // TODO: support multiple EEPROMs
puts("EEPROM: "); puts("EEPROM: ");
if (read_eeprom(eeprom)) { if (read_eeprom(devnum, eeprom)) {
printf("Read failed.\n"); printf("Read failed.\n");
return -1; return -1;
} }
@ -1083,7 +1100,7 @@ int mac_read_from_eeprom(void)
* *
* This function must be called after relocation. * This function must be called after relocation.
*/ */
int populate_serial_number(void) int populate_serial_number(int devnum)
{ {
char serialstr[257]; char serialstr[257];
int eeprom_index; int eeprom_index;
@ -1092,7 +1109,7 @@ int populate_serial_number(void)
if (env_get("serial#")) if (env_get("serial#"))
return 0; return 0;
if (read_eeprom(eeprom)) { if (read_eeprom(devnum, eeprom)) {
printf("Read failed.\n"); printf("Read failed.\n");
return -1; return -1;
} }

View File

@ -84,11 +84,12 @@ int read_tlv_eeprom(void *eeprom, int offset, int len, int dev);
* write_tlv_eeprom - Write the entire EEPROM binary data to the hardware * write_tlv_eeprom - Write the entire EEPROM binary data to the hardware
* @eeprom: Pointer to buffer to hold the binary data * @eeprom: Pointer to buffer to hold the binary data
* @len : Maximum size of buffer * @len : Maximum size of buffer
* @dev : EEPROM device to write
* *
* Note: this routine does not validate the EEPROM data. * Note: this routine does not validate the EEPROM data.
* *
*/ */
int write_tlv_eeprom(void *eeprom, int len); int write_tlv_eeprom(void *eeprom, int len, int dev);
/** /**
* read_tlvinfo_tlv_eeprom - Read the TLV from EEPROM, and validate * read_tlvinfo_tlv_eeprom - Read the TLV from EEPROM, and validate