| 1 |
/* SPDX-License-Identifier: BSD-3-Clause */ |
| 2 |
/* SPDX-FileCopyrightText: OpenMPT Project Developers and Contributors */ |
| 3 |
|
| 4 |
|
| 5 |
#pragma once |
| 6 |
|
| 7 |
#include "openmpt/all/BuildSettings.hpp" |
| 8 |
|
| 9 |
#include "mpt/base/bit.hpp" |
| 10 |
#include "mpt/base/macros.hpp" |
| 11 |
#include "mpt/base/memory.hpp" |
| 12 |
#include "openmpt/base/Types.hpp" |
| 13 |
|
| 14 |
#include <algorithm> |
| 15 |
|
| 16 |
#include <cmath> |
| 17 |
#include <cstddef> |
| 18 |
#include <cstdlib> |
| 19 |
|
| 20 |
|
| 21 |
OPENMPT_NAMESPACE_BEGIN |
| 22 |
|
| 23 |
|
| 24 |
namespace SC |
| 25 |
{ // SC = _S_ample_C_onversion |
| 26 |
|
| 27 |
|
| 28 |
struct EncodeuLaw |
| 29 |
{ |
| 30 |
using input_t = int16; |
| 31 |
using output_t = std::byte; |
| 32 |
static constexpr uint8 exp_table[17] = {0, 7 << 4, 6 << 4, 5 << 4, 4 << 4, 3 << 4, 2 << 4, 1 << 4, 0 << 4, 0, 0, 0, 0, 0, 0, 0, 0}; |
| 33 |
static constexpr uint8 mant_table[17] = {0, 10, 9, 8, 7, 6, 5, 4, 3, 3, 3, 3, 3, 3, 3, 3, 3}; |
| 34 |
MPT_FORCEINLINE output_t operator()(input_t val) |
| 35 |
{ |
| 36 |
uint16 x = static_cast<uint16>(val); |
| 37 |
uint8 out = static_cast<uint8>((x >> 8) & 0x80u); |
| 38 |
uint32 abs = x & 0x7fffu; |
| 39 |
if(x & 0x8000u) |
| 40 |
{ |
| 41 |
abs ^= 0x7fffu; |
| 42 |
abs += 1u; |
| 43 |
} |
| 44 |
x = static_cast<uint16>(std::clamp(static_cast<uint32>(abs + (33 << 2)), static_cast<uint32>(0), static_cast<uint32>(0x7fff))); |
| 45 |
int index = mpt::countl_zero(x); |
| 46 |
out |= exp_table[index]; |
| 47 |
out |= (x >> mant_table[index]) & 0x0fu; |
| 48 |
out ^= 0xffu; |
| 49 |
return mpt::byte_cast<std::byte>(out); |
| 50 |
} |
| 51 |
}; |
| 52 |
|
| 53 |
|
| 54 |
struct EncodeALaw |
| 55 |
{ |
| 56 |
using input_t = int16; |
| 57 |
using output_t = std::byte; |
| 58 |
static constexpr uint8 exp_table[17] = {0, 7 << 4, 6 << 4, 5 << 4, 4 << 4, 3 << 4, 2 << 4, 1 << 4, 0 << 4, 0, 0, 0, 0, 0, 0, 0, 0}; |
| 59 |
static constexpr uint8 mant_table[17] = {0, 10, 9, 8, 7, 6, 5, 4, 4, 4, 4, 4, 4, 4, 4, 4, 4}; |
| 60 |
MPT_FORCEINLINE output_t operator()(input_t val) |
| 61 |
{ |
| 62 |
int16 sx = std::clamp(val, static_cast<int16>(-32767), static_cast<int16>(32767)); |
| 63 |
uint16 x = static_cast<uint16>(sx); |
| 64 |
uint8 out = static_cast<uint8>(((x & 0x8000u) ^ 0x8000u) >> 8); |
| 65 |
x = static_cast<uint16>(std::abs(sx)); |
| 66 |
int index = mpt::countl_zero(x); |
| 67 |
out |= exp_table[index]; |
| 68 |
out |= (x >> mant_table[index]) & 0x0fu; |
| 69 |
out ^= 0x55u; |
| 70 |
return mpt::byte_cast<std::byte>(out); |
| 71 |
} |
| 72 |
}; |
| 73 |
|
| 74 |
|
| 75 |
} // namespace SC |
| 76 |
|
| 77 |
|
| 78 |
OPENMPT_NAMESPACE_END |