/* -*- c-basic-offset: 4; indent-tabs-mode: nil -*- */
/* ====================================================================
 * Copyright (c) 2015 Carnegie Mellon University.  All rights
 * reserved.
 *
 * Redistribution and use in source and binary forms, with or without
 * modification, are permitted provided that the following conditions
 * are met:
 *
 * 1. Redistributions of source code must retain the above copyright
 *    notice, this list of conditions and the following disclaimer. 
 *
 * 2. Redistributions in binary form must reproduce the above copyright
 *    notice, this list of conditions and the following disclaimer in
 *    the documentation and/or other materials provided with the
 *    distribution.
 *
 * This work was supported in part by funding from the Defense Advanced 
 * Research Projects Agency and the National Science Foundation of the 
 * United States of America, and the CMU Sphinx Speech Consortium.
 *
 * THIS SOFTWARE IS PROVIDED BY CARNEGIE MELLON UNIVERSITY ``AS IS'' AND 
 * ANY EXPRESSED OR IMPLIED WARRANTIES, INCLUDING, BUT NOT LIMITED TO, 
 * THE IMPLIED WARRANTIES OF MERCHANTABILITY AND FITNESS FOR A PARTICULAR
 * PURPOSE ARE DISCLAIMED.  IN NO EVENT SHALL CARNEGIE MELLON UNIVERSITY
 * NOR ITS EMPLOYEES BE LIABLE FOR ANY DIRECT, INDIRECT, INCIDENTAL,
 * SPECIAL, EXEMPLARY, OR CONSEQUENTIAL DAMAGES (INCLUDING, BUT NOT 
 * LIMITED TO, PROCUREMENT OF SUBSTITUTE GOODS OR SERVICES; LOSS OF USE, 
 * DATA, OR PROFITS; OR BUSINESS INTERRUPTION) HOWEVER CAUSED AND ON ANY 
 * THEORY OF LIABILITY, WHETHER IN CONTRACT, STRICT LIABILITY, OR TORT 
 * (INCLUDING NEGLIGENCE OR OTHERWISE) ARISING IN ANY WAY OUT OF THE USE 
 * OF THIS SOFTWARE, EVEN IF ADVISED OF THE POSSIBILITY OF SUCH DAMAGE.
 *
 * ====================================================================
 *
 */

/*
 * bitarr.c -- Bit array manipulations implementation.
 */

#ifdef HAVE_CONFIG_H
#include <config.h>
#endif
#include "sphinxbase/bitarr.h"

#define SIGN_BIT (0x80000000)

/**
 * Shift bits depending on byte order in system.
 * Fun fact: __BYTE_ORDER is wrong on Solaris Sparc, but the version without __ is correct.
 * @param bit is an offset last byte
 * @param length - amount of bits for required for digit that is going to be read
 * @return shift forgiven architecture
 */
static uint8 get_shift(uint8 bit, uint8 length)
{
#ifdef WORDS_BIGENDIAN
    return 64 - length - bit;
#else
    return bit;
#endif
}

/**
 * Read uint64 value from the given address
 * @param address to read from
 * @return uint64 value that was read
 */
static uint64 read_off(bitarr_address_t address)
{
#if defined(__arm) || defined(__arm__)
    uint64 value64;
    const uint8 *base_off = (const uint8 *)(address.base) + (address.offset >> 3);
    memcpy(&value64, base_off, sizeof(value64));
    return value64;
#else
    return *(const uint64*)((const uint8 *)(address.base) + (address.offset >> 3));
#endif
}

uint64 bitarr_read_int57(bitarr_address_t address, uint8 length, uint64 mask)
{
    return (read_off(address) >> get_shift(address.offset & 7, length)) & mask;
}

void bitarr_write_int57(bitarr_address_t address, uint8 length, uint64 value) 
{
#if defined(__arm) || defined(__arm__)
    uint64 value64;
    uint8 *base_off = (uint8 *)(address.base) + (address.offset >> 3);
    memcpy(&value64, base_off, sizeof(value64));
    value64 |= (value << get_shift(address.offset & 7, length));
    memcpy(base_off, &value64, sizeof(value64));
#else
    *(uint64 *)((uint8 *)(address.base) + (address.offset >> 3)) |= (value << get_shift(address.offset & 7, length));
#endif
}

uint32 bitarr_read_int25(bitarr_address_t address, uint8 length, uint32 mask) 
{
#if defined(__arm) || defined(__arm__)
    uint32 value32;
    const uint8 *base_off = (const uint8*)(address.base) + (address.offset >> 3);
    memcpy(&value32, base_off, sizeof(value32));
    return (value32 >> get_shift(address.offset & 7, length)) & mask;
#else
    return (*(const uint32*)((const uint8*)(address.base) + (address.offset >> 3)) >> get_shift(address.offset & 7, length)) & mask;
#endif
}

void bitarr_write_int25(bitarr_address_t address, uint8 length, uint32 value)
{
#if defined(__arm) || defined(__arm__)
    uint32 value32;
    uint8 *base_off = (uint8 *)(address.base) + (address.offset >> 3);
    memcpy(&value32, base_off, sizeof(value32));
    value32 |= (value << get_shift(address.offset & 7, length));
    memcpy(base_off, &value32, sizeof(value32));
#else
    *(uint32 *)((uint8 *)(address.base) + (address.offset >> 3)) |= (value << get_shift(address.offset & 7, length));
#endif
}

void bitarr_mask_from_max(bitarr_mask_t *bit_mask, uint32 max_value)
{
    bit_mask->bits = bitarr_required_bits(max_value);
    bit_mask->mask = (uint32)((1ULL << bit_mask->bits) - 1);
}

uint8 bitarr_required_bits(uint32 max_value)
{
    uint8 res;

    if (!max_value) return 0;
    res = 1;
    while (max_value >>= 1) res++;
    return res;
}