118 lines
1.6 KiB
C
118 lines
1.6 KiB
C
|
#include <winpr/crt.h>
|
||
|
|
#include <winpr/sysinfo.h>
|
||
|
|
#include <winpr/windows.h>
|
||
|
|
|
||
|
|
#include <winpr/intrin.h>
|
||
|
|
|
||
|
|
static BOOL g_LZCNT = FALSE;
|
||
|
|
|
||
|
|
static INLINE UINT32 lzcnt_s(UINT32 x)
|
||
|
|
{
|
||
|
|
if (!x)
|
||
|
|
return 32;
|
||
|
|
|
||
|
|
if (!g_LZCNT)
|
||
|
|
{
|
||
|
|
UINT32 y;
|
||
|
|
int n = 32;
|
||
|
|
y = x >> 16;
|
||
|
|
if (y != 0)
|
||
|
|
{
|
||
|
|
n = n - 16;
|
||
|
|
x = y;
|
||
|
|
}
|
||
|
|
y = x >> 8;
|
||
|
|
if (y != 0)
|
||
|
|
{
|
||
|
|
n = n - 8;
|
||
|
|
x = y;
|
||
|
|
}
|
||
|
|
y = x >> 4;
|
||
|
|
if (y != 0)
|
||
|
|
{
|
||
|
|
n = n - 4;
|
||
|
|
x = y;
|
||
|
|
}
|
||
|
|
y = x >> 2;
|
||
|
|
if (y != 0)
|
||
|
|
{
|
||
|
|
n = n - 2;
|
||
|
|
x = y;
|
||
|
|
}
|
||
|
|
y = x >> 1;
|
||
|
|
if (y != 0)
|
||
|
|
return n - 2;
|
||
|
|
return n - x;
|
||
|
|
}
|
||
|
|
|
||
|
|
return __lzcnt(x);
|
||
|
|
}
|
||
|
|
|
||
|
|
int test_lzcnt()
|
||
|
|
{
|
||
|
|
if (lzcnt_s(0x1) != 31)
|
||
|
|
{
|
||
|
|
fprintf(stderr, "__lzcnt(0x1) != 31: %" PRIu32 "\n", __lzcnt(0x1));
|
||
|
|
return -1;
|
||
|
|
}
|
||
|
|
|
||
|
|
if (lzcnt_s(0xFF) != 24)
|
||
|
|
{
|
||
|
|
fprintf(stderr, "__lzcnt(0xFF) != 24\n");
|
||
|
|
return -1;
|
||
|
|
}
|
||
|
|
|
||
|
|
if (lzcnt_s(0xFFFF) != 16)
|
||
|
|
{
|
||
|
|
fprintf(stderr, "__lzcnt(0xFFFF) != 16\n");
|
||
|
|
return -1;
|
||
|
|
}
|
||
|
|
|
||
|
|
if (lzcnt_s(0xFFFFFF) != 8)
|
||
|
|
{
|
||
|
|
fprintf(stderr, "__lzcnt(0xFFFFFF) != 8\n");
|
||
|
|
return -1;
|
||
|
|
}
|
||
|
|
|
||
|
|
if (lzcnt_s(0xFFFFFFFF) != 0)
|
||
|
|
{
|
||
|
|
fprintf(stderr, "__lzcnt(0xFFFFFFFF) != 0\n");
|
||
|
|
return -1;
|
||
|
|
}
|
||
|
|
|
||
|
|
return 0;
|
||
|
|
}
|
||
|
|
|
||
|
|
int test_lzcnt16()
|
||
|
|
{
|
||
|
|
if (__lzcnt16(0x1) != 15)
|
||
|
|
{
|
||
|
|
fprintf(stderr, "__lzcnt16(0x1) != 15\n");
|
||
|
|
return -1;
|
||
|
|
}
|
||
|
|
|
||
|
|
if (__lzcnt16(0xFF) != 8)
|
||
|
|
{
|
||
|
|
fprintf(stderr, "__lzcnt16(0xFF) != 8\n");
|
||
|
|
return -1;
|
||
|
|
}
|
||
|
|
|
||
|
|
if (__lzcnt16(0xFFFF) != 0)
|
||
|
|
{
|
||
|
|
fprintf(stderr, "__lzcnt16(0xFFFF) != 0\n");
|
||
|
|
return -1;
|
||
|
|
}
|
||
|
|
|
||
|
|
return 0;
|
||
|
|
}
|
||
|
|
|
||
|
|
int TestIntrinsics(int argc, char* argv[])
|
||
|
|
{
|
||
|
|
g_LZCNT = IsProcessorFeaturePresentEx(PF_EX_LZCNT);
|
||
|
|
|
||
|
|
printf("LZCNT available: %" PRId32 "\n", g_LZCNT);
|
||
|
|
|
||
|
|
// test_lzcnt16();
|
||
|
|
return test_lzcnt();
|
||
|
|
}
|