mt_scp.c 21 KB

123456789101112131415161718192021222324252627282930313233343536373839404142434445464748495051525354555657585960616263646566676869707172737475767778798081828384858687888990919293949596979899100101102103104105106107108109110111112113114115116117118119120121122123124125126127128129130131132133134135136137138139140141142143144145146147148149150151152153154155156157158159160161162163164165166167168169170171172173174175176177178179180181182183184185186187188189190191192193194195196197198199200201202203204205206207208209210211212213214215216217218219220221222223224225226227228229230231232233234235236237238239240241242243244245246247248249250251252253254255256257258259260261262263264265266267268269270271272273274275276277278279280281282283284285286287288289290291292293294295296297298299300301302303304305306307308309310311312313314315316317318319320321322323324325326327328329330331332333334335336337338339340341342343344345346347348349350351352353354355356357358359360361362363364365366367368369370371372373374375376377378379380381382383384385386387388389390391392393394395396397398399400401402403404405406407408409410411412413414415416417418419420421422423424425426427428429430431432433434435436437438439440441442443444445446447448449450451452453454455456457458459460461462463464465466467468469470471472473474475476477478479480481482483484485486487488489490491492493494495496497498499500501502503504505506507508509510511512513514515516517518519520521522523524525526527528529530531532533534535536537538539540541542543544545546547548549550551552553554555556557558559560561562563564565566567568569570571572573574575576577578579580581582583584585586587588589590591592593594595596597598599600601602603604605606607608609610611612613614615616617618619620621622623624625626627628629630631632633634635636637638639640641642643644645646647648649650651652653654655656657658659660661662663664665666667
  1. /* Copyright Statement:
  2. *
  3. * This software/firmware and related documentation ("MediaTek Software") are
  4. * protected under relevant copyright laws. The information contained herein
  5. * is confidential and proprietary to MediaTek Inc. and/or its licensors.
  6. * Without the prior written permission of MediaTek inc. and/or its licensors,
  7. * any reproduction, modification, use or disclosure of MediaTek Software,
  8. * and information contained herein, in whole or in part, shall be strictly prohibited.
  9. */
  10. /* MediaTek Inc. (C) 2015. All rights reserved.
  11. *
  12. * BY OPENING THIS FILE, RECEIVER HEREBY UNEQUIVOCALLY ACKNOWLEDGES AND AGREES
  13. * THAT THE SOFTWARE/FIRMWARE AND ITS DOCUMENTATIONS ("MEDIATEK SOFTWARE")
  14. * RECEIVED FROM MEDIATEK AND/OR ITS REPRESENTATIVES ARE PROVIDED TO RECEIVER ON
  15. * AN "AS-IS" BASIS ONLY. MEDIATEK EXPRESSLY DISCLAIMS ANY AND ALL WARRANTIES,
  16. * EXPRESS OR IMPLIED, INCLUDING BUT NOT LIMITED TO THE IMPLIED WARRANTIES OF
  17. * MERCHANTABILITY, FITNESS FOR A PARTICULAR PURPOSE OR NONINFRINGEMENT.
  18. * NEITHER DOES MEDIATEK PROVIDE ANY WARRANTY WHATSOEVER WITH RESPECT TO THE
  19. * SOFTWARE OF ANY THIRD PARTY WHICH MAY BE USED BY, INCORPORATED IN, OR
  20. * SUPPLIED WITH THE MEDIATEK SOFTWARE, AND RECEIVER AGREES TO LOOK ONLY TO SUCH
  21. * THIRD PARTY FOR ANY WARRANTY CLAIM RELATING THERETO. RECEIVER EXPRESSLY ACKNOWLEDGES
  22. * THAT IT IS RECEIVER'S SOLE RESPONSIBILITY TO OBTAIN FROM ANY THIRD PARTY ALL PROPER LICENSES
  23. * CONTAINED IN MEDIATEK SOFTWARE. MEDIATEK SHALL ALSO NOT BE RESPONSIBLE FOR ANY MEDIATEK
  24. * SOFTWARE RELEASES MADE TO RECEIVER'S SPECIFICATION OR TO CONFORM TO A PARTICULAR
  25. * STANDARD OR OPEN FORUM. RECEIVER'S SOLE AND EXCLUSIVE REMEDY AND MEDIATEK'S ENTIRE AND
  26. * CUMULATIVE LIABILITY WITH RESPECT TO THE MEDIATEK SOFTWARE RELEASED HEREUNDER WILL BE,
  27. * AT MEDIATEK'S OPTION, TO REVISE OR REPLACE THE MEDIATEK SOFTWARE AT ISSUE,
  28. * OR REFUND ANY SOFTWARE LICENSE FEES OR SERVICE CHARGE PAID BY RECEIVER TO
  29. * MEDIATEK FOR SUCH MEDIATEK SOFTWARE AT ISSUE.
  30. */
  31. #include <stdlib.h> /* for atoi() */
  32. #include <stdint.h>
  33. #include <ctype.h> /* for toupper() */
  34. #include <string.h>
  35. #include <debug.h>
  36. #include <platform/mt_gpt.h> // for get_timer()
  37. #include <arch/ops.h> // for arch_sync_cache_range()
  38. #include <platform/boot_mode.h>
  39. #include <platform/verified_boot.h>
  40. #include <verified_boot_common.h>
  41. #include <platform/sec_policy.h>
  42. #include <part_interface.h>
  43. #include <env.h>
  44. #ifdef DEVICE_TREE_SUPPORT
  45. #include <libfdt.h>
  46. #include <fdt_op.h>
  47. #endif
  48. #include <assert.h>
  49. #include <platform/mt_scp.h>
  50. #if ENABLE_SCP_EMI_PROTECTION
  51. #include <mt_emi_mpu.h>
  52. #endif
  53. #include <platform/errno.h>
  54. #ifdef MTK_AB_OTA_UPDATER
  55. #include "bootctrl.h"
  56. #endif
  57. // #define SCP_SRAM_LOCK_REG (*(volatile unsigned int *)(SCP_CFG_BASE + 0x0010))
  58. // #define SCP_SRAM_LOCK_UNIT 12
  59. // #define SCP_SRAM_LOCK_SHIFT 8
  60. #define SCP_JTAG_REG (*(volatile unsigned int *)(SCP_CFG_BASE + 0x00A0))
  61. #define SCP_JTAG_EN 0x0000003C
  62. // #define SCP_SRAM_EN_LOCK_REG (*(volatile unsigned int *)(SCP_CFG_BASE + 0x00DC))
  63. // #define SCP_SRAM_EN_REG (*(volatile unsigned int *)(SCP_CFG_BASE + 0x00E0))
  64. // #define SCP_SRAM_EN_BIT (1 << 20)
  65. #define SCP_SRAM_PWR_REG (*(volatile unsigned int *)(SCP_CFG_BASE + 0x402C))
  66. // #define SCP_SET_CLK_CG (*(volatile unsigned int *)(SCP_CFG_BASE + 0x4030))
  67. // #define SCP_EFUSE_DIS_INDEX 88
  68. // #define SCP_ROM_SIZE 88
  69. extern void dsb(void);
  70. extern unsigned int get_devinfo_with_index(unsigned int index);
  71. extern u64 physical_memory_size(void);
  72. extern int mboot_common_load_part(char *part_name, char *img_name, unsigned long addr);
  73. extern void mtk_wdt_restart(void);
  74. unsigned int get_scp_status(void);
  75. static int verify_load_scp_image(char *part_name, void *addr);
  76. int platform_scp_set_sram_region(int scp_A_sram_size);
  77. #if defined(DEVICE_TREE_SUPPORT)
  78. unsigned int get_scp_status(void);
  79. unsigned int set_scp_status(unsigned int en);
  80. int platform_fdt_scp_get_sram_size(void);
  81. int platform_fdt_scp(void *fdt);
  82. #else
  83. unsigned int get_scp_status(void) { return 0; } /* return 0, if scp disable */
  84. unsigned int set_scp_status(unsigned int en) { return 1; } /* return 1, if fail */
  85. int platform_fdt_scp_get_sram_size(void) { return -1; } /* return -1, if fail */
  86. int platform_fdt_scp(void *fdt) { return 0; } /* return 0, if success */
  87. #endif
  88. extern BOOT_ARGUMENT *g_boot_arg;
  89. static int load_scp_status = 0;
  90. static void *dram_addr;
  91. static char *scp_part_name[] = {"scp1", "scp2"};
  92. static int load_scp_image(char *part_name, char *img_name, void *addr)
  93. {
  94. uint32_t sec_ret;
  95. uint32_t scp_vfy_time;
  96. int ret;
  97. #ifdef MTK_SECURITY_SW_SUPPORT
  98. unsigned int policy_entry_idx = 0;
  99. unsigned int img_auth_required = 0;
  100. policy_entry_idx = get_policy_entry_idx(part_name);
  101. img_auth_required = get_vfy_policy(policy_entry_idx);
  102. /* verify cert chain of boot img */
  103. if (img_auth_required) {
  104. scp_vfy_time = get_timer(0);
  105. sec_ret = sec_img_auth_init(part_name, img_name, 0);
  106. if (sec_ret)
  107. return -1;
  108. dprintf(CRITICAL, "[SBC] image %s cert vfy pass(%d ms)\n", img_name, (unsigned int)get_timer(scp_vfy_time));
  109. #ifdef MTK_SECURITY_ANTI_ROLLBACK
  110. sec_ret = sec_rollback_check(1);
  111. if (sec_ret) {
  112. dprintf(CRITICAL, "[SBC] image %s ver check fail...(0x%x)\n", img_name, sec_ret);
  113. return -1;
  114. }
  115. #endif
  116. }
  117. #endif
  118. ret = mboot_common_load_part(part_name, img_name, (unsigned long)addr);
  119. dprintf(INFO, "%s(): load %s ret=%d\n", __func__, img_name, ret);
  120. if (ret <= 0)
  121. return -1;
  122. #ifdef MTK_SECURITY_SW_SUPPORT
  123. if (img_auth_required) {
  124. scp_vfy_time = get_timer(0);
  125. sec_ret = sec_img_auth(addr, ret);
  126. if (sec_ret)
  127. return -1;
  128. dprintf(CRITICAL, "[SBC] %s vfy pass(%d ms)\n", img_name, (unsigned int)get_timer(scp_vfy_time));
  129. }
  130. #endif
  131. return ret;
  132. }
  133. static char *scp_partition_name(void)
  134. {
  135. int array_size = (int)(sizeof(scp_part_name) / sizeof(scp_part_name[0]));
  136. int i;
  137. for (i = 0; i < array_size; i++) {
  138. if (partition_get_active_bit_by_name(scp_part_name[i]) == 1)
  139. return scp_part_name[i];
  140. }
  141. dprintf(CRITICAL, "no scp partition with active bit marked, load %s\n", scp_part_name[0]);
  142. return scp_part_name[0];
  143. }
  144. #if 0
  145. /******************************************************************************
  146. * This function is used to change SRAM DELSEL for MT6761, and it will make the
  147. * system more stable. It should be called before SCP is used.
  148. ******************************************************************************/
  149. static void change_sram_delsel(void)
  150. {
  151. DRV_WriteReg32(MBIST_AO_BASE + 0x24, 0x24F3001B);
  152. DRV_WriteReg32(MBIST_AO_BASE + 0x28, 0x001B24F3);
  153. DRV_WriteReg32(MBIST_AO_BASE + 0x2C, 0x24F324F3);
  154. }
  155. #endif
  156. /******************************************************************************
  157. ******************************************************************************/
  158. int load_scp(void)
  159. {
  160. int ret;
  161. int scp_A_sram_size = 0;
  162. #ifdef MTK_AB_OTA_UPDATER
  163. #define SCP_PARTITION_NAME_SIZE 10
  164. char part_name[SCP_PARTITION_NAME_SIZE];
  165. char *p_AB_suffix;
  166. int part_name_len = 0;
  167. #else
  168. char *part_name;
  169. #endif
  170. #if 0
  171. change_sram_delsel();
  172. #endif
  173. /* check if scp is turned off manually*/
  174. if (get_scp_status() == 0) {
  175. dprintf(CRITICAL, "[SCP] get_scp_status disabled\n");
  176. goto error;
  177. }
  178. dram_addr = (void *)(unsigned int)mblock_reserve_ext(&g_boot_arg->mblock_info,
  179. SCP_DRAM_SIZE, SCP_DRAM_ALIGN, DRAM_ADDR_MAX, 0, "SCP-reserved");
  180. dprintf(INFO, "[SCP] %s: dram_addr=%p\n", __func__, dram_addr);
  181. if (dram_addr == ((void *) 0)) {
  182. dprintf(CRITICAL, "[SCP] mblock_reserve fail\n");
  183. goto error;
  184. }
  185. #ifdef MTK_AB_OTA_UPDATER
  186. p_AB_suffix = get_suffix();
  187. if (p_AB_suffix) {
  188. /* Compose the partition name for A/B systems. */
  189. memset(part_name, 0, SCP_PARTITION_NAME_SIZE);
  190. strncpy (part_name, "scp", strlen("scp"));
  191. part_name_len = strlen(part_name);
  192. strncpy((void*)&part_name[part_name_len], (void*)p_AB_suffix,
  193. sizeof(part_name) - part_name_len);
  194. part_name[sizeof(part_name) - 1] = '\0';
  195. } else {
  196. dprintf(CRITICAL, "[SCP]get partition failed\n");
  197. goto error;
  198. }
  199. #else
  200. part_name = scp_partition_name();
  201. if (!part_name) {
  202. dprintf(CRITICAL, "[SCP]get partition failed\n");
  203. goto error;
  204. }
  205. #endif /* MTK_AB_OTA_UPDATER*/
  206. scp_A_sram_size = platform_fdt_scp_get_sram_size();
  207. dprintf(INFO, "[SCP] part_name=%s, scp_A_sram_size=%d\n",
  208. part_name, scp_A_sram_size);
  209. if (scp_A_sram_size < 0) {
  210. goto error;
  211. }
  212. ret = verify_load_scp_image(part_name, dram_addr);
  213. if (ret < 0) {
  214. goto error;
  215. }
  216. /*clean dcache & icache before set up EMI MPU*/
  217. arch_sync_cache_range((addr_t)dram_addr, SCP_DRAM_SIZE);
  218. /*
  219. * setup EMI MPU
  220. * domain 0: AP
  221. * domain 3: SCP
  222. */
  223. #if ENABLE_SCP_EMI_PROTECTION
  224. struct emi_region_info_t region_info;
  225. region_info.start = (unsigned long long)(unsigned int)dram_addr;
  226. region_info.end = (unsigned long long)(unsigned int)(dram_addr + SCP_DRAM_SIZE - 1);
  227. region_info.region = SCP_EMI_REGION;
  228. SET_ACCESS_PERMISSION(region_info.apc, UNLOCK,
  229. FORBIDDEN, FORBIDDEN, FORBIDDEN, FORBIDDEN,
  230. FORBIDDEN, FORBIDDEN, FORBIDDEN, FORBIDDEN,
  231. FORBIDDEN, FORBIDDEN, FORBIDDEN, FORBIDDEN,
  232. NO_PROTECTION, FORBIDDEN, FORBIDDEN, SEC_R_NSEC_R);
  233. emi_mpu_set_protection(&region_info);
  234. #endif
  235. dprintf(INFO, "%s(): done\n", __func__);
  236. load_scp_status = 1;
  237. return 0;
  238. error:
  239. /*
  240. * @ret = 0, malloc() error
  241. * @ret < 0, error code from load_scp_image()
  242. */
  243. load_scp_status = -1;
  244. return -1;
  245. }
  246. #if defined(DEVICE_TREE_SUPPORT)
  247. int platform_fdt_scp(void *fdt)
  248. {
  249. int nodeoffset;
  250. char *ret;
  251. nodeoffset = fdt_node_offset_by_compatible(fdt, -1, "mediatek,scp");
  252. if (nodeoffset < 0) {
  253. dprintf(CRITICAL, "[SCP] %s: getting node from dtb fails\n", __func__);
  254. return 1; /* return 1, if fail */
  255. }
  256. if (load_scp_status <= 0)
  257. ret = "disabled";
  258. else
  259. ret = "okay";
  260. if (fdt_setprop(fdt, nodeoffset, "status", ret, strlen(ret)) < 0) {
  261. dprintf(CRITICAL, "[SCP] %s: set status fails\n", __func__);
  262. return 1; /* return 1, if fail */
  263. }
  264. dprintf(CRITICAL, "[SCP] set core status=%s\n", ret);
  265. return 0; /* return 0, if success */
  266. }
  267. /* Load SCP sram size from dts */
  268. int platform_fdt_scp_get_sram_size(void)
  269. {
  270. int nodeoffset;
  271. unsigned int *data = NULL;
  272. int len = 0;
  273. void *kernel_fdt = get_kernel_fdt();
  274. if (kernel_fdt == NULL)
  275. panic("kernel fdt is NULL!\n");
  276. dprintf(INFO, "%s()\n", __func__);
  277. nodeoffset = fdt_node_offset_by_compatible(kernel_fdt, -1, "mediatek,scp");
  278. if (nodeoffset < 0) {
  279. dprintf(CRITICAL, "[SCP] mediatek,scp not found!\n");
  280. return -1; /* return -1, if fail */
  281. }
  282. data = (unsigned int *) fdt_getprop(kernel_fdt, nodeoffset, "scp_sramSize", &len);
  283. if (data == NULL) {
  284. dprintf(CRITICAL, "[SCP] get scp_sramSize info fail\n");
  285. return -1; /* return -1, if fail */
  286. }
  287. dprintf(INFO, "scp sram_size=%d, len=%d\n",
  288. fdt32_to_cpu(*(unsigned int *)data), len);
  289. return fdt32_to_cpu(*(unsigned int *)data);
  290. }
  291. unsigned int get_scp_status(void)
  292. {
  293. int scp_status;
  294. int nodeoffset;
  295. char *data = NULL;
  296. int len = 0;
  297. void *kernel_fdt = get_kernel_fdt();
  298. if (kernel_fdt == NULL)
  299. panic("kernel fdt is NULL!\n");
  300. nodeoffset = fdt_node_offset_by_compatible(kernel_fdt, -1, "mediatek,scp");
  301. if (nodeoffset < 0) {
  302. dprintf(CRITICAL, "scp get node from dtb fail\n");
  303. return 0;
  304. }
  305. data = (char*)fdt_getprop(kernel_fdt, nodeoffset, "status", &len);
  306. if (data == NULL) {
  307. dprintf(CRITICAL, "scp get status from dtb fail\n");
  308. return 0;
  309. }
  310. if (strncmp(data, "okay", len) == 0)
  311. scp_status = 1; /* 1 goes for "enabled" */
  312. else
  313. scp_status = 0; /* 0 goes for "disabled" */
  314. char *scp_env = get_env("scp");
  315. scp_status = (scp_env == NULL) ? scp_status : atoi(scp_env);
  316. dprintf(CRITICAL,"[SCP] current setting is %d.\n", scp_status);
  317. return scp_status;
  318. }
  319. unsigned int set_scp_status(unsigned int en)
  320. {
  321. char *SCP_STATUS[2] = {"0","1"};
  322. if (set_env("scp", SCP_STATUS[en]) == 0) {
  323. dprintf(CRITICAL,"[SCP]set SCP %s success. Plz reboot to make it applied.\n",SCP_STATUS[en]);
  324. return 0; /* return 0, if success*/
  325. } else {
  326. dprintf(CRITICAL,"[SCP]set SCP %s fail.\n",SCP_STATUS[en]);
  327. return 1; /* return 1, if fail */
  328. }
  329. }
  330. #endif
  331. /******************************************************************************
  332. ******************************************************************************/
  333. #ifdef MTK_TINYSYS_SCP_SUPPORT
  334. unsigned int get_scp_scpctl(void)
  335. {
  336. unsigned int scpctl = 0;
  337. int nodeoffset;
  338. char *data = NULL;
  339. int len = 0;
  340. char *prompt = "[SCPCTL]:";
  341. char *scpctl_env = NULL;
  342. void *kernel_fdt = get_kernel_fdt();
  343. if (kernel_fdt == NULL)
  344. panic("kernel fdt is NULL!\n");
  345. nodeoffset = fdt_node_offset_by_compatible(kernel_fdt, -1, "mediatek,scp");
  346. if (nodeoffset < 0) {
  347. dprintf(CRITICAL, "%s get node failed\n", prompt);
  348. goto __skip_dtb;
  349. }
  350. data = (char *)fdt_getprop(kernel_fdt, nodeoffset, "scpctl", &len);
  351. if (data == NULL) {
  352. dprintf(CRITICAL, "%s scpctl fail\n", prompt);
  353. goto __skip_dtb;
  354. }
  355. scpctl = atoul(data);
  356. __skip_dtb:
  357. scpctl_env = get_env("scpctl");
  358. if (scpctl_env != NULL) {
  359. /* skip leading white spaces */
  360. while (*scpctl_env == ' ')
  361. scpctl_env++;
  362. scpctl = atoul(scpctl_env);
  363. }
  364. dprintf(CRITICAL,"%s setting is 0x%x.\n", prompt, scpctl);
  365. return scpctl;
  366. }
  367. unsigned int set_scp_scpctl(unsigned int value)
  368. {
  369. char *prompt = "[SCPCTL]:";
  370. char buf[16]; /* power of 2 for the length of the format, 0x######## */
  371. snprintf(buf, sizeof(buf), "0x%x", value);
  372. if (set_env("scpctl", buf) == 0) {
  373. dprintf(CRITICAL,"%s setting %s successed. please reboot.\n",prompt, buf);
  374. return 0; /* return 0, if success*/
  375. }
  376. else {
  377. dprintf(CRITICAL,"%s setting %s failed.\n", prompt, buf);
  378. return 1; /* return 1, if fail */
  379. }
  380. }
  381. #endif
  382. /******************************************************************************
  383. ******************************************************************************/
  384. unsigned int get_scp_log_thru_ap_uart(void)
  385. {
  386. unsigned int enable = 0;
  387. char *env = get_env("scp_ap_uart");
  388. if (env == NULL) {
  389. dprintf(CRITICAL, "[SCP] Get SCP log thru AP UART: 0 (default)\n");
  390. } else {
  391. enable = atoi(env);
  392. dprintf(CRITICAL, "[SCP] Get SCP log thru AP UART: %d\n", enable);
  393. }
  394. return enable;
  395. }
  396. /******************************************************************************
  397. * Caller must make sure that the argument "en" is less than 2.
  398. ******************************************************************************/
  399. void set_scp_log_thru_ap_uart(unsigned int en)
  400. {
  401. char *en_array[2] = {"0", "1"};
  402. if (set_env("scp_ap_uart", en_array[en]) == 0) {
  403. dprintf(CRITICAL, "[SCP] Set SCP log thru AP UART: %s\n", en_array[en]);
  404. } else {
  405. dprintf(CRITICAL, "[SCP] Failed to set SCP log thru AP UART to %s!\n",
  406. en_array[en]);
  407. }
  408. }
  409. /******************************************************************************
  410. * AP read/write SCP SRAM through APB bus which can only read/write data in
  411. * 4-byte unit.
  412. ******************************************************************************/
  413. void scp_set_platform_name(struct scp_region_info_st *scp_region_info)
  414. {
  415. int index, max_idx, max_word_idx;
  416. char *chip = PLATFORM;
  417. unsigned int *platform = (unsigned int*)scp_region_info->platform;
  418. /* Use 32-bit type so that "words" is aligned. Round-up to ensure enough space. */
  419. unsigned int words[(MAX_PLATFORM_LEN + 3) / 4];
  420. char *byte_in_words = (char*)words;
  421. memset(words, 0, sizeof(words));
  422. max_idx = MAX_PLATFORM_LEN - 1; // for NULL
  423. for (index = 0; index < max_idx; index++) {
  424. byte_in_words[index] = toupper(chip[index]);
  425. if (chip[index] == '\0')
  426. break;
  427. }
  428. byte_in_words[index] = '\0';
  429. /* Copy data in word because of APB bus limitation. */
  430. max_word_idx = (MAX_PLATFORM_LEN / 4);
  431. for (index = 0; index < max_word_idx; index++) {
  432. platform[index] = words[index];
  433. }
  434. }
  435. /******************************************************************************
  436. ******************************************************************************/
  437. static int verify_load_scp_image(char *part_name, void *addr)
  438. {
  439. int scp_dram_use_size = 0;
  440. void *ld_ptr, *fw_ptr;
  441. uint32_t reg_temp;
  442. int ld_size, fw_size;
  443. int l1c_size;
  444. void *l1c_ptr, *l1c_backup_ptr = NULL;
  445. int scp_sram_size;
  446. struct scp_region_info_st *scp_region_info;
  447. // step 0: enable sram, enable 1 block per time
  448. for (reg_temp = 0xffffffff; reg_temp != 0;) {
  449. reg_temp = reg_temp >> 1;
  450. SCP_SRAM_PWR_REG = reg_temp;
  451. }
  452. /*
  453. * l1c sram, 64K / tail sram, +32k
  454. * L1_SRAM_PD / d_l1c_SRAM_PD / d_l1c_tag_SRAM_PD / p_l1c_SRAM_PD / p_l1c_tag_SRAM_PD
  455. */
  456. DRV_WriteReg32(CLK_CTRL_L1_SRAM_PD, 0);
  457. /* TCM_TAIL_SRAM_PD */
  458. DRV_WriteReg32(CLK_CTRL_TCM_TAIL_SRAM_PD, 0);
  459. // step 1: load/verify loader
  460. ld_ptr = addr;
  461. ld_size = load_scp_image(part_name, LOADER_NAME_SCP_A, ld_ptr);
  462. if (ld_size <= 0) {
  463. dprintf(CRITICAL, "[SCP] load_scp_image fail %s\n", LOADER_NAME_SCP_A);
  464. return -1;
  465. }
  466. // step 2: load/verify firmware
  467. fw_ptr = addr + SCP_FW_OFFSET;
  468. fw_size = load_scp_image(part_name, FIRMWARE_NAME_SCP_A, fw_ptr);
  469. if (fw_size <= 0) {
  470. dprintf(CRITICAL, "[SCP] load_scp_image fail %s\n", FIRMWARE_NAME_SCP_A);
  471. return -1;
  472. }
  473. // step 3: load/verify l1c code (optional)
  474. l1c_ptr = addr + SCP_L1C_OFFSET;
  475. l1c_size = load_scp_image(part_name, L1C_NAME_SCP_A, l1c_ptr);
  476. if (l1c_size > 0) {
  477. dprintf(INFO, "[SCP] load_scp_image %s %d bytes\n", L1C_NAME_SCP_A, l1c_size);
  478. /* assert if size of feature placed in dram plus size of overlay exceeds
  479. * size, SCP_L1C_BACKUO_OFFSET - SCP_L1C_OFFSET.
  480. */
  481. if (l1c_size > SCP_L1C_BACKUO_OFFSET - SCP_L1C_OFFSET)
  482. ASSERT(0);
  483. // step 3.1 backup l1c code
  484. l1c_backup_ptr = addr + SCP_L1C_BACKUO_OFFSET;
  485. memcpy(l1c_backup_ptr, l1c_ptr, l1c_size);
  486. /* Disable scp bus wt buffer */
  487. DRV_WriteReg32(SCP_SYS_CTRL, DRV_Reg32(SCP_SYS_CTRL)|(0x1 << AHB_SLICE_POST_WT));
  488. #if CFG_SCP_ULTRA_SUPPORT
  489. DRV_WriteReg32(BUS_QOS, (0x2 << AXI_AWULTRA) | (0x2 << AXI_ARULTRA));
  490. #endif
  491. /* Read the l1c setting from image in dram */
  492. scp_region_info = (struct scp_region_info_st*)(ld_ptr + SCP_LOADER_SIZE);
  493. scp_l1c_init(scp_region_info->Il1c_con, scp_region_info->Dl1c_con);
  494. } else {
  495. DRV_WriteReg32(SCP_SYS_CTRL, DRV_Reg32(SCP_SYS_CTRL)|(0x3 << BYPASS_P_L1C));
  496. /* scp clk gates: l1c controller */
  497. DRV_WriteReg32(SCP_CLR_CLK_CG, (1 << L1C_I_CTRL_CG) | (1 << L1C_D_CTRL_CG));
  498. dprintf(INFO, "[SCP] no l1c support\n");
  499. }
  500. // SCP DRAM layout
  501. /***********************
  502. * SCP loader *
  503. ************************
  504. * SCP Firmware *
  505. ************************
  506. * SCP L1C *
  507. ************************
  508. * SCP DRAM backup *
  509. ************************/
  510. // step 6: copy loader to sram
  511. memcpy((void *) SCP_SRAM_BASE, ld_ptr, ld_size);
  512. // step 7: save firmware/cache info to sram
  513. scp_region_info = (struct scp_region_info_st*)(SCP_SRAM_BASE + SCP_LOADER_SIZE);
  514. scp_region_info->ap_loader_start = (uint32_t)ld_ptr;
  515. scp_region_info->ap_loader_size = (uint32_t)ld_size;
  516. scp_region_info->ap_firmware_start = (uint32_t)fw_ptr;
  517. #if defined(DEVICE_TREE_SUPPORT)
  518. scp_sram_size = platform_fdt_scp_get_sram_size();
  519. #else
  520. scp_sram_size = SCP_SRAM_SIZE;
  521. #endif
  522. dprintf(INFO, "[SCP]sram size=%u bytes\n", scp_sram_size);
  523. if ( fw_size > (scp_sram_size - SCP_FW_OFFSET) ) {
  524. scp_region_info->ap_firmware_size =
  525. (scp_sram_size - SCP_FW_OFFSET
  526. - L1C_SIZE(scp_region_info->Il1c_con)
  527. - L1C_SIZE(scp_region_info->Dl1c_con));
  528. dprintf(INFO, "[SCP](overlay)firmware size %d bytes\n", scp_region_info->ap_firmware_size);
  529. } else {
  530. scp_region_info->ap_firmware_size = (uint32_t)fw_size;
  531. }
  532. scp_region_info->ap_dram_start = (uint32_t)l1c_ptr;
  533. scp_region_info->ap_dram_size = (uint32_t)l1c_size;
  534. scp_region_info->ap_dram_backup_start = (uint32_t)l1c_backup_ptr;
  535. scp_region_info->scp_log_thru_ap_uart = get_scp_log_thru_ap_uart();
  536. scp_region_info->Il1c_con = (uint32_t)L1C_SEL(L1C_IL1C)->L1C_CON;
  537. scp_region_info->Dl1c_con = (uint32_t)L1C_SEL(L1C_DL1C)->L1C_CON;
  538. scp_region_info->scpctl = get_scp_scpctl();
  539. scp_set_platform_name(scp_region_info);
  540. dprintf(INFO, "scp_region_info->ap_loader_start 0x%x\n", scp_region_info->ap_loader_start);
  541. dprintf(INFO, "scp_region_info->ap_loader_size 0x%x\n", scp_region_info->ap_loader_size);
  542. dprintf(INFO, "scp_region_info->ap_firmware_start 0x%x\n", scp_region_info->ap_firmware_start);
  543. dprintf(INFO, "scp_region_info->ap_firmware_size 0x%x\n", scp_region_info->ap_firmware_size);
  544. dprintf(INFO, "scp_region_info->ap_dram_start 0x%x\n", scp_region_info->ap_dram_start);
  545. dprintf(INFO, "scp_region_info->ap_dram_size 0x%x\n", scp_region_info->ap_dram_size);
  546. dprintf(INFO, "scp_region_info->ap_dram_backup_start 0x%x\n", scp_region_info->ap_dram_backup_start);
  547. dprintf(INFO, "scp_region_info->scp_log_thru_ap_uart 0x%x\n", scp_region_info->scp_log_thru_ap_uart);
  548. dprintf(INFO, "scp_region_info->Il1c_con 0x%x\n", scp_region_info->Il1c_con);
  549. dprintf(INFO, "scp_region_info->Dl1c_con 0x%x\n", scp_region_info->Dl1c_con);
  550. dprintf(INFO, "scp_region_info->scpctl 0x%x\n", scp_region_info->scpctl);
  551. dprintf(INFO, "scp_region_info->platform: %s\n", scp_region_info->platform);
  552. dsb();
  553. SCP_JTAG_REG |= SCP_JTAG_EN;
  554. dsb();
  555. return scp_dram_use_size;
  556. }
  557. void disable_scp_hw(void)
  558. {
  559. /* turn off SCP related module
  560. *PDEF_SCP_SRAM_PDN = #0xffffff
  561. *PDEF_SCP_CLK_SEL = #0x1
  562. *PDEF_SCP_CLK_EN = #0x0
  563. *PDEF_SCP_CFGREG_SW_RSTN = #0x0
  564. */
  565. DRV_WriteReg32(SCP_CFGREG_SW_RSTN, 0x0);
  566. DRV_WriteReg32(SCP_SRAM_PDN, 0xFFFFFFFF); /*turn off scp sram*/
  567. DRV_WriteReg32(SCP_CLK_SEL, 0x1); /*turn off scp clock*/
  568. DRV_WriteReg32(SCP_CLK_EN, 0x0);
  569. DRV_WriteReg32(CLK_CTRL_L1_SRAM_PD, 0xFFFFFFFF);
  570. DRV_WriteReg32(CLK_CTRL_TCM_TAIL_SRAM_PD, 0xFFFFFFFF);
  571. dprintf(CRITICAL, "DISABLE SCP\n");
  572. }