aee_platform_debug.c 19 KB

123456789101112131415161718192021222324252627282930313233343536373839404142434445464748495051525354555657585960616263646566676869707172737475767778798081828384858687888990919293949596979899100101102103104105106107108109110111112113114115116117118119120121122123124125126127128129130131132133134135136137138139140141142143144145146147148149150151152153154155156157158159160161162163164165166167168169170171172173174175176177178179180181182183184185186187188189190191192193194195196197198199200201202203204205206207208209210211212213214215216217218219220221222223224225226227228229230231232233234235236237238239240241242243244245246247248249250251252253254255256257258259260261262263264265266267268269270271272273274275276277278279280281282283284285286287288289290291292293294295296297298299300301302303304305306307308309310311312313314315316317318319320321322323324325326327328329330331332333334335336337338339340341342343344345346347348349350351352353354355356357358359360361362363364365366367368369370371372373374375376377378379380381382383384385386387388389390391392393394395396397398399400401402403404405406407408409410411412413414415416417418419420421422423424425426427428429430431432433434435436437438439440441442443444445446447448449450451452453454455456457458459460461462463464465466467468469470471472473474475476477478479480481482483484485486487488489490491492493494495496497498499500501502503504505506507508509510511512513514515516517518519520521522523524525526527528529530531532533534535536537538539540541542543544545546547548549550551552553554555556557558559560561562563564565566567568569570571572573574575576577578579580581582583584585586587588589590591592593594595596597598599600601602603604605606607608609610611612613614615616617618619620621622623624625626627628629630631632633634635636637638639640641642643644645646647648649650651652653654655656657658659660661662663664665666667668669670671672673674675676677678679680681682683684685686687688689690691692693694695696697698699700701702703704705706707708709710711712713714715716717718719720721722723724725726727728729730
  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 <malloc.h>
  32. #include <stdlib.h>
  33. #include <arch/arm/mmu.h>
  34. #include <dev/aee_platform_debug.h>
  35. #include <spm_common.h>
  36. #include <platform/dram_debug.h>
  37. #include <platform/plat_dbg_info.h>
  38. #include <platform/mt_reg_base.h>
  39. #include <platform/mt_typedefs.h>
  40. #include <platform/mtk_wdt.h>
  41. #include <platform/partition.h>
  42. #include <platform/platform_debug.h>
  43. #include "log_store_lk.h"
  44. #include <plat_debug_interface.h>
  45. #include <ram_console.h>
  46. #include <reg.h>
  47. #include <fdt.h>
  48. #include <libfdt.h>
  49. #include <debug.h>
  50. #ifdef MTK_TINYSYS_SSPM_SUPPORT
  51. #include <platform/mt_sspm.h>
  52. #endif
  53. #ifdef MTK_TINYSYS_SCP_SUPPORT
  54. #include <lib/zlib.h>
  55. #include <mt_scp.h>
  56. #include <mt_scp_excep.h>
  57. #endif
  58. #include <mtk_mcdi.h>
  59. #ifdef MTK_AB_OTA_UPDATER
  60. #include <mt_boot.h>
  61. #endif
  62. #include <plat_sram_flag.h>
  63. #include "mtk_secure_api.h"
  64. int plt_get_cluster_id(unsigned int cpu_id, unsigned int *core_id_in_cluster)
  65. {
  66. if (core_id_in_cluster == NULL)
  67. return -1;
  68. *core_id_in_cluster = (cpu_id % 4);
  69. return (cpu_id / 4);
  70. }
  71. unsigned long plt_get_cpu_power_status_at_wdt(void)
  72. {
  73. unsigned long bitmask = 0, ret;
  74. ret = readl(SLEEP_BASE + cfg_pc_latch.spm_pwr_sts);
  75. /* CPU0 ~ CPU3 */
  76. bitmask |= (ret & (0xf << 9)) >> 9;
  77. /* CPU4 ~ CPU7 */
  78. bitmask |= (ret & (0xf << 16)) >> 12;
  79. return bitmask;
  80. }
  81. static bool dfd_valid = false;
  82. static bool check_dfd_valid(u32* data)
  83. {
  84. if (data != NULL) {
  85. /*
  86. * 0x0 = {16’h0, 1’b0, 1’b1, 14’hx}
  87. * 0x4 = 32’h0
  88. * 0x8 = 32’h0
  89. * 0xC = 32’h0
  90. * 0x10 = 32’h0
  91. * 0x14 = 32’h0
  92. */
  93. if (((data[0] & 0xffff4000) == 0x4000)
  94. && data[1] == 0x0 && data[2] == 0x0
  95. && data[3] == 0x0 && data[4] == 0x0
  96. && data[5] == 0x0)
  97. dfd_valid = true;
  98. }
  99. return dfd_valid;
  100. }
  101. unsigned int plt_get_dfd_dump_type(void)
  102. {
  103. /* for mt6761 with DFD 3.0 -> always dump to DRAM*/
  104. if (cfg_dfd.version >= DFD_V3_0)
  105. return DFD_DUMP_TO_DRAM;
  106. else
  107. return DFD_DUMP_NOT_SUPPORT;
  108. }
  109. static unsigned int save_cpu_bus_data(u64 offset, int *len, CALLBACK dev_write)
  110. {
  111. char *buf = NULL;
  112. int ret;
  113. unsigned int datasize = 0;
  114. /* Save latch buffer */
  115. ret = latch_get((void **)&buf, len);
  116. if (ret && (buf != NULL)) {
  117. if (*len > 0)
  118. datasize = dev_write(buf, *len);
  119. latch_put((void **)&buf);
  120. }
  121. /* Save systracker buffer */
  122. ret = systracker_get((void **)&buf, len, 8);
  123. if (buf != NULL) {
  124. if (*len > 0)
  125. datasize += dev_write(buf, *len);
  126. systracker_put((void **)&buf);
  127. }
  128. return datasize;
  129. }
  130. static unsigned int save_dfd_data(u64 offset, int *len, CALLBACK dev_write)
  131. {
  132. char *buf = NULL;
  133. unsigned int datasize = 0;
  134. /* Save dfd buffer */
  135. if (dfd_get((void **)&buf, len)) {
  136. datasize = dev_write(buf, *len);
  137. dfd_put((void **)&buf);
  138. }
  139. return datasize;
  140. }
  141. void platform_lastpc_postinit(void)
  142. {
  143. mt_secure_call(MTK_SIP_LK_LASTPC, 0, 0, 0, 0);
  144. }
  145. /* SPM Debug Features */
  146. static unsigned int spm_wdt_latch_regs[] = {
  147. SLEEP_BASE + 0x800, /* PCM_WDT_LATCH_0 */
  148. SLEEP_BASE + 0x804, /* PCM_WDT_LATCH_1 */
  149. SLEEP_BASE + 0x808, /* PCM_WDT_LATCH_2 */
  150. SLEEP_BASE + 0x80c, /* PCM_WDT_LATCH_3 */
  151. SLEEP_BASE + 0x810, /* PCM_WDT_LATCH_4 */
  152. SLEEP_BASE + 0x814, /* PCM_WDT_LATCH_5 */
  153. SLEEP_BASE + 0x818, /* PCM_WDT_LATCH_6 */
  154. SLEEP_BASE + 0x81c, /* PCM_WDT_LATCH_7 */
  155. SLEEP_BASE + 0x820, /* PCM_WDT_LATCH_8 */
  156. SLEEP_BASE + 0x824, /* PCM_WDT_LATCH_9 */
  157. SLEEP_BASE + 0x838, /* PCM_WDT_LATCH_10 */
  158. SLEEP_BASE + 0x83c, /* PCM_WDT_LATCH_11 */
  159. SLEEP_BASE + 0x888, /* PCM_WDT_LATCH_12 */
  160. SLEEP_BASE + 0x88c, /* PCM_WDT_LATCH_13 */
  161. SLEEP_BASE + 0x828, /* WDT_LATCH_SPARE0 */
  162. SLEEP_BASE + 0x82c, /* WDT_LATCH_SPARE1 */
  163. SLEEP_BASE + 0x830, /* WDT_LATCH_SPARE2 */
  164. SLEEP_BASE + 0x834, /* WDT_LATCH_SPARE3 */
  165. SLEEP_BASE + 0x780, /* WDT_LATCH_SPARE0_FIX */
  166. SLEEP_BASE + 0x784, /* WDT_LATCH_SPARE1_FIX */
  167. SLEEP_BASE + 0x788, /* WDT_LATCH_SPARE2_FIX */
  168. SLEEP_BASE + 0x78C, /* WDT_LATCH_SPARE3_FIX */
  169. SLEEP_BASE + 0x914, /* SPM_ACK_CHK_LATCH */
  170. SLEEP_BASE + 0x934, /* SPM_ACK_CHK_LATCH2 */
  171. SLEEP_BASE + 0x954, /* SPM_ACK_CHK_LATCH3 */
  172. SLEEP_BASE + 0x974, /* SPM_ACK_CHK_LATCH4 */
  173. SLEEP_BASE + 0x840, /* DCHA_GATING_LATCH_0 */
  174. SLEEP_BASE + 0x844, /* DCHA_GATING_LATCH_1 */
  175. SLEEP_BASE + 0x848, /* DCHA_GATING_LATCH_2 */
  176. SLEEP_BASE + 0x84c, /* DCHA_GATING_LATCH_3 */
  177. SLEEP_BASE + 0x850, /* DCHA_GATING_LATCH_4 */
  178. SLEEP_BASE + 0x854, /* DCHA_GATING_LATCH_5 */
  179. SLEEP_BASE + 0x858, /* DCHA_GATING_LATCH_6 */
  180. SLEEP_BASE + 0x85c, /* DCHA_GATING_LATCH_7 */
  181. SLEEP_BASE + 0x860, /* DCHB_GATING_LATCH_0 */
  182. SLEEP_BASE + 0x864, /* DCHB_GATING_LATCH_1 */
  183. SLEEP_BASE + 0x868, /* DCHB_GATING_LATCH_2 */
  184. SLEEP_BASE + 0x86c, /* DCHB_GATING_LATCH_3 */
  185. SLEEP_BASE + 0x870, /* DCHB_GATING_LATCH_4 */
  186. SLEEP_BASE + 0x874, /* DCHB_GATING_LATCH_5 */
  187. SLEEP_BASE + 0x878, /* DCHB_GATING_LATCH_6 */
  188. SLEEP_BASE + 0x87c, /* DCHB_GATING_LATCH_7 */
  189. SLEEP_BASE + 0x880, /* DCHA_LATCH_RSV0 */
  190. SLEEP_BASE + 0x884, /* DCHB_LATCH_RSV0 */
  191. SLEEP_BASE + 0x794, /* DCHA_LATCH_RSV0_FIX */
  192. SLEEP_BASE + 0x79c, /* DCHB_LATCH_RSV0_FIX */
  193. };
  194. #define DVFSRC_LAST (DVFSRC_BASE + 0x308)
  195. #define DVFSRC_LAST_L (DVFSRC_BASE + 0x30C)
  196. #define DVFSRC_DUMP (DVFSRC_BASE + 0x400)
  197. #define DVFSRC_SIZE 0xE0
  198. #define SPM_DATA_BUF_LENGTH (4096)
  199. static int spm_dump_data(char *buf, int *wp)
  200. {
  201. unsigned int i;
  202. unsigned val;
  203. #ifdef SPM_FW_USE_PARTITION
  204. char part_name[16] = "spmfw";
  205. #ifdef MTK_AB_OTA_UPDATER
  206. get_AB_OTA_name((void *)&part_name, sizeof(part_name));
  207. #endif /* MTK_AB_OTA_UPDATER */
  208. #endif /* SPM_FW_USE_PARTITION */
  209. if (buf == NULL || wp == NULL)
  210. return -1;
  211. for (i = 0; i < (sizeof(spm_wdt_latch_regs)/sizeof(unsigned int)); i++) {
  212. val = readl(spm_wdt_latch_regs[i]);
  213. *wp += sprintf(buf + *wp,
  214. "SPM regs(0x%x) = 0x%x\n",
  215. spm_wdt_latch_regs[i], val);
  216. }
  217. #ifdef SPM_FW_USE_PARTITION
  218. get_spmfw_version(part_name, "spmfw", buf, wp);
  219. #endif /* SPM_FW_USE_PARTITION */
  220. val = readl(DVFSRC_LAST);
  221. *wp += sprintf(buf + *wp,
  222. "DVFSRC regs(0x%x) = 0x%08x\n", DVFSRC_LAST, val);
  223. val = readl(DVFSRC_LAST_L);
  224. *wp += sprintf(buf + *wp,
  225. "DVFSRC regs(0x%x) = 0x%08x\n", DVFSRC_LAST_L, val);
  226. for (i = 0; i < DVFSRC_SIZE; i += 4) {
  227. val = readl(DVFSRC_DUMP + i);
  228. *wp += sprintf(buf + *wp,
  229. "DVFSRC regs(0x%x) = 0x%08x\n", DVFSRC_DUMP + i, val);
  230. }
  231. if (*wp > SPM_DATA_BUF_LENGTH) {
  232. dprintf(CRITICAL, "[spm] out of range: 0x%x > SPM_DATA_BUF_LENGTH(0x%x)\n", *wp, SPM_DATA_BUF_LENGTH);
  233. assert(0);
  234. }
  235. return 1;
  236. }
  237. int spm_data_get(void **data, int *len)
  238. {
  239. int ret;
  240. *len = 0;
  241. *data = malloc(SPM_DATA_BUF_LENGTH);
  242. if (*data == NULL)
  243. return 0;
  244. ret = spm_dump_data(*data, len);
  245. if (ret < 0 || *len > SPM_DATA_BUF_LENGTH) {
  246. *len = (*len > SPM_DATA_BUF_LENGTH) ? SPM_DATA_BUF_LENGTH : *len;
  247. return ret;
  248. }
  249. return 1;
  250. }
  251. void spm_data_put(void **data)
  252. {
  253. free(*data);
  254. }
  255. static unsigned int save_spm_data(u64 offset, int *len, CALLBACK dev_write)
  256. {
  257. char *buf = NULL;
  258. unsigned int datasize = 0;
  259. /* Save SPM buffer */
  260. spm_data_get((void **)&buf, len);
  261. if (buf != NULL) {
  262. if (*len > 0)
  263. datasize = dev_write(buf, *len);
  264. spm_data_put((void **)&buf);
  265. }
  266. return datasize;
  267. }
  268. /*
  269. * FOR DRAMC data and DRAM Calibration Log
  270. * This area is applied for DRAM related debug.
  271. */
  272. /* DRAMC data */
  273. static int plat_dram_debug_get(void **data, int *len)
  274. {
  275. *data = (void *)DRAM_DEBUG_SRAM_ADDRESS;
  276. *len = DRAM_DEBUG_SRAM_LENGTH;
  277. return 1;
  278. }
  279. bool plat_boot_in_ddr_rsv(void)
  280. {
  281. struct LAST_DRAMC_INFO_T *last_dramc_info;
  282. last_dramc_info = (struct LAST_DRAMC_INFO_T *) get_dbg_info_base(0xD8A3);
  283. if ((last_dramc_info->fatal_err_flag & (1 << DRAM_DEBUG_FLAG_DDR_RSV_BIT)) == 0)
  284. return false;
  285. else
  286. return true;
  287. }
  288. static int plat_dram_klog_get(void **data, int *len)
  289. {
  290. *data = (void *)DRAM_KLOG_SRAM_ADDRESS;
  291. *len = DRAM_KLOG_SRAM_LENGTH;
  292. return 0;
  293. }
  294. static bool plat_dram_has_klog(void)
  295. {
  296. /* not to overwrite klog in abnormal boot or in DDR reserve mode */
  297. if (ram_console_is_abnormal_boot() || plat_boot_in_ddr_rsv())
  298. return false;
  299. // if (*(volatile unsigned int*)DRAM_KLOG_VALID_ADDRESS)
  300. // return true;
  301. return false;
  302. }
  303. static unsigned int save_dram_data(u64 offset, int *len, CALLBACK dev_write)
  304. {
  305. char *buf = NULL;
  306. unsigned int datasize = 0, allsize = 0;
  307. if (plat_dram_debug_get((void **)&buf, len)) {
  308. datasize = dev_write(buf, *len);
  309. allsize = datasize;
  310. }
  311. if (plat_dram_klog_get((void **)&buf, len)) {
  312. buf = malloc(*len);
  313. if (buf) {
  314. mrdump_read_log(buf, *len, MRDUMP_EXPDB_DRAM_KLOG_OFFSET);
  315. datasize = dev_write(buf, *len);
  316. allsize += datasize;
  317. free(buf);
  318. }
  319. }
  320. return allsize;
  321. }
  322. #ifdef MTK_TINYSYS_SSPM_SUPPORT
  323. #define SSPM_RETRY 10
  324. #define SSPM_BUF_LEN 768
  325. #define SYSRAM_START 0x40100000
  326. #define SYSRAM_END 0x40120000
  327. #define DRAM_START 0x80000000
  328. #define DRAM_END 0xC0000000
  329. #define BIT(x) (1 << x)
  330. enum {
  331. TO_PLATFORM = 0,
  332. TO_SSPM_OWN,
  333. TO_SSPM_LAST_LOG
  334. };
  335. static unsigned int save_sspm_coredump(u64 offset, int *len, CALLBACK dev_write)
  336. {
  337. unsigned int buf = 0;
  338. unsigned int datasize = 0;
  339. int retry = SSPM_RETRY;
  340. if (!(*(unsigned int *)SSPM_BACKUP)) {
  341. return 0;
  342. }
  343. do {
  344. buf = *(unsigned int *)(SSPM_DM_ADDR);
  345. *len = *(int *)SSPM_DM_SZ;
  346. if ( (buf != 0) && (*len > 0) ) {
  347. datasize = dev_write( (unsigned int *)buf, *len);
  348. break;
  349. } else {
  350. udelay(100);
  351. }
  352. } while ( --retry);
  353. buf = *(unsigned int *)(SSPM_RM_ADDR);
  354. *len = *(int *)SSPM_RM_SZ;
  355. if ( (buf != 0) && (*len > 0) ) {
  356. datasize += dev_write( (unsigned int *)buf, *len);
  357. }
  358. return datasize;
  359. }
  360. static unsigned int save_sspm_data(u64 offset, int *len, CALLBACK dev_write)
  361. {
  362. char *buf = NULL;
  363. char owner[3] = {'P', 'S', 'L'}; /* Platform, SSPM, SSPM_LAST_LOG */
  364. unsigned int addr = 0, dispatch = 0;
  365. unsigned int ahb_status, ahb_addr_m0, ahb_addr_m1, ahb_addr_m2;
  366. unsigned int datasize = 0, tbufl, tbufh, r, i, j;
  367. int length = 0;
  368. buf = malloc(SSPM_BUF_LEN);
  369. if (!buf) {
  370. return 0;
  371. }
  372. ahb_status = DRV_Reg32(SSPM_AHB_STATUS);
  373. ahb_addr_m0 = DRV_Reg32(SSPM_AHB_M0_ADDR);
  374. ahb_addr_m1 = DRV_Reg32(SSPM_AHB_M1_ADDR);
  375. ahb_addr_m2 = DRV_Reg32(SSPM_AHB_M2_ADDR);
  376. /* Set Auto-dispatch rule according by AHB_STATUS[13,10,5,4]. */
  377. if ( (ahb_status & (BIT(13) | BIT(10) | BIT(5) | BIT(4)) ) == 0x0 )
  378. {
  379. /* Bus hang issue. */
  380. if (ahb_status & BIT(2)) /* Master = M0 */
  381. addr = ahb_addr_m0;
  382. else if (ahb_status & BIT(3)) /* Master = M1 */
  383. addr = ahb_addr_m1;
  384. else if ((ahb_status & BIT(17)) == 0) /* Master M2 trans is pending. */
  385. addr = ahb_addr_m2;
  386. if (((addr >= SYSRAM_START) && (addr < SYSRAM_END)) ||
  387. ((addr >= DRAM_START) && (addr < DRAM_END)))
  388. dispatch = TO_PLATFORM;
  389. else
  390. dispatch = TO_SSPM_OWN;
  391. }
  392. else
  393. dispatch = TO_SSPM_LAST_LOG;
  394. memset(buf, 0, SSPM_BUF_LEN);
  395. length += snprintf(buf + length, SSPM_BUF_LEN - length,
  396. "STATUS: 0x%x\n"
  397. "M0: 0x%x\n"
  398. "M1: 0x%x\n"
  399. "M2: 0x%x\n"
  400. "SP: 0x%x\n"
  401. "LR: 0x%x\n"
  402. "PC: 0x%x\n"
  403. "Dispatch: %c\n",
  404. ahb_status, ahb_addr_m0, ahb_addr_m1, ahb_addr_m2,
  405. DRV_Reg32(SSPM_MD32_SP), DRV_Reg32(SSPM_MD32_LR),
  406. DRV_Reg32(SSPM_MD32_PC),
  407. owner[dispatch]);
  408. r = DRV_Reg32(SSPM_TBUF_WPTR);
  409. length += snprintf(buf + length, SSPM_BUF_LEN - length, "\nTBUF_WPTR=%u\n", r);
  410. for (i = 0, j = r; i < 16; ++i, j = --j & 0xF) {
  411. DRV_WriteReg32(SSPM_DBG_SEL, j);
  412. tbufl = DRV_Reg32(SSPM_TBUFL);
  413. tbufh = DRV_Reg32(SSPM_TBUFH);
  414. length += snprintf(buf + length, SSPM_BUF_LEN - length,
  415. "%u: TBUF=%u _H=0x%x _L=0x%x\n", i, j, tbufh, tbufl);
  416. }
  417. *len = length;
  418. if (*len > 0) {
  419. datasize = dev_write(buf, (*len > SSPM_BUF_LEN ? SSPM_BUF_LEN : *len));
  420. }
  421. free(buf);
  422. return datasize;
  423. }
  424. static unsigned int save_sspm_xfile(u64 offset, int *len, CALLBACK dev_write)
  425. {
  426. unsigned int buf = 0;
  427. unsigned int datasize = 0;
  428. unsigned int sspm_info;
  429. int ret;
  430. /* Get the information stored in SSPM_INFO by preloader
  431. struct sspm_info_t {
  432. unsigned int sspm_dm_ofs;
  433. unsigned int sspm_dm_sz;
  434. unsigned int rd_ofs;
  435. unsigned int rd_sz;
  436. unsigned int xfile_addr;
  437. unsigned int xfile_sz;
  438. };
  439. */
  440. sspm_info = *(unsigned int *)SSPM_INFO;
  441. #ifdef MTK_3LEVEL_PAGETABLE
  442. ret = arch_mmu_map(ROUNDDOWN((uint64_t)sspm_info, SECTION_SIZE),
  443. ROUNDDOWN((uint32_t)sspm_info, SECTION_SIZE),
  444. MMU_MEMORY_TYPE_NORMAL_WRITE_BACK | MMU_MEMORY_AP_P_RW_U_NA,
  445. SECTION_SIZE);
  446. if (ret) {
  447. dprintf(CRITICAL, "kedump: mmu map to 0x%llx fail(%d)\n",
  448. ROUNDDOWN((uint64_t)sspm_info, SECTION_SIZE), ret);
  449. return 0;
  450. }
  451. #endif
  452. buf = *((unsigned int *)sspm_info + 4);
  453. *len = *((int *)sspm_info + 5);
  454. dprintf(CRITICAL, "buf 0x%x, len:0x%x\n", buf, *len);
  455. if ( (buf != 0) && (*len > 0) ) {
  456. datasize = dev_write( (unsigned int *)buf, *len);
  457. }
  458. return datasize;
  459. }
  460. static unsigned int save_sspm_last_log(u64 offset, int *len, CALLBACK dev_write)
  461. {
  462. unsigned int buf = 0;
  463. unsigned int datasize = 0;
  464. buf = *(unsigned int *)(SSPM_LASTK_ADDR);
  465. *len = *(int *)SSPM_LASTK_SZ;
  466. if ( (buf != 0) && (*len > 0) ) {
  467. datasize = dev_write( (unsigned int *)buf, *len);
  468. }
  469. return datasize;
  470. }
  471. #endif /* #ifdef MTK_TINYSYS_SSPM_SUPPORT */
  472. #ifdef MTK_TINYSYS_SCP_SUPPORT
  473. #define SCP_EE_SIZE 0xA0000 //640 KB
  474. static unsigned int save_scp_coredump(u64 offset, int *len, CALLBACK dev_write)
  475. {
  476. int memory_dump_size;
  477. unsigned char *output = malloc(SCP_EE_SIZE);
  478. if (!output) {
  479. return 0;
  480. }
  481. memory_dump_size = scp_crash_dump(output);
  482. if ((memory_dump_size > SCP_EE_SIZE) || (memory_dump_size <= Z_NEED_DICT)) {
  483. dprintf(CRITICAL, "SCP memory_dump_size ERR %d\n", memory_dump_size);
  484. memory_dump_size = 0;
  485. } else
  486. memory_dump_size = dev_write(output, memory_dump_size);
  487. free(output);
  488. return memory_dump_size;
  489. }
  490. #endif
  491. static int plat_write_dram_klog(void)
  492. {
  493. char *sram_base = NULL;
  494. int len = 0;
  495. if (plat_dram_klog_get((void **)&sram_base, (int *)&len)) {
  496. if (plat_dram_has_klog()) {
  497. mrdump_write_log(MRDUMP_EXPDB_DRAM_KLOG_OFFSET, sram_base, len);
  498. }
  499. }
  500. return 0;
  501. }
  502. /* SRAM for Hybrid CPU DVFS */
  503. #define HVFS_SRAM_ADDRESS 0x00110800
  504. #define HVFS_SRAM_LENGTH 0x1400 /* 5K bytes */
  505. static int plat_hvfs_data_get(void **data, int *len)
  506. {
  507. *data = (void *)HVFS_SRAM_ADDRESS;
  508. *len = HVFS_SRAM_LENGTH;
  509. return 1;
  510. }
  511. static unsigned int save_hvfs_data(u64 offset, int *len, CALLBACK dev_write)
  512. {
  513. char *buf = NULL;
  514. unsigned int datasize = 0;
  515. if (plat_hvfs_data_get((void **)&buf, len)) {
  516. datasize = dev_write(buf, *len);
  517. }
  518. return datasize;
  519. }
  520. static int plat_mcdi_data_get(void **data, int *len)
  521. {
  522. mcdi_setup_file_info_for_kedump();
  523. *data = (void *)MCDI_SRAM_ADDRESS;
  524. *len = MCDI_SRAM_LENGTH;
  525. return 1;
  526. }
  527. static unsigned int save_mcdi_data(u64 offset, int *len, CALLBACK dev_write)
  528. {
  529. char *buf = NULL;
  530. unsigned int datasize = 0;
  531. if (plat_mcdi_data_get((void **)&buf, len)) {
  532. datasize = dev_write(buf, *len);
  533. }
  534. return datasize;
  535. }
  536. static int plat_log_dur_lkdump_get(void **data, int *len)
  537. {
  538. *data = (void *)current_buf_addr_get();
  539. *len = current_buf_pl_lk_log_size_get();
  540. if((*data == 0) || (*len == 0)) {
  541. dprintf(CRITICAL, "[LK_LOG_STORE] invalid current address or log length(addr 0x%x, len 0x%x)\n", (unsigned int)*data, (unsigned int)*len);
  542. return 0;
  543. }
  544. dprintf(CRITICAL, "[LK_LOG_STORE] the current buf addr is 0x%x, log len is 0x%x\n", (unsigned int)*data, (unsigned int)*len);
  545. return 1;
  546. }
  547. static unsigned int save_log_dur_lkdump(u64 offset, int *len, CALLBACK dev_write)
  548. {
  549. char *buf = NULL;
  550. unsigned int datasize = 0;
  551. if (plat_log_dur_lkdump_get((void **)&buf, len)) {
  552. datasize = dev_write(buf, *len);
  553. }
  554. return datasize;
  555. }
  556. /* platform initial function */
  557. int platform_debug_init(void)
  558. {
  559. /* function pointer assignment */
  560. plat_spm_data_get = save_spm_data;
  561. plat_dram_get = save_dram_data;
  562. plat_hvfs_get = save_hvfs_data;
  563. plat_cpu_bus_get = save_cpu_bus_data;
  564. #ifdef MTK_TINYSYS_SSPM_SUPPORT
  565. plat_sspm_coredump_get = save_sspm_coredump;
  566. plat_sspm_data_get = save_sspm_data;
  567. plat_sspm_xfile_get = save_sspm_xfile;
  568. plat_sspm_log_get = save_sspm_last_log;
  569. #endif
  570. #ifdef MTK_TINYSYS_SCP_SUPPORT
  571. plat_scp_coredump_get = save_scp_coredump;
  572. #endif
  573. plat_mcdi_get = save_mcdi_data;
  574. plat_dur_lkdump_get = save_log_dur_lkdump;
  575. plat_dfd20_get = save_dfd_data;
  576. dfd_op.check_dfd_valid = check_dfd_valid;
  577. /* routine tasks */
  578. plat_write_dram_klog();
  579. return 1;
  580. }
  581. extern int get_ccci_md_view_smem_addr_size(unsigned int user_id,
  582. unsigned long long *ap_addr, unsigned int *md_addr, unsigned int *size);
  583. int dfd_set_base_addr(void *fdt)
  584. {
  585. int ret = 0;
  586. int offset;
  587. u64 addr;
  588. unsigned int dfd_size;
  589. u32 addr_msb;
  590. unsigned int md_addr;
  591. unsigned long long ap_addr;
  592. DEF_PLAT_SRAM_FLAG *plat = NULL;
  593. if (!fdt)
  594. return -1;
  595. ret = get_ccci_md_view_smem_addr_size(0, &ap_addr, &md_addr, &dfd_size);
  596. if (ret < 0)
  597. return ret;
  598. offset = fdt_path_offset(fdt, "/chosen");
  599. if (offset < 0)
  600. return offset;
  601. /* pass base address to kernel */
  602. addr = cpu_to_fdt64(md_addr);
  603. ret = fdt_setprop(fdt, offset, "dfd,base_addr", &addr, sizeof(addr));
  604. if (ret < 0)
  605. return ret;
  606. addr_msb = cpu_to_fdt32(ap_addr);
  607. ret = fdt_setprop(fdt, offset, "dfd,base_addr_msb", &addr_msb, sizeof(addr_msb));
  608. if (ret < 0)
  609. return ret;
  610. /*
  611. * write base address[31:1] from AP view to plat_sram_flag2[31:1]
  612. * write base address[32:32] from AP view to plat_sram_flag2[0:0]
  613. */
  614. plat = (DEF_PLAT_SRAM_FLAG *)get_dbg_info_base(PLAT_SRAM_FLAG_KEY);
  615. if (!plat)
  616. return -1;
  617. plat->plat_sram_flag2 = (ap_addr & ~(0x1)) | ((ap_addr >> 32) & 0x1);
  618. return ret;
  619. }