aboutsummaryrefslogtreecommitdiff
path: root/Ryujinx.Graphics/VDec/H264BitStreamWriter.cs
blob: b4fad59be30f994aef5b8e3f632e8c89e4a67ad3 (plain) (blame)
1
2
3
4
5
6
7
8
9
10
11
12
13
14
15
16
17
18
19
20
21
22
23
24
25
26
27
28
29
30
31
32
33
34
35
36
37
38
39
40
41
42
43
44
45
46
47
48
49
50
51
52
53
54
55
56
57
58
59
60
61
62
63
64
65
66
67
68
69
70
71
72
73
74
75
76
77
78
79
using System.IO;

namespace Ryujinx.Graphics.VDec
{
    class H264BitStreamWriter : BitStreamWriter
    {
        public H264BitStreamWriter(Stream baseStream) : base(baseStream) { }

        public void WriteU(int value, int valueSize)
        {
            WriteBits(value, valueSize);
        }

        public void WriteSe(int value)
        {
            WriteExpGolombCodedInt(value);
        }

        public void WriteUe(int value)
        {
            WriteExpGolombCodedUInt((uint)value);
        }

        public void End()
        {
            WriteBit(true);

            Flush();
        }

        private void WriteExpGolombCodedInt(int value)
        {
            int sign = value <= 0 ? 0 : 1;

            if (value < 0)
            {
                value = -value;
            }

            value = (value << 1) - sign;

            WriteExpGolombCodedUInt((uint)value);
        }

        private void WriteExpGolombCodedUInt(uint value)
        {
            int size = 32 - CountLeadingZeros((int)value + 1);

            WriteBits(1, size);

            value -= (1u << (size - 1)) - 1;

            WriteBits((int)value, size - 1);
        }

        private static readonly byte[] ClzNibbleTbl = { 4, 3, 2, 2, 1, 1, 1, 1, 0, 0, 0, 0, 0, 0, 0, 0 };

        private static int CountLeadingZeros(int value)
        {
            if (value == 0)
            {
                return 32;
            }

            int nibbleIdx = 32;
            int preCount, count = 0;

            do
            {
                nibbleIdx -= 4;
                preCount = ClzNibbleTbl[(value >> nibbleIdx) & 0b1111];
                count += preCount;
            }
            while (preCount == 4);

            return count;
        }
    }
}