godot/servers/audio/reverb_sw.cpp

539 lines
17 KiB
C++
Raw Normal View History

2014-02-10 09:10:30 +08:00
/*************************************************************************/
/* reverb_sw.cpp */
/*************************************************************************/
/* This file is part of: */
/* GODOT ENGINE */
/* https://godotengine.org */
2014-02-10 09:10:30 +08:00
/*************************************************************************/
/* Copyright (c) 2007-2019 Juan Linietsky, Ariel Manzur. */
/* Copyright (c) 2014-2019 Godot Engine contributors (cf. AUTHORS.md) */
2014-02-10 09:10:30 +08: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. */
/*************************************************************************/
2014-02-10 09:10:30 +08:00
#include "reverb_sw.h"
Fix mismatched class/struct definition warnings [-Wmismatched-tags] Fixes the following Clang 7 warnings: ``` core/object.cpp:44:1: warning: '_ObjectDebugLock' defined as a struct here but previously declared as a class [-Wmismatched-tags] core/variant_call.cpp:43:1: warning: '_VariantCall' defined as a struct here but previously declared as a class [-Wmismatched-tags] drivers/gles3/rasterizer_storage_gles3.h:765:2: warning: 'MultiMesh' defined as a struct here but previously declared as a class [-Wmismatched-tags] editor/editor_node.h:794:1: warning: 'EditorProgress' defined as a struct here but previously declared as a class [-Wmismatched-tags] modules/bullet/rigid_body_bullet.h:230:17: warning: class 'KinematicUtilities' was previously declared as a struct [-Wmismatched-tags] modules/bullet/space_bullet.h:60:1: warning: class 'btSoftBodyWorldInfo' was previously declared as a struct [-Wmismatched-tags] scene/resources/world_2d.cpp:40:1: warning: 'SpatialIndexer2D' defined as a struct here but previously declared as a class [-Wmismatched-tags] scene/resources/world.cpp:39:1: warning: 'SpatialIndexer' defined as a struct here but previously declared as a class [-Wmismatched-tags] servers/audio/reverb_sw.cpp:60:1: warning: 'ReverbParamsSW' defined as a struct here but previously declared as a class [-Wmismatched-tags] thirdparty/bullet/BulletSoftBody/btSoftBody.h:43:1: warning: 'btSoftBodyWorldInfo' defined as a struct here but previously declared as a class [-Wmismatched-tags] ```
2018-10-01 22:46:50 +08:00
#include "core/print_string.h"
Fix mismatched class/struct definition warnings [-Wmismatched-tags] Fixes the following Clang 7 warnings: ``` core/object.cpp:44:1: warning: '_ObjectDebugLock' defined as a struct here but previously declared as a class [-Wmismatched-tags] core/variant_call.cpp:43:1: warning: '_VariantCall' defined as a struct here but previously declared as a class [-Wmismatched-tags] drivers/gles3/rasterizer_storage_gles3.h:765:2: warning: 'MultiMesh' defined as a struct here but previously declared as a class [-Wmismatched-tags] editor/editor_node.h:794:1: warning: 'EditorProgress' defined as a struct here but previously declared as a class [-Wmismatched-tags] modules/bullet/rigid_body_bullet.h:230:17: warning: class 'KinematicUtilities' was previously declared as a struct [-Wmismatched-tags] modules/bullet/space_bullet.h:60:1: warning: class 'btSoftBodyWorldInfo' was previously declared as a struct [-Wmismatched-tags] scene/resources/world_2d.cpp:40:1: warning: 'SpatialIndexer2D' defined as a struct here but previously declared as a class [-Wmismatched-tags] scene/resources/world.cpp:39:1: warning: 'SpatialIndexer' defined as a struct here but previously declared as a class [-Wmismatched-tags] servers/audio/reverb_sw.cpp:60:1: warning: 'ReverbParamsSW' defined as a struct here but previously declared as a class [-Wmismatched-tags] thirdparty/bullet/BulletSoftBody/btSoftBody.h:43:1: warning: 'btSoftBodyWorldInfo' defined as a struct here but previously declared as a class [-Wmismatched-tags] ```
2018-10-01 22:46:50 +08:00
#include <stdlib.h>
#define SETMIN(x, y) (x) = MIN((x), (y))
Fix mismatched class/struct definition warnings [-Wmismatched-tags] Fixes the following Clang 7 warnings: ``` core/object.cpp:44:1: warning: '_ObjectDebugLock' defined as a struct here but previously declared as a class [-Wmismatched-tags] core/variant_call.cpp:43:1: warning: '_VariantCall' defined as a struct here but previously declared as a class [-Wmismatched-tags] drivers/gles3/rasterizer_storage_gles3.h:765:2: warning: 'MultiMesh' defined as a struct here but previously declared as a class [-Wmismatched-tags] editor/editor_node.h:794:1: warning: 'EditorProgress' defined as a struct here but previously declared as a class [-Wmismatched-tags] modules/bullet/rigid_body_bullet.h:230:17: warning: class 'KinematicUtilities' was previously declared as a struct [-Wmismatched-tags] modules/bullet/space_bullet.h:60:1: warning: class 'btSoftBodyWorldInfo' was previously declared as a struct [-Wmismatched-tags] scene/resources/world_2d.cpp:40:1: warning: 'SpatialIndexer2D' defined as a struct here but previously declared as a class [-Wmismatched-tags] scene/resources/world.cpp:39:1: warning: 'SpatialIndexer' defined as a struct here but previously declared as a class [-Wmismatched-tags] servers/audio/reverb_sw.cpp:60:1: warning: 'ReverbParamsSW' defined as a struct here but previously declared as a class [-Wmismatched-tags] thirdparty/bullet/BulletSoftBody/btSoftBody.h:43:1: warning: 'btSoftBodyWorldInfo' defined as a struct here but previously declared as a class [-Wmismatched-tags] ```
2018-10-01 22:46:50 +08:00
#define rangeloop(c, min, max) \
for ((c) = (min); (c) < (max); (c)++)
2014-02-10 09:10:30 +08:00
#define MULSHIFT_S32(Factor1, Factor2, Bits) \
((int)(((int64_t)(Factor1) * (Factor2)) >> (Bits)))
2014-02-10 09:10:30 +08:00
struct ReverbParamsSW {
unsigned int BufferSize; // Required buffer size
int gLPF; // Coefficient
int gEcho0; // Coefficient
int gEcho1; // Coefficient
int gEcho2; // Coefficient
int gEcho3; // Coefficient
int gWall; // Coefficient
int gReva; // Coefficient
int gRevb; // Coefficient
int gInputL; // Coefficient
int gInputR; // Coefficient
unsigned int nRevaOldL; // Offset
unsigned int nRevaOldR; // Offset
unsigned int nRevbOldL; // Offset
unsigned int nRevbOldR; // Offset
unsigned int nLwlNew; // Offset
unsigned int nRwrNew; // Offset
unsigned int nEcho0L; // Offset
unsigned int nEcho0R; // Offset
unsigned int nEcho1L; // Offset
unsigned int nEcho1R; // Offset
unsigned int nLwlOld; // Offset
unsigned int nRwrOld; // Offset
unsigned int nLwrNew; // Offset
unsigned int nRwlNew; // Offset
unsigned int nEcho2L; // Offset
unsigned int nEcho2R; // Offset
unsigned int nEcho3L; // Offset
unsigned int nEcho3R; // Offset
unsigned int nLwrOld; // Offset
unsigned int nRwlOld; // Offset
unsigned int nRevaNewL; // Offset
unsigned int nRevaNewR; // Offset
unsigned int nRevbNewL; // Offset
unsigned int nRevbNewR; // Offset
2014-02-10 09:10:30 +08:00
};
static ReverbParamsSW reverb_params_Room = {
0x26C0 / 2,
//gLPF gEcho0 gEcho1 gEcho2 gEcho3 gWall
0x6D80, 0x54B8, -0x4130, 0x0000, 0x0000, -0x4580,
//gReva gRevb gInputL gInputR
0x5800, 0x5300, -0x8000, -0x8000,
//nRevaOldL nRevaOldR nRevbOldL nRevbOldR
0x01B4 - 0x007D, 0x0136 - 0x007D, 0x00B8 - 0x005B, 0x005C - 0x005B,
//nLwlNew nRwrNew nEcho0L nEcho0R nEcho1L nEcho1R
0x04D6, 0x0333, 0x03F0, 0x0227, 0x0374, 0x01EF,
//nLwlOld nRwrOld nLwrNew nRwlNew nEcho2L nEcho2R nEcho3L nEcho3R
0x0334, 0x01B5, 0x0000, 0x0000, 0x0000, 0x0000, 0x0000, 0x0000,
//nLwrOld nRwlOld nRevaNewL nRevaNewR nRevbNewL nRevbNewR
0x0000, 0x0000, 0x01B4, 0x0136, 0x00B8, 0x005C
2014-02-10 09:10:30 +08:00
};
static ReverbParamsSW reverb_params_StudioSmall = {
0x1F40 / 2,
//gLPF gEcho0 gEcho1 gEcho2 gEcho3 gWall
0x70F0, 0x4FA8, -0x4320, 0x4410, -0x3F10, -0x6400,
//gReva gRevb gInputL gInputR
0x5280, 0x4EC0, -0x8000, -0x8000,
//nRevaOldL nRevaOldR nRevbOldL nRevbOldR
0x00B4 - 0x0033, 0x0080 - 0x0033, 0x004C - 0x0025, 0x0026 - 0x0025,
//nLwlNew nRwrNew nEcho0L nEcho0R nEcho1L nEcho1R
0x03E4, 0x031B, 0x03A4, 0x02AF, 0x0372, 0x0266,
//nLwlOld nRwrOld nLwrNew nRwlNew nEcho2L nEcho2R nEcho3L nEcho3R
0x031C, 0x025D, 0x025C, 0x018E, 0x022F, 0x0135, 0x01D2, 0x00B7,
//nLwrOld nRwlOld nRevaNewL nRevaNewR nRevbNewL nRevbNewR
0x018F, 0x00B5, 0x00B4, 0x0080, 0x004C, 0x0026
2014-02-10 09:10:30 +08:00
};
static ReverbParamsSW reverb_params_StudioMedium = {
0x4840 / 2,
//gLPF gEcho0 gEcho1 gEcho2 gEcho3 gWall
0x70F0, 0x4FA8, -0x4320, 0x4510, -0x4110, -0x4B40,
//gReva gRevb gInputL gInputR
0x5280, 0x4EC0, -0x8000, -0x8000,
//nRevaOldL nRevaOldR nRevbOldL nRevbOldR
0x0264 - 0x00B1, 0x01B2 - 0x00B1, 0x0100 - 0x007F, 0x0080 - 0x007F,
//nLwlNew nRwrNew nEcho0L nEcho0R nEcho1L nEcho1R
0x0904, 0x076B, 0x0824, 0x065F, 0x07A2, 0x0616,
//nLwlOld nRwrOld nLwrNew nRwlNew nEcho2L nEcho2R nEcho3L nEcho3R
0x076C, 0x05ED, 0x05EC, 0x042E, 0x050F, 0x0305, 0x0462, 0x02B7,
//nLwrOld nRwlOld nRevaNewL nRevaNewR nRevbNewL nRevbNewR
0x042F, 0x0265, 0x0264, 0x01B2, 0x0100, 0x0080
2014-02-10 09:10:30 +08:00
};
static ReverbParamsSW reverb_params_StudioLarge = {
0x6FE0 / 2,
//gLPF gEcho0 gEcho1 gEcho2 gEcho3 gWall
0x6F60, 0x4FA8, -0x4320, 0x4510, -0x4110, -0x5980,
//gReva gRevb gInputL gInputR
0x5680, 0x52C0, -0x8000, -0x8000,
//nRevaOldL nRevaOldR nRevbOldL nRevbOldR
0x031C - 0x00E3, 0x0238 - 0x00E3, 0x0154 - 0x00A9, 0x00AA - 0x00A9,
//nLwlNew nRwrNew nEcho0L nEcho0R nEcho1L nEcho1R
0x0DFB, 0x0B58, 0x0D09, 0x0A3C, 0x0BD9, 0x0973,
//nLwlOld nRwrOld nLwrNew nRwlNew nEcho2L nEcho2R nEcho3L nEcho3R
0x0B59, 0x08DA, 0x08D9, 0x05E9, 0x07EC, 0x04B0, 0x06EF, 0x03D2,
//nLwrOld nRwlOld nRevaNewL nRevaNewR nRevbNewL nRevbNewR
0x05EA, 0x031D, 0x031C, 0x0238, 0x0154, 0x00AA
2014-02-10 09:10:30 +08:00
};
static ReverbParamsSW reverb_params_Hall = {
0xADE0 / 2,
//gLPF gEcho0 gEcho1 gEcho2 gEcho3 gWall
0x6000, 0x5000, 0x4C00, -0x4800, -0x4400, -0x4000,
//gReva gRevb gInputL gInputR
0x6000, 0x5C00, -0x8000, -0x8000,
//nRevaOldL nRevaOldR nRevbOldL nRevbOldR
0x05C0 - 0x01A5, 0x041A - 0x01A5, 0x0274 - 0x0139, 0x013A - 0x0139,
//nLwlNew nRwrNew nEcho0L nEcho0R nEcho1L nEcho1R
0x15BA, 0x11BB, 0x14C2, 0x10BD, 0x11BC, 0x0DC1,
//nLwlOld nRwrOld nLwrNew nRwlNew nEcho2L nEcho2R nEcho3L nEcho3R
0x11C0, 0x0DC3, 0x0DC0, 0x09C1, 0x0BC4, 0x07C1, 0x0A00, 0x06CD,
//nLwrOld nRwlOld nRevaNewL nRevaNewR nRevbNewL nRevbNewR
0x09C2, 0x05C1, 0x05C0, 0x041A, 0x0274, 0x013A
2014-02-10 09:10:30 +08:00
};
static ReverbParamsSW reverb_params_SpaceEcho = {
0xF6C0 / 2,
//gLPF gEcho0 gEcho1 gEcho2 gEcho3 gWall
0x7E00, 0x5000, -0x4C00, -0x5000, 0x4C00, -0x5000,
//gReva gRevb gInputL gInputR
0x6000, 0x5400, -0x8000, -0x8000,
//nRevaOldL nRevaOldR nRevbOldL nRevbOldR
0x0AE0 - 0x033D, 0x07A2 - 0x033D, 0x0464 - 0x0231, 0x0232 - 0x0231,
//nLwlNew nRwrNew nEcho0L nEcho0R nEcho1L nEcho1R
0x1ED6, 0x1A31, 0x1D14, 0x183B, 0x1BC2, 0x16B2,
//nLwlOld nRwrOld nLwrNew nRwlNew nEcho2L nEcho2R nEcho3L nEcho3R
0x1A32, 0x15EF, 0x15EE, 0x1055, 0x1334, 0x0F2D, 0x11F6, 0x0C5D,
//nLwrOld nRwlOld nRevaNewL nRevaNewR nRevbNewL nRevbNewR
0x1056, 0x0AE1, 0x0AE0, 0x07A2, 0x0464, 0x0232
2014-02-10 09:10:30 +08:00
};
static ReverbParamsSW reverb_params_Echo = {
0x18040 / 2,
//gLPF gEcho0 gEcho1 gEcho2 gEcho3 gWall
0x7FFF, 0x7FFF, 0x0000, 0x0000, 0x0000, -0x7F00,
//gReva gRevb gInputL gInputR
0x0000, 0x0000, -0x8000, -0x8000,
//nRevaOldL nRevaOldR nRevbOldL nRevbOldR
0x1004 - 0x0001, 0x1002 - 0x0001, 0x0004 - 0x0001, 0x0002 - 0x0001,
//nLwlNew nRwrNew nEcho0L nEcho0R nEcho1L nEcho1R
0x1FFF, 0x0FFF, 0x1005, 0x0005, 0x0000, 0x0000,
//nLwlOld nRwrOld nLwrNew nRwlNew nEcho2L nEcho2R nEcho3L nEcho3R
0x1005, 0x0005, 0x0000, 0x0000, 0x0000, 0x0000, 0x0000, 0x0000,
//nLwrOld nRwlOld nRevaNewL nRevaNewR nRevbNewL nRevbNewR
0x0000, 0x0000, 0x1004, 0x1002, 0x0004, 0x0002
2014-02-10 09:10:30 +08:00
};
static ReverbParamsSW reverb_params_Delay = {
0x18040 / 2,
//gLPF gEcho0 gEcho1 gEcho2 gEcho3 gWall
0x7FFF, 0x7FFF, 0x0000, 0x0000, 0x0000, 0x0000,
//gReva gRevb gInputL gInputR
0x0000, 0x0000, -0x8000, -0x8000,
//nRevaOldL nRevaOldR nRevbOldL nRevbOldR
0x1004 - 0x0001, 0x1002 - 0x0001, 0x0004 - 0x0001, 0x0002 - 0x0001,
//nLwlNew nRwrNew nEcho0L nEcho0R nEcho1L nEcho1R
0x1FFF, 0x0FFF, 0x1005, 0x0005, 0x0000, 0x0000,
//nLwlOld nRwrOld nLwrNew nRwlNew nEcho2L nEcho2R nEcho3L nEcho3R
0x1005, 0x0005, 0x0000, 0x0000, 0x0000, 0x0000, 0x0000, 0x0000,
//nLwrOld nRwlOld nRevaNewL nRevaNewR nRevbNewL nRevbNewR
0x0000, 0x0000, 0x1004, 0x1002, 0x0004, 0x0002
2014-02-10 09:10:30 +08:00
};
static ReverbParamsSW reverb_params_HalfEcho = {
0x3C00 / 2,
//gLPF gEcho0 gEcho1 gEcho2 gEcho3 gWall
0x70F0, 0x4FA8, -0x4320, 0x4510, -0x4110, -0x7B00,
//gReva gRevb gInputL gInputR
0x5F80, 0x54C0, -0x8000, -0x8000,
//nRevaOldL nRevaOldR nRevbOldL nRevbOldR
0x0058 - 0x0017, 0x0040 - 0x0017, 0x0028 - 0x0013, 0x0014 - 0x0013,
//nLwlNew nRwrNew nEcho0L nEcho0R nEcho1L nEcho1R
0x0371, 0x02AF, 0x02E5, 0x01DF, 0x02B0, 0x01D7,
//nLwlOld nRwrOld nLwrNew nRwlNew nEcho2L nEcho2R nEcho3L nEcho3R
0x0358, 0x026A, 0x01D6, 0x011E, 0x012D, 0x00B1, 0x011F, 0x0059,
//nLwrOld nRwlOld nRevaNewL nRevaNewR nRevbNewL nRevbNewR
0x01A0, 0x00E3, 0x0058, 0x0040, 0x0028, 0x0014
2014-02-10 09:10:30 +08:00
};
static ReverbParamsSW *reverb_param_modes[] = {
2014-02-10 09:10:30 +08:00
&reverb_params_Room,
&reverb_params_StudioSmall,
&reverb_params_StudioMedium,
&reverb_params_StudioLarge,
&reverb_params_Hall,
&reverb_params_SpaceEcho,
&reverb_params_Echo,
&reverb_params_Delay,
&reverb_params_HalfEcho,
};
bool ReverbSW::process(int *p_input, int *p_output, int p_frames, int p_stereo_stride) {
2014-02-10 09:10:30 +08:00
// p_input must point to a non-looping buffer.
// BOTH p_input and p_output must be touched (use ClearModuleBuffer).
2014-02-10 09:10:30 +08:00
if (!reverb_buffer)
return false;
// LOCAL MACROS
2014-02-10 09:10:30 +08:00
#undef LM_SETSRCOFFSET
#define LM_SETSRCOFFSET(x) \
(x) = current_params->x + Offset; \
if ((x) >= reverb_buffer_size) { \
(x) -= reverb_buffer_size; \
} \
SETMIN(aSample, reverb_buffer_size - (x));
2014-02-10 09:10:30 +08:00
/*
#undef LM_SETSRCOFFSET2
#define LM_SETSRCOFFSET2(x,y) \
(x) = ((y) << 3) >> HZShift; \
(x) += Offset; \
if ( (x) >= reverb_buffer_size ) { \
(x) -= reverb_buffer_size; \
} \
SETMIN ( aSample, reverb_buffer_size - (x) );
*/
#undef LM_SRCADVANCE
#define LM_SRCADVANCE(x) \
(x) += aSample;
2014-02-10 09:10:30 +08:00
#undef LM_MUL
#define LM_MUL(x, y) \
MULSHIFT_S32(x, current_params->y, 15)
2014-02-10 09:10:30 +08:00
#undef LM_REVERB
#define LM_REVERB(x) reverb_buffer[(x) + cSample]
2014-02-10 09:10:30 +08:00
// LOCAL VARIABLES
2014-02-10 09:10:30 +08:00
unsigned int Offset;
int lwl, lwr, rwl, rwr;
//unsigned char HZShift;
2014-02-10 09:10:30 +08:00
// CODE
2014-02-10 09:10:30 +08:00
lwl = state.lwl;
lwr = state.lwr;
rwl = state.rwl;
rwr = state.rwr;
Offset = state.Offset;
int max = 0;
2014-02-10 09:10:30 +08:00
while (p_frames) {
2014-02-10 09:10:30 +08:00
// Offsets
unsigned int nLwlOld;
unsigned int nRwrOld;
unsigned int nLwlNew;
unsigned int nRwrNew;
unsigned int nLwrOld;
unsigned int nRwlOld;
unsigned int nLwrNew;
unsigned int nRwlNew;
unsigned int nEcho0L;
unsigned int nEcho1L;
unsigned int nEcho2L;
unsigned int nEcho3L;
unsigned int nEcho0R;
unsigned int nEcho1R;
unsigned int nEcho2R;
unsigned int nEcho3R;
unsigned int nRevaOldL;
unsigned int nRevaOldR;
unsigned int nRevbOldL;
unsigned int nRevbOldR;
unsigned int nRevaNewL;
unsigned int nRevaNewR;
unsigned int nRevbNewL;
unsigned int nRevbNewR;
// Other variables
unsigned int aSample = p_frames;
// Set initial offsets
LM_SETSRCOFFSET(nLwlOld);
LM_SETSRCOFFSET(nRwrOld);
LM_SETSRCOFFSET(nLwlNew);
LM_SETSRCOFFSET(nRwrNew);
LM_SETSRCOFFSET(nLwrOld);
LM_SETSRCOFFSET(nRwlOld);
LM_SETSRCOFFSET(nLwrNew);
LM_SETSRCOFFSET(nRwlNew);
LM_SETSRCOFFSET(nEcho0L);
LM_SETSRCOFFSET(nEcho1L);
LM_SETSRCOFFSET(nEcho2L);
LM_SETSRCOFFSET(nEcho3L);
LM_SETSRCOFFSET(nEcho0R);
LM_SETSRCOFFSET(nEcho1R);
LM_SETSRCOFFSET(nEcho2R);
LM_SETSRCOFFSET(nEcho3R);
LM_SETSRCOFFSET(nRevaOldL);
LM_SETSRCOFFSET(nRevaOldR);
LM_SETSRCOFFSET(nRevbOldL);
LM_SETSRCOFFSET(nRevbOldR);
LM_SETSRCOFFSET(nRevaNewL);
LM_SETSRCOFFSET(nRevaNewR);
LM_SETSRCOFFSET(nRevbNewL);
LM_SETSRCOFFSET(nRevbNewR);
2014-02-10 09:10:30 +08:00
//SETMIN ( aSample, p_output.Size - p_output.Offset );
for (unsigned int cSample = 0; cSample < aSample; cSample++) {
2014-02-10 09:10:30 +08:00
int tempL0, tempL1, tempR0, tempR1;
tempL1 = p_input[(cSample << p_stereo_stride)] >> 8;
tempR1 = p_input[(cSample << p_stereo_stride) + 1] >> 8;
2014-02-10 09:10:30 +08:00
tempL0 = LM_MUL(tempL1, gInputL);
tempR0 = LM_MUL(tempR1, gInputR);
2014-02-10 09:10:30 +08:00
/*
Left -> Wall -> Left Reflection
*/
tempL1 = tempL0 + LM_MUL(LM_REVERB(nLwlOld), gWall);
tempR1 = tempR0 + LM_MUL(LM_REVERB(nRwrOld), gWall);
lwl += LM_MUL(tempL1 - lwl, gLPF);
rwr += LM_MUL(tempR1 - rwr, gLPF);
LM_REVERB(nLwlNew) = lwl;
LM_REVERB(nRwrNew) = rwr;
2014-02-10 09:10:30 +08:00
/*
Left -> Wall -> Right Reflection
*/
tempL1 = tempL0 + LM_MUL(LM_REVERB(nRwlOld), gWall);
tempR1 = tempR0 + LM_MUL(LM_REVERB(nLwrOld), gWall);
lwr += LM_MUL(tempL1 - lwr, gLPF);
rwl += LM_MUL(tempR1 - rwl, gLPF);
LM_REVERB(nLwrNew) = lwr;
LM_REVERB(nRwlNew) = rwl;
2014-02-10 09:10:30 +08:00
/*
Early Echo(Early Reflection)
*/
tempL0 =
LM_MUL(LM_REVERB(nEcho0L), gEcho0) +
LM_MUL(LM_REVERB(nEcho1L), gEcho1) +
LM_MUL(LM_REVERB(nEcho2L), gEcho2) +
LM_MUL(LM_REVERB(nEcho3L), gEcho3);
2014-02-10 09:10:30 +08:00
tempR0 =
LM_MUL(LM_REVERB(nEcho0R), gEcho0) +
LM_MUL(LM_REVERB(nEcho1R), gEcho1) +
LM_MUL(LM_REVERB(nEcho2R), gEcho2) +
LM_MUL(LM_REVERB(nEcho3R), gEcho3);
2014-02-10 09:10:30 +08:00
/*
Late Reverb
*/
tempL1 = LM_REVERB(nRevaOldL);
tempR1 = LM_REVERB(nRevaOldR);
tempL0 -= LM_MUL(tempL1, gReva);
tempR0 -= LM_MUL(tempR1, gReva);
LM_REVERB(nRevaNewL) = tempL0;
LM_REVERB(nRevaNewR) = tempR0;
tempL0 = LM_MUL(tempL0, gReva) + tempL1;
tempR0 = LM_MUL(tempR0, gReva) + tempR1;
tempL1 = LM_REVERB(nRevbOldL);
tempR1 = LM_REVERB(nRevbOldR);
tempL0 -= LM_MUL(tempL1, gRevb);
tempR0 -= LM_MUL(tempR1, gRevb);
LM_REVERB(nRevbNewL) = tempL0;
LM_REVERB(nRevbNewR) = tempR0;
tempL0 = LM_MUL(tempL0, gRevb) + tempL1;
tempR0 = LM_MUL(tempR0, gRevb) + tempR1;
2014-02-10 09:10:30 +08:00
/*
Output
*/
max |= abs(tempL0);
max |= abs(tempR0);
2014-02-10 09:10:30 +08:00
p_output[(cSample << p_stereo_stride)] += tempL0 << 8;
p_output[(cSample << p_stereo_stride) + 1] += tempR0 << 8;
2014-02-10 09:10:30 +08:00
}
// Advance offsets
Offset += aSample;
if (Offset >= reverb_buffer_size) {
Offset -= reverb_buffer_size;
}
2014-02-10 09:10:30 +08:00
p_input += aSample << p_stereo_stride;
p_output += aSample << p_stereo_stride;
p_frames -= aSample;
}
state.lwl = lwl;
state.lwr = lwr;
state.rwl = rwl;
state.rwr = rwr;
state.Offset = Offset;
return (max & 0x7FFFFF00) != 0; // audio was mixed?
2014-02-10 09:10:30 +08:00
}
void ReverbSW::adjust_current_params() {
*current_params = *reverb_param_modes[mode];
uint32_t maxofs = 0;
#define LM_CONFIG_PARAM(x) \
current_params->x = (int)(((int64_t)current_params->x * (int64_t)mix_rate * 8L) / (int64_t)44100); \
if (current_params->x > maxofs) \
maxofs = current_params->x;
LM_CONFIG_PARAM(nLwlOld);
LM_CONFIG_PARAM(nRwrOld);
LM_CONFIG_PARAM(nLwlNew);
LM_CONFIG_PARAM(nRwrNew);
LM_CONFIG_PARAM(nLwrOld);
LM_CONFIG_PARAM(nRwlOld);
LM_CONFIG_PARAM(nLwrNew);
LM_CONFIG_PARAM(nRwlNew);
LM_CONFIG_PARAM(nEcho0L);
LM_CONFIG_PARAM(nEcho1L);
LM_CONFIG_PARAM(nEcho2L);
LM_CONFIG_PARAM(nEcho3L);
LM_CONFIG_PARAM(nEcho0R);
LM_CONFIG_PARAM(nEcho1R);
LM_CONFIG_PARAM(nEcho2R);
LM_CONFIG_PARAM(nEcho3R);
LM_CONFIG_PARAM(nRevaOldL);
LM_CONFIG_PARAM(nRevaOldR);
LM_CONFIG_PARAM(nRevbOldL);
LM_CONFIG_PARAM(nRevbOldR);
LM_CONFIG_PARAM(nRevaNewL);
LM_CONFIG_PARAM(nRevaNewR);
LM_CONFIG_PARAM(nRevbNewL);
LM_CONFIG_PARAM(nRevbNewR);
int needed_buffer_size = maxofs + 1;
2014-02-10 09:10:30 +08:00
if (reverb_buffer)
memdelete_arr(reverb_buffer);
reverb_buffer = memnew_arr(int, needed_buffer_size);
reverb_buffer_size = needed_buffer_size;
2014-02-10 09:10:30 +08:00
for (uint32_t i = 0; i < reverb_buffer_size; i++)
reverb_buffer[i] = 0;
2014-02-10 09:10:30 +08:00
state.reset();
}
void ReverbSW::set_mode(ReverbMode p_mode) {
if (mode == p_mode)
2014-02-10 09:10:30 +08:00
return;
mode = p_mode;
2014-02-10 09:10:30 +08:00
adjust_current_params();
}
void ReverbSW::set_mix_rate(int p_mix_rate) {
if (p_mix_rate == mix_rate)
2014-02-10 09:10:30 +08:00
return;
mix_rate = p_mix_rate;
2014-02-10 09:10:30 +08:00
adjust_current_params();
}
ReverbSW::ReverbSW() {
reverb_buffer = 0;
reverb_buffer_size = 0;
mode = REVERB_MODE_ROOM;
mix_rate = 1;
2014-02-10 09:10:30 +08:00
current_params = memnew(ReverbParamsSW);
}
ReverbSW::~ReverbSW() {
if (reverb_buffer)
memdelete_arr(reverb_buffer);
memdelete(current_params);
}