123456789101112131415161718192021222324252627282930313233343536373839404142434445464748495051525354555657585960616263646566676869707172737475767778798081828384858687888990919293949596979899100101102103104105106107108109110111112113114115116117118119120121122123124125126127128129130131132133134135136137138139140141142143144145146147148149150151152153154155156157158159160161162163164165166167168169170171172173174175176177178179180181182183184185186187188189190191192193194195196197198199200201202203204205206207208209210211212213214215216217218219220221222223224225226227228229230231232233234235236237238239240241242243244245246247248249250251252253254255256257258259260261262263264265266267268269270271272273274275276277278279280281282283284285286287288289290291292293294295296297298299300301302303304305306307308309310311312313314315316317318319320321322323324325326327328329330331332333334335336337338339340341342343344345346347348349350351352353354355356357358359360361362363364365366367368 |
- // SPDX-License-Identifier: GPL-2.0
- /*
- * (C) Copyright 2019 - 2020 Xilinx, Inc.
- */
- #include <common.h>
- #include <cpu_func.h>
- #include <env.h>
- #include <fdtdec.h>
- #include <log.h>
- #include <malloc.h>
- #include <asm/io.h>
- #include <asm/arch/hardware.h>
- #include "fru.h"
- struct fru_table fru_data __section(".data");
- static u16 fru_cal_area_len(u8 len)
- {
- return len * FRU_COMMON_HDR_LEN_MULTIPLIER;
- }
- static u8 fru_version(u8 ver)
- {
- return ver & FRU_COMMON_HDR_VER_MASK;
- }
- static int fru_check_language(u8 code)
- {
- if (code != FRU_LANG_CODE_ENGLISH && code != FRU_LANG_CODE_ENGLISH_1) {
- printf("FRU_ERROR: Only English Language is supported\n");
- return -EINVAL;
- }
- return 0;
- }
- u8 fru_checksum(u8 *addr, u8 len)
- {
- u8 checksum = 0;
- while (len--) {
- checksum += *addr;
- addr++;
- }
- return checksum;
- }
- static int fru_check_type_len(u8 type_len, u8 language, u8 *type)
- {
- int len;
- if (type_len == FRU_TYPELEN_EOF)
- return -EINVAL;
- *type = (type_len & FRU_TYPELEN_CODE_MASK) >> FRU_TYPELEN_TYPE_SHIFT;
- len = type_len & FRU_TYPELEN_LEN_MASK;
- return len;
- }
- /* Return len */
- static u8 fru_gen_type_len(u8 *addr, char *name)
- {
- int len = strlen(name);
- struct fru_board_info_member *member;
- member = (struct fru_board_info_member *)addr;
- member->type_len = FRU_TYPELEN_TYPE_ASCII8 << FRU_TYPELEN_TYPE_SHIFT;
- member->type_len |= len;
- debug("%lx/%lx: Add %s to 0x%lx (len 0x%x)\n", (ulong)addr,
- (ulong)&member->type_len, name, (ulong)&member->name, len);
- memcpy(&member->name, name, len);
- /* Add +1 for type_len parameter */
- return 1 + len;
- }
- int fru_generate(unsigned long addr, char *manufacturer, char *board_name,
- char *serial_no, char *part_no, char *revision)
- {
- struct fru_common_hdr *header = (struct fru_common_hdr *)addr;
- struct fru_board_info_header *board_info;
- u8 *member;
- u8 len, pad, modulo;
- header->version = 1; /* Only version 1.0 is supported now */
- header->off_internal = 0; /* not present */
- header->off_chassis = 0; /* not present */
- header->off_board = (sizeof(*header)) / 8; /* Starting offset 8 */
- header->off_product = 0; /* not present */
- header->off_multirec = 0; /* not present */
- header->pad = 0;
- /*
- * This unsigned byte can be used to calculate a zero checksum
- * for the data area following the header. I.e. the modulo 256 sum of
- * the record data bytes plus the checksum byte equals zero.
- */
- header->crc = 0; /* Clear before calculation */
- header->crc = 0 - fru_checksum((u8 *)header, sizeof(*header));
- /* board info is just right after header */
- board_info = (void *)((u8 *)header + sizeof(*header));
- debug("header %lx, board_info %lx\n", (ulong)header, (ulong)board_info);
- board_info->ver = 1; /* 1.0 spec */
- board_info->lang_code = 0; /* English */
- board_info->time[0] = 0; /* unspecified */
- board_info->time[1] = 0; /* unspecified */
- board_info->time[2] = 0; /* unspecified */
- /* Member fields are just after board_info header */
- member = (u8 *)board_info + sizeof(*board_info);
- len = fru_gen_type_len(member, manufacturer); /* Board Manufacturer */
- member += len;
- len = fru_gen_type_len(member, board_name); /* Board Product name */
- member += len;
- len = fru_gen_type_len(member, serial_no); /* Board Serial number */
- member += len;
- len = fru_gen_type_len(member, part_no); /* Board part number */
- member += len;
- len = fru_gen_type_len(member, "U-Boot generator"); /* File ID */
- member += len;
- len = fru_gen_type_len(member, revision); /* Revision */
- member += len;
- *member++ = 0xc1; /* Indication of no more fields */
- len = member - (u8 *)board_info; /* Find current length */
- len += 1; /* Add checksum there too for calculation */
- modulo = len % 8;
- if (modulo) {
- /* Do not fill last item which is checksum */
- for (pad = 0; pad < 8 - modulo; pad++)
- *member++ = 0;
- /* Increase structure size */
- len += 8 - modulo;
- }
- board_info->len = len / 8; /* Size in multiples of 8 bytes */
- *member = 0; /* Clear before calculation */
- *member = 0 - fru_checksum((u8 *)board_info, len);
- debug("checksum %x(addr %x)\n", *member, len);
- env_set_hex("fru_addr", addr);
- env_set_hex("filesize", (unsigned long)member - addr + 1);
- return 0;
- }
- static int fru_parse_board(unsigned long addr)
- {
- u8 i, type;
- int len;
- u8 *data, *term, *limit;
- memcpy(&fru_data.brd.ver, (void *)addr, 6);
- addr += 6;
- data = (u8 *)&fru_data.brd.manufacturer_type_len;
- /* Record max structure limit not to write data over allocated space */
- limit = (u8 *)&fru_data.brd + sizeof(struct fru_board_data);
- for (i = 0; ; i++, data += FRU_BOARD_MAX_LEN) {
- len = fru_check_type_len(*(u8 *)addr, fru_data.brd.lang_code,
- &type);
- /*
- * Stop cature if it end of fields
- */
- if (len == -EINVAL)
- break;
- /* Stop when amount of chars is more then fields to record */
- if (data + len > limit)
- break;
- /* This record type/len field */
- *data++ = *(u8 *)addr;
- /* Add offset to match data */
- addr += 1;
- /* If len is 0 it means empty field that's why skip writing */
- if (!len)
- continue;
- /* Record data field */
- memcpy(data, (u8 *)addr, len);
- term = data + (u8)len;
- *term = 0;
- addr += len;
- }
- if (i < FRU_BOARD_AREA_TOTAL_FIELDS) {
- printf("Board area require minimum %d fields\n",
- FRU_BOARD_AREA_TOTAL_FIELDS);
- return -EINVAL;
- }
- return 0;
- }
- int fru_capture(unsigned long addr)
- {
- struct fru_common_hdr *hdr;
- u8 checksum = 0;
- checksum = fru_checksum((u8 *)addr, sizeof(struct fru_common_hdr));
- if (checksum) {
- printf("%s Common header CRC error\n", __func__);
- return -EINVAL;
- }
- hdr = (struct fru_common_hdr *)addr;
- memcpy((void *)&fru_data, (void *)hdr,
- sizeof(struct fru_common_hdr));
- fru_data.captured = true;
- if (hdr->off_board) {
- addr += fru_cal_area_len(hdr->off_board);
- fru_parse_board(addr);
- }
- env_set_hex("fru_addr", addr);
- return 0;
- }
- static int fru_display_board(struct fru_board_data *brd, int verbose)
- {
- u32 time = 0;
- u8 type;
- int len;
- u8 *data;
- static const char * const typecode[] = {
- "Binary/Unspecified",
- "BCD plus",
- "6-bit ASCII",
- "8-bit ASCII",
- "2-byte UNICODE"
- };
- static const char * const boardinfo[] = {
- "Manufacturer Name",
- "Product Name",
- "Serial No",
- "Part Number",
- "File ID",
- /* Xilinx spec */
- "Revision Number",
- };
- if (verbose) {
- printf("*****BOARD INFO*****\n");
- printf("Version:%d\n", fru_version(brd->ver));
- printf("Board Area Length:%d\n", fru_cal_area_len(brd->len));
- }
- if (fru_check_language(brd->lang_code))
- return -EINVAL;
- time = brd->time[2] << 16 | brd->time[1] << 8 |
- brd->time[0];
- if (verbose)
- printf("Time in Minutes from 0:00hrs 1/1/96: %d\n", time);
- data = (u8 *)&brd->manufacturer_type_len;
- for (u8 i = 0; i < (sizeof(boardinfo) / sizeof(*boardinfo)); i++) {
- len = fru_check_type_len(*data++, brd->lang_code,
- &type);
- if (len == -EINVAL) {
- printf("**** EOF for Board Area ****\n");
- break;
- }
- if (type <= FRU_TYPELEN_TYPE_ASCII8 &&
- (brd->lang_code == FRU_LANG_CODE_ENGLISH ||
- brd->lang_code == FRU_LANG_CODE_ENGLISH_1))
- debug("Type code: %s\n", typecode[type]);
- else
- debug("Type code: %s\n", typecode[type + 1]);
- if (!len) {
- debug("%s not found\n", boardinfo[i]);
- continue;
- }
- switch (type) {
- case FRU_TYPELEN_TYPE_BINARY:
- debug("Length: %d\n", len);
- printf(" %s: 0x%x\n", boardinfo[i], *data);
- break;
- case FRU_TYPELEN_TYPE_ASCII8:
- debug("Length: %d\n", len);
- printf(" %s: %s\n", boardinfo[i], data);
- break;
- default:
- debug("Unsupported type %x\n", type);
- }
- data += FRU_BOARD_MAX_LEN;
- }
- return 0;
- }
- static void fru_display_common_hdr(struct fru_common_hdr *hdr, int verbose)
- {
- if (!verbose)
- return;
- printf("*****COMMON HEADER*****\n");
- printf("Version:%d\n", fru_version(hdr->version));
- if (hdr->off_internal)
- printf("Internal Use Area Offset:%d\n",
- fru_cal_area_len(hdr->off_internal));
- else
- printf("*** No Internal Area ***\n");
- if (hdr->off_chassis)
- printf("Chassis Info Area Offset:%d\n",
- fru_cal_area_len(hdr->off_chassis));
- else
- printf("*** No Chassis Info Area ***\n");
- if (hdr->off_board)
- printf("Board Area Offset:%d\n",
- fru_cal_area_len(hdr->off_board));
- else
- printf("*** No Board Area ***\n");
- if (hdr->off_product)
- printf("Product Info Area Offset:%d\n",
- fru_cal_area_len(hdr->off_product));
- else
- printf("*** No Product Info Area ***\n");
- if (hdr->off_multirec)
- printf("MultiRecord Area Offset:%d\n",
- fru_cal_area_len(hdr->off_multirec));
- else
- printf("*** No MultiRecord Area ***\n");
- }
- int fru_display(int verbose)
- {
- if (!fru_data.captured) {
- printf("FRU data not available please run fru parse\n");
- return -EINVAL;
- }
- fru_display_common_hdr(&fru_data.hdr, verbose);
- return fru_display_board(&fru_data.brd, verbose);
- }
|