#include <winpr/crt.h>

#include <winpr/print.h>

#include <winpr/crypto.h>

#include <winpr/ssl.h>

static BOOL test_crypto_cipher_aes_128_cbc()

{

	WINPR_CIPHER_CTX* ctx;

	BOOL result = FALSE;

	BYTE key[] = "0123456789abcdeF";

	BYTE iv[] = "1234567887654321";

	BYTE ibuf[1024];

	BYTE obuf[1024];

	size_t ilen;

	size_t olen;

	size_t xlen;

	const char plaintext[] = "Lorem ipsum dolor sit amet, consectetur adipiscing elit, sed do "

	                         "eiusmod tempor incididunt ut labore et dolore magna aliqua.";

	/* encrypt */

	if (!(ctx = winpr_Cipher_New(WINPR_CIPHER_AES_128_CBC, WINPR_ENCRYPT, key, iv)))

	{

		fprintf(stderr, "%s: winpr_Cipher_New (encrypt) failed\n", __FUNCTION__);

		return FALSE;

	}

	memset(ibuf, 0, sizeof(ibuf));

	memset(obuf, 0, sizeof(obuf));

	ilen = strnlen(plaintext, sizeof(plaintext)) + 1;

	memcpy(ibuf, plaintext, ilen);

	ilen = ((ilen + 15) / 16) * 16;

	olen = 0;

	xlen = 0;

	if (!winpr_Cipher_Update(ctx, ibuf, ilen, obuf, &olen))

	{

		fprintf(stderr, "%s: winpr_Cipher_New (encrypt) failed\n", __FUNCTION__);

		goto out;

	}

	xlen += olen;

	if (!winpr_Cipher_Final(ctx, obuf + xlen, &olen))

	{

		fprintf(stderr, "%s: winpr_Cipher_Final (encrypt) failed\n", __FUNCTION__);

		goto out;

	}

	xlen += olen;

	if (xlen != ilen)

	{

		fprintf(stderr, "%s: error, xlen (%" PRIuz ") != ilen (%" PRIuz ") (encrypt)\n",

		        __FUNCTION__, xlen, ilen);

		goto out;

	}

	winpr_Cipher_Free(ctx);

	/* decrypt */

	if (!(ctx = winpr_Cipher_New(WINPR_CIPHER_AES_128_CBC, WINPR_DECRYPT, key, iv)))

	{

		fprintf(stderr, "%s: winpr_Cipher_New (decrypt) failed\n", __FUNCTION__);

		return FALSE;

	}

	memset(ibuf, 0, sizeof(ibuf));

	memcpy(ibuf, obuf, xlen);

	memset(obuf, 0, sizeof(obuf));

	ilen = xlen;

	olen = 0;

	xlen = 0;

	if (!winpr_Cipher_Update(ctx, ibuf, ilen, obuf, &olen))

	{

		fprintf(stderr, "%s: winpr_Cipher_New (decrypt) failed\n", __FUNCTION__);

		goto out;

	}

	xlen += olen;

	if (!winpr_Cipher_Final(ctx, obuf + xlen, &olen))

	{

		fprintf(stderr, "%s: winpr_Cipher_Final (decrypt) failed\n", __FUNCTION__);

		goto out;

	}

	xlen += olen;

	if (xlen != ilen)

	{

		fprintf(stderr, "%s: error, xlen (%" PRIuz ") != ilen (%" PRIuz ") (decrypt)\n",

		        __FUNCTION__, xlen, ilen);

		goto out;

	}

	if (strcmp((const char*)obuf, plaintext))

	{

		fprintf(stderr, "%s: error, decrypted data does not match plaintext\n", __FUNCTION__);

		goto out;

	}

	result = TRUE;

out:

	winpr_Cipher_Free(ctx);

	return result;

}

static const BYTE* TEST_RC4_KEY = (BYTE*)"Key";

static const char* TEST_RC4_PLAINTEXT = "Plaintext";

static const BYTE* TEST_RC4_CIPHERTEXT = (BYTE*)"\xBB\xF3\x16\xE8\xD9\x40\xAF\x0A\xD3";

static BOOL test_crypto_cipher_rc4()

{

	size_t len;

	BOOL rc = FALSE;

	BYTE* text = NULL;

	WINPR_RC4_CTX* ctx;

	len = strnlen(TEST_RC4_PLAINTEXT, sizeof(TEST_RC4_PLAINTEXT));

	if (!(text = (BYTE*)calloc(1, len)))

	{

		fprintf(stderr, "%s: failed to allocate text buffer (len=%" PRIuz ")\n", __FUNCTION__, len);

		goto out;

	}

	if ((ctx = winpr_RC4_New(TEST_RC4_KEY,

	                         strnlen((const char*)TEST_RC4_KEY, sizeof(TEST_RC4_KEY)))) == NULL)

	{

		fprintf(stderr, "%s: winpr_RC4_New failed\n", __FUNCTION__);

		goto out;

	}

	rc = winpr_RC4_Update(ctx, len, (const BYTE*)TEST_RC4_PLAINTEXT, text);

	winpr_RC4_Free(ctx);

	if (!rc)

	{

		fprintf(stderr, "%s: winpr_RC4_Update failed\n", __FUNCTION__);

		goto out;

	}

	if (memcmp(text, TEST_RC4_CIPHERTEXT, len) != 0)

	{

		char* actual;

		char* expected;

		actual = winpr_BinToHexString(text, len, FALSE);

		expected = winpr_BinToHexString(TEST_RC4_CIPHERTEXT, len, FALSE);

		fprintf(stderr, "%s: unexpected RC4 ciphertext: Actual: %s Expected: %s\n", __FUNCTION__,

		        actual, expected);

		free(actual);

		free(expected);

		goto out;

	}

	rc = TRUE;

out:

	free(text);

	return rc;

}

static const BYTE* TEST_RAND_DATA =

    (BYTE*)"\x1F\xC2\xEE\x4C\xA3\x66\x80\xA2\xCE\xFE\x56\xB4\x9E\x08\x30\x96"

           "\x33\x6A\xA9\x6D\x36\xFD\x3C\xB7\x83\x04\x4E\x5E\xDC\x22\xCD\xF3"

           "\x48\xDF\x3A\x2A\x61\xF1\xA8\xFA\x1F\xC6\xC7\x1B\x81\xB4\xE1\x0E"

           "\xCB\xA2\xEF\xA1\x12\x4A\x83\xE5\x1D\x72\x1D\x2D\x26\xA8\x6B\xC0";

static const BYTE* TEST_CIPHER_KEY =

    (BYTE*)"\x9D\x7C\xC0\xA1\x94\x3B\x07\x67\x2F\xD3\x83\x10\x51\x83\x38\x0E"

           "\x1C\x74\x8C\x4E\x15\x79\xD6\xFF\xE2\xF0\x37\x7F\x8C\xD7\xD2\x13";

static const BYTE* TEST_CIPHER_IV =

    (BYTE*)"\xFE\xE3\x9F\xF0\xD1\x5E\x37\x0C\xAB\xAB\x9B\x04\xF3\xDB\x99\x15";

static BOOL test_crypto_cipher_key()

{

	int status;

	BYTE key[32];

	BYTE iv[16];

	BYTE salt[8] = { 0x00, 0x11, 0x22, 0x33, 0x44, 0x55, 0x66, 0x77 };

	ZeroMemory(key, sizeof(key));

	ZeroMemory(iv, sizeof(iv));

	status = winpr_Cipher_BytesToKey(WINPR_CIPHER_AES_256_CBC, WINPR_MD_SHA1, salt, TEST_RAND_DATA,

	                                 64, 4, key, iv);

	if (status != 32 || memcmp(key, TEST_CIPHER_KEY, 32) || memcmp(iv, TEST_CIPHER_IV, 16))

	{

		char* akstr;

		char* ekstr;

		char* aivstr;

		char* eivstr;

		akstr = winpr_BinToHexString(key, 32, 0);

		ekstr = winpr_BinToHexString(TEST_CIPHER_KEY, 32, 0);

		aivstr = winpr_BinToHexString(iv, 16, 0);

		eivstr = winpr_BinToHexString(TEST_CIPHER_IV, 16, 0);

		fprintf(stderr, "Unexpected EVP_BytesToKey Key: Actual: %s, Expected: %s\n", akstr, ekstr);

		fprintf(stderr, "Unexpected EVP_BytesToKey IV : Actual: %s, Expected: %s\n", aivstr,

		        eivstr);

		free(akstr);

		free(ekstr);

		free(aivstr);

		free(eivstr);

	}

	return TRUE;

}

int TestCryptoCipher(int argc, char* argv[])

{

	winpr_InitializeSSL(WINPR_SSL_INIT_DEFAULT);

	if (!test_crypto_cipher_aes_128_cbc())

		return -1;

	if (!test_crypto_cipher_rc4())

		return -1;

	if (!test_crypto_cipher_key())

		return -1;

	return 0;

}