/* crc64.c - crc64 function  */
/*
 *  VasEBoot  --  GRand Unified Bootloader
 *  Copyright (C) 2008,2011  Free Software Foundation, Inc.
 *
 *  VasEBoot is free software: you can redistribute it and/or modify
 *  it under the terms of the GNU General Public License as published by
 *  the Free Software Foundation, either version 3 of the License, or
 *  (at your option) any later version.
 *
 *  VasEBoot is distributed in the hope that it will be useful,
 *  but WITHOUT ANY WARRANTY; without even the implied warranty of
 *  MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE.  See the
 *  GNU General Public License for more details.
 *
 *  You should have received a copy of the GNU General Public License
 *  along with VasEBoot.  If not, see <http://www.gnu.org/licenses/>.
 */

#include <VasEBoot/types.h>
#include <VasEBoot/dl.h>
#include <VasEBoot/crypto.h>

VasEBoot_MOD_LICENSE ("GPLv3+");

static VasEBoot_uint64_t crc64_table [256];

/* Helper for init_crc64_table.  */
static VasEBoot_uint64_t
reflect (VasEBoot_uint64_t ref, int len)
{
  VasEBoot_uint64_t result = 0;
  int i;

  for (i = 1; i <= len; i++)
    {
      if (ref & 1)
	result |= 1ULL << (len - i);
      ref >>= 1;
    }

  return result;
}

static void
init_crc64_table (void)
{
  VasEBoot_uint64_t polynomial = 0x42f0e1eba9ea3693ULL;
  int i, j;

  for(i = 0; i < 256; i++)
    {
      crc64_table[i] = reflect(i, 8) << 56;
      for (j = 0; j < 8; j++)
	{
	  crc64_table[i] = (crc64_table[i] << 1) ^
            (crc64_table[i] & (1ULL << 63) ? polynomial : 0);
	}
      crc64_table[i] = reflect(crc64_table[i], 64);
    }
}

static void
crc64_init (void *context)
{
  if (! crc64_table[1])
    init_crc64_table ();
  *(VasEBoot_uint64_t *) context = 0;
}

static void
crc64_write (void *context, const void *buf, VasEBoot_size_t size)
{
  unsigned i;
  const VasEBoot_uint8_t *data = buf;
  VasEBoot_uint64_t crc = ~VasEBoot_le_to_cpu64 (*(VasEBoot_uint64_t *) context);

  for (i = 0; i < size; i++)
    {
      crc = (crc >> 8) ^ crc64_table[(crc & 0xFF) ^ *data];
      data++;
    }

  *(VasEBoot_uint64_t *) context = VasEBoot_cpu_to_le64 (~crc);
}

static VasEBoot_uint8_t *
crc64_read (void *context)
{
  return context;
}

static void
crc64_final (void *context __attribute__ ((unused)))
{
}

gcry_md_spec_t _gcry_digest_spec_crc64 =
  {
    "CRC64", 0, 0, 0, 8,
    crc64_init, crc64_write, crc64_final, crc64_read,
    sizeof (VasEBoot_uint64_t),
    .blocksize = 64
  };

VasEBoot_MOD_INIT(crc64)
{
  VasEBoot_md_register (&_gcry_digest_spec_crc64);
}

VasEBoot_MOD_FINI(crc64)
{
  VasEBoot_md_unregister (&_gcry_digest_spec_crc64);
}