1 // SPDX-License-Identifier: GPL-2.0+
3 * Image manipulator for Vybrid SoCs
5 * Derived from vybridimage.c
7 * (C) Copyright 2016 DENX Software Engineering GmbH
8 * Written-by: Albert ARIBAUD <albert.aribaud@3adev.fr>
11 #include "imagetool.h"
16 * NAND page 0 boot header
19 struct nand_page_0_boot_header
{
22 uint8_t fcb_bytes
[512];
23 }; /* 0x00000000 - 0x000001ff */
24 uint8_t sw_ecc
[512]; /* 0x00000200 - 0x000003ff */
25 uint32_t padding
[65280]; /* 0x00000400 - 0x0003ffff */
26 uint8_t ivt_prefix
[1024]; /* 0x00040000 - 0x000403ff */
29 /* signature byte for a readable block */
31 static struct nand_page_0_boot_header vybridimage_header
;
33 static int vybridimage_check_image_types(uint8_t type
)
35 if (type
== IH_TYPE_VYBRIDIMAGE
)
40 static uint8_t vybridimage_sw_ecc(uint8_t byte
)
42 uint8_t bit0
= (byte
& (1 << 0)) ? 1 : 0;
43 uint8_t bit1
= (byte
& (1 << 1)) ? 1 : 0;
44 uint8_t bit2
= (byte
& (1 << 2)) ? 1 : 0;
45 uint8_t bit3
= (byte
& (1 << 3)) ? 1 : 0;
46 uint8_t bit4
= (byte
& (1 << 4)) ? 1 : 0;
47 uint8_t bit5
= (byte
& (1 << 5)) ? 1 : 0;
48 uint8_t bit6
= (byte
& (1 << 6)) ? 1 : 0;
49 uint8_t bit7
= (byte
& (1 << 7)) ? 1 : 0;
52 res
|= ((bit6
^ bit5
^ bit3
^ bit2
) << 0);
53 res
|= ((bit7
^ bit5
^ bit4
^ bit2
^ bit1
) << 1);
54 res
|= ((bit7
^ bit6
^ bit5
^ bit1
^ bit0
) << 2);
55 res
|= ((bit7
^ bit4
^ bit3
^ bit0
) << 3);
56 res
|= ((bit6
^ bit4
^ bit3
^ bit2
^ bit1
^ bit0
) << 4);
61 static int vybridimage_verify_header(unsigned char *ptr
, int image_size
,
62 struct image_tool_params
*params
)
64 struct nand_page_0_boot_header
*hdr
=
65 (struct nand_page_0_boot_header
*)ptr
;
68 if (hdr
->fcb
[1] != 0x46434220)
72 if (hdr
->fcb
[7] != 64)
74 if (hdr
->fcb
[14] != 6)
76 if (hdr
->fcb
[30] != 0x0001ff00)
78 if (hdr
->fcb
[43] != 1)
80 if (hdr
->fcb
[54] != 0)
82 if (hdr
->fcb
[55] != 8)
85 /* check software ECC */
86 for (idx
= 0; idx
< sizeof(hdr
->fcb_bytes
); idx
++) {
87 uint8_t sw_ecc
= vybridimage_sw_ecc(hdr
->fcb_bytes
[idx
]);
88 if (sw_ecc
!= hdr
->sw_ecc
[idx
])
95 static void vybridimage_set_header(void *ptr
, struct stat
*sbuf
, int ifd
,
96 struct image_tool_params
*params
)
98 struct nand_page_0_boot_header
*hdr
=
99 (struct nand_page_0_boot_header
*)ptr
;
102 /* fill header with 0x00 for first 56 entries then 0xff */
103 memset(&hdr
->fcb
[0], 0x0, 56*sizeof(uint32_t));
104 memset(&hdr
->fcb
[56], 0xff, 72*sizeof(uint32_t));
105 /* fill SW ecc and padding with 0xff */
106 memset(&hdr
->sw_ecc
[0], 0xff, sizeof(hdr
->sw_ecc
));
107 memset(&hdr
->padding
[0], 0xff, sizeof(hdr
->padding
));
108 /* fill IVT prefix with 0x00 */
109 memset(&hdr
->ivt_prefix
[0], 0x00, sizeof(hdr
->ivt_prefix
));
112 hdr
->fcb
[1] = 0x46434220; /* signature */
113 hdr
->fcb
[2] = 0x00000001; /* version */
114 hdr
->fcb
[5] = 2048; /* page size */
115 hdr
->fcb
[6] = (2048+64); /* page + OOB size */
116 hdr
->fcb
[7] = 64; /* pages per block */
117 hdr
->fcb
[14] = 6; /* ECC mode 6 */
118 hdr
->fcb
[26] = 128; /* fw address (0x40000) in 2K pages */
119 hdr
->fcb
[27] = 128; /* fw address (0x40000) in 2K pages */
120 hdr
->fcb
[30] = 0x0001ff00; /* DBBT search area start address */
121 hdr
->fcb
[33] = 2048; /* BB marker physical offset */
122 hdr
->fcb
[43] = 1; /* DISBBM */
123 hdr
->fcb
[54] = 0; /* DISBB_Search */
124 hdr
->fcb
[55] = 8; /* Bad block search limit */
126 /* compute software ECC */
127 for (idx
= 0; idx
< sizeof(hdr
->fcb_bytes
); idx
++)
128 hdr
->sw_ecc
[idx
] = vybridimage_sw_ecc(hdr
->fcb_bytes
[idx
]);
131 static void vybridimage_print_hdr_field(struct nand_page_0_boot_header
*hdr
,
134 printf("header.fcb[%d] = %08x\n", idx
, hdr
->fcb
[idx
]);
137 static void vybridimage_print_header(const void *ptr
)
139 struct nand_page_0_boot_header
*hdr
=
140 (struct nand_page_0_boot_header
*)ptr
;
143 for (idx
= 0; idx
< 56; idx
++)
144 vybridimage_print_hdr_field(hdr
, idx
);
148 * vybridimage parameters
153 sizeof(vybridimage_header
),
154 (void *)&vybridimage_header
,
156 vybridimage_verify_header
,
157 vybridimage_print_header
,
158 vybridimage_set_header
,
160 vybridimage_check_image_types
,