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