Blame view
tools/vybridimage.c
4.21 KB
ed0c2c0a9 tools: mkimage: a... |
1 2 3 4 5 6 7 8 9 10 11 12 13 14 15 16 17 18 19 20 21 22 23 24 25 26 27 28 29 30 31 32 33 34 35 36 37 38 39 40 41 42 43 44 45 46 47 48 49 50 51 52 53 54 55 56 57 58 59 60 61 62 63 64 65 66 67 68 69 70 71 72 73 74 75 76 77 78 79 80 81 82 83 84 85 86 87 88 89 90 91 92 93 94 95 96 97 98 99 100 101 102 103 104 105 106 107 108 109 110 111 112 113 114 115 116 117 118 119 120 121 122 123 124 125 126 127 128 129 130 131 132 133 134 135 136 137 138 139 140 141 142 143 144 145 146 147 148 149 150 151 152 153 154 155 156 157 158 159 160 161 162 163 164 165 |
/* * Image manipulator for Vybrid SoCs * * Derived from vybridimage.c * * (C) Copyright 2016 DENX Software Engineering GmbH * Written-by: Albert ARIBAUD <albert.aribaud@3adev.fr> * * SPDX-License-Identifier: GPL-2.0+ */ #include "imagetool.h" #include <compiler.h> #include <image.h> /* * NAND page 0 boot header */ struct nand_page_0_boot_header { union { uint32_t fcb[128]; uint8_t fcb_bytes[512]; }; /* 0x00000000 - 0x000001ff */ uint8_t sw_ecc[512]; /* 0x00000200 - 0x000003ff */ uint32_t padding[65280]; /* 0x00000400 - 0x0003ffff */ uint8_t ivt_prefix[1024]; /* 0x00040000 - 0x000403ff */ }; /* signature byte for a readable block */ static struct nand_page_0_boot_header vybridimage_header; static int vybridimage_check_image_types(uint8_t type) { if (type == IH_TYPE_VYBRIDIMAGE) return EXIT_SUCCESS; return EXIT_FAILURE; } static uint8_t vybridimage_sw_ecc(uint8_t byte) { uint8_t bit0 = (byte & (1 << 0)) ? 1 : 0; uint8_t bit1 = (byte & (1 << 1)) ? 1 : 0; uint8_t bit2 = (byte & (1 << 2)) ? 1 : 0; uint8_t bit3 = (byte & (1 << 3)) ? 1 : 0; uint8_t bit4 = (byte & (1 << 4)) ? 1 : 0; uint8_t bit5 = (byte & (1 << 5)) ? 1 : 0; uint8_t bit6 = (byte & (1 << 6)) ? 1 : 0; uint8_t bit7 = (byte & (1 << 7)) ? 1 : 0; uint8_t res = 0; res |= ((bit6 ^ bit5 ^ bit3 ^ bit2) << 0); res |= ((bit7 ^ bit5 ^ bit4 ^ bit2 ^ bit1) << 1); res |= ((bit7 ^ bit6 ^ bit5 ^ bit1 ^ bit0) << 2); res |= ((bit7 ^ bit4 ^ bit3 ^ bit0) << 3); res |= ((bit6 ^ bit4 ^ bit3 ^ bit2 ^ bit1 ^ bit0) << 4); return res; } static int vybridimage_verify_header(unsigned char *ptr, int image_size, struct image_tool_params *params) { struct nand_page_0_boot_header *hdr = (struct nand_page_0_boot_header *)ptr; int idx; if (hdr->fcb[1] != 0x46434220) return -1; if (hdr->fcb[2] != 1) return -1; if (hdr->fcb[7] != 64) return -1; if (hdr->fcb[14] != 6) return -1; if (hdr->fcb[30] != 0x0001ff00) return -1; if (hdr->fcb[43] != 1) return -1; if (hdr->fcb[54] != 0) return -1; if (hdr->fcb[55] != 8) return -1; /* check software ECC */ for (idx = 0; idx < sizeof(hdr->fcb_bytes); idx++) { uint8_t sw_ecc = vybridimage_sw_ecc(hdr->fcb_bytes[idx]); if (sw_ecc != hdr->sw_ecc[idx]) return -1; } return 0; } static void vybridimage_set_header(void *ptr, struct stat *sbuf, int ifd, struct image_tool_params *params) { struct nand_page_0_boot_header *hdr = (struct nand_page_0_boot_header *)ptr; int idx; /* fill header with 0x00 for first 56 entries then 0xff */ memset(&hdr->fcb[0], 0x0, 56*sizeof(uint32_t)); memset(&hdr->fcb[56], 0xff, 72*sizeof(uint32_t)); /* fill SW ecc and padding with 0xff */ memset(&hdr->sw_ecc[0], 0xff, sizeof(hdr->sw_ecc)); memset(&hdr->padding[0], 0xff, sizeof(hdr->padding)); /* fill IVT prefix with 0x00 */ memset(&hdr->ivt_prefix[0], 0x00, sizeof(hdr->ivt_prefix)); /* populate fcb */ hdr->fcb[1] = 0x46434220; /* signature */ hdr->fcb[2] = 0x00000001; /* version */ hdr->fcb[5] = 2048; /* page size */ hdr->fcb[6] = (2048+64); /* page + OOB size */ hdr->fcb[7] = 64; /* pages per block */ hdr->fcb[14] = 6; /* ECC mode 6 */ hdr->fcb[26] = 128; /* fw address (0x40000) in 2K pages */ hdr->fcb[27] = 128; /* fw address (0x40000) in 2K pages */ hdr->fcb[30] = 0x0001ff00; /* DBBT search area start address */ hdr->fcb[33] = 2048; /* BB marker physical offset */ hdr->fcb[43] = 1; /* DISBBM */ hdr->fcb[54] = 0; /* DISBB_Search */ hdr->fcb[55] = 8; /* Bad block search limit */ /* compute software ECC */ for (idx = 0; idx < sizeof(hdr->fcb_bytes); idx++) hdr->sw_ecc[idx] = vybridimage_sw_ecc(hdr->fcb_bytes[idx]); } static void vybridimage_print_hdr_field(struct nand_page_0_boot_header *hdr, int idx) { printf("header.fcb[%d] = %08x ", idx, hdr->fcb[idx]); } static void vybridimage_print_header(const void *ptr) { struct nand_page_0_boot_header *hdr = (struct nand_page_0_boot_header *)ptr; int idx; for (idx = 0; idx < 56; idx++) vybridimage_print_hdr_field(hdr, idx); } /* * vybridimage parameters */ U_BOOT_IMAGE_TYPE( vybridimage, "Vybrid Boot Image", sizeof(vybridimage_header), (void *)&vybridimage_header, NULL, vybridimage_verify_header, vybridimage_print_header, vybridimage_set_header, NULL, vybridimage_check_image_types, NULL, NULL ); |