#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();

}