2014-02-10 01:10:30 +00:00
|
|
|
/*************************************************************************/
|
|
|
|
/* cp_loader_it_samples.cpp */
|
|
|
|
/*************************************************************************/
|
|
|
|
/* This file is part of: */
|
|
|
|
/* GODOT ENGINE */
|
2017-08-27 12:11:45 +00:00
|
|
|
/* https://godotengine.org */
|
2014-02-10 01:10:30 +00:00
|
|
|
/*************************************************************************/
|
2019-06-04 09:41:49 +00:00
|
|
|
/* Copyright (c) 2007-2019 Juan Linietsky, Ariel Manzur. */
|
|
|
|
/* Copyright (c) 2014-2019 Godot Engine contributors (cf. AUTHORS.md) */
|
2014-02-10 01:10:30 +00:00
|
|
|
/* */
|
|
|
|
/* Permission is hereby granted, free of charge, to any person obtaining */
|
|
|
|
/* a copy of this software and associated documentation files (the */
|
|
|
|
/* "Software"), to deal in the Software without restriction, including */
|
|
|
|
/* without limitation the rights to use, copy, modify, merge, publish, */
|
|
|
|
/* distribute, sublicense, and/or sell copies of the Software, and to */
|
|
|
|
/* permit persons to whom the Software is furnished to do so, subject to */
|
|
|
|
/* the following conditions: */
|
|
|
|
/* */
|
|
|
|
/* The above copyright notice and this permission notice shall be */
|
|
|
|
/* included in all copies or substantial portions of the Software. */
|
|
|
|
/* */
|
|
|
|
/* THE SOFTWARE IS PROVIDED "AS IS", WITHOUT WARRANTY OF ANY KIND, */
|
|
|
|
/* EXPRESS OR IMPLIED, INCLUDING BUT NOT LIMITED TO THE WARRANTIES OF */
|
|
|
|
/* MERCHANTABILITY, FITNESS FOR A PARTICULAR PURPOSE AND NONINFRINGEMENT.*/
|
|
|
|
/* IN NO EVENT SHALL THE AUTHORS OR COPYRIGHT HOLDERS BE LIABLE FOR ANY */
|
|
|
|
/* CLAIM, DAMAGES OR OTHER LIABILITY, WHETHER IN AN ACTION OF CONTRACT, */
|
|
|
|
/* TORT OR OTHERWISE, ARISING FROM, OUT OF OR IN CONNECTION WITH THE */
|
|
|
|
/* SOFTWARE OR THE USE OR OTHER DEALINGS IN THE SOFTWARE. */
|
|
|
|
/*************************************************************************/
|
|
|
|
#include "cp_loader_it.h"
|
|
|
|
#include "cp_sample.h"
|
|
|
|
|
|
|
|
struct AuxSampleData {
|
|
|
|
|
|
|
|
uint32_t fileofs;
|
|
|
|
uint32_t c5spd;
|
|
|
|
uint32_t length;
|
|
|
|
uint32_t loop_begin;
|
|
|
|
uint32_t loop_end;
|
|
|
|
bool loop_enabled;
|
|
|
|
bool pingpong_enabled;
|
|
|
|
bool is16bit;
|
|
|
|
bool stereo;
|
|
|
|
bool exists;
|
|
|
|
bool compressed;
|
|
|
|
};
|
|
|
|
|
|
|
|
enum IT_Sample_Flags {
|
|
|
|
|
2017-03-18 23:36:26 +00:00
|
|
|
IT_SAMPLE_EXISTS = 1,
|
|
|
|
IT_SAMPLE_16BITS = 2,
|
|
|
|
IT_SAMPLE_STEREO = 4,
|
|
|
|
IT_SAMPLE_COMPRESSED = 8,
|
|
|
|
IT_SAMPLE_LOOPED = 16,
|
|
|
|
IT_SAMPLE_SUSTAIN_LOOPED = 32,
|
|
|
|
IT_SAMPLE_LOOP_IS_PINGPONG = 64,
|
|
|
|
IT_SAMPLE_SUSTAIN_LOOP_IS_PINGPONG = 128
|
2014-02-10 01:10:30 +00:00
|
|
|
};
|
|
|
|
|
|
|
|
CPLoader::Error CPLoader_IT::load_sample(CPSample *p_sample) {
|
|
|
|
|
|
|
|
AuxSampleData aux_sample_data;
|
|
|
|
|
|
|
|
char aux_header[4];
|
|
|
|
|
2017-03-18 23:36:26 +00:00
|
|
|
file->get_byte_array((uint8_t *)aux_header, 4);
|
|
|
|
|
|
|
|
if (aux_header[0] != 'I' ||
|
|
|
|
aux_header[1] != 'M' ||
|
|
|
|
aux_header[2] != 'P' ||
|
|
|
|
aux_header[3] != 'S') {
|
|
|
|
|
2014-02-10 01:10:30 +00:00
|
|
|
//CP_PRINTERR("IT CPLoader CPSample: Failed Identifier");
|
|
|
|
return FILE_UNRECOGNIZED;
|
|
|
|
}
|
|
|
|
|
|
|
|
// Ignore deprecated 8.3 filename
|
2017-03-18 23:36:26 +00:00
|
|
|
for (int i = 0; i < 12; i++)
|
|
|
|
file->get_byte();
|
|
|
|
|
2014-02-10 01:10:30 +00:00
|
|
|
file->get_byte(); //ignore zerobyte
|
2017-03-18 23:36:26 +00:00
|
|
|
|
|
|
|
p_sample->set_global_volume(file->get_byte());
|
|
|
|
|
2014-02-10 01:10:30 +00:00
|
|
|
/* SAMPLE FLAGS */
|
2017-03-18 23:36:26 +00:00
|
|
|
uint8_t flags = file->get_byte();
|
|
|
|
aux_sample_data.loop_enabled = flags & IT_SAMPLE_LOOPED;
|
|
|
|
aux_sample_data.pingpong_enabled = flags & IT_SAMPLE_LOOP_IS_PINGPONG;
|
|
|
|
aux_sample_data.is16bit = flags & IT_SAMPLE_16BITS;
|
|
|
|
aux_sample_data.exists = flags & IT_SAMPLE_EXISTS;
|
|
|
|
aux_sample_data.stereo = flags & IT_SAMPLE_STEREO;
|
|
|
|
aux_sample_data.compressed = flags & IT_SAMPLE_COMPRESSED;
|
|
|
|
|
2014-02-10 01:10:30 +00:00
|
|
|
p_sample->set_default_volume(file->get_byte());
|
|
|
|
/* SAMPLE NAME */
|
|
|
|
char aux_name[26];
|
2017-03-18 23:36:26 +00:00
|
|
|
file->get_byte_array((uint8_t *)aux_name, 26);
|
2014-02-10 01:10:30 +00:00
|
|
|
p_sample->set_name(aux_name);
|
2017-03-18 23:36:26 +00:00
|
|
|
|
2014-02-10 01:10:30 +00:00
|
|
|
// ??
|
2017-03-18 23:36:26 +00:00
|
|
|
uint8_t convert_flag = file->get_byte();
|
2014-02-10 01:10:30 +00:00
|
|
|
// PAN
|
2017-03-18 23:36:26 +00:00
|
|
|
uint8_t pan = file->get_byte();
|
|
|
|
p_sample->set_pan(pan & 0x7F);
|
|
|
|
p_sample->set_pan_enabled(pan & 0x80);
|
2014-02-10 01:10:30 +00:00
|
|
|
|
2017-03-18 23:36:26 +00:00
|
|
|
aux_sample_data.length = file->get_dword();
|
2014-02-10 01:10:30 +00:00
|
|
|
|
2017-03-18 23:36:26 +00:00
|
|
|
aux_sample_data.loop_begin = file->get_dword();
|
|
|
|
aux_sample_data.loop_end = file->get_dword();
|
|
|
|
aux_sample_data.c5spd = file->get_dword();
|
2014-02-10 01:10:30 +00:00
|
|
|
/*p_sample->data.set_sustain_loop_begin=*/file->get_dword();
|
|
|
|
/*p_sample->data.sustain_loop_end=*/file->get_dword();
|
2017-03-18 23:36:26 +00:00
|
|
|
aux_sample_data.fileofs = file->get_dword();
|
|
|
|
p_sample->set_vibrato_speed(file->get_byte());
|
|
|
|
p_sample->set_vibrato_depth(file->get_byte());
|
|
|
|
p_sample->set_vibrato_rate(file->get_byte());
|
|
|
|
switch (file->get_byte()) {
|
2014-02-10 01:10:30 +00:00
|
|
|
/* Vibrato Wave: 0=sine, 1=rampdown, 2=square, 3=random */
|
2017-03-18 23:36:26 +00:00
|
|
|
case 0: p_sample->set_vibrato_type(CPSample::VIBRATO_SINE); break;
|
|
|
|
case 1: p_sample->set_vibrato_type(CPSample::VIBRATO_SAW); break;
|
|
|
|
case 2: p_sample->set_vibrato_type(CPSample::VIBRATO_SQUARE); break;
|
|
|
|
case 3: p_sample->set_vibrato_type(CPSample::VIBRATO_RANDOM); break;
|
|
|
|
default: p_sample->set_vibrato_type(CPSample::VIBRATO_SINE); break;
|
2014-02-10 01:10:30 +00:00
|
|
|
}
|
2017-03-18 23:36:26 +00:00
|
|
|
|
2014-02-10 01:10:30 +00:00
|
|
|
//printf("Name %s - Flags: fileofs :%i - c5spd %i - len %i 16b %i - data?: %i\n",p_sample->get_name(),aux_sample_data.fileofs,aux_sample_data.c5spd, aux_sample_data.length, aux_sample_data.is16bit,aux_sample_data.exists);
|
|
|
|
CPSample_ID samp_id;
|
2017-03-18 23:36:26 +00:00
|
|
|
|
2014-02-10 01:10:30 +00:00
|
|
|
if (aux_sample_data.exists) {
|
2017-03-18 23:36:26 +00:00
|
|
|
samp_id = load_sample_data(aux_sample_data);
|
|
|
|
CPSampleManager::get_singleton()->set_c5_freq(samp_id, aux_sample_data.c5spd);
|
|
|
|
CPSampleManager::get_singleton()->set_loop_begin(samp_id, aux_sample_data.loop_begin);
|
|
|
|
CPSampleManager::get_singleton()->set_loop_end(samp_id, aux_sample_data.loop_end);
|
|
|
|
CPSample_Loop_Type loop_type = aux_sample_data.loop_enabled ? (aux_sample_data.pingpong_enabled ? CP_LOOP_BIDI : CP_LOOP_FORWARD) : CP_LOOP_NONE;
|
|
|
|
CPSampleManager::get_singleton()->set_loop_end(samp_id, aux_sample_data.loop_end);
|
|
|
|
CPSampleManager::get_singleton()->set_loop_type(samp_id, loop_type);
|
2014-02-10 01:10:30 +00:00
|
|
|
}
|
2017-03-18 23:36:26 +00:00
|
|
|
|
2014-02-10 01:10:30 +00:00
|
|
|
//printf("Loaded id is null?: %i\n",samp_id.is_null());
|
|
|
|
p_sample->set_sample_data(samp_id);
|
|
|
|
if (!samp_id.is_null()) {
|
2017-03-18 23:36:26 +00:00
|
|
|
|
|
|
|
// printf("Loaded ID: stereo: %i len %i 16bit %i\n",CPSampleManager::get_singleton()->is_stereo(samp_id), CPSampleManager::get_singleton()->get_size( samp_id), CPSampleManager::get_singleton()->is_16bits( samp_id) );
|
2014-02-10 01:10:30 +00:00
|
|
|
}
|
|
|
|
|
2017-03-18 23:36:26 +00:00
|
|
|
CP_ERR_COND_V(file->eof_reached(), FILE_CORRUPTED);
|
|
|
|
CP_ERR_COND_V(file->get_error(), FILE_CORRUPTED);
|
2014-02-10 01:10:30 +00:00
|
|
|
|
2017-03-18 23:36:26 +00:00
|
|
|
return FILE_OK;
|
|
|
|
}
|
2014-02-10 01:10:30 +00:00
|
|
|
|
2017-03-18 23:36:26 +00:00
|
|
|
CPSample_ID CPLoader_IT::load_sample_data(AuxSampleData &p_sample_data) {
|
2014-02-10 01:10:30 +00:00
|
|
|
|
2017-03-18 23:36:26 +00:00
|
|
|
int aux_sample_properties = (p_sample_data.is16bit ? IT_SAMPLE_16BITS : 0) | (p_sample_data.compressed ? IT_SAMPLE_COMPRESSED : 0) | (p_sample_data.stereo ? IT_SAMPLE_STEREO : 0);
|
2014-02-10 01:10:30 +00:00
|
|
|
|
|
|
|
file->seek(p_sample_data.fileofs);
|
2017-03-18 23:36:26 +00:00
|
|
|
|
|
|
|
CPSampleManager *sm = CPSampleManager::get_singleton();
|
2014-02-10 01:10:30 +00:00
|
|
|
|
|
|
|
CPSample_ID id;
|
2017-03-18 23:36:26 +00:00
|
|
|
|
2014-02-10 01:10:30 +00:00
|
|
|
switch (aux_sample_properties) {
|
|
|
|
|
2017-03-18 23:36:26 +00:00
|
|
|
case (0): // 8 bits, mono
|
|
|
|
case (IT_SAMPLE_16BITS): // 16 bits mono
|
|
|
|
case (IT_SAMPLE_STEREO): // 8 bits stereo
|
|
|
|
case (IT_SAMPLE_16BITS | IT_SAMPLE_STEREO): { // 16 bits mono
|
2014-02-10 01:10:30 +00:00
|
|
|
|
2017-03-18 23:36:26 +00:00
|
|
|
id = sm->create(p_sample_data.is16bit, p_sample_data.stereo, p_sample_data.length);
|
2014-02-10 01:10:30 +00:00
|
|
|
if (id.is_null())
|
|
|
|
break;
|
|
|
|
|
|
|
|
sm->lock_data(id);
|
|
|
|
|
2017-03-18 23:36:26 +00:00
|
|
|
int16_t *ptr16 = (int16_t *)sm->get_data(id);
|
|
|
|
int8_t *ptr8 = (int8_t *)ptr16;
|
2014-02-10 01:10:30 +00:00
|
|
|
|
2017-03-18 23:36:26 +00:00
|
|
|
int chans = p_sample_data.stereo ? 2 : 1;
|
2014-02-10 01:10:30 +00:00
|
|
|
|
|
|
|
if (p_sample_data.is16bit) {
|
|
|
|
|
2017-03-18 23:36:26 +00:00
|
|
|
for (int c = 0; c < chans; c++) {
|
2014-02-10 01:10:30 +00:00
|
|
|
|
2017-03-18 23:36:26 +00:00
|
|
|
for (int i = 0; i < p_sample_data.length; i++) {
|
2014-02-10 01:10:30 +00:00
|
|
|
|
2017-03-18 23:36:26 +00:00
|
|
|
ptr16[i * chans + c] = file->get_word();
|
2014-02-10 01:10:30 +00:00
|
|
|
}
|
|
|
|
}
|
|
|
|
} else {
|
|
|
|
|
2017-03-18 23:36:26 +00:00
|
|
|
for (int c = 0; c < chans; c++) {
|
2014-02-10 01:10:30 +00:00
|
|
|
|
2017-03-18 23:36:26 +00:00
|
|
|
for (int i = 0; i < p_sample_data.length; i++) {
|
2014-02-10 01:10:30 +00:00
|
|
|
|
2017-03-18 23:36:26 +00:00
|
|
|
ptr8[i * chans + c] = file->get_byte();
|
2014-02-10 01:10:30 +00:00
|
|
|
}
|
|
|
|
}
|
|
|
|
}
|
|
|
|
|
|
|
|
sm->unlock_data(id);
|
|
|
|
|
|
|
|
} break;
|
|
|
|
case (IT_SAMPLE_COMPRESSED): { // 8 bits compressed
|
|
|
|
|
2017-03-18 23:36:26 +00:00
|
|
|
id = sm->create(false, false, p_sample_data.length);
|
2014-02-10 01:10:30 +00:00
|
|
|
if (id.is_null())
|
|
|
|
break;
|
|
|
|
sm->lock_data(id);
|
2017-03-18 23:36:26 +00:00
|
|
|
|
|
|
|
if (load_sample_8bits_IT_compressed((void *)sm->get_data(id), p_sample_data.length)) {
|
2014-02-10 01:10:30 +00:00
|
|
|
|
|
|
|
sm->unlock_data(id);
|
|
|
|
sm->destroy(id);
|
2017-03-18 23:36:26 +00:00
|
|
|
|
2014-02-10 01:10:30 +00:00
|
|
|
break;
|
|
|
|
}
|
|
|
|
|
|
|
|
sm->unlock_data(id);
|
|
|
|
|
|
|
|
} break;
|
2017-03-18 23:36:26 +00:00
|
|
|
case (IT_SAMPLE_16BITS | IT_SAMPLE_COMPRESSED): { // 16 bits compressed
|
2014-02-10 01:10:30 +00:00
|
|
|
|
2017-03-18 23:36:26 +00:00
|
|
|
id = sm->create(true, false, p_sample_data.length);
|
2014-02-10 01:10:30 +00:00
|
|
|
if (id.is_null())
|
|
|
|
break;
|
|
|
|
sm->lock_data(id);
|
2017-03-18 23:36:26 +00:00
|
|
|
|
|
|
|
if (load_sample_16bits_IT_compressed((void *)sm->get_data(id), p_sample_data.length)) {
|
2014-02-10 01:10:30 +00:00
|
|
|
|
|
|
|
sm->unlock_data(id);
|
|
|
|
sm->destroy(id);
|
|
|
|
break;
|
|
|
|
}
|
|
|
|
|
|
|
|
sm->unlock_data(id);
|
|
|
|
|
|
|
|
} break;
|
|
|
|
default: {
|
2017-03-18 23:36:26 +00:00
|
|
|
|
2014-02-10 01:10:30 +00:00
|
|
|
// I dont know how to handle stereo compressed, does that exist?
|
|
|
|
} break;
|
|
|
|
}
|
|
|
|
|
|
|
|
return id;
|
|
|
|
}
|
|
|
|
|
|
|
|
CPLoader::Error CPLoader_IT::load_samples() {
|
|
|
|
|
2017-03-18 23:36:26 +00:00
|
|
|
for (int i = 0; i < header.smpnum; i++) {
|
2014-02-10 01:10:30 +00:00
|
|
|
|
2017-03-18 23:36:26 +00:00
|
|
|
//seek to sample
|
|
|
|
file->seek(0xC0 + header.ordnum + header.insnum * 4 + i * 4);
|
2014-02-10 01:10:30 +00:00
|
|
|
|
2017-03-18 23:36:26 +00:00
|
|
|
uint32_t final_location = file->get_dword();
|
|
|
|
file->seek(final_location);
|
2014-02-10 01:10:30 +00:00
|
|
|
|
2017-03-18 23:36:26 +00:00
|
|
|
Error err = load_sample(song->get_sample(i));
|
|
|
|
CP_ERR_COND_V(err, err);
|
2014-02-10 01:10:30 +00:00
|
|
|
}
|
|
|
|
|
|
|
|
if (file->eof_reached() || file->get_error())
|
|
|
|
return FILE_CORRUPTED;
|
|
|
|
|
|
|
|
return FILE_OK;
|
|
|
|
}
|
|
|
|
/* * NOTICE * NOTICE * NOTICE * NOTICE * NOTICE * NOTICE * NOTICE * NOTICE * NOTICE * NOTICE * NOTICE
|
|
|
|
|
|
|
|
-The following sample decompression code is based on xmp's code.(http://xmp.helllabs.org) which is based in openCP code.
|
|
|
|
|
|
|
|
* NOTICE * NOTICE * NOTICE * NOTICE * NOTICE * NOTICE * NOTICE * NOTICE * NOTICE * NOTICE * NOTICE */
|
|
|
|
|
2017-03-18 23:36:26 +00:00
|
|
|
uint32_t CPLoader_IT::read_n_bits_from_IT_compressed_block(uint8_t p_bits_to_read) {
|
|
|
|
|
|
|
|
uint32_t aux_return_value;
|
|
|
|
uint32_t val;
|
|
|
|
|
|
|
|
uint8_t *buffer = (uint8_t *)source_position;
|
|
|
|
if (p_bits_to_read <= source_remaining_bits) {
|
|
|
|
|
|
|
|
val = buffer[3];
|
|
|
|
val <<= 8;
|
|
|
|
val |= buffer[2];
|
|
|
|
val <<= 8;
|
|
|
|
val |= buffer[1];
|
|
|
|
val <<= 8;
|
|
|
|
val |= buffer[0];
|
|
|
|
|
|
|
|
aux_return_value = val & ((1 << p_bits_to_read) - 1);
|
|
|
|
val >>= p_bits_to_read;
|
|
|
|
source_remaining_bits -= p_bits_to_read;
|
|
|
|
|
|
|
|
buffer[3] = val >> 24;
|
|
|
|
buffer[2] = (val >> 16) & 0xFF;
|
|
|
|
buffer[1] = (val >> 8) & 0xFF;
|
|
|
|
buffer[0] = (val)&0xFF;
|
|
|
|
|
|
|
|
} else {
|
|
|
|
aux_return_value = buffer[3];
|
|
|
|
aux_return_value <<= 8;
|
|
|
|
aux_return_value |= buffer[2];
|
|
|
|
aux_return_value <<= 8;
|
|
|
|
aux_return_value |= buffer[1];
|
|
|
|
aux_return_value <<= 8;
|
|
|
|
aux_return_value |= buffer[0];
|
|
|
|
|
|
|
|
uint32_t nbits = p_bits_to_read - source_remaining_bits;
|
|
|
|
source_position++;
|
|
|
|
|
|
|
|
buffer += 4;
|
|
|
|
val = buffer[3];
|
|
|
|
val <<= 8;
|
|
|
|
val |= buffer[2];
|
|
|
|
val <<= 8;
|
|
|
|
val |= buffer[1];
|
|
|
|
val <<= 8;
|
|
|
|
val |= buffer[0];
|
|
|
|
aux_return_value |= ((val & ((1 << nbits) - 1)) << source_remaining_bits);
|
|
|
|
val >>= nbits;
|
|
|
|
source_remaining_bits = 32 - nbits;
|
|
|
|
buffer[3] = val >> 24;
|
|
|
|
buffer[2] = (val >> 16) & 0xFF;
|
|
|
|
buffer[1] = (val >> 8) & 0xFF;
|
|
|
|
buffer[0] = (val)&0xFF;
|
|
|
|
}
|
|
|
|
|
|
|
|
return aux_return_value;
|
2014-02-10 01:10:30 +00:00
|
|
|
}
|
|
|
|
|
2017-03-18 23:36:26 +00:00
|
|
|
bool CPLoader_IT::read_IT_compressed_block(bool p_16bits) {
|
2014-02-10 01:10:30 +00:00
|
|
|
|
|
|
|
uint16_t size;
|
|
|
|
|
2017-03-18 23:36:26 +00:00
|
|
|
size = file->get_word();
|
2014-02-10 01:10:30 +00:00
|
|
|
|
|
|
|
if (file->eof_reached() || file->get_error()) return true;
|
|
|
|
|
2017-03-18 23:36:26 +00:00
|
|
|
pat_data = (uint8_t *)CP_ALLOC(4 * ((size >> 2) + 2));
|
2014-02-10 01:10:30 +00:00
|
|
|
if (!pat_data)
|
|
|
|
return true;
|
|
|
|
|
2017-03-18 23:36:26 +00:00
|
|
|
source_buffer = (uint32_t *)pat_data;
|
|
|
|
file->get_byte_array((uint8_t *)source_buffer, size);
|
|
|
|
|
2014-02-10 01:10:30 +00:00
|
|
|
if (file->eof_reached() || file->get_error()) {
|
2017-03-18 23:36:26 +00:00
|
|
|
|
2014-02-10 01:10:30 +00:00
|
|
|
free_IT_compressed_block();
|
|
|
|
return true;
|
|
|
|
}
|
2017-03-18 23:36:26 +00:00
|
|
|
|
2014-02-10 01:10:30 +00:00
|
|
|
source_position = source_buffer;
|
|
|
|
source_remaining_bits = 32;
|
|
|
|
|
|
|
|
return false;
|
|
|
|
}
|
|
|
|
|
2017-03-18 23:36:26 +00:00
|
|
|
void CPLoader_IT::free_IT_compressed_block() {
|
2014-02-10 01:10:30 +00:00
|
|
|
|
|
|
|
if (pat_data) {
|
|
|
|
CP_FREE(pat_data);
|
2017-03-18 23:36:26 +00:00
|
|
|
pat_data = NULL;
|
2014-02-10 01:10:30 +00:00
|
|
|
}
|
|
|
|
}
|
|
|
|
|
2017-03-18 23:36:26 +00:00
|
|
|
bool CPLoader_IT::load_sample_8bits_IT_compressed(void *p_dest_buffer, int p_buffsize) {
|
2014-02-10 01:10:30 +00:00
|
|
|
|
2017-03-18 23:36:26 +00:00
|
|
|
int8_t *dest_buffer; /* destination buffer which will be returned */
|
|
|
|
uint16_t block_length; /* length of compressed data block in samples */
|
|
|
|
uint16_t block_position; /* position in block */
|
|
|
|
uint8_t bit_width; /* actual "bit width" */
|
|
|
|
uint16_t aux_value; /* value read from file to be processed */
|
|
|
|
int8_t d1, d2; /* integrator buffers (d2 for it2.15) */
|
|
|
|
int8_t *dest_position; /* position in output buffer */
|
|
|
|
int8_t v; /* sample value */
|
2014-02-10 01:10:30 +00:00
|
|
|
bool it215; // is this an it215 module?
|
|
|
|
|
2017-03-18 23:36:26 +00:00
|
|
|
dest_buffer = (int8_t *)p_dest_buffer;
|
2014-02-10 01:10:30 +00:00
|
|
|
|
2017-03-18 23:36:26 +00:00
|
|
|
if (dest_buffer == NULL)
|
2014-02-10 01:10:30 +00:00
|
|
|
return true;
|
|
|
|
|
2017-03-18 23:36:26 +00:00
|
|
|
for (int i = 0; i < p_buffsize; i++)
|
|
|
|
dest_buffer[i] = 0;
|
2014-02-10 01:10:30 +00:00
|
|
|
|
|
|
|
dest_position = dest_buffer;
|
|
|
|
|
2017-03-18 23:36:26 +00:00
|
|
|
it215 = (header.cmwt == 0x215);
|
2014-02-10 01:10:30 +00:00
|
|
|
|
|
|
|
/* now unpack data till the dest buffer is full */
|
|
|
|
|
|
|
|
while (p_buffsize) {
|
2017-03-18 23:36:26 +00:00
|
|
|
/* read a new block of compressed data and reset variables */
|
|
|
|
if (read_IT_compressed_block(false)) {
|
2014-02-10 01:10:30 +00:00
|
|
|
CP_PRINTERR("Out of memory decompressing IT CPSample");
|
|
|
|
return true;
|
|
|
|
}
|
|
|
|
|
|
|
|
block_length = (p_buffsize < 0x8000) ? p_buffsize : 0x8000;
|
|
|
|
|
|
|
|
block_position = 0;
|
|
|
|
|
2017-03-18 23:36:26 +00:00
|
|
|
bit_width = 9; /* start with width of 9 bits */
|
2014-02-10 01:10:30 +00:00
|
|
|
|
2017-03-18 23:36:26 +00:00
|
|
|
d1 = d2 = 0; /* reset integrator buffers */
|
2014-02-10 01:10:30 +00:00
|
|
|
|
2017-03-18 23:36:26 +00:00
|
|
|
/* now uncompress the data block */
|
|
|
|
while (block_position < block_length) {
|
2014-02-10 01:10:30 +00:00
|
|
|
|
2017-03-18 23:36:26 +00:00
|
|
|
aux_value = read_n_bits_from_IT_compressed_block(bit_width); /* read bits */
|
2014-02-10 01:10:30 +00:00
|
|
|
|
2017-03-18 23:36:26 +00:00
|
|
|
if (bit_width < 7) { /* method 1 (1-6 bits) */
|
2014-02-10 01:10:30 +00:00
|
|
|
|
2017-03-18 23:36:26 +00:00
|
|
|
if (aux_value == (1 << (bit_width - 1))) { /* check for "100..." */
|
2014-02-10 01:10:30 +00:00
|
|
|
|
|
|
|
aux_value = read_n_bits_from_IT_compressed_block(3) + 1; /* yes -> read new width; */
|
2017-03-18 23:36:26 +00:00
|
|
|
bit_width = (aux_value < bit_width) ? aux_value : aux_value + 1;
|
|
|
|
/* and expand it */
|
|
|
|
continue; /* ... next value */
|
2014-02-10 01:10:30 +00:00
|
|
|
}
|
|
|
|
|
2017-03-18 23:36:26 +00:00
|
|
|
} else if (bit_width < 9) { /* method 2 (7-8 bits) */
|
2014-02-10 01:10:30 +00:00
|
|
|
|
|
|
|
uint8_t border = (0xFF >> (9 - bit_width)) - 4;
|
2017-03-18 23:36:26 +00:00
|
|
|
/* lower border for width chg */
|
2014-02-10 01:10:30 +00:00
|
|
|
|
2017-03-18 23:36:26 +00:00
|
|
|
if (aux_value > border && aux_value <= (border + 8)) {
|
2014-02-10 01:10:30 +00:00
|
|
|
|
|
|
|
aux_value -= border; /* convert width to 1-8 */
|
|
|
|
bit_width = (aux_value < bit_width) ? aux_value : aux_value + 1;
|
2017-03-18 23:36:26 +00:00
|
|
|
/* and expand it */
|
|
|
|
continue; /* ... next value */
|
2014-02-10 01:10:30 +00:00
|
|
|
}
|
|
|
|
|
2017-03-18 23:36:26 +00:00
|
|
|
} else if (bit_width == 9) { /* method 3 (9 bits) */
|
2014-02-10 01:10:30 +00:00
|
|
|
|
2017-03-18 23:36:26 +00:00
|
|
|
if (aux_value & 0x100) { /* bit 8 set? */
|
2014-02-10 01:10:30 +00:00
|
|
|
|
2017-03-18 23:36:26 +00:00
|
|
|
bit_width = (aux_value + 1) & 0xff; /* new width... */
|
|
|
|
continue; /* ... and next value */
|
2014-02-10 01:10:30 +00:00
|
|
|
}
|
|
|
|
|
|
|
|
} else { /* illegal width, abort */
|
|
|
|
|
|
|
|
free_IT_compressed_block();
|
|
|
|
CP_PRINTERR("CPSample has illegal BitWidth ");
|
|
|
|
return true;
|
|
|
|
}
|
|
|
|
|
|
|
|
/* now expand value to signed byte */
|
2017-03-18 23:36:26 +00:00
|
|
|
if (bit_width < 8) {
|
2014-02-10 01:10:30 +00:00
|
|
|
|
|
|
|
uint8_t tmp_shift = 8 - bit_width;
|
|
|
|
|
2017-03-18 23:36:26 +00:00
|
|
|
v = (aux_value << tmp_shift);
|
|
|
|
v >>= tmp_shift;
|
2014-02-10 01:10:30 +00:00
|
|
|
|
2017-03-18 23:36:26 +00:00
|
|
|
} else
|
|
|
|
v = (int8_t)aux_value;
|
2014-02-10 01:10:30 +00:00
|
|
|
|
|
|
|
/* integrate upon the sample values */
|
|
|
|
d1 += v;
|
2017-03-18 23:36:26 +00:00
|
|
|
d2 += d1;
|
2014-02-10 01:10:30 +00:00
|
|
|
|
|
|
|
/* ... and store it into the buffer */
|
|
|
|
*(dest_position++) = it215 ? d2 : d1;
|
|
|
|
block_position++;
|
|
|
|
}
|
|
|
|
|
|
|
|
/* now subtract block lenght from total length and go on */
|
|
|
|
free_IT_compressed_block();
|
|
|
|
p_buffsize -= block_length;
|
|
|
|
}
|
|
|
|
|
|
|
|
return false;
|
|
|
|
}
|
|
|
|
|
2017-03-18 23:36:26 +00:00
|
|
|
bool CPLoader_IT::load_sample_16bits_IT_compressed(void *p_dest_buffer, int p_buffsize) {
|
2014-02-10 01:10:30 +00:00
|
|
|
|
2017-03-18 23:36:26 +00:00
|
|
|
int16_t *dest_buffer; /* destination buffer which will be returned */
|
|
|
|
uint16_t block_length; /* length of compressed data block in samples */
|
|
|
|
uint16_t block_position; /* position in block */
|
|
|
|
uint8_t bit_width; /* actual "bit width" */
|
|
|
|
uint32_t aux_value; /* value read from file to be processed */
|
|
|
|
int16_t d1, d2; /* integrator buffers (d2 for it2.15) */
|
|
|
|
int16_t *dest_position; /* position in output buffer */
|
|
|
|
int16_t v; /* sample value */
|
2014-02-10 01:10:30 +00:00
|
|
|
|
|
|
|
bool it215; // is this an it215 module?
|
|
|
|
|
2017-03-18 23:36:26 +00:00
|
|
|
dest_buffer = (int16_t *)p_dest_buffer;
|
2014-02-10 01:10:30 +00:00
|
|
|
|
2017-03-18 23:36:26 +00:00
|
|
|
if (dest_buffer == NULL)
|
2014-02-10 01:10:30 +00:00
|
|
|
return true;
|
|
|
|
|
2017-03-18 23:36:26 +00:00
|
|
|
for (int i = 0; i < p_buffsize; i++)
|
|
|
|
dest_buffer[i] = 0;
|
2014-02-10 01:10:30 +00:00
|
|
|
|
|
|
|
dest_position = dest_buffer;
|
|
|
|
|
2017-03-18 23:36:26 +00:00
|
|
|
it215 = (header.cmwt == 0x215);
|
2014-02-10 01:10:30 +00:00
|
|
|
|
|
|
|
while (p_buffsize) {
|
2017-03-18 23:36:26 +00:00
|
|
|
/* read a new block of compressed data and reset variables */
|
|
|
|
if (read_IT_compressed_block(true)) {
|
2014-02-10 01:10:30 +00:00
|
|
|
|
|
|
|
return true;
|
|
|
|
}
|
|
|
|
|
|
|
|
block_length = (p_buffsize < 0x4000) ? p_buffsize : 0x4000;
|
|
|
|
|
|
|
|
block_position = 0;
|
|
|
|
|
2017-03-18 23:36:26 +00:00
|
|
|
bit_width = 17; /* start with width of 9 bits */
|
2014-02-10 01:10:30 +00:00
|
|
|
|
2017-03-18 23:36:26 +00:00
|
|
|
d1 = d2 = 0; /* reset integrator buffers */
|
2014-02-10 01:10:30 +00:00
|
|
|
|
2017-03-18 23:36:26 +00:00
|
|
|
while (block_position < block_length) {
|
2014-02-10 01:10:30 +00:00
|
|
|
|
2017-03-18 23:36:26 +00:00
|
|
|
aux_value = read_n_bits_from_IT_compressed_block(bit_width); /* read bits */
|
2014-02-10 01:10:30 +00:00
|
|
|
|
2017-03-18 23:36:26 +00:00
|
|
|
if (bit_width < 7) { /* method 1 (1-6 bits) */
|
2014-02-10 01:10:30 +00:00
|
|
|
|
2017-03-18 23:36:26 +00:00
|
|
|
if ((signed)aux_value == (1 << (bit_width - 1))) { /* check for "100..." */
|
2014-02-10 01:10:30 +00:00
|
|
|
|
|
|
|
aux_value = read_n_bits_from_IT_compressed_block(4) + 1; /* yes -> read new width; */
|
2017-03-18 23:36:26 +00:00
|
|
|
bit_width = (aux_value < bit_width) ? aux_value : aux_value + 1;
|
|
|
|
/* and expand it */
|
|
|
|
continue; /* ... next value */
|
2014-02-10 01:10:30 +00:00
|
|
|
}
|
|
|
|
|
2017-03-18 23:36:26 +00:00
|
|
|
} else if (bit_width < 17) {
|
2014-02-10 01:10:30 +00:00
|
|
|
|
|
|
|
uint16_t border = (0xFFFF >> (17 - bit_width)) - 8;
|
|
|
|
|
2017-03-18 23:36:26 +00:00
|
|
|
if ((int)aux_value > (int)border && (int)aux_value <= ((int)border + 16)) {
|
2014-02-10 01:10:30 +00:00
|
|
|
|
|
|
|
aux_value -= border; /* convert width to 1-8 */
|
|
|
|
bit_width = (aux_value < bit_width) ? aux_value : aux_value + 1;
|
2017-03-18 23:36:26 +00:00
|
|
|
/* and expand it */
|
|
|
|
continue; /* ... next value */
|
2014-02-10 01:10:30 +00:00
|
|
|
}
|
|
|
|
|
2017-03-18 23:36:26 +00:00
|
|
|
} else if (bit_width == 17) {
|
2014-02-10 01:10:30 +00:00
|
|
|
|
2017-03-18 23:36:26 +00:00
|
|
|
if (aux_value & 0x10000) { /* bit 8 set? */
|
2014-02-10 01:10:30 +00:00
|
|
|
|
2017-03-18 23:36:26 +00:00
|
|
|
bit_width = (aux_value + 1) & 0xff; /* new width... */
|
|
|
|
continue; /* ... and next value */
|
2014-02-10 01:10:30 +00:00
|
|
|
}
|
|
|
|
|
|
|
|
} else { /* illegal width, abort */
|
|
|
|
|
|
|
|
CP_PRINTERR("CPSample has illegal BitWidth ");
|
|
|
|
|
|
|
|
free_IT_compressed_block();
|
2017-03-18 23:36:26 +00:00
|
|
|
|
2014-02-10 01:10:30 +00:00
|
|
|
return true;
|
|
|
|
}
|
|
|
|
|
|
|
|
/* now expand value to signed byte */
|
2017-03-18 23:36:26 +00:00
|
|
|
if (bit_width < 16) {
|
2014-02-10 01:10:30 +00:00
|
|
|
|
|
|
|
uint8_t tmp_shift = 16 - bit_width;
|
|
|
|
|
2017-03-18 23:36:26 +00:00
|
|
|
v = (aux_value << tmp_shift);
|
|
|
|
v >>= tmp_shift;
|
2014-02-10 01:10:30 +00:00
|
|
|
|
2017-03-18 23:36:26 +00:00
|
|
|
} else
|
|
|
|
v = (int16_t)aux_value;
|
2014-02-10 01:10:30 +00:00
|
|
|
|
|
|
|
/* integrate upon the sample values */
|
|
|
|
d1 += v;
|
2017-03-18 23:36:26 +00:00
|
|
|
d2 += d1;
|
2014-02-10 01:10:30 +00:00
|
|
|
|
|
|
|
/* ... and store it into the buffer */
|
|
|
|
*(dest_position++) = it215 ? d2 : d1;
|
|
|
|
block_position++;
|
|
|
|
}
|
|
|
|
|
|
|
|
/* now subtract block lenght from total length and go on */
|
|
|
|
free_IT_compressed_block();
|
|
|
|
p_buffsize -= block_length;
|
|
|
|
}
|
|
|
|
|
|
|
|
return false;
|
|
|
|
}
|