KEDump.c 41 KB

12345678910111213141516171819202122232425262728293031323334353637383940414243444546474849505152535455565758596061626364656667686970717273747576777879808182838485868788899091929394959697989910010110210310410510610710810911011111211311411511611711811912012112212312412512612712812913013113213313413513613713813914014114214314414514614714814915015115215315415515615715815916016116216316416516616716816917017117217317417517617717817918018118218318418518618718818919019119219319419519619719819920020120220320420520620720820921021121221321421521621721821922022122222322422522622722822923023123223323423523623723823924024124224324424524624724824925025125225325425525625725825926026126226326426526626726826927027127227327427527627727827928028128228328428528628728828929029129229329429529629729829930030130230330430530630730830931031131231331431531631731831932032132232332432532632732832933033133233333433533633733833934034134234334434534634734834935035135235335435535635735835936036136236336436536636736836937037137237337437537637737837938038138238338438538638738838939039139239339439539639739839940040140240340440540640740840941041141241341441541641741841942042142242342442542642742842943043143243343443543643743843944044144244344444544644744844945045145245345445545645745845946046146246346446546646746846947047147247347447547647747847948048148248348448548648748848949049149249349449549649749849950050150250350450550650750850951051151251351451551651751851952052152252352452552652752852953053153253353453553653753853954054154254354454554654754854955055155255355455555655755855956056156256356456556656756856957057157257357457557657757857958058158258358458558658758858959059159259359459559659759859960060160260360460560660760860961061161261361461561661761861962062162262362462562662762862963063163263363463563663763863964064164264364464564664764864965065165265365465565665765865966066166266366466566666766866967067167267367467567667767867968068168268368468568668768868969069169269369469569669769869970070170270370470570670770870971071171271371471571671771871972072172272372472572672772872973073173273373473573673773873974074174274374474574674774874975075175275375475575675775875976076176276376476576676776876977077177277377477577677777877978078178278378478578678778878979079179279379479579679779879980080180280380480580680780880981081181281381481581681781881982082182282382482582682782882983083183283383483583683783883984084184284384484584684784884985085185285385485585685785885986086186286386486586686786886987087187287387487587687787887988088188288388488588688788888989089189289389489589689789889990090190290390490590690790890991091191291391491591691791891992092192292392492592692792892993093193293393493593693793893994094194294394494594694794894995095195295395495595695795895996096196296396496596696796896997097197297397497597697797897998098198298398498598698798898999099199299399499599699799899910001001100210031004100510061007100810091010101110121013101410151016101710181019102010211022102310241025102610271028102910301031103210331034103510361037103810391040104110421043104410451046104710481049105010511052105310541055105610571058105910601061106210631064106510661067106810691070107110721073107410751076107710781079108010811082108310841085108610871088108910901091109210931094109510961097109810991100110111021103110411051106110711081109111011111112111311141115111611171118111911201121112211231124112511261127112811291130113111321133113411351136113711381139114011411142114311441145114611471148114911501151115211531154115511561157115811591160116111621163116411651166116711681169117011711172117311741175117611771178117911801181118211831184118511861187118811891190119111921193119411951196119711981199120012011202120312041205120612071208120912101211121212131214121512161217121812191220122112221223122412251226122712281229123012311232123312341235123612371238123912401241124212431244124512461247124812491250125112521253125412551256125712581259126012611262126312641265126612671268126912701271127212731274127512761277127812791280128112821283128412851286128712881289129012911292
  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) 2016. 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 <stdio.h>
  32. #include <string.h>
  33. #include <stdlib.h>
  34. #include <arch/arm/mmu.h>
  35. #ifdef MTK_GPT_SCHEME_SUPPORT
  36. #include <platform/partition.h>
  37. #else
  38. #include <mt_partition.h>
  39. #endif
  40. #include <platform/boot_mode.h>
  41. #include <platform/ram_console.h>
  42. #include <platform/mt_reg_base.h>
  43. #include <platform/mt_rtc.h>
  44. #include <dev/aee_platform_debug.h>
  45. #include "mrdump_elf.h"
  46. #include "KEHeader.h"
  47. #include <lib/zlib.h>
  48. #ifdef MTK_3LEVEL_PAGETABLE
  49. #include <err.h>
  50. #include <target.h>
  51. #endif
  52. #ifdef MTK_MRDUMP_SRAM_CB
  53. #include <platform/mtk_mrdump.h>
  54. #endif
  55. #include <platform/mtk_wdt.h>
  56. #include <part_interface.h>
  57. #include "mrdump_private.h"
  58. #include <log_store_lk.h>
  59. #include <boot_info.h>
  60. #include <load_vfy_boot.h>
  61. enum {
  62. AEE_LKDUMP_CLEAR = 0,
  63. AEE_LKDUMP_RAMCONSOLE_RAW,
  64. AEE_LKDUMP_PSTORE_RAW,
  65. AEE_LKDUMP_KEDUMP_CRC,
  66. AEE_LKDUMP_MINI_RDUMP,
  67. AEE_LKDUMP_PROC_CUR_TSK, //5
  68. AEE_LKDUMP_KERNEL_LOG_RAW,
  69. AEE_LKDUMP_DISP_DEBUG_RAW,
  70. AEE_LKDUMP_DFD20,
  71. AEE_LKDUMP_LAST_DRAM,
  72. AEE_LKDUMP_LAST_CPU_BUS, //10
  73. AEE_LKDUMP_LAST_SPM_DATA,
  74. AEE_LKDUMP_LAST_SPM_SRAM_DATA,
  75. AEE_LKDUMP_ATF_LAST,
  76. AEE_LKDUMP_ATF_CRASH,
  77. AEE_LKDUMP_ATF_RAW,
  78. AEE_LKDUMP_ATF_RDUMP, //16
  79. AEE_LKDUMP_CPU_HVFS_RAW,
  80. AEE_LKDUMP_SSPM_COREDUMP,
  81. AEE_LKDUMP_SSPM_DATA,
  82. AEE_LKDUMP_SSPM_XFILE,
  83. AEE_LKDUMP_SSPM_LAST_LOG, //21
  84. AEE_LKDUMP_PLLK_LAST_LOG,
  85. AEE_LKDUMP_MCDI_DATA,
  86. AEE_LKDUMP_SCP_COREDUMP,
  87. AEE_LKDUMP_LAST_INFRA_CG,
  88. AEE_LKDUMP_ADSP_COREDUMP,
  89. AEE_LKDUMP_MCUPM_COREDUMP,
  90. AEE_LKDUMP_MCUPM_DATA,
  91. AEE_LKDUMP_MCUPM_XFILE,
  92. AEE_LKDUMP_MCUPM_LAST_LOG,
  93. //new added before this line please
  94. AEE_LKDUMP_ZAEE_LOG,
  95. AEE_LKDUMP_HEADER,
  96. #ifdef MTK_PICACHU_SUPPORT
  97. AEE_LKDUMP_PICACHU_LOG,
  98. #endif
  99. AEE_LKDUMP_UNKNOWN
  100. };
  101. static struct aee_db_file_info adfi[AEE_PLAT_DEBUG_NUM] = {
  102. [AEE_PLAT_DFD20] = { "DFD20.dfd", 0x40000, AEE_LKDUMP_DFD20}, /* 256 KB */
  103. [AEE_PLAT_DRAM] = { "SYS_LAST_DRAM", 0x2400, AEE_LKDUMP_LAST_DRAM}, /* 9 KB */
  104. [AEE_PLAT_CPU_BUS] = { "SYS_LAST_CPU_BUS", 0x10000, AEE_LKDUMP_LAST_CPU_BUS}, /* 64 KB */
  105. [AEE_PLAT_SPM_DATA] = { "SYS_LAST_SPM_DATA", 0x1000, AEE_LKDUMP_LAST_SPM_DATA}, /* 4 KB */
  106. [AEE_PLAT_SPM_SRAM_DATA] = { "SYS_LAST_SPM_SRAM_DATA", 0x1000, AEE_LKDUMP_LAST_SPM_SRAM_DATA}, /* 4 KB */
  107. [AEE_PLAT_ATF_LAST_LOG] = { "SYS_ATF_LAST", 0x20000, AEE_LKDUMP_ATF_LAST}, /* 128KB */
  108. [AEE_PLAT_ATF_CRASH_REPORT] = { "SYS_ATF_CRASH", 0x30000, AEE_LKDUMP_ATF_CRASH}, /* 64KB+128KB */
  109. [AEE_PLAT_ATF_RAW_LOG] = { "SYS_ATF_RAW_LOG", 0x60000, AEE_LKDUMP_ATF_RAW}, /* 384 KB */
  110. [AEE_PLAT_ATF_RDUMP_LOG] = { "SYS_ATF_RDUMP", 0x80000, AEE_LKDUMP_ATF_RDUMP }, /* 512KB */
  111. [AEE_PLAT_HVFS] = { "SYS_CPUHVFS_RAW", 0x3000, AEE_LKDUMP_CPU_HVFS_RAW}, /* 12 KB */
  112. #ifdef MTK_TINYSYS_SSPM_SUPPORT
  113. [AEE_PLAT_SSPM_COREDUMP] = { "SYS_SSPM_COREDUMP", 0x40080, AEE_LKDUMP_SSPM_COREDUMP}, /* 256KB + 128Byte */
  114. [AEE_PLAT_SSPM_DATA] = { "SYS_SSPM_DATA", 0x400, AEE_LKDUMP_SSPM_DATA}, /* 1KB */
  115. [AEE_PLAT_SSPM_XFILE] = { "SYS_SSPM_XFILE", 0xA0000, AEE_LKDUMP_SSPM_XFILE}, /* 640KB */
  116. [AEE_PLAT_SSPM_LAST_LOG] = { "SYS_SSPM_LAST_LOG", 0x400, AEE_LKDUMP_SSPM_LAST_LOG}, /* 1KB */
  117. #endif
  118. [AEE_PLAT_PLLK_LAST_LOG] = { "SYS_PLLK_LAST_LOG", 0x40000, AEE_LKDUMP_PLLK_LAST_LOG}, /* 256KB */
  119. [AEE_PLAT_LOG_DUR_LKDUMP] = { "SYS_LOG_DUR_LKDUMP", 0x40000, AEE_PLAT_LOG_DUR_LKDUMP}, /* 256KB */
  120. [AEE_PLAT_MCDI_DATA] = { "SYS_MCDI_DATA", 0x800, AEE_LKDUMP_MCDI_DATA}, /* 2KB, size will modified by plat. */
  121. #ifdef MTK_TINYSYS_SCP_SUPPORT
  122. [AEE_PLAT_SCP_COREDUMP] = { "SYS_SCP_DUMP.gz", 0xA0000, AEE_LKDUMP_SCP_COREDUMP}, /* 640KB */
  123. #endif
  124. [AEE_PLAT_INFRA_CG] = { "SYS_LAST_INFRA_CG", 0x1000, AEE_LKDUMP_LAST_INFRA_CG}, /* 4 KB */
  125. #ifdef MTK_AUDIODSP_SUPPORT
  126. [AEE_PLAT_ADSP_COREDUMP] = { "SYS_ADSP_COREDUMP", 0x11000, AEE_LKDUMP_ADSP_COREDUMP}, /* 68KB */
  127. #endif
  128. #ifdef MTK_TINYSYS_MCUPM_SUPPORT
  129. [AEE_PLAT_MCUPM_COREDUMP] = { "SYS_MCUPM_COREDUMP", 0x40080, AEE_LKDUMP_MCUPM_COREDUMP}, /* 256KB + 128Byte */
  130. [AEE_PLAT_MCUPM_DATA] = { "SYS_MCUPM_DATA", 0x400, AEE_LKDUMP_MCUPM_DATA}, /* 1KB */
  131. [AEE_PLAT_MCUPM_XFILE] = { "SYS_MCUPM_XFILE", 0xA0000, AEE_LKDUMP_MCUPM_XFILE}, /* 640KB */
  132. [AEE_PLAT_MCUPM_LAST_LOG] = { "SYS_MCUPM_LAST_LOG", 0x400, AEE_LKDUMP_MCUPM_LAST_LOG}, /* 1KB */
  133. #endif
  134. #ifdef MTK_PICACHU_SUPPORT
  135. [AEE_PLAT_PICACHU_LOG] = { "SYS_PICACHU_LOG", 0x80000, AEE_LKDUMP_PICACHU_LOG}, /* 512 KB */
  136. #endif
  137. };
  138. struct aee_db_file_info* get_file_info(void)
  139. {
  140. return adfi;
  141. }
  142. /**************************/
  143. /* ---------------- */
  144. /* RAM_CONSOLE_DRAM_ADDR */
  145. /* (1M align) */
  146. /* +RAM_CONSOLE_DRAM_SIZE */
  147. /* */
  148. /* ---------------- */
  149. /* +0xe0000 */
  150. /* */
  151. /* ---------------- */
  152. /* KE_RESERVED_MEM_ADDR */
  153. /* */
  154. /* ---------------- */
  155. /* RAMDISK_LOAD_ADDR */
  156. /**************************/
  157. static unsigned int ke_reserved_mem_addr_atag(void)
  158. {
  159. unsigned int addr;
  160. unsigned int size;
  161. mrdump_mini_header_addr_size(&addr, &size);
  162. return addr;
  163. }
  164. #define KE_RESERVED_MEM_ADDR ke_reserved_mem_addr_atag()
  165. #define EXPDB_RESERVED_OTHER (3 * 1024 * 1024) //reserved expdb for control block and pl/lk log
  166. #if defined(MTK_MLC_NAND_SUPPORT) || defined(MTK_TLC_NAND_SUPPORT)
  167. #define MEM_EXPDB_SIZE 0x300000
  168. static char *mem_expdb;
  169. #endif
  170. struct ke_dev {
  171. part_dev_t *dev;
  172. uint part_id;
  173. u64 ptn;
  174. u64 part_size;
  175. };
  176. static struct ke_dev dev;
  177. struct elfhdr {
  178. void *start;
  179. unsigned int e_machine;
  180. unsigned int e_phoff;
  181. unsigned int e_phnum;
  182. };
  183. struct kedump_crc {
  184. unsigned int ram_console_crc;
  185. unsigned int pstore_crc;
  186. };
  187. static struct kedump_crc kc;
  188. extern BOOT_ARGUMENT *g_boot_arg;
  189. #define SZLOG 20480
  190. static char logbuf[SZLOG];
  191. extern bool ram_console_should_restore(unsigned char *tmp_ram_console);
  192. #ifdef MTK_PMIC_FULL_RESET
  193. extern bool ram_console_reboot_by_cold_reset(void);
  194. #endif
  195. int check_ram_console_is_abnormal_boot(void)
  196. {
  197. return ram_console_is_abnormal_boot();
  198. }
  199. static unsigned int last_dump_step;
  200. int sLOG(char *fmt, ...)
  201. {
  202. va_list args;
  203. static int pos = 0;
  204. va_start(args, fmt);
  205. if (pos < SZLOG - 1) /* vsnprintf bug */
  206. pos += vsnprintf(logbuf + pos, SZLOG - pos - 1, fmt, args);
  207. va_end(args);
  208. return 0;
  209. }
  210. #define LOG(fmt, ...) \
  211. do { \
  212. sLOG(fmt, ##__VA_ARGS__); \
  213. printf(fmt, ##__VA_ARGS__); \
  214. } while (0)
  215. #define LOGD(fmt, ...) \
  216. sLOG(fmt, ##__VA_ARGS__)
  217. #define elf_note elf32_note
  218. #define PHDR_PTR(ehdr, phdr, mem) \
  219. (ehdr->e_machine == EM_ARM ? ((struct elf32_phdr*)phdr)->mem : ((struct elf64_phdr*)phdr)->mem)
  220. #define PHDR_TYPE(ehdr, phdr) PHDR_PTR(ehdr, phdr, p_type)
  221. #define PHDR_VADDR(ehdr, phdr) PHDR_PTR(ehdr, phdr, p_vaddr)
  222. #define PHDR_ADDR(ehdr, phdr) PHDR_PTR(ehdr, phdr, p_paddr)
  223. #define PHDR_SIZE(ehdr, phdr) PHDR_PTR(ehdr, phdr, p_filesz)
  224. #define PHDR_OFF(ehdr, phdr) PHDR_PTR(ehdr, phdr, p_offset)
  225. #define PHDR_INDEX(ehdr, i) \
  226. (ehdr->e_machine == EM_ARM ? ehdr->start + ehdr->e_phoff + sizeof(struct elf32_phdr) * i : ehdr->start + ehdr->e_phoff + sizeof(struct elf64_phdr) *i)
  227. #ifndef ALIGN
  228. #define ALIGN(x, a) (((x) + ((a) -1)) & ~((a) -1))
  229. #endif
  230. extern uint64_t v2p_64(uint64_t vptr);
  231. static struct mrdump_control_block g_mcb;
  232. static uint64_t _get_mpt(struct mrdump_control_block *mcb)
  233. {
  234. if (mcb == NULL) {
  235. LOG("%s: mrdump_cb is NULL\n", __func__);
  236. return 0;
  237. }
  238. if (memcmp(mcb->sig, MRDUMP_GO_DUMP, 8) == 0) {
  239. struct mrdump_machdesc *mmp = &mcb->machdesc;
  240. /* LOG("kedump: get mpt:0x%llx\n", mmp->master_page_table); */
  241. return mmp->master_page_table;
  242. } else {
  243. LOG("mrdump_cb: unexpected sig error:0x%llx in %s\n", *(uint64_t *)mcb, __func__);
  244. return 0;
  245. }
  246. }
  247. uint64_t get_mpt(void)
  248. {
  249. return _get_mpt(&g_mcb);
  250. }
  251. static void get_vmalloc_range(struct mrdump_control_block *mcb, uint64_t *vmalloc_start, uint64_t *vmalloc_end)
  252. {
  253. if (mcb == NULL || vmalloc_start == NULL || vmalloc_end == NULL)
  254. return;
  255. if (memcmp(mcb->sig, MRDUMP_GO_DUMP, 8) == 0) {
  256. struct mrdump_machdesc *mmp = &mcb->machdesc;
  257. *vmalloc_start = mmp->vmalloc_start;
  258. *vmalloc_end = mmp->vmalloc_end;
  259. } else {
  260. *vmalloc_start = 0;
  261. *vmalloc_end = 0;
  262. }
  263. }
  264. static bool is_dram_address(uint64_t addr, struct mrdump_control_block *mcb)
  265. {
  266. if (mcb == NULL)
  267. return false;
  268. if (memcmp(mcb->sig, MRDUMP_GO_DUMP, 8) == 0) {
  269. struct mrdump_machdesc *mmp = &mcb->machdesc;
  270. return (addr >= mmp->dram_start && addr < mmp->dram_end);
  271. } else {
  272. return false;
  273. }
  274. }
  275. static int is_arm_32bit(struct mrdump_control_block *mcb, uint64_t vaddr)
  276. {
  277. bool isret = (vaddr <= 0xffffffffUL) ? true : false;
  278. if (mcb == NULL)
  279. return isret;
  280. if (memcmp(mcb->sig, MRDUMP_GO_DUMP, 8) == 0) {
  281. struct mrdump_machdesc *mmp = &mcb->machdesc;
  282. return (mmp->page_offset > 0 && mmp->page_offset <= 0xffffffffUL);
  283. } else {
  284. return isret;
  285. }
  286. }
  287. static unsigned int calculate_crc32(void *data, unsigned int len)
  288. {
  289. unsigned int mycrc;
  290. unsigned int ret;
  291. mycrc = crc32(0L, Z_NULL, 0);
  292. ret = crc32(mycrc, data, len);
  293. LOG("kedump: crc = 0x%x\n", ret);
  294. return ret;
  295. }
  296. static struct elfhdr* kedump_elf_hdr(void)
  297. {
  298. char *ei;
  299. static struct elfhdr kehdr;
  300. static struct elfhdr *ehdr = (void*)-1;
  301. if (ehdr != (void*)-1)
  302. return ehdr;
  303. ehdr = NULL;
  304. kehdr.start = (void*)(KE_RESERVED_MEM_ADDR);
  305. LOG("kedump: KEHeader %p\n", kehdr.start);
  306. if (kehdr.start) {
  307. ei = (char*)kehdr.start; //elf_hdr.e_ident
  308. LOG("kedump: read header 0x%p[0x%x%x%x%x]\n", ei, ei[0], ei[1], ei[2], ei[3]);
  309. /* valid elf header */
  310. if (ei[0] == 0x7f && ei[1] == 'E' && ei[2] == 'L' && ei[3] == 'F') {
  311. kehdr.e_machine = ((struct elf32_hdr*)(kehdr.start))->e_machine;
  312. if (kehdr.e_machine == EM_ARM) {
  313. kehdr.e_phnum = ((struct elf32_hdr*)(kehdr.start))->e_phnum;
  314. kehdr.e_phoff = ((struct elf32_hdr*)(kehdr.start))->e_phoff;
  315. ehdr = &kehdr;
  316. } else if (kehdr.e_machine == EM_AARCH64) {
  317. kehdr.e_phnum = ((struct elf64_hdr*)(kehdr.start))->e_phnum;
  318. kehdr.e_phoff = ((struct elf64_hdr*)(kehdr.start))->e_phoff;
  319. ehdr = &kehdr;
  320. }
  321. }
  322. if (ehdr == NULL)
  323. LOG("kedump: invalid header[0x%x%x%x%x]\n", ei[0], ei[1], ei[2], ei[3]);
  324. }
  325. LOG("kedump: mach[0x%x], phnum[0x%x], phoff[0x%x]\n", kehdr.e_machine, kehdr.e_phnum, kehdr.e_phoff);
  326. return ehdr;
  327. }
  328. static int kedump_dev_open(void)
  329. {
  330. int index;
  331. index = partition_get_index(AEE_IPANIC_PLABLE);
  332. dev.dev = mt_part_get_device();
  333. if (index == -1 || dev.dev == NULL) {
  334. LOG("kedump: no %s partition[%d]\n", AEE_IPANIC_PLABLE, index);
  335. return -1;
  336. }
  337. #if (defined(MTK_UFS_SUPPORT) || defined(MTK_NEW_COMBO_EMMC_SUPPORT))
  338. dev.part_id = partition_get_region(index);
  339. #endif
  340. dev.ptn = partition_get_offset(index);
  341. dev.part_size = partition_get_size(index);
  342. if (dev.part_size < EXPDB_RESERVED_OTHER) {
  343. LOG("kedump: partition size(%llx) is lesser then reserved!(%llx)\n", dev.part_size, (unsigned long long)EXPDB_RESERVED_OTHER);
  344. return -1;
  345. }
  346. dev.part_size -= EXPDB_RESERVED_OTHER; //reserved expdb for others
  347. LOG("kedump: partiton %d[%llx - %llx]\n", index, dev.ptn, dev.part_size);
  348. return 0;
  349. }
  350. #if defined(MTK_MLC_NAND_SUPPORT) || defined(MTK_TLC_NAND_SUPPORT)
  351. unsigned long long mem_expdb_write(void *data, unsigned long long offset, unsigned long sz)
  352. {
  353. if ((offset + sz) > MEM_EXPDB_SIZE) {
  354. LOG("overflow!\n");
  355. return 0;
  356. }
  357. memcpy((mem_expdb + offset), data, (unsigned long)sz);
  358. return sz;
  359. }
  360. #endif
  361. #define TRUNK 0x8000
  362. static unsigned long long kedump_dev_write (unsigned long long offset, uint64_t data, unsigned long sz)
  363. {
  364. unsigned long long size_wrote = 0;
  365. vaddr_t vaddr = (uint32_t)data;
  366. vaddr_t memsrc = vaddr;
  367. uint8_t *trunk = malloc(TRUNK);
  368. unsigned long rest = sz;
  369. if (trunk == NULL) {
  370. LOG("kedump: malloc failed\n");
  371. return 0;
  372. }
  373. LOG("kedump: offset:0x%llx, data:0x%llx, size:0x%lx\n", offset, data, sz);
  374. #ifdef MTK_3LEVEL_PAGETABLE
  375. {
  376. /*int ret;*/
  377. uint64_t start = ROUNDDOWN((uint64_t)data, (uint64_t)PAGE_SIZE);
  378. vaddr = ROUNDUP((vaddr_t)target_get_scratch_address(), PAGE_SIZE);
  379. uint32_t secsize = ROUNDUP((uint32_t)(data - start + sz), PAGE_SIZE);
  380. if (start >= DRAM_PHY_ADDR) {
  381. /* minirdump: minirdump will dump memory in DRAM, we must allocate it first */
  382. int map_ok = arch_mmu_map((uint64_t) start, vaddr,
  383. MMU_MEMORY_TYPE_NORMAL_WRITE_BACK | MMU_MEMORY_AP_P_RW_U_NA, secsize);
  384. if (map_ok != NO_ERROR)
  385. LOG("kedump: map error\n");
  386. memsrc = vaddr + (uint32_t)(data - start);
  387. }
  388. /*LOG("kedump: start:0x%llx, vaddr:0x%x, secsize:0x%x, memsrc:0x%x\n", start, vaddr, secsize, memsrc);*/
  389. }
  390. #endif
  391. if (offset >= dev.part_size || sz > dev.part_size - offset) {
  392. if (trunk != NULL)
  393. free(trunk);
  394. LOG("kedump: write oversize %lx -> %llx > %llx\n", sz, offset, dev.part_size);
  395. return 0;
  396. }
  397. while (rest > 0) {
  398. unsigned long write_sz;
  399. memset(trunk, 0x0, TRUNK);
  400. if (rest <= TRUNK) {
  401. write_sz = rest;
  402. } else {
  403. write_sz = TRUNK;
  404. }
  405. memcpy(trunk, (void *)(memsrc + (sz - rest)), write_sz);
  406. #if (defined(MTK_UFS_SUPPORT) || defined(MTK_EMMC_SUPPORT))
  407. #if (defined(MTK_UFS_SUPPORT) || defined(MTK_NEW_COMBO_EMMC_SUPPORT))
  408. size_wrote += dev.dev->write(dev.dev, trunk, dev.ptn + offset, write_sz, dev.part_id);
  409. #else
  410. size_wrote += dev.dev->write(dev.dev, trunk, dev.ptn + offset, write_sz);
  411. #endif
  412. #elif defined(MTK_NAND_SUPPORT)
  413. size_wrote += dev.dev->write(dev.dev, trunk, (unsigned long)dev.ptn + offset, write_sz);
  414. #endif
  415. #if defined(MTK_MLC_NAND_SUPPORT) || defined(MTK_TLC_NAND_SUPPORT)
  416. size_wrote += mem_expdb_write(trunk, offset, write_sz);
  417. #endif
  418. offset += write_sz;
  419. rest -= write_sz;
  420. }
  421. if ((long long)size_wrote <= 0) {
  422. LOG("kedump: write failed(%llx), %lx@%llx -> %llx\n", size_wrote, sz, data, offset);
  423. size_wrote = 0;
  424. }
  425. free(trunk);
  426. #ifdef MTK_3LEVEL_PAGETABLE
  427. {
  428. /* restore vaddr */
  429. uint64_t start = ROUNDDOWN((uint64_t)data, (uint64_t)PAGE_SIZE);
  430. uint32_t secsize = ROUNDUP((uint32_t)(data - start + sz), PAGE_SIZE);
  431. if (start >= DRAM_PHY_ADDR) {
  432. int map_ok = arch_mmu_map(vaddr, vaddr, MMU_MEMORY_TYPE_NORMAL_WRITE_BACK | MMU_MEMORY_AP_P_RW_U_NA, secsize);
  433. if (map_ok != NO_ERROR) {
  434. LOG("kedump: arch_mmu_map restore error: map_ok=%d, vaddr=0x%08lx\n",
  435. map_ok, (unsigned long)vaddr);
  436. }
  437. }
  438. }
  439. #endif
  440. return size_wrote;
  441. }
  442. uint64_t kedump_mem_read(uint64_t data, unsigned long sz, void *buf)
  443. {
  444. uint64_t size_read = 0;
  445. vaddr_t vaddr = (uint32_t)data;
  446. vaddr_t memsrc = vaddr;
  447. uint8_t *trunk = NULL;
  448. unsigned long rest = sz;
  449. unsigned long buf_offset = 0;
  450. if(!is_dram_address(data, &g_mcb) || !is_dram_address((data + sz), &g_mcb)) {
  451. LOG("kedump: illegal address:0x%llx(sz:0x%lx)\n", data, sz);
  452. return 0;
  453. }
  454. trunk = malloc(TRUNK);
  455. if (trunk == NULL) {
  456. LOG("kedump: malloc failed in %s\n", __func__);
  457. return 0;
  458. }
  459. /* LOG("kedump: read data:0x%llx, size:0x%lx\n", data, sz); */
  460. #ifdef MTK_3LEVEL_PAGETABLE
  461. {
  462. /*int ret;*/
  463. uint64_t start = ROUNDDOWN((uint64_t)data, (uint64_t)PAGE_SIZE);
  464. vaddr = ROUNDUP((vaddr_t)target_get_scratch_address(), PAGE_SIZE);
  465. uint32_t secsize = ROUNDUP((uint32_t)(data - start + sz), PAGE_SIZE);
  466. if (start >= DRAM_PHY_ADDR) {
  467. /* minirdump: minirdump will dump memory in DRAM, we must allocate it first */
  468. int map_ok = arch_mmu_map((uint64_t) start, vaddr,
  469. MMU_MEMORY_TYPE_NORMAL_WRITE_BACK | MMU_MEMORY_AP_P_RW_U_NA, secsize);
  470. if (map_ok != NO_ERROR)
  471. LOG("kedump: map error in %s\n", __func__);
  472. memsrc = vaddr + (uint32_t)(data - start);
  473. } else {
  474. LOG("kedump: try to map address:0x%llx(sz:0x%lx)\n", data, sz);
  475. LOG("kedump: illegal rounddown:0x%llx\n", start);
  476. free(trunk);
  477. return 0;
  478. }
  479. /*LOG("kedump: start:0x%llx, vaddr:0x%x, secsize:0x%x, memsrc:0x%x\n", start, vaddr, secsize, memsrc);*/
  480. }
  481. #endif
  482. while (rest > 0) {
  483. unsigned long read_sz;
  484. memset(trunk, 0x0, TRUNK);
  485. if (rest <= TRUNK) {
  486. read_sz = rest;
  487. } else {
  488. read_sz = TRUNK;
  489. }
  490. memcpy(trunk, (void *)(memsrc + (sz - rest)), read_sz);
  491. memcpy(buf + buf_offset, trunk, read_sz);
  492. size_read += read_sz;
  493. buf_offset += read_sz;
  494. rest -= read_sz;
  495. }
  496. free(trunk);
  497. #ifdef MTK_3LEVEL_PAGETABLE
  498. {
  499. /* restore vaddr */
  500. uint64_t start = ROUNDDOWN((uint64_t)data, (uint64_t)PAGE_SIZE);
  501. uint32_t secsize = ROUNDUP((uint32_t)(data - start + sz), PAGE_SIZE);
  502. if (start >= DRAM_PHY_ADDR) {
  503. int map_ok = arch_mmu_map(vaddr, vaddr, MMU_MEMORY_TYPE_NORMAL_WRITE_BACK | MMU_MEMORY_AP_P_RW_U_NA, secsize);
  504. if (map_ok != NO_ERROR) {
  505. LOG("kedump: arch_mmu_map restore error: map_ok=%d, vaddr=0x%08lx in %s\n",
  506. map_ok, (unsigned long)vaddr, __func__);
  507. }
  508. }
  509. }
  510. #endif
  511. return size_read;
  512. }
  513. static unsigned long long offset_plat_debug = 0;
  514. static unsigned long length_plat_debug = 0;
  515. static unsigned long long kedump_plat_write (void *data, unsigned long sz)
  516. {
  517. unsigned long long datasize = 0;
  518. datasize = kedump_dev_write(offset_plat_debug, (uint64_t)((uint32_t)data), sz);
  519. offset_plat_debug += datasize;
  520. length_plat_debug += sz;
  521. return datasize;
  522. }
  523. static void kedump_dev_close(void)
  524. {
  525. return;
  526. }
  527. /* the min offset reserved for the header's size. */
  528. static unsigned long kedump_mrdump_header_size (struct elfhdr *ehdr)
  529. {
  530. void *phdr = PHDR_INDEX(ehdr, 1);
  531. return ALIGN(PHDR_OFF(ehdr, phdr) + PHDR_SIZE(ehdr, phdr), PAGE_SIZE);
  532. }
  533. static unsigned long long kedump_dev_write_vmalloc_range(unsigned long long offset, uint64_t vaddr, uint64_t addr, unsigned long size)
  534. {
  535. bool flag;
  536. unsigned long long lcheckaddr;
  537. unsigned long long lnew, hnew, hnewtmp;
  538. unsigned long long vmalloc_start, vmalloc_end;
  539. unsigned long long paddr, pcheckaddr;
  540. int checkloop = 0;
  541. unsigned long long size_wrote = 0;
  542. /* vaddr & vadd + size are PAGE_SIZE alignment */
  543. lnew = vaddr;
  544. hnew = vaddr + size;
  545. paddr = addr;
  546. flag = true;
  547. get_vmalloc_range(&g_mcb, &vmalloc_start, &vmalloc_end);
  548. if (hnew <= lnew
  549. || !(vaddr >= vmalloc_start && vaddr + size <= vmalloc_end)) {
  550. LOG("kedump: wrong range 0x%llx-0x%llx\n", lnew, hnew);
  551. return 0;
  552. }
  553. while (flag) {
  554. for(checkloop = 1; checkloop < (int)((hnew - lnew) / PAGE_SIZE); checkloop++) {
  555. lcheckaddr = lnew + checkloop * (unsigned long long)PAGE_SIZE;
  556. pcheckaddr = v2p_64(lcheckaddr);
  557. /* NOTE:
  558. * convert result should not be 0
  559. * if the result is 0 it should be the case invalid pfn pa address is recorded in kernel
  560. * */
  561. if (pcheckaddr == 0 || !is_dram_address(pcheckaddr, &g_mcb)) {
  562. if (pcheckaddr != 0)
  563. LOG("kedump: invalid convert address:0x%llx\n", pcheckaddr);
  564. LOG("kedump: convert failed expected pa:0x%llx (va:0x%llx)\n", paddr + checkloop * (unsigned long long)PAGE_SIZE, lcheckaddr);
  565. continue;
  566. }
  567. if (pcheckaddr != (paddr + checkloop * (unsigned long long)PAGE_SIZE)) {
  568. flag = false;
  569. LOG("kedump: non-cont 0x%llx found(va:0x%llx, pa:0x%llx)\n", paddr + checkloop * (unsigned long long)PAGE_SIZE, lcheckaddr, pcheckaddr);
  570. break;
  571. } else {
  572. }
  573. }
  574. hnewtmp = flag ? hnew : lcheckaddr;
  575. size_wrote += kedump_dev_write(offset, (uint64_t)paddr, (hnewtmp - lnew));
  576. offset += (hnewtmp - lnew);
  577. if (!flag) {
  578. lnew = lcheckaddr;
  579. paddr = pcheckaddr;
  580. flag = true;
  581. } else {
  582. flag = false;
  583. }
  584. }
  585. return size_wrote;
  586. }
  587. static unsigned int kedump_mini_rdump(struct elfhdr *ehdr, unsigned long long offset)
  588. {
  589. void *phdr;
  590. unsigned long long addr;
  591. unsigned long long vaddr;
  592. unsigned long long vmalloc_start, vmalloc_end;
  593. unsigned long size;
  594. unsigned int i;
  595. unsigned int total = 0;
  596. unsigned long elfoff = kedump_mrdump_header_size(ehdr);
  597. unsigned long sz_header = elfoff;
  598. #ifdef MTK_3LEVEL_PAGETABLE
  599. {
  600. uint32_t start = KE_RESERVED_MEM_ADDR;
  601. /* KEDump need to use header in DRAZM, we must allocate it first */
  602. arch_mmu_map(ROUNDDOWN((uint64_t)start, PAGE_SIZE), ROUNDDOWN((uint32_t)start, PAGE_SIZE),
  603. MMU_MEMORY_TYPE_NORMAL_WRITE_BACK | MMU_MEMORY_AP_P_RW_U_NA, ROUNDUP(sz_header, PAGE_SIZE));
  604. }
  605. #endif
  606. for (i = 0; i < ehdr->e_phnum; i++) {
  607. phdr = PHDR_INDEX(ehdr, i);
  608. if (PHDR_SIZE(ehdr, phdr) != 0 || PHDR_TYPE(ehdr, phdr) != 0)
  609. LOGD("kedump: PT[%d] %llx@%llx -> %llx(%llx)\n", PHDR_TYPE(ehdr, phdr), (uint64_t)PHDR_SIZE(ehdr, phdr), (uint64_t)PHDR_ADDR(ehdr, phdr), (uint64_t)elfoff, (uint64_t)PHDR_OFF(ehdr, phdr));
  610. if (PHDR_TYPE(ehdr, phdr) != PT_LOAD)
  611. continue;
  612. addr = PHDR_ADDR(ehdr, phdr);
  613. vaddr = PHDR_VADDR(ehdr, phdr);
  614. #ifdef MTK_MRDUMP_SRAM_CB
  615. if ((addr < DRAM_PHY_ADDR) && ((addr < MRDUMP_CB_ADDR) || (addr > (MRDUMP_CB_ADDR + MRDUMP_CB_SIZE)))) {
  616. LOG("kedump: skip dump non-allow PA:%llx, VA:%llx\n", addr, PHDR_VADDR(ehdr, phdr));
  617. continue;
  618. }
  619. #else
  620. if (addr < DRAM_PHY_ADDR) {
  621. LOG("kedump: skip dump non-dram PA:%llx, VA:%llx\n", addr, PHDR_VADDR(ehdr, phdr));
  622. continue;
  623. }
  624. #endif
  625. size = PHDR_SIZE(ehdr, phdr);
  626. if (size == 0 || elfoff == 0)
  627. LOG("kedump: dump addr 0x%llx, size 0x%lx\n", addr, size);
  628. if (ehdr->e_machine == EM_ARM)
  629. ((struct elf32_phdr*)phdr)->p_offset = elfoff;
  630. else
  631. ((struct elf64_phdr*)phdr)->p_offset = elfoff;
  632. if (size != 0 && elfoff != 0) {
  633. /* LOG("kedump: start:0x%llx-0x%llx\n", vaddr, vaddr + size); */
  634. /*
  635. * 1.|start...end|...|vmalloc_start...vmalloc_end|
  636. *
  637. * 2.|vmalloc_start...vmalloc_end|...|start...end|
  638. *
  639. * 3.|vmalloc_start...|start...end|...vmalloc_end|
  640. *
  641. * 4.|vmalloc_start...|start...vmalloc_end|...end|
  642. *
  643. * 5.|start...|vmalloc_start...end|...vmalloc_end|
  644. *
  645. * 6.|start...|vmalloc_start...vmalloc_end|...end|
  646. */
  647. get_vmalloc_range(&g_mcb, &vmalloc_start, &vmalloc_end);
  648. if (!is_arm_32bit(&g_mcb, vaddr)
  649. && (vaddr >= vmalloc_start) && (vaddr + size <= vmalloc_end)) {
  650. /* LOG("kedump: overlapp case: 3\n"); */
  651. total += kedump_dev_write_vmalloc_range(offset + elfoff, vaddr, addr, size);
  652. } else {
  653. if (!is_arm_32bit(&g_mcb, vaddr)) {
  654. if ((vaddr + size <= vmalloc_start) || (vaddr >= vmalloc_end)) {
  655. /* LOG("kedump: normal no-overlapp case: %d\n", (vaddr + size <= vmalloc_start) ? 1 : 2); */
  656. } else if ((vaddr <= vmalloc_start) && (vaddr + size >= vmalloc_end)) {
  657. /* not expected max size for mini rdump load is smaller than vmalloc */
  658. LOG("kedump: never overlapp case: 6\n");
  659. } else if ((vaddr + size <= vmalloc_end) || (vaddr >= vmalloc_start)) {
  660. /* not expected cases */
  661. LOG("kedump: should not be overlapp case: %d\n", (vaddr + size <= vmalloc_end) ? 5 : 4);
  662. }
  663. }
  664. total += kedump_dev_write(offset + elfoff, (uint64_t)addr, size);
  665. }
  666. }
  667. elfoff += size;
  668. }
  669. total += kedump_dev_write(offset, (uint64_t)((uint32_t)ehdr->start), sz_header);
  670. return total;
  671. }
  672. static unsigned int kedump_misc(unsigned long long addr, unsigned int start, unsigned int size, unsigned long long offset)
  673. {
  674. unsigned int total;
  675. LOG("kedump: misc data %x@%llx+%x\n", size, addr, start);
  676. if (start >= size)
  677. start = start % size;
  678. total = kedump_dev_write(offset, (uint64_t)(addr + start), size - start);
  679. if (start)
  680. total += kedump_dev_write(offset + total, (uint64_t)addr, start);
  681. return total;
  682. }
  683. static unsigned int kedump_misc32(struct mrdump_mini_misc_data32 *data, unsigned long long offset)
  684. {
  685. unsigned int addr = data->paddr;
  686. unsigned int start = 0;
  687. unsigned int size = data->size;
  688. if (data->start != 0)
  689. kedump_mem_read(data->start, sizeof(unsigned int), &start);
  690. else
  691. start = 0;
  692. return kedump_misc((uint64_t)((uint32_t)addr), start, size, offset);
  693. }
  694. static unsigned int kedump_misc64(struct mrdump_mini_misc_data64 *data, unsigned long long offset)
  695. {
  696. unsigned long long addr = (unsigned long long)data->paddr;
  697. unsigned int start = 0;
  698. unsigned int size = (unsigned int)data->size;
  699. if (data->start != 0)
  700. kedump_mem_read(data->start, sizeof(unsigned int), &start);
  701. else
  702. start = 0;
  703. return kedump_misc(addr, start, size, offset);
  704. }
  705. struct ipanic_header panic_header;
  706. static unsigned long long header_off;
  707. static void kedump_add2hdr(unsigned int offset, unsigned int size, unsigned datasize, char *name)
  708. {
  709. struct ipanic_data_header *pdata;
  710. int i;
  711. for (i = 0; i < IPANIC_NR_SECTIONS; i++) {
  712. pdata = &panic_header.data_hdr[i];
  713. if (pdata->valid == 0)
  714. break;
  715. }
  716. LOG("kedump add: %s[%d] %x/%x@%x\n", name, i, datasize, size, offset);
  717. if (i < IPANIC_NR_SECTIONS) {
  718. pdata->offset = offset;
  719. pdata->total = size;
  720. pdata->used = datasize;
  721. strlcpy((char*)pdata->name, name, sizeof(pdata->name));
  722. pdata->valid = 1;
  723. }
  724. header_off += kedump_dev_write(header_off, (uint64_t)((uint32_t)(pdata)), sizeof(struct ipanic_data_header));
  725. }
  726. static int kedump_kernel_info(unsigned long long *offset)
  727. {
  728. struct elfhdr *ehdr;
  729. unsigned long sz_misc;
  730. void *phdr_misc;
  731. struct elf_note *misc, *miscs;
  732. char *m_name;
  733. void *m_data;
  734. char name[32];
  735. unsigned int size, datasize;
  736. unsigned int i;
  737. ehdr = kedump_elf_hdr();
  738. if (0 == ehdr)
  739. return -1;
  740. ram_console_set_dump_step(AEE_LKDUMP_MINI_RDUMP);
  741. datasize = kedump_mini_rdump(ehdr, *offset);
  742. size = datasize;
  743. kedump_add2hdr(*offset, size, datasize, "SYS_MINI_RDUMP");
  744. *offset += datasize;
  745. phdr_misc = PHDR_INDEX(ehdr, 1);
  746. miscs = (struct elf_note*)(ehdr->start + PHDR_OFF(ehdr, phdr_misc));
  747. LOGD("kedump: misc[%p] %llx@%llx\n", phdr_misc, PHDR_SIZE(ehdr, phdr_misc), PHDR_OFF(ehdr, phdr_misc));
  748. sz_misc = sizeof(struct elf_note) + miscs->n_namesz + miscs->n_descsz;
  749. LOGD("kedump: miscs[%p], size %lx\n", miscs, sz_misc);
  750. for (i = 0; i < (PHDR_SIZE(ehdr, phdr_misc)) / sz_misc; i++) {
  751. char klog_first[16];
  752. unsigned int start_tmp = 0;
  753. memset(klog_first, 0x0, sizeof(klog_first));
  754. misc = (struct elf_note*)((void*)miscs + sz_misc * i);
  755. m_name = (char*)misc + sizeof(struct elf_note);
  756. if (m_name[0] == 'N' && m_name[1] == 'A' && m_name[2] == '\0')
  757. break;
  758. m_data = (void*)misc + sizeof(struct elf_note) + misc->n_namesz;
  759. if (misc->n_descsz == sizeof(struct mrdump_mini_misc_data32)) {
  760. if (strcmp(m_name, "_KERNEL_LOG_") == 0) {
  761. if (((struct mrdump_mini_misc_data32*)m_data)->start != 0)
  762. kedump_mem_read(((struct mrdump_mini_misc_data32*)m_data)->start, sizeof(unsigned int), &start_tmp);
  763. else
  764. start_tmp = 0;
  765. sprintf(klog_first, "_%u", start_tmp);
  766. ((struct mrdump_mini_misc_data32*)m_data)->start = 0;
  767. }
  768. datasize = kedump_misc32((struct mrdump_mini_misc_data32*)m_data, *offset);
  769. size = ((struct mrdump_mini_misc_data32*)m_data)->size;
  770. } else {
  771. if (strcmp(m_name, "_KERNEL_LOG_") == 0) {
  772. if (((struct mrdump_mini_misc_data64*)m_data)->start != 0)
  773. kedump_mem_read(((struct mrdump_mini_misc_data64*)m_data)->start, sizeof(unsigned int), &start_tmp);
  774. else
  775. start_tmp = 0;
  776. sprintf(klog_first, "_%u", start_tmp);
  777. ((struct mrdump_mini_misc_data64*)m_data)->start = 0;
  778. }
  779. datasize = kedump_misc64((struct mrdump_mini_misc_data64*)m_data, *offset);
  780. size = ((struct mrdump_mini_misc_data64*)m_data)->size;
  781. }
  782. /* [SYS_]MISC[_RAW] */
  783. if (m_name[0] == '_')
  784. strlcpy (name, "SYS", sizeof(name));
  785. else
  786. name[0] = 0;
  787. strlcat (name, m_name, sizeof(name));
  788. if (m_name[strlen(m_name)-1] == '_')
  789. strlcat (name, "RAW", sizeof(name));
  790. if (klog_first[0] != 0)
  791. strlcat(name, klog_first, sizeof(name));
  792. kedump_add2hdr(*offset, size, datasize, name);
  793. *offset += datasize;
  794. }
  795. return 0;
  796. }
  797. static int kedump_ram_console(unsigned long long *offset)
  798. {
  799. unsigned int sz_misc = 0, addr_misc = 0;
  800. unsigned int datasize;
  801. /* ram_console raw log */
  802. ram_console_set_dump_step(AEE_LKDUMP_RAMCONSOLE_RAW);
  803. ram_console_addr_size(&addr_misc, &sz_misc);
  804. if (addr_misc && sz_misc) {
  805. datasize = kedump_misc(addr_misc, 0, sz_misc, *offset);
  806. kc.ram_console_crc = calculate_crc32((void *)addr_misc, sz_misc);
  807. kedump_add2hdr(*offset, sz_misc, datasize, "SYS_RAMCONSOLE_RAW");
  808. *offset += datasize;
  809. }
  810. #ifdef MTK_PMIC_FULL_RESET
  811. /* pstore raw log*/
  812. ram_console_set_dump_step(AEE_LKDUMP_PSTORE_RAW);
  813. addr_misc = 0;
  814. sz_misc = 0;
  815. pstore_addr_size(&addr_misc, &sz_misc);
  816. if (addr_misc && sz_misc) {
  817. datasize = kedump_misc(addr_misc, 0, sz_misc, *offset);
  818. #ifdef MTK_3LEVEL_PAGETABLE
  819. {
  820. /*int ret;*/
  821. uint32_t start = ROUNDDOWN((uint32_t)addr_misc, PAGE_SIZE);
  822. uint32_t secsize = ROUNDUP(((uint32_t)sz_misc), PAGE_SIZE);
  823. if (start >= DRAM_PHY_ADDR) {
  824. /* minirdump: minirdump will dump memory in DRAM, we must allocate it first */
  825. arch_mmu_map((uint64_t) start, start,
  826. MMU_MEMORY_TYPE_NORMAL_WRITE_BACK | MMU_MEMORY_AP_P_RW_U_NA, secsize);
  827. }
  828. }
  829. #endif
  830. kc.pstore_crc = calculate_crc32((void *)addr_misc, sz_misc);
  831. kedump_add2hdr(*offset, sz_misc, datasize, "SYS_PSTORE_RAW");
  832. *offset += datasize;
  833. }
  834. #endif
  835. /* save crc data*/
  836. ram_console_set_dump_step(AEE_LKDUMP_KEDUMP_CRC);
  837. datasize = kedump_dev_write(*offset, (uint64_t)((uint32_t)(&kc)), sizeof(struct kedump_crc));
  838. kedump_add2hdr(*offset, sizeof(struct kedump_crc), datasize, "KEDUMP_CRC");
  839. *offset += datasize;
  840. return 0;
  841. }
  842. static int kedump_platform_debug(unsigned long long *offset)
  843. {
  844. /* platform debug */
  845. int len = 0;
  846. unsigned int datasize;
  847. unsigned int i;
  848. for (i=0; i<AEE_PLAT_DEBUG_NUM; i++) {
  849. offset_plat_debug = *offset;
  850. length_plat_debug = 0;
  851. ram_console_set_dump_step(adfi[i].step);
  852. datasize = kedump_plat_savelog(i, offset_plat_debug, &len, kedump_plat_write);
  853. if ((datasize > 0) && (datasize <= adfi[i].filesize)) {
  854. kedump_add2hdr(*offset, length_plat_debug, datasize, adfi[i].filename);
  855. *offset += datasize;
  856. }
  857. }
  858. return 0;
  859. }
  860. static int kedump_to_expdb(void)
  861. {
  862. unsigned long long offset;
  863. unsigned int datasize;
  864. part_dev_t *part_dev;
  865. part_dev = mt_part_get_device();
  866. if (!part_dev || !part_dev->blkdev) {
  867. LOG("kedump: device get error, dev:%p\n", part_dev);
  868. return -1;
  869. }
  870. if (kedump_dev_open() != 0)
  871. return -1;
  872. last_dump_step = ram_console_get_dump_step();
  873. if (last_dump_step != AEE_LKDUMP_CLEAR) {
  874. LOG("kedump: last lk dump is not finished at step %u\n", last_dump_step);
  875. return 0;
  876. }
  877. #if defined(MTK_MLC_NAND_SUPPORT) || defined(MTK_TLC_NAND_SUPPORT)
  878. mem_expdb = malloc(MEM_EXPDB_SIZE);
  879. if (mem_expdb == NULL) {
  880. LOG("mem_expdb malloc fail!\n");
  881. return -1;
  882. }
  883. LOG("mem_expdb malloc success, 0x%x size is 0x%x\n", mem_expdb, MEM_EXPDB_SIZE);
  884. memset(mem_expdb, 0x0, MEM_EXPDB_SIZE);
  885. #endif
  886. //write header firstly
  887. panic_header.magic = AEE_IPANIC_MAGIC;
  888. panic_header.version = AEE_IPANIC_PHDR_VERSION;
  889. panic_header.size = sizeof(panic_header);
  890. panic_header.blksize = part_dev->blkdev->blksz;
  891. panic_header.partsize = dev.part_size;
  892. kedump_dev_write(0, (uint64_t)((uint32_t)(&panic_header)), sizeof(panic_header));
  893. header_off = sizeof(panic_header) - sizeof(struct ipanic_data_header) * IPANIC_NR_SECTIONS;
  894. LOG("kedump: block size:0x%lx\n", part_dev->blkdev->blksz);
  895. /* reserve space in expdb for panic header */
  896. offset = ALIGN(sizeof(panic_header), part_dev->blkdev->blksz);
  897. kedump_ram_console(&offset);
  898. kedump_kernel_info(&offset);
  899. kedump_platform_debug(&offset);
  900. /* save KEdump flow logs */
  901. datasize = kedump_dev_write(offset, (uint64_t)(uint32_t)logbuf, SZLOG);
  902. kedump_add2hdr(offset, SZLOG, datasize, "ZAEE_LOG");
  903. offset += datasize;
  904. #if defined(MTK_MLC_NAND_SUPPORT) || defined(MTK_TLC_NAND_SUPPORT)
  905. unsigned long long size_wrote = dev.dev->write(dev.dev, mem_expdb, (unsigned long)dev.ptn, MEM_EXPDB_SIZE/*dev.part_size*/, dev.part_id);
  906. free(mem_expdb);
  907. #endif
  908. ram_console_set_dump_step(AEE_LKDUMP_CLEAR);
  909. return 0;
  910. }
  911. static int kedump_restore_mem(void)
  912. {
  913. int i;
  914. struct ipanic_header iheader;
  915. struct kedump_crc saved_crc = {0, 0};
  916. unsigned int crc;
  917. unsigned int sz_misc = 0, addr_misc = 0;
  918. unsigned int sz_misc_pstore = 0, addr_misc_pstore = 0;
  919. unsigned char *temp_ram_console = NULL;
  920. #ifdef MTK_PMIC_FULL_RESET
  921. unsigned char *temp_pstore = NULL;
  922. #endif
  923. if (kedump_dev_open() != 0)
  924. return -1;
  925. dev.dev->read(dev.dev, dev.ptn, (unsigned char *)&iheader, sizeof(struct ipanic_header), dev.part_id);
  926. if (iheader.magic == AEE_IPANIC_MAGIC && iheader.version >= AEE_IPANIC_PHDR_VERSION) {
  927. LOG("kedump: found content in expdb\n");
  928. for (i = IPANIC_NR_SECTIONS - 1; i >= 0; i--) {
  929. if (strncmp((const char *)iheader.data_hdr[i].name, "KEDUMP_CRC", sizeof("KEDUMP_CRC") - 1) == 0) {
  930. LOG("kedump: read %s from offset 0x%x size 0x%x\n", iheader.data_hdr[i].name, iheader.data_hdr[i].offset, iheader.data_hdr[i].used);
  931. dev.dev->read(dev.dev, dev.ptn + iheader.data_hdr[i].offset, (uchar *)(&saved_crc), iheader.data_hdr[i].used, dev.part_id);
  932. }
  933. if (strncmp((const char *)iheader.data_hdr[i].name, "SYS_RAMCONSOLE_RAW", sizeof("SYS_RAMCONSOLE_RAW") - 1) == 0) {
  934. ram_console_addr_size(&addr_misc, &sz_misc);
  935. if (addr_misc && sz_misc) {
  936. temp_ram_console = malloc(sz_misc);
  937. if (!temp_ram_console) {
  938. LOG("kedump: temp ram_console alloc fail\n");
  939. } else {
  940. LOG("kedump: read %s from offset 0x%x size 0x%x\n", iheader.data_hdr[i].name, iheader.data_hdr[i].offset, iheader.data_hdr[i].used);
  941. memset(temp_ram_console, 0x0, sz_misc);
  942. //dev.dev->read(dev.dev, dev.ptn + iheader.data_hdr[i].offset, (uchar *)addr_misc, iheader.data_hdr[i].used, dev.part_id);
  943. dev.dev->read(dev.dev, dev.ptn + iheader.data_hdr[i].offset, temp_ram_console, iheader.data_hdr[i].used, dev.part_id);
  944. crc = calculate_crc32(temp_ram_console, sz_misc);
  945. if (crc != saved_crc.ram_console_crc) {
  946. LOG("kedump: temp ram_console crc fail\n");
  947. free(temp_ram_console);
  948. temp_ram_console = NULL;
  949. }
  950. }
  951. } else {
  952. LOG("kedump: ram_console not init\n");
  953. }
  954. }
  955. #ifdef MTK_PMIC_FULL_RESET
  956. else if (strncmp((const char *)iheader.data_hdr[i].name, "SYS_PSTORE_RAW", sizeof("SYS_PSTORE_RAW") - 1) == 0) {
  957. pstore_addr_size(&addr_misc_pstore, &sz_misc_pstore);
  958. if (!addr_misc_pstore || !sz_misc_pstore)
  959. continue;
  960. #ifdef MTK_3LEVEL_PAGETABLE
  961. {
  962. /*int ret;*/
  963. uint32_t start = ROUNDDOWN((uint32_t)addr_misc_pstore, PAGE_SIZE);
  964. uint32_t secsize = ROUNDUP(((uint32_t)sz_misc_pstore), PAGE_SIZE);
  965. if (start >= DRAM_PHY_ADDR) {
  966. /* minirdump: minirdump will dump memory in DRAM, we must allocate it first */
  967. arch_mmu_map((uint64_t) start, start,
  968. MMU_MEMORY_TYPE_NORMAL_WRITE_BACK | MMU_MEMORY_AP_P_RW_U_NA, secsize);
  969. }
  970. }
  971. #endif
  972. temp_pstore = malloc(sz_misc_pstore);
  973. if (!temp_pstore) {
  974. LOG("kedump: temp pstore alloc fail\n");
  975. } else {
  976. LOG("kedump: read %s from offset 0x%x size 0x%x\n", iheader.data_hdr[i].name, iheader.data_hdr[i].offset, iheader.data_hdr[i].used);
  977. memset(temp_pstore, 0x0, sz_misc_pstore);
  978. //dev.dev->read(dev.dev, dev.ptn + iheader.data_hdr[i].offset, (uchar *)addr_misc_pstore, iheader.data_hdr[i].used, dev.part_id);
  979. dev.dev->read(dev.dev, dev.ptn + iheader.data_hdr[i].offset, temp_pstore, iheader.data_hdr[i].used, dev.part_id);
  980. crc = calculate_crc32(temp_pstore, sz_misc_pstore);
  981. if (crc != saved_crc.pstore_crc) {
  982. LOG("kedump: temp pstore crc fail\n");
  983. free(temp_pstore);
  984. temp_pstore = NULL;
  985. }
  986. }
  987. }
  988. #endif
  989. }
  990. if (ram_console_should_restore(temp_ram_console)) {
  991. LOG("kedump: ram_console_should_restore\n");
  992. memcpy((uchar *)addr_misc, temp_ram_console, sz_misc);
  993. #ifdef MTK_PMIC_FULL_RESET
  994. if (temp_pstore)
  995. memcpy((uchar *)addr_misc_pstore, temp_pstore, sz_misc_pstore);
  996. #endif
  997. ram_console_set_dump_step(AEE_LKDUMP_CLEAR);
  998. ram_console_is_abnormal_boot();
  999. }
  1000. if (temp_ram_console)
  1001. free(temp_ram_console);
  1002. #ifdef MTK_PMIC_FULL_RESET
  1003. if (temp_pstore)
  1004. free(temp_pstore);
  1005. #endif
  1006. }
  1007. return 0;
  1008. }
  1009. static int kedump_skip(void)
  1010. {
  1011. unsigned int boot_reason = g_boot_arg->boot_reason;
  1012. static int kedump_dumped = 0;
  1013. LOG("kedump: boot_reason(%d)\n", boot_reason);
  1014. ram_console_init();
  1015. /* this flow should be executed once only */
  1016. if (kedump_dumped == 0) {
  1017. kedump_dumped = 1;
  1018. if (ram_console_is_abnormal_boot())
  1019. return 0;
  1020. }
  1021. #ifdef MTK_PMIC_FULL_RESET
  1022. //if this reboot is full pmic reset, then restore the memory of ram_console and pstore
  1023. if (ram_console_reboot_by_cold_reset()) {
  1024. LOG("kedump: last is full pmic reset!\n");
  1025. kedump_restore_mem();
  1026. return 1;
  1027. } else {
  1028. LOG("kedump: last is not full pmic reset!\n");
  1029. }
  1030. #endif
  1031. // for power lost or reboot before KE DB collected scenario
  1032. kedump_restore_mem();
  1033. return 1;
  1034. }
  1035. static int kedump_avail(void)
  1036. {
  1037. #ifdef MTK_3LEVEL_PAGETABLE
  1038. vaddr_t vaddr = (vaddr_t)target_get_scratch_address();
  1039. LOG("kedump: address:0x%lx, page size:0x%x\n", vaddr, PAGE_SIZE);
  1040. {
  1041. uint32_t start = KE_RESERVED_MEM_ADDR;
  1042. /* KEDump need to use header in DRAZM, we must allocate it first */
  1043. arch_mmu_map(ROUNDDOWN((uint64_t)start, PAGE_SIZE), ROUNDDOWN((uint32_t)start, PAGE_SIZE),
  1044. MMU_MEMORY_TYPE_NORMAL_WRITE_BACK | MMU_MEMORY_AP_P_RW_U_NA, ROUNDUP(sizeof(struct elfhdr), PAGE_SIZE));
  1045. }
  1046. #endif
  1047. void *flag = (void *)(KE_RESERVED_MEM_ADDR);
  1048. if (((char *)flag)[0] == 0x81 && ((char *)flag)[1] == 'E' && ((char *)flag)[2] == 'L' && ((char *)flag)[3] == 'F') {
  1049. LOG("kedump: already dumped in lk\n");
  1050. return -1;
  1051. }
  1052. if (((char *)flag)[0] == 0x0 && ((char *)flag)[1] == 'E' && ((char *)flag)[2] == 'L' && ((char *)flag)[3] == 'F') {
  1053. LOG("kedump: already dumped in kernel\n");
  1054. return -1;
  1055. }
  1056. /*
  1057. * read boot image first for determine kernel
  1058. * is 32 bit or 64 bit
  1059. */
  1060. load_bootimg_hdr(BOOTIMG_TYPE_BOOT);
  1061. return 0;
  1062. }
  1063. int kedump_get_data_info(int index, char **name, u32 *offset, u32 *size)
  1064. {
  1065. struct ipanic_header iheader;
  1066. struct ipanic_data_header *pdata;
  1067. if (kedump_dev_open() != 0)
  1068. return -1;
  1069. dev.dev->read(dev.dev, dev.ptn, (unsigned char *)&iheader, sizeof(struct ipanic_header), dev.part_id);
  1070. if (iheader.magic != AEE_IPANIC_MAGIC || iheader.version < AEE_IPANIC_PHDR_VERSION)
  1071. return -2;
  1072. if (index < 0 || index >= IPANIC_NR_SECTIONS) {
  1073. LOG("kedump: invalid index number:%d\n", index);
  1074. return -3;
  1075. }
  1076. if (name == NULL || offset == NULL || size == NULL) {
  1077. LOG("kedump: invalid argument number:%d\n", index);
  1078. return -4;
  1079. }
  1080. pdata = &iheader.data_hdr[index];
  1081. if (pdata->valid == 0)
  1082. return -5;
  1083. *name = (char *)pdata->name;
  1084. *offset = pdata->offset;
  1085. *size = pdata->used;
  1086. return 0;
  1087. }
  1088. static int kedump_done(void)
  1089. {
  1090. void *flag = (void *)(KE_RESERVED_MEM_ADDR);
  1091. ((char *)flag)[0] = 0x81;
  1092. ((char *)flag)[1] = 'E';
  1093. ((char *)flag)[2] = 'L';
  1094. ((char *)flag)[3] = 'F';
  1095. arch_clean_cache_range((addr_t)KE_RESERVED_MEM_ADDR, sizeof(struct elfhdr));
  1096. return 0;
  1097. }
  1098. /* in case that platform didn't support smart_reset_check() */
  1099. const char *smart_reset_check(void) __attribute__((weak));
  1100. const char *smart_reset_check(void)
  1101. {
  1102. return NULL;
  1103. }
  1104. /* in case that platform didn't support mtk_wdt_get_last_stage() */
  1105. const char *mtk_wdt_get_last_stage(void) __attribute__((weak));
  1106. const char *mtk_wdt_get_last_stage(void)
  1107. {
  1108. return NULL;
  1109. }
  1110. #define SHOW_ARGS(p, a, b, c, d) \
  1111. LOG(#a":0x%llx, "#b":0x%llx,"#c":0x%llx, "#d":0x%llx\n", (p)->a, (p)->b, (p)->c, (p)->d)
  1112. static void show_info(struct mrdump_control_block *mcb)
  1113. {
  1114. if (mcb == NULL) {
  1115. LOG("%s: mrdump_cb is NULL\n", __func__);
  1116. return;
  1117. }
  1118. if (memcmp(mcb->sig, MRDUMP_GO_DUMP, 8) == 0) {
  1119. struct mrdump_machdesc *mmp = &mcb->machdesc;
  1120. SHOW_ARGS(mmp, vmalloc_start, vmalloc_end, master_page_table, high_memory);
  1121. } else {
  1122. LOG("mrdump_cb: sig error:0x%llx in %s\n", *(uint64_t *)mcb, __func__);
  1123. return;
  1124. }
  1125. }
  1126. extern BOOT_ARGUMENT *g_boot_arg;
  1127. /* Dump KE infomation to expdb */
  1128. /* 1: has expception, 0: has no exception */
  1129. int kedump_mini(void)
  1130. {
  1131. const char *status;
  1132. struct rtc_time tm;
  1133. if (!read_kedump_config()) {
  1134. LOG("kedump: disable\n");
  1135. return 0;
  1136. }
  1137. status = smart_reset_check();
  1138. if (status != NULL)
  1139. LOG("%s\n", status);
  1140. status = mtk_wdt_get_last_stage();
  1141. if (status != NULL)
  1142. LOG("%s\n", status);
  1143. LOG("kedump mini start\n");
  1144. rtc_get_time(&tm);
  1145. LOG("kedump: current time: [%d/%d/%d %d:%d:%d]\n", tm.tm_year, tm.tm_mon, tm.tm_mday, tm.tm_hour, tm.tm_min, tm.tm_sec);
  1146. if (g_boot_arg) {
  1147. if (!g_boot_arg->ddr_reserve_enable)
  1148. LOG("kedump: ddr reserve mode disabled\n");
  1149. else
  1150. LOG("kedump: ddr reserve mode enabled\n");
  1151. if (!g_boot_arg->ddr_reserve_success)
  1152. LOG("kedump: ddr reserve mode failed\n");
  1153. } else {
  1154. LOG("kedump: null boot arg pointer error\n");
  1155. }
  1156. if (lkdump_debug_init())
  1157. LOG("kedump: lkdump debug init ok\n");
  1158. else
  1159. LOG("kedump: lkdump debug not ready\n");
  1160. if (kedump_skip())
  1161. return 0;
  1162. if (kedump_avail())
  1163. return 0;
  1164. aee_mrdump_get_info(&g_mcb);
  1165. show_info(&g_mcb);
  1166. kedump_to_expdb();
  1167. kedump_done();
  1168. LOG("kedump mini done\n");
  1169. return 1;
  1170. }