aboutsummaryrefslogtreecommitdiff
path: root/Ryujinx.Common/BitUtils.cs
blob: 5c858029bd20a8cdd122ec2cf4135129cdfa93b9 (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
80
81
82
83
84
85
86
87
88
89
90
91
92
93
94
95
96
97
98
99
100
101
102
103
104
namespace Ryujinx.Common
{
    public static class BitUtils
    {
        public static int AlignUp(int Value, int Size)
        {
            return (Value + (Size - 1)) & -Size;
        }

        public static ulong AlignUp(ulong Value, int Size)
        {
            return (ulong)AlignUp((long)Value, Size);
        }

        public static long AlignUp(long Value, int Size)
        {
            return (Value + (Size - 1)) & -(long)Size;
        }

        public static int AlignDown(int Value, int Size)
        {
            return Value & -Size;
        }

        public static ulong AlignDown(ulong Value, int Size)
        {
            return (ulong)AlignDown((long)Value, Size);
        }

        public static long AlignDown(long Value, int Size)
        {
            return Value & -(long)Size;
        }

        public static ulong DivRoundUp(ulong Value, uint Dividend)
        {
            return (Value + Dividend - 1) / Dividend;
        }

        public static long DivRoundUp(long Value, int Dividend)
        {
            return (Value + Dividend - 1) / Dividend;
        }

        public static bool IsPowerOfTwo32(int Value)
        {
            return Value != 0 && (Value & (Value - 1)) == 0;
        }

        public static bool IsPowerOfTwo64(long Value)
        {
            return Value != 0 && (Value & (Value - 1)) == 0;
        }

        public static int CountLeadingZeros32(int Value)
        {
            return (int)CountLeadingZeros((ulong)Value, 32);
        }

        public static int CountLeadingZeros64(long Value)
        {
            return (int)CountLeadingZeros((ulong)Value, 64);
        }

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

        private static ulong CountLeadingZeros(ulong Value, int Size) // Size is 8, 16, 32 or 64 (SIMD&FP or Base Inst.).
        {
            if (Value == 0ul)
            {
                return (ulong)Size;
            }

            int NibbleIdx = Size;
            int PreCount, Count = 0;

            do
            {
                NibbleIdx -= 4;
                PreCount = ClzNibbleTbl[(Value >> NibbleIdx) & 0b1111];
                Count += PreCount;
            }
            while (PreCount == 4);

            return (ulong)Count;
        }

        public static long ReverseBits64(long Value)
        {
            return (long)ReverseBits64((ulong)Value);
        }

        private static ulong ReverseBits64(ulong Value)
        {
            Value = ((Value & 0xaaaaaaaaaaaaaaaa) >> 1 ) | ((Value & 0x5555555555555555) << 1 );
            Value = ((Value & 0xcccccccccccccccc) >> 2 ) | ((Value & 0x3333333333333333) << 2 );
            Value = ((Value & 0xf0f0f0f0f0f0f0f0) >> 4 ) | ((Value & 0x0f0f0f0f0f0f0f0f) << 4 );
            Value = ((Value & 0xff00ff00ff00ff00) >> 8 ) | ((Value & 0x00ff00ff00ff00ff) << 8 );
            Value = ((Value & 0xffff0000ffff0000) >> 16) | ((Value & 0x0000ffff0000ffff) << 16);

            return (Value >> 32) | (Value << 32);
        }
    }
}