Public-Mirror/GARbro-mirror
1
0
Fork 0
mirror of https://github.com/crskycode/GARbro.git synced 2024-12-19 09:24:12 +08:00
Code Issues Projects Releases Wiki Activity
GARbro-mirror/ArcFormats/Entis/EriReader.cs
morkt 77fde27d26 bunch of stuff.
2023-08-24 01:33:50 +04:00

2845 lines
102 KiB
C#
Raw Blame History

// *****************************************************************************
// E R I S A - L i b r a r y
// -----------------------------------------------------------------------------
// Copyright (C) 2002-2004 Leshade Entis, Entis-soft. All rights reserved.
// *****************************************************************************
//
// C# port by morkt
//
using System;
using System.Diagnostics;
using System.IO;
using System.Windows.Media;
using System.Windows.Media.Imaging;
namespace GameRes.Formats.Entis
{
internal class EriReader
{
EriMetaData m_info;
byte[] m_output;
ERISADecodeContext m_context;
int m_dst;
int m_nBlockSize;
int m_nBlockArea;
int m_nBlockSamples;
int m_nChannelCount;
int m_nWidthBlocks;
int m_nHeightBlocks;
int m_dwBytesPerLine;
int m_ptrDstBlock;
int m_nDstLineBytes;
int m_nDstPixelBytes;
int m_nDstWidth;
int m_nDstHeight;
// buffers for lossless encoding
byte[] m_ptrOperations;
sbyte[] m_ptrColumnBuf;
sbyte[] m_ptrLineBuf;
sbyte[] m_ptrDecodeBuf;
sbyte[] m_ptrArrangeBuf;
int[] m_pArrangeTable = new int[4];
// lossy encoding
int m_nBlocksetCount;
int m_nYUVLineBytes;
int m_nYUVPixelBytes;
sbyte[] m_ptrLossyOps;
float[] m_ptrVertBufLOT;
float[] m_ptrHorzBufLOT;
float[][] m_ptrBlocksetBuf;
float[] m_ptrMatrixBuf;
float[] m_ptrIQParamBuf;
byte[] m_ptrIQParamTable;
// float[] m_ptrBuffer2;
sbyte[] m_ptrBlockLineBuf;
sbyte[] m_ptrNextBlockBuf;
sbyte[] m_ptrImageBuf;
sbyte[] m_ptrYUVImage;
sbyte[] m_ptrMovingVector;
sbyte[] m_ptrMoveVecFlags;
int[] m_ptrMovePrevBlocks;
int[] m_ptrNextPrevBlocks;
HuffmanTree m_pHuffmanTree;
ErisaProbModel m_pProbERISA;
PtrProcedure[] m_pfnColorOperation;
byte[] m_src_frame;
public EriMetaData Info { get { return m_info; } }
public byte[] Data { get { return m_output; } }
public PixelFormat Format { get; private set; }
public int Stride { get { return Math.Abs (m_dwBytesPerLine); } }
public BitmapPalette Palette { get; private set; }
public EriReader (Stream stream, EriMetaData info, Color[] palette, byte[] key_frame = null)
{
m_info = info;
m_src_frame = key_frame;
switch (m_info.Architecture)
{
case EriCode.Nemesis:
case EriCode.RunlengthHuffman:
case EriCode.RunlengthGamma:
if (CvType.Lossless_ERI == m_info.Transformation && 0 == m_info.BlockingDegree)
throw new InvalidFormatException();
break;
case EriCode.ArithmeticCode:
if (CvType.Lossless_ERI != m_info.Transformation)
throw new InvalidFormatException();
break;
default:
throw new InvalidFormatException();
}
switch (m_info.FormatType & EriType.Mask)
{
case EriType.RGB:
if (m_info.BPP <= 8)
m_nChannelCount = 1;
else if (0 == (m_info.FormatType & EriType.WithAlpha))
m_nChannelCount = 3;
else
m_nChannelCount = 4;
break;
case EriType.Gray:
m_nChannelCount = 1;
break;
default:
throw new InvalidFormatException();
}
if (CvType.Lossless_ERI == m_info.Transformation)
InitializeLossless();
else if (CvType.LOT_ERI == m_info.Transformation
|| CvType.DCT_ERI == m_info.Transformation)
InitializeLossy();
else
throw new NotSupportedException ("Not supported ERI compression");
if (null != palette)
Palette = new BitmapPalette (palette);
CreateImageBuffer();
m_context.AttachInputFile (stream);
m_pfnColorOperation = new PtrProcedure[0x10]
{
ColorOperation0000,
ColorOperation0000,
ColorOperation0000,
ColorOperation0000,
ColorOperation0000,
ColorOperation0101,
ColorOperation0110,
ColorOperation0111,
ColorOperation0000,
ColorOperation1001,
ColorOperation1010,
ColorOperation1011,
ColorOperation0000,
ColorOperation1101,
ColorOperation1110,
ColorOperation1111
};
}
internal void AddImageBuffer (EriReader src_reader)
{
var dst_reader = this;
var dst_img = dst_reader.Data;
var src_img = src_reader.Data;
int src_bpp = (src_reader.Info.BPP + 7) / 8;
int dst_bpp = (dst_reader.Info.BPP + 7) / 8;
bool has_alpha = src_bpp == 4 && src_bpp == dst_bpp;
int src_stride = src_reader.Stride;
int dst_stride = dst_reader.Stride;
int height = (int)dst_reader.Info.Height;
int width = (int)dst_reader.Info.Width;
for (int y = 0; y < height; ++y)
{
int src = src_stride * y;
int dst = dst_stride * y;
for (int x = 0; x < width; ++x)
{
dst_img[dst ] += src_img[src ];
dst_img[dst+1] += src_img[src+1];
dst_img[dst+2] += src_img[src+2];
if (has_alpha)
dst_img[dst+3] += src_img[src+3];
dst += dst_bpp;
src += src_bpp;
}
}
}
private void InitializeLossless ()
{
if (0 != m_info.BlockingDegree)
{
m_nBlockSize = 1 << m_info.BlockingDegree;
m_nBlockArea = 1 << (m_info.BlockingDegree * 2);
m_nBlockSamples = m_nBlockArea * m_nChannelCount;
m_nWidthBlocks = ((int)m_info.Width + m_nBlockSize - 1) >> m_info.BlockingDegree;
m_nHeightBlocks = ((int)m_info.Height + m_nBlockSize - 1) >> m_info.BlockingDegree;
m_ptrOperations = new byte[m_nWidthBlocks * m_nHeightBlocks];
m_ptrColumnBuf = new sbyte[m_nBlockSize * m_nChannelCount];
m_ptrLineBuf = new sbyte[m_nChannelCount * (m_nWidthBlocks << m_info.BlockingDegree)];
m_ptrDecodeBuf = new sbyte[m_nBlockSamples];
m_ptrArrangeBuf = new sbyte[m_nBlockSamples];
InitializeArrangeTable();
}
if (0x00020200 == m_info.Version)
{
if (EriCode.RunlengthHuffman == m_info.Architecture)
{
m_pHuffmanTree = new HuffmanTree();
}
else if (EriCode.Nemesis == m_info.Architecture)
{
m_pProbERISA = new ErisaProbModel();
}
}
if (EriCode.RunlengthHuffman == m_info.Architecture)
m_context = new HuffmanDecodeContext (0x10000);
else if (EriCode.Nemesis == m_info.Architecture)
m_context = new ProbDecodeContext (0x10000);
else
m_context = new RLEDecodeContext (0x10000);
}
private void InitializeLossy ()
{
if (3 != m_info.BlockingDegree)
throw new InvalidFormatException();
m_nBlockSize = 1 << m_info.BlockingDegree;
m_nBlockArea = 1 << (m_info.BlockingDegree * 2);
m_nBlockSamples = m_nBlockArea * m_nChannelCount;
m_nWidthBlocks = ((int)m_info.Width + m_nBlockSize * 2 - 1) >> (m_info.BlockingDegree + 1);
m_nHeightBlocks = ((int)m_info.Height + m_nBlockSize * 2 - 1) >> (m_info.BlockingDegree + 1);
if (CvType.LOT_ERI == m_info.Transformation)
{
++m_nWidthBlocks;
++m_nHeightBlocks;
}
if (EriSampling.YUV_4_4_4 == m_info.SamplingFlags)
{
m_nBlocksetCount = m_nChannelCount * 4;
}
else if (EriSampling.YUV_4_1_1 == m_info.SamplingFlags)
{
switch (m_nChannelCount)
{
case 1:
m_nBlocksetCount = 4;
break;
case 3:
m_nBlocksetCount = 6;
break;
case 4:
m_nBlocksetCount = 10;
break;
default:
throw new InvalidFormatException();
}
}
else
throw new InvalidFormatException();
m_ptrDecodeBuf = new sbyte[m_nBlockArea * 16];
m_ptrVertBufLOT = new float[m_nBlockSamples * 2 * m_nWidthBlocks];
m_ptrHorzBufLOT = new float[m_nBlockSamples * 2];
m_ptrBlocksetBuf = new float[16][];
m_ptrMatrixBuf = new float[m_nBlockArea * 16];
m_ptrIQParamBuf = new float[m_nBlockArea * 2];
m_ptrIQParamTable = new byte[m_nBlockArea * 2];
int dwTotalBlocks = m_nWidthBlocks * m_nHeightBlocks;
m_ptrLossyOps = new sbyte[dwTotalBlocks * 2];
m_ptrImageBuf = new sbyte[dwTotalBlocks * m_nBlockArea * m_nBlocksetCount];
m_ptrMovingVector = new sbyte[dwTotalBlocks * 4];
m_ptrMoveVecFlags = new sbyte[dwTotalBlocks];
m_ptrMovePrevBlocks = new int[dwTotalBlocks * 4];
for (int i = 0; i < 16; i ++)
{
m_ptrBlocksetBuf[i] = new float[m_nBlockArea];
}
m_nYUVPixelBytes = m_nChannelCount;
if (3 == m_nYUVPixelBytes)
{
m_nYUVPixelBytes = 4;
}
m_nYUVLineBytes = ((m_nYUVPixelBytes * m_nWidthBlocks * m_nBlockSize * 2) + 0xF) & (~0xF);
int nYUVImageSize = m_nYUVLineBytes * m_nHeightBlocks * m_nBlockSize * 2;
m_ptrBlockLineBuf = new sbyte[m_nYUVLineBytes * 16];
m_ptrYUVImage = new sbyte[nYUVImageSize];
InitializeZigZagTable();
m_pHuffmanTree = new HuffmanTree();
m_pProbERISA = new ErisaProbModel();
m_context = new HuffmanDecodeContext (0x10000);
}
int[] m_ptrTable;
void InitializeArrangeTable ()
{
int i, j, k, l, m;
m_ptrTable = new int[m_nBlockSamples * 4];
m_pArrangeTable[0] = 0;
m_pArrangeTable[1] = m_nBlockSamples;
m_pArrangeTable[2] = m_nBlockSamples * 2;
m_pArrangeTable[3] = m_nBlockSamples * 3;
int ptrNext = m_pArrangeTable[0];
for (i = 0; i < m_nBlockSamples; ++i)
{
m_ptrTable[ptrNext+i] = i;
}
ptrNext = m_pArrangeTable[1];
l = 0;
for (i = 0; i < m_nChannelCount; i++)
{
for (j = 0; j < m_nBlockSize; j++)
{
m = l + j;
for (k = 0; k < m_nBlockSize; k++)
{
m_ptrTable[ptrNext++] = m;
m += m_nBlockSize;
}
}
l += m_nBlockArea;
}
ptrNext = m_pArrangeTable[2];
for (i = 0; i < m_nBlockArea; i++)
{
k = i;
for (j = 0; j < m_nChannelCount; j++)
{
m_ptrTable[ptrNext++] = k;
k += m_nBlockArea;
}
}
ptrNext = m_pArrangeTable[3];
for (i = 0; i < m_nBlockSize; i++)
{
l = i;
for (j = 0; j < m_nBlockSize; j++)
{
m = l;
l += m_nBlockSize;
for (k = 0; k < m_nChannelCount; k++)
{
m_ptrTable[ptrNext++] = m;
m += m_nBlockArea;
}
}
}
}
void InitializeZigZagTable ()
{
m_ptrTable = new int[m_nBlockArea];
m_pArrangeTable[0] = 0;
uint i = 0;
int x = 0, y = 0;
for (;;)
{
for (;;)
{
m_ptrTable[i++] = x + y * m_nBlockSize;
if (i >= m_nBlockArea)
return;
++x;
--y;
if (x >= m_nBlockSize)
{
--x;
y += 2;
break;
}
else if (y < 0)
{
y = 0;
break;
}
}
for (;;)
{
m_ptrTable[i++] = x + y * m_nBlockSize;
if (i >= m_nBlockArea)
return;
++y;
--x;
if (y >= m_nBlockSize)
{
--y;
x += 2;
break;
}
else if (x < 0)
{
x = 0;
break;
}
}
}
}
private void CreateImageBuffer ()
{
m_dwBytesPerLine = (((int)m_info.Width * m_info.BPP / 8) + 3) & ~3;
m_output = new byte[m_dwBytesPerLine * (int)m_info.Height];
if (!m_info.VerticalFlip)
{
m_dst = ((int)m_info.Height - 1) * m_dwBytesPerLine;
m_dwBytesPerLine = -m_dwBytesPerLine;
}
else
{
m_dst = 0;
}
}
public void DecodeImage ()
{
if (CvType.Lossless_ERI == m_info.Transformation)
DecodeLosslessImage (m_context as RLEDecodeContext);
else
DecodeLossyImage (m_context as HuffmanDecodeContext);
}
private delegate void PtrProcedure ();
private void DecodeLosslessImage (RLEDecodeContext context)
{
context.FlushBuffer();
uint nERIVersion = context.GetNBits (8);
uint fOpTable = context.GetNBits (8);
uint fEncodeType = context.GetNBits (8);
uint nBitCount = context.GetNBits (8);
if (0 != fOpTable || 0 != (fEncodeType & 0xFE))
{
throw new InvalidFormatException();
}
switch (nERIVersion)
{
case 1:
if (nBitCount != 0)
throw new InvalidFormatException();
break;
case 2:
if (nBitCount != 0 || fEncodeType != 0)
throw new InvalidFormatException();
DecodeType2Image (context);
return;
case 4:
DecodeType4Image (context);
return;
case 8:
if (nBitCount != 8)
throw new InvalidFormatException();
break;
case 16:
if ((nBitCount != 8) || (fEncodeType != 0))
throw new InvalidFormatException();
break;
default:
throw new InvalidFormatException();
}
m_nDstPixelBytes = m_info.BPP >> 3;
m_nDstLineBytes = m_dwBytesPerLine;
var pfnRestoreFunc = GetLLRestoreFunc (m_info.FormatType, m_info.BPP);
if (null == pfnRestoreFunc)
throw new InvalidFormatException();
if (EriCode.Nemesis == m_info.Architecture)
{
Debug.Assert (m_pProbERISA != null);
m_pProbERISA.Initialize();
}
int i;
int ptrNextOperation = 0; // index within m_ptrOperations
if ((0 != (fEncodeType & 1)) && (m_nChannelCount >= 3))
{
if (m_info.Architecture == EriCode.Nemesis)
throw new InvalidFormatException();
int nAllBlockCount = m_nWidthBlocks * m_nHeightBlocks;
for (i = 0; i < nAllBlockCount; i++)
{
if (EriCode.RunlengthGamma == m_info.Architecture)
{
m_ptrOperations[i] = (byte)(context.GetNBits(4) | 0xC0);
}
else
{
Debug.Assert (EriCode.RunlengthHuffman == m_info.Architecture);
m_ptrOperations[i] = (byte)(context as HuffmanDecodeContext).GetHuffmanCode (m_pHuffmanTree);
}
}
}
if (context.GetABit() != 0)
throw new InvalidFormatException();
if (EriCode.RunlengthGamma == m_info.Architecture)
{
if (0 != (fEncodeType & 1))
{
context.InitGammaContext();
}
}
else if (EriCode.RunlengthHuffman == m_info.Architecture)
{
(context as HuffmanDecodeContext).PrepareToDecodeERINACode();
}
else
{
Debug.Assert (EriCode.Nemesis == m_info.Architecture);
(context as ProbDecodeContext).PrepareToDecodeERISACode();
}
int nWidthSamples = m_nChannelCount * m_nWidthBlocks * m_nBlockSize;
for (i = 0; i < nWidthSamples; ++i)
m_ptrLineBuf[i] = 0;
int nAllBlockLines = m_nBlockSize * m_nChannelCount;
int nLeftHeight = (int)m_info.Height;
for (int nPosY = 0; nPosY < m_nHeightBlocks; ++nPosY)
{
int nColumnBufSamples = m_nBlockSize * m_nChannelCount;
for (i = 0; i < nColumnBufSamples; ++i)
m_ptrColumnBuf[i] = 0;
m_ptrDstBlock = m_dst + nPosY * m_dwBytesPerLine * m_nBlockSize;
m_nDstHeight = Math.Min (m_nBlockSize, nLeftHeight);
int nLeftWidth = (int)m_info.Width;
int ptrNextLineBuf = 0; // m_ptrLineBuf;
for (int nPosX = 0; nPosX < m_nWidthBlocks; ++nPosX)
{
m_nDstWidth = Math.Min (m_nBlockSize, nLeftWidth);
uint dwOperationCode;
if (m_nChannelCount >= 3)
{
if (0 != (fEncodeType & 1))
{
dwOperationCode = m_ptrOperations[ptrNextOperation++];
}
else if (m_info.Architecture == EriCode.RunlengthHuffman)
{
dwOperationCode = (uint)(context as HuffmanDecodeContext).GetHuffmanCode (m_pHuffmanTree);
}
else if (m_info.Architecture == EriCode.Nemesis)
{
dwOperationCode = (uint)(context as ProbDecodeContext).DecodeERISACode (m_pProbERISA);
}
else
{
Debug.Assert (EriCode.RunlengthGamma == m_info.Architecture);
dwOperationCode = context.GetNBits (4) | 0xC0;
context.InitGammaContext();
}
}
else
{
if (EriType.Gray == m_info.FormatType)
{
dwOperationCode = 0xC0;
}
else
{
dwOperationCode = 0;
}
if (0 == (fEncodeType & 1) && m_info.Architecture == EriCode.RunlengthGamma)
{
context.InitGammaContext();
}
}
if (context.DecodeBytes (m_ptrArrangeBuf, (uint)m_nBlockSamples) < m_nBlockSamples)
{
throw new InvalidFormatException();
}
PerformOperation (dwOperationCode, nAllBlockLines, m_ptrLineBuf, ptrNextLineBuf);
ptrNextLineBuf += nColumnBufSamples;
pfnRestoreFunc();
m_ptrDstBlock += m_nDstPixelBytes * m_nBlockSize;
nLeftWidth -= m_nBlockSize;
}
nLeftHeight -= m_nBlockSize;
}
}
#pragma warning disable 162 // unreachable code
private void DecodeType2Image (RLEDecodeContext context)
{
if (m_info.BPP != 8)
throw new InvalidFormatException();
throw new NotImplementedException ("Arithmetic compression not implemented");
if (EriCode.ArithmeticCode == m_info.Architecture)
{
// (context as ArithmeticContext).InitArithmeticContext (8);
m_ptrLineBuf = new sbyte[m_info.Width*4];
}
else
throw new NotImplementedException();
int dst = m_dst;
for (int nPosY = 0; nPosY < (int)m_info.Height; ++nPosY)
{
if (context.DecodeBytes (m_ptrLineBuf, m_info.Width) < m_info.Width)
throw new InvalidFormatException();
for (int x = 0; x < (int)m_info.Width; ++x)
m_output[dst+x] = (byte)m_ptrLineBuf[4 * x];
dst += m_dwBytesPerLine;
}
}
private void DecodeType4Image (RLEDecodeContext context)
{
throw new NotImplementedException ("Arithmetic compression not implemented");
}
private void DecodeLossyImage (HuffmanDecodeContext context)
{
context.FlushBuffer();
uint nERIVersion = context.GetNBits (8);
uint fOpTable = context.GetNBits (8);
uint fEncodeType = context.GetNBits (8);
uint nBitCount = context.GetNBits (8);
var orig_trans = m_info.Transformation;
CalcImageSizeInBlocks ((fEncodeType == 1) ? CvType.DCT_ERI : orig_trans);
m_ptrDstBlock = m_dst;
m_nDstPixelBytes = m_info.BPP >> 3;
m_nDstLineBytes = m_dwBytesPerLine;
m_nDstWidth = (int)m_info.Width;
m_nDstHeight = (int)m_info.Height;
if (9 == nERIVersion)
{
if (fOpTable != 0 || (fEncodeType & 0xFE) != 0 || nBitCount != 8)
throw new InvalidFormatException();
DecodeLossyV9 (context, fEncodeType);
return;
}
var pfnRestoreFunc = GetLSRestoreFunc (m_info.FormatType, m_info.BPP);
if (null == pfnRestoreFunc)
throw new InvalidFormatException();
if (context.GetABit() != 0)
throw new InvalidFormatException();
if (0x28 == nERIVersion)
{
if (EriCode.RunlengthGamma != m_info.Architecture)
throw new InvalidFormatException();
Debug.Assert (m_pHuffmanTree != null);
context.PrepareToDecodeERINACode (HuffmanDecodeContext.efERINAOrder0);
}
else
throw new InvalidFormatException();
throw new NotImplementedException ("Lossy ERI compression not implemented");
for (int i = 0; i < m_nBlockArea * 2; ++i)
{
m_ptrIQParamTable[i] = (byte)context.GetHuffmanCode (m_pHuffmanTree);
}
int nTotalBlocks = m_nWidthBlocks * m_nHeightBlocks;
int nTotalSamples = nTotalBlocks * m_nBlockArea * m_nBlocksetCount;
context.InitGammaContext();
if (context.DecodeGammaCodeBytes (m_ptrLossyOps, (uint)nTotalBlocks * 2) < nTotalBlocks * 2)
throw new InvalidFormatException();
Debug.Assert (8 == m_nBlockSize);
const int nBlockSize = 16;
uint nWidthDivBlocks = (m_info.Width + (nBlockSize - 1)) / nBlockSize;
uint nHeightDivBlocks = (m_info.Height + (nBlockSize - 1)) / nBlockSize;
uint nTotalDivBlocks = nWidthDivBlocks * nHeightDivBlocks;
if (0 != (fOpTable & 1))
{
context.InitGammaContext();
if (context.DecodeGammaCodeBytes (m_ptrMoveVecFlags, nTotalDivBlocks) < nTotalDivBlocks)
throw new InvalidFormatException();
context.InitGammaContext();
if (context.DecodeGammaCodeBytes (m_ptrMovingVector, nTotalDivBlocks * 4) < nTotalDivBlocks * 4 )
throw new InvalidFormatException();
}
else if (null != m_src_frame)
{
for (uint i = 0; i < nTotalDivBlocks; ++i)
m_ptrMoveVecFlags[i] = 1;
for (uint i = 0; i < nTotalDivBlocks*4; ++i)
m_ptrMovingVector[i] = 0;
}
if (null != m_src_frame)
{
SetupMovingVector();
}
if (CvType.LOT_ERI == m_info.Transformation)
{
for (int i = 0; i < m_ptrVertBufLOT.Length; ++i)
m_ptrVertBufLOT[i] = 0;
}
Action<float[], int> pfnBlockMatrix;
if (CvType.LOT_ERI == m_info.Transformation)
pfnBlockMatrix = MatrixILOT8x8;
else
pfnBlockMatrix = MatrixIDCT8x8;
Action<int, int> pfnBlockScaling;
if (EriSampling.YUV_4_1_1 == m_info.SamplingFlags)
pfnBlockScaling = BlockScaling411;
else
pfnBlockScaling = BlockScaling444;
int ptrQParam = 0; // m_ptrLossyOps
int nLineBlockSamples = m_nWidthBlocks * m_nBlockArea * m_nBlocksetCount;
m_ptrNextPrevBlocks = m_ptrMovePrevBlocks;
for (int nPosY = 0; nPosY < m_nHeightBlocks; ++nPosY)
{
if (CvType.LOT_ERI == m_info.Transformation)
{
for (int i = 0; i < m_ptrHorzBufLOT.Length; ++i)
m_ptrHorzBufLOT[i] = 0;
}
int ptrVertBufLOT = 0; // m_ptrVertBufLOT;
m_ptrNextBlockBuf = m_ptrBlockLineBuf;
if (context.DecodeBytes (m_ptrImageBuf, (uint)nLineBlockSamples) < nLineBlockSamples)
throw new InvalidFormatException();
int ptrSrcData = 0; // m_ptrImageBuf;
for (int nPosX = 0; nPosX < m_nWidthBlocks; ++nPosX)
{
ArrangeAndIQuantumize (ptrSrcData, ptrQParam);
ptrSrcData += m_nBlockArea * m_nBlocksetCount;
ptrQParam += 2;
pfnBlockMatrix (m_ptrVertBufLOT, ptrVertBufLOT);
ptrVertBufLOT += m_nBlockArea * 2 * m_nChannelCount;
pfnBlockScaling (nPosX, nPosY);
}
}
pfnRestoreFunc();
if (0 != (fOpTable & 0xC))
{
throw new NotImplementedException ("Filtering operations not implemented");
}
m_info.Transformation = orig_trans;
}
void DecodeLossyV9 (HuffmanDecodeContext context, uint fEncodeType)
{
throw new NotImplementedException();
/*
if (m_nChannelCount < 3)
throw new InvalidFormatException();
m_nDstPixelBytes = m_info.BPP >> 3;
var pfnRestoreFunc = GetLSRestoreFunc (m_info.FormatType, m_info.BPP);
if (null == pfnRestoreFunc)
throw new InvalidFormatException();
if (EriCode.RunlengthHuffman == m_info.Architecture)
context.PrepareToDecodeERINACode();
if (context.GetABit() != 0)
throw new InvalidFormatException();
float field_1A8 = 256.0f / (context.GetNBits (8) + 1);
uint v9 = context.GetNBits (8);
double field_1A4 = 2.0 / (double)m_nBlockSize;
int nTotalBlocks = m_nHeightBlocks * m_nWidthBlocks;
bool is_encode_type_1 = (fEncodeType & 1) != 0;
field_1A8 = (float)(field_1A8 * field_1A4);
float field_1AC = (float)(256.0 / (v9 + 1) * field_1A4);
if (is_encode_type_1)
{
uint v12 = (uint)(nTotalBlocks * m_nBlocksetCount);
context.InitGammaContext();
if (context.DecodeGammaCodeBytes (m_ptrMoveVecFlags, v12) < v12)
throw new InvalidFormatException();
m_pHuffmanTree.Initialize();
int nAllBlockCount = 4 * nTotalBlocks;
for (int i = 0; i < nAllBlockCount; ++i)
{
m_ptrIQParamTable[i] = (byte)context.GetHuffmanCode (m_pHuffmanTree);
}
if (m_info.Architecture != EriCode.RunlengthHuffman)
context.InitGammaContext();
}
var field_70 = new byte[m_nBlocksetCount * 4];
int image_height = (int)m_info.Height;
int ptrSrcData = 0; // this->m_ptrMoveVecFlags;
int ptrQParam = 0; // this->m_ptrIQParamTable;
for (int nPosY = 0; nPosY < m_nHeightBlocks; ++nPosY)
{
int image_dst = (m_dwBytesPerLine * nPosY) << (m_info.BlockingDegree + 1);
int v48 = m_nBlockSize;
int v43 = m_nBlockSize;
if (image_height < m_nBlockSize)
{
v48 = image_height;
v43 = 0;
}
else if (image_height < 2 * m_nBlockSize)
{
v43 = image_height - m_nBlockSize;
}
int image_width = (int)m_info.Width;
for (int i = 0; i < m_nBlocksetCount; ++i)
{
m_ptrHorzBufLOT[i] = 0;
}
for (int nPosX = 0; nPosX < m_nWidthBlocks; ++nPosX)
{
if (is_encode_type_1)
{
Buffer.BlockCopy (m_ptrMoveVecFlags, ptrSrcData, field_70, 0, 4 * m_nBlocksetCount);
ptrSrcData += 4 * m_nBlocksetCount;
}
else
{
context.InitGammaContext();
if (context.DecodeGammaCodeBytes (field_70, m_nBlocksetCount) < m_nBlocksetCount)
throw new InvalidFormatException();
m_ptrIQParamTable[ptrQParam ] = (byte)context.GetHuffmanCode (m_pHuffmanTree);
m_ptrIQParamTable[ptrQParam+1] = (byte)context.GetHuffmanCode (m_pHuffmanTree);
m_ptrIQParamTable[ptrQParam+2] = (byte)context.GetHuffmanCode (m_pHuffmanTree);
m_ptrIQParamTable[ptrQParam+3] = (byte)context.GetHuffmanCode (m_pHuffmanTree);
}
int v23 = m_nBlocksetCount * (m_nBlockArea - 1);
if (EriCode.RunlengthHuffman == m_info.dwArchitecture)
{
if (sub_439080 (&this->field_70[4 * m_nBlocksetCount], v23) < v23 )
throw new InvalidFormatException();
}
else
{
if (!is_encode_type_1)
context.InitGammaContext();
if (context.DecodeGammaCodeBytes ((SBYTE *)&this->field_70[4 * this->m_nBlocksetCount], v23) < v23)
throw new InvalidFormatException();
}
for (int v24 = 0; v24 < m_nBlocksetCount; ++v24)
{
uint v27 = LittleEndian.ToUInt32 (field_70, v24 * 4) + m_ptrHorzBufLOT[v24];
m_ptrHorzBufLOT[v24] = v27;
LittleEndian.Pack (v27, field_70, v24 * 4);
}
sub_43ADE0 (this, (int)ptrQParam, (int)ptrQParam);
ptrQParam += 4;
sub_425A49 (this);
field_94 (this);
sub_43B1B0 (this);
int v29 = m_nBlockSize;
int v30 = m_nBlockSize;
if (image_width < m_nBlockSize)
{
v29 = image_width;
v30 = 0;
}
else if (image_width < 2 * m_nBlockSize)
{
v30 = image_width - m_nBlockSize;
}
int v59 = v30;
int v61 = v30;
int v58 = v29;
int v54 = v48;
int v55 = v48;
int v60 = v29;
int v56 = v43;
int v57 = v43;
int v31 = m_nDstPixelBytes;
int v62 = 0;
v32 = (float *)this->m_ptrBlocksetBuf;
v63 = m_nBlockSize * v31;
v33 = m_dwBytesPerLine;
v64 = m_nBlockSize * v33;
v65 = m_nBlockSize * (v33 + v31);
for (int v34 = 0; v34 < 16; v34 += 4)
{
v35 = v66;
v36 = v32;
v37 = 4;
do
{
v38 = *v36;
v36 += 4;
*v35 = v38;
++v35;
--v37;
}
while ( v37 );
pfnRestoreFunc (
&image_dst[*(int *)((char *)&v62 + v34)],
imginf->dwBytesPerLine,
v66,
*(uint *)((char *)&v58 + v34),
*(uint *)((char *)&v54 + v34));
++v32;
}
image_width -= 2 * m_nBlockSize;
image_dst += m_nDstPixelBytes << (m_info.BlockingDegree + 1);
}
image_height -= 2 * m_nBlockSize;
}
*/
}
void CalcImageSizeInBlocks (CvType fdwTransformation)
{
m_info.Transformation = fdwTransformation;
m_nWidthBlocks = (((int)m_info.Width + m_nBlockSize * 2 - 1) >> (m_info.BlockingDegree + 1));
m_nHeightBlocks = ((int)m_info.Height + m_nBlockSize * 2 - 1) >> (m_info.BlockingDegree + 1);
if (CvType.LOT_ERI == fdwTransformation)
{
++m_nWidthBlocks;
++m_nHeightBlocks;
}
}
void SetupMovingVector ()
{
throw new NotImplementedException ("Lossy delta compression not implemented");
}
void PerformOperation (uint dwOpCode, int nAllBlockLines, sbyte[] pNextLineBuf, int iNextLineIdx )
{
int i, j, k;
uint nArrangeCode, nColorOperation, nDiffOperation;
nColorOperation = dwOpCode & 0x0F;
nArrangeCode = (dwOpCode >> 4) & 0x03;
nDiffOperation = (dwOpCode >> 6) & 0x03;
if (0 == nArrangeCode)
{
Buffer.BlockCopy (m_ptrArrangeBuf, 0, m_ptrDecodeBuf, 0, m_nBlockSamples);
if (0 == dwOpCode)
{
return;
}
}
else
{
int pArrange = m_pArrangeTable[nArrangeCode];
for (i = 0; i < m_nBlockSamples; i++)
{
m_ptrDecodeBuf[m_ptrTable[pArrange + i]] = m_ptrArrangeBuf[i];
}
}
m_pfnColorOperation[nColorOperation]();
int ptrNextBuf = 0; // m_ptrDecodeBuf
int ptrNextColBuf = 0; // m_ptrColumnBuf
if (0 != (nDiffOperation & 1))
{
for (i = 0; i < nAllBlockLines; i++)
{
sbyte nLastVal = m_ptrColumnBuf[ptrNextColBuf];
for (j = 0; j < m_nBlockSize; j++)
{
nLastVal += m_ptrDecodeBuf[ptrNextBuf];
m_ptrDecodeBuf[ptrNextBuf++] = nLastVal;
}
m_ptrColumnBuf[ptrNextColBuf++] = nLastVal;
}
}
else
{
for (i = 0; i < nAllBlockLines; i ++)
{
m_ptrColumnBuf[ptrNextColBuf++] = m_ptrDecodeBuf[ptrNextBuf + m_nBlockSize - 1];
ptrNextBuf += m_nBlockSize;
}
}
int iNextDst = 0;
for (k = 0; k < m_nChannelCount; k++)
{
sbyte[] ptrLastLine = pNextLineBuf;
int idxLastLine = iNextLineIdx;
for (i = 0; i < m_nBlockSize; i++)
{
for (j = 0; j < m_nBlockSize; j++)
{
m_ptrDecodeBuf[iNextDst+j] += ptrLastLine[idxLastLine+j];
}
ptrLastLine = m_ptrDecodeBuf;
idxLastLine = iNextDst;
iNextDst += m_nBlockSize;
}
Buffer.BlockCopy (ptrLastLine, idxLastLine, pNextLineBuf, iNextLineIdx, m_nBlockSize);
iNextLineIdx += m_nBlockSize;
}
}
PtrProcedure GetLLRestoreFunc (EriType fdwFormatType, int dwBitsPerPixel)
{
switch (dwBitsPerPixel)
{
case 32:
if (EriType.RGBA == fdwFormatType)
{
Format = PixelFormats.Bgra32;
if (null == m_src_frame)
return RestoreRGBA32;
else
return RestoreDeltaRGBA32;
}
Format = PixelFormats.Bgr32;
if (null == m_src_frame)
return RestoreRGB24;
else
return RestoreDeltaRGB24;
case 24:
Format = PixelFormats.Bgr24;
if (null == m_src_frame)
return RestoreRGB24;
else
return RestoreDeltaRGB24;
case 16:
Format = PixelFormats.Bgr555;
return RestoreRGB16;
case 8:
if (null == Palette)
Format = PixelFormats.Gray8;
else
Format = PixelFormats.Indexed8;
return RestoreGray8;
}
return null;
}
PtrProcedure GetLSRestoreFunc (EriType fdwFormatType, int dwBitsPerPixel)
{
switch (dwBitsPerPixel)
{
case 32:
if (EriType.RGBA == fdwFormatType)
{
Format = PixelFormats.Bgra32;
if (null == m_src_frame)
return LossyRestoreRGBA32;
else
return LossyRestoreDeltaRGBA32;
}
Format = PixelFormats.Bgr32;
if (null == m_src_frame)
return LossyRestoreRGB24;
else
return LossyRestoreDeltaRGB24;
case 24:
Format = PixelFormats.Bgr24;
if (null == m_src_frame)
return LossyRestoreRGB24;
else
return LossyRestoreDeltaRGB24;
case 8:
Format = PixelFormats.Gray8;
if (null == m_src_frame)
return LossyRestoreGray8;
else
return LossyRestoreDeltaGray8;
}
return null;
}
void RestoreRGBA32 ()
{
int ptrDstLine = m_ptrDstBlock;
int ptrSrcLine = 0; //m_ptrDecodeBuf;
int nBlockSamples = m_nBlockArea;
int nBlockSamplesX3 = nBlockSamples * 3;
for (uint y = 0; y < m_nDstHeight; y++)
{
int ptrDstNext = ptrDstLine;
int ptrSrcNext = ptrSrcLine;
for (uint x = 0; x < m_nDstWidth; x++)
{
m_output[ptrDstNext++] = (byte)m_ptrDecodeBuf[ptrSrcNext];
m_output[ptrDstNext++] = (byte)m_ptrDecodeBuf[ptrSrcNext + nBlockSamples];
m_output[ptrDstNext++] = (byte)m_ptrDecodeBuf[ptrSrcNext + nBlockSamples * 2];
m_output[ptrDstNext++] = (byte)m_ptrDecodeBuf[ptrSrcNext + nBlockSamplesX3];
ptrSrcNext ++;
}
ptrSrcLine += m_nBlockSize;
ptrDstLine += m_nDstLineBytes;
}
}
void RestoreRGB24()
{
int ptrDstLine = m_ptrDstBlock;
int ptrSrcLine = 0; //m_ptrDecodeBuf;
int nBytesPerPixel = m_nDstPixelBytes;
int nBlockSamples = m_nBlockArea;
for (uint y = 0; y < m_nDstHeight; y++)
{
int ptrDstNext = ptrDstLine;
int ptrSrcNext = ptrSrcLine;
for (uint x = 0; x < m_nDstWidth; x++)
{
m_output[ptrDstNext] = (byte)m_ptrDecodeBuf[ptrSrcNext];
m_output[ptrDstNext+1] = (byte)m_ptrDecodeBuf[ptrSrcNext + nBlockSamples];
m_output[ptrDstNext+2] = (byte)m_ptrDecodeBuf[ptrSrcNext + nBlockSamples * 2];
ptrSrcNext ++;
ptrDstNext += nBytesPerPixel;
}
ptrSrcLine += m_nBlockSize;
ptrDstLine += m_nDstLineBytes;
}
}
void LossyRestoreRGB24_V9 ()
{
/*
int nLineOffset = 0;
int nBytesPerPixel = m_nDstPixelBytes;
int ptrDstLine = m_ptrDstBlock;
for (uint y = 0; y < m_nDstHeight; ++y)
{
int nOffsetPos = nLineOffset;
int ptrNextDst = ptrDstLine;
for (uint x = 0; x < m_nDstWidth; ++x)
{
m_output[ptrNextDst ] = RoundR32ToByte (m_ptrBuffer2[0][nOffsetPos]);
m_output[ptrNextDst+1] = RoundR32ToByte (m_ptrBuffer2[1][nOffsetPos]);
m_output[ptrNextDst+2] = RoundR32ToByte (m_ptrBuffer2[2][nOffsetPos]);
++nOffsetPos;
ptrNextDst += nBytesPerPixel;
}
nLineOffset += m_nBlockSize;
ptrDstLine += m_nDstLineBytes;
}
*/
}
static byte RoundR32ToByte (float r)
{
int n = Erisa.RoundR32ToInt (r);
if (n < 0)
return 0;
else if (n >= 0x100)
return 0xFF;
return (byte)n;
}
void RestoreDeltaRGBA32 ()
{
int ptrDstLine = m_ptrDstBlock;
int ptrSrcLine = 0; //m_ptrDecodeBuf;
int nBlockSamples = m_nBlockArea;
int nBlockSamplesX3 = nBlockSamples * 3;
for (uint y = 0; y < m_nDstHeight; y++)
{
int ptrDstNext = ptrDstLine;
int ptrSrcNext = ptrSrcLine;
for (uint x = 0; x < m_nDstWidth; x++)
{
m_output[ptrDstNext] = (byte)(m_src_frame[ptrDstNext] + m_ptrDecodeBuf[ptrSrcNext]);
m_output[ptrDstNext+1] = (byte)(m_src_frame[ptrDstNext+1] + m_ptrDecodeBuf[ptrSrcNext + nBlockSamples]);
m_output[ptrDstNext+2] = (byte)(m_src_frame[ptrDstNext+2] + m_ptrDecodeBuf[ptrSrcNext + nBlockSamples * 2]);
m_output[ptrDstNext+3] = (byte)(m_src_frame[ptrDstNext+3] + m_ptrDecodeBuf[ptrSrcNext + nBlockSamplesX3]);
ptrSrcNext ++;
ptrDstNext += 4;
}
ptrSrcLine += m_nBlockSize;
ptrDstLine += m_nDstLineBytes;
}
}
void RestoreDeltaRGB24()
{
int ptrDstLine = m_ptrDstBlock;
int ptrSrcLine = 0; //m_ptrDecodeBuf;
int nBytesPerPixel = m_nDstPixelBytes;
int nBlockSamples = m_nBlockArea;
for (uint y = 0; y < m_nDstHeight; y++)
{
int ptrDstNext = ptrDstLine;
int ptrSrcNext = ptrSrcLine;
for (uint x = 0; x < m_nDstWidth; x++)
{
m_output[ptrDstNext] = (byte)(m_src_frame[ptrDstNext] + m_ptrDecodeBuf[ptrSrcNext]);
m_output[ptrDstNext+1] = (byte)(m_src_frame[ptrDstNext+1] + m_ptrDecodeBuf[ptrSrcNext + nBlockSamples]);
m_output[ptrDstNext+2] = (byte)(m_src_frame[ptrDstNext+2] + m_ptrDecodeBuf[ptrSrcNext + nBlockSamples * 2]);
ptrSrcNext ++;
ptrDstNext += nBytesPerPixel;
}
ptrSrcLine += m_nBlockSize;
ptrDstLine += m_nDstLineBytes;
}
}
void RestoreRGB16()
{
int ptrDstLine = m_ptrDstBlock;
int ptrSrcLine = 0; //m_ptrDecodeBuf;
int nBlockSamples = m_nBlockArea;
for (uint y = 0; y < m_nDstHeight; y++)
{
int ptrDstNext = ptrDstLine;
int ptrSrcNext = ptrSrcLine;
for (uint x = 0; x < m_nDstWidth; x++)
{
int word = (m_ptrDecodeBuf[ptrSrcNext] & 0x1F) |
((m_ptrDecodeBuf[ptrSrcNext + nBlockSamples] & 0x1F) << 5) |
((m_ptrDecodeBuf[ptrSrcNext + nBlockSamples * 2] & 0x1F) << 10);
m_output[ptrDstNext++] = (byte)word;
m_output[ptrDstNext++] = (byte)(word >> 8);
ptrSrcNext ++;
}
ptrSrcLine += m_nBlockSize;
ptrDstLine += m_nDstLineBytes;
}
}
void RestoreGray8()
{
int ptrDstLine = m_ptrDstBlock;
int ptrSrcLine = 0; //m_ptrDecodeBuf;
for (uint y = 0; y < m_nDstHeight; y++)
{
Buffer.BlockCopy (m_ptrDecodeBuf, ptrSrcLine, m_output, ptrDstLine, m_nDstWidth);
ptrSrcLine += m_nBlockSize;
ptrDstLine += m_nDstLineBytes;
}
}
void LossyRestoreRGB24 ()
{
ConvertImageYUVtoRGB();
int nSrcLineBytes = m_nYUVLineBytes;
int nSrcPixelBytes = m_nYUVPixelBytes;
int ptrSrcImage = 0; // m_ptrYUVImage;
int nDstLineBytes = m_nDstLineBytes;
int nDstPixelBytes = m_nDstPixelBytes;
int ptrDstImage = m_ptrDstBlock;
int nWidth = m_nDstWidth;
for (uint y = 0; y < m_nDstHeight; ++y)
{
int ptrSrcLine = ptrSrcImage;
int ptrDstLine = ptrDstImage;
for (uint x = 0; x < nWidth; ++x)
{
m_output[ptrDstLine] = (byte)m_ptrYUVImage[ptrSrcLine];
m_output[ptrDstLine+1] = (byte)m_ptrYUVImage[ptrSrcLine+1];
m_output[ptrDstLine+2] = (byte)m_ptrYUVImage[ptrSrcLine+2];
ptrSrcLine += nSrcPixelBytes;
ptrDstLine += nDstPixelBytes;
}
ptrSrcImage += nSrcLineBytes;
ptrDstImage += nDstLineBytes;
}
}
void LossyRestoreRGBA32 ()
{
ConvertImageYUVtoRGB();
int nSrcLineBytes = m_nYUVLineBytes;
int ptrSrcImage = 0; //m_ptrYUVImage;
int nDstLineBytes = m_nDstLineBytes;
int ptrDstImage = m_ptrDstBlock;
int nLineBytes = m_nDstWidth*4;
for (uint y = 0; y < m_nDstHeight; ++y)
{
Buffer.BlockCopy (m_ptrYUVImage, ptrSrcImage, m_output, ptrDstImage, nLineBytes);
ptrSrcImage += nSrcLineBytes;
ptrDstImage += nDstLineBytes;
}
}
void LossyRestoreDeltaRGB24 ()
{
MoveImageWithVector();
ConvertImageYUVtoRGB (m_src_frame != null);
int nSrcLineBytes = m_nYUVLineBytes;
int nSrcPixelBytes = m_nYUVPixelBytes;
int ptrSrcImage = 0; //m_ptrYUVImage;
int nDstLineBytes = m_nDstLineBytes;
int nDstPixelBytes = m_nDstPixelBytes;
int ptrDstImage = m_ptrDstBlock;
int nWidth = m_nDstWidth;
for (uint y = 0; y < m_nDstHeight; ++y)
{
int ptrSrcLine = ptrSrcImage;
int ptrDstLine = ptrDstImage;
for (uint x = 0; x < nWidth; ++x)
{
int b = m_src_frame[ptrDstLine] + (m_ptrYUVImage[ptrSrcLine] << 1);
int g = m_src_frame[ptrDstLine+1] + (m_ptrYUVImage[ptrSrcLine+1] << 1);
int r = m_src_frame[ptrDstLine+2] + (m_ptrYUVImage[ptrSrcLine+2] << 1);
if ((uint)b > 0xFF)
{
b = (~b >> 31) & 0xFF;
}
if ((uint)g > 0xFF)
{
g = (~g >> 31) & 0xFF;
}
if ((uint)r > 0xFF)
{
r = (~r >> 31) & 0xFF;
}
m_output[ptrDstLine] = (byte)b;
m_output[ptrDstLine+1] = (byte)g;
m_output[ptrDstLine+2] = (byte)r;
ptrSrcLine += nSrcPixelBytes;
ptrDstLine += nDstPixelBytes;
}
ptrSrcImage += nSrcLineBytes;
ptrDstImage += nDstLineBytes;
}
}
void LossyRestoreDeltaRGBA32 ()
{
MoveImageWithVector();
ConvertImageYUVtoRGB (m_src_frame != null);
int nSrcLineBytes = m_nYUVLineBytes;
int ptrSrcImage = 0; // m_ptrYUVImage;
int nDstLineBytes = m_nDstLineBytes;
int ptrDstImage = m_ptrDstBlock;
int nWidth = m_nDstWidth;
for (uint y = 0; y < m_nDstHeight; ++y)
{
int ptrSrcLine = ptrSrcImage;
int ptrDstLine = ptrDstImage;
for (uint x = 0; x < nWidth; ++x)
{
int b = m_src_frame[ptrDstLine] + (m_ptrYUVImage[ptrSrcLine] << 1);
int g = m_src_frame[ptrDstLine+1] + (m_ptrYUVImage[ptrSrcLine+1] << 1);
int r = m_src_frame[ptrDstLine+2] + (m_ptrYUVImage[ptrSrcLine+2] << 1);
int a = m_src_frame[ptrDstLine+3] + (m_ptrYUVImage[ptrSrcLine+3] << 1);
if ((uint)b > 0xFF)
{
b = (~b >> 31) & 0xFF;
}
if ((uint)g > 0xFF)
{
g = (~g >> 31) & 0xFF;
}
if ((uint)r > 0xFF)
{
r = (~r >> 31) & 0xFF;
}
if ((uint) a > 0xFF)
{
a = (~a >> 31) & 0xFF;
}
m_output[ptrDstLine] = (byte)b;
m_output[ptrDstLine+1] = (byte)g;
m_output[ptrDstLine+2] = (byte)r;
m_output[ptrDstLine+3] = (byte)a;
ptrSrcLine += 4;
ptrDstLine += 4;
}
ptrSrcImage += nSrcLineBytes;
ptrDstImage += nDstLineBytes;
}
}
void LossyRestoreGray8 ()
{
int nSrcLineBytes = m_nYUVLineBytes;
int ptrSrcImage = 0; // m_ptrYUVImage
int nDstLineBytes = m_nDstLineBytes;
int ptrDstImage = m_ptrDstBlock;
for (uint y = 0; y < m_nDstHeight; ++y)
{
Buffer.BlockCopy (m_ptrYUVImage, ptrSrcImage, m_output, ptrDstImage, m_nDstWidth);
ptrSrcImage += nSrcLineBytes;
ptrDstImage += nDstLineBytes;
}
}
void LossyRestoreDeltaGray8 ()
{
int nSrcLineBytes = m_nYUVLineBytes;
int ptrSrcImage = 0; // m_ptrYUVImage
int nDstLineBytes = m_nDstLineBytes;
int ptrDstImage = m_ptrDstBlock;
int nWidth = m_nDstWidth;
for (uint y = 0; y < m_nDstHeight; ++y)
{
int ptrSrcLine = ptrSrcImage;
int ptrDstLine = ptrDstImage;
for (int x = 0; x < nWidth; ++x)
{
int g = m_output[ptrDstLine+x] + (m_ptrYUVImage[ptrSrcLine+x] << 1);
if ((uint)g > 0xFF)
{
g = (~g >> 31) & 0xFF;
}
m_output[ptrDstLine+x] = (byte)g;
}
ptrSrcImage += nSrcLineBytes;
ptrDstImage += nDstLineBytes;
}
}
void MoveImageWithVector ()
{
throw new NotImplementedException ("Lossy delta compression not implemented");
}
void ColorOperation0000 ()
{
}
void ColorOperation0101 ()
{
int ptrNext = 0; // m_ptrDecodeBuf;
int nChSamples = m_nBlockArea;
int nRepCount = m_nBlockArea;
do
{
sbyte nBase = m_ptrDecodeBuf[ptrNext];
m_ptrDecodeBuf[ptrNext++ + nChSamples] += nBase;
}
while (0 != --nRepCount);
}
void ColorOperation0110 ()
{
int ptrNext = 0; // m_ptrDecodeBuf;
int nChSamples = m_nBlockArea * 2;
int nRepCount = m_nBlockArea;
do
{
sbyte nBase = m_ptrDecodeBuf[ptrNext];
m_ptrDecodeBuf[ptrNext++ + nChSamples] += nBase;
}
while (0 != --nRepCount);
}
void ColorOperation0111 ()
{
int ptrNext = 0; // m_ptrDecodeBuf;
int nChSamples = m_nBlockArea;
int nRepCount = m_nBlockArea;
do
{
sbyte nBase = m_ptrDecodeBuf[ptrNext];
m_ptrDecodeBuf[ptrNext + nChSamples] += nBase;
m_ptrDecodeBuf[ptrNext + nChSamples * 2] += nBase;
ptrNext ++;
}
while (0 != --nRepCount);
}
void ColorOperation1001 ()
{
int ptrNext = 0; //m_ptrDecodeBuf;
int nChSamples = m_nBlockArea;
int nRepCount = m_nBlockArea;
do
{
sbyte nBase = m_ptrDecodeBuf[ptrNext + nChSamples];
m_ptrDecodeBuf[ptrNext++] += nBase;
}
while (0 != --nRepCount);
}
void ColorOperation1010 ()
{
int ptrNext = 0; // m_ptrDecodeBuf;
int nChSamples = m_nBlockArea;
int nRepCount = m_nBlockArea;
do
{
sbyte nBase = m_ptrDecodeBuf[ptrNext + nChSamples];
m_ptrDecodeBuf[ptrNext++ + nChSamples * 2] += nBase;
}
while (0 != --nRepCount);
}
void ColorOperation1011 ()
{
int ptrNext = 0; //m_ptrDecodeBuf;
int nChSamples = m_nBlockArea;
int nRepCount = m_nBlockArea;
do
{
sbyte nBase = m_ptrDecodeBuf[ptrNext + nChSamples];
m_ptrDecodeBuf[ptrNext] += nBase;
m_ptrDecodeBuf[ptrNext + nChSamples * 2] += nBase;
ptrNext ++;
}
while (0 != --nRepCount);
}
void ColorOperation1101 ()
{
int ptrNext = 0; //m_ptrDecodeBuf;
int nChSamples = m_nBlockArea * 2;
int nRepCount = m_nBlockArea;
do
{
sbyte nBase = m_ptrDecodeBuf[ptrNext + nChSamples];
m_ptrDecodeBuf[ptrNext++] += nBase;
}
while (0 != --nRepCount);
}
void ColorOperation1110 ()
{
int ptrNext = 0; // m_ptrDecodeBuf;
int nChSamples = m_nBlockArea;
int nRepCount = m_nBlockArea;
do
{
sbyte nBase = m_ptrDecodeBuf[ptrNext + nChSamples * 2];
m_ptrDecodeBuf[ptrNext++ + nChSamples] += nBase;
}
while (0 != --nRepCount);
}
void ColorOperation1111 ()
{
int ptrNext = 0; // m_ptrDecodeBuf;
int nChSamples = m_nBlockArea;
int nRepCount = m_nBlockArea;
do
{
sbyte nBase = m_ptrDecodeBuf[ptrNext + nChSamples * 2];
m_ptrDecodeBuf[ptrNext] += nBase;
m_ptrDecodeBuf[ptrNext + nChSamples] += nBase;
ptrNext ++;
}
while (0 != --nRepCount);
}
void ArrangeAndIQuantumize (int ptrSrcData, int ptrCoefficient)
{
int i, j, k;
float rMatrixScale = (float)(512.0 / m_nBlockSize);
var pIQParamPtr = new int[2];
for (i = 0; i < 2; ++i)
{
float rScale = 1.0f;
if (0 != (m_ptrLossyOps[ptrCoefficient+i] & 1))
{
rScale = 1.5f;
}
rScale *= (float)Math.Pow (2.0, (m_ptrLossyOps[ptrCoefficient+i] / 2));
rScale *= rMatrixScale;
int pIQParamTable = i * m_nBlockArea; // m_ptrIQParamTable
pIQParamPtr[i] = pIQParamTable; // m_ptrIQParamBuf
for (j = 0; j < m_nBlockArea; ++j)
{
m_ptrIQParamBuf[pIQParamPtr[i]+j] = (float)(rScale * (m_ptrIQParamTable[pIQParamTable+j] + 1));
}
}
if (CvType.DCT_ERI == m_info.Transformation)
{
m_ptrImageBuf[ptrSrcData+m_nBlockArea] += m_ptrImageBuf[ptrSrcData];
m_ptrImageBuf[ptrSrcData+m_nBlockArea*2] += m_ptrImageBuf[ptrSrcData];
m_ptrImageBuf[ptrSrcData+m_nBlockArea*3] += m_ptrImageBuf[ptrSrcData];
if (EriSampling.YUV_4_4_4 == m_info.SamplingFlags)
{
k = m_nBlockArea * 4;
j = 1;
}
else
{
k = m_nBlockArea * 6;
j = 3;
}
for (i = j; i < m_nChannelCount; ++i)
{
m_ptrImageBuf[ptrSrcData + k + m_nBlockArea] += m_ptrImageBuf[ptrSrcData+k];
m_ptrImageBuf[ptrSrcData + k + m_nBlockArea*2] += m_ptrImageBuf[ptrSrcData+k];
m_ptrImageBuf[ptrSrcData + k + m_nBlockArea*3] += m_ptrImageBuf[ptrSrcData+k];
k += m_nBlockArea * 4;
}
}
var pIQParam = new int[16]; // within m_ptrIQParamBuf
pIQParam[0] = pIQParam[1] = pIQParam[2] = pIQParam[3] = pIQParamPtr[0];
if (EriSampling.YUV_4_4_4 == m_info.SamplingFlags)
{
for (i = 4; i < 12; ++i)
{
pIQParam[i] = pIQParamPtr[1];
}
for (i = 12; i < m_nBlocksetCount; ++i)
{
pIQParam[i] = pIQParamPtr[0];
}
}
else
{
pIQParam[4] = pIQParam[5] = pIQParamPtr[1];
for (i = 6; i < m_nBlocksetCount; ++i)
{
pIQParam[i] = pIQParamPtr[0];
}
}
int pArrange = m_pArrangeTable[0];
for (i = 0; i < m_nBlocksetCount; ++i)
{
float[] ptrDst = m_ptrBlocksetBuf[i];
Erisa.ConvertArraySByteToFloat (m_ptrMatrixBuf, m_ptrImageBuf, ptrSrcData, m_nBlockArea);
ptrSrcData += m_nBlockArea;
Erisa.VectorMultiply (m_ptrMatrixBuf, m_ptrIQParamBuf, pIQParam[i], m_nBlockArea);
for (j = 0; j < m_nBlockArea; ++j)
{
ptrDst[m_ptrTable[pArrange + j]] = m_ptrMatrixBuf[j];
}
}
}
void MatrixIDCT8x8 (float[] matrix, int index)
{
for (int i = 0; i < m_nBlocksetCount; i ++ )
{
Erisa.FastIDCT8x8 (m_ptrBlocksetBuf[i]);
}
}
void MatrixILOT8x8 (float[] matrix, int ptrVertBufLOT)
{
int i, j, k, l = 0;
int ptrHorzBufLOT = 0; // m_ptrHorzBufLOT;
for (i = 0; i < 2; ++i)
{
for (j = 0; j < 2; ++j)
{
Erisa.FastILOT8x8 (m_ptrBlocksetBuf[l], m_ptrHorzBufLOT, ptrHorzBufLOT, matrix, ptrVertBufLOT + j * m_nBlockArea);
++l;
}
ptrHorzBufLOT += m_nBlockArea;
}
ptrVertBufLOT += m_nBlockArea * 2;
if (m_nChannelCount < 3)
return;
if (EriSampling.YUV_4_4_4 == m_info.SamplingFlags)
{
for (k = 0; k < 2; k++)
{
for (i = 0; i < 2; i++)
{
for (j = 0; j < 2; j++)
{
Erisa.FastILOT8x8 (m_ptrBlocksetBuf[l], m_ptrHorzBufLOT, ptrHorzBufLOT, matrix, ptrVertBufLOT + j * m_nBlockArea );
l++;
}
ptrHorzBufLOT += m_nBlockArea;
}
ptrVertBufLOT += m_nBlockArea * 2;
}
}
else if (EriSampling.YUV_4_1_1 == m_info.SamplingFlags)
{
for (k = 0; k < 2; k++)
{
Erisa.FastILOT8x8 (m_ptrBlocksetBuf[l], m_ptrHorzBufLOT, ptrHorzBufLOT, matrix, ptrVertBufLOT);
l++;
ptrHorzBufLOT += m_nBlockArea;
ptrVertBufLOT += m_nBlockArea;
}
}
else
return;
if (m_nChannelCount < 4)
return;
for (i = 0; i < 2; i++)
{
for (j = 0; j < 2; j++)
{
Erisa.FastILOT8x8 (m_ptrBlocksetBuf[l], m_ptrHorzBufLOT, ptrHorzBufLOT, matrix, ptrVertBufLOT + j * m_nBlockArea);
l++;
}
ptrHorzBufLOT += m_nBlockArea;
}
ptrVertBufLOT += m_nBlockArea * 2;
}
void BlockScaling444 (int x, int y)
{
int nBlockOffset = m_info.Transformation == CvType.LOT_ERI ? 1 : 0;
for (int i = 0; i < 2; i++)
{
int yPos = y * 2 + i - nBlockOffset;
if (yPos < 0)
{
continue;
}
for (int j = 0; j < 2; j++)
{
int xPos = x * 2 + j - nBlockOffset;
if (xPos < 0)
continue;
int k = i * 2 + j;
if (null != m_src_frame)
{
Erisa.ConvertArrayFloatToSByte (m_ptrDecodeBuf, m_ptrBlocksetBuf[k], m_nBlockArea);
}
else
{
Erisa.ConvertArrayFloatToByte (m_ptrDecodeBuf, m_ptrBlocksetBuf[k], m_nBlockArea);
}
StoreYUVImageChannel (xPos, yPos, 0);
if (m_nChannelCount < 3)
{
continue;
}
Erisa.ConvertArrayFloatToSByte (m_ptrDecodeBuf, m_ptrBlocksetBuf[k + 4], m_nBlockArea );
StoreYUVImageChannel (xPos, yPos, 1);
Erisa.ConvertArrayFloatToSByte (m_ptrDecodeBuf, m_ptrBlocksetBuf[k + 8], m_nBlockArea);
StoreYUVImageChannel (xPos, yPos, 2);
if (m_nChannelCount < 4)
continue;
if (null != m_src_frame)
{
Erisa.ConvertArrayFloatToSByte (m_ptrDecodeBuf, m_ptrBlocksetBuf[k + 12], m_nBlockArea);
}
else
{
Erisa.ConvertArrayFloatToByte (m_ptrDecodeBuf, m_ptrBlocksetBuf[k + 12], m_nBlockArea);
}
StoreYUVImageChannel (xPos, yPos, 3);
}
}
}
void BlockScaling411 (int x, int y)
{
int nBlockOffset = m_info.Transformation == CvType.LOT_ERI ? 1 : 0;
for (int i = 0; i < 2; i++)
{
int yPos = y * 2 + i - nBlockOffset * 2;
if (yPos < 0)
continue;
for (int j = 0; j < 2; j++)
{
int xPos = x * 2 + j - nBlockOffset * 2;
if (xPos < 0)
continue;
int k = i * 2 + j;
if (null != m_src_frame)
{
Erisa.ConvertArrayFloatToSByte (m_ptrDecodeBuf, m_ptrBlocksetBuf[k], m_nBlockArea );
}
else
{
Erisa.ConvertArrayFloatToByte (m_ptrDecodeBuf, m_ptrBlocksetBuf[k], m_nBlockArea );
}
StoreYUVImageChannel (xPos, yPos, 0);
if (m_nChannelCount < 4)
continue;
if (null != m_src_frame)
{
Erisa.ConvertArrayFloatToSByte (m_ptrDecodeBuf, m_ptrBlocksetBuf[k + 6], m_nBlockArea);
}
else
{
Erisa.ConvertArrayFloatToByte (m_ptrDecodeBuf, m_ptrBlocksetBuf[k + 6], m_nBlockArea);
}
StoreYUVImageChannel (xPos, yPos, 3);
}
}
if (m_nChannelCount < 3)
return;
y -= nBlockOffset;
x -= nBlockOffset;
if (y < 0 || x < 0)
return;
Erisa.ConvertArrayFloatToSByte (m_ptrDecodeBuf, m_ptrBlocksetBuf[4], m_nBlockArea);
StoreYUVImageChannelX2 (x, y, 1);
Erisa.ConvertArrayFloatToSByte (m_ptrDecodeBuf, m_ptrBlocksetBuf[5], m_nBlockArea);
StoreYUVImageChannelX2 (x, y, 2);
}
void ConvertImageYUVtoRGB (bool differential = false)
{
if (m_nChannelCount < 3)
return;
int nPixelBytes = m_nYUVPixelBytes;
int nWidth = m_nDstWidth;
int nHeight = m_nDstHeight;
int ptrYUVLine = 0; // m_ptrYUVImage
for (uint y = 0; y < nHeight; ++y)
{
int ptrYUVPixel = ptrYUVLine;
if (differential)
{
for (uint x = 0; x < nWidth; ++x)
{
int Cy = m_ptrYUVImage[ptrYUVPixel];
int u = m_ptrYUVImage[ptrYUVPixel+1];
int v = m_ptrYUVImage[ptrYUVPixel+2];
int b = Cy + ((u * 7) >> 2) + 0x80;
int g = Cy - ((u * 3 + v * 6) >> 3) + 0x80;
int r = Cy + ((v * 3) >> 1) + 0x80;
if ((uint)b > 0xFF)
{
b = (~b >> 31) & 0xFF;
}
m_ptrYUVImage[ptrYUVPixel] = (sbyte)(b - 0x80);
if ((uint)g > 0xFF)
{
g = (~g >> 31) & 0xFF;
}
m_ptrYUVImage[ptrYUVPixel+1] = (sbyte)(g - 0x80);
if ((uint)r > 0xFF)
{
r = (~r >> 31) & 0xFF;
}
m_ptrYUVImage[ptrYUVPixel+2] = (sbyte)(r - 0x80);
ptrYUVPixel += nPixelBytes;
}
}
else
{
for (uint x = 0; x < nWidth; ++x)
{
int Cy = (byte)m_ptrYUVImage[ptrYUVPixel];
int u = m_ptrYUVImage[ptrYUVPixel+1];
int v = m_ptrYUVImage[ptrYUVPixel+2];
int b = Cy + ((u * 7) >> 2);
int g = Cy - ((u * 3 + v * 6) >> 3);
int r = Cy + ((v * 3) >> 1);
if ((uint)b > 0xFF)
{
b = (~b >> 31) & 0xFF;
}
m_ptrYUVImage[ptrYUVPixel] = (sbyte)b;
if ((uint)g > 0xFF)
{
g = (~g >> 31) & 0xFF;
}
m_ptrYUVImage[ptrYUVPixel+1] = (sbyte)g;
if ((uint)r > 0xFF)
{
r = (~r >> 31) & 0xFF;
}
m_ptrYUVImage[ptrYUVPixel+2] = (sbyte)r;
ptrYUVPixel += nPixelBytes;
}
}
ptrYUVLine += m_nYUVLineBytes;
}
}
void StoreYUVImageChannel (int xBlock, int yBlock, int iChannel)
{
int nPixelBytes = m_nYUVPixelBytes;
int nBlockSize = m_nBlockSize;
int nBlockArea = m_nBlockArea;
int ptrDstYUV = (yBlock * nBlockSize * m_nYUVLineBytes)
+ (xBlock * nBlockSize * nPixelBytes) + iChannel;
int ptrSrcYUV = 0; // m_ptrDecodeBuf;
for (int y = 0; y < nBlockSize; y++)
{
int ptrDstLine = ptrDstYUV;
for (int x = 0; x < nBlockSize; x++)
{
m_ptrYUVImage[ptrDstLine] = m_ptrDecodeBuf[ptrSrcYUV++];
ptrDstLine += nPixelBytes;
}
ptrDstYUV += m_nYUVLineBytes;
}
}
void StoreYUVImageChannelX2 (int xBlock, int yBlock, int iChannel)
{
int nPixelBytes = m_nYUVPixelBytes;
int nLineBytes = m_nYUVLineBytes;
int nBlockSize = m_nBlockSize;
int nBlockArea = m_nBlockArea;
int ptrDstYUV = (yBlock * nBlockSize * 2 * nLineBytes)
+ (xBlock * nBlockSize * 2 * nPixelBytes) + iChannel;
int ptrSrcYUV = 0; // m_ptrDecodeBuf;
for (int y = 0; y < nBlockSize; y++)
{
int ptrDstLine = ptrDstYUV;
for (int x = 0; x < nBlockSize; x++)
{
sbyte d = m_ptrDecodeBuf[ptrSrcYUV++];
m_ptrYUVImage[ptrDstLine + nLineBytes + nPixelBytes] = d;
m_ptrYUVImage[ptrDstLine + nLineBytes] = d;
m_ptrYUVImage[ptrDstLine + nPixelBytes] = d;
m_ptrYUVImage[ptrDstLine] = d;
ptrDstLine += nPixelBytes * 2;
}
ptrDstYUV += nLineBytes * 2;
}
}
}
internal static class Erina
{
public const int CodeFlag = int.MinValue;
public const int HuffmanEscape = 0x7FFFFFFF;
public const int HuffmanNull = 0x8000;
public const int HuffmanMax = 0x4000;
public const int HuffmanRoot = 0x200;
}
internal class HuffmanNode
{
public ushort Weight;
public ushort Parent;
public int ChildCode;
public void CopyFrom (HuffmanNode other)
{
this.Weight = other.Weight;
this.Parent = other.Parent;
this.ChildCode = other.ChildCode;
}
}
internal class HuffmanTree
{
public HuffmanNode[] m_hnTree = new HuffmanNode[0x201];
public int[] m_iSymLookup = new int[0x100];
public int m_iEscape;
public int m_iTreePointer;
public HuffmanTree ()
{
Initialize();
}
public void Initialize ()
{
for (int i = 0; i < 0x201; i++)
{
m_hnTree[i] = new HuffmanNode();
}
for (int i = 0; i < 0x100; i++)
{
m_iSymLookup[i] = Erina.HuffmanNull;
}
m_iEscape = Erina.HuffmanNull;
m_iTreePointer = Erina.HuffmanRoot;
m_hnTree[Erina.HuffmanRoot].Weight = 0;
m_hnTree[Erina.HuffmanRoot].Parent = Erina.HuffmanNull;
m_hnTree[Erina.HuffmanRoot].ChildCode = Erina.HuffmanNull;
}
public void IncreaseOccuredCount (int iEntry)
{
m_hnTree[iEntry].Weight++;
Normalize (iEntry);
if (m_hnTree[Erina.HuffmanRoot].Weight >= Erina.HuffmanMax)
{
HalfAndRebuild();
}
}
private void RecountOccuredCount (int iParent)
{
int iChild = m_hnTree[iParent].ChildCode;
m_hnTree[iParent].Weight = (ushort)(m_hnTree[iChild].Weight + m_hnTree[iChild + 1].Weight);
}
private void Normalize (int iEntry)
{
while (iEntry < Erina.HuffmanRoot)
{
int iSwap = iEntry + 1;
ushort weight = m_hnTree[iEntry].Weight;
while (iSwap < Erina.HuffmanRoot)
{
if (m_hnTree[iSwap].Weight >= weight)
break;
++iSwap;
}
if (iEntry == --iSwap)
{
iEntry = m_hnTree[iEntry].Parent;
RecountOccuredCount (iEntry);
continue;
}
int iChild, nCode;
if (0 == (m_hnTree[iEntry].ChildCode & Erina.CodeFlag))
{
iChild = m_hnTree[iEntry].ChildCode;
m_hnTree[iChild].Parent = (ushort)iSwap;
m_hnTree[iChild + 1].Parent = (ushort)iSwap;
}
else
{
nCode = m_hnTree[iEntry].ChildCode & ~Erina.CodeFlag;
if (nCode != Erina.HuffmanEscape)
m_iSymLookup[nCode & 0xFF] = iSwap;
else
m_iEscape = iSwap;
}
if (0 == (m_hnTree[iSwap].ChildCode & Erina.CodeFlag))
{
iChild = m_hnTree[iSwap].ChildCode;
m_hnTree[iChild].Parent = (ushort)iEntry;
m_hnTree[iChild+1].Parent = (ushort)iEntry;
}
else
{
nCode = m_hnTree[iSwap].ChildCode & ~Erina.CodeFlag;
if (nCode != Erina.HuffmanEscape)
m_iSymLookup[nCode & 0xFF] = iEntry;
else
m_iEscape = iEntry;
}
var node = m_hnTree[iSwap]; // XXX
ushort iEntryParent = m_hnTree[iEntry].Parent;
ushort iSwapParent = m_hnTree[iSwap].Parent;
m_hnTree[iSwap] = m_hnTree[iEntry];
m_hnTree[iEntry] = node;
m_hnTree[iSwap].Parent = iSwapParent;
m_hnTree[iEntry].Parent = iEntryParent;
RecountOccuredCount (iSwapParent);
iEntry = iSwapParent;
}
}
public void AddNewEntry (int nNewCode)
{
if (m_iTreePointer > 0)
{
m_iTreePointer -= 2;
int i = m_iTreePointer;
var phnNew = m_hnTree[i];
phnNew.Weight = 1;
phnNew.ChildCode = Erina.CodeFlag | nNewCode;
m_iSymLookup[nNewCode & 0xFF] = i;
var phnRoot = m_hnTree[Erina.HuffmanRoot];
if (phnRoot.ChildCode != Erina.HuffmanNull)
{
var phnParent = m_hnTree[i + 2];
var phnChild = m_hnTree[i + 1];
phnChild.CopyFrom (phnParent); // m_hnTree[i + 1] = m_hnTree[i + 2];
if (0 != (phnChild.ChildCode & Erina.CodeFlag))
{
int nCode = phnChild.ChildCode & ~Erina.CodeFlag;
if (nCode != Erina.HuffmanEscape)
m_iSymLookup[nCode & 0xFF] = i + 1;
else
m_iEscape = i + 1;
}
phnParent.Weight = (ushort)(phnNew.Weight + phnChild.Weight);
phnParent.Parent = phnChild.Parent;
phnParent.ChildCode = i;
phnNew.Parent = phnChild.Parent = (ushort)(i + 2);
Normalize (i + 2);
}
else
{
phnNew.Parent = Erina.HuffmanRoot;
m_iEscape = i + 1;
var phnEscape = m_hnTree[m_iEscape];
phnEscape.Weight = 1;
phnEscape.Parent = Erina.HuffmanRoot;
phnEscape.ChildCode = Erina.CodeFlag | Erina.HuffmanEscape;
phnRoot.Weight = 2;
phnRoot.ChildCode = i;
}
}
else
{
int i = m_iTreePointer;
var phnEntry = m_hnTree[i];
if (phnEntry.ChildCode == (Erina.CodeFlag | Erina.HuffmanEscape))
{
phnEntry = m_hnTree[i + 1];
}
phnEntry.ChildCode = Erina.CodeFlag | nNewCode;
}
}
private void HalfAndRebuild ()
{
int i;
int iNextEntry = Erina.HuffmanRoot;
for (i = Erina.HuffmanRoot - 1; i >= m_iTreePointer; i--)
{
if (0 != (m_hnTree[i].ChildCode & Erina.CodeFlag))
{
m_hnTree[i].Weight = (ushort)((m_hnTree[i].Weight + 1) >> 1);
m_hnTree[iNextEntry--].CopyFrom (m_hnTree[i]);
}
}
++iNextEntry;
int iChild, nCode;
i = m_iTreePointer;
for (;;)
{
m_hnTree[i].CopyFrom (m_hnTree[iNextEntry]);
m_hnTree[i + 1].CopyFrom (m_hnTree[iNextEntry + 1]);
iNextEntry += 2;
var phnChild1 = m_hnTree[i];
var phnChild2 = m_hnTree[i + 1];
if (0 == (phnChild1.ChildCode & Erina.CodeFlag))
{
iChild = phnChild1.ChildCode;
m_hnTree[iChild].Parent = (ushort)i;
m_hnTree[iChild + 1].Parent = (ushort)i;
}
else
{
nCode = phnChild1.ChildCode & ~Erina.CodeFlag;
if (Erina.HuffmanEscape == nCode)
m_iEscape = i;
else
m_iSymLookup[nCode & 0xFF] = i;
}
if (0 == (phnChild2.ChildCode & Erina.CodeFlag))
{
iChild = phnChild2.ChildCode;
m_hnTree[iChild].Parent = (ushort)(i + 1);
m_hnTree[iChild + 1].Parent = (ushort)(i + 1);
}
else
{
nCode = phnChild2.ChildCode & ~Erina.CodeFlag;
if (Erina.HuffmanEscape == nCode)
m_iEscape = i + 1;
else
m_iSymLookup[nCode & 0xFF] = i + 1;
}
ushort weight = (ushort)(phnChild1.Weight + phnChild2.Weight);
if (iNextEntry <= Erina.HuffmanRoot)
{
int j = iNextEntry;
for (;;)
{
if (weight <= m_hnTree[j].Weight)
{
m_hnTree[j - 1].Weight = weight;
m_hnTree[j - 1].ChildCode = i;
break;
}
m_hnTree[j - 1].CopyFrom (m_hnTree[j]);
if (++j > Erina.HuffmanRoot)
{
m_hnTree[Erina.HuffmanRoot].Weight = weight;
m_hnTree[Erina.HuffmanRoot].ChildCode = i;
break;
}
}
--iNextEntry;
}
else
{
m_hnTree[Erina.HuffmanRoot].Weight = weight;
m_hnTree[Erina.HuffmanRoot].Parent = Erina.HuffmanNull;
m_hnTree[Erina.HuffmanRoot].ChildCode = i;
phnChild1.Parent = Erina.HuffmanRoot;
phnChild2.Parent = Erina.HuffmanRoot;
break;
}
i += 2;
}
}
}
internal class RLEDecodeContext : ERISADecodeContext
{
protected int m_flgZero;
protected uint m_nLength;
public RLEDecodeContext (uint nBufferingSize) : base (nBufferingSize)
{
}
public void InitGammaContext ()
{
m_flgZero = GetABit();
m_nLength = 0;
}
public override uint DecodeBytes (Array ptrDst, uint nCount)
{
return DecodeGammaCodeBytes (ptrDst as sbyte[], nCount);
}
public uint DecodeGammaCodeBytes (sbyte[] ptrDst, uint nCount)
{
int dst = 0;
uint nDecoded = 0;
if (m_nLength == 0)
{
m_nLength = (uint)GetGammaCode();
if (0 == m_nLength)
{
return nDecoded;
}
}
for (;;)
{
uint nRepeat = Math.Min (m_nLength, nCount);
Debug.Assert (nRepeat > 0);
m_nLength -= nRepeat;
nCount -= nRepeat;
if (0 == m_flgZero)
{
nDecoded += nRepeat;
do
{
ptrDst[dst++] = 0;
}
while (0 != --nRepeat);
}
else
{
do
{
sbyte nSign = (sbyte)GetABit();
sbyte nCode = (sbyte)GetGammaCode();
if (0 == nCode)
{
return nDecoded;
}
nDecoded ++;
ptrDst[dst++] = (sbyte)((nCode ^ nSign) - nSign);
}
while (0 != --nRepeat);
}
if (0 == nCount)
{
if (0 == m_nLength)
{
m_flgZero = ~m_flgZero;
}
return nDecoded;
}
m_flgZero = ~m_flgZero;
m_nLength = (uint) GetGammaCode();
if (0 == m_nLength)
{
return nDecoded;
}
}
}
protected int GetGammaCode()
{
if (!PrefetchBuffer())
{
return 0;
}
m_nIntBufCount--;
uint dwIntBuf = m_dwIntBuffer;
m_dwIntBuffer <<= 1;
if (0 == (dwIntBuf & 0x80000000))
{
return 1;
}
if (!PrefetchBuffer())
{
return 0;
}
int nCode = 0;
if ((0 != (~m_dwIntBuffer & 0x55000000)) && (m_nIntBufCount >= 8))
{
uint i = (m_dwIntBuffer >> 24) << 1;
nCode = nGammaCodeLookup[i];
int nBitCount = nGammaCodeLookup[i + 1];
Debug.Assert (nBitCount <= m_nIntBufCount);
Debug.Assert (nCode > 0);
m_nIntBufCount -= nBitCount;
m_dwIntBuffer <<= nBitCount;
return nCode;
}
int nBase = 2;
for (;;)
{
if (m_nIntBufCount >= 2)
{
dwIntBuf = m_dwIntBuffer;
m_dwIntBuffer <<= 2;
nCode = (int)(((uint)nCode << 1) | (dwIntBuf >> 31));
m_nIntBufCount -= 2;
if (0 == (dwIntBuf & 0x40000000))
{
return nCode + nBase;
}
nBase <<= 1;
}
else
{
if (!PrefetchBuffer())
{
return 0;
}
nCode = (int)(((uint)nCode << 1) | (m_dwIntBuffer >> 31));
m_nIntBufCount --;
m_dwIntBuffer <<= 1;
if (!PrefetchBuffer())
{
return 0;
}
dwIntBuf = m_dwIntBuffer;
m_nIntBufCount --;
m_dwIntBuffer <<= 1;
if (0 == (dwIntBuf & 0x80000000))
{
return nCode + nBase;
}
nBase <<= 1;
}
}
}
static readonly byte[] nGammaCodeLookup = new byte[0x200]
{
2, 2, 2, 2, 2, 2, 2, 2, 2, 2, 2, 2, 2, 2, 2, 2,
2, 2, 2, 2, 2, 2, 2, 2, 2, 2, 2, 2, 2, 2, 2, 2,
2, 2, 2, 2, 2, 2, 2, 2, 2, 2, 2, 2, 2, 2, 2, 2,
2, 2, 2, 2, 2, 2, 2, 2, 2, 2, 2, 2, 2, 2, 2, 2,
2, 2, 2, 2, 2, 2, 2, 2, 2, 2, 2, 2, 2, 2, 2, 2,
2, 2, 2, 2, 2, 2, 2, 2, 2, 2, 2, 2, 2, 2, 2, 2,
2, 2, 2, 2, 2, 2, 2, 2, 2, 2, 2, 2, 2, 2, 2, 2,
2, 2, 2, 2, 2, 2, 2, 2, 2, 2, 2, 2, 2, 2, 2, 2,
4, 4, 4, 4, 4, 4, 4, 4, 4, 4, 4, 4, 4, 4, 4, 4,
4, 4, 4, 4, 4, 4, 4, 4, 4, 4, 4, 4, 4, 4, 4, 4,
8, 6, 8, 6, 8, 6, 8, 6, 16, 8, 0xff, 0xff, 17, 8, 0xff, 0xff,
9, 6, 9, 6, 9, 6, 9, 6, 18, 8, 0xff, 0xff, 19, 8, 0xff, 0xff,
5, 4, 5, 4, 5, 4, 5, 4, 5, 4, 5, 4, 5, 4, 5, 4,
5, 4, 5, 4, 5, 4, 5, 4, 5, 4, 5, 4, 5, 4, 5, 4,
10, 6, 10, 6, 10, 6, 10, 6, 20, 8, 0xff, 0xff, 21, 8, 0xff, 0xff,
11, 6, 11, 6, 11, 6, 11, 6, 22, 8, 0xff, 0xff, 23, 8, 0xff, 0xff,
3, 2, 3, 2, 3, 2, 3, 2, 3, 2, 3, 2, 3, 2, 3, 2,
3, 2, 3, 2, 3, 2, 3, 2, 3, 2, 3, 2, 3, 2, 3, 2,
3, 2, 3, 2, 3, 2, 3, 2, 3, 2, 3, 2, 3, 2, 3, 2,
3, 2, 3, 2, 3, 2, 3, 2, 3, 2, 3, 2, 3, 2, 3, 2,
3, 2, 3, 2, 3, 2, 3, 2, 3, 2, 3, 2, 3, 2, 3, 2,
3, 2, 3, 2, 3, 2, 3, 2, 3, 2, 3, 2, 3, 2, 3, 2,
3, 2, 3, 2, 3, 2, 3, 2, 3, 2, 3, 2, 3, 2, 3, 2,
3, 2, 3, 2, 3, 2, 3, 2, 3, 2, 3, 2, 3, 2, 3, 2,
6, 4, 6, 4, 6, 4, 6, 4, 6, 4, 6, 4, 6, 4, 6, 4,
6, 4, 6, 4, 6, 4, 6, 4, 6, 4, 6, 4, 6, 4, 6, 4,
12, 6, 12, 6, 12, 6, 12, 6, 24, 8, 0xff, 0xff, 25, 8, 0xff, 0xff,
13, 6, 13, 6, 13, 6, 13, 6, 26, 8, 0xff, 0xff, 27, 8, 0xff, 0xff,
7, 4, 7, 4, 7, 4, 7, 4, 7, 4, 7, 4, 7, 4, 7, 4,
7, 4, 7, 4, 7, 4, 7, 4, 7, 4, 7, 4, 7, 4, 7, 4,
14, 6, 14, 6, 14, 6, 14, 6, 28, 8, 0xff, 0xff, 29, 8, 0xff, 0xff,
15, 6, 15, 6, 15, 6, 15, 6, 30, 8, 0xff, 0xff, 31, 8, 0xff, 0xff
};
}
internal class HuffmanDecodeContext : RLEDecodeContext
{
int m_dwERINAFlags;
HuffmanTree m_pLastHuffmanTree;
HuffmanTree[] m_ppHuffmanTree;
// ERINAEncodingFlag
public const int efERINAOrder0 = 0x0000;
public const int efERINAOrder1 = 0x0001;
public HuffmanDecodeContext (uint nBufferingSize) : base (nBufferingSize)
{
}
public void PrepareToDecodeERINACode (int flags = efERINAOrder1)
{
int i;
if (null == m_ppHuffmanTree)
{
m_ppHuffmanTree = new HuffmanTree[0x101];
}
m_dwERINAFlags = flags;
m_nLength = 0;
if (efERINAOrder0 == flags)
{
m_ppHuffmanTree[0] = new HuffmanTree();
m_ppHuffmanTree[0x100] = new HuffmanTree();
for (i = 1; i < 0x100; i++)
{
m_ppHuffmanTree[i] = m_ppHuffmanTree[0];
}
}
else
{
for (i = 0; i < 0x101; i++)
{
m_ppHuffmanTree[i] = new HuffmanTree();
}
}
m_pLastHuffmanTree = m_ppHuffmanTree[0];
}
public override uint DecodeBytes (Array ptrDst, uint nCount)
{
return DecodeErinaCodeBytes (ptrDst as sbyte[], nCount);
}
public uint DecodeErinaCodeBytes (sbyte[] ptrDst, uint nCount)
{
var tree = m_pLastHuffmanTree;
int symbol, length;
uint i = 0;
if (m_nLength > 0)
{
length = (int)Math.Min (m_nLength, nCount);
m_nLength -= (uint)length;
do
{
ptrDst[i++] = 0;
}
while (0 != --length);
}
while (i < nCount)
{
symbol = GetHuffmanCode (tree);
if (Erina.HuffmanEscape == symbol)
{
break;
}
ptrDst[i++] = (sbyte)symbol;
if (0 == symbol)
{
length = GetLengthHuffman (m_ppHuffmanTree[0x100]);
if (Erina.HuffmanEscape == length)
{
break;
}
if (0 != --length)
{
m_nLength = (uint)length;
if (i + length > nCount)
{
length = (int)(nCount - i);
}
m_nLength -= (uint)length;
while (length > 0)
{
ptrDst[i++] = 0;
--length;
}
}
}
tree = m_ppHuffmanTree[symbol & 0xFF];
}
m_pLastHuffmanTree = tree;
return i;
}
private int GetLengthHuffman (HuffmanTree tree)
{
int nCode;
if (tree.m_iEscape != Erina.HuffmanNull)
{
int iEntry = Erina.HuffmanRoot;
int iChild = tree.m_hnTree[Erina.HuffmanRoot].ChildCode;
do
{
if (!PrefetchBuffer())
{
return Erina.HuffmanEscape;
}
iEntry = iChild + (int)(m_dwIntBuffer >> 31);
iChild = tree.m_hnTree[iEntry].ChildCode;
m_dwIntBuffer <<= 1;
--m_nIntBufCount;
}
while (0 == (iChild & Erina.CodeFlag));
if ((m_dwERINAFlags != efERINAOrder0) ||
(tree.m_hnTree[Erina.HuffmanRoot].Weight < Erina.HuffmanMax-1))
{
tree.IncreaseOccuredCount (iEntry);
}
nCode = iChild & ~Erina.CodeFlag;
if (nCode != Erina.HuffmanEscape)
{
return nCode;
}
}
nCode = GetGammaCode();
if (-1 == nCode)
{
return Erina.HuffmanEscape;
}
tree.AddNewEntry (nCode);
return nCode;
}
public int GetHuffmanCode (HuffmanTree tree)
{
int nCode;
if (tree.m_iEscape != Erina.HuffmanNull)
{
int iEntry = Erina.HuffmanRoot;
int iChild = tree.m_hnTree[Erina.HuffmanRoot].ChildCode;
do
{
if (!PrefetchBuffer())
{
return Erina.HuffmanEscape;
}
iEntry = iChild + (int)(m_dwIntBuffer >> 31);
iChild = tree.m_hnTree[iEntry].ChildCode;
m_dwIntBuffer <<= 1;
--m_nIntBufCount;
}
while (0 == (iChild & Erina.CodeFlag));
if ((m_dwERINAFlags != efERINAOrder0) ||
(tree.m_hnTree[Erina.HuffmanRoot].Weight < Erina.HuffmanMax-1))
{
tree.IncreaseOccuredCount (iEntry);
}
nCode = iChild & ~Erina.CodeFlag;
if (nCode != Erina.HuffmanEscape)
{
return nCode;
}
}
nCode = (int)GetNBits (8);
tree.AddNewEntry (nCode);
return nCode;
}
}
internal class ProbDecodeContext : RLEDecodeContext
{
protected uint m_dwCodeRegister;
protected uint m_dwAugendRegister;
protected int m_nPostBitCount;
protected ErisaProbModel m_pPhraseLenProb = new ErisaProbModel();
protected ErisaProbModel m_pPhraseIndexProb = new ErisaProbModel();
protected ErisaProbModel m_pRunLenProb = new ErisaProbModel();
protected ErisaProbModel m_pLastERISAProb;
protected ErisaProbModel[] m_ppTableERISA;
public ProbDecodeContext (uint nBufferingSize) : base (nBufferingSize)
{
}
public void PrepareToDecodeERISACode ()
{
if (null == m_ppTableERISA)
{
m_ppTableERISA = new ErisaProbModel[0x101];
for (int i = 0; i < 0x101; ++i)
{
m_ppTableERISA[i] = new ErisaProbModel();
m_ppTableERISA[i].Initialize();
}
}
m_pLastERISAProb = m_ppTableERISA[0];
m_pPhraseLenProb.Initialize();
m_pPhraseIndexProb.Initialize();
m_pRunLenProb.Initialize();
InitializeERISACode();
}
public override uint DecodeBytes (Array ptrDst, uint nCount)
{
return DecodeERISACodeBytes (ptrDst as sbyte[], nCount);
}
uint DecodeERISACodeBytes (sbyte[] ptrDst, uint nCount)
{
var pProb = m_pLastERISAProb;
int nSymbol, iSym;
uint i = 0;
while (i < nCount)
{
if (m_nLength > 0)
{
uint nCurrent = nCount - i;
if (nCurrent > m_nLength)
nCurrent = m_nLength;
m_nLength -= nCurrent;
for (uint j = 0; j < nCurrent; j++)
{
ptrDst[i++] = 0;
}
continue;
}
iSym = DecodeERISACodeIndex (pProb);
if (iSym < 0)
break;
nSymbol = pProb.SymTable[iSym].Symbol;
pProb.IncreaseSymbol (iSym);
ptrDst[i++] = (sbyte)nSymbol;
if (0 == nSymbol)
{
iSym = DecodeERISACodeIndex (m_pRunLenProb);
if (iSym < 0)
break;
m_nLength = (uint)m_pRunLenProb.SymTable[iSym].Symbol;
m_pRunLenProb.IncreaseSymbol (iSym);
}
pProb = m_ppTableERISA[nSymbol & 0xFF];
}
m_pLastERISAProb = pProb;
return i;
}
void InitializeERISACode ()
{
m_nLength = 0;
m_dwCodeRegister = GetNBits (32);
m_dwAugendRegister = 0xFFFF;
m_nPostBitCount = 0;
}
public int DecodeERISACode (ErisaProbModel pModel)
{
int iSym = DecodeERISACodeIndex (pModel);
int nSymbol = ErisaProbModel.EscCode;
if (iSym >= 0)
{
nSymbol = pModel.SymTable[iSym].Symbol;
pModel.IncreaseSymbol (iSym);
}
return nSymbol;
}
protected int DecodeERISACodeIndex (ErisaProbModel pModel)
{
uint dwAcc = m_dwCodeRegister * pModel.TotalCount / m_dwAugendRegister;
if (dwAcc >= ErisaProbModel.TotalLimit)
{
return -1;
}
int iSym = 0;
ushort wAcc = (ushort)dwAcc;
ushort wFs = 0;
ushort wOccured;
for (;;)
{
wOccured = pModel.SymTable[iSym].Occured;
if (wAcc < wOccured)
break;
wAcc -= wOccured;
wFs += wOccured;
if (++iSym >= pModel.SymbolSorts)
return -1;
}
m_dwCodeRegister -= (m_dwAugendRegister * wFs + pModel.TotalCount - 1) / pModel.TotalCount;
m_dwAugendRegister = m_dwAugendRegister * wOccured / pModel.TotalCount;
Debug.Assert (m_dwAugendRegister != 0);
while (0 == (m_dwAugendRegister & 0x8000))
{
int nNextBit = GetABit();
if (1 == nNextBit)
{
if ((++m_nPostBitCount) >= 256)
return -1;
nNextBit = 0;
}
m_dwCodeRegister = (m_dwCodeRegister << 1) | ((uint)nNextBit & 1);
m_dwAugendRegister <<= 1;
}
m_dwCodeRegister &= 0xFFFF;
return iSym;
}
}
internal class ErisaProbModel
{
public const int TotalLimit = 0x2000;
public const int SymbolSortMax = 0x101;
public const int SubSortMax = 0x80;
public const int ProbSlotMax = 0x800;
public const short EscCode = -1;
internal struct CodeSymbol
{
public ushort Occured;
public short Symbol;
}
public uint TotalCount;
public int SymbolSorts;
public CodeSymbol[] SymTable = new CodeSymbol[SymbolSortMax];
public CodeSymbol[] SubModel = new CodeSymbol[SubSortMax];
public void Initialize ()
{
TotalCount = SymbolSortMax;
SymbolSorts = SymbolSortMax;
for (short i = 0; i < 0x100; ++i)
{
SymTable[i].Occured = 1;
SymTable[i].Symbol = i;
}
SymTable[0x100].Occured = 1;
SymTable[0x100].Symbol = EscCode;
for (short i = 0; i < SubSortMax; ++i)
{
SubModel[i].Occured = 0;
SubModel[i].Symbol = -1;
}
}
public int AccumulateProb (short wSymbol)
{
int index = FindSymbol (wSymbol);
Debug.Assert (index >= 0);
int occured = SymTable[index].Occured;
int i = 0;
while (occured < TotalCount)
{
occured <<= 1;
i++;
}
return i;
}
public void HalfOccuredCount ()
{
TotalCount = 0;
for (int i = 0; i < SymbolSorts; ++i)
{
TotalCount += SymTable[i].Occured = (ushort)((SymTable[i].Occured + 1) >> 1);
}
for (int i = 0; i < SubSortMax; ++i)
{
SubModel[i].Occured >>= 1;
}
}
public int IncreaseSymbol (int index)
{
ushort occured = ++SymTable[index].Occured;
short symbol = SymTable[index].Symbol;
while (--index >= 0)
{
if (SymTable[index].Occured >= occured)
break;
SymTable[index + 1] = SymTable[index];
}
SymTable[++index].Occured = occured;
SymTable[index].Symbol = symbol;
if (++TotalCount >= TotalLimit)
{
HalfOccuredCount();
}
return index;
}
public int FindSymbol (short symbol)
{
for (int index = 0; index < SymbolSorts; ++index)
{
if (SymTable[index].Symbol == symbol)
return index;
}
return -1;
}
public int AddSymbol (short symbol)
{
int index = SymbolSorts++;
TotalCount++;
SymTable[index].Symbol = symbol;
SymTable[index].Occured = 1;
return index;
}
}
}
Reference in New Issue View Git Blame Copy Permalink