mirror of
https://source.denx.de/u-boot/u-boot.git
synced 2025-09-29 17:51:26 +02:00
- cmd: tlv_eeprom: Misc cleanups & improvements (Josua)
This commit is contained in:
commit
fbfe7fb5ae
107
cmd/tlv_eeprom.c
107
cmd/tlv_eeprom.c
@ -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;
|
||||||
}
|
}
|
||||||
|
@ -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
|
||||||
|
Loading…
x
Reference in New Issue
Block a user