| 12345678910111213141516171819202122232425262728293031323334353637383940414243444546474849505152535455565758596061626364656667686970717273747576777879808182838485868788899091929394959697989910010110210310410510610710810911011111211311411511611711811912012112212312412512612712812913013113213313413513613713813914014114214314414514614714814915015115215315415515615715815916016116216316416516616716816917017117217317417517617717817918018118218318418518618718818919019119219319419519619719819920020120220320420520620720820921021121221321421521621721821922022122222322422522622722822923023123223323423523623723823924024124224324424524624724824925025125225325425525625725825926026126226326426526626726826927027127227327427527627727827928028128228328428528628728828929029129229329429529629729829930030130230330430530630730830931031131231331431531631731831932032132232332432532632732832933033133233333433533633733833934034134234334434534634734834935035135235335435535635735835936036136236336436536636736836937037137237337437537637737837938038138238338438538638738838939039139239339439539639739839940040140240340440540640740840941041141241341441541641741841942042142242342442542642742842943043143243343443543643743843944044144244344444544644744844945045145245345445545645745845946046146246346446546646746846947047147247347447547647747847948048148248348448548648748848949049149249349449549649749849950050150250350450550650750850951051151251351451551651751851952052152252352452552652752852953053153253353453553653753853954054154254354454554654754854955055155255355455555655755855956056156256356456556656756856957057157257357457557657757857958058158258358458558658758858959059159259359459559659759859960060160260360460560660760860961061161261361461561661761861962062162262362462562662762862963063163263363463563663763863964064164264364464564664764864965065165265365465565665765865966066166266366466566666766866967067167267367467567667767867968068168268368468568668768868969069169269369469569669769869970070170270370470570670770870971071171271371471571671771871972072172272372472572672772872973073173273373473573673773873974074174274374474574674774874975075175275375475575675775875976076176276376476576676776876977077177277377477577677777877978078178278378478578678778878979079179279379479579679779879980080180280380480580680780880981081181281381481581681781881982082182282382482582682782882983083183283383483583683783883984084184284384484584684784884985085185285385485585685785885986086186286386486586686786886987087187287387487587687787887988088188288388488588688788888989089189289389489589689789889990090190290390490590690790890991091191291391491591691791891992092192292392492592692792892993093193293393493593693793893994094194294394494594694794894995095195295395495595695795895996096196296396496596696796896997097197297397497597697797897998098198298398498598698798898999099199299399499599699799899910001001100210031004100510061007100810091010101110121013101410151016101710181019102010211022102310241025102610271028102910301031103210331034103510361037103810391040104110421043104410451046104710481049105010511052105310541055105610571058105910601061106210631064106510661067106810691070107110721073107410751076107710781079108010811082108310841085108610871088108910901091109210931094109510961097109810991100110111021103110411051106110711081109111011111112111311141115111611171118111911201121112211231124112511261127112811291130113111321133113411351136113711381139114011411142114311441145114611471148114911501151115211531154115511561157115811591160116111621163116411651166116711681169117011711172117311741175117611771178117911801181118211831184118511861187118811891190119111921193119411951196119711981199120012011202120312041205120612071208120912101211121212131214121512161217121812191220122112221223122412251226122712281229123012311232123312341235123612371238123912401241124212431244124512461247124812491250125112521253125412551256125712581259126012611262126312641265126612671268126912701271127212731274127512761277127812791280128112821283128412851286128712881289129012911292 |
- /* Copyright Statement:
- *
- * This software/firmware and related documentation ("MediaTek Software") are
- * protected under relevant copyright laws. The information contained herein
- * is confidential and proprietary to MediaTek Inc. and/or its licensors.
- * Without the prior written permission of MediaTek inc. and/or its licensors,
- * any reproduction, modification, use or disclosure of MediaTek Software,
- * and information contained herein, in whole or in part, shall be strictly prohibited.
- */
- /* MediaTek Inc. (C) 2016. All rights reserved.
- *
- * BY OPENING THIS FILE, RECEIVER HEREBY UNEQUIVOCALLY ACKNOWLEDGES AND AGREES
- * THAT THE SOFTWARE/FIRMWARE AND ITS DOCUMENTATIONS ("MEDIATEK SOFTWARE")
- * RECEIVED FROM MEDIATEK AND/OR ITS REPRESENTATIVES ARE PROVIDED TO RECEIVER ON
- * AN "AS-IS" BASIS ONLY. MEDIATEK EXPRESSLY DISCLAIMS ANY AND ALL WARRANTIES,
- * EXPRESS OR IMPLIED, INCLUDING BUT NOT LIMITED TO THE IMPLIED WARRANTIES OF
- * MERCHANTABILITY, FITNESS FOR A PARTICULAR PURPOSE OR NONINFRINGEMENT.
- * NEITHER DOES MEDIATEK PROVIDE ANY WARRANTY WHATSOEVER WITH RESPECT TO THE
- * SOFTWARE OF ANY THIRD PARTY WHICH MAY BE USED BY, INCORPORATED IN, OR
- * SUPPLIED WITH THE MEDIATEK SOFTWARE, AND RECEIVER AGREES TO LOOK ONLY TO SUCH
- * THIRD PARTY FOR ANY WARRANTY CLAIM RELATING THERETO. RECEIVER EXPRESSLY ACKNOWLEDGES
- * THAT IT IS RECEIVER'S SOLE RESPONSIBILITY TO OBTAIN FROM ANY THIRD PARTY ALL PROPER LICENSES
- * CONTAINED IN MEDIATEK SOFTWARE. MEDIATEK SHALL ALSO NOT BE RESPONSIBLE FOR ANY MEDIATEK
- * SOFTWARE RELEASES MADE TO RECEIVER'S SPECIFICATION OR TO CONFORM TO A PARTICULAR
- * STANDARD OR OPEN FORUM. RECEIVER'S SOLE AND EXCLUSIVE REMEDY AND MEDIATEK'S ENTIRE AND
- * CUMULATIVE LIABILITY WITH RESPECT TO THE MEDIATEK SOFTWARE RELEASED HEREUNDER WILL BE,
- * AT MEDIATEK'S OPTION, TO REVISE OR REPLACE THE MEDIATEK SOFTWARE AT ISSUE,
- * OR REFUND ANY SOFTWARE LICENSE FEES OR SERVICE CHARGE PAID BY RECEIVER TO
- * MEDIATEK FOR SUCH MEDIATEK SOFTWARE AT ISSUE.
- */
- #include <stdio.h>
- #include <string.h>
- #include <stdlib.h>
- #include <arch/arm/mmu.h>
- #ifdef MTK_GPT_SCHEME_SUPPORT
- #include <platform/partition.h>
- #else
- #include <mt_partition.h>
- #endif
- #include <platform/boot_mode.h>
- #include <platform/ram_console.h>
- #include <platform/mt_reg_base.h>
- #include <platform/mt_rtc.h>
- #include <dev/aee_platform_debug.h>
- #include "mrdump_elf.h"
- #include "KEHeader.h"
- #include <lib/zlib.h>
- #ifdef MTK_3LEVEL_PAGETABLE
- #include <err.h>
- #include <target.h>
- #endif
- #ifdef MTK_MRDUMP_SRAM_CB
- #include <platform/mtk_mrdump.h>
- #endif
- #include <platform/mtk_wdt.h>
- #include <part_interface.h>
- #include "mrdump_private.h"
- #include <log_store_lk.h>
- #include <boot_info.h>
- #include <load_vfy_boot.h>
- enum {
- AEE_LKDUMP_CLEAR = 0,
- AEE_LKDUMP_RAMCONSOLE_RAW,
- AEE_LKDUMP_PSTORE_RAW,
- AEE_LKDUMP_KEDUMP_CRC,
- AEE_LKDUMP_MINI_RDUMP,
- AEE_LKDUMP_PROC_CUR_TSK, //5
- AEE_LKDUMP_KERNEL_LOG_RAW,
- AEE_LKDUMP_DISP_DEBUG_RAW,
- AEE_LKDUMP_DFD20,
- AEE_LKDUMP_LAST_DRAM,
- AEE_LKDUMP_LAST_CPU_BUS, //10
- AEE_LKDUMP_LAST_SPM_DATA,
- AEE_LKDUMP_LAST_SPM_SRAM_DATA,
- AEE_LKDUMP_ATF_LAST,
- AEE_LKDUMP_ATF_CRASH,
- AEE_LKDUMP_ATF_RAW,
- AEE_LKDUMP_ATF_RDUMP, //16
- AEE_LKDUMP_CPU_HVFS_RAW,
- AEE_LKDUMP_SSPM_COREDUMP,
- AEE_LKDUMP_SSPM_DATA,
- AEE_LKDUMP_SSPM_XFILE,
- AEE_LKDUMP_SSPM_LAST_LOG, //21
- AEE_LKDUMP_PLLK_LAST_LOG,
- AEE_LKDUMP_MCDI_DATA,
- AEE_LKDUMP_SCP_COREDUMP,
- AEE_LKDUMP_LAST_INFRA_CG,
- AEE_LKDUMP_ADSP_COREDUMP,
- AEE_LKDUMP_MCUPM_COREDUMP,
- AEE_LKDUMP_MCUPM_DATA,
- AEE_LKDUMP_MCUPM_XFILE,
- AEE_LKDUMP_MCUPM_LAST_LOG,
- //new added before this line please
- AEE_LKDUMP_ZAEE_LOG,
- AEE_LKDUMP_HEADER,
- #ifdef MTK_PICACHU_SUPPORT
- AEE_LKDUMP_PICACHU_LOG,
- #endif
- AEE_LKDUMP_UNKNOWN
- };
- static struct aee_db_file_info adfi[AEE_PLAT_DEBUG_NUM] = {
- [AEE_PLAT_DFD20] = { "DFD20.dfd", 0x40000, AEE_LKDUMP_DFD20}, /* 256 KB */
- [AEE_PLAT_DRAM] = { "SYS_LAST_DRAM", 0x2400, AEE_LKDUMP_LAST_DRAM}, /* 9 KB */
- [AEE_PLAT_CPU_BUS] = { "SYS_LAST_CPU_BUS", 0x10000, AEE_LKDUMP_LAST_CPU_BUS}, /* 64 KB */
- [AEE_PLAT_SPM_DATA] = { "SYS_LAST_SPM_DATA", 0x1000, AEE_LKDUMP_LAST_SPM_DATA}, /* 4 KB */
- [AEE_PLAT_SPM_SRAM_DATA] = { "SYS_LAST_SPM_SRAM_DATA", 0x1000, AEE_LKDUMP_LAST_SPM_SRAM_DATA}, /* 4 KB */
- [AEE_PLAT_ATF_LAST_LOG] = { "SYS_ATF_LAST", 0x20000, AEE_LKDUMP_ATF_LAST}, /* 128KB */
- [AEE_PLAT_ATF_CRASH_REPORT] = { "SYS_ATF_CRASH", 0x30000, AEE_LKDUMP_ATF_CRASH}, /* 64KB+128KB */
- [AEE_PLAT_ATF_RAW_LOG] = { "SYS_ATF_RAW_LOG", 0x60000, AEE_LKDUMP_ATF_RAW}, /* 384 KB */
- [AEE_PLAT_ATF_RDUMP_LOG] = { "SYS_ATF_RDUMP", 0x80000, AEE_LKDUMP_ATF_RDUMP }, /* 512KB */
- [AEE_PLAT_HVFS] = { "SYS_CPUHVFS_RAW", 0x3000, AEE_LKDUMP_CPU_HVFS_RAW}, /* 12 KB */
- #ifdef MTK_TINYSYS_SSPM_SUPPORT
- [AEE_PLAT_SSPM_COREDUMP] = { "SYS_SSPM_COREDUMP", 0x40080, AEE_LKDUMP_SSPM_COREDUMP}, /* 256KB + 128Byte */
- [AEE_PLAT_SSPM_DATA] = { "SYS_SSPM_DATA", 0x400, AEE_LKDUMP_SSPM_DATA}, /* 1KB */
- [AEE_PLAT_SSPM_XFILE] = { "SYS_SSPM_XFILE", 0xA0000, AEE_LKDUMP_SSPM_XFILE}, /* 640KB */
- [AEE_PLAT_SSPM_LAST_LOG] = { "SYS_SSPM_LAST_LOG", 0x400, AEE_LKDUMP_SSPM_LAST_LOG}, /* 1KB */
- #endif
- [AEE_PLAT_PLLK_LAST_LOG] = { "SYS_PLLK_LAST_LOG", 0x40000, AEE_LKDUMP_PLLK_LAST_LOG}, /* 256KB */
- [AEE_PLAT_LOG_DUR_LKDUMP] = { "SYS_LOG_DUR_LKDUMP", 0x40000, AEE_PLAT_LOG_DUR_LKDUMP}, /* 256KB */
- [AEE_PLAT_MCDI_DATA] = { "SYS_MCDI_DATA", 0x800, AEE_LKDUMP_MCDI_DATA}, /* 2KB, size will modified by plat. */
- #ifdef MTK_TINYSYS_SCP_SUPPORT
- [AEE_PLAT_SCP_COREDUMP] = { "SYS_SCP_DUMP.gz", 0xA0000, AEE_LKDUMP_SCP_COREDUMP}, /* 640KB */
- #endif
- [AEE_PLAT_INFRA_CG] = { "SYS_LAST_INFRA_CG", 0x1000, AEE_LKDUMP_LAST_INFRA_CG}, /* 4 KB */
- #ifdef MTK_AUDIODSP_SUPPORT
- [AEE_PLAT_ADSP_COREDUMP] = { "SYS_ADSP_COREDUMP", 0x11000, AEE_LKDUMP_ADSP_COREDUMP}, /* 68KB */
- #endif
- #ifdef MTK_TINYSYS_MCUPM_SUPPORT
- [AEE_PLAT_MCUPM_COREDUMP] = { "SYS_MCUPM_COREDUMP", 0x40080, AEE_LKDUMP_MCUPM_COREDUMP}, /* 256KB + 128Byte */
- [AEE_PLAT_MCUPM_DATA] = { "SYS_MCUPM_DATA", 0x400, AEE_LKDUMP_MCUPM_DATA}, /* 1KB */
- [AEE_PLAT_MCUPM_XFILE] = { "SYS_MCUPM_XFILE", 0xA0000, AEE_LKDUMP_MCUPM_XFILE}, /* 640KB */
- [AEE_PLAT_MCUPM_LAST_LOG] = { "SYS_MCUPM_LAST_LOG", 0x400, AEE_LKDUMP_MCUPM_LAST_LOG}, /* 1KB */
- #endif
- #ifdef MTK_PICACHU_SUPPORT
- [AEE_PLAT_PICACHU_LOG] = { "SYS_PICACHU_LOG", 0x80000, AEE_LKDUMP_PICACHU_LOG}, /* 512 KB */
- #endif
- };
- struct aee_db_file_info* get_file_info(void)
- {
- return adfi;
- }
- /**************************/
- /* ---------------- */
- /* RAM_CONSOLE_DRAM_ADDR */
- /* (1M align) */
- /* +RAM_CONSOLE_DRAM_SIZE */
- /* */
- /* ---------------- */
- /* +0xe0000 */
- /* */
- /* ---------------- */
- /* KE_RESERVED_MEM_ADDR */
- /* */
- /* ---------------- */
- /* RAMDISK_LOAD_ADDR */
- /**************************/
- static unsigned int ke_reserved_mem_addr_atag(void)
- {
- unsigned int addr;
- unsigned int size;
- mrdump_mini_header_addr_size(&addr, &size);
- return addr;
- }
- #define KE_RESERVED_MEM_ADDR ke_reserved_mem_addr_atag()
- #define EXPDB_RESERVED_OTHER (3 * 1024 * 1024) //reserved expdb for control block and pl/lk log
- #if defined(MTK_MLC_NAND_SUPPORT) || defined(MTK_TLC_NAND_SUPPORT)
- #define MEM_EXPDB_SIZE 0x300000
- static char *mem_expdb;
- #endif
- struct ke_dev {
- part_dev_t *dev;
- uint part_id;
- u64 ptn;
- u64 part_size;
- };
- static struct ke_dev dev;
- struct elfhdr {
- void *start;
- unsigned int e_machine;
- unsigned int e_phoff;
- unsigned int e_phnum;
- };
- struct kedump_crc {
- unsigned int ram_console_crc;
- unsigned int pstore_crc;
- };
- static struct kedump_crc kc;
- extern BOOT_ARGUMENT *g_boot_arg;
- #define SZLOG 20480
- static char logbuf[SZLOG];
- extern bool ram_console_should_restore(unsigned char *tmp_ram_console);
- #ifdef MTK_PMIC_FULL_RESET
- extern bool ram_console_reboot_by_cold_reset(void);
- #endif
- int check_ram_console_is_abnormal_boot(void)
- {
- return ram_console_is_abnormal_boot();
- }
- static unsigned int last_dump_step;
- int sLOG(char *fmt, ...)
- {
- va_list args;
- static int pos = 0;
- va_start(args, fmt);
- if (pos < SZLOG - 1) /* vsnprintf bug */
- pos += vsnprintf(logbuf + pos, SZLOG - pos - 1, fmt, args);
- va_end(args);
- return 0;
- }
- #define LOG(fmt, ...) \
- do { \
- sLOG(fmt, ##__VA_ARGS__); \
- printf(fmt, ##__VA_ARGS__); \
- } while (0)
- #define LOGD(fmt, ...) \
- sLOG(fmt, ##__VA_ARGS__)
- #define elf_note elf32_note
- #define PHDR_PTR(ehdr, phdr, mem) \
- (ehdr->e_machine == EM_ARM ? ((struct elf32_phdr*)phdr)->mem : ((struct elf64_phdr*)phdr)->mem)
- #define PHDR_TYPE(ehdr, phdr) PHDR_PTR(ehdr, phdr, p_type)
- #define PHDR_VADDR(ehdr, phdr) PHDR_PTR(ehdr, phdr, p_vaddr)
- #define PHDR_ADDR(ehdr, phdr) PHDR_PTR(ehdr, phdr, p_paddr)
- #define PHDR_SIZE(ehdr, phdr) PHDR_PTR(ehdr, phdr, p_filesz)
- #define PHDR_OFF(ehdr, phdr) PHDR_PTR(ehdr, phdr, p_offset)
- #define PHDR_INDEX(ehdr, i) \
- (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)
- #ifndef ALIGN
- #define ALIGN(x, a) (((x) + ((a) -1)) & ~((a) -1))
- #endif
- extern uint64_t v2p_64(uint64_t vptr);
- static struct mrdump_control_block g_mcb;
- static uint64_t _get_mpt(struct mrdump_control_block *mcb)
- {
- if (mcb == NULL) {
- LOG("%s: mrdump_cb is NULL\n", __func__);
- return 0;
- }
- if (memcmp(mcb->sig, MRDUMP_GO_DUMP, 8) == 0) {
- struct mrdump_machdesc *mmp = &mcb->machdesc;
- /* LOG("kedump: get mpt:0x%llx\n", mmp->master_page_table); */
- return mmp->master_page_table;
- } else {
- LOG("mrdump_cb: unexpected sig error:0x%llx in %s\n", *(uint64_t *)mcb, __func__);
- return 0;
- }
- }
- uint64_t get_mpt(void)
- {
- return _get_mpt(&g_mcb);
- }
- static void get_vmalloc_range(struct mrdump_control_block *mcb, uint64_t *vmalloc_start, uint64_t *vmalloc_end)
- {
- if (mcb == NULL || vmalloc_start == NULL || vmalloc_end == NULL)
- return;
- if (memcmp(mcb->sig, MRDUMP_GO_DUMP, 8) == 0) {
- struct mrdump_machdesc *mmp = &mcb->machdesc;
- *vmalloc_start = mmp->vmalloc_start;
- *vmalloc_end = mmp->vmalloc_end;
- } else {
- *vmalloc_start = 0;
- *vmalloc_end = 0;
- }
- }
- static bool is_dram_address(uint64_t addr, struct mrdump_control_block *mcb)
- {
- if (mcb == NULL)
- return false;
- if (memcmp(mcb->sig, MRDUMP_GO_DUMP, 8) == 0) {
- struct mrdump_machdesc *mmp = &mcb->machdesc;
- return (addr >= mmp->dram_start && addr < mmp->dram_end);
- } else {
- return false;
- }
- }
- static int is_arm_32bit(struct mrdump_control_block *mcb, uint64_t vaddr)
- {
- bool isret = (vaddr <= 0xffffffffUL) ? true : false;
- if (mcb == NULL)
- return isret;
- if (memcmp(mcb->sig, MRDUMP_GO_DUMP, 8) == 0) {
- struct mrdump_machdesc *mmp = &mcb->machdesc;
- return (mmp->page_offset > 0 && mmp->page_offset <= 0xffffffffUL);
- } else {
- return isret;
- }
- }
- static unsigned int calculate_crc32(void *data, unsigned int len)
- {
- unsigned int mycrc;
- unsigned int ret;
- mycrc = crc32(0L, Z_NULL, 0);
- ret = crc32(mycrc, data, len);
- LOG("kedump: crc = 0x%x\n", ret);
- return ret;
- }
- static struct elfhdr* kedump_elf_hdr(void)
- {
- char *ei;
- static struct elfhdr kehdr;
- static struct elfhdr *ehdr = (void*)-1;
- if (ehdr != (void*)-1)
- return ehdr;
- ehdr = NULL;
- kehdr.start = (void*)(KE_RESERVED_MEM_ADDR);
- LOG("kedump: KEHeader %p\n", kehdr.start);
- if (kehdr.start) {
- ei = (char*)kehdr.start; //elf_hdr.e_ident
- LOG("kedump: read header 0x%p[0x%x%x%x%x]\n", ei, ei[0], ei[1], ei[2], ei[3]);
- /* valid elf header */
- if (ei[0] == 0x7f && ei[1] == 'E' && ei[2] == 'L' && ei[3] == 'F') {
- kehdr.e_machine = ((struct elf32_hdr*)(kehdr.start))->e_machine;
- if (kehdr.e_machine == EM_ARM) {
- kehdr.e_phnum = ((struct elf32_hdr*)(kehdr.start))->e_phnum;
- kehdr.e_phoff = ((struct elf32_hdr*)(kehdr.start))->e_phoff;
- ehdr = &kehdr;
- } else if (kehdr.e_machine == EM_AARCH64) {
- kehdr.e_phnum = ((struct elf64_hdr*)(kehdr.start))->e_phnum;
- kehdr.e_phoff = ((struct elf64_hdr*)(kehdr.start))->e_phoff;
- ehdr = &kehdr;
- }
- }
- if (ehdr == NULL)
- LOG("kedump: invalid header[0x%x%x%x%x]\n", ei[0], ei[1], ei[2], ei[3]);
- }
- LOG("kedump: mach[0x%x], phnum[0x%x], phoff[0x%x]\n", kehdr.e_machine, kehdr.e_phnum, kehdr.e_phoff);
- return ehdr;
- }
- static int kedump_dev_open(void)
- {
- int index;
- index = partition_get_index(AEE_IPANIC_PLABLE);
- dev.dev = mt_part_get_device();
- if (index == -1 || dev.dev == NULL) {
- LOG("kedump: no %s partition[%d]\n", AEE_IPANIC_PLABLE, index);
- return -1;
- }
- #if (defined(MTK_UFS_SUPPORT) || defined(MTK_NEW_COMBO_EMMC_SUPPORT))
- dev.part_id = partition_get_region(index);
- #endif
- dev.ptn = partition_get_offset(index);
- dev.part_size = partition_get_size(index);
- if (dev.part_size < EXPDB_RESERVED_OTHER) {
- LOG("kedump: partition size(%llx) is lesser then reserved!(%llx)\n", dev.part_size, (unsigned long long)EXPDB_RESERVED_OTHER);
- return -1;
- }
- dev.part_size -= EXPDB_RESERVED_OTHER; //reserved expdb for others
- LOG("kedump: partiton %d[%llx - %llx]\n", index, dev.ptn, dev.part_size);
- return 0;
- }
- #if defined(MTK_MLC_NAND_SUPPORT) || defined(MTK_TLC_NAND_SUPPORT)
- unsigned long long mem_expdb_write(void *data, unsigned long long offset, unsigned long sz)
- {
- if ((offset + sz) > MEM_EXPDB_SIZE) {
- LOG("overflow!\n");
- return 0;
- }
- memcpy((mem_expdb + offset), data, (unsigned long)sz);
- return sz;
- }
- #endif
- #define TRUNK 0x8000
- static unsigned long long kedump_dev_write (unsigned long long offset, uint64_t data, unsigned long sz)
- {
- unsigned long long size_wrote = 0;
- vaddr_t vaddr = (uint32_t)data;
- vaddr_t memsrc = vaddr;
- uint8_t *trunk = malloc(TRUNK);
- unsigned long rest = sz;
- if (trunk == NULL) {
- LOG("kedump: malloc failed\n");
- return 0;
- }
- LOG("kedump: offset:0x%llx, data:0x%llx, size:0x%lx\n", offset, data, sz);
- #ifdef MTK_3LEVEL_PAGETABLE
- {
- /*int ret;*/
- uint64_t start = ROUNDDOWN((uint64_t)data, (uint64_t)PAGE_SIZE);
- vaddr = ROUNDUP((vaddr_t)target_get_scratch_address(), PAGE_SIZE);
- uint32_t secsize = ROUNDUP((uint32_t)(data - start + sz), PAGE_SIZE);
- if (start >= DRAM_PHY_ADDR) {
- /* minirdump: minirdump will dump memory in DRAM, we must allocate it first */
- int map_ok = arch_mmu_map((uint64_t) start, vaddr,
- MMU_MEMORY_TYPE_NORMAL_WRITE_BACK | MMU_MEMORY_AP_P_RW_U_NA, secsize);
- if (map_ok != NO_ERROR)
- LOG("kedump: map error\n");
- memsrc = vaddr + (uint32_t)(data - start);
- }
- /*LOG("kedump: start:0x%llx, vaddr:0x%x, secsize:0x%x, memsrc:0x%x\n", start, vaddr, secsize, memsrc);*/
- }
- #endif
- if (offset >= dev.part_size || sz > dev.part_size - offset) {
- if (trunk != NULL)
- free(trunk);
- LOG("kedump: write oversize %lx -> %llx > %llx\n", sz, offset, dev.part_size);
- return 0;
- }
- while (rest > 0) {
- unsigned long write_sz;
- memset(trunk, 0x0, TRUNK);
- if (rest <= TRUNK) {
- write_sz = rest;
- } else {
- write_sz = TRUNK;
- }
- memcpy(trunk, (void *)(memsrc + (sz - rest)), write_sz);
- #if (defined(MTK_UFS_SUPPORT) || defined(MTK_EMMC_SUPPORT))
- #if (defined(MTK_UFS_SUPPORT) || defined(MTK_NEW_COMBO_EMMC_SUPPORT))
- size_wrote += dev.dev->write(dev.dev, trunk, dev.ptn + offset, write_sz, dev.part_id);
- #else
- size_wrote += dev.dev->write(dev.dev, trunk, dev.ptn + offset, write_sz);
- #endif
- #elif defined(MTK_NAND_SUPPORT)
- size_wrote += dev.dev->write(dev.dev, trunk, (unsigned long)dev.ptn + offset, write_sz);
- #endif
- #if defined(MTK_MLC_NAND_SUPPORT) || defined(MTK_TLC_NAND_SUPPORT)
- size_wrote += mem_expdb_write(trunk, offset, write_sz);
- #endif
- offset += write_sz;
- rest -= write_sz;
- }
- if ((long long)size_wrote <= 0) {
- LOG("kedump: write failed(%llx), %lx@%llx -> %llx\n", size_wrote, sz, data, offset);
- size_wrote = 0;
- }
- free(trunk);
- #ifdef MTK_3LEVEL_PAGETABLE
- {
- /* restore vaddr */
- uint64_t start = ROUNDDOWN((uint64_t)data, (uint64_t)PAGE_SIZE);
- uint32_t secsize = ROUNDUP((uint32_t)(data - start + sz), PAGE_SIZE);
- if (start >= DRAM_PHY_ADDR) {
- int map_ok = arch_mmu_map(vaddr, vaddr, MMU_MEMORY_TYPE_NORMAL_WRITE_BACK | MMU_MEMORY_AP_P_RW_U_NA, secsize);
- if (map_ok != NO_ERROR) {
- LOG("kedump: arch_mmu_map restore error: map_ok=%d, vaddr=0x%08lx\n",
- map_ok, (unsigned long)vaddr);
- }
- }
- }
- #endif
- return size_wrote;
- }
- uint64_t kedump_mem_read(uint64_t data, unsigned long sz, void *buf)
- {
- uint64_t size_read = 0;
- vaddr_t vaddr = (uint32_t)data;
- vaddr_t memsrc = vaddr;
- uint8_t *trunk = NULL;
- unsigned long rest = sz;
- unsigned long buf_offset = 0;
- if(!is_dram_address(data, &g_mcb) || !is_dram_address((data + sz), &g_mcb)) {
- LOG("kedump: illegal address:0x%llx(sz:0x%lx)\n", data, sz);
- return 0;
- }
- trunk = malloc(TRUNK);
- if (trunk == NULL) {
- LOG("kedump: malloc failed in %s\n", __func__);
- return 0;
- }
- /* LOG("kedump: read data:0x%llx, size:0x%lx\n", data, sz); */
- #ifdef MTK_3LEVEL_PAGETABLE
- {
- /*int ret;*/
- uint64_t start = ROUNDDOWN((uint64_t)data, (uint64_t)PAGE_SIZE);
- vaddr = ROUNDUP((vaddr_t)target_get_scratch_address(), PAGE_SIZE);
- uint32_t secsize = ROUNDUP((uint32_t)(data - start + sz), PAGE_SIZE);
- if (start >= DRAM_PHY_ADDR) {
- /* minirdump: minirdump will dump memory in DRAM, we must allocate it first */
- int map_ok = arch_mmu_map((uint64_t) start, vaddr,
- MMU_MEMORY_TYPE_NORMAL_WRITE_BACK | MMU_MEMORY_AP_P_RW_U_NA, secsize);
- if (map_ok != NO_ERROR)
- LOG("kedump: map error in %s\n", __func__);
- memsrc = vaddr + (uint32_t)(data - start);
- } else {
- LOG("kedump: try to map address:0x%llx(sz:0x%lx)\n", data, sz);
- LOG("kedump: illegal rounddown:0x%llx\n", start);
- free(trunk);
- return 0;
- }
- /*LOG("kedump: start:0x%llx, vaddr:0x%x, secsize:0x%x, memsrc:0x%x\n", start, vaddr, secsize, memsrc);*/
- }
- #endif
- while (rest > 0) {
- unsigned long read_sz;
- memset(trunk, 0x0, TRUNK);
- if (rest <= TRUNK) {
- read_sz = rest;
- } else {
- read_sz = TRUNK;
- }
- memcpy(trunk, (void *)(memsrc + (sz - rest)), read_sz);
- memcpy(buf + buf_offset, trunk, read_sz);
- size_read += read_sz;
- buf_offset += read_sz;
- rest -= read_sz;
- }
- free(trunk);
- #ifdef MTK_3LEVEL_PAGETABLE
- {
- /* restore vaddr */
- uint64_t start = ROUNDDOWN((uint64_t)data, (uint64_t)PAGE_SIZE);
- uint32_t secsize = ROUNDUP((uint32_t)(data - start + sz), PAGE_SIZE);
- if (start >= DRAM_PHY_ADDR) {
- int map_ok = arch_mmu_map(vaddr, vaddr, MMU_MEMORY_TYPE_NORMAL_WRITE_BACK | MMU_MEMORY_AP_P_RW_U_NA, secsize);
- if (map_ok != NO_ERROR) {
- LOG("kedump: arch_mmu_map restore error: map_ok=%d, vaddr=0x%08lx in %s\n",
- map_ok, (unsigned long)vaddr, __func__);
- }
- }
- }
- #endif
- return size_read;
- }
- static unsigned long long offset_plat_debug = 0;
- static unsigned long length_plat_debug = 0;
- static unsigned long long kedump_plat_write (void *data, unsigned long sz)
- {
- unsigned long long datasize = 0;
- datasize = kedump_dev_write(offset_plat_debug, (uint64_t)((uint32_t)data), sz);
- offset_plat_debug += datasize;
- length_plat_debug += sz;
- return datasize;
- }
- static void kedump_dev_close(void)
- {
- return;
- }
- /* the min offset reserved for the header's size. */
- static unsigned long kedump_mrdump_header_size (struct elfhdr *ehdr)
- {
- void *phdr = PHDR_INDEX(ehdr, 1);
- return ALIGN(PHDR_OFF(ehdr, phdr) + PHDR_SIZE(ehdr, phdr), PAGE_SIZE);
- }
- static unsigned long long kedump_dev_write_vmalloc_range(unsigned long long offset, uint64_t vaddr, uint64_t addr, unsigned long size)
- {
- bool flag;
- unsigned long long lcheckaddr;
- unsigned long long lnew, hnew, hnewtmp;
- unsigned long long vmalloc_start, vmalloc_end;
- unsigned long long paddr, pcheckaddr;
- int checkloop = 0;
- unsigned long long size_wrote = 0;
- /* vaddr & vadd + size are PAGE_SIZE alignment */
- lnew = vaddr;
- hnew = vaddr + size;
- paddr = addr;
- flag = true;
- get_vmalloc_range(&g_mcb, &vmalloc_start, &vmalloc_end);
- if (hnew <= lnew
- || !(vaddr >= vmalloc_start && vaddr + size <= vmalloc_end)) {
- LOG("kedump: wrong range 0x%llx-0x%llx\n", lnew, hnew);
- return 0;
- }
- while (flag) {
- for(checkloop = 1; checkloop < (int)((hnew - lnew) / PAGE_SIZE); checkloop++) {
- lcheckaddr = lnew + checkloop * (unsigned long long)PAGE_SIZE;
- pcheckaddr = v2p_64(lcheckaddr);
- /* NOTE:
- * convert result should not be 0
- * if the result is 0 it should be the case invalid pfn pa address is recorded in kernel
- * */
- if (pcheckaddr == 0 || !is_dram_address(pcheckaddr, &g_mcb)) {
- if (pcheckaddr != 0)
- LOG("kedump: invalid convert address:0x%llx\n", pcheckaddr);
- LOG("kedump: convert failed expected pa:0x%llx (va:0x%llx)\n", paddr + checkloop * (unsigned long long)PAGE_SIZE, lcheckaddr);
- continue;
- }
- if (pcheckaddr != (paddr + checkloop * (unsigned long long)PAGE_SIZE)) {
- flag = false;
- LOG("kedump: non-cont 0x%llx found(va:0x%llx, pa:0x%llx)\n", paddr + checkloop * (unsigned long long)PAGE_SIZE, lcheckaddr, pcheckaddr);
- break;
- } else {
- }
- }
- hnewtmp = flag ? hnew : lcheckaddr;
- size_wrote += kedump_dev_write(offset, (uint64_t)paddr, (hnewtmp - lnew));
- offset += (hnewtmp - lnew);
- if (!flag) {
- lnew = lcheckaddr;
- paddr = pcheckaddr;
- flag = true;
- } else {
- flag = false;
- }
- }
- return size_wrote;
- }
- static unsigned int kedump_mini_rdump(struct elfhdr *ehdr, unsigned long long offset)
- {
- void *phdr;
- unsigned long long addr;
- unsigned long long vaddr;
- unsigned long long vmalloc_start, vmalloc_end;
- unsigned long size;
- unsigned int i;
- unsigned int total = 0;
- unsigned long elfoff = kedump_mrdump_header_size(ehdr);
- unsigned long sz_header = elfoff;
- #ifdef MTK_3LEVEL_PAGETABLE
- {
- uint32_t start = KE_RESERVED_MEM_ADDR;
- /* KEDump need to use header in DRAZM, we must allocate it first */
- arch_mmu_map(ROUNDDOWN((uint64_t)start, PAGE_SIZE), ROUNDDOWN((uint32_t)start, PAGE_SIZE),
- MMU_MEMORY_TYPE_NORMAL_WRITE_BACK | MMU_MEMORY_AP_P_RW_U_NA, ROUNDUP(sz_header, PAGE_SIZE));
- }
- #endif
- for (i = 0; i < ehdr->e_phnum; i++) {
- phdr = PHDR_INDEX(ehdr, i);
- if (PHDR_SIZE(ehdr, phdr) != 0 || PHDR_TYPE(ehdr, phdr) != 0)
- 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));
- if (PHDR_TYPE(ehdr, phdr) != PT_LOAD)
- continue;
- addr = PHDR_ADDR(ehdr, phdr);
- vaddr = PHDR_VADDR(ehdr, phdr);
- #ifdef MTK_MRDUMP_SRAM_CB
- if ((addr < DRAM_PHY_ADDR) && ((addr < MRDUMP_CB_ADDR) || (addr > (MRDUMP_CB_ADDR + MRDUMP_CB_SIZE)))) {
- LOG("kedump: skip dump non-allow PA:%llx, VA:%llx\n", addr, PHDR_VADDR(ehdr, phdr));
- continue;
- }
- #else
- if (addr < DRAM_PHY_ADDR) {
- LOG("kedump: skip dump non-dram PA:%llx, VA:%llx\n", addr, PHDR_VADDR(ehdr, phdr));
- continue;
- }
- #endif
- size = PHDR_SIZE(ehdr, phdr);
- if (size == 0 || elfoff == 0)
- LOG("kedump: dump addr 0x%llx, size 0x%lx\n", addr, size);
- if (ehdr->e_machine == EM_ARM)
- ((struct elf32_phdr*)phdr)->p_offset = elfoff;
- else
- ((struct elf64_phdr*)phdr)->p_offset = elfoff;
- if (size != 0 && elfoff != 0) {
- /* LOG("kedump: start:0x%llx-0x%llx\n", vaddr, vaddr + size); */
- /*
- * 1.|start...end|...|vmalloc_start...vmalloc_end|
- *
- * 2.|vmalloc_start...vmalloc_end|...|start...end|
- *
- * 3.|vmalloc_start...|start...end|...vmalloc_end|
- *
- * 4.|vmalloc_start...|start...vmalloc_end|...end|
- *
- * 5.|start...|vmalloc_start...end|...vmalloc_end|
- *
- * 6.|start...|vmalloc_start...vmalloc_end|...end|
- */
- get_vmalloc_range(&g_mcb, &vmalloc_start, &vmalloc_end);
- if (!is_arm_32bit(&g_mcb, vaddr)
- && (vaddr >= vmalloc_start) && (vaddr + size <= vmalloc_end)) {
- /* LOG("kedump: overlapp case: 3\n"); */
- total += kedump_dev_write_vmalloc_range(offset + elfoff, vaddr, addr, size);
- } else {
- if (!is_arm_32bit(&g_mcb, vaddr)) {
- if ((vaddr + size <= vmalloc_start) || (vaddr >= vmalloc_end)) {
- /* LOG("kedump: normal no-overlapp case: %d\n", (vaddr + size <= vmalloc_start) ? 1 : 2); */
- } else if ((vaddr <= vmalloc_start) && (vaddr + size >= vmalloc_end)) {
- /* not expected max size for mini rdump load is smaller than vmalloc */
- LOG("kedump: never overlapp case: 6\n");
- } else if ((vaddr + size <= vmalloc_end) || (vaddr >= vmalloc_start)) {
- /* not expected cases */
- LOG("kedump: should not be overlapp case: %d\n", (vaddr + size <= vmalloc_end) ? 5 : 4);
- }
- }
- total += kedump_dev_write(offset + elfoff, (uint64_t)addr, size);
- }
- }
- elfoff += size;
- }
- total += kedump_dev_write(offset, (uint64_t)((uint32_t)ehdr->start), sz_header);
- return total;
- }
- static unsigned int kedump_misc(unsigned long long addr, unsigned int start, unsigned int size, unsigned long long offset)
- {
- unsigned int total;
- LOG("kedump: misc data %x@%llx+%x\n", size, addr, start);
- if (start >= size)
- start = start % size;
- total = kedump_dev_write(offset, (uint64_t)(addr + start), size - start);
- if (start)
- total += kedump_dev_write(offset + total, (uint64_t)addr, start);
- return total;
- }
- static unsigned int kedump_misc32(struct mrdump_mini_misc_data32 *data, unsigned long long offset)
- {
- unsigned int addr = data->paddr;
- unsigned int start = 0;
- unsigned int size = data->size;
- if (data->start != 0)
- kedump_mem_read(data->start, sizeof(unsigned int), &start);
- else
- start = 0;
- return kedump_misc((uint64_t)((uint32_t)addr), start, size, offset);
- }
- static unsigned int kedump_misc64(struct mrdump_mini_misc_data64 *data, unsigned long long offset)
- {
- unsigned long long addr = (unsigned long long)data->paddr;
- unsigned int start = 0;
- unsigned int size = (unsigned int)data->size;
- if (data->start != 0)
- kedump_mem_read(data->start, sizeof(unsigned int), &start);
- else
- start = 0;
- return kedump_misc(addr, start, size, offset);
- }
- struct ipanic_header panic_header;
- static unsigned long long header_off;
- static void kedump_add2hdr(unsigned int offset, unsigned int size, unsigned datasize, char *name)
- {
- struct ipanic_data_header *pdata;
- int i;
- for (i = 0; i < IPANIC_NR_SECTIONS; i++) {
- pdata = &panic_header.data_hdr[i];
- if (pdata->valid == 0)
- break;
- }
- LOG("kedump add: %s[%d] %x/%x@%x\n", name, i, datasize, size, offset);
- if (i < IPANIC_NR_SECTIONS) {
- pdata->offset = offset;
- pdata->total = size;
- pdata->used = datasize;
- strlcpy((char*)pdata->name, name, sizeof(pdata->name));
- pdata->valid = 1;
- }
- header_off += kedump_dev_write(header_off, (uint64_t)((uint32_t)(pdata)), sizeof(struct ipanic_data_header));
- }
- static int kedump_kernel_info(unsigned long long *offset)
- {
- struct elfhdr *ehdr;
- unsigned long sz_misc;
- void *phdr_misc;
- struct elf_note *misc, *miscs;
- char *m_name;
- void *m_data;
- char name[32];
- unsigned int size, datasize;
- unsigned int i;
- ehdr = kedump_elf_hdr();
- if (0 == ehdr)
- return -1;
- ram_console_set_dump_step(AEE_LKDUMP_MINI_RDUMP);
- datasize = kedump_mini_rdump(ehdr, *offset);
- size = datasize;
- kedump_add2hdr(*offset, size, datasize, "SYS_MINI_RDUMP");
- *offset += datasize;
- phdr_misc = PHDR_INDEX(ehdr, 1);
- miscs = (struct elf_note*)(ehdr->start + PHDR_OFF(ehdr, phdr_misc));
- LOGD("kedump: misc[%p] %llx@%llx\n", phdr_misc, PHDR_SIZE(ehdr, phdr_misc), PHDR_OFF(ehdr, phdr_misc));
- sz_misc = sizeof(struct elf_note) + miscs->n_namesz + miscs->n_descsz;
- LOGD("kedump: miscs[%p], size %lx\n", miscs, sz_misc);
- for (i = 0; i < (PHDR_SIZE(ehdr, phdr_misc)) / sz_misc; i++) {
- char klog_first[16];
- unsigned int start_tmp = 0;
- memset(klog_first, 0x0, sizeof(klog_first));
- misc = (struct elf_note*)((void*)miscs + sz_misc * i);
- m_name = (char*)misc + sizeof(struct elf_note);
- if (m_name[0] == 'N' && m_name[1] == 'A' && m_name[2] == '\0')
- break;
- m_data = (void*)misc + sizeof(struct elf_note) + misc->n_namesz;
- if (misc->n_descsz == sizeof(struct mrdump_mini_misc_data32)) {
- if (strcmp(m_name, "_KERNEL_LOG_") == 0) {
- if (((struct mrdump_mini_misc_data32*)m_data)->start != 0)
- kedump_mem_read(((struct mrdump_mini_misc_data32*)m_data)->start, sizeof(unsigned int), &start_tmp);
- else
- start_tmp = 0;
- sprintf(klog_first, "_%u", start_tmp);
- ((struct mrdump_mini_misc_data32*)m_data)->start = 0;
- }
- datasize = kedump_misc32((struct mrdump_mini_misc_data32*)m_data, *offset);
- size = ((struct mrdump_mini_misc_data32*)m_data)->size;
- } else {
- if (strcmp(m_name, "_KERNEL_LOG_") == 0) {
- if (((struct mrdump_mini_misc_data64*)m_data)->start != 0)
- kedump_mem_read(((struct mrdump_mini_misc_data64*)m_data)->start, sizeof(unsigned int), &start_tmp);
- else
- start_tmp = 0;
- sprintf(klog_first, "_%u", start_tmp);
- ((struct mrdump_mini_misc_data64*)m_data)->start = 0;
- }
- datasize = kedump_misc64((struct mrdump_mini_misc_data64*)m_data, *offset);
- size = ((struct mrdump_mini_misc_data64*)m_data)->size;
- }
- /* [SYS_]MISC[_RAW] */
- if (m_name[0] == '_')
- strlcpy (name, "SYS", sizeof(name));
- else
- name[0] = 0;
- strlcat (name, m_name, sizeof(name));
- if (m_name[strlen(m_name)-1] == '_')
- strlcat (name, "RAW", sizeof(name));
- if (klog_first[0] != 0)
- strlcat(name, klog_first, sizeof(name));
- kedump_add2hdr(*offset, size, datasize, name);
- *offset += datasize;
- }
- return 0;
- }
- static int kedump_ram_console(unsigned long long *offset)
- {
- unsigned int sz_misc = 0, addr_misc = 0;
- unsigned int datasize;
- /* ram_console raw log */
- ram_console_set_dump_step(AEE_LKDUMP_RAMCONSOLE_RAW);
- ram_console_addr_size(&addr_misc, &sz_misc);
- if (addr_misc && sz_misc) {
- datasize = kedump_misc(addr_misc, 0, sz_misc, *offset);
- kc.ram_console_crc = calculate_crc32((void *)addr_misc, sz_misc);
- kedump_add2hdr(*offset, sz_misc, datasize, "SYS_RAMCONSOLE_RAW");
- *offset += datasize;
- }
- #ifdef MTK_PMIC_FULL_RESET
- /* pstore raw log*/
- ram_console_set_dump_step(AEE_LKDUMP_PSTORE_RAW);
- addr_misc = 0;
- sz_misc = 0;
- pstore_addr_size(&addr_misc, &sz_misc);
- if (addr_misc && sz_misc) {
- datasize = kedump_misc(addr_misc, 0, sz_misc, *offset);
- #ifdef MTK_3LEVEL_PAGETABLE
- {
- /*int ret;*/
- uint32_t start = ROUNDDOWN((uint32_t)addr_misc, PAGE_SIZE);
- uint32_t secsize = ROUNDUP(((uint32_t)sz_misc), PAGE_SIZE);
- if (start >= DRAM_PHY_ADDR) {
- /* minirdump: minirdump will dump memory in DRAM, we must allocate it first */
- arch_mmu_map((uint64_t) start, start,
- MMU_MEMORY_TYPE_NORMAL_WRITE_BACK | MMU_MEMORY_AP_P_RW_U_NA, secsize);
- }
- }
- #endif
- kc.pstore_crc = calculate_crc32((void *)addr_misc, sz_misc);
- kedump_add2hdr(*offset, sz_misc, datasize, "SYS_PSTORE_RAW");
- *offset += datasize;
- }
- #endif
- /* save crc data*/
- ram_console_set_dump_step(AEE_LKDUMP_KEDUMP_CRC);
- datasize = kedump_dev_write(*offset, (uint64_t)((uint32_t)(&kc)), sizeof(struct kedump_crc));
- kedump_add2hdr(*offset, sizeof(struct kedump_crc), datasize, "KEDUMP_CRC");
- *offset += datasize;
- return 0;
- }
- static int kedump_platform_debug(unsigned long long *offset)
- {
- /* platform debug */
- int len = 0;
- unsigned int datasize;
- unsigned int i;
- for (i=0; i<AEE_PLAT_DEBUG_NUM; i++) {
- offset_plat_debug = *offset;
- length_plat_debug = 0;
- ram_console_set_dump_step(adfi[i].step);
- datasize = kedump_plat_savelog(i, offset_plat_debug, &len, kedump_plat_write);
- if ((datasize > 0) && (datasize <= adfi[i].filesize)) {
- kedump_add2hdr(*offset, length_plat_debug, datasize, adfi[i].filename);
- *offset += datasize;
- }
- }
- return 0;
- }
- static int kedump_to_expdb(void)
- {
- unsigned long long offset;
- unsigned int datasize;
- part_dev_t *part_dev;
- part_dev = mt_part_get_device();
- if (!part_dev || !part_dev->blkdev) {
- LOG("kedump: device get error, dev:%p\n", part_dev);
- return -1;
- }
- if (kedump_dev_open() != 0)
- return -1;
- last_dump_step = ram_console_get_dump_step();
- if (last_dump_step != AEE_LKDUMP_CLEAR) {
- LOG("kedump: last lk dump is not finished at step %u\n", last_dump_step);
- return 0;
- }
- #if defined(MTK_MLC_NAND_SUPPORT) || defined(MTK_TLC_NAND_SUPPORT)
- mem_expdb = malloc(MEM_EXPDB_SIZE);
- if (mem_expdb == NULL) {
- LOG("mem_expdb malloc fail!\n");
- return -1;
- }
- LOG("mem_expdb malloc success, 0x%x size is 0x%x\n", mem_expdb, MEM_EXPDB_SIZE);
- memset(mem_expdb, 0x0, MEM_EXPDB_SIZE);
- #endif
- //write header firstly
- panic_header.magic = AEE_IPANIC_MAGIC;
- panic_header.version = AEE_IPANIC_PHDR_VERSION;
- panic_header.size = sizeof(panic_header);
- panic_header.blksize = part_dev->blkdev->blksz;
- panic_header.partsize = dev.part_size;
- kedump_dev_write(0, (uint64_t)((uint32_t)(&panic_header)), sizeof(panic_header));
- header_off = sizeof(panic_header) - sizeof(struct ipanic_data_header) * IPANIC_NR_SECTIONS;
- LOG("kedump: block size:0x%lx\n", part_dev->blkdev->blksz);
- /* reserve space in expdb for panic header */
- offset = ALIGN(sizeof(panic_header), part_dev->blkdev->blksz);
- kedump_ram_console(&offset);
- kedump_kernel_info(&offset);
- kedump_platform_debug(&offset);
- /* save KEdump flow logs */
- datasize = kedump_dev_write(offset, (uint64_t)(uint32_t)logbuf, SZLOG);
- kedump_add2hdr(offset, SZLOG, datasize, "ZAEE_LOG");
- offset += datasize;
- #if defined(MTK_MLC_NAND_SUPPORT) || defined(MTK_TLC_NAND_SUPPORT)
- 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);
- free(mem_expdb);
- #endif
- ram_console_set_dump_step(AEE_LKDUMP_CLEAR);
- return 0;
- }
- static int kedump_restore_mem(void)
- {
- int i;
- struct ipanic_header iheader;
- struct kedump_crc saved_crc = {0, 0};
- unsigned int crc;
- unsigned int sz_misc = 0, addr_misc = 0;
- unsigned int sz_misc_pstore = 0, addr_misc_pstore = 0;
- unsigned char *temp_ram_console = NULL;
- #ifdef MTK_PMIC_FULL_RESET
- unsigned char *temp_pstore = NULL;
- #endif
- if (kedump_dev_open() != 0)
- return -1;
- dev.dev->read(dev.dev, dev.ptn, (unsigned char *)&iheader, sizeof(struct ipanic_header), dev.part_id);
- if (iheader.magic == AEE_IPANIC_MAGIC && iheader.version >= AEE_IPANIC_PHDR_VERSION) {
- LOG("kedump: found content in expdb\n");
- for (i = IPANIC_NR_SECTIONS - 1; i >= 0; i--) {
- if (strncmp((const char *)iheader.data_hdr[i].name, "KEDUMP_CRC", sizeof("KEDUMP_CRC") - 1) == 0) {
- 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);
- dev.dev->read(dev.dev, dev.ptn + iheader.data_hdr[i].offset, (uchar *)(&saved_crc), iheader.data_hdr[i].used, dev.part_id);
- }
- if (strncmp((const char *)iheader.data_hdr[i].name, "SYS_RAMCONSOLE_RAW", sizeof("SYS_RAMCONSOLE_RAW") - 1) == 0) {
- ram_console_addr_size(&addr_misc, &sz_misc);
- if (addr_misc && sz_misc) {
- temp_ram_console = malloc(sz_misc);
- if (!temp_ram_console) {
- LOG("kedump: temp ram_console alloc fail\n");
- } else {
- 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);
- memset(temp_ram_console, 0x0, sz_misc);
- //dev.dev->read(dev.dev, dev.ptn + iheader.data_hdr[i].offset, (uchar *)addr_misc, iheader.data_hdr[i].used, dev.part_id);
- dev.dev->read(dev.dev, dev.ptn + iheader.data_hdr[i].offset, temp_ram_console, iheader.data_hdr[i].used, dev.part_id);
- crc = calculate_crc32(temp_ram_console, sz_misc);
- if (crc != saved_crc.ram_console_crc) {
- LOG("kedump: temp ram_console crc fail\n");
- free(temp_ram_console);
- temp_ram_console = NULL;
- }
- }
- } else {
- LOG("kedump: ram_console not init\n");
- }
- }
- #ifdef MTK_PMIC_FULL_RESET
- else if (strncmp((const char *)iheader.data_hdr[i].name, "SYS_PSTORE_RAW", sizeof("SYS_PSTORE_RAW") - 1) == 0) {
- pstore_addr_size(&addr_misc_pstore, &sz_misc_pstore);
- if (!addr_misc_pstore || !sz_misc_pstore)
- continue;
- #ifdef MTK_3LEVEL_PAGETABLE
- {
- /*int ret;*/
- uint32_t start = ROUNDDOWN((uint32_t)addr_misc_pstore, PAGE_SIZE);
- uint32_t secsize = ROUNDUP(((uint32_t)sz_misc_pstore), PAGE_SIZE);
- if (start >= DRAM_PHY_ADDR) {
- /* minirdump: minirdump will dump memory in DRAM, we must allocate it first */
- arch_mmu_map((uint64_t) start, start,
- MMU_MEMORY_TYPE_NORMAL_WRITE_BACK | MMU_MEMORY_AP_P_RW_U_NA, secsize);
- }
- }
- #endif
- temp_pstore = malloc(sz_misc_pstore);
- if (!temp_pstore) {
- LOG("kedump: temp pstore alloc fail\n");
- } else {
- 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);
- memset(temp_pstore, 0x0, sz_misc_pstore);
- //dev.dev->read(dev.dev, dev.ptn + iheader.data_hdr[i].offset, (uchar *)addr_misc_pstore, iheader.data_hdr[i].used, dev.part_id);
- dev.dev->read(dev.dev, dev.ptn + iheader.data_hdr[i].offset, temp_pstore, iheader.data_hdr[i].used, dev.part_id);
- crc = calculate_crc32(temp_pstore, sz_misc_pstore);
- if (crc != saved_crc.pstore_crc) {
- LOG("kedump: temp pstore crc fail\n");
- free(temp_pstore);
- temp_pstore = NULL;
- }
- }
- }
- #endif
- }
- if (ram_console_should_restore(temp_ram_console)) {
- LOG("kedump: ram_console_should_restore\n");
- memcpy((uchar *)addr_misc, temp_ram_console, sz_misc);
- #ifdef MTK_PMIC_FULL_RESET
- if (temp_pstore)
- memcpy((uchar *)addr_misc_pstore, temp_pstore, sz_misc_pstore);
- #endif
- ram_console_set_dump_step(AEE_LKDUMP_CLEAR);
- ram_console_is_abnormal_boot();
- }
- if (temp_ram_console)
- free(temp_ram_console);
- #ifdef MTK_PMIC_FULL_RESET
- if (temp_pstore)
- free(temp_pstore);
- #endif
- }
- return 0;
- }
- static int kedump_skip(void)
- {
- unsigned int boot_reason = g_boot_arg->boot_reason;
- static int kedump_dumped = 0;
- LOG("kedump: boot_reason(%d)\n", boot_reason);
- ram_console_init();
- /* this flow should be executed once only */
- if (kedump_dumped == 0) {
- kedump_dumped = 1;
- if (ram_console_is_abnormal_boot())
- return 0;
- }
- #ifdef MTK_PMIC_FULL_RESET
- //if this reboot is full pmic reset, then restore the memory of ram_console and pstore
- if (ram_console_reboot_by_cold_reset()) {
- LOG("kedump: last is full pmic reset!\n");
- kedump_restore_mem();
- return 1;
- } else {
- LOG("kedump: last is not full pmic reset!\n");
- }
- #endif
- // for power lost or reboot before KE DB collected scenario
- kedump_restore_mem();
- return 1;
- }
- static int kedump_avail(void)
- {
- #ifdef MTK_3LEVEL_PAGETABLE
- vaddr_t vaddr = (vaddr_t)target_get_scratch_address();
- LOG("kedump: address:0x%lx, page size:0x%x\n", vaddr, PAGE_SIZE);
- {
- uint32_t start = KE_RESERVED_MEM_ADDR;
- /* KEDump need to use header in DRAZM, we must allocate it first */
- arch_mmu_map(ROUNDDOWN((uint64_t)start, PAGE_SIZE), ROUNDDOWN((uint32_t)start, PAGE_SIZE),
- MMU_MEMORY_TYPE_NORMAL_WRITE_BACK | MMU_MEMORY_AP_P_RW_U_NA, ROUNDUP(sizeof(struct elfhdr), PAGE_SIZE));
- }
- #endif
- void *flag = (void *)(KE_RESERVED_MEM_ADDR);
- if (((char *)flag)[0] == 0x81 && ((char *)flag)[1] == 'E' && ((char *)flag)[2] == 'L' && ((char *)flag)[3] == 'F') {
- LOG("kedump: already dumped in lk\n");
- return -1;
- }
- if (((char *)flag)[0] == 0x0 && ((char *)flag)[1] == 'E' && ((char *)flag)[2] == 'L' && ((char *)flag)[3] == 'F') {
- LOG("kedump: already dumped in kernel\n");
- return -1;
- }
- /*
- * read boot image first for determine kernel
- * is 32 bit or 64 bit
- */
- load_bootimg_hdr(BOOTIMG_TYPE_BOOT);
- return 0;
- }
- int kedump_get_data_info(int index, char **name, u32 *offset, u32 *size)
- {
- struct ipanic_header iheader;
- struct ipanic_data_header *pdata;
- if (kedump_dev_open() != 0)
- return -1;
- dev.dev->read(dev.dev, dev.ptn, (unsigned char *)&iheader, sizeof(struct ipanic_header), dev.part_id);
- if (iheader.magic != AEE_IPANIC_MAGIC || iheader.version < AEE_IPANIC_PHDR_VERSION)
- return -2;
- if (index < 0 || index >= IPANIC_NR_SECTIONS) {
- LOG("kedump: invalid index number:%d\n", index);
- return -3;
- }
- if (name == NULL || offset == NULL || size == NULL) {
- LOG("kedump: invalid argument number:%d\n", index);
- return -4;
- }
- pdata = &iheader.data_hdr[index];
- if (pdata->valid == 0)
- return -5;
- *name = (char *)pdata->name;
- *offset = pdata->offset;
- *size = pdata->used;
- return 0;
- }
- static int kedump_done(void)
- {
- void *flag = (void *)(KE_RESERVED_MEM_ADDR);
- ((char *)flag)[0] = 0x81;
- ((char *)flag)[1] = 'E';
- ((char *)flag)[2] = 'L';
- ((char *)flag)[3] = 'F';
- arch_clean_cache_range((addr_t)KE_RESERVED_MEM_ADDR, sizeof(struct elfhdr));
- return 0;
- }
- /* in case that platform didn't support smart_reset_check() */
- const char *smart_reset_check(void) __attribute__((weak));
- const char *smart_reset_check(void)
- {
- return NULL;
- }
- /* in case that platform didn't support mtk_wdt_get_last_stage() */
- const char *mtk_wdt_get_last_stage(void) __attribute__((weak));
- const char *mtk_wdt_get_last_stage(void)
- {
- return NULL;
- }
- #define SHOW_ARGS(p, a, b, c, d) \
- LOG(#a":0x%llx, "#b":0x%llx,"#c":0x%llx, "#d":0x%llx\n", (p)->a, (p)->b, (p)->c, (p)->d)
- static void show_info(struct mrdump_control_block *mcb)
- {
- if (mcb == NULL) {
- LOG("%s: mrdump_cb is NULL\n", __func__);
- return;
- }
- if (memcmp(mcb->sig, MRDUMP_GO_DUMP, 8) == 0) {
- struct mrdump_machdesc *mmp = &mcb->machdesc;
- SHOW_ARGS(mmp, vmalloc_start, vmalloc_end, master_page_table, high_memory);
- } else {
- LOG("mrdump_cb: sig error:0x%llx in %s\n", *(uint64_t *)mcb, __func__);
- return;
- }
- }
- extern BOOT_ARGUMENT *g_boot_arg;
- /* Dump KE infomation to expdb */
- /* 1: has expception, 0: has no exception */
- int kedump_mini(void)
- {
- const char *status;
- struct rtc_time tm;
- if (!read_kedump_config()) {
- LOG("kedump: disable\n");
- return 0;
- }
- status = smart_reset_check();
- if (status != NULL)
- LOG("%s\n", status);
- status = mtk_wdt_get_last_stage();
- if (status != NULL)
- LOG("%s\n", status);
- LOG("kedump mini start\n");
- rtc_get_time(&tm);
- 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);
- if (g_boot_arg) {
- if (!g_boot_arg->ddr_reserve_enable)
- LOG("kedump: ddr reserve mode disabled\n");
- else
- LOG("kedump: ddr reserve mode enabled\n");
- if (!g_boot_arg->ddr_reserve_success)
- LOG("kedump: ddr reserve mode failed\n");
- } else {
- LOG("kedump: null boot arg pointer error\n");
- }
- if (lkdump_debug_init())
- LOG("kedump: lkdump debug init ok\n");
- else
- LOG("kedump: lkdump debug not ready\n");
- if (kedump_skip())
- return 0;
- if (kedump_avail())
- return 0;
- aee_mrdump_get_info(&g_mcb);
- show_info(&g_mcb);
- kedump_to_expdb();
- kedump_done();
- LOG("kedump mini done\n");
- return 1;
- }
|