mirror of
https://github.com/brain-hackers/u-boot-brain
synced 2024-08-20 00:48:52 +09:00
![Wolfgang Denk](/assets/img/avatar_default.png)
Fix error detected by cppcheck: [board/matrix_vision/mvblx/sys_eeprom.c:353]: (error) Buffer is accessed out of bounds. Signed-off-by: Wolfgang Denk <wd@denx.de> cc: Michael Jones <michael.jones@matrix-vision.de> Acked-by: Michael Jones <michael.jones@matrix-vision.de>
404 lines
8.4 KiB
C
404 lines
8.4 KiB
C
/*
|
|
* Copyright 2006, 2008-2009, 2011 Freescale Semiconductor
|
|
* York Sun (yorksun@freescale.com)
|
|
* Haiying Wang (haiying.wang@freescale.com)
|
|
* Timur Tabi (timur@freescale.com)
|
|
*
|
|
* SPDX-License-Identifier: GPL-2.0+
|
|
*/
|
|
|
|
#include <common.h>
|
|
#include <command.h>
|
|
#include <i2c.h>
|
|
|
|
/* #define DEBUG */
|
|
|
|
/*
|
|
* static eeprom: EEPROM layout
|
|
*/
|
|
static struct __attribute__ ((__packed__)) eeprom {
|
|
u8 id[16]; /* 0x01 - 0x0F Type e.g. 100wG-5111 */
|
|
u8 sn[10]; /* 0x10 - 0x19 Serial Number */
|
|
u8 date[6]; /* 0x1A - 0x1F Build Date */
|
|
u8 mac[6]; /* 0x20 - 0x25 MAC address */
|
|
u8 reserved[10];/* 0x26 - 0x2f reserved */
|
|
u32 crc; /* x+1 CRC32 checksum */
|
|
} e;
|
|
|
|
/* Set to 1 if we've read EEPROM into memory */
|
|
static int has_been_read;
|
|
|
|
/**
|
|
* show_eeprom - display the contents of the EEPROM
|
|
*/
|
|
static void show_eeprom(void)
|
|
{
|
|
unsigned int crc;
|
|
char safe_string[16];
|
|
|
|
#ifdef DEBUG
|
|
int i;
|
|
#endif
|
|
u8 *p;
|
|
|
|
/* ID */
|
|
strncpy(safe_string, (char *)e.id, sizeof(e.id));
|
|
safe_string[sizeof(e.id)-1] = 0;
|
|
printf("ID: mvBlueLYNX-X%s\n", safe_string);
|
|
|
|
/* Serial number */
|
|
strncpy(safe_string, (char *)e.sn, sizeof(e.sn));
|
|
safe_string[sizeof(e.sn)-1] = 0;
|
|
printf("SN: %s\n", safe_string);
|
|
|
|
/* Build date, BCD date values, as YYMMDDhhmmss */
|
|
printf("Build date: 20%02x/%02x/%02x %02x:%02x:%02x %s\n",
|
|
e.date[0], e.date[1], e.date[2],
|
|
e.date[3] & 0x7F, e.date[4], e.date[5],
|
|
e.date[3] & 0x80 ? "PM" : "");
|
|
|
|
/* Show MAC address */
|
|
p = e.mac;
|
|
printf("Eth: %02x:%02x:%02x:%02x:%02x:%02x\n",
|
|
p[0], p[1], p[2], p[3], p[4], p[5]);
|
|
|
|
crc = crc32(0, (void *)&e, sizeof(e) - 4);
|
|
|
|
if (crc == be32_to_cpu(e.crc))
|
|
printf("CRC: %08x\n", be32_to_cpu(e.crc));
|
|
else
|
|
printf("CRC: %08x (should be %08x)\n", be32_to_cpu(e.crc), crc);
|
|
|
|
#ifdef DEBUG
|
|
printf("EEPROM dump: (0x%x bytes)\n", sizeof(e));
|
|
for (i = 0; i < sizeof(e); i++) {
|
|
if ((i % 16) == 0)
|
|
printf("%02X: ", i);
|
|
printf("%02X ", ((u8 *)&e)[i]);
|
|
if (((i % 16) == 15) || (i == sizeof(e) - 1))
|
|
printf("\n");
|
|
}
|
|
#endif
|
|
}
|
|
|
|
/**
|
|
* read_eeprom - read the EEPROM into memory
|
|
*/
|
|
static int read_eeprom(void)
|
|
{
|
|
int ret;
|
|
#ifdef CONFIG_SYS_EEPROM_BUS_NUM
|
|
unsigned int bus;
|
|
#endif
|
|
|
|
if (has_been_read)
|
|
return 0;
|
|
|
|
#ifdef CONFIG_SYS_EEPROM_BUS_NUM
|
|
bus = i2c_get_bus_num();
|
|
i2c_set_bus_num(CONFIG_SYS_EEPROM_BUS_NUM);
|
|
#endif
|
|
|
|
ret = eeprom_read(CONFIG_SYS_I2C_EEPROM_ADDR, 0,
|
|
(uchar *)&e, sizeof(e));
|
|
|
|
#ifdef CONFIG_SYS_EEPROM_BUS_NUM
|
|
i2c_set_bus_num(bus);
|
|
#endif
|
|
|
|
#ifdef DEBUG
|
|
show_eeprom();
|
|
#endif
|
|
|
|
has_been_read = (ret == 0) ? 1 : 0;
|
|
|
|
return ret;
|
|
}
|
|
|
|
/**
|
|
* update_crc - update the CRC
|
|
*
|
|
* This function should be called after each update to the EEPROM structure,
|
|
* to make sure the CRC is always correct.
|
|
*/
|
|
static void update_crc(void)
|
|
{
|
|
u32 crc;
|
|
|
|
crc = crc32(0, (void *)&e, sizeof(e) - 4);
|
|
e.crc = cpu_to_be32(crc);
|
|
}
|
|
|
|
/**
|
|
* prog_eeprom - write the EEPROM from memory
|
|
*/
|
|
static int prog_eeprom(void)
|
|
{
|
|
int ret = 0;
|
|
#ifdef CONFIG_SYS_EEPROM_BUS_NUM
|
|
unsigned int bus;
|
|
#endif
|
|
|
|
update_crc();
|
|
|
|
#ifdef CONFIG_SYS_EEPROM_BUS_NUM
|
|
bus = i2c_get_bus_num();
|
|
i2c_set_bus_num(CONFIG_SYS_EEPROM_BUS_NUM);
|
|
#endif
|
|
|
|
ret = eeprom_write(CONFIG_SYS_I2C_EEPROM_ADDR, 0,
|
|
(uchar *)&e, sizeof(e));
|
|
|
|
if (!ret) {
|
|
/* Verify the write by reading back the EEPROM and comparing */
|
|
struct eeprom e2;
|
|
#ifdef DEBUG
|
|
printf("%s verifying...\n", __func__);
|
|
#endif
|
|
ret = eeprom_read(CONFIG_SYS_I2C_EEPROM_ADDR, 0,
|
|
(uchar *)&e2, sizeof(e2));
|
|
|
|
if (!ret && memcmp(&e, &e2, sizeof(e)))
|
|
ret = -1;
|
|
}
|
|
|
|
#ifdef CONFIG_SYS_EEPROM_BUS_NUM
|
|
i2c_set_bus_num(bus);
|
|
#endif
|
|
|
|
if (ret) {
|
|
printf("Programming failed.\n");
|
|
has_been_read = 0;
|
|
return -1;
|
|
}
|
|
|
|
printf("Programming passed.\n");
|
|
return 0;
|
|
}
|
|
|
|
/**
|
|
* h2i - converts hex character into a number
|
|
*
|
|
* This function takes a hexadecimal character (e.g. '7' or 'C') and returns
|
|
* the integer equivalent.
|
|
*/
|
|
static inline u8 h2i(char p)
|
|
{
|
|
if ((p >= '0') && (p <= '9'))
|
|
return p - '0';
|
|
|
|
if ((p >= 'A') && (p <= 'F'))
|
|
return (p - 'A') + 10;
|
|
|
|
if ((p >= 'a') && (p <= 'f'))
|
|
return (p - 'a') + 10;
|
|
|
|
return 0;
|
|
}
|
|
|
|
/**
|
|
* set_date - stores the build date into the EEPROM
|
|
*
|
|
* This function takes a pointer to a string in the format "YYMMDDhhmmss"
|
|
* (2-digit year, 2-digit month, etc), converts it to a 6-byte BCD string,
|
|
* and stores it in the build date field of the EEPROM local copy.
|
|
*/
|
|
static void set_date(const char *string)
|
|
{
|
|
unsigned int i;
|
|
|
|
if (strlen(string) != 12) {
|
|
printf("Usage: mac date YYMMDDhhmmss\n");
|
|
return;
|
|
}
|
|
|
|
for (i = 0; i < 6; i++)
|
|
e.date[i] = h2i(string[2 * i]) << 4 | h2i(string[2 * i + 1]);
|
|
|
|
update_crc();
|
|
}
|
|
|
|
/**
|
|
* set_mac_address - stores a MAC address into the EEPROM
|
|
*
|
|
* This function takes a pointer to MAC address string
|
|
* (i.e."XX:XX:XX:XX:XX:XX", where "XX" is a two-digit hex number) and
|
|
* stores it in the MAC address field in the EEPROM local copy.
|
|
*/
|
|
static void set_mac_address(const char *string)
|
|
{
|
|
char *p = (char *) string;
|
|
unsigned int i;
|
|
|
|
for (i = 0; *p && (i < 6); i++) {
|
|
e.mac[i] = simple_strtoul(p, &p, 16);
|
|
if (*p == ':')
|
|
p++;
|
|
}
|
|
|
|
update_crc();
|
|
}
|
|
|
|
int do_mac(cmd_tbl_t *cmdtp, int flag, int argc, char * const argv[])
|
|
{
|
|
char cmd;
|
|
|
|
if (argc == 1) {
|
|
show_eeprom();
|
|
return 0;
|
|
}
|
|
|
|
cmd = argv[1][0];
|
|
|
|
if (cmd == 'r') {
|
|
#ifdef DEBUG
|
|
printf("%s read\n", __func__);
|
|
#endif
|
|
read_eeprom();
|
|
return 0;
|
|
}
|
|
|
|
if (argc == 2) {
|
|
switch (cmd) {
|
|
case 's': /* save */
|
|
#ifdef DEBUG
|
|
printf("%s save\n", __func__);
|
|
#endif
|
|
prog_eeprom();
|
|
break;
|
|
default:
|
|
return cmd_usage(cmdtp);
|
|
}
|
|
|
|
return 0;
|
|
}
|
|
|
|
/* We know we have at least one parameter */
|
|
|
|
switch (cmd) {
|
|
case 'n': /* serial number */
|
|
#ifdef DEBUG
|
|
printf("%s serial number\n", __func__);
|
|
#endif
|
|
memset(e.sn, 0, sizeof(e.sn));
|
|
strncpy((char *)e.sn, argv[2], sizeof(e.sn) - 1);
|
|
update_crc();
|
|
break;
|
|
case 'd': /* date BCD format YYMMDDhhmmss */
|
|
set_date(argv[2]);
|
|
break;
|
|
case 'e': /* errata */
|
|
printf("mac errata not implemented\n");
|
|
break;
|
|
case 'i': /* id */
|
|
memset(e.id, 0, sizeof(e.id));
|
|
strncpy((char *)e.id, argv[2], sizeof(e.id) - 1);
|
|
update_crc();
|
|
break;
|
|
case 'p': /* ports */
|
|
printf("mac ports not implemented (always 1 port)\n");
|
|
break;
|
|
case '0' ... '9':
|
|
/* we only have "mac 0" but any digit can be used here */
|
|
set_mac_address(argv[2]);
|
|
break;
|
|
case 'h': /* help */
|
|
default:
|
|
return cmd_usage(cmdtp);
|
|
}
|
|
|
|
return 0;
|
|
}
|
|
|
|
static inline int is_portrait(void)
|
|
{
|
|
int i;
|
|
unsigned int orient_index = 0; /* idx of char which determines orientation */
|
|
|
|
for (i = sizeof(e.id)/sizeof(*e.id) - 1; i>=0; i--) {
|
|
if (e.id[i] == '-') {
|
|
orient_index = i+1;
|
|
break;
|
|
}
|
|
}
|
|
|
|
return (orient_index &&
|
|
(e.id[orient_index] >= '5') && (e.id[orient_index] <= '8'));
|
|
}
|
|
|
|
int mac_read_from_eeprom(void)
|
|
{
|
|
u32 crc, crc_offset = offsetof(struct eeprom, crc);
|
|
u32 *crcp; /* Pointer to the CRC in the data read from the EEPROM */
|
|
#define FILENAME_LANDSCAPE "mvBlueLynx_X.rbf"
|
|
#define FILENAME_PORTRAIT "mvBlueLynx_X_sensor_cd.rbf"
|
|
|
|
if (read_eeprom()) {
|
|
printf("EEPROM Read failed.\n");
|
|
return -1;
|
|
}
|
|
|
|
crc = crc32(0, (void *)&e, crc_offset);
|
|
crcp = (void *)&e + crc_offset;
|
|
if (crc != be32_to_cpu(*crcp)) {
|
|
printf("EEPROM CRC mismatch (%08x != %08x)\n", crc,
|
|
be32_to_cpu(e.crc));
|
|
return -1;
|
|
}
|
|
|
|
if (memcmp(&e.mac, "\0\0\0\0\0\0", 6) &&
|
|
memcmp(&e.mac, "\xFF\xFF\xFF\xFF\xFF\xFF", 6)) {
|
|
char ethaddr[18];
|
|
|
|
sprintf(ethaddr, "%02X:%02X:%02X:%02X:%02X:%02X",
|
|
e.mac[0],
|
|
e.mac[1],
|
|
e.mac[2],
|
|
e.mac[3],
|
|
e.mac[4],
|
|
e.mac[5]);
|
|
/* Only initialize environment variables that are blank
|
|
* (i.e. have not yet been set)
|
|
*/
|
|
if (!getenv("ethaddr"))
|
|
setenv("ethaddr", ethaddr);
|
|
}
|
|
|
|
if (memcmp(&e.sn, "\0\0\0\0\0\0\0\0\0\0", 10) &&
|
|
memcmp(&e.sn, "\xFF\xFF\xFF\xFF\xFF\xFF\xFF\xFF\xFF\xFF", 10)) {
|
|
char serial_num[12];
|
|
|
|
strncpy(serial_num, (char *)e.sn, sizeof(e.sn) - 1);
|
|
/* Only initialize environment variables that are blank
|
|
* (i.e. have not yet been set)
|
|
*/
|
|
if (!getenv("serial#"))
|
|
setenv("serial#", serial_num);
|
|
}
|
|
|
|
/* decide which fpga file to load depending on orientation */
|
|
if (is_portrait())
|
|
setenv("fpgafilename", FILENAME_PORTRAIT);
|
|
else
|
|
setenv("fpgafilename", FILENAME_LANDSCAPE);
|
|
|
|
/* TODO should I calculate CRC here? */
|
|
return 0;
|
|
}
|
|
|
|
#ifdef CONFIG_SERIAL_TAG
|
|
void get_board_serial(struct tag_serialnr *serialnr)
|
|
{
|
|
char *serial = getenv("serial#");
|
|
|
|
if (serial && (strlen(serial) > 3)) {
|
|
/* use the numerical part of the serial number LXnnnnnn */
|
|
serialnr->high = 0;
|
|
serialnr->low = simple_strtoul(serial + 2, NULL, 10);
|
|
} else {
|
|
serialnr->high = 0;
|
|
serialnr->low = 0;
|
|
}
|
|
}
|
|
#endif
|