boot_info.c 20 KB

123456789101112131415161718192021222324252627282930313233343536373839404142434445464748495051525354555657585960616263646566676869707172737475767778798081828384858687888990919293949596979899100101102103104105106107108109110111112113114115116117118119120121122123124125126127128129130131132133134135136137138139140141142143144145146147148149150151152153154155156157158159160161162163164165166167168169170171172173174175176177178179180181182183184185186187188189190191192193194195196197198199200201202203204205206207208209210211212213214215216217218219220221222223224225226227228229230231232233234235236237238239240241242243244245246247248249250251252253254255256257258259260261262263264265266267268269270271272273274275276277278279280281282283284285286287288289290291292293294295296297298299300301302303304305306307308309310311312313314315316317318319320321322323324325326327328329330331332333334335336337338339340341342343344345346347348349350351352353354355356357358359360361362363364365366367368369370371372373374375376377378379380381382383384385386387388389390391392393394395396397398399400401402403404405406407408409410411412413414415416417418419420421422423424425426427428429430431432433434435436437438439440441442443444445446447448449450451452453454455456457458459460461462463464465466467468469470471472473474475476477478479480481482483484485486487488489490491492493494495496497498499500501502503504505506507508509510511512513514515516517518519520521522523524525526527528529530531532533534535536537538539540541542543544545546547548549550551552553554555556557558559560561562563564565566567568569570571572573574575576577578579580581582583584585586587588589590591592593594595596597598599600601602603604605606607608609610611612613614615616617618619620621622623624625626627628629630631632633634635636637638639640641642643644645646647648649650651652653654655656657658659660661662663664665666667668669670671672673674675676677678679680681682683684685686687688689690691692693
  1. /* Copyright Statement:
  2. *
  3. * This software/firmware and related documentation ("MediaTek Software") are
  4. * protected under relevant copyright laws. The information contained herein
  5. * is confidential and proprietary to MediaTek Inc. and/or its licensors.
  6. * Without the prior written permission of MediaTek inc. and/or its licensors,
  7. * any reproduction, modification, use or disclosure of MediaTek Software,
  8. * and information contained herein, in whole or in part, shall be strictly prohibited.
  9. */
  10. /* MediaTek Inc. (C) 2015. All rights reserved.
  11. *
  12. * BY OPENING THIS FILE, RECEIVER HEREBY UNEQUIVOCALLY ACKNOWLEDGES AND AGREES
  13. * THAT THE SOFTWARE/FIRMWARE AND ITS DOCUMENTATIONS ("MEDIATEK SOFTWARE")
  14. * RECEIVED FROM MEDIATEK AND/OR ITS REPRESENTATIVES ARE PROVIDED TO RECEIVER ON
  15. * AN "AS-IS" BASIS ONLY. MEDIATEK EXPRESSLY DISCLAIMS ANY AND ALL WARRANTIES,
  16. * EXPRESS OR IMPLIED, INCLUDING BUT NOT LIMITED TO THE IMPLIED WARRANTIES OF
  17. * MERCHANTABILITY, FITNESS FOR A PARTICULAR PURPOSE OR NONINFRINGEMENT.
  18. * NEITHER DOES MEDIATEK PROVIDE ANY WARRANTY WHATSOEVER WITH RESPECT TO THE
  19. * SOFTWARE OF ANY THIRD PARTY WHICH MAY BE USED BY, INCORPORATED IN, OR
  20. * SUPPLIED WITH THE MEDIATEK SOFTWARE, AND RECEIVER AGREES TO LOOK ONLY TO SUCH
  21. * THIRD PARTY FOR ANY WARRANTY CLAIM RELATING THERETO. RECEIVER EXPRESSLY ACKNOWLEDGES
  22. * THAT IT IS RECEIVER'S SOLE RESPONSIBILITY TO OBTAIN FROM ANY THIRD PARTY ALL PROPER LICENSES
  23. * CONTAINED IN MEDIATEK SOFTWARE. MEDIATEK SHALL ALSO NOT BE RESPONSIBLE FOR ANY MEDIATEK
  24. * SOFTWARE RELEASES MADE TO RECEIVER'S SPECIFICATION OR TO CONFORM TO A PARTICULAR
  25. * STANDARD OR OPEN FORUM. RECEIVER'S SOLE AND EXCLUSIVE REMEDY AND MEDIATEK'S ENTIRE AND
  26. * CUMULATIVE LIABILITY WITH RESPECT TO THE MEDIATEK SOFTWARE RELEASED HEREUNDER WILL BE,
  27. * AT MEDIATEK'S OPTION, TO REVISE OR REPLACE THE MEDIATEK SOFTWARE AT ISSUE,
  28. * OR REFUND ANY SOFTWARE LICENSE FEES OR SERVICE CHARGE PAID BY RECEIVER TO
  29. * MEDIATEK FOR SUCH MEDIATEK SOFTWARE AT ISSUE.
  30. */
  31. #include <string.h>
  32. #include <stdlib.h>
  33. #include <pal_typedefs.h>
  34. #include <pal_log.h>
  35. #include <pal_assert.h>
  36. #include <load_vfy_boot.h>
  37. #include <boot_info.h>
  38. #include <bootimg.h>
  39. #include <boot_opt.h>
  40. #include <img_workbuf.h>
  41. #include <platform/boot_mode.h>
  42. #include <part_interface.h>
  43. #include <mkimg.h>
  44. #include <odm_mdtbo.h>
  45. #include <ufdt_overlay.h>
  46. #include <platform/errno.h>
  47. #include <mt_boot.h>
  48. #include <target.h>
  49. static struct boot_info g_boot_info;
  50. /* get ramdisk image address when it's loaded */
  51. static uint32_t get_bootimg_ramdisk_load_addr(void)
  52. {
  53. int32_t kernel_sz = 0;
  54. uint32_t ramdisk_addr = 0;
  55. PAL_ASSERT(g_boot_info.hdr_loaded);
  56. PAL_ASSERT(g_boot_info.img_loaded);
  57. kernel_sz = get_kernel_sz();
  58. if (kernel_sz == 0)
  59. return 0;
  60. ramdisk_addr = g_boot_info.bootimg_load_addr + g_boot_info.page_sz +
  61. (uint32_t)kernel_sz;
  62. if (g_boot_info.kernel_with_mkimg_hdr)
  63. ramdisk_addr -= MKIMG_HDR_SZ;
  64. return (uint32_t)ramdisk_addr;
  65. }
  66. int relocate_ramdisk(uint32_t *ramdisk_addr, uint32_t *ramdisk_real_sz)
  67. {
  68. uint32_t ramdisk_load_addr;
  69. int ret = 0;
  70. PAL_ASSERT(g_boot_info.hdr_loaded);
  71. switch (g_boot_info.bootimg_hdr_version){
  72. case BOOT_HEADER_VERSION_THREE:
  73. /* vendor_boot ramdisk offset */
  74. ramdisk_load_addr = g_boot_info.vendorbootimg_load_addr
  75. + ROUNDUP(sizeof(struct vendor_boot_img_hdr_v3), g_boot_info.page_sz);
  76. PAL_ASSERT(g_boot_info.ramdisk_addr != 0);
  77. PAL_ASSERT(ramdisk_load_addr != 0);
  78. memcpy((void *)g_boot_info.ramdisk_addr,
  79. (void *)ramdisk_load_addr, g_boot_info.vendorboot_ramdisk_sz);
  80. /* concat boot image ramdisk */
  81. ramdisk_load_addr = get_bootimg_ramdisk_load_addr();
  82. memcpy((void *)(g_boot_info.ramdisk_addr + g_boot_info.vendorboot_ramdisk_sz),
  83. (void *)ramdisk_load_addr, g_boot_info.bootimg_ramdisk_sz);
  84. *ramdisk_addr = g_boot_info.ramdisk_addr;
  85. *ramdisk_real_sz = g_boot_info.bootimg_ramdisk_sz + g_boot_info.vendorboot_ramdisk_sz;
  86. break;
  87. case BOOT_HEADER_VERSION_TWO:
  88. case BOOT_HEADER_VERSION_ONE:
  89. case BOOT_HEADER_VERSION_ZERO:
  90. ramdisk_load_addr = get_bootimg_ramdisk_load_addr();
  91. PAL_ASSERT(g_boot_info.ramdisk_addr != 0);
  92. PAL_ASSERT(ramdisk_load_addr != 0);
  93. #if (!defined(SYSTEM_AS_ROOT) && !defined(MTK_RECOVERY_RAMDISK_SPLIT))
  94. PAL_ASSERT(g_boot_info.bootimg_ramdisk_sz != 0);
  95. #endif
  96. *ramdisk_addr = g_boot_info.ramdisk_addr;
  97. *ramdisk_real_sz = g_boot_info.bootimg_ramdisk_sz;
  98. memcpy((void *)g_boot_info.ramdisk_addr, (void *)ramdisk_load_addr, g_boot_info.bootimg_ramdisk_sz);
  99. break;
  100. default:
  101. pal_log_err("invalid boot image version\n");
  102. ret = -2;
  103. }
  104. return ret;
  105. }
  106. char *get_bootimg_partition_name(uint32_t bootimg_type)
  107. {
  108. char *result = NULL;
  109. switch (bootimg_type) {
  110. case BOOTIMG_TYPE_RECOVERY:
  111. #ifndef RECOVERY_AS_BOOT
  112. #ifdef MTK_GPT_SCHEME_SUPPORT
  113. result = "recovery";
  114. #else
  115. result = "RECOVERY";
  116. #endif
  117. break;
  118. #endif
  119. case BOOTIMG_TYPE_BOOT:
  120. #ifdef MTK_GPT_SCHEME_SUPPORT
  121. result = "boot";
  122. #else
  123. result = "BOOTIMG";
  124. #endif
  125. break;
  126. default:
  127. break;
  128. }
  129. return result;
  130. }
  131. static int decap_dtb_from_kernel(void *bootimg_addr)
  132. {
  133. unsigned int zimage_size;
  134. char *dtb_ptr;
  135. const char *dtb_sz;
  136. int ret = 0;
  137. uint32_t kernel_load_addr;
  138. const uint32_t fdt_magic_num = FDT_MAGIC;
  139. int i;
  140. if (!g_boot_info.hdr_loaded)
  141. return -2;
  142. if (g_is_64bit_kernel) {
  143. zimage_size = g_boot_info.kernel_sz;
  144. pal_log_info("64 bits kernel\n");
  145. pal_log_err("%s:boot image kernel_sz=0x%08x\n", __func__, zimage_size);
  146. dtb_ptr = (char *)(get_kernel_addr() + zimage_size);
  147. dtb_ptr -= 4;
  148. for (i = 0; i < (DTB_MAX_SIZE - 4); i++, dtb_ptr--) {
  149. /*
  150. * dtb append after image.gz may not 4 byte alignment
  151. */
  152. if (*(dtb_ptr + 3) == EXTRACT_UBYTE(fdt_magic_num, 0) &&
  153. *(dtb_ptr + 2) == EXTRACT_UBYTE(fdt_magic_num, 1) &&
  154. *(dtb_ptr + 1) == EXTRACT_UBYTE(fdt_magic_num, 2) &&
  155. *(dtb_ptr + 0) == EXTRACT_UBYTE(fdt_magic_num, 3)) {
  156. g_boot_info.dtb_load_addr = (uint32_t)dtb_ptr;
  157. break;
  158. }
  159. }
  160. if (g_boot_info.dtb_load_addr == 0) {
  161. pal_log_err("Can't find main device tree!\n");
  162. ret = -1;
  163. goto fail;
  164. }
  165. dtb_sz = dtb_ptr + 4;
  166. g_boot_info.dtb_img_size = (uint32_t)(*(dtb_sz) << 24) + (uint32_t)(*(dtb_sz + 1) << 16) +
  167. (uint32_t)(*(dtb_sz + 2) << 8) + (uint32_t)(*(dtb_sz + 3));
  168. zimage_size -= g_boot_info.dtb_img_size;
  169. g_boot_info.kernel_sz = zimage_size;
  170. pal_log_err("%s:zimage_size=0x%08x, g_boot_info.dtb_img_size=0x%08x\n", __func__,
  171. zimage_size, g_boot_info.dtb_img_size);
  172. } else {
  173. kernel_load_addr = get_kernel_addr();
  174. zimage_size = *(uint32_t *)((uint32_t)kernel_load_addr + 0x2c) -
  175. *(uint32_t *)((uint32_t)kernel_load_addr + 0x28);
  176. g_boot_info.kernel_sz = zimage_size;
  177. dtb_ptr = (char *)(get_kernel_addr() + zimage_size);
  178. g_boot_info.dtb_load_addr = (uint32_t)dtb_ptr;
  179. /* It is not sure zImage is four byte alignment */
  180. if (!(*(dtb_ptr + 3) == EXTRACT_UBYTE(fdt_magic_num, 0) &&
  181. *(dtb_ptr + 2) == EXTRACT_UBYTE(fdt_magic_num, 1) &&
  182. *(dtb_ptr + 1) == EXTRACT_UBYTE(fdt_magic_num, 2) &&
  183. *(dtb_ptr + 0) == EXTRACT_UBYTE(fdt_magic_num, 3))) {
  184. pal_log_err("Can't find main device tree!\n");
  185. ret = -1;
  186. goto fail;
  187. }
  188. dtb_sz = dtb_ptr + 4;
  189. g_boot_info.dtb_img_size = (uint32_t)(*(dtb_sz) << 24) + (uint32_t)(*(dtb_sz + 1) << 16) +
  190. (uint32_t)(*(dtb_sz + 2) << 8) + (uint32_t)(*(dtb_sz + 3));
  191. pal_log_err("%s:zimage_size=0x%08x, g_boot_info.dtb_img_size=0x%08x\n", __func__,
  192. zimage_size, g_boot_info.dtb_img_size);
  193. }
  194. fail:
  195. return ret;
  196. }
  197. static int decap_dtb_from_bootimg(void *bootimg_addr)
  198. {
  199. char *dtb_ptr;
  200. int ret = 0;
  201. if (!g_boot_info.hdr_loaded)
  202. return -2;
  203. dtb_ptr = (char *)(bootimg_addr + g_boot_info.page_sz
  204. + ROUNDUP(g_boot_info.kernel_sz, g_boot_info.page_sz)
  205. + ROUNDUP(g_boot_info.bootimg_ramdisk_sz, g_boot_info.page_sz)
  206. + ROUNDUP(g_boot_info.second_sz, g_boot_info.page_sz)
  207. + ROUNDUP(g_boot_info.recovery_dtbo_size, g_boot_info.page_sz));
  208. if (g_boot_info.dtb_img_size == 0) {
  209. pal_log_err("can't find v2 dtb\n");
  210. ret = -1;
  211. goto fail;
  212. }
  213. /* Check dtb format comes with mkdtimg (table_header+table_entry+fdt_body) */
  214. if (DT_TABLE_MAGIC == fdt_magic(dtb_ptr))
  215. {
  216. struct dt_table_header *dt_tbl_hdr = (struct dt_table_header *)dtb_ptr;
  217. uint32_t dt_entry_count = fdt32_to_cpu(dt_tbl_hdr->dt_entry_count);
  218. g_boot_info.dtb_load_addr = (uint32_t)dtb_ptr + sizeof(struct dt_table_header)
  219. + dt_entry_count * sizeof(struct dt_table_entry);
  220. }
  221. else if (FDT_MAGIC == fdt_magic(dtb_ptr))
  222. g_boot_info.dtb_load_addr = (uint32_t)dtb_ptr;
  223. else {
  224. pal_log_err("main dtb is not packed with valid fdt format!\n");
  225. ret = -2;
  226. goto fail;
  227. }
  228. g_boot_info.dtb_img_size = fdt_totalsize(g_boot_info.dtb_load_addr);
  229. fail:
  230. return ret;
  231. }
  232. static int decap_dtbo_from_bootimg(void *bootimg_addr)
  233. {
  234. struct dt_table_header *dt_tbl_hdr_buffer;
  235. uint32_t dtbo_idx;
  236. uint32_t dtbo_offset = 0;
  237. int ret = 0;
  238. if (!g_boot_info.hdr_loaded)
  239. return -2;
  240. /* this boot image is recovery image if recovery_dtbo_offset is not 0 */
  241. if (g_boot_info.recovery_dtbo_offset) {
  242. dt_tbl_hdr_buffer = (struct dt_table_header *)(g_boot_info.bootimg_load_addr + (uint32_t) g_boot_info.recovery_dtbo_offset);
  243. ret = parse_dtbo_tbl(dt_tbl_hdr_buffer, (uint32_t)get_odm_mdtbo_index(),
  244. &dtbo_idx,
  245. (uint32_t *)&(g_boot_info.dtbo_img_size), (uint32_t *)&dtbo_offset);
  246. if (ret == 0) {
  247. pal_log_err("%s dtbo_offset: %d, dtbo_size: %d\n", __func__, dtbo_offset, g_boot_info.dtbo_img_size);
  248. g_boot_info.dtbo_load_addr = g_boot_info.bootimg_load_addr + g_boot_info.recovery_dtbo_offset + dtbo_offset;
  249. } else {
  250. pal_log_err("parse_dtbo_tbl fail!\n");
  251. ret = -1;
  252. return ret;
  253. }
  254. }
  255. return ret;
  256. }
  257. static int decap_dtb_from_vendorbootimg(void *vendorbootimg_addr)
  258. {
  259. char *dtb_ptr;
  260. int ret = 0;
  261. if (!g_boot_info.hdr_loaded)
  262. return -2;
  263. dtb_ptr = (char *)(vendorbootimg_addr + ROUNDUP(sizeof(struct vendor_boot_img_hdr_v3), g_boot_info.page_sz)
  264. + ROUNDUP(g_boot_info.vendorboot_ramdisk_sz, g_boot_info.page_sz));
  265. if (g_boot_info.dtb_img_size == 0) {
  266. pal_log_err("can't find dtb\n");
  267. ret = -1;
  268. goto fail;
  269. }
  270. /* Check dtb format comes with mkdtimg (table_header+table_entry+fdt_body) */
  271. if (DT_TABLE_MAGIC == fdt_magic(dtb_ptr))
  272. {
  273. struct dt_table_header *dt_tbl_hdr = (struct dt_table_header *)dtb_ptr;
  274. uint32_t dt_entry_count = fdt32_to_cpu(dt_tbl_hdr->dt_entry_count);
  275. g_boot_info.dtb_load_addr = (uint32_t)dtb_ptr + sizeof(struct dt_table_header)
  276. + dt_entry_count * sizeof(struct dt_table_entry);
  277. }
  278. else if (FDT_MAGIC == fdt_magic(dtb_ptr))
  279. g_boot_info.dtb_load_addr = (uint32_t)dtb_ptr;
  280. else {
  281. pal_log_err("main dtb is not packed with valid fdt format!\n");
  282. ret = -2;
  283. goto fail;
  284. }
  285. g_boot_info.dtb_img_size = fdt_totalsize(g_boot_info.dtb_load_addr);
  286. fail:
  287. return ret;
  288. }
  289. static int vendorbootimg_decap(void *vendorbootimg_addr)
  290. {
  291. int ret = 0;
  292. struct vendor_boot_img_hdr_v3 *vendorboot_v3_ptr = (struct vendor_boot_img_hdr_v3 *)vendorbootimg_addr;
  293. if (!vendorbootimg_addr) {
  294. pal_log_err("vendor_boot image is NULL\n");
  295. ret = -1;
  296. goto end;
  297. }
  298. g_boot_info.vendorbootimg_load_addr = (uint32_t)vendorboot_v3_ptr;
  299. g_boot_info.dtb_img_size = vendorboot_v3_ptr->dtb_size;
  300. g_boot_info.tags_addr = vendorboot_v3_ptr->tags_addr;
  301. /* boot image v3 fixed at 4096 bytes */
  302. g_boot_info.page_sz = 4096;
  303. g_boot_info.kernel_addr = vendorboot_v3_ptr->kernel_addr;
  304. g_boot_info.vendorboot_ramdisk_sz = vendorboot_v3_ptr->vendor_ramdisk_size;
  305. g_boot_info.ramdisk_addr = vendorboot_v3_ptr->ramdisk_addr;
  306. /* parse cmdline */
  307. platform_parse_bootopt(vendorboot_v3_ptr->cmdline);
  308. end:
  309. return ret;
  310. }
  311. static int bootimg_decap(void *bootimg_addr)
  312. {
  313. struct bootimg_hdr *pbootimg = bootimg_addr;
  314. struct boot_img_hdr_v3 *bootimg_v3_ptr = (struct boot_img_hdr_v3 *)bootimg_addr;
  315. struct vendor_boot_img_hdr_v3 *vendorboot_v3_ptr = (struct vendor_boot_img_hdr_v3 *)get_img_work_buf("vendor_boot");
  316. int ret = 0;
  317. if (!pbootimg) {
  318. pal_log_err("boot image is NULL\n");
  319. ret = -3;
  320. goto end;
  321. }
  322. if (FALSE == bootimg_hdr_valid((uint8_t *)pbootimg)) {
  323. pal_log_err("invalid boot image header\n");
  324. ret = -1;
  325. goto end;
  326. }
  327. g_boot_info.bootimg_hdr_version = pbootimg->header_version;
  328. g_boot_info.bootimg_load_addr = (uint32_t)pbootimg;
  329. switch (pbootimg->header_version) {
  330. case BOOT_HEADER_VERSION_THREE:
  331. g_boot_info.kernel_sz = bootimg_v3_ptr->kernel_size;
  332. g_boot_info.bootimg_ramdisk_sz = bootimg_v3_ptr->ramdisk_size;
  333. g_boot_info.bootimg_os_version = bootimg_v3_ptr->os_version;
  334. g_boot_info.second_addr = 0;
  335. g_boot_info.second_sz= 0;
  336. if (vendorbootimg_decap(vendorboot_v3_ptr) < 0) {
  337. pal_log_err("invalid vendorboot image header\n");
  338. ret = -4;
  339. goto end;
  340. }
  341. /* concat boot cmdline to vendor_boot cmdline */
  342. cmdline_append((const char *)vendorboot_v3_ptr->cmdline);
  343. cmdline_append((const char *)bootimg_v3_ptr->cmdline);
  344. break;
  345. case BOOT_HEADER_VERSION_TWO:
  346. g_boot_info.dtb_img_size = pbootimg->dtb_size;
  347. case BOOT_HEADER_VERSION_ONE:
  348. g_boot_info.recovery_dtbo_offset = pbootimg->recovery_dtbo_offset;
  349. g_boot_info.recovery_dtbo_size = pbootimg->recovery_dtbo_size;
  350. case BOOT_HEADER_VERSION_ZERO:
  351. g_boot_info.tags_addr = pbootimg->tags_addr;
  352. g_boot_info.page_sz = pbootimg->page_sz;
  353. g_boot_info.kernel_sz = pbootimg->kernel_sz;
  354. g_boot_info.kernel_addr = pbootimg->kernel_addr;
  355. g_boot_info.second_addr = pbootimg->second_addr;
  356. g_boot_info.second_sz= pbootimg->second_sz;
  357. g_boot_info.ramdisk_addr = pbootimg->ramdisk_addr;
  358. g_boot_info.bootimg_ramdisk_sz = pbootimg->ramdisk_sz;
  359. g_boot_info.bootimg_os_version = pbootimg->os_version;
  360. /* parse cmdline */
  361. platform_parse_bootopt(pbootimg->cmdline);
  362. /* ensure commandline is terminated */
  363. pbootimg->cmdline[BOOTIMG_ARGS_SZ - 1] = 0;
  364. /* append cmdline from bootimg hdr */
  365. cmdline_append((const char *)pbootimg->cmdline);
  366. break;
  367. default:
  368. pal_log_err("invalid boot image version\n");
  369. ret = -2;
  370. }
  371. g_boot_info.hdr_loaded = 1;
  372. end:
  373. return ret;
  374. }
  375. int load_bootinfo_bootimg(void *bootimg_addr)
  376. {
  377. int ret = 0;
  378. struct bootimg_hdr boot_hdr;
  379. void *bootimg_ptr;
  380. bootimg_ptr = get_img_work_buf("boot");
  381. if (bootimg_decap(bootimg_ptr) != 0)
  382. panic("boot image decapsulate fail!\n");
  383. boot_hdr.kernel_addr = g_boot_info.kernel_addr;
  384. boot_hdr.kernel_sz = g_boot_info.kernel_sz;
  385. boot_hdr.ramdisk_addr = g_boot_info.ramdisk_addr;
  386. #ifdef LK_RAMDISK_MAX_SIZE
  387. boot_hdr.ramdisk_sz = LK_RAMDISK_MAX_SIZE;
  388. #else
  389. boot_hdr.ramdisk_sz = g_boot_info.bootimg_ramdisk_sz + g_boot_info.vendorboot_ramdisk_sz;
  390. #endif
  391. boot_hdr.tags_addr = g_boot_info.tags_addr;
  392. if (!boot_hdr.kernel_addr)
  393. #ifdef LK_DYNAMIC_KERNEL_64_MAX_SIZE
  394. boot_hdr.kernel_addr = KERNEL_MBLOCK_LIMIT - LK_DYNAMIC_KERNEL_64_MAX_SIZE;
  395. #else
  396. boot_hdr.kernel_addr = KERNEL_MBLOCK_LIMIT - LK_KERNEL_64_MAX_SIZE;
  397. #endif
  398. if (!boot_hdr.ramdisk_addr)
  399. boot_hdr.ramdisk_addr = KERNEL_MBLOCK_LIMIT - ROUNDUP(boot_hdr.ramdisk_sz, PAGE_SIZE);
  400. if (!boot_hdr.tags_addr)
  401. boot_hdr.tags_addr = KERNEL_MBLOCK_LIMIT - DTB_MAX_SIZE;
  402. mboot_allocate_bootimg_from_mblock(&boot_hdr);
  403. g_boot_info.kernel_addr = boot_hdr.kernel_addr;
  404. g_boot_info.ramdisk_addr = boot_hdr.ramdisk_addr;
  405. g_boot_info.tags_addr = boot_hdr.tags_addr;
  406. setup_kernel_fdt((void *)g_boot_info.tags_addr);
  407. switch(g_boot_info.bootimg_hdr_version) {
  408. case BOOT_HEADER_VERSION_THREE:
  409. ret = decap_dtb_from_vendorbootimg((void *)g_boot_info.vendorbootimg_load_addr);
  410. break;
  411. case BOOT_HEADER_VERSION_TWO:
  412. ret = decap_dtb_from_bootimg((void *)g_boot_info.bootimg_load_addr);
  413. ret += decap_dtbo_from_bootimg((void *)g_boot_info.bootimg_load_addr);
  414. break;
  415. case BOOT_HEADER_VERSION_ONE:
  416. ret = decap_dtb_from_kernel((void *)g_boot_info.bootimg_load_addr);
  417. ret += decap_dtbo_from_bootimg((void *)g_boot_info.bootimg_load_addr);
  418. break;
  419. case BOOT_HEADER_VERSION_ZERO:
  420. ret = decap_dtb_from_kernel((void *)g_boot_info.bootimg_load_addr);
  421. break;
  422. }
  423. return ret;
  424. }
  425. uint32_t bootimg_hdr_valid(uint8_t *buf)
  426. {
  427. if (strncmp((char *)buf, BOOTIMG_MAGIC, BOOTIMG_MAGIC_SZ) == 0)
  428. return 1;
  429. else
  430. return 0;
  431. }
  432. uint32_t mkimg_hdr_valid(uint8_t *buf)
  433. {
  434. union mkimg_hdr *l_mkimg_hdr = (union mkimg_hdr *)buf;
  435. if (l_mkimg_hdr->info.magic == MKIMG_MAGIC)
  436. return 1;
  437. else
  438. return 0;
  439. }
  440. uint32_t load_bootimg_hdr(uint32_t bootimg_type)
  441. {
  442. uint32_t ret = 0;
  443. char *part_name = NULL;
  444. unsigned long len;
  445. union mkimg_hdr mkimg_hdr_inst;
  446. struct bootimg_hdr boot_hdr;
  447. /* boot image header could be loaded only once */
  448. if (g_boot_info.hdr_loaded)
  449. return 0;
  450. part_name = get_bootimg_partition_name(bootimg_type);
  451. if (part_name == NULL) {
  452. pal_log_err("unknown boot image type: 0x%x\n", bootimg_type);
  453. return -1;
  454. }
  455. len = partition_read(part_name,
  456. (off_t)0,
  457. (uint8_t *)&boot_hdr,
  458. sizeof(boot_hdr));
  459. if (len != sizeof(boot_hdr)) {
  460. pal_log_err("boot image load fail: 0x%lu\n", len);
  461. return -1;
  462. }
  463. len = partition_read(part_name,
  464. (off_t)BOOTIMG_HDR_SZ,
  465. (uint8_t *)&mkimg_hdr_inst,
  466. sizeof(mkimg_hdr_inst.info));
  467. if (len != sizeof(mkimg_hdr_inst.info)) {
  468. pal_log_err("mkimg header load fail: 0x%lu\n", len);
  469. return -1;
  470. }
  471. if (FALSE == bootimg_hdr_valid((uint8_t *)&boot_hdr)) {
  472. pal_log_err("invalid boot image header\n");
  473. return -1;
  474. }
  475. if (mkimg_hdr_valid((uint8_t *)&mkimg_hdr_inst))
  476. g_boot_info.kernel_with_mkimg_hdr = 1;
  477. if (0 == ret) {
  478. g_boot_info.hdr_loaded = 1;
  479. g_boot_info.type = bootimg_type;
  480. }
  481. platform_parse_bootopt(boot_hdr.cmdline);
  482. return ret;
  483. }
  484. uint32_t get_recovery_dtbo_sz(void)
  485. {
  486. PAL_ASSERT(g_boot_info.hdr_loaded);
  487. return (uint32_t)g_boot_info.recovery_dtbo_size;
  488. }
  489. uint64_t get_recovery_dtbo_offset(void)
  490. {
  491. PAL_ASSERT(g_boot_info.hdr_loaded);
  492. return (uint64_t)g_boot_info.recovery_dtbo_offset;
  493. }
  494. uint32_t get_page_sz(void)
  495. {
  496. PAL_ASSERT(g_boot_info.hdr_loaded);
  497. return (uint32_t)g_boot_info.page_sz;
  498. }
  499. /* get final kernel image location (after relocation) */
  500. uint32_t get_kernel_target_addr(void)
  501. {
  502. PAL_ASSERT(g_boot_info.hdr_loaded);
  503. return (uint32_t)g_boot_info.kernel_addr;
  504. }
  505. /* get kernel image address when it's loaded */
  506. uint32_t get_kernel_addr(void)
  507. {
  508. uint32_t kernel_addr = 0;
  509. PAL_ASSERT(g_boot_info.hdr_loaded);
  510. kernel_addr = g_boot_info.bootimg_load_addr + g_boot_info.page_sz;
  511. return (uint32_t)kernel_addr;
  512. }
  513. int32_t get_kernel_sz(void)
  514. {
  515. uint32_t page_sz = 0;
  516. uint32_t kernel_sz = 0;
  517. int32_t out_kernel_sz = 0;
  518. PAL_ASSERT(g_boot_info.hdr_loaded);
  519. kernel_sz = g_boot_info.kernel_sz;
  520. page_sz = g_boot_info.page_sz;
  521. out_kernel_sz = (int32_t)(((kernel_sz + page_sz - 1) / page_sz) *
  522. page_sz);
  523. return out_kernel_sz;
  524. }
  525. uint32_t get_kernel_real_sz(void)
  526. {
  527. PAL_ASSERT(g_boot_info.hdr_loaded);
  528. return g_boot_info.kernel_sz;
  529. }
  530. /* get final ramdisk image location (after relocation) */
  531. uint32_t get_ramdisk_target_addr(void)
  532. {
  533. PAL_ASSERT(g_boot_info.hdr_loaded);
  534. return (uint32_t)g_boot_info.ramdisk_addr;
  535. }
  536. uint32_t get_tags_addr(void)
  537. {
  538. PAL_ASSERT(g_boot_info.hdr_loaded);
  539. return (uint32_t)g_boot_info.tags_addr;
  540. }
  541. uint32_t get_os_version(void)
  542. {
  543. PAL_ASSERT(g_boot_info.hdr_loaded);
  544. return (uint32_t)g_boot_info.bootimg_os_version;
  545. }
  546. uint32_t get_header_version(void)
  547. {
  548. PAL_ASSERT(g_boot_info.hdr_loaded);
  549. return (uint32_t)g_boot_info.bootimg_hdr_version;
  550. }
  551. uint32_t get_main_dtb_size(void)
  552. {
  553. if (!g_boot_info.hdr_loaded)
  554. pal_log_err("%s: g_boot_info.hdr_loaded is 0\n", __func__);
  555. return (uint32_t)g_boot_info.dtb_img_size;
  556. }
  557. uint32_t get_main_dtb_load_addr(void)
  558. {
  559. if (!g_boot_info.hdr_loaded)
  560. pal_log_err("%s: g_boot_info.hdr_loaded is 0\n", __func__);
  561. return (uint32_t)g_boot_info.dtb_load_addr;
  562. }
  563. uint32_t get_dtbo_load_addr(void)
  564. {
  565. return g_boot_info.dtbo_load_addr;
  566. }
  567. uint32_t get_dtbo_img_size(void)
  568. {
  569. return g_boot_info.dtbo_img_size;
  570. }
  571. void set_bootimg_loaded(uint32_t addr)
  572. {
  573. PAL_ASSERT(g_boot_info.hdr_loaded);
  574. g_boot_info.img_loaded = 1;
  575. }
  576. void set_recovery_dtbo_loaded(void)
  577. {
  578. g_boot_info.recovery_dtbo_loaded = 1;
  579. return;
  580. }
  581. uint32_t get_recovery_dtbo_loaded(void)
  582. {
  583. return (uint32_t)g_boot_info.recovery_dtbo_loaded;
  584. }
  585. void set_bootimg_verified(void)
  586. {
  587. g_boot_info.verified = 1;
  588. return;
  589. }
  590. void set_bootimg_verify_skipped(void)
  591. {
  592. g_boot_info.vfy_skipped = 1;
  593. return;
  594. }
  595. void set_dtbo_load_addr(uint32_t dtbo_load_addr)
  596. {
  597. assert(dtbo_load_addr != 0);
  598. g_boot_info.dtbo_load_addr = dtbo_load_addr;
  599. }
  600. void set_dtbo_img_size(uint32_t dtbo_img_size)
  601. {
  602. assert(dtbo_img_size != 0);
  603. g_boot_info.dtbo_img_size = dtbo_img_size;
  604. }
  605. void set_recovery_img_loaded(void)
  606. {
  607. g_boot_info.recovery_img_loaded = 1;
  608. }
  609. uint32_t get_recovery_img_loaded(void)
  610. {
  611. return (uint32_t)g_boot_info.recovery_img_loaded;
  612. }