[linux-2.6-block.git] / net / mptcp / crypto.c

// SPDX-License-Identifier: GPL-2.0
/* Multipath TCP cryptographic functions
 * Copyright (c) 2017 - 2019, Intel Corporation.
 *
 * Note: This code is based on mptcp_ctrl.c, mptcp_ipv4.c, and
 *       mptcp_ipv6 from multipath-tcp.org, authored by:
 *
 *       Sébastien Barré <sebastien.barre@uclouvain.be>
 *       Christoph Paasch <christoph.paasch@uclouvain.be>
 *       Jaakko Korkeaniemi <jaakko.korkeaniemi@aalto.fi>
 *       Gregory Detal <gregory.detal@uclouvain.be>
 *       Fabien Duchêne <fabien.duchene@uclouvain.be>
 *       Andreas Seelinger <Andreas.Seelinger@rwth-aachen.de>
 *       Lavkesh Lahngir <lavkesh51@gmail.com>
 *       Andreas Ripke <ripke@neclab.eu>
 *       Vlad Dogaru <vlad.dogaru@intel.com>
 *       Octavian Purdila <octavian.purdila@intel.com>
 *       John Ronan <jronan@tssg.org>
 *       Catalin Nicutar <catalin.nicutar@gmail.com>
 *       Brandon Heller <brandonh@stanford.edu>
 */

#include <linux/kernel.h>
#include <crypto/sha2.h>
#include <asm/unaligned.h>

#include "protocol.h"

#define SHA256_DIGEST_WORDS (SHA256_DIGEST_SIZE / 4)

void mptcp_crypto_key_sha(u64 key, u32 *token, u64 *idsn)
{
	__be32 mptcp_hashed_key[SHA256_DIGEST_WORDS];
	__be64 input = cpu_to_be64(key);

	sha256((__force u8 *)&input, sizeof(input), (u8 *)mptcp_hashed_key);

	if (token)
		*token = be32_to_cpu(mptcp_hashed_key[0]);
	if (idsn)
		*idsn = be64_to_cpu(*((__be64 *)&mptcp_hashed_key[6]));
}

void mptcp_crypto_hmac_sha(u64 key1, u64 key2, u8 *msg, int len, void *hmac)
{
	u8 input[SHA256_BLOCK_SIZE + SHA256_DIGEST_SIZE];
	u8 key1be[8];
	u8 key2be[8];
	int i;

	if (WARN_ON_ONCE(len > SHA256_DIGEST_SIZE))
		len = SHA256_DIGEST_SIZE;

	put_unaligned_be64(key1, key1be);
	put_unaligned_be64(key2, key2be);

	/* Generate key xored with ipad */
	memset(input, 0x36, SHA256_BLOCK_SIZE);
	for (i = 0; i < 8; i++)
		input[i] ^= key1be[i];
	for (i = 0; i < 8; i++)
		input[i + 8] ^= key2be[i];

	memcpy(&input[SHA256_BLOCK_SIZE], msg, len);

	/* emit sha256(K1 || msg) on the second input block, so we can
	 * reuse 'input' for the last hashing
	 */
	sha256(input, SHA256_BLOCK_SIZE + len, &input[SHA256_BLOCK_SIZE]);

	/* Prepare second part of hmac */
	memset(input, 0x5C, SHA256_BLOCK_SIZE);
	for (i = 0; i < 8; i++)
		input[i] ^= key1be[i];
	for (i = 0; i < 8; i++)
		input[i + 8] ^= key2be[i];

	sha256(input, SHA256_BLOCK_SIZE + SHA256_DIGEST_SIZE, hmac);
}

#if IS_MODULE(CONFIG_MPTCP_KUNIT_TEST)
EXPORT_SYMBOL_GPL(mptcp_crypto_hmac_sha);
#endif
Commit	Line	Data
79c0949e PK	1	// SPDX-License-Identifier: GPL-2.0
	2	/* Multipath TCP cryptographic functions
	3	* Copyright (c) 2017 - 2019, Intel Corporation.
	4	*
	5	* Note: This code is based on mptcp_ctrl.c, mptcp_ipv4.c, and
	6	* mptcp_ipv6 from multipath-tcp.org, authored by:
	7	*
	8	* Sébastien Barré <sebastien.barre@uclouvain.be>
	9	* Christoph Paasch <christoph.paasch@uclouvain.be>
	10	* Jaakko Korkeaniemi <jaakko.korkeaniemi@aalto.fi>
	11	* Gregory Detal <gregory.detal@uclouvain.be>
	12	* Fabien Duchêne <fabien.duchene@uclouvain.be>
	13	* Andreas Seelinger <Andreas.Seelinger@rwth-aachen.de>
	14	* Lavkesh Lahngir <lavkesh51@gmail.com>
	15	* Andreas Ripke <ripke@neclab.eu>
	16	* Vlad Dogaru <vlad.dogaru@intel.com>
	17	* Octavian Purdila <octavian.purdila@intel.com>
	18	* John Ronan <jronan@tssg.org>
	19	* Catalin Nicutar <catalin.nicutar@gmail.com>
	20	* Brandon Heller <brandonh@stanford.edu>
	21	*/
	22
	23	#include <linux/kernel.h>
a24d22b2	24	#include <crypto/sha2.h>
79c0949e PK	25	#include <asm/unaligned.h>
	26
	27	#include "protocol.h"
	28
65492c5a	29	#define SHA256_DIGEST_WORDS (SHA256_DIGEST_SIZE / 4)
79c0949e PK	30
	31	void mptcp_crypto_key_sha(u64 key, u32 token, u64 idsn)
	32	{
65492c5a PA	33	__be32 mptcp_hashed_key[SHA256_DIGEST_WORDS];
65492c5a PA	34	__be64 input = cpu_to_be64(key);
79c0949e	35
5a7a0d94	36	sha256((__force u8 )&input, sizeof(input), (u8 )mptcp_hashed_key);
79c0949e PK	37
	38	if (token)
	39	*token = be32_to_cpu(mptcp_hashed_key[0]);
	40	if (idsn)
65492c5a	41	idsn = be64_to_cpu(((__be64 *)&mptcp_hashed_key[6]));
79c0949e PK	42	}
79c0949e PK	43
3df523ab	44	void mptcp_crypto_hmac_sha(u64 key1, u64 key2, u8 msg, int len, void hmac)
79c0949e	45	{
65492c5a	46	u8 input[SHA256_BLOCK_SIZE + SHA256_DIGEST_SIZE];
79c0949e PK	47	u8 key1be[8];
	48	u8 key2be[8];
	49	int i;
	50
3df523ab PK	51	if (WARN_ON_ONCE(len > SHA256_DIGEST_SIZE))
	52	len = SHA256_DIGEST_SIZE;
	53
79c0949e PK	54	put_unaligned_be64(key1, key1be);
	55	put_unaligned_be64(key2, key2be);
	56
	57	/* Generate key xored with ipad */
ac0ad93d	58	memset(input, 0x36, SHA256_BLOCK_SIZE);
79c0949e PK	59	for (i = 0; i < 8; i++)
	60	input[i] ^= key1be[i];
	61	for (i = 0; i < 8; i++)
	62	input[i + 8] ^= key2be[i];
	63
3df523ab	64	memcpy(&input[SHA256_BLOCK_SIZE], msg, len);
79c0949e	65
79c0949e PK	66	/* emit sha256(K1 \|\| msg) on the second input block, so we can
	67	* reuse 'input' for the last hashing
	68	*/
5a7a0d94	69	sha256(input, SHA256_BLOCK_SIZE + len, &input[SHA256_BLOCK_SIZE]);
79c0949e PK	70
79c0949e PK	71	/* Prepare second part of hmac */
ac0ad93d	72	memset(input, 0x5C, SHA256_BLOCK_SIZE);
79c0949e PK	73	for (i = 0; i < 8; i++)
	74	input[i] ^= key1be[i];
	75	for (i = 0; i < 8; i++)
	76	input[i + 8] ^= key2be[i];
	77
5a7a0d94	78	sha256(input, SHA256_BLOCK_SIZE + SHA256_DIGEST_SIZE, hmac);
65492c5a PA	79	}
65492c5a PA	80
3fcc8a25	81	#if IS_MODULE(CONFIG_MPTCP_KUNIT_TEST)
a00a5822	82	EXPORT_SYMBOL_GPL(mptcp_crypto_hmac_sha);
65492c5a	83	#endif