Sweden-Number/libs/jxr/image/sys/strcodec.c

1252 lines
37 KiB
C

//*@@@+++@@@@******************************************************************
//
// Copyright © Microsoft Corp.
// All rights reserved.
//
// Redistribution and use in source and binary forms, with or without
// modification, are permitted provided that the following conditions are met:
//
// • Redistributions of source code must retain the above copyright notice,
// this list of conditions and the following disclaimer.
// • Redistributions in binary form must reproduce the above copyright notice,
// this list of conditions and the following disclaimer in the documentation
// and/or other materials provided with the distribution.
//
// THIS SOFTWARE IS PROVIDED BY THE COPYRIGHT HOLDERS AND CONTRIBUTORS "AS IS"
// AND ANY EXPRESS OR IMPLIED WARRANTIES, INCLUDING, BUT NOT LIMITED TO, THE
// IMPLIED WARRANTIES OF MERCHANTABILITY AND FITNESS FOR A PARTICULAR PURPOSE
// ARE DISCLAIMED. IN NO EVENT SHALL THE COPYRIGHT HOLDER OR CONTRIBUTORS BE
// LIABLE FOR ANY DIRECT, INDIRECT, INCIDENTAL, SPECIAL, EXEMPLARY, OR
// CONSEQUENTIAL DAMAGES (INCLUDING, BUT NOT LIMITED TO, PROCUREMENT OF
// SUBSTITUTE GOODS OR SERVICES; LOSS OF USE, DATA, OR PROFITS; OR BUSINESS
// INTERRUPTION) HOWEVER CAUSED AND ON ANY THEORY OF LIABILITY, WHETHER IN
// CONTRACT, STRICT LIABILITY, OR TORT (INCLUDING NEGLIGENCE OR OTHERWISE)
// ARISING IN ANY WAY OUT OF THE USE OF THIS SOFTWARE, EVEN IF ADVISED OF THE
// POSSIBILITY OF SUCH DAMAGE.
//
//*@@@---@@@@******************************************************************
#include "strcodec.h"
#include "perfTimer.h"
#ifdef MEM_TRACE
#define TRACE_MALLOC 1
#define TRACE_NEW 0
#define TRACE_HEAP 0
#include "memtrace.h"
#endif
//================================================================
// Quantization index tables
//================================================================
const int blkOffset[16] = {0, 64, 16, 80, 128, 192, 144, 208, 32, 96, 48, 112, 160, 224, 176, 240};
const int blkOffsetUV[4] = {0, 32, 16, 48};
const int blkOffsetUV_422[8] = {0, 64, 16, 80, 32, 96, 48, 112};
const int dctIndex[3][16] = { /** permutation matrix tailored to the transform, nothing to do with ZZS **/
{0,5,1,6, 10,12,8,14, 2,4,3,7, 9,13,11,15}, //AC 444
{0,5,1,6, 10,12,8,14, 2,4,3,7, 9,13,11,15}, //AC 420
{0,128,64,208, 32,240,48,224, 16,192,80,144, 112,176,96,160 }, //DC 444
};
//================================================================
// Color conversion index table
//================================================================
const U8 idxCC[16][16] =
{
{0x00, 0x01, 0x05, 0x04, 0x40, 0x41, 0x45, 0x44, 0x80, 0x81, 0x85, 0x84, 0xc0, 0xc1, 0xc5, 0xc4, },
{0x02, 0x03, 0x07, 0x06, 0x42, 0x43, 0x47, 0x46, 0x82, 0x83, 0x87, 0x86, 0xc2, 0xc3, 0xc7, 0xc6, },
{0x0a, 0x0b, 0x0f, 0x0e, 0x4a, 0x4b, 0x4f, 0x4e, 0x8a, 0x8b, 0x8f, 0x8e, 0xca, 0xcb, 0xcf, 0xce, },
{0x08, 0x09, 0x0d, 0x0c, 0x48, 0x49, 0x4d, 0x4c, 0x88, 0x89, 0x8d, 0x8c, 0xc8, 0xc9, 0xcd, 0xcc, },
{0x10, 0x11, 0x15, 0x14, 0x50, 0x51, 0x55, 0x54, 0x90, 0x91, 0x95, 0x94, 0xd0, 0xd1, 0xd5, 0xd4, },
{0x12, 0x13, 0x17, 0x16, 0x52, 0x53, 0x57, 0x56, 0x92, 0x93, 0x97, 0x96, 0xd2, 0xd3, 0xd7, 0xd6, },
{0x1a, 0x1b, 0x1f, 0x1e, 0x5a, 0x5b, 0x5f, 0x5e, 0x9a, 0x9b, 0x9f, 0x9e, 0xda, 0xdb, 0xdf, 0xde, },
{0x18, 0x19, 0x1d, 0x1c, 0x58, 0x59, 0x5d, 0x5c, 0x98, 0x99, 0x9d, 0x9c, 0xd8, 0xd9, 0xdd, 0xdc, },
{0x20, 0x21, 0x25, 0x24, 0x60, 0x61, 0x65, 0x64, 0xa0, 0xa1, 0xa5, 0xa4, 0xe0, 0xe1, 0xe5, 0xe4, },
{0x22, 0x23, 0x27, 0x26, 0x62, 0x63, 0x67, 0x66, 0xa2, 0xa3, 0xa7, 0xa6, 0xe2, 0xe3, 0xe7, 0xe6, },
{0x2a, 0x2b, 0x2f, 0x2e, 0x6a, 0x6b, 0x6f, 0x6e, 0xaa, 0xab, 0xaf, 0xae, 0xea, 0xeb, 0xef, 0xee, },
{0x28, 0x29, 0x2d, 0x2c, 0x68, 0x69, 0x6d, 0x6c, 0xa8, 0xa9, 0xad, 0xac, 0xe8, 0xe9, 0xed, 0xec, },
{0x30, 0x31, 0x35, 0x34, 0x70, 0x71, 0x75, 0x74, 0xb0, 0xb1, 0xb5, 0xb4, 0xf0, 0xf1, 0xf5, 0xf4, },
{0x32, 0x33, 0x37, 0x36, 0x72, 0x73, 0x77, 0x76, 0xb2, 0xb3, 0xb7, 0xb6, 0xf2, 0xf3, 0xf7, 0xf6, },
{0x3a, 0x3b, 0x3f, 0x3e, 0x7a, 0x7b, 0x7f, 0x7e, 0xba, 0xbb, 0xbf, 0xbe, 0xfa, 0xfb, 0xff, 0xfe, },
{0x38, 0x39, 0x3d, 0x3c, 0x78, 0x79, 0x7d, 0x7c, 0xb8, 0xb9, 0xbd, 0xbc, 0xf8, 0xf9, 0xfd, 0xfc, },
};
const U8 idxCC_420[8][8] =
{
{0x00, 0x01, 0x05, 0x04, 0x20, 0x21, 0x25, 0x24, },
{0x02, 0x03, 0x07, 0x06, 0x22, 0x23, 0x27, 0x26, },
{0x0a, 0x0b, 0x0f, 0x0e, 0x2a, 0x2b, 0x2f, 0x2e, },
{0x08, 0x09, 0x0d, 0x0c, 0x28, 0x29, 0x2d, 0x2c, },
{0x10, 0x11, 0x15, 0x14, 0x30, 0x31, 0x35, 0x34, },
{0x12, 0x13, 0x17, 0x16, 0x32, 0x33, 0x37, 0x36, },
{0x1a, 0x1b, 0x1f, 0x1e, 0x3a, 0x3b, 0x3f, 0x3e, },
{0x18, 0x19, 0x1d, 0x1c, 0x38, 0x39, 0x3d, 0x3c, },
};
/*************************************************************************
gGDISignature
*************************************************************************/
const Char gGDISignature[] = {'W', 'M', 'P', 'H', 'O', 'T', 'O', '\0'};
// check if enough memory allocated for the image buffer
Int checkImageBuffer(CWMImageStrCodec * pSC, size_t cWidth, size_t cRows)
{
const BITDEPTH_BITS bd = pSC->WMISCP.bYUVData ?
BD_32S : pSC->WMII.bdBitDepth;
const COLORFORMAT cf = pSC->WMISCP.bYUVData ?
pSC->m_param.cfColorFormat : pSC->WMII.cfColorFormat;
size_t cBytes;
Bool bLessThan64Bit = sizeof(void *) < 8;
if(cf == YUV_420)
cRows = (cRows + 1) / 2;
if(cRows > pSC->WMIBI.cLine)
return ICERR_ERROR;
if(cf == YUV_422 || cf == YUV_420)
cWidth = (cWidth + 1) / 2;
if (bLessThan64Bit && (cWidth >> ((sizeof(size_t) * 8 - 5)))) {
/** potential overflow - 32 bit pointers insufficient to address cache **/
/** this uses 2 macroblock row constraint, which is tighter than ensuring rollover doesn't occur below **/
return ICERR_ERROR;
}
cBytes = pSC->WMISCP.bYUVData ? cWidth * sizeof(PixelI) *
(cf == YUV_420 ? 6 : (cf == YUV_422 ? 4 : (cf == YUV_444 ? 3 : 1))) :
(bd == BD_1 ? (pSC->WMII.cBitsPerUnit * cWidth + 7) / 8 : (pSC->WMII.cBitsPerUnit + 7) / 8 * cWidth);
return (cBytes > pSC->WMIBI.cbStride ? ICERR_ERROR : ICERR_OK);
}
Void writeQPIndex(BitIOInfo * pIO, U8 uiIndex, U32 cBits)
{
if(uiIndex == 0)
putBit16(pIO, 1, 1); // default QP
else{
putBit16(pIO, 0, 1); // non default QP
putBit16(pIO, uiIndex - 1, cBits);
}
}
U8 readQPIndex(BitIOInfo * pIO, U32 cBits)
{
if(getBit16(pIO, 1))
return 0; // default QP
return (U8) getBit16(pIO, cBits) + 1;
}
Void getTilePos(CWMImageStrCodec* pSC, size_t mbX, size_t mbY)
{
if(mbX == 0){ // left image boundary
pSC->cTileColumn = 0;
}
else if(pSC->cTileColumn < pSC->WMISCP.cNumOfSliceMinus1V && mbX == pSC->WMISCP.uiTileX[pSC->cTileColumn + 1]){ // left tile boundary
pSC->cTileColumn ++;
}
if(mbY == 0){ // top image boundary
pSC->cTileRow = 0;
}
else if(pSC->cTileRow < pSC->WMISCP.cNumOfSliceMinus1H && mbY == pSC->WMISCP.uiTileY[pSC->cTileRow + 1]){ // top tile boundary
pSC->cTileRow ++;
}
pSC->m_bCtxLeft = (mbX == pSC->WMISCP.uiTileX[pSC->cTileColumn]);
pSC->m_bCtxTop = (mbY == pSC->WMISCP.uiTileY[pSC->cTileRow]);
pSC->m_bResetContext = pSC->m_bResetRGITotals = (((mbX - pSC->WMISCP.uiTileX[pSC->cTileColumn]) & 0xf) == 0);
if(pSC->cTileColumn == pSC->WMISCP.cNumOfSliceMinus1V){ // last tile column
if(mbX + 1 == pSC->cmbWidth)
pSC->m_bResetContext = TRUE;
}
else if(mbX + 1 == pSC->WMISCP.uiTileX[pSC->cTileColumn + 1])
pSC->m_bResetContext = TRUE;
}
//================================================================
// utility functions for 2 macro block rows
//================================================================
Void initMRPtr(CWMImageStrCodec* pSC)
{
size_t j, jend = (pSC->m_pNextSC != NULL);
for (j = 0; j <= jend; j++) {
memcpy (pSC->p0MBbuffer, pSC->a0MBbuffer, sizeof (pSC->p0MBbuffer));
memcpy (pSC->p1MBbuffer, pSC->a1MBbuffer, sizeof (pSC->p1MBbuffer));
pSC = pSC->m_pNextSC;
}
}
Void advanceMRPtr(CWMImageStrCodec* pSC)
{
const COLORFORMAT cf = pSC->m_param.cfColorFormat;
const int cpChroma = cblkChromas[cf] * 16;
size_t i, j, jend = (pSC->m_pNextSC != NULL);
assert(pSC->m_bSecondary == FALSE);
for (j = 0; j <= jend; j++) {
int cpStride = 16 * 16;
for (i = 0; i < pSC->m_param.cNumChannels; i++) {
pSC->pPlane[i] = pSC->p0MBbuffer[i];
pSC->p0MBbuffer[i] += cpStride;
pSC->p1MBbuffer[i] += cpStride;
cpStride = cpChroma;
}
pSC = pSC->m_pNextSC;
}
}
/* advance to next MB row */
Void advanceOneMBRow(CWMImageStrCodec *pSC)
{
size_t i, j, jend = (pSC->m_pNextSC != NULL);
CWMIPredInfo *pPredInfo;
for (j = 0; j <= jend; j++) {
for(i = 0; i < pSC->m_param.cNumChannels; i ++){ // swap current row and previous row
pPredInfo = pSC->PredInfo[i];
pSC->PredInfo[i] = pSC->PredInfoPrevRow[i];
pSC->PredInfoPrevRow[i] = pPredInfo;
}
pSC = pSC->m_pNextSC;
}
}
Void swapMRPtr(CWMImageStrCodec* pSC)
{
PixelI *pTemp[MAX_CHANNELS];
size_t j, jend = (pSC->m_pNextSC != NULL);
for (j = 0; j <= jend; j++) {
memcpy (pTemp, pSC->a0MBbuffer, sizeof (pSC->a0MBbuffer));
memcpy (pSC->a0MBbuffer, pSC->a1MBbuffer, sizeof (pSC->a0MBbuffer));
memcpy (pSC->a1MBbuffer, pTemp, sizeof (pSC->a0MBbuffer));
pSC = pSC->m_pNextSC;
}
}
//================================================================
// Empty function to fill slot
//================================================================
Int IDPEmpty(CWMImageStrCodec* pSC)
{
UNREFERENCED_PARAMETER( pSC );
return ICERR_OK;
}
ERR WMPAlloc(void** ppv, size_t cb)
{
*ppv = calloc(1, cb);
return *ppv ? WMP_errSuccess : WMP_errOutOfMemory;
}
ERR WMPFree(void** ppv)
{
if (*ppv)
{
free(*ppv);
*ppv = NULL;
}
return WMP_errSuccess;
}
//================================================================
// Streaming I/O functions
//================================================================
ERR CreateWS_File(struct WMPStream** ppWS, const char* szFilename, const char* szMode)
{
ERR err = WMP_errSuccess;
struct WMPStream* pWS = NULL;
Call(WMPAlloc((void** )ppWS, sizeof(**ppWS)));
pWS = *ppWS;
pWS->Close = CloseWS_File;
pWS->EOS = EOSWS_File;
pWS->Read = ReadWS_File;
pWS->Write = WriteWS_File;
//pWS->GetLine = GetLineWS_File;
pWS->SetPos = SetPosWS_File;
pWS->GetPos = GetPosWS_File;
#ifdef WIN32
FailIf(0 != fopen_s(&pWS->state.file.pFile, szFilename, szMode), WMP_errFileIO);
#else
pWS->state.file.pFile = fopen(szFilename, szMode);
FailIf(NULL == pWS->state.file.pFile, WMP_errFileIO);
#endif
Cleanup:
return err;
}
ERR CloseWS_File(struct WMPStream** ppWS)
{
ERR err = WMP_errSuccess;
struct WMPStream* pWS = *ppWS;
fclose(pWS->state.file.pFile);
Call(WMPFree((void**)ppWS));
Cleanup:
return err;
}
Bool EOSWS_File(struct WMPStream* pWS)
{
return feof(pWS->state.file.pFile);
}
ERR ReadWS_File(struct WMPStream* pWS, void* pv, size_t cb)
{
// ERR err = WMP_errSuccess;
return (fread(pv, cb, 1, pWS->state.file.pFile) == 1) ? WMP_errSuccess : WMP_errFileIO;
}
ERR WriteWS_File(struct WMPStream* pWS, const void* pv, size_t cb)
{
ERR err = WMP_errSuccess;
if(0 != cb)
{
FailIf(1 != fwrite(pv, cb, 1, pWS->state.file.pFile), WMP_errFileIO);
}
Cleanup:
return err;
}
ERR SetPosWS_File(struct WMPStream* pWS, size_t offPos)
{
ERR err = WMP_errSuccess;
FailIf(0 != fseek(pWS->state.file.pFile, (long)offPos, SEEK_SET), WMP_errFileIO);
Cleanup:
return err;
}
ERR GetPosWS_File(struct WMPStream* pWS, size_t* poffPos)
{
ERR err = WMP_errSuccess;
long lOff = 0;
FailIf(-1 == (lOff = ftell(pWS->state.file.pFile)), WMP_errFileIO);
*poffPos = (size_t)lOff;
Cleanup:
return err;
}
//----------------------------------------------------------------
ERR CreateWS_Memory(struct WMPStream** ppWS, void* pv, size_t cb)
{
ERR err = WMP_errSuccess;
struct WMPStream* pWS = NULL;
Call(WMPAlloc((void** )ppWS, sizeof(**ppWS)));
pWS = *ppWS;
pWS->state.buf.pbBuf = pv;
pWS->state.buf.cbBuf = cb;
pWS->state.buf.cbCur = 0;
pWS->Close = CloseWS_Memory;
pWS->EOS = EOSWS_Memory;
pWS->Read = ReadWS_Memory;
pWS->Write = WriteWS_Memory;
pWS->SetPos = SetPosWS_Memory;
pWS->GetPos = GetPosWS_Memory;
Cleanup:
return err;
}
ERR CloseWS_Memory(struct WMPStream** ppWS)
{
ERR err = WMP_errSuccess;
Call(WMPFree((void**)ppWS));
Cleanup:
return err;
}
Bool EOSWS_Memory(struct WMPStream* pWS)
{
return pWS->state.buf.cbBuf <= pWS->state.buf.cbCur;
}
ERR ReadWS_Memory(struct WMPStream* pWS, void* pv, size_t cb)
{
ERR err = WMP_errSuccess;
// FailIf(pWS->state.buf.cbBuf < pWS->state.buf.cbCur, WMP_errBufferOverflow);
if(pWS->state.buf.cbBuf < pWS->state.buf.cbCur)
return err;
FailIf(pWS->state.buf.cbCur + cb < pWS->state.buf.cbCur, WMP_errBufferOverflow);
if (pWS->state.buf.cbBuf < pWS->state.buf.cbCur + cb)
{
cb = pWS->state.buf.cbBuf - pWS->state.buf.cbCur;
}
memcpy(pv, pWS->state.buf.pbBuf + pWS->state.buf.cbCur, cb);
pWS->state.buf.cbCur += cb;
Cleanup:
return err;
}
ERR WriteWS_Memory(struct WMPStream* pWS, const void* pv, size_t cb)
{
ERR err = WMP_errSuccess;
FailIf(pWS->state.buf.cbCur + cb < pWS->state.buf.cbCur, WMP_errBufferOverflow);
FailIf(pWS->state.buf.cbBuf < pWS->state.buf.cbCur + cb, WMP_errBufferOverflow);
memcpy(pWS->state.buf.pbBuf + pWS->state.buf.cbCur, pv, cb);
pWS->state.buf.cbCur += cb;
Cleanup:
return err;
}
ERR SetPosWS_Memory(struct WMPStream* pWS, size_t offPos)
{
ERR err = WMP_errSuccess;
//While the following condition is possibly useful, failure occurs
//at the end of a file since packets beyond the end may be accessed
//FailIf(pWS->state.buf.cbBuf < offPos, WMP_errBufferOverflow);
pWS->state.buf.cbCur = offPos;
//Cleanup:
return err;
}
ERR GetPosWS_Memory(struct WMPStream* pWS, size_t* poffPos)
{
*poffPos = pWS->state.buf.cbCur;
return WMP_errSuccess;
}
//=================================================================
// Linked list based WMPStream
// - for indefinite size, multiple stream out
// - reads not supported in this mode
//=================================================================
ERR CreateWS_List(struct WMPStream** ppWS)
{
ERR err = WMP_errSuccess;
struct WMPStream* pWS = NULL;
Call(WMPAlloc((void** )ppWS, sizeof(**ppWS) + PACKETLENGTH + sizeof(void *)));
pWS = *ppWS;
pWS->state.buf.pbBuf = (U8 *)pWS + sizeof(**ppWS) + sizeof(void *); // first buffer points here
memset(pWS->state.buf.pbBuf - sizeof(void *), 0, sizeof(void *));
pWS->state.buf.cbBuf = PACKETLENGTH;
pWS->state.buf.cbCur = 0;
pWS->state.buf.cbBufCount = 0;
pWS->Close = CloseWS_List;
pWS->EOS = NULL; // doesn't get called
pWS->Read = ReadWS_List;
pWS->Write = WriteWS_List;
pWS->SetPos = SetPosWS_List;
pWS->GetPos = GetPosWS_List;
//printf ("create buffer %d: %x\n", pWS->state.buf.cbBufCount, pWS->state.buf.pbBuf);
Cleanup:
return err;
}
ERR CloseWS_List(struct WMPStream** ppWS)
{
ERR err = WMP_errSuccess;
if (ppWS) {
U8 *pBuf = (U8 *)(ppWS[0] + 1); // pointer to buffer
U8 *pNext = (U8 *)(((void **)pBuf)[0]);
while (pNext) {
//struct WMPStream *pWS = ppWS[0];
pBuf = pNext;
pNext = (U8 *)(((void **)(pBuf))[0]);
//printf ("delete buffer %x\n", pBuf);
Call(WMPFree((void**)&pBuf));
}
}
Call(WMPFree((void**)ppWS));
Cleanup:
return err;
}
ERR ReadWS_List(struct WMPStream* pWS, void* pv, size_t cb)
{
ERR err = WMP_errSuccess;
FailIf(pWS->state.buf.cbCur + cb < pWS->state.buf.cbCur, WMP_errBufferOverflow);
if (pWS->state.buf.cbBuf < pWS->state.buf.cbCur + PACKETLENGTH * pWS->state.buf.cbBufCount + cb)
{
cb = pWS->state.buf.cbBuf - pWS->state.buf.cbCur - PACKETLENGTH * pWS->state.buf.cbBufCount;
}
while (cb) {
size_t cl = PACKETLENGTH - pWS->state.buf.cbCur;
if (cl > cb)
cl = cb;
memcpy(pv, pWS->state.buf.pbBuf + pWS->state.buf.cbCur, cl);
pWS->state.buf.cbCur += cl;
pv = (void *)((U8 *)pv + cl);
cb -= cl;
if (pWS->state.buf.cbCur == PACKETLENGTH) {
pWS->state.buf.pbBuf = (U8 *)((void **)(pWS->state.buf.pbBuf - sizeof(void *)))[0] + sizeof(void *);
pWS->state.buf.cbCur = 0;
pWS->state.buf.cbBufCount++;
//printf ("read buffer %d: %x\n", pWS->state.buf.cbBufCount, pWS->state.buf.pbBuf);
}
}
Cleanup:
return err;
}
ERR WriteWS_List(struct WMPStream* pWS, const void* pv, size_t cb)
{
ERR err = WMP_errSuccess;
FailIf(pWS->state.buf.cbCur + cb < pWS->state.buf.cbCur, WMP_errBufferOverflow);
FailIf(pWS->state.buf.cbBuf < pWS->state.buf.cbCur + cb, WMP_errBufferOverflow);
while (cb) {
size_t cl = PACKETLENGTH - pWS->state.buf.cbCur;
if (cl > cb)
cl = cb;
memcpy(pWS->state.buf.pbBuf + pWS->state.buf.cbCur, pv, cl);
pWS->state.buf.cbCur += cl;
pv = (const void *)((U8 *)pv + cl);
cb -= cl;
if (pWS->state.buf.cbCur == PACKETLENGTH) { // allocate next packet in list
U8 *pBuf = NULL;
void **pPtrLoc = (void **)(pWS->state.buf.pbBuf - sizeof(void *));
Call(WMPAlloc((void **)&pBuf, PACKETLENGTH + sizeof(void *)));
pPtrLoc[0] = (void *)pBuf;
pWS->state.buf.pbBuf = pBuf + sizeof(void *);
pWS->state.buf.cbBuf += PACKETLENGTH;
memset(pBuf, 0, sizeof(void *));
pWS->state.buf.cbCur = 0;
pWS->state.buf.cbBufCount++;
//printf ("create buffer %d: %x\n", pWS->state.buf.cbBufCount, pWS->state.buf.pbBuf);
}
}
Cleanup:
return err;
}
ERR SetPosWS_List(struct WMPStream* pWS, size_t offPos)
{
ERR err = WMP_errSuccess;
// get the first buffer
U8 *pBuf = (U8 *)(pWS + 1); // pointer to buffer
pWS->state.buf.cbCur = 0;
pWS->state.buf.cbBufCount = 0;
while (offPos >= PACKETLENGTH && pBuf != NULL) {
pBuf = (U8 *)(((void **)pBuf)[0]);
offPos -= PACKETLENGTH;
pWS->state.buf.cbBufCount++;
}
if (pBuf == NULL)
goto Cleanup;
pWS->state.buf.cbCur = offPos;
pWS->state.buf.pbBuf = pBuf + sizeof(void *);
//printf ("seek buffer %d: %x\n", pWS->state.buf.cbBufCount, pWS->state.buf.pbBuf);
Cleanup:
return err;
}
ERR GetPosWS_List(struct WMPStream* pWS, size_t* poffPos)
{
*poffPos = pWS->state.buf.cbCur + PACKETLENGTH * pWS->state.buf.cbBufCount;
return WMP_errSuccess;
}
//================================================================
// Simple BitIO access functions
//================================================================
// init SimpleBitIO
ERR attach_SB(SimpleBitIO* pSB, struct WMPStream* pWS)
{
pSB->pWS = pWS;
pSB->cbRead = 0;
pSB->bAccumulator = 0;
pSB->cBitLeft = 0;
return WMP_errSuccess;
}
// extract upto 32bit from input stream
U32 getBit32_SB(SimpleBitIO* pSB, U32 cBits)
{
U32 rc = 0;
while (pSB->cBitLeft < cBits)
{
rc <<= pSB->cBitLeft;
rc |= pSB->bAccumulator >> (8 - pSB->cBitLeft);
cBits -= pSB->cBitLeft;
pSB->pWS->Read(pSB->pWS, &pSB->bAccumulator, 1);
pSB->cbRead++;
pSB->cBitLeft = 8;
}
rc <<= cBits;
rc |= pSB->bAccumulator >> (8 - cBits);
pSB->bAccumulator <<= cBits;
pSB->cBitLeft -= cBits;
return rc;
}
// ignore input to byte boundary
Void flushToByte_SB(SimpleBitIO* pSB)
{
pSB->bAccumulator = 0;
pSB->cBitLeft = 0;
}
// return read byte count
U32 getByteRead_SB(SimpleBitIO* pSB)
{
return pSB->cbRead;
}
ERR detach_SB(SimpleBitIO* pSB)
{
assert(0 == pSB->cBitLeft);
pSB->pWS = NULL;
return WMP_errSuccess;
}
//================================================================
// Memory access functions
//================================================================
#if (defined(WIN32) && !defined(UNDER_CE)) || (defined(UNDER_CE) && defined(_ARM_))
// WinCE ARM and Desktop x86
#else
// other platform
#ifdef _BIG__ENDIAN_
#define _byteswap_ulong(x) (x)
#else // _BIG__ENDIAN_
U32 _byteswap_ulong(U32 bits)
{
U32 r = (bits & 0xffu) << 24;
r |= (bits << 8) & 0xff0000u;
r |= ((bits >> 8) & 0xff00u);
r |= ((bits >> 24) & 0xffu);
return r;
}
#endif // _BIG__ENDIAN_
#endif
U32 load4BE(void* pv)
{
#ifdef _BIG__ENDIAN_
return (*(U32*)pv);
#else // _BIG__ENDIAN_
#if defined(_M_IA64) || defined(_ARM_)
U32 v;
v = ((U16 *) pv)[0];
v |= ((U32)((U16 *) pv)[1]) << 16;
return _byteswap_ulong(v);
#else // _M_IA64
return _byteswap_ulong(*(U32*)pv);
#endif // _M_IA64
#endif // _BIG__ENDIAN_
}
#define LOAD16 load4BE
#ifdef _BIG__ENDIAN_
#define WRITESWAP_ENDIAN(a) ((a)>>16)
#else // _BIG__ENDIAN_
#define WRITESWAP_ENDIAN(a) _byteswap_ulong(a)
#endif // _BIG__ENDIAN_
//================================================================
// Bit I/O functions
//================================================================
Int allocateBitIOInfo(CWMImageStrCodec* pSC)
{
U32 cNumBitIO;
SUBBAND sbSubband = pSC->WMISCP.sbSubband;
pSC->cSB = (sbSubband == SB_DC_ONLY ? 1 : (sbSubband == SB_NO_HIGHPASS ? 2 : (sbSubband == SB_NO_FLEXBITS ? 3 : 4)));
// # of additional BitIOs other than pSC->pIOHeader
if (!pSC->m_param.bIndexTable) { // pure streaming mode, no index table, no additional BitIO!
assert (pSC->WMISCP.bfBitstreamFormat == SPATIAL && pSC->WMISCP.cNumOfSliceMinus1H + pSC->WMISCP.cNumOfSliceMinus1V == 0);
cNumBitIO = 0;
}
else if(pSC->WMISCP.bfBitstreamFormat == SPATIAL)
cNumBitIO = pSC->WMISCP.cNumOfSliceMinus1V + 1;
else
cNumBitIO = (pSC->WMISCP.cNumOfSliceMinus1V + 1) * pSC->cSB;
if(cNumBitIO > MAX_TILES * 4)
return ICERR_ERROR;
// allocate additional BitIos
if(cNumBitIO > 0){
U32 i = 0;
size_t cb = sizeof(BitIOInfo) * cNumBitIO + (PACKETLENGTH * 4 - 1) + PACKETLENGTH * 4 * cNumBitIO;
U8* pb = (U8*)malloc(cb);
if (NULL == pb) return ICERR_ERROR;
memset(pb, 0, cb);
pSC->m_ppBitIO = (BitIOInfo**)pb;
pb += sizeof(BitIOInfo) * cNumBitIO;
pb = (U8*)ALIGNUP(pb, PACKETLENGTH * 4) + PACKETLENGTH * 2;
for (i = 0; i < cNumBitIO; ++i){
pSC->m_ppBitIO[i] = (BitIOInfo*)pb;
pb += PACKETLENGTH * 4;
}
// allocate index table
if(cNumBitIO > MAX_TILES * 4 || pSC->WMISCP.cNumOfSliceMinus1H >= MAX_TILES)
return ICERR_ERROR;
pSC->pIndexTable = malloc(cNumBitIO * (pSC->WMISCP.cNumOfSliceMinus1H + 1) * sizeof(size_t));
if(NULL == pSC->pIndexTable) return ICERR_ERROR;
}
pSC->cNumBitIO = cNumBitIO;
return ICERR_OK;
}
Int setBitIOPointers(CWMImageStrCodec* pSC)
{
if(pSC->cNumBitIO > 0){
U32 i;
for(i = 0; i <= pSC->WMISCP.cNumOfSliceMinus1V; i ++){
CCodingContext * pContext = &pSC->m_pCodingContext[i];
if(pSC->WMISCP.bfBitstreamFormat == SPATIAL){
pContext->m_pIODC = pContext->m_pIOLP = pContext->m_pIOAC = pContext->m_pIOFL = pSC->m_ppBitIO[i];
}
else{
U32 j = pSC->cSB;
pContext->m_pIODC = pSC->m_ppBitIO[i * j];
if(j > 1)
pContext->m_pIOLP = pSC->m_ppBitIO[i * j + 1];
if(j > 2)
pContext->m_pIOAC = pSC->m_ppBitIO[i * j + 2];
if(j > 3)
pContext->m_pIOFL = pSC->m_ppBitIO[i * j + 3];
}
}
}
else{ // streamimg mode
CCodingContext * pContext = &pSC->m_pCodingContext[0];
pContext->m_pIODC = pContext->m_pIOLP = pContext->m_pIOAC = pContext->m_pIOFL = pSC->pIOHeader;
}
return ICERR_OK;
}
Int allocateTileInfo(CWMImageStrCodec * pSC)
{
size_t i;
if(pSC->WMISCP.cNumOfSliceMinus1V >= MAX_TILES)
return ICERR_ERROR;
pSC->pTile = (CWMITile *)malloc((pSC->WMISCP.cNumOfSliceMinus1V + 1) * sizeof(CWMITile));
if(pSC->pTile == NULL)
return ICERR_ERROR;
memset(pSC->pTile, 0, (pSC->WMISCP.cNumOfSliceMinus1V + 1) * sizeof(CWMITile));
for(i = 0; i <= pSC->WMISCP.cNumOfSliceMinus1V; i ++)
pSC->pTile[i].cNumQPHP = pSC->pTile[i].cNumQPLP = 1, pSC->pTile[i].cBitsHP = pSC->pTile[i].cBitsLP = 0;
return ICERR_OK;
}
Void freeTileInfo(CWMImageStrCodec * pSC)
{
size_t iTile;
if((pSC->m_param.uQPMode & 1) != 0) // not DC uniform
for(iTile = 0; iTile <= pSC->WMISCP.cNumOfSliceMinus1V; iTile ++)
freeQuantizer(pSC->pTile[iTile].pQuantizerDC);
else
freeQuantizer(pSC->pTile[0].pQuantizerDC);
if(pSC->WMISCP.sbSubband != SB_DC_ONLY)
if((pSC->m_param.uQPMode & 2) != 0) // not LP uniform
for(iTile = 0; iTile <= pSC->WMISCP.cNumOfSliceMinus1V; iTile ++)
freeQuantizer(pSC->pTile[iTile].pQuantizerLP);
else
freeQuantizer(pSC->pTile[0].pQuantizerLP);
if(pSC->WMISCP.sbSubband != SB_DC_ONLY && pSC->WMISCP.sbSubband != SB_NO_HIGHPASS)
if((pSC->m_param.uQPMode & 4) != 0) // not HP uniform
for(iTile = 0; iTile <= pSC->WMISCP.cNumOfSliceMinus1V; iTile ++)
freeQuantizer(pSC->pTile[iTile].pQuantizerHP);
else
freeQuantizer(pSC->pTile[0].pQuantizerHP);
if(pSC->pTile != NULL)
free(pSC->pTile);
}
Int allocateQuantizer(CWMIQuantizer * pQuantizer[MAX_CHANNELS], size_t cChannel, size_t cQP)
{
size_t iCh;
if(cQP > 16 || cChannel > MAX_CHANNELS)
return ICERR_ERROR;
pQuantizer[0] = (CWMIQuantizer *)malloc(cQP * sizeof(CWMIQuantizer) * cChannel);
if(pQuantizer[0] == NULL)
return ICERR_ERROR;
for(iCh = 1; iCh < cChannel; iCh ++)
pQuantizer[iCh] = pQuantizer[iCh - 1] + cQP;
return ICERR_OK;
}
Void freeQuantizer(CWMIQuantizer * pQuantizer[MAX_CHANNELS])
{
if(pQuantizer[0] != NULL)
free(pQuantizer[0]);
}
Void formatQuantizer(CWMIQuantizer * pQuantizer[MAX_CHANNELS], U8 cChMode, size_t cCh, size_t iPos, Bool bShiftedUV,
Bool bScaledArith)
{
size_t iCh;
for(iCh = 0; iCh < cCh; iCh ++){
if(iCh > 0)
if(cChMode == 0) // uniform
pQuantizer[iCh][iPos] = pQuantizer[0][iPos];
else if(cChMode == 1) // mixed
pQuantizer[iCh][iPos] = pQuantizer[1][iPos];
remapQP(pQuantizer[iCh] + iPos, (iCh > 0 && bShiftedUV == TRUE) ? SHIFTZERO - 1 : SHIFTZERO, bScaledArith);
}
}
Void setUniformQuantizer(CWMImageStrCodec * pSC, size_t sb)
{
size_t iCh, iTile;
for(iCh = 0; iCh < pSC->m_param.cNumChannels; iCh ++)
for(iTile = 1; iTile <= pSC->WMISCP.cNumOfSliceMinus1V; iTile ++)
if(sb == 0) // DC
pSC->pTile[iTile].pQuantizerDC[iCh] = pSC->pTile[0].pQuantizerDC[iCh];
else if(sb == 1) // LP
pSC->pTile[iTile].pQuantizerLP[iCh] = pSC->pTile[0].pQuantizerLP[iCh];
else // HP
pSC->pTile[iTile].pQuantizerHP[iCh] = pSC->pTile[0].pQuantizerHP[iCh];
}
Void useDCQuantizer(CWMImageStrCodec * pSC, size_t iTile)
{
size_t iCh;
for(iCh = 0; iCh < pSC->m_param.cNumChannels; iCh ++)
pSC->pTile[iTile].pQuantizerLP[iCh][0] = *pSC->pTile[iTile].pQuantizerDC[iCh];
}
Void useLPQuantizer(CWMImageStrCodec * pSC, size_t cQP, size_t iTile)
{
size_t iCh, iQP;
for(iCh = 0; iCh < pSC->m_param.cNumChannels; iCh ++)
for(iQP = 0; iQP < cQP; iQP ++)
pSC->pTile[iTile].pQuantizerHP[iCh][iQP] = pSC->pTile[iTile].pQuantizerLP[iCh][iQP];
}
U8 dquantBits(U8 cQP)
{
return (cQP < 2 ? 0 : (cQP < 4 ? 1 : (cQP < 6 ? 2 : (cQP < 10 ? 3 : 4))));
}
#ifndef ARMOPT_BITIO
U32 peekBit16(BitIOInfo* pIO, U32 cBits)
{
PEEKBIT16(pIO, cBits);
}
U32 flushBit16(BitIOInfo* pIO, U32 cBits)
{
FLUSHBIT16(pIO, cBits);
}
U32 getBit16(BitIOInfo* pIO, U32 cBits)
{
U32 uiRet = peekBit16(pIO, cBits);
flushBit16(pIO, cBits);
return uiRet;
}
U32 getBool16(BitIOInfo* pIO)
{
U32 uiRet = peekBit16(pIO, 1);
flushBit16(pIO, 1);
return uiRet;
}
/** this function returns cBits if zero is read, or a signed value if first cBits are not all zero **/
I32 getBit16s(BitIOInfo* pIO, U32 cBits)
{
U32 uiRet = peekBit16(pIO, cBits + 1);
if (uiRet < 2) {
flushBit16(pIO, cBits);
return 0;
}
else {
flushBit16(pIO, cBits + 1);
if (uiRet & 1)
return (-(I32)(uiRet >> 1));
else
return (I32)(uiRet >> 1);
}
}
U32 getBit32(BitIOInfo* pIO, U32 cBits)
{
U32 uiRet = 0;
assert(0 <= (I32)cBits && cBits <= 32);
if (16 < cBits)
{
uiRet = getBit16(pIO, 16);
cBits -= 16;
uiRet <<= cBits;
}
uiRet |= getBit16(pIO, cBits);
return uiRet;
}
U32 flushToByte(BitIOInfo* pIO)
{
return flushBit16(pIO, (16 - pIO->cBitsUsed) & 7);
}
#endif // ARMOPT_BITIO
//----------------------------------------------------------------
Void putBit16z(BitIOInfo* pIO, U32 uiBits, U32 cBits)
{
assert(cBits <= 16);
assert(0 == uiBits >> cBits);
pIO->uiAccumulator = (pIO->uiAccumulator << cBits) | uiBits;
pIO->cBitsUsed += cBits;
*(U16*)pIO->pbCurrent = (U16)WRITESWAP_ENDIAN(pIO->uiAccumulator << (32 - pIO->cBitsUsed));
pIO->pbCurrent = MASKPTR(pIO->pbCurrent + ((pIO->cBitsUsed >> 3) & 2), pIO->iMask);
pIO->cBitsUsed &= 16 - 1;
}
Void putBit16(BitIOInfo* pIO, U32 uiBits, U32 cBits)
{
assert(cBits <= 16);
uiBits &= ~(-1 << cBits);
putBit16z(pIO, uiBits, cBits);
}
Void putBit32(BitIOInfo* pIO, U32 uiBits, U32 cBits)
{
assert(0 <= (I32)cBits && cBits <= 32);
if (16 < cBits)
{
putBit16(pIO, uiBits >> (cBits - 16), 16);
cBits -= 16;
}
putBit16(pIO, uiBits, cBits);
}
Void fillToByte(BitIOInfo* pIO)
{
putBit16z(pIO, 0, (16 - pIO->cBitsUsed) & 7);
}
//----------------------------------------------------------------
U32 getBit16_S(CWMImageStrCodec* pSC, BitIOInfo* pIO, U32 cBits)
{
U32 rc = getBit16(pIO, cBits);
readIS_L1(pSC, pIO);
return rc;
}
U32 putBit16_S(CWMImageStrCodec* pSC, BitIOInfo* pIO, U32 uiBits, U32 cBits)
{
putBit16(pIO, uiBits, cBits);
writeIS_L1(pSC, pIO);
return 0;
}
//----------------------------------------------------------------
// Query buffered data size held in BitIOInfo
// Write() for Enc, Read() for Dec
//----------------------------------------------------------------
U32 getSizeRead(BitIOInfo* pIO)
{
return (U32)(UINTPTR_T)(pIO->pbStart + PACKETLENGTH * 2 - pIO->pbCurrent) - pIO->cBitsUsed / 8;
}
U32 getSizeWrite(BitIOInfo* pIO)
{
return (U32)(UINTPTR_T)(pIO->pbCurrent + (pIO->pbStart <= pIO->pbCurrent ? 0 : PACKETLENGTH * 2) - pIO->pbStart) + pIO->cBitsUsed / 8;
}
//----------------------------------------------------------------
// Query stream offset from attached BitIO object for dec
//----------------------------------------------------------------
U32 getPosRead(BitIOInfo* pIO)
{
size_t cbCached = (pIO->pbStart + PACKETLENGTH * 2 - pIO->pbCurrent) - pIO->cBitsUsed / 8;
return (U32)(pIO->offRef - cbCached);
}
//================================================================
// Block I/O functions
//================================================================
#ifndef ARMOPT_BITIO
ERR attachISRead(BitIOInfo* pIO, struct WMPStream* pWS, CWMImageStrCodec* pSC)
{
UNREFERENCED_PARAMETER( pSC );
pWS->GetPos(pWS, &pIO->offRef);
pIO->pbStart = (U8*)pIO - PACKETLENGTH * 2;
pIO->pbCurrent = pIO->pbStart;
PERFTIMER_STOP(pSC->m_fMeasurePerf, pSC->m_ptEncDecPerf);
pWS->SetPos(pWS, pIO->offRef);
pWS->Read(pWS, pIO->pbStart, PACKETLENGTH * 2);
PERFTIMER_START(pSC->m_fMeasurePerf, pSC->m_ptEncDecPerf);
pIO->offRef += PACKETLENGTH * 2;
pIO->uiAccumulator = load4BE(pIO->pbStart);
pIO->cBitsUsed = 0;
pIO->iMask = ~(PACKETLENGTH * 2);
pIO->iMask &= ~1;
pIO->pWS = pWS;
return WMP_errSuccess;
}
ERR readIS(CWMImageStrCodec* pSC, BitIOInfo* pIO)
{
ERR err = WMP_errSuccess;
UNREFERENCED_PARAMETER( pSC );
if (PACKET1(pIO->pbStart, pIO->pbCurrent, PACKETLENGTH))
{
struct WMPStream *pWS = pIO->pWS;
PERFTIMER_STOP(pSC->m_fMeasurePerf, pSC->m_ptEncDecPerf);
//Call(0 != pIO->pWS->Read(pIO->pWS, pIO->pbStart, PACKETLENGTH));
// TODO: add error checking code
pWS->SetPos(pWS, pIO->offRef);
pWS->Read(pWS, pIO->pbStart, PACKETLENGTH);
pIO->offRef += PACKETLENGTH;
PERFTIMER_START(pSC->m_fMeasurePerf, pSC->m_ptEncDecPerf);
// make shadow copy for first 4B
pIO->uiShadow = *(U32*)pIO->pbStart;
// reposition pbPacket pointer
pIO->pbStart = MASKPTR(pIO->pbStart + PACKETLENGTH, pIO->iMask);
}
//Cleanup:
return err;
}
ERR detachISRead(CWMImageStrCodec* pSC, BitIOInfo* pIO)
{
ERR err = WMP_errSuccess;
struct WMPStream* pWS = pIO->pWS;
size_t cbRemain = 0;
// we can ONLY detach IStream at byte boundary
flushToByte(pIO);
assert(0 == (pIO->cBitsUsed % 8));
Call(readIS_L1(pSC, pIO));
// set stream to right offset, undo buffering
cbRemain = (pIO->pbStart + PACKETLENGTH * 2) - (pIO->pbCurrent + pIO->cBitsUsed / 8);
pWS->SetPos(pWS, pIO->offRef - cbRemain);
pIO->pWS = NULL;
Cleanup:
return err;
}
#endif // ARMOPT_BITIO
//----------------------------------------------------------------
ERR attachISWrite(BitIOInfo* pIO, struct WMPStream* pWS)
{
pWS->GetPos(pWS, &pIO->offRef);
pIO->pbStart = (U8*)pIO - PACKETLENGTH * 2;
pIO->pbCurrent = pIO->pbStart;
pIO->uiAccumulator = 0;
pIO->cBitsUsed = 0;
pIO->iMask = ~(PACKETLENGTH * 2);
pIO->pWS = pWS;
return WMP_errSuccess;
}
// write out packet if we have >=1 packet data filled
ERR writeIS(CWMImageStrCodec* pSC, BitIOInfo* pIO)
{
ERR err = WMP_errSuccess;
UNREFERENCED_PARAMETER( pSC );
if (PACKET1(pIO->pbStart, pIO->pbCurrent, PACKETLENGTH))
{
PERFTIMER_STOP(pSC->m_fMeasurePerf, pSC->m_ptEncDecPerf);
err = pIO->pWS->Write(pIO->pWS, pIO->pbStart, PACKETLENGTH);
PERFTIMER_START(pSC->m_fMeasurePerf, pSC->m_ptEncDecPerf);
Call(err);
// reposition pbStart pointer
pIO->pbStart = MASKPTR(pIO->pbStart + PACKETLENGTH, pIO->iMask);
}
Cleanup:
return err;
}
// write out partially filled buffer and detach bitIO from IStream
ERR detachISWrite(CWMImageStrCodec* pSC, BitIOInfo* pIO)
{
ERR err = WMP_errSuccess;
// we can ONLY detach IStream at byte boundary
assert(0 == (pIO->cBitsUsed % 8));
Call(writeIS_L1(pSC, pIO));
PERFTIMER_STOP(pSC->m_fMeasurePerf, pSC->m_ptEncDecPerf);
err = pIO->pWS->Write(pIO->pWS, pIO->pbStart, pIO->pbCurrent + pIO->cBitsUsed / 8 - pIO->pbStart);
PERFTIMER_START(pSC->m_fMeasurePerf, pSC->m_ptEncDecPerf);
Call(err);
pIO->pWS = NULL;
Cleanup:
return err;
}
//=========================
// Performance Measurement
//=========================
#ifndef DISABLE_PERF_MEASUREMENT
void OutputIndivPerfTimer(struct PERFTIMERSTATE *pPerfTimer,
char *pszTimerName,
char *pszDescription,
float fltMegaPixels)
{
PERFTIMERRESULTS rResults;
Bool fResult;
fResult = FALSE;
printf("%s (%s): ", pszTimerName, pszDescription);
if (pPerfTimer)
{
fResult = PerfTimerGetResults(pPerfTimer, &rResults);
if (fResult)
{
printf("%.3f milliseconds, %.6f MP/sec\n", (float)rResults.iElapsedTime / 1000000,
1000000000 * fltMegaPixels / rResults.iElapsedTime);
if (rResults.iZeroTimeIntervals > 0)
{
printf(" *** WARNING: %d time intervals were measured as zero. "
"This perf timer has insufficient precision!\n\n",
(int) rResults.iZeroTimeIntervals);
}
}
}
if (FALSE == fResult)
printf("Results not available!\n");
}
void OutputPerfTimerReport(CWMImageStrCodec *pState)
{
float fltMegaPixels;
assert(pState->m_fMeasurePerf);
printf("***************************************************************************\n");
printf("* Perf Report\n");
printf("***************************************************************************\n\n");
fltMegaPixels = (float)pState->WMII.cWidth * pState->WMII.cHeight / 1000000;
printf("Image Width = %d, Height = %d, total MegaPixels = %.1f MP\n",
(int) pState->WMII.cWidth, (int) pState->WMII.cHeight, fltMegaPixels);
OutputIndivPerfTimer(pState->m_ptEncDecPerf, "m_ptEncDecPerf", "excl I/O", fltMegaPixels);
OutputIndivPerfTimer(pState->m_ptEndToEndPerf, "m_ptEndToEndPerf", "incl I/O", fltMegaPixels);
}
#endif // DISABLE_PERF_MEASUREMENT