2 * Copyright 2015-2016 Freescale Semiconductor, Inc.
5 * SPDX-License-Identifier: GPL-2.0+
10 * Contains all the functions to handle parsing and loading of PE firmware
14 #include <net/pfe_eth/pfe_eth.h>
15 #include <net/pfe_eth/pfe_firmware.h>
17 #define PFE_FIRMEWARE_FIT_CNF_NAME "config@1"
19 static const void *pfe_fit_addr = (void *)CONFIG_SYS_LS_PFE_FW_ADDR;
22 * PFE elf firmware loader.
23 * Loads an elf firmware image into a list of PE's (specified using a bitmask)
25 * @param pe_mask Mask of PE id's to load firmware to
26 * @param pfe_firmware Pointer to the firmware image
28 * @return 0 on success, a negative value on error
30 static int pfe_load_elf(int pe_mask, uint8_t *pfe_firmware)
32 Elf32_Ehdr *elf_hdr = (Elf32_Ehdr *)pfe_firmware;
33 Elf32_Half sections = be16_to_cpu(elf_hdr->e_shnum);
34 Elf32_Shdr *shdr = (Elf32_Shdr *)(pfe_firmware +
35 be32_to_cpu(elf_hdr->e_shoff));
39 debug("%s: no of sections: %d\n", __func__, sections);
41 /* Some sanity checks */
42 if (strncmp((char *)&elf_hdr->e_ident[EI_MAG0], ELFMAG, SELFMAG)) {
43 printf("%s: incorrect elf magic number\n", __func__);
47 if (elf_hdr->e_ident[EI_CLASS] != ELFCLASS32) {
48 printf("%s: incorrect elf class(%x)\n", __func__,
49 elf_hdr->e_ident[EI_CLASS]);
53 if (elf_hdr->e_ident[EI_DATA] != ELFDATA2MSB) {
54 printf("%s: incorrect elf data(%x)\n", __func__,
55 elf_hdr->e_ident[EI_DATA]);
59 if (be16_to_cpu(elf_hdr->e_type) != ET_EXEC) {
60 printf("%s: incorrect elf file type(%x)\n", __func__,
61 be16_to_cpu(elf_hdr->e_type));
65 for (section = 0; section < sections; section++, shdr++) {
66 if (!(be32_to_cpu(shdr->sh_flags) & (SHF_WRITE | SHF_ALLOC |
69 for (id = 0; id < MAX_PE; id++)
70 if (pe_mask & BIT(id)) {
71 ret = pe_load_elf_section(id,
84 * Get PFE firmware from FIT image
86 * @param data pointer to PFE firmware
87 * @param size pointer to size of the firmware
88 * @param fw_name pfe firmware name, either class or tmu
90 * @return 0 on success, a negative value on error
92 static int pfe_get_fw(const void **data,
93 size_t *size, char *fw_name)
95 int conf_node_off, fw_node_off;
96 char *conf_node_name = NULL;
100 conf_node_name = PFE_FIRMEWARE_FIT_CNF_NAME;
102 conf_node_off = fit_conf_get_node(pfe_fit_addr, conf_node_name);
103 if (conf_node_off < 0) {
104 printf("PFE Firmware: %s: no such config\n", conf_node_name);
108 fw_node_off = fit_conf_get_prop_node(pfe_fit_addr, conf_node_off,
110 if (fw_node_off < 0) {
111 printf("PFE Firmware: No '%s' in config\n",
116 if (!(fit_image_verify(pfe_fit_addr, fw_node_off))) {
117 printf("PFE Firmware: Bad firmware image (bad CRC)\n");
121 if (fit_image_get_data(pfe_fit_addr, fw_node_off, data, size)) {
122 printf("PFE Firmware: Can't get %s subimage data/size",
127 ret = fit_get_desc(pfe_fit_addr, fw_node_off, &desc);
129 printf("PFE Firmware: Can't get description\n");
131 printf("%s\n", desc);
137 * Check PFE FIT image
139 * @return 0 on success, a negative value on error
141 static int pfe_fit_check(void)
145 ret = fdt_check_header(pfe_fit_addr);
147 printf("PFE Firmware: Bad firmware image (not a FIT image)\n");
151 if (!fit_check_format(pfe_fit_addr)) {
152 printf("PFE Firmware: Bad firmware image (bad FIT header)\n");
161 * PFE firmware initialization.
162 * Loads different firmware files from FIT image.
163 * Initializes PE IMEM/DMEM and UTIL-PE DDR
164 * Initializes control path symbol addresses (by looking them up in the elf
166 * Takes PE's out of reset
168 * @return 0 on success, a negative value on error
170 int pfe_firmware_init(void)
172 char *pfe_firmware_name;
173 const void *raw_image_addr;
174 size_t raw_image_size = 0;
179 ret = pfe_fit_check();
183 for (fw_count = 0; fw_count < 2; fw_count++) {
185 pfe_firmware_name = "class";
186 else if (fw_count == 1)
187 pfe_firmware_name = "tmu";
189 pfe_get_fw(&raw_image_addr, &raw_image_size, pfe_firmware_name);
190 pfe_firmware = malloc(raw_image_size);
193 memcpy((void *)pfe_firmware, (void *)raw_image_addr,
197 ret = pfe_load_elf(CLASS_MASK, pfe_firmware);
198 else if (fw_count == 1)
199 ret = pfe_load_elf(TMU_MASK, pfe_firmware);
202 printf("%s: %s firmware load failed\n", __func__,
206 debug("%s: %s firmware loaded\n", __func__, pfe_firmware_name);
212 gpi_enable(HGPI_BASE_ADDR);
219 * PFE firmware cleanup
222 void pfe_firmware_exit(void)
224 debug("%s\n", __func__);