[Feature][T106]ZXW P56U09 code
Only Configure: Yes
Affected branch: master
Affected module: unknow
Is it affected on both ZXIC and MTK: only ZXIC
Self-test: No
Doc Update: No
Change-Id: I3cbd8b420271eb20c2b40ebe5c78f83059cd42f3
diff --git a/boot/common/src/uboot/drivers/hash/Makefile b/boot/common/src/uboot/drivers/hash/Makefile
new file mode 100755
index 0000000..bc1ab96
--- /dev/null
+++ b/boot/common/src/uboot/drivers/hash/Makefile
@@ -0,0 +1,48 @@
+#
+# Copyright 2000-2008
+# Wolfgang Denk, DENX Software Engineering, wd@denx.de.
+#
+# See file CREDITS for list of people who contributed to this
+# project.
+#
+# This program is free software; you can redistribute it and/or
+# modify it under the terms of the GNU General Public License as
+# published by the Free Software Foundation; either version 2 of
+# the License, or (at your option) any later version.
+#
+# This program is distributed in the hope that it will be useful,
+# but WITHOUT ANY WARRANTY; without even the implied warranty of
+# MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE. See the
+# GNU General Public License for more details.
+#
+# You should have received a copy of the GNU General Public License
+# along with this program; if not, write to the Free Software
+# Foundation, Inc., 59 Temple Place, Suite 330, Boston,
+# MA 02111-1307 USA
+#
+
+include $(TOPDIR)/config.mk
+
+LIB := $(obj)libdrv_hash.o
+
+COBJS-y += drv_hash.o
+COBJS-y += sha256.o
+
+COBJS := $(COBJS-y)
+SRCS := $(COBJS:.o=.c)
+OBJS := $(addprefix $(obj),$(COBJS))
+
+all: $(LIB)
+
+$(LIB): $(obj).depend $(OBJS)
+ $(call cmd_link_o_target, $(OBJS))
+
+
+#########################################################################
+
+# defines $(obj).depend target
+include $(SRCTREE)/rules.mk
+
+sinclude $(obj).depend
+
+########################################################################
diff --git a/boot/common/src/uboot/drivers/hash/drv_hash.c b/boot/common/src/uboot/drivers/hash/drv_hash.c
new file mode 100644
index 0000000..ac24808
--- /dev/null
+++ b/boot/common/src/uboot/drivers/hash/drv_hash.c
@@ -0,0 +1,165 @@
+/* -------------------------------------------------------------------------------------------------------------------@udN
+ * °æȨËùÓÐ(C)2012, ÖÐÐËͨѶ¹É·ÝÓÐÏÞ¹«Ë¾
+ *
+ * ÎÄ ¼þ Ãû: drv_hash.c
+ *
+------------------------------------------------------------------------------------------------------------*/
+
+#include "drv_hash.h"
+#include <sdio.h>
+
+/**-------------------------------------------------------------------------------------------------------------------@n
+ *Hash_set_len ¹¦ÄÜÏêÊö:
+ ½«ÏûÏ¢³¤¶ÈÒÔbitΪµ¥Î»ÅäÖõ½³¤¶È¼Ä´æÆ÷ÖÐ
+ --------------------------------------------------------------
+ ×¢Òâ:
+ ±¾º¯Êý¿¼Âǵ½¼ÆËãhashµÄÊý¾Ý³¤¶ÈÒ»°ã¶¼ÊÇ°´byte´«È룬ÇÒ×ÜÁ¿²»»á³¬¹ý4G byte£¬
+ Òò´Ë¼ò»¯Á˺¯Êý¹¦ÄÜ¡£
+ byte_Len ×ÜÊý²»Äܳ¬¹ý4G£¬·ñÔò¸Ãº¯ÊýÐèÒªÖØÐÂÐ޸ġ£
+ *--------------------------------------------------------------------------------------------------------------------*/
+static void hash_SetLen(u32 byte_Len)
+{
+ REG32(HASH_LENGTH0) = byte_Len<<3;
+ REG32(HASH_LENGTH1) = byte_Len>>29;
+ REG32(HASH_LENGTH2) = 0;
+ REG32(HASH_LENGTH3) = 0;
+}
+
+#ifdef HASH_CODE_SUPPORT_ALL
+static void hash_SetHmacKey(u32* pHmacKey, u32* HmacKey_len)
+{
+ u32 udI;
+
+ for(udI=0;udI<32;udI++)
+ {
+ //¼Ä´æÆ÷¸ßµØÖ·´æ·ÅµÍλÊý¾Ý£¬Êý¾Ý´æ·ÅÊǵ͵ØÖ··Å¸ßλÊý¾Ý
+ if(udI<(32-HmacKey_len))
+ REG32(HASH_HMACKEY+udI*4) = 0;
+ else
+ REG32(HASH_HMACKEY+udI*4) = pHmacKey[udI-(32-HmacKey_len)];
+ }
+}
+#endif
+
+/* ·µ»Øhash ¼ÆËã½á¹ûºÍ½á¹ûµÄ³¤¶È£¬³¤¶Èµ¥Î»ÊÇword */
+static void hash_GetResult(u32 udMode, u32* HashResult, u32* ResultLen)
+{
+ u32 udI, udResultLen=0;
+
+#ifdef HASH_CODE_SUPPORT_ALL
+ switch(udMode)
+ {
+ case HASH_MODE_MD5:
+ case HASH_MODE_HMAC_MD5:
+ udResultLen = 4; /* 4*4bytes = 128bit*/
+ break;
+
+ case HASH_MODE_SHA1:
+ case HASH_MODE_HMAC_SHA1:
+ udResultLen = 5; /* 160 bit */
+ break;
+
+ case HASH_MODE_SHA224:
+ case HASH_MODE_HMAC_SHA224:
+ udResultLen = 7; /* 224 bit */
+ break;
+
+ case HASH_MODE_SHA256:
+ case HASH_MODE_HMAC_SHA256:
+ udResultLen = 8; /* 256 bit */
+ break;
+
+ case HASH_MODE_SHA384:
+ case HASH_MODE_HMAC_SHA384:
+ udResultLen = 12; /* 384 bit */
+ break;
+
+ case HASH_MODE_SHA512:
+ case HASH_MODE_HMAC_SHA512:
+ udResultLen = 16; /* 512 bit */
+ break;
+
+ default:
+ break;
+ }
+#else
+ udResultLen = 4;
+#endif
+
+ *ResultLen = udResultLen;
+
+ for(udI=0;udI<udResultLen;udI++) //hash¼ÆËãÖ§³Ö128bitÊý¾Ý
+ {
+ //¼Ä´æÆ÷µÍµØÖ·´æ·Åresult µÄ¸ßλ
+ HashResult[udI] = REG32(HASH_RESULT+(16-udResultLen+udI)*4);
+ }
+}
+
+/**-------------------------------------------------------------------------------------------------------------------@n
+ * @brief HASHÄ£¿éÇý¶¯½Ó¿Ú
+ *
+ * ¹¦ÄÜÏêÊö:
+ * - Hash_Computeº¯ÊýÊôÓÚ½Ó¿Úº¯Êý, Æ书ÄÜÊÇ:
+ * - HASHÄ£¿éÇý¶¯½Ó¿Ú
+ *
+ * ²ÎÊý¸ÅÊö:
+ input:
+ udMode--------hashģʽ
+ udBigEndian----´óС¶Ë¸ñʽ
+ ploadAddr------¼ÆËãhashµÄÔ´Êý¾ÝÖ¸Õë
+ loadLen--------Ô´Êý¾Ý³¤¶È
+ pHmacKey------HMACģʽϵÄÃÜÔ¿
+ HmacKey_len---ÃÜÔ¿³¤¶È
+ output:
+ HashResult-----hash¼ÆËã½á¹û
+ ResultLen------hash½á¹ûµÄ³¤¶È
+ * ·µ »Ø Öµ: 0:³É¹¦ 1:ʧ°Ü
+
+ *--------------------------------------------------------------------------------------------------------------------*/
+u32 Hash_Calculate(u32 udMode, u32 udBigEndian, u32* ploadAddr, u32 loadLen, u32* pHmacKey, u32* HmacKey_len, u32* HashResult, u32* ResultLen)
+{
+ u32 udMessageLen_word;
+ u32 udI;
+ volatile u32 count_time = 0;
+
+ if((loadLen == 0) || (ploadAddr == NULL) || (HashResult == NULL) )
+ {
+ return 1;
+ }
+
+ //config hash mode and enable module
+ REG32(HASH_CONTROL) = (udMode<<4)|(udBigEndian<<12)|1;
+
+ hash_SetLen(loadLen);
+
+#ifdef HASH_CODE_SUPPORT_ALL
+ //write HMAC key
+ if(udMode&0x10)
+ {
+ hash_SetHmacKey(pHmacKey, HmacKey_len);
+ }
+#endif
+
+ REG32(HASH_START) = 1;//Hash_Start
+
+ //start write message data into fifo
+ udMessageLen_word = (loadLen + 3) / 4;
+ for(udI = 0; udI < udMessageLen_word; udI++)
+ {
+ count_time = 10;
+ REG32(HASH_DATA) = ploadAddr[udI];
+ while(count_time--);
+ }
+
+ while(REG32(HASH_START) & 0x1); /* if cal busy, continue to wait*/
+
+ //read Result
+ hash_GetResult(udMode, HashResult, ResultLen);
+
+ REG32(HASH_CONTROL) = 0;//Hash_DisableModule;
+
+ return 0;
+}
+
+/** @} */
+
diff --git a/boot/common/src/uboot/drivers/hash/drv_hash.h b/boot/common/src/uboot/drivers/hash/drv_hash.h
new file mode 100644
index 0000000..c06dd5b
--- /dev/null
+++ b/boot/common/src/uboot/drivers/hash/drv_hash.h
@@ -0,0 +1,65 @@
+/**---------------------------------------------------------------@n
+ * °æȨËùÓÐ(C)2011, ÖÐÐËͨѶ¹É·ÝÓÐÏÞ¹«Ë¾
+ *
+ * ÎļþÃû³Æ: drv_hash.h
+ * ÄÚÈÝÕªÒª: HASHÉ豸linuxÇý¶¯³ÌÐòÍ·Îļþ
+ * ÆäËû˵Ã÷:
+ *
+ * --------------------------------------------------------------
+ * Ð޸ļǼ1: // ÐÞ¸ÄÀúÊ·¼Ç¼£¬°üÀ¨ÐÞ¸ÄÈÕÆÚ¡¢ÐÞ¸ÄÕß¼°ÐÞ¸ÄÄÚÈÝ
+ * ÐÞ¸ÄÈÕÆÚ:
+ * °æ ±¾ ºÅ:
+ * ÐÞ ¸Ä ÈË:
+ * ÐÞ¸ÄÄÚÈÝ:
+ *
+ * ---------------------------------------------------------*/
+
+#ifndef DRV_HASH_H
+#define DRV_HASH_H
+
+#include <common.h>
+#include <secure_verify.h>
+
+#define HASH_CONTROL (SYS_HASH_BASE+0x04)
+#define HASH_START (SYS_HASH_BASE+0x08)
+#define HASH_DATA (SYS_HASH_BASE+0x10)
+#define HASH_INTSTATUS (SYS_HASH_BASE+0x1c)
+#define HASH_LENGTH0 (SYS_HASH_BASE+0x2c)
+#define HASH_LENGTH1 (SYS_HASH_BASE+0x28)
+#define HASH_LENGTH2 (SYS_HASH_BASE+0x24)
+#define HASH_LENGTH3 (SYS_HASH_BASE+0x20)
+#define HASH_RESULT (SYS_HASH_BASE+0x30)
+#define HASH_HMACKEY (SYS_HASH_BASE+0x70)
+
+//Çý¶¯ÊÇ·ñÖ§³ÖËùÓеÄģʽ£¬ÓÃÓÚ¼ò»¯´úÂëÁ¿
+//#define HASH_CODE_SUPPORT_ALL
+
+#define HASH_MODE_MD5 0x0
+#ifdef HASH_CODE_SUPPORT_ALL
+#define HASH_MODE_SHA1 0x1
+#define HASH_MODE_SHA224 0x2
+#define HASH_MODE_SHA256 0x3
+#define HASH_MODE_SHA384 0x4
+#define HASH_MODE_SHA512 0x5
+#define HASH_MODE_HMAC_MD5 (HASH_MODE_MD5|0x10)
+#define HASH_MODE_HMAC_SHA1 (HASH_MODE_SHA1|0x10)
+#define HASH_MODE_HMAC_SHA224 (HASH_MODE_SHA224|0x10)
+#define HASH_MODE_HMAC_SHA256 (HASH_MODE_SHA256|0x10)
+#define HASH_MODE_HMAC_SHA384 (HASH_MODE_SHA384|0x10)
+#define HASH_MODE_HMAC_SHA512 (HASH_MODE_SHA512|0x10)
+#endif
+
+#define HASH_SMALL_ENDIAN 0
+#define HASH_BIG_ENDIAN 1
+
+u32 Hash_Calculate(u32 udMode, u32 udBigEndian, u32* ploadAddr, u32 loadLen, u32* pHmacKey, u32* HmacKey_len, u32* HashResult, u32* ResultLen);
+
+#endif
+
+
+
+
+
+
+
+
diff --git a/boot/common/src/uboot/drivers/hash/sha256.c b/boot/common/src/uboot/drivers/hash/sha256.c
new file mode 100755
index 0000000..65c7e3d
--- /dev/null
+++ b/boot/common/src/uboot/drivers/hash/sha256.c
@@ -0,0 +1,273 @@
+// SPDX-License-Identifier: GPL-2.0+
+/*
+ * FIPS-180-2 compliant SHA-256 implementation
+ *
+ * Copyright (C) 2001-2003 Christophe Devine
+ */
+
+#ifndef USE_HOSTCC
+#include <common.h>
+#include <linux/string.h>
+#else
+#include <string.h>
+#endif /* USE_HOSTCC */
+#include <watchdog.h>
+#include "sha256.h"
+
+const uint8_t sha256_der_prefix[SHA256_DER_LEN] = {
+ 0x30, 0x31, 0x30, 0x0d, 0x06, 0x09, 0x60, 0x86,
+ 0x48, 0x01, 0x65, 0x03, 0x04, 0x02, 0x01, 0x05,
+ 0x00, 0x04, 0x20
+};
+
+/*
+ * 32-bit integer manipulation macros (big endian)
+ */
+#ifndef GET_UINT32_BE
+#define GET_UINT32_BE(n,b,i) { \
+ (n) = ( (unsigned long) (b)[(i) ] << 24 ) \
+ | ( (unsigned long) (b)[(i) + 1] << 16 ) \
+ | ( (unsigned long) (b)[(i) + 2] << 8 ) \
+ | ( (unsigned long) (b)[(i) + 3] ); \
+}
+#endif
+#ifndef PUT_UINT32_BE
+#define PUT_UINT32_BE(n,b,i) { \
+ (b)[(i) ] = (unsigned char) ( (n) >> 24 ); \
+ (b)[(i) + 1] = (unsigned char) ( (n) >> 16 ); \
+ (b)[(i) + 2] = (unsigned char) ( (n) >> 8 ); \
+ (b)[(i) + 3] = (unsigned char) ( (n) ); \
+}
+#endif
+
+void sha256_starts(sha256_context * ctx)
+{
+ ctx->total[0] = 0;
+ ctx->total[1] = 0;
+
+ ctx->state[0] = 0x6A09E667;
+ ctx->state[1] = 0xBB67AE85;
+ ctx->state[2] = 0x3C6EF372;
+ ctx->state[3] = 0xA54FF53A;
+ ctx->state[4] = 0x510E527F;
+ ctx->state[5] = 0x9B05688C;
+ ctx->state[6] = 0x1F83D9AB;
+ ctx->state[7] = 0x5BE0CD19;
+}
+
+static void sha256_process(sha256_context *ctx, const uint8_t data[64])
+{
+ uint32_t temp1, temp2;
+ uint32_t W[64];
+ uint32_t A, B, C, D, E, F, G, H;
+
+ GET_UINT32_BE(W[0], data, 0);
+ GET_UINT32_BE(W[1], data, 4);
+ GET_UINT32_BE(W[2], data, 8);
+ GET_UINT32_BE(W[3], data, 12);
+ GET_UINT32_BE(W[4], data, 16);
+ GET_UINT32_BE(W[5], data, 20);
+ GET_UINT32_BE(W[6], data, 24);
+ GET_UINT32_BE(W[7], data, 28);
+ GET_UINT32_BE(W[8], data, 32);
+ GET_UINT32_BE(W[9], data, 36);
+ GET_UINT32_BE(W[10], data, 40);
+ GET_UINT32_BE(W[11], data, 44);
+ GET_UINT32_BE(W[12], data, 48);
+ GET_UINT32_BE(W[13], data, 52);
+ GET_UINT32_BE(W[14], data, 56);
+ GET_UINT32_BE(W[15], data, 60);
+
+#define SHR(x,n) ((x & 0xFFFFFFFF) >> n)
+#define ROTR(x,n) (SHR(x,n) | (x << (32 - n)))
+
+#define S0(x) (ROTR(x, 7) ^ ROTR(x,18) ^ SHR(x, 3))
+#define S1(x) (ROTR(x,17) ^ ROTR(x,19) ^ SHR(x,10))
+
+#define S2(x) (ROTR(x, 2) ^ ROTR(x,13) ^ ROTR(x,22))
+#define S3(x) (ROTR(x, 6) ^ ROTR(x,11) ^ ROTR(x,25))
+
+#define F0(x,y,z) ((x & y) | (z & (x | y)))
+#define F1(x,y,z) (z ^ (x & (y ^ z)))
+
+#define R(t) \
+( \
+ W[t] = S1(W[t - 2]) + W[t - 7] + \
+ S0(W[t - 15]) + W[t - 16] \
+)
+
+#define P(a,b,c,d,e,f,g,h,x,K) { \
+ temp1 = h + S3(e) + F1(e,f,g) + K + x; \
+ temp2 = S2(a) + F0(a,b,c); \
+ d += temp1; h = temp1 + temp2; \
+}
+
+ A = ctx->state[0];
+ B = ctx->state[1];
+ C = ctx->state[2];
+ D = ctx->state[3];
+ E = ctx->state[4];
+ F = ctx->state[5];
+ G = ctx->state[6];
+ H = ctx->state[7];
+
+ P(A, B, C, D, E, F, G, H, W[0], 0x428A2F98);
+ P(H, A, B, C, D, E, F, G, W[1], 0x71374491);
+ P(G, H, A, B, C, D, E, F, W[2], 0xB5C0FBCF);
+ P(F, G, H, A, B, C, D, E, W[3], 0xE9B5DBA5);
+ P(E, F, G, H, A, B, C, D, W[4], 0x3956C25B);
+ P(D, E, F, G, H, A, B, C, W[5], 0x59F111F1);
+ P(C, D, E, F, G, H, A, B, W[6], 0x923F82A4);
+ P(B, C, D, E, F, G, H, A, W[7], 0xAB1C5ED5);
+ P(A, B, C, D, E, F, G, H, W[8], 0xD807AA98);
+ P(H, A, B, C, D, E, F, G, W[9], 0x12835B01);
+ P(G, H, A, B, C, D, E, F, W[10], 0x243185BE);
+ P(F, G, H, A, B, C, D, E, W[11], 0x550C7DC3);
+ P(E, F, G, H, A, B, C, D, W[12], 0x72BE5D74);
+ P(D, E, F, G, H, A, B, C, W[13], 0x80DEB1FE);
+ P(C, D, E, F, G, H, A, B, W[14], 0x9BDC06A7);
+ P(B, C, D, E, F, G, H, A, W[15], 0xC19BF174);
+ P(A, B, C, D, E, F, G, H, R(16), 0xE49B69C1);
+ P(H, A, B, C, D, E, F, G, R(17), 0xEFBE4786);
+ P(G, H, A, B, C, D, E, F, R(18), 0x0FC19DC6);
+ P(F, G, H, A, B, C, D, E, R(19), 0x240CA1CC);
+ P(E, F, G, H, A, B, C, D, R(20), 0x2DE92C6F);
+ P(D, E, F, G, H, A, B, C, R(21), 0x4A7484AA);
+ P(C, D, E, F, G, H, A, B, R(22), 0x5CB0A9DC);
+ P(B, C, D, E, F, G, H, A, R(23), 0x76F988DA);
+ P(A, B, C, D, E, F, G, H, R(24), 0x983E5152);
+ P(H, A, B, C, D, E, F, G, R(25), 0xA831C66D);
+ P(G, H, A, B, C, D, E, F, R(26), 0xB00327C8);
+ P(F, G, H, A, B, C, D, E, R(27), 0xBF597FC7);
+ P(E, F, G, H, A, B, C, D, R(28), 0xC6E00BF3);
+ P(D, E, F, G, H, A, B, C, R(29), 0xD5A79147);
+ P(C, D, E, F, G, H, A, B, R(30), 0x06CA6351);
+ P(B, C, D, E, F, G, H, A, R(31), 0x14292967);
+ P(A, B, C, D, E, F, G, H, R(32), 0x27B70A85);
+ P(H, A, B, C, D, E, F, G, R(33), 0x2E1B2138);
+ P(G, H, A, B, C, D, E, F, R(34), 0x4D2C6DFC);
+ P(F, G, H, A, B, C, D, E, R(35), 0x53380D13);
+ P(E, F, G, H, A, B, C, D, R(36), 0x650A7354);
+ P(D, E, F, G, H, A, B, C, R(37), 0x766A0ABB);
+ P(C, D, E, F, G, H, A, B, R(38), 0x81C2C92E);
+ P(B, C, D, E, F, G, H, A, R(39), 0x92722C85);
+ P(A, B, C, D, E, F, G, H, R(40), 0xA2BFE8A1);
+ P(H, A, B, C, D, E, F, G, R(41), 0xA81A664B);
+ P(G, H, A, B, C, D, E, F, R(42), 0xC24B8B70);
+ P(F, G, H, A, B, C, D, E, R(43), 0xC76C51A3);
+ P(E, F, G, H, A, B, C, D, R(44), 0xD192E819);
+ P(D, E, F, G, H, A, B, C, R(45), 0xD6990624);
+ P(C, D, E, F, G, H, A, B, R(46), 0xF40E3585);
+ P(B, C, D, E, F, G, H, A, R(47), 0x106AA070);
+ P(A, B, C, D, E, F, G, H, R(48), 0x19A4C116);
+ P(H, A, B, C, D, E, F, G, R(49), 0x1E376C08);
+ P(G, H, A, B, C, D, E, F, R(50), 0x2748774C);
+ P(F, G, H, A, B, C, D, E, R(51), 0x34B0BCB5);
+ P(E, F, G, H, A, B, C, D, R(52), 0x391C0CB3);
+ P(D, E, F, G, H, A, B, C, R(53), 0x4ED8AA4A);
+ P(C, D, E, F, G, H, A, B, R(54), 0x5B9CCA4F);
+ P(B, C, D, E, F, G, H, A, R(55), 0x682E6FF3);
+ P(A, B, C, D, E, F, G, H, R(56), 0x748F82EE);
+ P(H, A, B, C, D, E, F, G, R(57), 0x78A5636F);
+ P(G, H, A, B, C, D, E, F, R(58), 0x84C87814);
+ P(F, G, H, A, B, C, D, E, R(59), 0x8CC70208);
+ P(E, F, G, H, A, B, C, D, R(60), 0x90BEFFFA);
+ P(D, E, F, G, H, A, B, C, R(61), 0xA4506CEB);
+ P(C, D, E, F, G, H, A, B, R(62), 0xBEF9A3F7);
+ P(B, C, D, E, F, G, H, A, R(63), 0xC67178F2);
+
+ ctx->state[0] += A;
+ ctx->state[1] += B;
+ ctx->state[2] += C;
+ ctx->state[3] += D;
+ ctx->state[4] += E;
+ ctx->state[5] += F;
+ ctx->state[6] += G;
+ ctx->state[7] += H;
+}
+
+void sha256_update(sha256_context *ctx, const uint8_t *input, uint32_t length)
+{
+ uint32_t left, fill;
+
+ if (!length)
+ return;
+
+ left = ctx->total[0] & 0x3F;
+ fill = 64 - left;
+
+ ctx->total[0] += length;
+ ctx->total[0] &= 0xFFFFFFFF;
+
+ if (ctx->total[0] < length)
+ ctx->total[1]++;
+
+ if (left && length >= fill) {
+ memcpy((void *) (ctx->buffer + left), (void *) input, fill);
+ sha256_process(ctx, ctx->buffer);
+ length -= fill;
+ input += fill;
+ left = 0;
+ }
+
+ while (length >= 64) {
+ sha256_process(ctx, input);
+ length -= 64;
+ input += 64;
+ }
+
+ if (length)
+ memcpy((void *) (ctx->buffer + left), (void *) input, length);
+}
+
+static uint8_t sha256_padding[64] = {
+ 0x80, 0, 0, 0, 0, 0, 0, 0, 0, 0, 0, 0, 0, 0, 0, 0,
+ 0, 0, 0, 0, 0, 0, 0, 0, 0, 0, 0, 0, 0, 0, 0, 0,
+ 0, 0, 0, 0, 0, 0, 0, 0, 0, 0, 0, 0, 0, 0, 0, 0,
+ 0, 0, 0, 0, 0, 0, 0, 0, 0, 0, 0, 0, 0, 0, 0, 0
+};
+
+void sha256_finish(sha256_context * ctx, uint8_t digest[32])
+{
+ uint32_t last, padn;
+ uint32_t high, low;
+ uint8_t msglen[8];
+
+ high = ((ctx->total[0] >> 29)
+ | (ctx->total[1] << 3));
+ low = (ctx->total[0] << 3);
+
+ PUT_UINT32_BE(high, msglen, 0);
+ PUT_UINT32_BE(low, msglen, 4);
+
+ last = ctx->total[0] & 0x3F;
+ padn = (last < 56) ? (56 - last) : (120 - last);
+
+ sha256_update(ctx, sha256_padding, padn);
+ sha256_update(ctx, msglen, 8);
+
+ PUT_UINT32_BE(ctx->state[0], digest, 0);
+ PUT_UINT32_BE(ctx->state[1], digest, 4);
+ PUT_UINT32_BE(ctx->state[2], digest, 8);
+ PUT_UINT32_BE(ctx->state[3], digest, 12);
+ PUT_UINT32_BE(ctx->state[4], digest, 16);
+ PUT_UINT32_BE(ctx->state[5], digest, 20);
+ PUT_UINT32_BE(ctx->state[6], digest, 24);
+ PUT_UINT32_BE(ctx->state[7], digest, 28);
+}
+
+/*
+ * Output = SHA-256( input buffer ). Trigger the watchdog every 'chunk_sz'
+ * bytes of input processed.
+ */
+void sha256_csum_wd(const unsigned char *input, unsigned int ilen,
+ unsigned char *output)
+{
+ sha256_context ctx;
+
+ sha256_starts(&ctx);
+
+ sha256_update(&ctx, input, ilen);
+
+ sha256_finish(&ctx, output);
+}
diff --git a/boot/common/src/uboot/drivers/hash/sha256.h b/boot/common/src/uboot/drivers/hash/sha256.h
new file mode 100755
index 0000000..2da2952
--- /dev/null
+++ b/boot/common/src/uboot/drivers/hash/sha256.h
@@ -0,0 +1,25 @@
+#ifndef _SHA256_H
+#define _SHA256_H
+
+#define SHA256_SUM_LEN 32
+#define SHA256_DER_LEN 19
+
+extern const uint8_t sha256_der_prefix[];
+
+/* Reset watchdog each time we process this many bytes */
+#define CHUNKSZ_SHA256 (64 * 1024)
+
+typedef struct {
+ uint32_t total[2];
+ uint32_t state[8];
+ uint8_t buffer[64];
+} sha256_context;
+
+void sha256_starts(sha256_context * ctx);
+void sha256_update(sha256_context *ctx, const uint8_t *input, uint32_t length);
+void sha256_finish(sha256_context * ctx, uint8_t digest[SHA256_SUM_LEN]);
+
+void sha256_csum_wd(const unsigned char *input, unsigned int ilen,
+ unsigned char *output);
+
+#endif /* _SHA256_H */