HYL_OK3568_LINUX/external/rkupdate/RKImage.cpp

#include "RKImage.h"
#include "MD5Checksum.h"

extern int IsRK3308_Platform();
extern int Compatible_rk3308bs_loader();

DWORD CRKImage::GetVersion()
{
    return m_version;
}
DWORD CRKImage::GetMergeVersion()
{
    return m_mergeVersion;
}
STRUCT_RKTIME CRKImage::GetReleaseTime()
{
    return m_releaseTime;
}
ENUM_RKDEVICE_TYPE CRKImage::GetSupportDevice()
{
    return m_supportDevice;
}
ENUM_OS_TYPE CRKImage::GetOsType()
{
    UINT *pOsType;
    pOsType = (UINT *)&m_reserved[4];
    return (ENUM_OS_TYPE) * pOsType;
}
USHORT CRKImage::GetBackupSize()
{
    USHORT *pBackupSize;
    pBackupSize = (USHORT *)&m_reserved[12];
    return *pBackupSize;
}
DWORD CRKImage::GetBootOffset()
{
    return m_bootOffset;
}
DWORD CRKImage::GetBootSize()
{
    return m_bootSize;
}
DWORD CRKImage::GetFWOffset()
{
    return m_fwOffset;
}
long long CRKImage::GetFWSize()
{
    return m_fwSize;
}

FILE *CRKImage::GetFWFileHandle()
{
    return m_pFile;
}

char *CRKImage::GetFwPath()
{
    return m_imgPath;
}

bool CRKImage::Md5Check(long long nCheckSize)
{
    printf("In Md5Check\n");
    tstring strNewMd5 = _T("");
    strNewMd5 = CMD5Checksum::GetMD5(m_pFile, nCheckSize);
    if (strNewMd5.size() == 32)
    {
        BYTE newMd5[32];
        memcpy(newMd5, strNewMd5.c_str(), 32);
        int i, j;
        printf("New Md5:\n");
        for (i = 0; i < 2; i++)
        {
            for (j = 0; j < 16; j++)
            {
                printf("%02X ", newMd5[i * 16 + j]);
            }
            printf("\r\n");
        }
        printf("Old Md5:\n");
        for (i = 0; i < 2; i++)
        {
            for (j = 0; j < 16; j++)
            {
                printf("%02X ", m_md5[i * 16 + j]);
            }
            printf("\r\n");
        }
        if (memcmp(newMd5, m_md5, 32) != 0)
        {
            return false;
        }
        else
        {
            return true;
        }
    }
    else
    {
        return false;
    }
}

bool CRKImage::SaveBootFile(tstring filename)
{
    FILE *file = NULL;
    file = fopen(filename.c_str(), _T("wb+"));
    if (!file)
    {
        return false;
    }
    BYTE buffer[1024];
    DWORD dwBufferSize = 1024;
    DWORD dwBootSize = m_bootSize;
    DWORD dwReadSize;
    fseek(m_pFile, m_bootOffset, SEEK_SET);
    do
    {
        dwReadSize = (dwBootSize >= 1024) ? dwBufferSize : dwBootSize;
        size_t ret = fread(buffer, 1, dwReadSize, m_pFile);
        if (ret != dwReadSize)
        {
            printf("fread error: read:%d, req read:%d", ret, dwReadSize);
        }
        fwrite(buffer, 1, dwReadSize, file);
        dwBootSize -= dwReadSize;
    } while (dwBootSize > 0);
    fclose(file);
    return true;
}

bool CRKImage::SaveFWFile(tstring filename)
{
    FILE *file = NULL;
    file = fopen(filename.c_str(), _T("wb+"));
    if (!file)
    {
        return false;
    }
    BYTE buffer[1024];
    DWORD dwBufferSize = 1024;
    long long dwFWSize = m_fwSize;
    DWORD dwReadSize;
    fseeko(m_pFile, m_fwOffset, SEEK_SET);
    do
    {
        dwReadSize = (dwFWSize >= 1024) ? dwBufferSize : dwFWSize;
        size_t ret = fread(buffer, 1, dwReadSize, m_pFile);
        if (ret != dwReadSize)
        {
            printf("fread error: read:%d, req read:%d", ret, dwReadSize);
        }

        fwrite(buffer, 1, dwReadSize, file);
        dwFWSize -= dwReadSize;
    } while (dwFWSize > 0);
    fclose(file);
    return true;
}

bool CRKImage::GetData(long long dwOffset, DWORD dwSize, PBYTE lpBuffer)
{
    if (dwOffset < 0 || dwSize == 0)
    {
        return false;
    }
    if (dwOffset + dwSize > m_fileSize)
    {
        return false;
    }

    fseeko64(m_pFile, dwOffset, SEEK_SET);
    UINT uiActualRead;
    uiActualRead = fread(lpBuffer, 1, dwSize, m_pFile);
    if (dwSize != uiActualRead)
    {
        return false;
    }
    return true;
}
void CRKImage::GetReservedData(PBYTE &lpData, USHORT &usSize)
{
    lpData = m_reserved;
    usSize = IMAGE_RESERVED_SIZE;
}
int CRKImage::GetMd5Data(PBYTE &lpMd5, PBYTE &lpSignMd5)
{
    lpMd5 = m_md5;
    lpSignMd5 = m_signMd5;
    return m_signMd5Size;
}

CRKImage::CRKImage(tstring filename, bool &bCheck)
{
    Version.setContainer(this);
    Version.getter(&CRKImage::GetVersion);
    MergeVersion.setContainer(this);
    MergeVersion.getter(&CRKImage::GetMergeVersion);
    ReleaseTime.setContainer(this);
    ReleaseTime.getter(&CRKImage::GetReleaseTime);
    SupportDevice.setContainer(this);
    SupportDevice.getter(&CRKImage::GetSupportDevice);
    OsType.setContainer(this);
    OsType.getter(&CRKImage::GetOsType);
    BackupSize.setContainer(this);
    BackupSize.getter(&CRKImage::GetBackupSize);
    BootOffset.setContainer(this);
    BootOffset.getter(&CRKImage::GetBootOffset);
    BootSize.setContainer(this);
    BootSize.getter(&CRKImage::GetBootSize);
    FWOffset.setContainer(this);
    FWOffset.getter(&CRKImage::GetFWOffset);
    FWSize.setContainer(this);
    FWSize.getter(&CRKImage::GetFWSize);
    FwPath.setContainer(this);
    FwPath.getter(&CRKImage::GetFwPath);

    bool bDoMdb5Check = bCheck;
    struct stat64 statBuf;
    m_bootObject = NULL;
    m_pFile = NULL;

    m_signMd5Size = 0;
    memset(m_md5, 0, 32);
    memset(m_signMd5, 0, 256);

    tchar szName[256];
    _tcscpy(szName, filename.c_str());
    if (stat64(szName, &statBuf) < 0)
    {
        bCheck = false;
        printf("CRKImage : stat <%s> happen error.error_reason = %s\n", szName, strerror(errno));
        return;
    }
    if (S_ISDIR(statBuf.st_mode))
    {
        bCheck = false;
        printf("CRKImage : Error! stat mode is DIR\n");
        return;
    }
    m_fileSize = statBuf.st_size;
    memcpy(m_imgPath, szName, sizeof(szName));

    bool bOnlyBootFile = false;
    transform(filename.begin(), filename.end(), filename.begin(), (int(*)(int))tolower);
    if (filename.find(_T(".bin")) != tstring::npos)
    {
        bOnlyBootFile = true;
    }

    m_pFile = fopen(szName, "rb");
    if (!m_pFile)
    {
        bCheck = false;
        printf("CRKImage : fopen <%s> fail,will try use fopen64 \n", szName);

        m_pFile = fopen64(szName, "rb");
        if (!m_pFile)
        {
            bCheck = false;
            printf("CRKImage : fopen64 <%s> fail\n", szName);
            return;
        }
    }

    //code will be error if firmware is signed.md5 is not last 32 byte.
    //  fseeko(m_pFile,-32,SEEK_END);
    //  fread(m_md5,1,32,m_pFile);
    //  fseeko(m_pFile,0,SEEK_SET);
    //  if (!Md5Check())
    //  {
    //      bCheck = false;
    //      return;
    //  }

    int nMd5DataSize;
    long long ulFwSize;
    STRUCT_RKIMAGE_HEAD imageHead;
    if (!bOnlyBootFile)
    {
        fseeko64(m_pFile, 0, SEEK_SET);
        size_t ret = fread((PBYTE)(&imageHead), 1, sizeof(STRUCT_RKIMAGE_HEAD), m_pFile);
        if (ret != sizeof(STRUCT_RKIMAGE_HEAD))
        {
            return;
        }

        if (imageHead.uiTag != 0x57464B52)
        {
            bCheck = false;
            printf("CRKImage :Error! imageHead.uiTag != 0x57464B52\n");
            return;
        }
        if ((imageHead.reserved[14] == 'H') && (imageHead.reserved[15] == 'I'))
        {
            ulFwSize = *((DWORD *)(&imageHead.reserved[16]));
            ulFwSize <<= 32;
            ulFwSize += imageHead.dwFWOffset;
            ulFwSize += imageHead.dwFWSize;
        }
        else
        {
            ulFwSize = imageHead.dwFWOffset + imageHead.dwFWSize;
        }
        nMd5DataSize = GetImageSize() - ulFwSize;
        if (nMd5DataSize >= 160)
        {
            //sign image
            m_bSignFlag = true;
            m_signMd5Size = nMd5DataSize - 32;
            fseeko64(m_pFile, ulFwSize, SEEK_SET);
            size_t ret = fread(m_md5, 1, 32, m_pFile);
            if (ret != 32)
            {
                printf("%s:read error\n", __func__);
            }
            ret = fread(m_signMd5, 1, nMd5DataSize - 32, m_pFile);
            if (ret != nMd5DataSize - 32)
            {
                printf("%s :ret = %d\n", __func__, ret);
            }
        }
        else
        {
            fseeko64(m_pFile, -32, SEEK_END);
            size_t read = fread(m_md5, 1, 32, m_pFile);
            if (read != 32)
            {
                printf("%s: read error\n", __func__);
            }
        }
        if (bDoMdb5Check)
        {
            if (!Md5Check(ulFwSize))
            {
                printf("Md5Check update.img ulFwSize:%ld", ulFwSize);
                //bCheck = false;
                //return;
                bCheck = true;
            }
        }

        m_version = imageHead.dwVersion;
        m_mergeVersion = imageHead.dwMergeVersion;
        m_releaseTime.usYear = imageHead.stReleaseTime.usYear;
        m_releaseTime.ucMonth = imageHead.stReleaseTime.ucMonth;
        m_releaseTime.ucDay = imageHead.stReleaseTime.ucDay;
        m_releaseTime.ucHour = imageHead.stReleaseTime.ucHour;
        m_releaseTime.ucMinute = imageHead.stReleaseTime.ucMinute;
        m_releaseTime.ucSecond = imageHead.stReleaseTime.ucSecond;
        m_supportDevice = imageHead.emSupportChip;
        m_bootOffset = imageHead.dwBootOffset;
        m_bootSize = imageHead.dwBootSize;
        m_fwOffset = imageHead.dwFWOffset;
        m_fwSize = ulFwSize - m_fwOffset;

        memcpy(m_reserved, imageHead.reserved, IMAGE_RESERVED_SIZE);
    }
    else
    {
        m_bootOffset = 0;
        m_bootSize = m_fileSize;
    }

    PBYTE lpBoot;
    lpBoot = new BYTE[m_bootSize];
    fseeko64(m_pFile, m_bootOffset, SEEK_SET);
    size_t ret = fread(lpBoot, 1, m_bootSize, m_pFile);
    if (ret != m_bootSize)
    {
        printf("%s : read error\n", __func__);
    }
    bool bRet;
    m_bootObject = new CRKBoot(lpBoot, m_bootSize, bRet);
    if (!bRet)
    {
        bCheck = false;
        printf("CRKImage :Error! new CRKBoot fail!\n");
        return;
    }
    if (bOnlyBootFile)
    {
        m_supportDevice = m_bootObject->SupportDevice;
        UINT *pOsType;
        pOsType = (UINT *)&m_reserved[4];
        *pOsType = (UINT)RK_OS;
        fclose(m_pFile);
        m_pFile = NULL;
    }
    bCheck = true;
}
CRKImage::~CRKImage()
{
    if (m_pFile)
    {
        fclose(m_pFile);
        m_pFile = NULL;
    }
    if (m_bootObject)
    {
        delete m_bootObject;
        m_bootObject = NULL;
    }
}

long long CRKImage::GetImageSize()
{
    return m_fileSize;
}