[T106][ZXW-22]7520V3SCV2.01.01.02P42U09_VEC_V0.8_AP_VEC origin source commit
Change-Id: Ic6e05d89ecd62fc34f82b23dcf306c93764aec4b
diff --git a/boot/common/src/uboot/drivers/efuse/efuse.c b/boot/common/src/uboot/drivers/efuse/efuse.c
new file mode 100644
index 0000000..becc890
--- /dev/null
+++ b/boot/common/src/uboot/drivers/efuse/efuse.c
@@ -0,0 +1,365 @@
+/*******************************************************************************
+ * Copyright (C) 2016, ZXIC Corporation.
+ *
+ * File Name:
+ * File Mark:
+ * Description:
+ * Others:
+ * Version: 1.0
+ * Author: zxic
+ * Date: 2016.12.15
+ * modify
+ ********************************************************************************/
+
+/****************************************************************************
+* Include files
+****************************************************************************/
+#include <malloc.h>
+#include <errno.h>
+#include <asm/io.h>
+#include <linux/mtd/mtd.h>
+#include <asm-generic/ioctl.h>
+#include <config.h>
+#include <common.h>
+#include <command.h>
+
+#include <../drivers/hash/drv_hash.h>
+#include <../drivers/rsa/drv_rsa.h>
+#include <secure_verify.h>
+#include <asm/arch/efuse.h>
+
+
+
+/****************************************************************************
+* Local Macros
+****************************************************************************/
+#define E_N_LEN 256
+#define HASH_LEN 128
+#define reg32(addr) (*(volatile unsigned long *)(addr))
+
+/****************************************************************************
+* Local Types
+****************************************************************************/
+
+
+/****************************************************************************
+* Global Value
+****************************************************************************/
+/* Disable Secure Verify as Default. */
+unsigned int guiEfuseStatus = 1;
+unsigned char g_ddr_size_flag = 0;
+
+static unsigned char gbEfuseReadFlag = 0;
+
+/****************************************************************************
+* Local Funcs
+****************************************************************************/
+
+static void efuse_read_prepare(void)
+{
+ //start read efuse all 256bit
+ while((reg32(SYS_EFUSE_BASE + 0x4) & 1) == 1);// bit0=1 ctl is busy
+ reg32(SYS_EFUSE_BASE + 0x4) = 1;
+ while((reg32(SYS_EFUSE_BASE + 0x14) & 2) == 0);//bit1=0 read not over
+}
+
+static void efuse_program_32bit(u32 bit_offset, u32 data)
+{
+ while((reg32(SYS_EFUSE_BASE+0x4)&1)==1);// bit0=1 ctl is busy
+ reg32(SYS_EFUSE_BASE+0x8) = bit_offset;
+ reg32(SYS_EFUSE_BASE+0xc) = data;
+ reg32(SYS_EFUSE_BASE+0x4) = (0<<4)|(2<<1)|1;//cs0 program 32bit
+ while((reg32(SYS_EFUSE_BASE+0x4)&1)==1);// bit0=1 ctl is busy
+ reg32(SYS_EFUSE_BASE+0x4) = (1<<4)|(2<<1)|1;//cs1 program 32bit
+}
+
+void efuse_program_secure_en(u32 en)
+{
+ while((reg32(SYS_EFUSE_BASE+0x4)&1)==1);// bit0=1 ctl is busy
+ reg32(SYS_EFUSE_BASE+0x8) = 0; //bit[7:0] secure_boot_en
+ if(en)
+ reg32(SYS_EFUSE_BASE+0xc) = 0xFF;
+ reg32(SYS_EFUSE_BASE+0x4) = (0<<4)|(2<<1)|1;//cs0 program 32bit
+ while((reg32(SYS_EFUSE_BASE+0x4)&1)==1);// bit0=1 ctl is busy
+ reg32(SYS_EFUSE_BASE+0x4) = (1<<4)|(2<<1)|1;//cs1 program 32bit
+}
+
+void efuse_program_chip_flag(u32 flag)
+{
+ while((reg32(SYS_EFUSE_BASE+0x4)&1)==1);// bit0=1 ctl is busy
+ reg32(SYS_EFUSE_BASE+0x8) = 0; //bit[31:8] secure_chip_flag
+
+ if(flag&0xFF != 0)
+ reg32(SYS_EFUSE_BASE+0xc) = 0;
+ else
+ reg32(SYS_EFUSE_BASE+0xc) = flag;
+
+ reg32(SYS_EFUSE_BASE+0x4) = (0<<4)|(2<<1)|1;//cs0 program 32bit
+ while((reg32(SYS_EFUSE_BASE+0x4)&1)==1);// bit0=1 ctl is busy
+ reg32(SYS_EFUSE_BASE+0x4) = (1<<4)|(2<<1)|1;//cs1 program 32bit
+}
+
+void efuse_program_puk_hash(u32 *key)
+{
+ efuse_program_32bit(32, key[0]);
+ efuse_program_32bit(64, key[1]);
+ efuse_program_32bit(96, key[2]);
+ efuse_program_32bit(128, key[3]);
+}
+#if 0
+/**-------------------------------------------------------------------------------------------------------------------@n
+ * º¯ÊýÃû³Æ: chip_is_spe
+ * ¹¦ÄÜÃèÊö: ÓÃÓÚÅжÏоƬÊÇ·ñΪרÍøоƬ
+ * ·µ »Ø Öµ: 0,¹«ÍøоƬ 1,רÍøоƬ
+ *--------------------------------------------------------------------------------------------------------------------*/
+u32 chip_is_spe(void)
+{
+ u8 tmp_chip_flag[3] = {0x53, 0x50, 0x45}; /*SPE*/
+ u32 efuse_tmp_buf[5] = {0};
+ efuse_struct *psEfuseInfo = NULL;
+
+ psEfuseInfo = (efuse_struct *)efuse_tmp_buf;
+ memcpy(psEfuseInfo, EFUSE_RAM_BASE, sizeof(efuse_struct));
+
+ if(memcmp(psEfuseInfo->chip_flag,tmp_chip_flag,3))
+ /*chip com*/
+ return 0;
+
+ /*chip spe*/
+ return 1;
+}
+#endif
+static void efuse_get_data(void)
+{
+ efuse_struct *psEfuseInfo = NULL;
+ u32 uiLen = 0;
+
+ /* Secure Verify. 1->Disable, 0->Enable. */
+ if((reg32(EFUSE_BYPASS) & 1) == 1)
+ {
+ guiEfuseStatus = 1; //Disable.
+ BOOT_PRINTF(UBOOT_NOTICE, "EFUSE_BYPASS=1, SecureVerify->Disable.\n");
+ return ;
+ }
+
+ /* step 0*/
+ psEfuseInfo = (efuse_struct*)EFUSE_RAM_BASE;
+
+ /* get chip flag */
+ if(((psEfuseInfo->secure_flag >> 8) == ZX297520V3ECO_GW_WINBD_256M_DDR)
+ ||((psEfuseInfo->secure_flag >> 8) == ZX297520V3ECO_ZW_WINBD_256M_DDR)
+ ||((psEfuseInfo->secure_flag >> 8) == ZX297520V3ECO_GW_UNILC_256M_DDR)
+ ||((psEfuseInfo->secure_flag >> 8) == ZX297520V3ECO_ZW_UNILC_256M_DDR)
+ ||((psEfuseInfo->secure_flag >> 8) == ZX297520V3ECO_GW_APM_256M_DDR)
+ || ((psEfuseInfo->secure_flag >> 8) == ZX297520V3ECO_ZW_APM_256M_DDR))
+ {
+ g_ddr_size_flag = CHIP_DDR_IS_32M;
+ BOOT_PRINTF(UBOOT_NOTICE, "secure_flag=0x%x.\n", psEfuseInfo->secure_flag);
+ }
+ else if(((psEfuseInfo->secure_flag >> 8) == ZX297520V3ECO_GW_UNILC_512M_DDR)
+ ||((psEfuseInfo->secure_flag >> 8) == ZX297520V3ECO_GW_APM_512M_DDR)
+ ||((psEfuseInfo->secure_flag >> 8) == ZX297520V3ECO_GW_ESMT_512M_DDR)
+ ||((psEfuseInfo->secure_flag >> 8) == ZX297520V3ECO_ZW_UNILC_512M_DDR)
+ ||((psEfuseInfo->secure_flag >> 8) == ZX297520V3ECO_AZW_UNILC_512M_DDR)
+ ||((psEfuseInfo->secure_flag >> 8) == ZX297520V3ECO_ZW_APM_512M_DDR)
+ ||((psEfuseInfo->secure_flag >> 8) == ZX297520V3ECO_ZW_ESMT_512M_DDR))
+ {
+ g_ddr_size_flag = CHIP_DDR_IS_64M;
+ BOOT_PRINTF(UBOOT_NOTICE, "secure_flag=0x%x.\n", psEfuseInfo->secure_flag);
+ }
+ else if((psEfuseInfo->secure_flag >> 8) == ZX297520V3ECOSC_GW_NYC_2G_DDR)
+ {
+ g_ddr_size_flag = CHIP_DDR_IS_256M;
+ BOOT_PRINTF(UBOOT_NOTICE, "secure_flag=0x%x.\n", psEfuseInfo->secure_flag);
+ }
+ else
+ {
+ g_ddr_size_flag = CHIP_DDR_IS_128M;
+ BOOT_PRINTF(UBOOT_NOTICE, "secure_flag=0x%x.\n", psEfuseInfo->secure_flag);
+ }
+
+ if((psEfuseInfo->secure_flag & 0xFF) != 0xFF)
+ {
+ guiEfuseStatus = 1; //Disable.
+ BOOT_PRINTF(UBOOT_NOTICE, "secure_flag!=0xFF, SecureVerify->Disable.\n");
+ return ;
+ }
+
+ /* step 1*/
+ for(uiLen = 0; uiLen < 4; uiLen++)
+ {
+ if(psEfuseInfo->puk_hash[uiLen] != 0)
+ {
+ break;
+ }
+ if(uiLen == 3)
+ {
+ guiEfuseStatus = 1; //Disable.
+ BOOT_PRINTF(UBOOT_NOTICE, "PubKey_HASH=Invalid, SecureVerify->Disable.\n");
+ return ;
+ }
+ }
+ BOOT_PRINTF(UBOOT_NOTICE, "All Flag & Param is Valid, SecureVerify->ENABLE.\n");
+ guiEfuseStatus = 0; //Enable.
+}
+
+static u8 efuse_cmp_word(u32* src, u32* dst, u32 cnt)
+{
+ u32 i;
+ for(i = 0; i < cnt; i++)
+ {
+ if(src[i] != dst[i])
+ {
+ return 1;
+ }
+ }
+ return 0;
+}
+
+u8 secure_verify(u32 addr)
+{
+ u32 uiLen = 0;
+ u32 uiRet = -1;
+ u32 uiLoop = 0;
+ image_header_t *puiLegacyImgAddr = NULL;
+ sImageHeader *psImageHeader = NULL;
+ u32 *puiDataLoadAddr = NULL;
+ u32 *puiArrPubKeyEN = NULL;
+ u32 *puiArrHASH = NULL;
+
+ efuse_struct *psEfuseInfo = NULL;
+
+ u32 uiHashResArr[4] = {0};
+ u32 uiHashResLen = 0;
+ u32 uiHashVerifySize = 0;
+ u32 uiRsaResArr[32] = {0};
+
+ T_Rsa_Paramter sRSAInput;
+ u32 *puiRsaResAddr = NULL;
+
+ if(NULL == addr)
+ {
+ BOOT_PRINTF(UBOOT_ERR, "Bad Parameter(Empty Pointer)!\n");
+ return -1;
+ }
+
+ psImageHeader = (sImageHeader *)addr;
+ puiLegacyImgAddr = (image_header_t *)(addr + sizeof(sImageHeader));
+ uiHashVerifySize = ___htonl(puiLegacyImgAddr->ih_size) + sizeof(image_header_t);
+
+ psEfuseInfo = (efuse_struct*)EFUSE_RAM_BASE;
+
+ BOOT_PRINTF(UBOOT_NOTICE, "uiHashVerifySize=0x%x, EFUSE_RAM_BASE=0x%x.\n", uiHashVerifySize, EFUSE_RAM_BASE);
+
+ /*
+ * step 0
+ */
+ uiLen = E_N_LEN;
+ puiArrPubKeyEN = psImageHeader->uiPubKeyRsaE;
+
+ Hash_Calculate(HASH_MODE_MD5, HASH_SMALL_ENDIAN, puiArrPubKeyEN, uiLen, NULL, 0, uiHashResArr, &uiHashResLen);
+
+ BOOT_PRINTF(UBOOT_DBG, "secure_flag=0x%x.\n", psEfuseInfo->secure_flag);
+
+ if(efuse_cmp_word(psEfuseInfo->puk_hash, uiHashResArr, uiHashResLen))
+ {
+ BOOT_PRINTF(UBOOT_ERR, "PubKey Hash Verify -> Failed !\n");
+ return 1;
+ }
+ puiArrHASH = psImageHeader->uiHashY;
+
+ /*
+ * step 1
+ */
+ sRSAInput.udCalMode = RSA_MOD_EXPO_WITH_INIT;
+ sRSAInput.udNbitLen = 1024;
+ sRSAInput.udEbitLen = 1024;
+ sRSAInput.pudInputM = puiArrHASH;
+ sRSAInput.pudInputE = puiArrPubKeyEN;
+ sRSAInput.pudInputN = (puiArrPubKeyEN + 32);
+ sRSAInput.pudOutputP = uiRsaResArr;
+
+ uiRet = Rsa_Calculate(sRSAInput);
+ if(uiRet != 0)
+ {
+ BOOT_PRINTF(UBOOT_ERR, "Rsa_Calculate ERROR(0x%x)!\n", uiRet);
+ return 2;
+ }
+ puiRsaResAddr = sRSAInput.pudOutputP + (32 - uiHashResLen);
+
+ /*
+ * step 2
+ */
+ uiLen = uiHashVerifySize;
+ puiDataLoadAddr = ___htonl(puiLegacyImgAddr->ih_load) - sizeof(image_header_t);
+
+ /* Cleanup Output Buffer. */
+ uiHashResLen = 0;
+ memset(uiHashResArr, 0, 4*sizeof(uiHashResArr[0]));
+
+ uiRet = Hash_Calculate(HASH_MODE_MD5, HASH_SMALL_ENDIAN, puiDataLoadAddr, uiLen, NULL, 0, uiHashResArr, &uiHashResLen);
+ if(uiRet != 0)
+ {
+ BOOT_PRINTF(UBOOT_ERR, "Hash_Calculate ERROR(0x%x)!\n", uiRet);
+ return -1;
+ }
+
+ if(efuse_cmp_word(puiRsaResAddr, uiHashResArr, uiHashResLen))
+ {
+ BOOT_PRINTF(UBOOT_ERR, "LegacyImg Verify -> Failed !\n");
+ return 3;
+ }
+
+ return 0;
+}
+
+void efuse_get_devinfo(efuse_struct *efuse_info)
+{
+ u32 i;
+ efuse_struct *s_efuse = (efuse_struct*)EFUSE_RAM_BASE;
+
+ efuse_read_prepare();
+
+ efuse_info->secure_flag = s_efuse->secure_flag;
+
+ for(i = 0; i < 4; i ++)
+ {
+ efuse_info->puk_hash[i] = s_efuse->puk_hash[i];
+ }
+
+ for(i = 0; i < 3; i ++)
+ {
+ efuse_info->dev_id[i] = s_efuse->dev_id[i];
+
+ }
+
+}
+/*******************************************************************************
+* Function: efuse_init
+* Description:
+* Parameters:
+* Input:
+*
+* Output:
+*
+* Returns:
+*
+* Others:
+********************************************************************************/
+int efuse_init(void)
+{
+ /* Init Once is Enough. */
+ if(gbEfuseReadFlag == 0)
+ {
+ efuse_read_prepare();
+ gbEfuseReadFlag = 1;
+ BOOT_PRINTF(UBOOT_DBG, "gbEfuseReadFlag=1.\n");
+ }
+
+ /* Efuse Status decide ENABLE/DISABLE SecureVerify. */
+ efuse_get_data();
+
+ return 0;
+}
+
+