1 /*
2  * Copyright (c) 2017 Nordic Semiconductor ASA
3  * Copyright (c) 2016-2017 Linaro Limited
4  *
5  * SPDX-License-Identifier: Apache-2.0
6  */
7 
8 #include <stddef.h>
9 #include <errno.h>
10 #include <string.h>
11 #include <zephyr/drivers/flash.h>
12 #include <zephyr/storage/flash_map.h>
13 #include <zephyr/kernel.h>
14 #include <zephyr/init.h>
15 
16 #include <zephyr/sys/__assert.h>
17 #include <zephyr/sys/byteorder.h>
18 
19 #include "bootutil/bootutil_public.h"
20 #include <zephyr/dfu/mcuboot.h>
21 
22 #include "mcuboot_priv.h"
23 
24 /*
25  * Helpers for image headers and trailers, as defined by mcuboot.
26  */
27 
28 /*
29  * Strict defines: the definitions in the following block contain
30  * values which are MCUboot implementation requirements.
31  */
32 
33 /* Header: */
34 #define BOOT_HEADER_MAGIC_V1 0x96f3b83d
35 #define BOOT_HEADER_SIZE_V1 32
36 
37 /* Get active partition. zephyr,code-partition chosen node must be defined */
38 #define ACTIVE_SLOT_FLASH_AREA_ID DT_FIXED_PARTITION_ID(DT_CHOSEN(zephyr_code_partition))
39 
40 /*
41  * Raw (on-flash) representation of the v1 image header.
42  */
43 struct mcuboot_v1_raw_header {
44 	uint32_t header_magic;
45 	uint32_t image_load_address;
46 	uint16_t header_size;
47 	uint16_t pad;
48 	uint32_t image_size;
49 	uint32_t image_flags;
50 	struct {
51 		uint8_t major;
52 		uint8_t minor;
53 		uint16_t revision;
54 		uint32_t build_num;
55 	} version;
56 	uint32_t pad2;
57 } __packed;
58 
59 /*
60  * End of strict defines
61  */
62 
boot_read_v1_header(uint8_t area_id,struct mcuboot_v1_raw_header * v1_raw)63 static int boot_read_v1_header(uint8_t area_id,
64 			       struct mcuboot_v1_raw_header *v1_raw)
65 {
66 	const struct flash_area *fa;
67 	int rc;
68 
69 	rc = flash_area_open(area_id, &fa);
70 	if (rc) {
71 		return rc;
72 	}
73 
74 	/*
75 	 * Read and sanity-check the raw header.
76 	 */
77 	rc = flash_area_read(fa, 0, v1_raw, sizeof(*v1_raw));
78 	flash_area_close(fa);
79 	if (rc) {
80 		return rc;
81 	}
82 
83 	v1_raw->header_magic = sys_le32_to_cpu(v1_raw->header_magic);
84 	v1_raw->image_load_address =
85 		sys_le32_to_cpu(v1_raw->image_load_address);
86 	v1_raw->header_size = sys_le16_to_cpu(v1_raw->header_size);
87 	v1_raw->image_size = sys_le32_to_cpu(v1_raw->image_size);
88 	v1_raw->image_flags = sys_le32_to_cpu(v1_raw->image_flags);
89 	v1_raw->version.revision =
90 		sys_le16_to_cpu(v1_raw->version.revision);
91 	v1_raw->version.build_num =
92 		sys_le32_to_cpu(v1_raw->version.build_num);
93 
94 	/*
95 	 * Sanity checks.
96 	 *
97 	 * Larger values in header_size than BOOT_HEADER_SIZE_V1 are
98 	 * possible, e.g. if Zephyr was linked with
99 	 * CONFIG_ROM_START_OFFSET > BOOT_HEADER_SIZE_V1.
100 	 */
101 	if ((v1_raw->header_magic != BOOT_HEADER_MAGIC_V1) ||
102 	    (v1_raw->header_size < BOOT_HEADER_SIZE_V1)) {
103 		return -EIO;
104 	}
105 
106 	return 0;
107 }
108 
boot_read_bank_header(uint8_t area_id,struct mcuboot_img_header * header,size_t header_size)109 int boot_read_bank_header(uint8_t area_id,
110 			  struct mcuboot_img_header *header,
111 			  size_t header_size)
112 {
113 	int rc;
114 	struct mcuboot_v1_raw_header v1_raw;
115 	struct mcuboot_img_sem_ver *sem_ver;
116 	size_t v1_min_size = (sizeof(uint32_t) +
117 			      sizeof(struct mcuboot_img_header_v1));
118 
119 	/*
120 	 * Only version 1 image headers are supported.
121 	 */
122 	if (header_size < v1_min_size) {
123 		return -ENOMEM;
124 	}
125 	rc = boot_read_v1_header(area_id, &v1_raw);
126 	if (rc) {
127 		return rc;
128 	}
129 
130 	/*
131 	 * Copy just the fields we care about into the return parameter.
132 	 *
133 	 * - header_magic:       skip (only used to check format)
134 	 * - image_load_address: skip (only matters for PIC code)
135 	 * - header_size:        skip (only used to check format)
136 	 * - image_size:         include
137 	 * - image_flags:        skip (all unsupported or not relevant)
138 	 * - version:            include
139 	 */
140 	header->mcuboot_version = 1U;
141 	header->h.v1.image_size = v1_raw.image_size;
142 	sem_ver = &header->h.v1.sem_ver;
143 	sem_ver->major = v1_raw.version.major;
144 	sem_ver->minor = v1_raw.version.minor;
145 	sem_ver->revision = v1_raw.version.revision;
146 	sem_ver->build_num = v1_raw.version.build_num;
147 	return 0;
148 }
149 
mcuboot_swap_type_multi(int image_index)150 int mcuboot_swap_type_multi(int image_index)
151 {
152 	return boot_swap_type_multi(image_index);
153 }
154 
mcuboot_swap_type(void)155 int mcuboot_swap_type(void)
156 {
157 #ifdef FLASH_AREA_IMAGE_SECONDARY
158 	return boot_swap_type();
159 #else
160 	return BOOT_SWAP_TYPE_NONE;
161 #endif
162 
163 }
164 
boot_request_upgrade(int permanent)165 int boot_request_upgrade(int permanent)
166 {
167 #ifdef FLASH_AREA_IMAGE_SECONDARY
168 	int rc;
169 
170 	rc = boot_set_pending(permanent);
171 	if (rc) {
172 		return -EFAULT;
173 	}
174 #endif /* FLASH_AREA_IMAGE_SECONDARY */
175 	return 0;
176 }
177 
boot_request_upgrade_multi(int image_index,int permanent)178 int boot_request_upgrade_multi(int image_index, int permanent)
179 {
180 	int rc;
181 
182 	rc = boot_set_pending_multi(image_index, permanent);
183 	if (rc) {
184 		return -EFAULT;
185 	}
186 	return 0;
187 }
188 
boot_is_img_confirmed(void)189 bool boot_is_img_confirmed(void)
190 {
191 	struct boot_swap_state state;
192 	const struct flash_area *fa;
193 	int rc;
194 
195 	rc = flash_area_open(FLASH_AREA_IMAGE_PRIMARY, &fa);
196 	if (rc) {
197 		return false;
198 	}
199 
200 	rc = boot_read_swap_state(fa, &state);
201 	if (rc != 0) {
202 		return false;
203 	}
204 
205 	if (state.magic == BOOT_MAGIC_UNSET) {
206 		/* This is initial/preprogramed image.
207 		 * Such image can neither be reverted nor physically confirmed.
208 		 * Treat this image as confirmed which ensures consistency
209 		 * with `boot_write_img_confirmed...()` procedures.
210 		 */
211 		return true;
212 	}
213 
214 	return state.image_ok == BOOT_FLAG_SET;
215 }
216 
boot_write_img_confirmed(void)217 int boot_write_img_confirmed(void)
218 {
219 	const struct flash_area *fa;
220 	int rc = 0;
221 
222 	if (flash_area_open(ACTIVE_SLOT_FLASH_AREA_ID, &fa) != 0) {
223 		return -EIO;
224 	}
225 
226 	rc = boot_set_next(fa, true, true);
227 
228 	flash_area_close(fa);
229 
230 	return rc;
231 }
232 
boot_write_img_confirmed_multi(int image_index)233 int boot_write_img_confirmed_multi(int image_index)
234 {
235 	int rc;
236 
237 	rc = boot_set_confirmed_multi(image_index);
238 	if (rc) {
239 		return -EIO;
240 	}
241 
242 	return 0;
243 }
244 
boot_erase_img_bank(uint8_t area_id)245 int boot_erase_img_bank(uint8_t area_id)
246 {
247 	const struct flash_area *fa;
248 	int rc;
249 
250 	rc = flash_area_open(area_id, &fa);
251 	if (rc) {
252 		return rc;
253 	}
254 
255 	rc = flash_area_flatten(fa, 0, fa->fa_size);
256 
257 	flash_area_close(fa);
258 
259 	return rc;
260 }
261 
boot_get_trailer_status_offset(size_t area_size)262 ssize_t boot_get_trailer_status_offset(size_t area_size)
263 {
264 	return (ssize_t)area_size - BOOT_MAGIC_SZ - BOOT_MAX_ALIGN * 2;
265 }
266 
boot_get_area_trailer_status_offset(uint8_t area_id)267 ssize_t boot_get_area_trailer_status_offset(uint8_t area_id)
268 {
269 	int rc;
270 	const struct flash_area *fa;
271 	ssize_t offset;
272 
273 	rc = flash_area_open(area_id, &fa);
274 	if (rc) {
275 		return rc;
276 	}
277 
278 	offset = boot_get_trailer_status_offset(fa->fa_size);
279 
280 	flash_area_close(fa);
281 
282 	if (offset < 0) {
283 		return -EFAULT;
284 	}
285 
286 	return offset;
287 }
288