123456789101112131415161718192021222324252627282930313233343536373839404142434445464748495051525354555657585960616263646566676869707172737475767778798081828384858687888990919293949596979899100101102103104105106107108109110111112113114115116117118119120121122123124125126127128129130131132133134135136137138139140141142143144145146147148149150151152153154155156157158159160161162163164165166167168169170171172173174175176177178179180181182183184185186187188189190191192193194195196197198199200201202203204205206207208209210211212213214215216217218219220221222223224225226227228229230231232233234235236237238239240241242243244245246247248249250251252253254255256257258259260261262263264265266267268269270271272273274275276277278279280281282283284285286287288289290291292293294295296297298299300301302303304305306307308309310311312313314315316317318319320321322323324325326327328329330331332333334335336337338339340341342343344345346347348349350351352353354355356357358359360361362363364365366367368369370371372373374375376377378379380381382383384385386387388389390391392393394395396397398399400401402403404405406407408409410411412413414415416417418419420421422423424425426427428429430431432433434435436437438439440441442443444445446447448449450 |
- #include <common.h>
- #include <config.h>
- #include <command.h>
- #include <i2c.h>
- #include <eeprom_layout.h>
- #ifndef CONFIG_SYS_I2C_SPEED
- #define CONFIG_SYS_I2C_SPEED 50000
- #endif
- #ifndef CONFIG_SYS_EEPROM_PAGE_WRITE_DELAY_MS
- #define CONFIG_SYS_EEPROM_PAGE_WRITE_DELAY_MS 0
- #endif
- #ifndef CONFIG_SYS_EEPROM_PAGE_WRITE_BITS
- #define CONFIG_SYS_EEPROM_PAGE_WRITE_BITS 8
- #endif
- #ifndef I2C_RXTX_LEN
- #define I2C_RXTX_LEN 128
- #endif
- #define EEPROM_PAGE_SIZE (1 << CONFIG_SYS_EEPROM_PAGE_WRITE_BITS)
- #define EEPROM_PAGE_OFFSET(x) ((x) & (EEPROM_PAGE_SIZE - 1))
- #if !defined(CONFIG_SPI) || defined(CONFIG_ENV_EEPROM_IS_ON_I2C)
- #if !defined(CONFIG_SYS_I2C_EEPROM_ADDR_LEN) || \
- (CONFIG_SYS_I2C_EEPROM_ADDR_LEN < 1) || \
- (CONFIG_SYS_I2C_EEPROM_ADDR_LEN > 2)
- #error CONFIG_SYS_I2C_EEPROM_ADDR_LEN must be 1 or 2
- #endif
- #endif
- __weak int eeprom_write_enable(unsigned dev_addr, int state)
- {
- return 0;
- }
- void eeprom_init(int bus)
- {
-
- #if defined(CONFIG_SPI) && !defined(CONFIG_ENV_EEPROM_IS_ON_I2C)
- spi_init_f();
- #endif
-
- #if defined(CONFIG_HARD_I2C) || defined(CONFIG_SYS_I2C)
- #if defined(CONFIG_SYS_I2C)
- if (bus >= 0)
- i2c_set_bus_num(bus);
- #endif
- i2c_init(CONFIG_SYS_I2C_SPEED, CONFIG_SYS_I2C_SLAVE);
- #endif
- }
- static int eeprom_addr(unsigned dev_addr, unsigned offset, uchar *addr)
- {
- unsigned blk_off;
- int alen;
- blk_off = offset & 0xff;
- #if CONFIG_SYS_I2C_EEPROM_ADDR_LEN == 1
- addr[0] = offset >> 8;
- addr[1] = blk_off;
- alen = 2;
- #else
- addr[0] = offset >> 16;
- addr[1] = offset >> 8;
- addr[2] = blk_off;
- alen = 3;
- #endif
- addr[0] |= dev_addr;
- return alen;
- }
- static int eeprom_len(unsigned offset, unsigned end)
- {
- unsigned len = end - offset;
-
- #if !defined(CONFIG_SYS_I2C_FRAM)
- unsigned blk_off = offset & 0xff;
- unsigned maxlen = EEPROM_PAGE_SIZE - EEPROM_PAGE_OFFSET(blk_off);
- if (maxlen > I2C_RXTX_LEN)
- maxlen = I2C_RXTX_LEN;
- if (len > maxlen)
- len = maxlen;
- #endif
- return len;
- }
- static int eeprom_rw_block(unsigned offset, uchar *addr, unsigned alen,
- uchar *buffer, unsigned len, bool read)
- {
- int ret = 0;
-
- #if defined(CONFIG_SPI) && !defined(CONFIG_ENV_EEPROM_IS_ON_I2C)
- if (read)
- spi_read(addr, alen, buffer, len);
- else
- spi_write(addr, alen, buffer, len);
- #else
- #if defined(CONFIG_SYS_I2C_EEPROM_BUS)
- i2c_set_bus_num(CONFIG_SYS_I2C_EEPROM_BUS);
- #endif
- if (read)
- ret = i2c_read(addr[0], offset, alen - 1, buffer, len);
- else
- ret = i2c_write(addr[0], offset, alen - 1, buffer, len);
- if (ret)
- ret = 1;
- #endif
- return ret;
- }
- static int eeprom_rw(unsigned dev_addr, unsigned offset, uchar *buffer,
- unsigned cnt, bool read)
- {
- unsigned end = offset + cnt;
- unsigned alen, len;
- int rcode = 0;
- uchar addr[3];
- while (offset < end) {
- alen = eeprom_addr(dev_addr, offset, addr);
- len = eeprom_len(offset, end);
- rcode = eeprom_rw_block(offset, addr, alen, buffer, len, read);
- buffer += len;
- offset += len;
- if (!read)
- udelay(CONFIG_SYS_EEPROM_PAGE_WRITE_DELAY_MS * 1000);
- }
- return rcode;
- }
- int eeprom_read(unsigned dev_addr, unsigned offset, uchar *buffer, unsigned cnt)
- {
-
- return eeprom_rw(dev_addr, offset, buffer, cnt, 1);
- }
- int eeprom_write(unsigned dev_addr, unsigned offset,
- uchar *buffer, unsigned cnt)
- {
- int ret;
- eeprom_write_enable(dev_addr, 1);
-
- ret = eeprom_rw(dev_addr, offset, buffer, cnt, 0);
- eeprom_write_enable(dev_addr, 0);
- return ret;
- }
- static int parse_numeric_param(char *str)
- {
- char *endptr;
- int value = simple_strtol(str, &endptr, 16);
- return (*endptr != '\0') ? -1 : value;
- }
- static int parse_i2c_bus_addr(int *i2c_bus, ulong *i2c_addr, int argc,
- char * const argv[], int argc_no_bus_addr)
- {
- int argc_no_bus = argc_no_bus_addr + 1;
- int argc_bus_addr = argc_no_bus_addr + 2;
- #ifdef CONFIG_SYS_DEF_EEPROM_ADDR
- if (argc == argc_no_bus_addr) {
- *i2c_bus = -1;
- *i2c_addr = CONFIG_SYS_DEF_EEPROM_ADDR;
- return 0;
- }
- #endif
- if (argc == argc_no_bus) {
- *i2c_bus = -1;
- *i2c_addr = parse_numeric_param(argv[0]);
- return 1;
- }
- if (argc == argc_bus_addr) {
- *i2c_bus = parse_numeric_param(argv[0]);
- *i2c_addr = parse_numeric_param(argv[1]);
- return 2;
- }
- return CMD_RET_USAGE;
- }
- #ifdef CONFIG_CMD_EEPROM_LAYOUT
- __weak int eeprom_parse_layout_version(char *str)
- {
- return LAYOUT_VERSION_UNRECOGNIZED;
- }
- static unsigned char eeprom_buf[CONFIG_SYS_EEPROM_SIZE];
- #ifndef CONFIG_EEPROM_LAYOUT_HELP_STRING
- #define CONFIG_EEPROM_LAYOUT_HELP_STRING "<not defined>"
- #endif
- #endif
- enum eeprom_action {
- EEPROM_READ,
- EEPROM_WRITE,
- EEPROM_PRINT,
- EEPROM_UPDATE,
- EEPROM_ACTION_INVALID,
- };
- static enum eeprom_action parse_action(char *cmd)
- {
- if (!strncmp(cmd, "read", 4))
- return EEPROM_READ;
- if (!strncmp(cmd, "write", 5))
- return EEPROM_WRITE;
- #ifdef CONFIG_CMD_EEPROM_LAYOUT
- if (!strncmp(cmd, "print", 5))
- return EEPROM_PRINT;
- if (!strncmp(cmd, "update", 6))
- return EEPROM_UPDATE;
- #endif
- return EEPROM_ACTION_INVALID;
- }
- static int eeprom_execute_command(enum eeprom_action action, int i2c_bus,
- ulong i2c_addr, int layout_ver, char *key,
- char *value, ulong addr, ulong off, ulong cnt)
- {
- int rcode = 0;
- const char *const fmt =
- "\nEEPROM @0x%lX %s: addr %08lx off %04lx count %ld ... ";
- #ifdef CONFIG_CMD_EEPROM_LAYOUT
- struct eeprom_layout layout;
- #endif
- if (action == EEPROM_ACTION_INVALID)
- return CMD_RET_USAGE;
- eeprom_init(i2c_bus);
- if (action == EEPROM_READ) {
- printf(fmt, i2c_addr, "read", addr, off, cnt);
- rcode = eeprom_read(i2c_addr, off, (uchar *)addr, cnt);
- puts("done\n");
- return rcode;
- } else if (action == EEPROM_WRITE) {
- printf(fmt, i2c_addr, "write", addr, off, cnt);
- rcode = eeprom_write(i2c_addr, off, (uchar *)addr, cnt);
- puts("done\n");
- return rcode;
- }
- #ifdef CONFIG_CMD_EEPROM_LAYOUT
- rcode = eeprom_read(i2c_addr, 0, eeprom_buf, CONFIG_SYS_EEPROM_SIZE);
- if (rcode < 0)
- return rcode;
- eeprom_layout_setup(&layout, eeprom_buf, CONFIG_SYS_EEPROM_SIZE,
- layout_ver);
- if (action == EEPROM_PRINT) {
- layout.print(&layout);
- return 0;
- }
- layout.update(&layout, key, value);
- rcode = eeprom_write(i2c_addr, 0, layout.data, CONFIG_SYS_EEPROM_SIZE);
- #endif
- return rcode;
- }
- #define NEXT_PARAM(argc, index) { (argc)--; (index)++; }
- int do_eeprom(cmd_tbl_t *cmdtp, int flag, int argc, char * const argv[])
- {
- int layout_ver = LAYOUT_VERSION_AUTODETECT;
- enum eeprom_action action = EEPROM_ACTION_INVALID;
- int i2c_bus = -1, index = 0;
- ulong i2c_addr = -1, addr = 0, cnt = 0, off = 0;
- int ret;
- char *field_name = "";
- char *field_value = "";
- if (argc <= 1)
- return CMD_RET_USAGE;
- NEXT_PARAM(argc, index);
- action = parse_action(argv[index]);
- NEXT_PARAM(argc, index);
- if (action == EEPROM_ACTION_INVALID)
- return CMD_RET_USAGE;
- #ifdef CONFIG_CMD_EEPROM_LAYOUT
- if (action == EEPROM_PRINT || action == EEPROM_UPDATE) {
- if (!strcmp(argv[index], "-l")) {
- NEXT_PARAM(argc, index);
- layout_ver = eeprom_parse_layout_version(argv[index]);
- NEXT_PARAM(argc, index);
- }
- }
- #endif
- switch (action) {
- case EEPROM_READ:
- case EEPROM_WRITE:
- ret = parse_i2c_bus_addr(&i2c_bus, &i2c_addr, argc,
- argv + index, 3);
- break;
- case EEPROM_PRINT:
- ret = parse_i2c_bus_addr(&i2c_bus, &i2c_addr, argc,
- argv + index, 0);
- break;
- case EEPROM_UPDATE:
- ret = parse_i2c_bus_addr(&i2c_bus, &i2c_addr, argc,
- argv + index, 2);
- break;
- default:
-
- return CMD_RET_USAGE;
- }
- if (ret == CMD_RET_USAGE)
- return ret;
- while (ret--)
- NEXT_PARAM(argc, index);
- if (action == EEPROM_READ || action == EEPROM_WRITE) {
- addr = parse_numeric_param(argv[index]);
- NEXT_PARAM(argc, index);
- off = parse_numeric_param(argv[index]);
- NEXT_PARAM(argc, index);
- cnt = parse_numeric_param(argv[index]);
- }
- #ifdef CONFIG_CMD_EEPROM_LAYOUT
- if (action == EEPROM_UPDATE) {
- field_name = argv[index];
- NEXT_PARAM(argc, index);
- field_value = argv[index];
- NEXT_PARAM(argc, index);
- }
- #endif
- return eeprom_execute_command(action, i2c_bus, i2c_addr, layout_ver,
- field_name, field_value, addr, off, cnt);
- }
- U_BOOT_CMD(
- eeprom, 8, 1, do_eeprom,
- "EEPROM sub-system",
- "read <bus> <devaddr> addr off cnt\n"
- "eeprom write <bus> <devaddr> addr off cnt\n"
- " - read/write `cnt' bytes from `devaddr` EEPROM at offset `off'"
- #ifdef CONFIG_CMD_EEPROM_LAYOUT
- "\n"
- "eeprom print [-l <layout_version>] <bus> <devaddr>\n"
- " - Print layout fields and their data in human readable format\n"
- "eeprom update [-l <layout_version>] <bus> <devaddr> field_name field_value\n"
- " - Update a specific eeprom field with new data.\n"
- " The new data must be written in the same human readable format as shown by the print command.\n"
- "\n"
- "LAYOUT VERSIONS\n"
- "The -l option can be used to force the command to interpret the EEPROM data using the chosen layout.\n"
- "If the -l option is omitted, the command will auto detect the layout based on the data in the EEPROM.\n"
- "The values which can be provided with the -l option are:\n"
- CONFIG_EEPROM_LAYOUT_HELP_STRING"\n"
- #endif
- )
|