// SPDX-License-Identifier: GPL-2.0-or-later
/*
 * Crypto library utility functions
 *
 * Copyright (c) 2006 Herbert Xu <herbert@gondor.apana.org.au>
 */

#include <crypto/utils.h>
#include <linux/export.h>
#include <linux/module.h>
#include <linux/unaligned.h>

/*
 * XOR @len bytes from @src1 and @src2 together, writing the result to @dst
 * (which may alias one of the sources).  Don't call this directly; call
 * crypto_xor() or crypto_xor_cpy() instead.
 */
void __crypto_xor(u8 *dst, const u8 *src1, const u8 *src2, unsigned int len)
{
 int relalign = 0;

 if (!IS_ENABLED(CONFIG_HAVE_EFFICIENT_UNALIGNED_ACCESS)) {
  int size = sizeof(unsigned long);
  int d = (((unsigned long)dst ^ (unsigned long)src1) |
    ((unsigned long)dst ^ (unsigned long)src2)) &
   (size - 1);

  relalign = d ? 1 << __ffs(d) : size;

  /*
   * If we care about alignment, process as many bytes as
   * needed to advance dst and src to values whose alignments
   * equal their relative alignment. This will allow us to
   * process the remainder of the input using optimal strides.
 */
  while (((unsigned long)dst & (relalign - 1)) && len > 0) {
   *dst++ = *src1++ ^ *src2++;
   len--;
  }
 }

 while (IS_ENABLED(CONFIG_64BIT) && len >= 8 && !(relalign & 7)) {
  if (IS_ENABLED(CONFIG_HAVE_EFFICIENT_UNALIGNED_ACCESS)) {
   u64 l = get_unaligned((u64 *)src1) ^
    get_unaligned((u64 *)src2);
   put_unaligned(l, (u64 *)dst);
  } else {
   *(u64 *)dst = *(u64 *)src1 ^ *(u64 *)src2;
  }
  dst += 8;
  src1 += 8;
  src2 += 8;
  len -= 8;
 }

 while (len >= 4 && !(relalign & 3)) {
  if (IS_ENABLED(CONFIG_HAVE_EFFICIENT_UNALIGNED_ACCESS)) {
   u32 l = get_unaligned((u32 *)src1) ^
    get_unaligned((u32 *)src2);
   put_unaligned(l, (u32 *)dst);
  } else {
   *(u32 *)dst = *(u32 *)src1 ^ *(u32 *)src2;
  }
  dst += 4;
  src1 += 4;
  src2 += 4;
  len -= 4;
 }

 while (len >= 2 && !(relalign & 1)) {
  if (IS_ENABLED(CONFIG_HAVE_EFFICIENT_UNALIGNED_ACCESS)) {
   u16 l = get_unaligned((u16 *)src1) ^
    get_unaligned((u16 *)src2);
   put_unaligned(l, (u16 *)dst);
  } else {
   *(u16 *)dst = *(u16 *)src1 ^ *(u16 *)src2;
  }
  dst += 2;
  src1 += 2;
  src2 += 2;
  len -= 2;
 }

 while (len--)
  *dst++ = *src1++ ^ *src2++;
}
EXPORT_SYMBOL_GPL(__crypto_xor);

MODULE_DESCRIPTION("Crypto library utility functions");
MODULE_LICENSE("GPL");