curry/hdmitx/halHDCPTx.c

//<MStar Software>
//******************************************************************************
// MStar Software
// Copyright (c) 2010 - 2012 MStar Semiconductor, Inc. All rights reserved.
// All software, firmware and related documentation herein ("MStar Software") are
// intellectual property of MStar Semiconductor, Inc. ("MStar") and protected by
// law, including, but not limited to, copyright law and international treaties.
// Any use, modification, reproduction, retransmission, or republication of all
// or part of MStar Software is expressly prohibited, unless prior written
// permission has been granted by MStar.
//
// By accessing, browsing and/or using MStar Software, you acknowledge that you
// have read, understood, and agree, to be bound by below terms ("Terms") and to
// comply with all applicable laws and regulations:
//
// 1. MStar shall retain any and all right, ownership and interest to MStar
//    Software and any modification/derivatives thereof.
//    No right, ownership, or interest to MStar Software and any
//    modification/derivatives thereof is transferred to you under Terms.
//
// 2. You understand that MStar Software might include, incorporate or be
//    supplied together with third party`s software and the use of MStar
//    Software may require additional licenses from third parties.
//    Therefore, you hereby agree it is your sole responsibility to separately
//    obtain any and all third party right and license necessary for your use of
//    such third party`s software.
//
// 3. MStar Software and any modification/derivatives thereof shall be deemed as
//    MStar`s confidential information and you agree to keep MStar`s
//    confidential information in strictest confidence and not disclose to any
//    third party.
//
// 4. MStar Software is provided on an "AS IS" basis without warranties of any
//    kind. Any warranties are hereby expressly disclaimed by MStar, including
//    without limitation, any warranties of merchantability, non-infringement of
//    intellectual property rights, fitness for a particular purpose, error free
//    and in conformity with any international standard.  You agree to waive any
//    claim against MStar for any loss, damage, cost or expense that you may
//    incur related to your use of MStar Software.
//    In no event shall MStar be liable for any direct, indirect, incidental or
//    consequential damages, including without limitation, lost of profit or
//    revenues, lost or damage of data, and unauthorized system use.
//    You agree that this Section 4 shall still apply without being affected
//    even if MStar Software has been modified by MStar in accordance with your
//    request or instruction for your use, except otherwise agreed by both
//    parties in writing.
//
// 5. If requested, MStar may from time to time provide technical supports or
//    services in relation with MStar Software to you for your use of
//    MStar Software in conjunction with your or your customer`s product
//    ("Services").
//    You understand and agree that, except otherwise agreed by both parties in
//    writing, Services are provided on an "AS IS" basis and the warranty
//    disclaimer set forth in Section 4 above shall apply.
//
// 6. Nothing contained herein shall be construed as by implication, estoppels
//    or otherwise:
//    (a) conferring any license or right to use MStar name, trademark, service
//        mark, symbol or any other identification;
//    (b) obligating MStar or any of its affiliates to furnish any person,
//        including without limitation, you and your customers, any assistance
//        of any kind whatsoever, or any information; or
//    (c) conferring any license or right under any intellectual property right.
//
// 7. These terms shall be governed by and construed in accordance with the laws
//    of Taiwan, R.O.C., excluding its conflict of law rules.
//    Any and all dispute arising out hereof or related hereto shall be finally
//    settled by arbitration referred to the Chinese Arbitration Association,
//    Taipei in accordance with the ROC Arbitration Law and the Arbitration
//    Rules of the Association by three (3) arbitrators appointed in accordance
//    with the said Rules.
//    The place of arbitration shall be in Taipei, Taiwan and the language shall
//    be English.
//    The arbitration award shall be final and binding to both parties.
//
//******************************************************************************
//<MStar Software>
////////////////////////////////////////////////////////////////////////////////
//
// Copyright (c) 2006-2009 MStar Semiconductor, Inc.
// All rights reserved.
//
// Unless otherwise stipulated in writing, any and all information contained
// herein regardless in any format shall remain the sole proprietary of
// MStar Semiconductor Inc. and be kept in strict confidence
// (��MStar Confidential Information��) by the recipient.
// Any unauthorized act including without limitation unauthorized disclosure,
// copying, use, reproduction, sale, distribution, modification, disassembling,
// reverse engineering and compiling of the contents of MStar Confidential
// Information is unlawful and strictly prohibited. MStar hereby reserves the
// rights to any and all damages, losses, costs and expenses resulting therefrom.
//
////////////////////////////////////////////////////////////////////////////////

///////////////////////////////////////////////////////////////////////////////////////////////////
///
/// file    halHDCPTx.c
/// @author MStar Semiconductor Inc.
/// @brief  HDMITx HDCP HAL
///////////////////////////////////////////////////////////////////////////////////////////////////


//-------------------------------------------------------------------------------------------------
//  Include Files
//-------------------------------------------------------------------------------------------------
#ifdef MSOS_TYPE_LINUX_KERNEL
#include <linux/string.h>
#else
#include <string.h>
#endif
#include "MsCommon.h"
#include "halHDMIUtilTx.h"
#include "regHDMITx.h"
#include "halHDCPTx.h"

//-------------------------------------------------------------------------------------------------
//  Driver Compiler Options
//-------------------------------------------------------------------------------------------------


//-------------------------------------------------------------------------------------------------
//  Local Defines
//-------------------------------------------------------------------------------------------------

#define HDCP_KEY_OFFSET         8U

//-------------------------------------------------------------------------------------------------
//  Local Structures
//-------------------------------------------------------------------------------------------------

//-------------------------------------------------------------------------------------------------
//  Global Variables
//-------------------------------------------------------------------------------------------------

MS_BOOL bDebugHDCPFlag = FALSE;
MS_U8 HDCP_AKSV[5] = {0, 0, 0, 0, 0,};
MS_U8 HDCP_BKSV[5] = {0, 0, 0, 0, 0,};

MS_U8 HDCP_KEY[304];

//-------------------------------------------------------------------------------------------------
//  Local Variables
//-------------------------------------------------------------------------------------------------

MSTHDMITX_REG_TYPE TxHdcpInitTbl[] =
{
    {HDMITX_HDCP_REG_BASE, REG_HDCP_TX_MODE_01, 0x8000, 0x8000}, // Enable HDCP encryption
    {HDMITX_HDCP_REG_BASE, REG_HDCP_TX_COMMAND_02, 0x001C, 0x0000}, //[4]: 1: km new mode; 0: km old mode
};

MSTHDMITX_REG_TYPE TxHdcpEncryptOnTbl[] =
{
    {HDMITX_HDCP_REG_BASE, REG_HDCP_TX_COMMAND_02, 0x0008, 0x0008},
};

MSTHDMITX_REG_TYPE TxHdcpEncryptOffTbl[] =
{
    {HDMITX_HDCP_REG_BASE, REG_HDCP_TX_COMMAND_02, 0x0008, 0x0000},
};

MS_U8 TxHdcpAnTbl[] =
{
    0x03, 0x04, 0x07, 0x0C, 0x13, 0x1C, 0x27, 0x34,
};

MS_U32 sm_K160[4] =
{
    0x5A827999, 0x6ED9EBA1, 0x8F1BBCDC, 0xCA62C1D6
};

MS_U32 sm_H160[SHA160LENGTH] =
{
    0x67452301, 0xEFCDAB89, 0x98BADCFE, 0x10325476, 0xC3D2E1F0
};


//-------------------------------------------------------------------------------------------------
//  Debug Functions
//-------------------------------------------------------------------------------------------------

//-------------------------------------------------------------------------------------------------
//  Local Functions
//-------------------------------------------------------------------------------------------------

extern MS_BOOL MDrv_EEPROM_Read(MS_U32 u32Addr, MS_U8 *pu8Buf, MS_U32 u32Size);

void Bytes2Word(MS_U8 const * pcBytes, MS_U32  * ruiWord)
{
    *ruiWord = ((MS_U32) pcBytes[3])
             | (((MS_U32) pcBytes[2]) << 8)
             | (((MS_U32) pcBytes[1]) << 16)
             | (((MS_U32) pcBytes[0]) << 24);
}

//#define   Bytes2Word(pcBytes) (((MS_U32)pcBytes[3]) | (((MS_U32)pcBytes[2])<<8) |       (( (MS_U32)pcBytes[1] )<<16) | (( (MS_U32)pcBytes[0] )<<24))

MS_U32 CircularShift(MS_U32 uiBits, MS_U32 uiWord)
{
    return (uiWord << uiBits) | (uiWord >> (32 - uiBits));
}

void Word2Bytes1(MS_U32 const * ruiWord, MS_U8* pcBytes)
{
	pcBytes += 3;
	*pcBytes = *ruiWord & 0xff;
	*--pcBytes = (*ruiWord >> 8) & 0xff;
	*--pcBytes = (*ruiWord >> 16) & 0xff;
	*--pcBytes = (*ruiWord >> 24) & 0xff;
}

void Word2Bytes(MS_U32 const * ruiWord, MS_U8* pcBytes)
{
    pcBytes += 3;
    *pcBytes = (*ruiWord>>24) & 0xff;
    *--pcBytes = (*ruiWord >> 16) & 0xff;
    *--pcBytes = (*ruiWord >> 8) & 0xff;
    *--pcBytes = (*ruiWord) & 0xff;
}


void MHal_HDMITx_HdcpDebugEnable(MS_BOOL benable)
{
    bDebugHDCPFlag = benable;
}

void MHal_HDMITx_GetHdcpKey(MS_BOOL useinternalkey, MS_U8 *data)
{
    if(!useinternalkey)
    {
        memcpy(&HDCP_KEY[0], data, 304*sizeof(MS_U8));
    	{
            MS_U16 i;

            if(bDebugHDCPFlag)
            {
                printf("HDCP key = \n");
                for(i=0;i<304;i++)
                {
                    printf("0x%x, ", HDCP_KEY[i]);
                    if(i%16 == 15)
                        printf("\n");
                }
            }
        }
    }
}

void MHal_HDMITx_HdcpKeyInit(MS_BOOL useinternalkey)
{
    if(!useinternalkey)
    {
        MDrv_EEPROM_Read(0x00, HDCP_KEY, 304);
    #if 1
    	{
            MS_U16 i;

            if(bDebugHDCPFlag)
            {
                printf("HDCP key = \n");
                for(i=0;i<304;i++)
                {
                    printf("0x%x, ", HDCP_KEY[i]);
                    if(i%16 == 15)
                        printf("\n");
                }
            }

	}
    #endif
    }
}


//******************************************************************************
//
//  [Function Name]:
//      TxHdcpInit
//  [Description]:
//      This routine is the initialization for HDCP module.
//  [Arguments]:
//      arg1:   tx index
//  [Return]:
//      None
//
//*******************************************************************************
void MHal_HDMITx_HdcpInit(void)
{
    MS_U8 num;

    num = sizeof(TxHdcpInitTbl) / sizeof(MSTHDMITX_REG_TYPE);
    MHal_HDMITx_RegsTbl_Write(TxHdcpInitTbl, num);
}


//******************************************************************************
//
//  [Function Name]:
//      TxHdcpRxActive
//  [Description]:
//      This routine check the HDCP Rx active or not
//  [Arguments]:
//      arg1:   tx index
//  [Return]:
//      FALSE:      no HDCP Rx
//      TRUE:       HDCP Rx active
//
//*******************************************************************************
MS_BOOL MHal_HDMITx_HdcpRxActive(void)
{
    MS_U8 regval;

    if (MHal_HDMITx_Rx74ReadByte(0x40, &regval) == TRUE)
    {
        if(regval != 0xFF)
            return TRUE;
    }
    return FALSE;
}


//******************************************************************************
//
//  [Function Name]:
//      TxHdcpSetEncrypt
//  [Description]:
//      This routine set encryption for HDCP module.
//  [Arguments]:
//      arg1:   tx index
//      arg2:   0:disable 1:enable
//  [Return]:
//      None
//
//*******************************************************************************
void MHal_HDMITx_HdcpSetEncrypt(MS_BOOL enable)
{
    switch (enable)
    {
        case 0:
            MHal_HDMITx_RegsTbl_Write(TxHdcpEncryptOffTbl, 1);
            break;
        case 1:
            MHal_HDMITx_RegsTbl_Write(TxHdcpEncryptOnTbl, 1);
            break;
        default:
            break;
    }
}


//******************************************************************************
//
//  [Function Name]:
//      TxHdcpCheckBksvLn
//  [Description]:
//      This routine check the HDCP Rx's BKSV and calculate the Key
//  [Arguments]:
//      arg1:   tx index
//  [Return]:
//      TRUE:   pass
//      FALSE:  fail
//
//*******************************************************************************
MS_BOOL MHal_HDMITx_HdcpCheckBksvLn(void)
{
    MS_U8 bksv[5] = {0}, Lm[7] = {0};
    MS_U8 temp, carry_bit, seed;
    MS_U8 i, j, k, t;
    MS_U16 offset;

    if(bDebugHDCPFlag)
        printf("TxHdcpCheckBksvLn()\r\n");
    // Check BKSV 20 bit1 20 bit0
    k = 0;
    for (t = 0; t < 10; t++)
    {
        for (i = 0; i < 5; i++)
        {
            if(MHal_HDMITx_Rx74ReadByte(i, &bksv[i]) == FALSE)
            {
                if(bDebugHDCPFlag)
                    printf("Reading BKSV failed because I2C\r\n");
                return FALSE;
            }
            for (j = 0; j < 8; j++)
                k += (bksv[i] >> j) & 0x01;

			HDCP_BKSV[i] = bksv[i];
        }
        if (k == 20)
            break;
        MsOS_DelayTask(20);
        k=0;
    }

    if(bDebugHDCPFlag)
    {
        printf("Bksv=");
        for (i = 0; i < 5; i++)
            printf("0x%x, ", bksv[i]);
        printf("\r\n");
    }

    if (k != 20)
        return FALSE;
    for (i = 0; i < 7; i++)
        Lm[i] = 0;

#if 0
    for(i=0;i<18;i++)
    {
        for(j=0;j<16;j++)
        {
            if(HDCP_KEY[(i<<4)+j]!=MHal_HDMITx_Rx74ReadByte((i<<4)+j))
            DBG_HDCP(printf("\r\nerror address=%x\r\n,",(i<<4)+j));
        }
    }
#endif

    // Generate cipher infomation from Key & BKSV
    for (i = 0; i < 5; i++)
        for (j = 0; j < 8; j++)
        {
            //if(RxBksvTbl[4-i] & (1<<j))
            if (bksv[i] & (1 << j))
            {
                carry_bit = 0;
                offset = (i * 8 + j) * 7 + HDCP_KEY_OFFSET;
                for (k = 0; k < 7; k++)
                {
                    seed = (k + HDCP_KEY[7]) % 7;
                    temp = HDCP_KEY[offset + k] ^ HDCP_KEY[seed];
                    Lm[k] = Lm[k] + temp + carry_bit;
                    if (((carry_bit == 0) && (Lm[k] >= temp)) || ((carry_bit == 1) && (Lm[k] > temp)))
                        carry_bit = 0;
                    else
                        carry_bit = 1;
                }
            }
        }
    temp = HDCP_KEY[288];

    if(bDebugHDCPFlag)
        printf("Km= ");
    for (i = 0; i < 7; i++)
    {
        if (i < 6)
            Lm[i] = Lm[i] ^ temp;
        else
            Lm[i] = Lm[i] ^ (~temp);

        if(i%2)
            MHal_HDMITx_Write(HDMITX_HDCP_REG_BASE, REG_HDCP_TX_LN_04+(i/2), (Lm[i]<<8) | Lm[i-1]);
        if(bDebugHDCPFlag)
            printf("0x%x, ", Lm[i]);
    }
    if(bDebugHDCPFlag)
        printf("\n");
    MHal_HDMITx_Write(HDMITX_HDCP_REG_BASE, REG_HDCP_TX_LN_SEED_07, (temp<<8) | Lm[6]);
    if(bDebugHDCPFlag)
        printf("Seed=0x%x\r\n", temp);

    return TRUE;
}


//******************************************************************************
//
//  [Function Name]:
//      TxHdcpWriteAn
//  [Description]:
//      This routine Write An to the HDCP Rx
//  [Arguments]:
//      arg1:   tx index
//      arg2:   use internal An or not
//  [Return]:
//      None
//
//*******************************************************************************
MS_BOOL MHal_HDMITx_HdcpWriteAn(MS_U8 internal)
{
    MS_U16 temp;
    MS_U8 i;

    if (internal == 1)
    {
        MHal_HDMITx_Mask_Write(HDMITX_HDCP_REG_BASE, REG_HDCP_TX_MODE_01, 0x0100, 0x0100);
        MHal_HDMITx_Mask_Write(HDMITX_HDCP_REG_BASE, REG_HDCP_TX_COMMAND_02, BIT1, BIT1);
        MHal_HDMITx_Mask_Write(HDMITX_HDCP_REG_BASE, REG_HDCP_TX_COMMAND_02, BIT1, 0);

        //Waiting for HW An Auto Gen Ready
        MsOS_DelayTaskUs(1);

        if(bDebugHDCPFlag)
            printf("Internal An=");
        for (i = 0; i < 4; i++)
        {
            temp = MHal_HDMITx_Read(HDMITX_HDCP_REG_BASE, REG_HDCP_TX_AN_08+i);
            if(MHal_HDMITx_Rx74WriteByte(0x18 + (i*2), (MS_U8)(temp & 0x00FF)) == FALSE)
            {
                if(bDebugHDCPFlag)
                    printf("Writing An failed because I2C\r\n");
                return FALSE;
            }
            if(MHal_HDMITx_Rx74WriteByte(0x18 + (i*2+1), (MS_U8)((temp & 0xFF00)>>8)) == FALSE)
            {
                if(bDebugHDCPFlag)
                    printf("Writing An failed because I2C\r\n");
                return FALSE;
            }
            if(bDebugHDCPFlag)
            {
                printf("0x%x, ", temp & 0x00FF);
                printf("0x%x, ", (temp & 0xFF00)>>8);
            }
        }
        if(bDebugHDCPFlag)
            printf("\r\n");
    }
    else
    {
        MHal_HDMITx_Mask_Write(HDMITX_HDCP_REG_BASE, REG_HDCP_TX_MODE_01, 0x0100, 0x0000);
        for(i = 0; i < 4; i++)
            MHal_HDMITx_Write(HDMITX_HDCP_REG_BASE, REG_HDCP_TX_AN_08+i, (TxHdcpAnTbl[2*i+1] <<8) | (TxHdcpAnTbl[2*i]));
        if(MHal_HDMITx_Rx74WriteBytes(0x18, 8, TxHdcpAnTbl) == FALSE)
        {
            if(bDebugHDCPFlag)
                printf("Writing An failed because I2C\r\n");
            return FALSE;
        }
        if(bDebugHDCPFlag)
        {
             printf("External An=");
             for (i = 0; i < 8; i++)
                 printf("0x%x, ", TxHdcpAnTbl[i]);
             printf("\r\n");
        }
    }
    return TRUE;
}


//******************************************************************************
//
//  [Function Name]:
//      TxHdcpWriteAksv
//  [Description]:
//      This routine Write AKSV to the HDCP Rx
//  [Arguments]:
//      arg1:   tx index
//  [Return]:
//      None
//
//*******************************************************************************
MS_BOOL MHal_HDMITx_HdcpWriteAksv(void)
{
    MS_U8 temp;
    MS_U8 i, k, j;

    if(bDebugHDCPFlag)
        printf("Aksv=");
    for (i = 0, k=0; i < 5; i++)
    {
        //temp = TxHdcpKeyTbl[i];
        temp = HDCP_KEY[i];
        HDCP_AKSV[i] = temp;
        if(MHal_HDMITx_Rx74WriteByte(0x10 + i, temp) == FALSE)
        {
            if(bDebugHDCPFlag)
                printf("Writing Aksv failed because I2C\r\n");
            return FALSE;
        }
        for (j = 0; j < 8; j++)
            k += (temp >> j) & 0x01; // check AKSV whether is 20 zeros and 20 ones or not.
        if(bDebugHDCPFlag)
            printf("0x%x, ", temp);
    }
    if(bDebugHDCPFlag)
        printf("\r\n");
    if(k!=20)	return FALSE;
    return TRUE;
}


//******************************************************************************
//
//  [Function Name]:
//      MHal_HDMITx_GET74
//  [Description]:
//      This routine get data from 74reg
//  [Arguments]:
//
//  [Return]:
//      None
//
//*******************************************************************************
void MHal_HDMITx_GET74(MS_U8 udata, MS_U8 *pdata)
{
   if(udata == 0x00)
       memcpy(pdata, &HDCP_BKSV, 5*sizeof(MS_U8));
   else if(udata == 0x10)
       memcpy(pdata, &HDCP_AKSV, 5*sizeof(MS_U8));
}


//******************************************************************************
//
//  [Function Name]:
//      TxHdcpStartCipher
//  [Description]:
//      This routine Start HDCP Tx Cipher
//  [Arguments]:
//      arg1:   tx index
//  [Return]:
//      None
//
//*******************************************************************************
void MHal_HDMITx_HdcpStartCipher(void)
{
    MS_U8 count = 0xFF;

    MHal_HDMITx_Mask_Write(HDMITX_HDCP_REG_BASE, REG_HDCP_TX_COMMAND_02, 0x000F, 0);
    MHal_HDMITx_Mask_Write(HDMITX_HDCP_REG_BASE, REG_HDCP_TX_COMMAND_02, 0x000F, BIT0);
    MHal_HDMITx_Mask_Write(HDMITX_HDCP_REG_BASE, REG_HDCP_TX_COMMAND_02, 0x000F, 0);

    while (count-- && !(MHal_HDMITx_Read(HDMITX_HDCP_REG_BASE, REG_HDCP_TX_COMMAND_02) & BIT8));
    if (count == 0)
    {
        if(bDebugHDCPFlag)
            printf("Cipher not done!!!\r\n");
    }
}


//******************************************************************************
//
//  [Function Name]:
//      TxHdcpAuthPass
//  [Description]:
//      This routine finish the authentication
//  [Arguments]:
//      arg1:   tx index
//  [Return]:
//      None
//
//*******************************************************************************
void MHal_HDMITx_HdcpAuthPass(void)
{
    MHal_HDMITx_Mask_Write(HDMITX_HDCP_REG_BASE, REG_HDCP_TX_COMMAND_02, 0x000F, 0x000C);
}


void MHal_HDMITx_HdcpSha1Init(SHA1_DATA *dig)
{
    MS_U8 i;

    for (i = 0; i < SHA160LENGTH; i++)
        dig->m_auiBuf[i] = sm_H160[i];
    dig->m_auiBits[0] = 0;
    dig->m_auiBits[1] = 0;
    memset(dig->m_aucIn, 0, BLOCKSIZE) ;  // 2006/1/18 3:31PM by Emily
}


//******************************************************************************
//
//  [Function Name]:
//      TxHdcpCheckRi
//  [Description]:
//      This routine check the hdcp Ri values
//  [Arguments]:
//      arg1:   tx index
//      arg2:   output Tx Ri value
//      arg3:   output Rx Ri value
//  [Return]:
//      None
//
//*******************************************************************************
MS_BOOL MHal_HDMITx_HdcpCheckRi(MS_U16 *ptx_ri, MS_U16 *prx_ri)
{
    *ptx_ri = MHal_HDMITx_Read(HDMITX_HDCP_REG_BASE, REG_HDCP_TX_RI_00);
    if(MHal_HDMITx_Rx74ReadBytes(0x08, 2, (MS_U8 *)prx_ri) == TRUE)
    {
        if (*prx_ri == *ptx_ri)
            return TRUE;
    }
    if(MHal_HDMITx_Rx74ReadBytes(0x08, 2, (MS_U8 *)prx_ri) == TRUE)
    {
        if (*prx_ri == *ptx_ri)
            return TRUE;
    }
    *ptx_ri = MHal_HDMITx_Read(HDMITX_HDCP_REG_BASE, REG_HDCP_TX_RI_00);
    if (*prx_ri == *ptx_ri)
        return TRUE;
    else
        return FALSE;
}


void _MHal_HDMITx_HdcpSha1Transform(SHA1_DATA *dig)
{
    MS_U8 * pucIn = dig->m_aucIn;
    MS_U32 auiW[80];
    MS_U8 i;
    MS_U32 temp;
    MS_U32 A, B, C, D, E;

    for (i = 0; i < 16; i++,pucIn += 4)
        auiW[i] = ((MS_U32)pucIn[3]) | ((MS_U32)pucIn[2] << 8) |
                  ((MS_U32)pucIn[1] << 16) | ((MS_U32)pucIn[0] << 24);
    for (i = 16; i < 80; i++)
        auiW[i] = ((auiW[i - 3] ^ auiW[i - 8] ^ auiW[i - 14] ^ auiW[i - 16]) << 1) |
                  ((auiW[i - 3] ^ auiW[i - 8] ^ auiW[i - 14] ^ auiW[i - 16]) >> 31);

    A = dig->m_auiBuf[0];
    B = dig->m_auiBuf[1];
    C = dig->m_auiBuf[2];
    D = dig->m_auiBuf[3];
    E = dig->m_auiBuf[4];

    for (i = 0; i < 20; i++)
    {
        temp = ((A << 5) | (A >> 27)) + ((B & C) | ((~B) & D)) + E + auiW[i] + sm_K160[0];
        E = D;
        D = C;
		C = (B << 30) | (B >> 2);
        B = A;
        A = temp;
    }
    for (i = 20; i < 40; i++)
    {
        temp = ((A << 5) | (A >> 27)) + (B ^ C ^ D) + E + auiW[i] + sm_K160[1];
        E = D;
        D = C;
		C = (B << 30) | (B >> 2);
        B = A;
        A = temp;
    }
    for (i = 40; i < 60; i++)
    {
        temp = ((A << 5) | (A >> 27)) + ((B & C) | (B & D) | (C & D)) + E + auiW[i] + sm_K160[2];
        E = D;
        D = C;
		C = (B << 30) | (B >> 2);
        B = A;
        A = temp;
    }
    for (i = 60; i < 80; i++)
    {
        temp = ((A << 5) | (A >> 27)) + (B ^ C ^ D) + E + auiW[i] + sm_K160[3];
        E = D;
        D = C;
		C = (B << 30) | (B >> 2);
        B = A;
        A = temp;
    }
    dig->m_auiBuf[0] += A;
    dig->m_auiBuf[1] += B;
    dig->m_auiBuf[2] += C;
    dig->m_auiBuf[3] += D;
    dig->m_auiBuf[4] += E;
}


void MHal_HDMITx_HdcpSha1AddData(SHA1_DATA *dig, MS_U8 const * pcData, MS_U16  iDataLength)
{
    MS_U32  uiT;

    //Update bitcount
    uiT = dig->m_auiBits[0];
    if ((dig->m_auiBits[0] = uiT + ((MS_U32) iDataLength << 3)) < uiT)
        dig->m_auiBits[1]++; //Carry from low to high
    //dig->m_auiBits[1] += ((MS_U32) iDataLength) >> 29;  //Fix coverity impact : iDataLength >> 29 is 0
    uiT = (uiT >> 3) & (BLOCKSIZE - 1); //Bytes already
    //Handle any leading odd-sized chunks
    if (uiT != 0)
    {
        MS_U8 * puc = (MS_U8 *) dig->m_aucIn + uiT;
        uiT = BLOCKSIZE - uiT;
        if (iDataLength < uiT)
        {
            memcpy(puc, pcData, iDataLength);
            return;
        }
        memcpy(puc, pcData, uiT);
        _MHal_HDMITx_HdcpSha1Transform(dig);
        pcData += uiT;
        iDataLength -= uiT;
    }
    //Process data in 64-byte chunks
    while (iDataLength >= BLOCKSIZE)
    {
        memcpy(dig->m_aucIn, pcData, BLOCKSIZE);
        _MHal_HDMITx_HdcpSha1Transform(dig);
        pcData += BLOCKSIZE;
        iDataLength -= BLOCKSIZE;
    }
    //Handle any remaining bytes of data
    memcpy(dig->m_aucIn, pcData, iDataLength);
}


void MHal_HDMITx_HdcpSha1FinalDigest(SHA1_DATA *dig, MS_U8* pcDigest)
{
    MS_U16  uiCount;
    MS_U8   *puc;
    MS_U8   i;

    //Compute number of bytes mod 64
    uiCount = (dig->m_auiBits[0] >> 3) & (BLOCKSIZE - 1);
    //Set the first char of padding to 0x80. This is safe since there is
    //always at least one byte free
    puc = dig->m_aucIn + uiCount;
    *puc++ = 0x80;
    //Bytes of padding needed to make 64 bytes
    uiCount = BLOCKSIZE - uiCount - 1;

    //Pad out to 56 mod 64
    if (uiCount < 8)
    {
        //Two lots of padding: Pad the first block to 64 bytes
        memset(puc, 0, uiCount);
        _MHal_HDMITx_HdcpSha1Transform(dig);
        //Now fill the next block with 56 bytes
        memset(dig->m_aucIn, 0, BLOCKSIZE - 8);
    }
    else
    {
        //Pad block to 56 bytes
        memset(puc, 0, uiCount - 8);
    }

    //Append length in bits and transform
    Word2Bytes1(&dig->m_auiBits[1], &dig->m_aucIn[BLOCKSIZE - 8]);
    Word2Bytes1(&dig->m_auiBits[0], &dig->m_aucIn[BLOCKSIZE - 4]);
    _MHal_HDMITx_HdcpSha1Transform(dig);

    for (i = 0; i < SHA160LENGTH; i++,pcDigest += 4)
        Word2Bytes(&dig->m_auiBuf[i], pcDigest);
}


// *************  For customer NDS **************//

MS_BOOL MHal_HDMITx_HDCP_Get_BCaps(MS_U8 *u8bcaps)
{
    return (MHal_HDMITx_Rx74ReadByte(0x40, u8bcaps));
}

MS_BOOL MHal_HDMITx_HDCP_Get_BStatus(MS_U16 *u16bstatus)
{
    MS_U8 u8data1 = 0x0;
	MS_U8 u8data2 = 0x0;
    MS_BOOL ret = TRUE;

    if(!MHal_HDMITx_Rx74ReadByte(0x42, &u8data2) || !MHal_HDMITx_Rx74ReadByte(0x41, &u8data1))
        ret = FALSE;
    *u16bstatus = ((MS_U16) u8data2<< 8) | u8data1;
    return ret;
}

MS_BOOL MHal_HDMITx_HDCP_Get_BKSV(MS_U8 *u8bksv)
{
    MS_U8 i;
    MS_BOOL ret = TRUE;

    for(i=0; i<5; i++)
    {
        if(!MHal_HDMITx_Rx74ReadByte(0x00+i, u8bksv+i))
            ret = FALSE;
    }
    return ret;
}

void MHal_HDMITx_HDCP_SHA1_Transform(unsigned int *sha1, const MS_U8 *s)
{
    SHA1_DATA tdig;

    MHal_HDMITx_HdcpSha1Init(&tdig);
    // MS_U32 M[2], w[16]
    // w[0]=M[0];
    // w[1]=M[1];
    // w[2]=0x80000000;
    // w[3]=0;w[4]=0;w[5]=0;w[6]=0;w[7]=0;w[8]=0;w[9]=0;w[10]=0;w[11]=0;w[12]=0;w[13]=0;
    // w[14]=0;w[15]=0x00000040;
    memcpy(&tdig.m_aucIn[0], s, 8*sizeof(MS_U8)); // The first 8 bytes are copy from message
    tdig.m_aucIn[8] = 0x80; // append the bit "1" and K = 439 bits "0" to the message
    memset(&tdig.m_aucIn[9], 0, 54*sizeof(MS_U8));
    tdig.m_aucIn[63] = 0x40; // apppend length of message, 64 bytes

    _MHal_HDMITx_HdcpSha1Transform(&tdig);
    memcpy(sha1, &tdig.m_auiBuf[0], 5*sizeof(MS_U32));
    //printf("@@SRM - Trans Msg= %8x%8x%8x%8x%8x\r\n", tdig.m_auiBuf[0],tdig.m_auiBuf[1],tdig.m_auiBuf[2],tdig.m_auiBuf[3],tdig.m_auiBuf[4]);
}

// *************  end  **************//