/*
 * broadvoice - a library for the BroadVoice 16 and 32 codecs
 *
 * bitpack16.c - 
 *
 * Adapted by Steve Underwood <steveu@coppice.org> from code which is
 * Copyright 2000-2009 Broadcom Corporation
 *
 * All rights reserved.
 *
 * This program is free software; you can redistribute it and/or modify
 * it under the terms of the GNU Lesser General Public License version 2.1,
 * as published by the Free Software Foundation.
 *
 * This program 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 Lesser General Public License for more details.
 *
 * You should have received a copy of the GNU Lesser General Public
 * License along with this program; if not, write to the Free Software
 * Foundation, Inc., 675 Mass Ave, Cambridge, MA 02139, USA.
 */

/*! \file */

#if defined(HAVE_CONFIG_H)
#include "config.h"
#endif

#include <inttypes.h>

#include "broadvoice.h"
#include "bv16strct.h"
#include "bitstream.h"
#include "bitpack16.h"

/*
 *  The following is the bit table within the bit structure for
 *  BroadVoice16
 *
 *  int16_t  bit_table[] =
 *  {
 *        7, 7,                           // LSP
 *        7,                              // Pitch Lag
 *        5,                              // Pitch Gain
 *        4,                              // Excitation Vector Log-Gain
 *        5, 5, 5, 5, 5, 5, 5, 5, 5, 5    // Excitation Vector
 *  };
 */

int bv16_bitpack(uint8_t *PackedStream, struct BV16_Bit_Stream *BitStruct)
{
    bitstream_state_t bs;
    uint8_t *stream;
    int i;

    stream = PackedStream;
    bitstream_init(&bs);
    bitstream_put(&bs, &stream, BitStruct->lspidx[0], 7);
    bitstream_put(&bs, &stream, BitStruct->lspidx[1], 7);
    bitstream_put(&bs, &stream, BitStruct->ppidx, 7);
    bitstream_put(&bs, &stream, BitStruct->bqidx, 5);
    bitstream_put(&bs, &stream, BitStruct->gidx, 4);
    
    for (i = 0;  i < 10;  i++)
        bitstream_put(&bs, &stream, BitStruct->qvidx[i], 5);
    bitstream_flush(&bs, &stream);
    return stream - PackedStream;
}

void bv16_bitunpack(const uint8_t *PackedStream, struct BV16_Bit_Stream *BitStruct)
{
    bitstream_state_t bs;
    const uint8_t *stream;
    int i;

    stream = PackedStream;
    bitstream_init(&bs);

    BitStruct->lspidx[0] = (int16_t) bitstream_get(&bs, &stream, 7);
    BitStruct->lspidx[1] = (int16_t) bitstream_get(&bs, &stream, 7);
    BitStruct->ppidx = (int16_t) bitstream_get(&bs, &stream, 7);
    BitStruct->bqidx = (int16_t) bitstream_get(&bs, &stream, 5);
    BitStruct->gidx = (int16_t) bitstream_get(&bs, &stream, 4);

    for (i = 0;  i < 10;  i++)
        BitStruct->qvidx[i] = (int16_t) bitstream_get(&bs, &stream, 5);
}