Mercurial > audlegacy
changeset 4232:704607c1f858
1st attempt to integrate dithering and RG engine
author | Eugene Zagidullin <e.asphyx@gmail.com> |
---|---|
date | Wed, 30 Jan 2008 01:22:37 +0300 |
parents | f6625617716b |
children | 74c6f3d3cf1d |
files | src/Makefile src/audacious/input.c src/audacious/main.c src/audacious/main.h src/audacious/plugin.h src/audacious/ui_preferences.c src/libSAD/Makefile src/libSAD/SFMT-alti.h src/libSAD/SFMT-params.h src/libSAD/SFMT-params19937.h src/libSAD/SFMT-sse2.h src/libSAD/SFMT.c src/libSAD/SFMT.h src/libSAD/dither.c src/libSAD/dither.h src/libSAD/dither_ops.c src/libSAD/dither_ops.h src/libSAD/libSAD.h src/libSAD/noicegen.c src/libSAD/noisegen.h |
diffstat | 20 files changed, 2301 insertions(+), 2 deletions(-) [+] |
line wrap: on
line diff
--- a/src/Makefile Mon Jan 28 02:50:54 2008 +0100 +++ b/src/Makefile Wed Jan 30 01:22:37 2008 +0300 @@ -1,4 +1,4 @@ -SUBDIRS = libguess audacious libid3tag +SUBDIRS = libguess audacious libid3tag libSAD include ../extra.mk
--- a/src/audacious/input.c Mon Jan 28 02:50:54 2008 +0100 +++ b/src/audacious/input.c Wed Jan 30 01:22:37 2008 +0300 @@ -250,6 +250,8 @@ right[i] = (*ptr16++); } break; + default: + AUDDBG("Incorrect sample format!\n"); } }
--- a/src/audacious/main.c Mon Jan 28 02:50:54 2008 +0100 +++ b/src/audacious/main.c Wed Jan 30 01:22:37 2008 +0300 @@ -230,6 +230,7 @@ .warn_about_broken_gtk_engines = TRUE, /* warn about broken gtk themes */ FALSE, /* disable inline themes */ TRUE, /* remember jtf text entry */ + 16, /* output bit depth */ }; typedef struct bmp_cfg_boolent_t { @@ -378,6 +379,7 @@ {"colorize_r", &cfg.colorize_r, TRUE}, {"colorize_g", &cfg.colorize_g, TRUE}, {"colorize_b", &cfg.colorize_b, TRUE}, + {"output_bit_depth", &cfg.output_bit_depth, TRUE}, }; static gint ncfgient = G_N_ELEMENTS(bmp_numents);
--- a/src/audacious/main.h Mon Jan 28 02:50:54 2008 +0100 +++ b/src/audacious/main.h Wed Jan 30 01:22:37 2008 +0300 @@ -142,6 +142,7 @@ gboolean warn_about_broken_gtk_engines; gboolean disable_inline_gtk; gboolean remember_jtf_entry; + gint output_bit_depth; }; typedef struct _BmpConfig BmpConfig;
--- a/src/audacious/plugin.h Mon Jan 28 02:50:54 2008 +0100 +++ b/src/audacious/plugin.h Wed Jan 30 01:22:37 2008 +0300 @@ -62,12 +62,30 @@ typedef enum { FMT_U8, FMT_S8, + FMT_U16_LE, FMT_U16_BE, FMT_U16_NE, FMT_S16_LE, FMT_S16_BE, - FMT_S16_NE + FMT_S16_NE, + + /* added in Audacious 1.5 */ + FMT_U24_LE, /* stored in lower 3 bytes of 32-bit value, highest byte must be always set to 0 --asphyx */ + FMT_U24_BE, + FMT_U24_NE, + FMT_S24_LE, + FMT_S24_BE, + FMT_S24_NE, + + FMT_U32_LE, + FMT_U32_BE, + FMT_U32_NE, + FMT_S32_LE, + FMT_S32_BE, + FMT_S32_NE, + + FMT_FLOAT, } AFormat; typedef enum {
--- a/src/audacious/ui_preferences.c Mon Jan 28 02:50:54 2008 +0100 +++ b/src/audacious/ui_preferences.c Wed Jan 30 01:22:37 2008 +0300 @@ -188,6 +188,7 @@ static void mainwin_font_set_cb(); static void playlist_font_set_cb(); GtkWidget *ui_preferences_chardet_table_populate(void); +static GtkWidget *ui_preferences_bit_depth(void); static PreferencesWidget appearance_misc_widgets[] = { {WIDGET_LABEL, N_("<b>_Fonts</b>"), NULL, NULL, NULL, FALSE}, @@ -215,6 +216,8 @@ N_("When checked, Audacious will detect file formats on demand. This can result in a messier playlist, but delivers a major speed benefit."), FALSE}, {WIDGET_CHK_BTN, N_("Detect file formats by extension."), &cfg.use_extension_probing, NULL, N_("When checked, Audacious will detect file formats based by extension. Only files with extensions of supported formats will be loaded."), FALSE}, + {WIDGET_LABEL, N_("<b>Bit Depth</b>"), NULL, NULL, NULL, FALSE}, + {WIDGET_CUSTOM, NULL, NULL, NULL, NULL, TRUE, ui_preferences_bit_depth}, }; static PreferencesWidget playback_page_widgets[] = { @@ -1631,6 +1634,38 @@ return widget; } +static void +on_bit_depth_cbox_changed(GtkWidget *cbox, gpointer data) +{ + gint active = gtk_combo_box_get_active(GTK_COMBO_BOX(cbox)); + cfg.output_bit_depth = (active == 1) ? 24 : 16; +} + +GtkWidget * +ui_preferences_bit_depth(void) +{ + GtkWidget *box = gtk_hbox_new(FALSE, 10); + GtkWidget *label = gtk_label_new(_("Output bit depth:")); + gtk_misc_set_alignment(GTK_MISC(label), 1, 0.5); + gtk_box_pack_start(GTK_BOX(box), label, FALSE, FALSE, 0); + + GtkWidget *combo = gtk_combo_box_new_text (); + gtk_combo_box_append_text(GTK_COMBO_BOX (combo), "16"); + gtk_combo_box_append_text(GTK_COMBO_BOX (combo), "24"); + gtk_box_pack_start(GTK_BOX(box), combo, FALSE, FALSE, 0); + + gint active = (cfg.output_bit_depth == 24) ? 1 : 0; + gtk_combo_box_set_active(GTK_COMBO_BOX(combo), active); + g_signal_connect(combo, "changed", G_CALLBACK(on_bit_depth_cbox_changed), NULL); + + gtk_tooltips_set_tip (tooltips, box, + _("All streams will be converted to this bit depth.\n" + "This should be the max supported bit depth of\nthe sound card or output plugin."), + NULL); + + return box; +} + /* it's at early stage */ static void create_widgets(GtkBox *box, PreferencesWidget *widgets, gint amt)
--- /dev/null Thu Jan 01 00:00:00 1970 +0000 +++ b/src/libSAD/Makefile Wed Jan 30 01:22:37 2008 +0300 @@ -0,0 +1,7 @@ +STATIC_LIB_NOINST = libSAD.a +SRCS = dither.c \ + dither_ops.c \ + SFMT.c \ + noicegen.c + +include ../../buildsys.mk
--- /dev/null Thu Jan 01 00:00:00 1970 +0000 +++ b/src/libSAD/SFMT-alti.h Wed Jan 30 01:22:37 2008 +0300 @@ -0,0 +1,156 @@ +/** + * @file SFMT-alti.h + * + * @brief SIMD oriented Fast Mersenne Twister(SFMT) + * pseudorandom number generator + * + * @author Mutsuo Saito (Hiroshima University) + * @author Makoto Matsumoto (Hiroshima University) + * + * Copyright (C) 2007 Mutsuo Saito, Makoto Matsumoto and Hiroshima + * University. All rights reserved. + * + * The new BSD License is applied to this software. + * see LICENSE.txt + */ + +#ifndef SFMT_ALTI_H +#define SFMT_ALTI_H + +inline static vector unsigned int vec_recursion(vector unsigned int a, + vector unsigned int b, + vector unsigned int c, + vector unsigned int d) + ALWAYSINLINE; + +/** + * This function represents the recursion formula in AltiVec and BIG ENDIAN. + * @param a a 128-bit part of the interal state array + * @param b a 128-bit part of the interal state array + * @param c a 128-bit part of the interal state array + * @param d a 128-bit part of the interal state array + * @return output + */ +inline static vector unsigned int vec_recursion(vector unsigned int a, + vector unsigned int b, + vector unsigned int c, + vector unsigned int d) { + + const vector unsigned int sl1 = ALTI_SL1; + const vector unsigned int sr1 = ALTI_SR1; +#ifdef ONLY64 + const vector unsigned int mask = ALTI_MSK64; + const vector unsigned char perm_sl = ALTI_SL2_PERM64; + const vector unsigned char perm_sr = ALTI_SR2_PERM64; +#else + const vector unsigned int mask = ALTI_MSK; + const vector unsigned char perm_sl = ALTI_SL2_PERM; + const vector unsigned char perm_sr = ALTI_SR2_PERM; +#endif + vector unsigned int v, w, x, y, z; + x = vec_perm(a, (vector unsigned int)perm_sl, perm_sl); + v = a; + y = vec_sr(b, sr1); + z = vec_perm(c, (vector unsigned int)perm_sr, perm_sr); + w = vec_sl(d, sl1); + z = vec_xor(z, w); + y = vec_and(y, mask); + v = vec_xor(v, x); + z = vec_xor(z, y); + z = vec_xor(z, v); + return z; +} + +/** + * This function fills the internal state array with pseudorandom + * integers. + */ +inline static void gen_rand_all(void) { + int i; + vector unsigned int r, r1, r2; + + r1 = sfmt[N - 2].s; + r2 = sfmt[N - 1].s; + for (i = 0; i < N - POS1; i++) { + r = vec_recursion(sfmt[i].s, sfmt[i + POS1].s, r1, r2); + sfmt[i].s = r; + r1 = r2; + r2 = r; + } + for (; i < N; i++) { + r = vec_recursion(sfmt[i].s, sfmt[i + POS1 - N].s, r1, r2); + sfmt[i].s = r; + r1 = r2; + r2 = r; + } +} + +/** + * This function fills the user-specified array with pseudorandom + * integers. + * + * @param array an 128-bit array to be filled by pseudorandom numbers. + * @param size number of 128-bit pesudorandom numbers to be generated. + */ +inline static void gen_rand_array(w128_t *array, int size) { + int i, j; + vector unsigned int r, r1, r2; + + r1 = sfmt[N - 2].s; + r2 = sfmt[N - 1].s; + for (i = 0; i < N - POS1; i++) { + r = vec_recursion(sfmt[i].s, sfmt[i + POS1].s, r1, r2); + array[i].s = r; + r1 = r2; + r2 = r; + } + for (; i < N; i++) { + r = vec_recursion(sfmt[i].s, array[i + POS1 - N].s, r1, r2); + array[i].s = r; + r1 = r2; + r2 = r; + } + /* main loop */ + for (; i < size - N; i++) { + r = vec_recursion(array[i - N].s, array[i + POS1 - N].s, r1, r2); + array[i].s = r; + r1 = r2; + r2 = r; + } + for (j = 0; j < 2 * N - size; j++) { + sfmt[j].s = array[j + size - N].s; + } + for (; i < size; i++) { + r = vec_recursion(array[i - N].s, array[i + POS1 - N].s, r1, r2); + array[i].s = r; + sfmt[j++].s = r; + r1 = r2; + r2 = r; + } +} + +#ifndef ONLY64 +#if defined(__APPLE__) +#define ALTI_SWAP (vector unsigned char) \ + (4, 5, 6, 7, 0, 1, 2, 3, 12, 13, 14, 15, 8, 9, 10, 11) +#else +#define ALTI_SWAP {4, 5, 6, 7, 0, 1, 2, 3, 12, 13, 14, 15, 8, 9, 10, 11} +#endif +/** + * This function swaps high and low 32-bit of 64-bit integers in user + * specified array. + * + * @param array an 128-bit array to be swaped. + * @param size size of 128-bit array. + */ +inline static void swap(w128_t *array, int size) { + int i; + const vector unsigned char perm = ALTI_SWAP; + + for (i = 0; i < size; i++) { + array[i].s = vec_perm(array[i].s, (vector unsigned int)perm, perm); + } +} +#endif + +#endif
--- /dev/null Thu Jan 01 00:00:00 1970 +0000 +++ b/src/libSAD/SFMT-params.h Wed Jan 30 01:22:37 2008 +0300 @@ -0,0 +1,97 @@ +#ifndef SFMT_PARAMS_H +#define SFMT_PARAMS_H + +#if !defined(MEXP) +#ifdef __GNUC__ + #warning "MEXP is not defined. I assume MEXP is 19937." +#endif + #define MEXP 19937 +#endif +/*----------------- + BASIC DEFINITIONS + -----------------*/ +/** Mersenne Exponent. The period of the sequence + * is a multiple of 2^MEXP-1. + * #define MEXP 19937 */ +/** SFMT generator has an internal state array of 128-bit integers, + * and N is its size. */ +#define N (MEXP / 128 + 1) +/** N32 is the size of internal state array when regarded as an array + * of 32-bit integers.*/ +#define N32 (N * 4) +/** N64 is the size of internal state array when regarded as an array + * of 64-bit integers.*/ +#define N64 (N * 2) + +/*---------------------- + the parameters of SFMT + following definitions are in paramsXXXX.h file. + ----------------------*/ +/** the pick up position of the array. +#define POS1 122 +*/ + +/** the parameter of shift left as four 32-bit registers. +#define SL1 18 + */ + +/** the parameter of shift left as one 128-bit register. + * The 128-bit integer is shifted by (SL2 * 8) bits. +#define SL2 1 +*/ + +/** the parameter of shift right as four 32-bit registers. +#define SR1 11 +*/ + +/** the parameter of shift right as one 128-bit register. + * The 128-bit integer is shifted by (SL2 * 8) bits. +#define SR2 1 +*/ + +/** A bitmask, used in the recursion. These parameters are introduced + * to break symmetry of SIMD. +#define MSK1 0xdfffffefU +#define MSK2 0xddfecb7fU +#define MSK3 0xbffaffffU +#define MSK4 0xbffffff6U +*/ + +/** These definitions are part of a 128-bit period certification vector. +#define PARITY1 0x00000001U +#define PARITY2 0x00000000U +#define PARITY3 0x00000000U +#define PARITY4 0xc98e126aU +*/ + +#if MEXP == 607 + #include "SFMT-params607.h" +#elif MEXP == 1279 + #include "SFMT-params1279.h" +#elif MEXP == 2281 + #include "SFMT-params2281.h" +#elif MEXP == 4253 + #include "SFMT-params4253.h" +#elif MEXP == 11213 + #include "SFMT-params11213.h" +#elif MEXP == 19937 + #include "SFMT-params19937.h" +#elif MEXP == 44497 + #include "SFMT-params44497.h" +#elif MEXP == 86243 + #include "SFMT-params86243.h" +#elif MEXP == 132049 + #include "SFMT-params132049.h" +#elif MEXP == 216091 + #include "SFMT-params216091.h" +#else +#ifdef __GNUC__ + #error "MEXP is not valid." + #undef MEXP +#else + #undef MEXP +#endif + +#endif + +#endif /* SFMT_PARAMS_H */
--- /dev/null Thu Jan 01 00:00:00 1970 +0000 +++ b/src/libSAD/SFMT-params19937.h Wed Jan 30 01:22:37 2008 +0300 @@ -0,0 +1,46 @@ +#ifndef SFMT_PARAMS19937_H +#define SFMT_PARAMS19937_H + +#define POS1 122 +#define SL1 18 +#define SL2 1 +#define SR1 11 +#define SR2 1 +#define MSK1 0xdfffffefU +#define MSK2 0xddfecb7fU +#define MSK3 0xbffaffffU +#define MSK4 0xbffffff6U +#define PARITY1 0x00000001U +#define PARITY2 0x00000000U +#define PARITY3 0x00000000U +#define PARITY4 0x13c9e684U + + +/* PARAMETERS FOR ALTIVEC */ +#if defined(__APPLE__) /* For OSX */ + #define ALTI_SL1 (vector unsigned int)(SL1, SL1, SL1, SL1) + #define ALTI_SR1 (vector unsigned int)(SR1, SR1, SR1, SR1) + #define ALTI_MSK (vector unsigned int)(MSK1, MSK2, MSK3, MSK4) + #define ALTI_MSK64 \ + (vector unsigned int)(MSK2, MSK1, MSK4, MSK3) + #define ALTI_SL2_PERM \ + (vector unsigned char)(1,2,3,23,5,6,7,0,9,10,11,4,13,14,15,8) + #define ALTI_SL2_PERM64 \ + (vector unsigned char)(1,2,3,4,5,6,7,31,9,10,11,12,13,14,15,0) + #define ALTI_SR2_PERM \ + (vector unsigned char)(7,0,1,2,11,4,5,6,15,8,9,10,17,12,13,14) + #define ALTI_SR2_PERM64 \ + (vector unsigned char)(15,0,1,2,3,4,5,6,17,8,9,10,11,12,13,14) +#else /* For OTHER OSs(Linux?) */ + #define ALTI_SL1 {SL1, SL1, SL1, SL1} + #define ALTI_SR1 {SR1, SR1, SR1, SR1} + #define ALTI_MSK {MSK1, MSK2, MSK3, MSK4} + #define ALTI_MSK64 {MSK2, MSK1, MSK4, MSK3} + #define ALTI_SL2_PERM {1,2,3,23,5,6,7,0,9,10,11,4,13,14,15,8} + #define ALTI_SL2_PERM64 {1,2,3,4,5,6,7,31,9,10,11,12,13,14,15,0} + #define ALTI_SR2_PERM {7,0,1,2,11,4,5,6,15,8,9,10,17,12,13,14} + #define ALTI_SR2_PERM64 {15,0,1,2,3,4,5,6,17,8,9,10,11,12,13,14} +#endif /* For OSX */ +#define IDSTR "SFMT-19937:122-18-1-11-1:dfffffef-ddfecb7f-bffaffff-bffffff6" + +#endif /* SFMT_PARAMS19937_H */
--- /dev/null Thu Jan 01 00:00:00 1970 +0000 +++ b/src/libSAD/SFMT-sse2.h Wed Jan 30 01:22:37 2008 +0300 @@ -0,0 +1,121 @@ +/** + * @file SFMT-sse2.h + * @brief SIMD oriented Fast Mersenne Twister(SFMT) for Intel SSE2 + * + * @author Mutsuo Saito (Hiroshima University) + * @author Makoto Matsumoto (Hiroshima University) + * + * @note We assume LITTLE ENDIAN in this file + * + * Copyright (C) 2006, 2007 Mutsuo Saito, Makoto Matsumoto and Hiroshima + * University. All rights reserved. + * + * The new BSD License is applied to this software, see LICENSE.txt + */ + +#ifndef SFMT_SSE2_H +#define SFMT_SSE2_H + +inline static __m128i mm_recursion(__m128i *a, __m128i *b, __m128i c, + __m128i d, __m128i mask) ALWAYSINLINE; + +/** + * This function represents the recursion formula. + * @param a a 128-bit part of the interal state array + * @param b a 128-bit part of the interal state array + * @param c a 128-bit part of the interal state array + * @param d a 128-bit part of the interal state array + * @param mask 128-bit mask + * @return output + */ +inline static __m128i mm_recursion(__m128i *a, __m128i *b, + __m128i c, __m128i d, __m128i mask) { + __m128i v, x, y, z; + + x = _mm_load_si128(a); + y = _mm_srli_epi32(*b, SR1); + z = _mm_srli_si128(c, SR2); + v = _mm_slli_epi32(d, SL1); + z = _mm_xor_si128(z, x); + z = _mm_xor_si128(z, v); + x = _mm_slli_si128(x, SL2); + y = _mm_and_si128(y, mask); + z = _mm_xor_si128(z, x); + z = _mm_xor_si128(z, y); + return z; +} + +/** + * This function fills the internal state array with pseudorandom + * integers. + */ +inline static void gen_rand_all(void) { + int i; + __m128i r, r1, r2, mask; + mask = _mm_set_epi32(MSK4, MSK3, MSK2, MSK1); + + r1 = _mm_load_si128(&sfmt[N - 2].si); + r2 = _mm_load_si128(&sfmt[N - 1].si); + for (i = 0; i < N - POS1; i++) { + r = mm_recursion(&sfmt[i].si, &sfmt[i + POS1].si, r1, r2, mask); + _mm_store_si128(&sfmt[i].si, r); + r1 = r2; + r2 = r; + } + for (; i < N; i++) { + r = mm_recursion(&sfmt[i].si, &sfmt[i + POS1 - N].si, r1, r2, mask); + _mm_store_si128(&sfmt[i].si, r); + r1 = r2; + r2 = r; + } +} + +/** + * This function fills the user-specified array with pseudorandom + * integers. + * + * @param array an 128-bit array to be filled by pseudorandom numbers. + * @param size number of 128-bit pesudorandom numbers to be generated. + */ +inline static void gen_rand_array(w128_t *array, int size) { + int i, j; + __m128i r, r1, r2, mask; + mask = _mm_set_epi32(MSK4, MSK3, MSK2, MSK1); + + r1 = _mm_load_si128(&sfmt[N - 2].si); + r2 = _mm_load_si128(&sfmt[N - 1].si); + for (i = 0; i < N - POS1; i++) { + r = mm_recursion(&sfmt[i].si, &sfmt[i + POS1].si, r1, r2, mask); + _mm_store_si128(&array[i].si, r); + r1 = r2; + r2 = r; + } + for (; i < N; i++) { + r = mm_recursion(&sfmt[i].si, &array[i + POS1 - N].si, r1, r2, mask); + _mm_store_si128(&array[i].si, r); + r1 = r2; + r2 = r; + } + /* main loop */ + for (; i < size - N; i++) { + r = mm_recursion(&array[i - N].si, &array[i + POS1 - N].si, r1, r2, + mask); + _mm_store_si128(&array[i].si, r); + r1 = r2; + r2 = r; + } + for (j = 0; j < 2 * N - size; j++) { + r = _mm_load_si128(&array[j + size - N].si); + _mm_store_si128(&sfmt[j].si, r); + } + for (; i < size; i++) { + r = mm_recursion(&array[i - N].si, &array[i + POS1 - N].si, r1, r2, + mask); + _mm_store_si128(&array[i].si, r); + _mm_store_si128(&sfmt[j++].si, r); + r1 = r2; + r2 = r; + } +} + +#endif
--- /dev/null Thu Jan 01 00:00:00 1970 +0000 +++ b/src/libSAD/SFMT.c Wed Jan 30 01:22:37 2008 +0300 @@ -0,0 +1,618 @@ +/** + * @file SFMT.c + * @brief SIMD oriented Fast Mersenne Twister(SFMT) + * + * @author Mutsuo Saito (Hiroshima University) + * @author Makoto Matsumoto (Hiroshima University) + * + * Copyright (C) 2006,2007 Mutsuo Saito, Makoto Matsumoto and Hiroshima + * University. All rights reserved. + * + * The new BSD License is applied to this software, see LICENSE.txt + */ +#include <string.h> +#include <assert.h> +#include "SFMT.h" +#include "SFMT-params.h" + +#if defined(__BIG_ENDIAN__) && !defined(__amd64) && !defined(BIG_ENDIAN64) +#define BIG_ENDIAN64 1 +#endif +#if defined(HAVE_ALTIVEC) && !defined(BIG_ENDIAN64) +#define BIG_ENDIAN64 1 +#endif +#if defined(ONLY64) && !defined(BIG_ENDIAN64) + #if defined(__GNUC__) + #error "-DONLY64 must be specified with -DBIG_ENDIAN64" + #endif +#undef ONLY64 +#endif +/*------------------------------------------------------ + 128-bit SIMD data type for Altivec, SSE2 or standard C + ------------------------------------------------------*/ +#if defined(HAVE_ALTIVEC) + #if !defined(__APPLE__) + #include <altivec.h> + #endif +/** 128-bit data structure */ +union W128_T { + vector unsigned int s; + uint32_t u[4]; +}; +/** 128-bit data type */ +typedef union W128_T w128_t; + +#elif defined(HAVE_SSE2) + #include <emmintrin.h> + +/** 128-bit data structure */ +union W128_T { + __m128i si; + uint32_t u[4]; +}; +/** 128-bit data type */ +typedef union W128_T w128_t; + +#else + +/** 128-bit data structure */ +struct W128_T { + uint32_t u[4]; +}; +/** 128-bit data type */ +typedef struct W128_T w128_t; + +#endif + +/*-------------------------------------- + FILE GLOBAL VARIABLES + internal state, index counter and flag + --------------------------------------*/ +/** the 128-bit internal state array */ +static w128_t sfmt[N]; +/** the 32bit integer pointer to the 128-bit internal state array */ +static uint32_t *psfmt32 = &sfmt[0].u[0]; +#if !defined(BIG_ENDIAN64) || defined(ONLY64) +/** the 64bit integer pointer to the 128-bit internal state array */ +static uint64_t *psfmt64 = (uint64_t *)&sfmt[0].u[0]; +#endif +/** index counter to the 32-bit internal state array */ +static int idx; +/** a flag: it is 0 if and only if the internal state is not yet + * initialized. */ +static int initialized = 0; +/** a parity check vector which certificate the period of 2^{MEXP} */ +static uint32_t parity[4] = {PARITY1, PARITY2, PARITY3, PARITY4}; + +/*---------------- + STATIC FUNCTIONS + ----------------*/ +inline static int idxof(int i); +inline static void rshift128(w128_t *out, w128_t const *in, int shift); +inline static void lshift128(w128_t *out, w128_t const *in, int shift); +inline static void gen_rand_all(void); +inline static void gen_rand_array(w128_t *array, int size); +inline static uint32_t func1(uint32_t x); +inline static uint32_t func2(uint32_t x); +static void period_certification(void); +#if defined(BIG_ENDIAN64) && !defined(ONLY64) +inline static void swap(w128_t *array, int size); +#endif + +#if defined(HAVE_ALTIVEC) + #include "SFMT-alti.h" +#elif defined(HAVE_SSE2) + #include "SFMT-sse2.h" +#endif + +/** + * This function simulate a 64-bit index of LITTLE ENDIAN + * in BIG ENDIAN machine. + */ +#ifdef ONLY64 +inline static int idxof(int i) { + return i ^ 1; +} +#else +inline static int idxof(int i) { + return i; +} +#endif +/** + * This function simulates SIMD 128-bit right shift by the standard C. + * The 128-bit integer given in in is shifted by (shift * 8) bits. + * This function simulates the LITTLE ENDIAN SIMD. + * @param out the output of this function + * @param in the 128-bit data to be shifted + * @param shift the shift value + */ +#ifdef ONLY64 +inline static void rshift128(w128_t *out, w128_t const *in, int shift) { + uint64_t th, tl, oh, ol; + + th = ((uint64_t)in->u[2] << 32) | ((uint64_t)in->u[3]); + tl = ((uint64_t)in->u[0] << 32) | ((uint64_t)in->u[1]); + + oh = th >> (shift * 8); + ol = tl >> (shift * 8); + ol |= th << (64 - shift * 8); + out->u[0] = (uint32_t)(ol >> 32); + out->u[1] = (uint32_t)ol; + out->u[2] = (uint32_t)(oh >> 32); + out->u[3] = (uint32_t)oh; +} +#else +inline static void rshift128(w128_t *out, w128_t const *in, int shift) { + uint64_t th, tl, oh, ol; + + th = ((uint64_t)in->u[3] << 32) | ((uint64_t)in->u[2]); + tl = ((uint64_t)in->u[1] << 32) | ((uint64_t)in->u[0]); + + oh = th >> (shift * 8); + ol = tl >> (shift * 8); + ol |= th << (64 - shift * 8); + out->u[1] = (uint32_t)(ol >> 32); + out->u[0] = (uint32_t)ol; + out->u[3] = (uint32_t)(oh >> 32); + out->u[2] = (uint32_t)oh; +} +#endif +/** + * This function simulates SIMD 128-bit left shift by the standard C. + * The 128-bit integer given in in is shifted by (shift * 8) bits. + * This function simulates the LITTLE ENDIAN SIMD. + * @param out the output of this function + * @param in the 128-bit data to be shifted + * @param shift the shift value + */ +#ifdef ONLY64 +inline static void lshift128(w128_t *out, w128_t const *in, int shift) { + uint64_t th, tl, oh, ol; + + th = ((uint64_t)in->u[2] << 32) | ((uint64_t)in->u[3]); + tl = ((uint64_t)in->u[0] << 32) | ((uint64_t)in->u[1]); + + oh = th << (shift * 8); + ol = tl << (shift * 8); + oh |= tl >> (64 - shift * 8); + out->u[0] = (uint32_t)(ol >> 32); + out->u[1] = (uint32_t)ol; + out->u[2] = (uint32_t)(oh >> 32); + out->u[3] = (uint32_t)oh; +} +#else +inline static void lshift128(w128_t *out, w128_t const *in, int shift) { + uint64_t th, tl, oh, ol; + + th = ((uint64_t)in->u[3] << 32) | ((uint64_t)in->u[2]); + tl = ((uint64_t)in->u[1] << 32) | ((uint64_t)in->u[0]); + + oh = th << (shift * 8); + ol = tl << (shift * 8); + oh |= tl >> (64 - shift * 8); + out->u[1] = (uint32_t)(ol >> 32); + out->u[0] = (uint32_t)ol; + out->u[3] = (uint32_t)(oh >> 32); + out->u[2] = (uint32_t)oh; +} +#endif + +/** + * This function represents the recursion formula. + * @param r output + * @param a a 128-bit part of the internal state array + * @param b a 128-bit part of the internal state array + * @param c a 128-bit part of the internal state array + * @param d a 128-bit part of the internal state array + */ +#ifdef ONLY64 +inline static void do_recursion(w128_t *r, w128_t *a, w128_t *b, w128_t *c, + w128_t *d) { + w128_t x; + w128_t y; + + lshift128(&x, a, SL2); + rshift128(&y, c, SR2); + r->u[0] = a->u[0] ^ x.u[0] ^ ((b->u[0] >> SR1) & MSK2) ^ y.u[0] + ^ (d->u[0] << SL1); + r->u[1] = a->u[1] ^ x.u[1] ^ ((b->u[1] >> SR1) & MSK1) ^ y.u[1] + ^ (d->u[1] << SL1); + r->u[2] = a->u[2] ^ x.u[2] ^ ((b->u[2] >> SR1) & MSK4) ^ y.u[2] + ^ (d->u[2] << SL1); + r->u[3] = a->u[3] ^ x.u[3] ^ ((b->u[3] >> SR1) & MSK3) ^ y.u[3] + ^ (d->u[3] << SL1); +} +#else +inline static void do_recursion(w128_t *r, w128_t *a, w128_t *b, w128_t *c, + w128_t *d) { + w128_t x; + w128_t y; + + lshift128(&x, a, SL2); + rshift128(&y, c, SR2); + r->u[0] = a->u[0] ^ x.u[0] ^ ((b->u[0] >> SR1) & MSK1) ^ y.u[0] + ^ (d->u[0] << SL1); + r->u[1] = a->u[1] ^ x.u[1] ^ ((b->u[1] >> SR1) & MSK2) ^ y.u[1] + ^ (d->u[1] << SL1); + r->u[2] = a->u[2] ^ x.u[2] ^ ((b->u[2] >> SR1) & MSK3) ^ y.u[2] + ^ (d->u[2] << SL1); + r->u[3] = a->u[3] ^ x.u[3] ^ ((b->u[3] >> SR1) & MSK4) ^ y.u[3] + ^ (d->u[3] << SL1); +} +#endif + +#if (!defined(HAVE_ALTIVEC)) && (!defined(HAVE_SSE2)) +/** + * This function fills the internal state array with pseudorandom + * integers. + */ +inline static void gen_rand_all(void) { + int i; + w128_t *r1, *r2; + + r1 = &sfmt[N - 2]; + r2 = &sfmt[N - 1]; + for (i = 0; i < N - POS1; i++) { + do_recursion(&sfmt[i], &sfmt[i], &sfmt[i + POS1], r1, r2); + r1 = r2; + r2 = &sfmt[i]; + } + for (; i < N; i++) { + do_recursion(&sfmt[i], &sfmt[i], &sfmt[i + POS1 - N], r1, r2); + r1 = r2; + r2 = &sfmt[i]; + } +} + +/** + * This function fills the user-specified array with pseudorandom + * integers. + * + * @param array an 128-bit array to be filled by pseudorandom numbers. + * @param size number of 128-bit pseudorandom numbers to be generated. + */ +inline static void gen_rand_array(w128_t *array, int size) { + int i, j; + w128_t *r1, *r2; + + r1 = &sfmt[N - 2]; + r2 = &sfmt[N - 1]; + for (i = 0; i < N - POS1; i++) { + do_recursion(&array[i], &sfmt[i], &sfmt[i + POS1], r1, r2); + r1 = r2; + r2 = &array[i]; + } + for (; i < N; i++) { + do_recursion(&array[i], &sfmt[i], &array[i + POS1 - N], r1, r2); + r1 = r2; + r2 = &array[i]; + } + for (; i < size - N; i++) { + do_recursion(&array[i], &array[i - N], &array[i + POS1 - N], r1, r2); + r1 = r2; + r2 = &array[i]; + } + for (j = 0; j < 2 * N - size; j++) { + sfmt[j] = array[j + size - N]; + } + for (; i < size; i++, j++) { + do_recursion(&array[i], &array[i - N], &array[i + POS1 - N], r1, r2); + r1 = r2; + r2 = &array[i]; + sfmt[j] = array[i]; + } +} +#endif + +#if defined(BIG_ENDIAN64) && !defined(ONLY64) && !defined(HAVE_ALTIVEC) +inline static void swap(w128_t *array, int size) { + int i; + uint32_t x, y; + + for (i = 0; i < size; i++) { + x = array[i].u[0]; + y = array[i].u[2]; + array[i].u[0] = array[i].u[1]; + array[i].u[2] = array[i].u[3]; + array[i].u[1] = x; + array[i].u[3] = y; + } +} +#endif +/** + * This function represents a function used in the initialization + * by init_by_array + * @param x 32-bit integer + * @return 32-bit integer + */ +static uint32_t func1(uint32_t x) { + return (x ^ (x >> 27)) * (uint32_t)1664525UL; +} + +/** + * This function represents a function used in the initialization + * by init_by_array + * @param x 32-bit integer + * @return 32-bit integer + */ +static uint32_t func2(uint32_t x) { + return (x ^ (x >> 27)) * (uint32_t)1566083941UL; +} + +/** + * This function certificate the period of 2^{MEXP} + */ +static void period_certification(void) { + int inner = 0; + int i, j; + uint32_t work; + + for (i = 0; i < 4; i++) + inner ^= psfmt32[idxof(i)] & parity[i]; + for (i = 16; i > 0; i >>= 1) + inner ^= inner >> i; + inner &= 1; + /* check OK */ + if (inner == 1) { + return; + } + /* check NG, and modification */ + for (i = 0; i < 4; i++) { + work = 1; + for (j = 0; j < 32; j++) { + if ((work & parity[i]) != 0) { + psfmt32[idxof(i)] ^= work; + return; + } + work = work << 1; + } + } +} + +/*---------------- + PUBLIC FUNCTIONS + ----------------*/ +/** + * This function returns the identification string. + * The string shows the word size, the Mersenne exponent, + * and all parameters of this generator. + */ +const char *get_idstring(void) { + return IDSTR; +} + +/** + * This function returns the minimum size of array used for \b + * fill_array32() function. + * @return minimum size of array used for fill_array32() function. + */ +int get_min_array_size32(void) { + return N32; +} + +/** + * This function returns the minimum size of array used for \b + * fill_array64() function. + * @return minimum size of array used for fill_array64() function. + */ +int get_min_array_size64(void) { + return N64; +} + +#ifndef ONLY64 +/** + * This function generates and returns 32-bit pseudorandom number. + * init_gen_rand or init_by_array must be called before this function. + * @return 32-bit pseudorandom number + */ +uint32_t gen_rand32(void) { + uint32_t r; + + assert(initialized); + if (idx >= N32) { + gen_rand_all(); + idx = 0; + } + r = psfmt32[idx++]; + return r; +} +#endif +/** + * This function generates and returns 64-bit pseudorandom number. + * init_gen_rand or init_by_array must be called before this function. + * The function gen_rand64 should not be called after gen_rand32, + * unless an initialization is again executed. + * @return 64-bit pseudorandom number + */ +uint64_t gen_rand64(void) { +#if defined(BIG_ENDIAN64) && !defined(ONLY64) + uint32_t r1, r2; +#else + uint64_t r; +#endif + + assert(initialized); + assert(idx % 2 == 0); + + if (idx >= N32) { + gen_rand_all(); + idx = 0; + } +#if defined(BIG_ENDIAN64) && !defined(ONLY64) + r1 = psfmt32[idx]; + r2 = psfmt32[idx + 1]; + idx += 2; + return ((uint64_t)r2 << 32) | r1; +#else + r = psfmt64[idx / 2]; + idx += 2; + return r; +#endif +} + +#ifndef ONLY64 +/** + * This function generates pseudorandom 32-bit integers in the + * specified array[] by one call. The number of pseudorandom integers + * is specified by the argument size, which must be at least 624 and a + * multiple of four. The generation by this function is much faster + * than the following gen_rand function. + * + * For initialization, init_gen_rand or init_by_array must be called + * before the first call of this function. This function can not be + * used after calling gen_rand function, without initialization. + * + * @param array an array where pseudorandom 32-bit integers are filled + * by this function. The pointer to the array must be \b "aligned" + * (namely, must be a multiple of 16) in the SIMD version, since it + * refers to the address of a 128-bit integer. In the standard C + * version, the pointer is arbitrary. + * + * @param size the number of 32-bit pseudorandom integers to be + * generated. size must be a multiple of 4, and greater than or equal + * to (MEXP / 128 + 1) * 4. + * + * @note \b memalign or \b posix_memalign is available to get aligned + * memory. Mac OSX doesn't have these functions, but \b malloc of OSX + * returns the pointer to the aligned memory block. + */ +void fill_array32(uint32_t *array, int size) { + assert(initialized); + assert(idx == N32); + assert(size % 4 == 0); + assert(size >= N32); + + gen_rand_array((w128_t *)array, size / 4); + idx = N32; +} +#endif + +/** + * This function generates pseudorandom 64-bit integers in the + * specified array[] by one call. The number of pseudorandom integers + * is specified by the argument size, which must be at least 312 and a + * multiple of two. The generation by this function is much faster + * than the following gen_rand function. + * + * For initialization, init_gen_rand or init_by_array must be called + * before the first call of this function. This function can not be + * used after calling gen_rand function, without initialization. + * + * @param array an array where pseudorandom 64-bit integers are filled + * by this function. The pointer to the array must be "aligned" + * (namely, must be a multiple of 16) in the SIMD version, since it + * refers to the address of a 128-bit integer. In the standard C + * version, the pointer is arbitrary. + * + * @param size the number of 64-bit pseudorandom integers to be + * generated. size must be a multiple of 2, and greater than or equal + * to (MEXP / 128 + 1) * 2 + * + * @note \b memalign or \b posix_memalign is available to get aligned + * memory. Mac OSX doesn't have these functions, but \b malloc of OSX + * returns the pointer to the aligned memory block. + */ +void fill_array64(uint64_t *array, int size) { + assert(initialized); + assert(idx == N32); + assert(size % 2 == 0); + assert(size >= N64); + + gen_rand_array((w128_t *)array, size / 2); + idx = N32; + +#if defined(BIG_ENDIAN64) && !defined(ONLY64) + swap((w128_t *)array, size /2); +#endif +} + +/** + * This function initializes the internal state array with a 32-bit + * integer seed. + * + * @param seed a 32-bit integer used as the seed. + */ +void init_gen_rand(uint32_t seed) { + int i; + + psfmt32[idxof(0)] = seed; + for (i = 1; i < N32; i++) { + psfmt32[idxof(i)] = 1812433253UL * (psfmt32[idxof(i - 1)] + ^ (psfmt32[idxof(i - 1)] >> 30)) + + i; + } + idx = N32; + period_certification(); + initialized = 1; +} + +/** + * This function initializes the internal state array, + * with an array of 32-bit integers used as the seeds + * @param init_key the array of 32-bit integers, used as a seed. + * @param key_length the length of init_key. + */ +void init_by_array(uint32_t *init_key, int key_length) { + int i, j, count; + uint32_t r; + int lag; + int mid; + int size = N * 4; + + if (size >= 623) { + lag = 11; + } else if (size >= 68) { + lag = 7; + } else if (size >= 39) { + lag = 5; + } else { + lag = 3; + } + mid = (size - lag) / 2; + + memset(sfmt, 0x8b, sizeof(sfmt)); + if (key_length + 1 > N32) { + count = key_length + 1; + } else { + count = N32; + } + r = func1(psfmt32[idxof(0)] ^ psfmt32[idxof(mid)] + ^ psfmt32[idxof(N32 - 1)]); + psfmt32[idxof(mid)] += r; + r += key_length; + psfmt32[idxof(mid + lag)] += r; + psfmt32[idxof(0)] = r; + + count--; + for (i = 1, j = 0; (j < count) && (j < key_length); j++) { + r = func1(psfmt32[idxof(i)] ^ psfmt32[idxof((i + mid) % N32)] + ^ psfmt32[idxof((i + N32 - 1) % N32)]); + psfmt32[idxof((i + mid) % N32)] += r; + r += init_key[j] + i; + psfmt32[idxof((i + mid + lag) % N32)] += r; + psfmt32[idxof(i)] = r; + i = (i + 1) % N32; + } + for (; j < count; j++) { + r = func1(psfmt32[idxof(i)] ^ psfmt32[idxof((i + mid) % N32)] + ^ psfmt32[idxof((i + N32 - 1) % N32)]); + psfmt32[idxof((i + mid) % N32)] += r; + r += i; + psfmt32[idxof((i + mid + lag) % N32)] += r; + psfmt32[idxof(i)] = r; + i = (i + 1) % N32; + } + for (j = 0; j < N32; j++) { + r = func2(psfmt32[idxof(i)] + psfmt32[idxof((i + mid) % N32)] + + psfmt32[idxof((i + N32 - 1) % N32)]); + psfmt32[idxof((i + mid) % N32)] ^= r; + r -= i; + psfmt32[idxof((i + mid + lag) % N32)] ^= r; + psfmt32[idxof(i)] = r; + i = (i + 1) % N32; + } + + idx = N32; + period_certification(); + initialized = 1; +}
--- /dev/null Thu Jan 01 00:00:00 1970 +0000 +++ b/src/libSAD/SFMT.h Wed Jan 30 01:22:37 2008 +0300 @@ -0,0 +1,125 @@ +/** + * @file SFMT.h + * + * @brief SIMD oriented Fast Mersenne Twister(SFMT) pseudorandom + * number generator + * + * @author Mutsuo Saito (Hiroshima University) + * @author Makoto Matsumoto (Hiroshima University) + * + * Copyright (C) 2006, 2007 Mutsuo Saito, Makoto Matsumoto and Hiroshima + * University. All rights reserved. + * + * The new BSD License is applied to this software. + * see LICENSE.txt + * + * @note We assume that your system has inttypes.h. If your system + * doesn't have inttypes.h, you have to typedef uint32_t and uint64_t, + * and you have to define PRIu64 and PRIx64 in this file as follows: + * @verbatim + typedef unsigned int uint32_t + typedef unsigned long long uint64_t + #define PRIu64 "llu" + #define PRIx64 "llx" +@endverbatim + * uint32_t must be exactly 32-bit unsigned integer type (no more, no + * less), and uint64_t must be exactly 64-bit unsigned integer type. + * PRIu64 and PRIx64 are used for printf function to print 64-bit + * unsigned int and 64-bit unsigned int in hexadecimal format. + */ + +#ifndef SFMT_H +#define SFMT_H + +#include <stdio.h> + +#if defined(__STDC_VERSION__) && (__STDC_VERSION__ >= 199901L) + #include <inttypes.h> +#elif defined(_MSC_VER) || defined(__BORLANDC__) + typedef unsigned int uint32_t; + typedef unsigned __int64 uint64_t; + #define inline __inline +#else + #include <inttypes.h> + #if defined(__GNUC__) + #define inline __inline__ + #endif +#endif + +#ifndef PRIu64 + #if defined(_MSC_VER) || defined(__BORLANDC__) + #define PRIu64 "I64u" + #define PRIx64 "I64x" + #else + #define PRIu64 "llu" + #define PRIx64 "llx" + #endif +#endif + +#if defined(__GNUC__) +#define ALWAYSINLINE __attribute__((always_inline)) +#endif + +uint32_t gen_rand32(void); +uint64_t gen_rand64(void); +void fill_array32(uint32_t *array, int size); +void fill_array64(uint64_t *array, int size); +void init_gen_rand(uint32_t seed); +void init_by_array(uint32_t *init_key, int key_length); +const char *get_idstring(void); +int get_min_array_size32(void); +int get_min_array_size64(void); + +/* These real versions are due to Isaku Wada */ +/** generates a random number on [0,1]-real-interval */ +inline static double to_real1(uint32_t v) +{ + return v * (1.0/4294967295.0); + /* divided by 2^32-1 */ +} + +/** generates a random number on [0,1]-real-interval */ +inline static double genrand_real1(void) +{ + return to_real1(gen_rand32()); +} + +/** generates a random number on [0,1)-real-interval */ +inline static double to_real2(uint32_t v) +{ + return v * (1.0/4294967296.0); + /* divided by 2^32 */ +} + +/** generates a random number on [0,1)-real-interval */ +inline static double genrand_real2(void) +{ + return to_real2(gen_rand32()); +} + +/** generates a random number on (0,1)-real-interval */ +inline static double to_real3(uint32_t v) +{ + return (((double)v) + 0.5)*(1.0/4294967296.0); + /* divided by 2^32 */ +} + +/** generates a random number on (0,1)-real-interval */ +inline static double genrand_real3(void) +{ + return to_real3(gen_rand32()); +} +/** These real versions are due to Isaku Wada */ + +/** generates a random number on [0,1) with 53-bit resolution*/ +inline static double to_res53(uint64_t v) +{ + return v * (1.0/18446744073709551616.0L); +} + +/** generates a random number on [0,1) with 53-bit resolution*/ +inline static double genrand_res53(void) +{ + return to_res53(gen_rand64()); +} +#endif
--- /dev/null Thu Jan 01 00:00:00 1970 +0000 +++ b/src/libSAD/dither.c Wed Jan 30 01:22:37 2008 +0300 @@ -0,0 +1,492 @@ +/* Scale & Dither library (libSAD) + * High-precision bit depth converter with ReplayGain support + * + * (c)2007 by Eugene Zagidullin (e.asphyx@gmail.com) + * + * This program is free software; you can redistribute it and/or modify + * it under the terms of the GNU General Public License as published by + * the Free Software Foundation; either version 2 of the License, or + * (at your option) any later version. + * + * 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 General Public License for more details. + * You should have received a copy of the GNU General Public License + * along with this program; if not, write to the Free Software + * Foundation, Inc., 59 Temple Place, Suite 330, Boston, MA 02111-1307 USA + */ + + +#include "common.h" +#include "buffer.h" +#include "noisegen.h" + +#include <assert.h> +#include <math.h> + +/* + * Supported conversions: + * + * O U T P U T + * ,------------------+-----------------------------------------------. + * | |S8 U8 S16 U16 S24 U24 S32 U32 FLOAT FIXED-POINT| + * +------------------+-----------------------------------------------+ + * | S8 |X X X X X X X X - - | + * | U8 |X X X X X X X X - - | + * I | S16 |X X X X X X X X - - | + * N | U16 |X X X X X X X X - - | + * P | S24 |X X X X X X X X - - | + * U | U24 |X X X X X X X X - - | + * T | S32 |X X X X X X X X - - | + * | U32 |X X X X X X X X - - | + * | FLOAT |X X X X X X X X X - | + * | FIXED-POINT |X X X X X X X X X - | + * `------------------+-----------------------------------------------' + */ + +#define SCALE(x,s) (s != 1.0 ? x * s : x) +#define MAXINT(a) (1L << ((a)-1)) +#define CLIP(x,m) (x > m-1 ? m-1 : (x < -m ? -m : x)) + +/* private object */ +typedef struct { + SAD_sample_format input_sample_format; + SAD_sample_format output_sample_format; + int input_bits; + int input_fracbits; + int output_bits; + int output_fracbits; + int channels; + SAD_channels_order input_chorder; + SAD_channels_order output_chorder; + SAD_get_sample_proc get_sample; + SAD_put_sample_proc put_sample; + int dither; + int hardlimit; + float scale; + float rg_scale; +} SAD_state_priv; + +/* error code */ + +//static SAD_error SAD_last_error = SAD_ERROR_OK; + +static inline double compute_hardlimit (double sample, float scale) { + sample *= scale; + const double k = 0.5; /* -6dBFS */ + if (sample > k) { + return tanh((sample - k) / (1 - k)) * (1 - k) + k; + } + else if (sample < -k) { + return tanh((sample + k) / (1 - k)) * (1 - k) - k; + } + return sample; +} + +/* + * Dither fixed-point normalized or integer sample to n-bits integer + * samples < -1 and > 1 will be clipped + */ + +static inline sad_sint32 __dither_sample_fixed_to_int (sad_sint32 sample, int inbits, int fracbits, int outbits, float scale, int dither, + int hardlimit) +{ + int n_bits_to_loose, bitwidth, precision_loss; + sad_sint32 maxint = MAXINT(outbits); + + n_bits_to_loose = 0; + bitwidth = inbits; + precision_loss = FALSE; + +/*#ifdef DEEP_DEBUG + printf("f: __dither_sample_fixed_to_int\n"); +#endif*/ + + if (fracbits == 0) { + if (inbits<29) { + /* convert to 4.28 fixed-point */ + n_bits_to_loose = 29 - inbits; + sample <<= n_bits_to_loose; + bitwidth += n_bits_to_loose; + } + + n_bits_to_loose += inbits - outbits; + + if (inbits > outbits) { + precision_loss = TRUE; +#ifdef PRECISION_DEBUG + printf("Precision loss, reason: bitwidth loss %d --> %d\n", inbits, outbits); +#endif + } + } else { + n_bits_to_loose = fracbits + 1 - outbits; + bitwidth = fracbits; + precision_loss = TRUE; +#ifdef PRECISION_DEBUG + printf("Precision loss, reason: fixed-point input\n", inbits, outbits); +#endif + } + + assert(n_bits_to_loose >=0 ); + + if (hardlimit) { + sample = (sad_sint32)(compute_hardlimit((double)sample/(double)MAXINT(bitwidth), scale) * (double)MAXINT(bitwidth)); +#ifdef PRECISION_DEBUG + printf("Precision loss, reason: hard limiter\n", inbits, outbits); +#endif + precision_loss = TRUE; + } else { + sample = SCALE(sample, scale); + } + + if (scale != 1.0){ + precision_loss = TRUE; +#ifdef PRECISION_DEBUG + printf("Precision loss, reason: scale\n", inbits, outbits); +#endif + } + + if (precision_loss && (n_bits_to_loose >= 1)) sample += (1L << (n_bits_to_loose - 1)); + +#ifdef DITHER_DEBUG + sad_sint32 val_wo_dither = sample, >> n_bits_to_loose; + val_wo_dither = CLIP(val_wo_dither, maxint); +#endif + if (dither && precision_loss && (n_bits_to_loose >= 1)) { + sad_sint32 dither_num = triangular_dither_noise(n_bits_to_loose + 1); + sample += dither_num; + } + + sample >>= n_bits_to_loose; + + /* Clipping */ +#ifdef CLIPPING_DEBUG + sad_sint32 val_wo_clip = sample; +#endif + sample = CLIP(sample, maxint); +#ifdef CLIPPING_DEBUG + if (val_wo_clip != sample) { + printf("Clipping: %d --> %d\n", val_wo_clip, sample); + } +#endif +#ifdef DITHER_DEBUG + if (dither && precision_loss && (n_bits_to_loose >= 1)) printf("%d --> %d, noise: %d\n", val_wo_dither, sample, sample - val_wo_dither); +#endif + return sample; +} + +/* + * Dither floating-point normalized sample to n-bits integer + * samples < -1 and > 1 will be clipped + */ +static inline sad_sint32 __dither_sample_float_to_int (float sample, int nbits, float scale, int dither, int hardlimit) { + +#ifdef DEEP_DEBUG + printf("f: __dither_sample_float_to_int\n"); +#endif + + sad_sint32 maxint = MAXINT(nbits); + + if (hardlimit) { + sample = compute_hardlimit((double)sample, scale); + } else { + sample = SCALE(sample, scale); + } + + sample *= maxint; + /* we want to round precisely */ + sample = (sample < 0 ? sample - 0.5 : sample + 0.5); + +#ifdef DITHER_DEBUG + sad_sint32 val_wo_dither = (sad_sint32) sample; + val_wo_dither = CLIP(val_wo_dither, maxint); +#endif + if (dither) { + float dither_num = triangular_dither_noise_f(); + sample += dither_num; + } + + /* Round and clipping */ + sad_sint32 value = (sad_sint32) sample; +#ifdef CLIPPING_DEBUG + sad_sint32 val_wo_clip = value; +#endif + value = CLIP(value, maxint); +#ifdef CLIPPING_DEBUG + if (val_wo_clip != value) { + printf("Clipping: %d --> %d\n", val_wo_clip, value); + } +#endif + +#ifdef DITHER_DEBUG + printf("%d --> %d, noise: %d\n", val_wo_dither, value, value - val_wo_dither); +#endif + return value; +} + +static inline float __dither_sample_float_to_float (float sample, float scale, int hardlimit) { +#ifdef DEEP_DEBUG + printf("f: __dither_sample_float_to_float\n"); +#endif + if (hardlimit) { + sample = compute_hardlimit((double)sample, scale); + } else { + sample = SCALE(sample, scale); + } + return sample; +} + +static inline float __dither_sample_fixed_to_float (sad_sint32 sample, int inbits, int fracbits, float scale, int hardlimit) { + float fsample; + +#ifdef DEEP_DEBUG + printf("f: __dither_sample_fixed_to_float\n"); +#endif + if (fracbits == 0) { + fsample = (float)sample / (float)MAXINT(inbits); + } else { + fsample = (float)sample / (float)MAXINT(fracbits+1); + } + return __dither_sample_float_to_float (fsample, scale, hardlimit); +} + + + + + +SAD_dither_t* SAD_dither_init(SAD_buffer_format *inbuf_format, SAD_buffer_format *outbuf_format, int *error) { + SAD_state_priv *priv; + + DEBUG_MSG("f: SAD_dither_init\n",0); + + priv = calloc(sizeof(SAD_state_priv), 1); + + /* Check buffer formats and assign buffer ops */ + SAD_buffer_ops* inops = SAD_assign_buf_ops(inbuf_format); + + if (inbuf_format->sample_format != SAD_SAMPLE_FLOAT) { + if (inops != NULL) { + priv->get_sample = inops->get_sample; + } else { + free(priv); + *error = SAD_ERROR_INCORRECT_INPUT_SAMPLEFORMAT; + return NULL; + } + } + + SAD_buffer_ops* outops = SAD_assign_buf_ops(outbuf_format); + + if (outbuf_format->sample_format != SAD_SAMPLE_FLOAT) { + if (outops != NULL) { + priv->put_sample = outops->put_sample; + } else { + free(priv); + *error = SAD_ERROR_INCORRECT_OUTPUT_SAMPLEFORMAT; + return NULL; + } + } + + priv->input_fracbits = 0; + priv->output_fracbits = 0; + priv->input_sample_format = inbuf_format->sample_format; + priv->output_sample_format = outbuf_format->sample_format; + priv->input_chorder = inbuf_format->channels_order; + priv->output_chorder = outbuf_format->channels_order; + priv->channels = inbuf_format->channels; + priv->scale = 1.0; + priv->rg_scale = 1.0; + priv->dither = TRUE; + priv->hardlimit = FALSE; + + switch(outbuf_format->sample_format){ + case SAD_SAMPLE_S8: + case SAD_SAMPLE_U8: priv->output_bits = 8; break; + case SAD_SAMPLE_S16: + case SAD_SAMPLE_U16: priv->output_bits = 16; break; + case SAD_SAMPLE_S24: + case SAD_SAMPLE_U24: priv->output_bits = 24; break; + case SAD_SAMPLE_S32: + case SAD_SAMPLE_U32: priv->output_bits = 32; break; + case SAD_SAMPLE_FLOAT: break; + default: + free(priv); + *error = SAD_ERROR_INCORRECT_OUTPUT_SAMPLEFORMAT; + return NULL; + } + + switch(inbuf_format->sample_format){ + case SAD_SAMPLE_S8: + case SAD_SAMPLE_U8: priv->input_bits = 8; break; + case SAD_SAMPLE_S16: + case SAD_SAMPLE_U16: priv->input_bits = 16; break; + case SAD_SAMPLE_S24: + case SAD_SAMPLE_U24: priv->input_bits = 24; break; + case SAD_SAMPLE_S32: + case SAD_SAMPLE_U32: priv->input_bits = 32; break; + case SAD_SAMPLE_FIXED32: priv->input_fracbits = inbuf_format->fracbits; break; + case SAD_SAMPLE_FLOAT: break; + default: + free(priv); + *error = SAD_ERROR_INCORRECT_INPUT_SAMPLEFORMAT; + return NULL; + } + + *error = SAD_ERROR_OK; + return (SAD_dither_t*)priv; +} + +int SAD_dither_free(SAD_dither_t* state) { + DEBUG_MSG("f: SAD_dither_free\n",0); + free(state); + return SAD_ERROR_OK; +} + +/* + * Depend on format->channels_order inbuf and outbuf will be treated as + * smth* or smth** if channels_order = SAD_CHORDER_INTERLEAVED or SAD_CHORDER_SEPARATED + * accordingly + * + * frame is aggregate of format->channels samples + */ + +#define GET_FLOAT_SAMPLE(b,o,n,c,i) (o == SAD_CHORDER_INTERLEAVED ? (((float*)b)[i*n+c]) : (((float**)b)[c][i])) +#define PUT_FLOAT_SAMPLE(b,o,n,c,i,s) { \ + if (o == SAD_CHORDER_INTERLEAVED) { \ + ((float*)b)[i*n+c] = s; \ + } else { \ + ((float**)b)[c][i] = s; \ + } \ + } + +int SAD_dither_process_buffer (SAD_dither_t *state, void *inbuf, void *outbuf, int frames) +{ + SAD_state_priv *priv = (SAD_state_priv*) state; + int i, ch; + int channels = priv->channels; + int inbits = priv->input_bits; + int outbits = priv->output_bits; + int fracbits = priv->input_fracbits; + float scale = priv->scale * priv->rg_scale; + int dither = priv->dither; + int hardlimit = priv->hardlimit; + SAD_channels_order input_chorder = priv->input_chorder; + SAD_channels_order output_chorder = priv->output_chorder; + + SAD_get_sample_proc get_sample = priv->get_sample; + SAD_put_sample_proc put_sample = priv->put_sample; + +#ifdef DEEP_DEBUG + printf("f: SAD_process_buffer\n"); +#endif + + if (priv->input_sample_format == SAD_SAMPLE_FLOAT) { + if (priv->output_sample_format == SAD_SAMPLE_FLOAT) { + /* process buffer */ + for(i=0; i<frames; i++) { + for(ch=0; ch<channels; ch++) { + float sample = GET_FLOAT_SAMPLE(inbuf, input_chorder, channels, ch ,i); + sample = __dither_sample_float_to_float(sample, scale, hardlimit); + PUT_FLOAT_SAMPLE(outbuf, output_chorder, channels, ch ,i, sample); + } + } + } else { + if (put_sample == NULL) return SAD_ERROR_CORRUPTED_PRIVATE_DATA; + /* process buffer */ + for(i=0; i<frames; i++) { + for(ch=0; ch<channels; ch++) { + float sample = GET_FLOAT_SAMPLE(inbuf, input_chorder, channels, ch ,i); + sad_sint32 isample = __dither_sample_float_to_int(sample, outbits, scale, dither, hardlimit); + put_sample (outbuf, isample, channels, ch, i); + } + } + } + } else { + if (priv->output_sample_format == SAD_SAMPLE_FLOAT) { + if (get_sample == NULL) return SAD_ERROR_CORRUPTED_PRIVATE_DATA; + /* process buffer */ + for(i=0; i<frames; i++) { + for(ch=0; ch<channels; ch++) { + sad_sint32 sample = get_sample (inbuf, channels, ch, i); + float fsample = __dither_sample_fixed_to_float (sample, inbits, fracbits, scale, hardlimit); + PUT_FLOAT_SAMPLE(outbuf, output_chorder, channels, ch ,i, fsample); + } + } + } else { + if (put_sample == NULL || get_sample == NULL) return SAD_ERROR_CORRUPTED_PRIVATE_DATA; + /* process buffer */ + for(i=0; i<frames; i++) { + for(ch=0; ch<channels; ch++){ + sad_sint32 sample = get_sample (inbuf, channels, ch, i); + sad_sint32 isample = __dither_sample_fixed_to_int (sample, inbits, fracbits, outbits, scale, dither, hardlimit); + put_sample (outbuf, isample, channels, ch, i); + } + } + } + } + + return SAD_ERROR_OK; +} + +int SAD_dither_apply_replaygain (SAD_dither_t *state, SAD_replaygain_info *rg_info, SAD_replaygain_mode *mode) { + SAD_state_priv *priv = (SAD_state_priv*) state; + float scale = -1.0, peak = 0.0; + + DEBUG_MSG("f: SAD_dither_apply_replaygain\n",0); + + if(!rg_info->present) { + priv->rg_scale = 1.0; + priv->hardlimit = FALSE; + return SAD_ERROR_OK; + } + + switch(mode->mode) { + case SAD_RG_ALBUM: + scale = db2scale(rg_info->album_gain); + peak = rg_info->album_peak; + if (peak == 0.0) { + scale = db2scale(rg_info->track_gain); // fallback to per-track mode + peak = rg_info->track_peak; + DEBUG_MSG("f: SAD_dither_apply_replaygain: fallback to track mode\n",0); + } + break; + case SAD_RG_TRACK: + scale = db2scale(rg_info->track_gain); + peak = rg_info->track_peak; + break; + case SAD_RG_NONE: + scale = -1.0; + } + + if (scale != -1.0 && peak != 0.0) { + DEBUG_MSG("f: SAD_dither_apply_replaygain: applying\n",0); + scale *= mode->preamp; + // Clipping prevention + if(mode->clipping_prevention) { +#ifdef DEBUG + if(scale * peak > 1.0) DEBUG_MSG("f: SAD_dither_apply_replaygain: clipping prevented\n",0); +#endif + scale = scale * peak > 1.0 ? 1.0 / peak : scale; + } + scale = scale > 15.0 ? 15.0 : scale; // safety + priv->rg_scale = scale; + priv->hardlimit = mode->hard_limit; // apply settings + } else { + priv->rg_scale = 1.0; + priv->hardlimit = FALSE; + } + + return SAD_ERROR_OK; +} + +int SAD_dither_set_scale (SAD_dither_t *state, float scale) { + SAD_state_priv *priv = (SAD_state_priv*) state; + priv->scale = scale; + return SAD_ERROR_OK; +} + +int SAD_dither_set_dither (SAD_dither_t *state, int dither) { + SAD_state_priv *priv = (SAD_state_priv*) state; + priv->dither = dither; + return SAD_ERROR_OK; +}
--- /dev/null Thu Jan 01 00:00:00 1970 +0000 +++ b/src/libSAD/dither.h Wed Jan 30 01:22:37 2008 +0300 @@ -0,0 +1,28 @@ +#ifndef DITHER_H +#define DITHER_H + +#include "common.h" + +#define SAD_ERROR_INCORRECT_INPUT_SAMPLEFORMAT -2 +#define SAD_ERROR_INCORRECT_OUTPUT_SAMPLEFORMAT -3 +#define SAD_ERROR_CORRUPTED_PRIVATE_DATA -4 + +typedef sad_sint32 (*SAD_get_sample_proc) (void *buf, int nch, int ch, int i); +typedef void (*SAD_put_sample_proc) (void *buf, sad_sint32 sample, int nch, int ch, int i); + +typedef struct { + SAD_get_sample_proc get_sample; + SAD_put_sample_proc put_sample; +} SAD_buffer_ops; + +/* private data */ +typedef struct {} SAD_dither_t; + +SAD_dither_t* SAD_dither_init(SAD_buffer_format *inbuf_format, SAD_buffer_format *outbuf_format, int *error); +int SAD_dither_free(SAD_dither_t* state); +int SAD_dither_process_buffer (SAD_dither_t *state, void *inbuf, void *outbuf, int frames); +int SAD_dither_apply_replaygain (SAD_dither_t *state, SAD_replaygain_info *rg_info, SAD_replaygain_mode *mode); +int SAD_dither_set_scale (SAD_dither_t *state, float scale); +int SAD_dither_set_dither (SAD_dither_t *state, int dither); + +#endif
--- /dev/null Thu Jan 01 00:00:00 1970 +0000 +++ b/src/libSAD/dither_ops.c Wed Jan 30 01:22:37 2008 +0300 @@ -0,0 +1,301 @@ +/* Scale & Dither library (libSAD) + * High-precision bit depth converter with ReplayGain support + * + * (c)2007 by Eugene Zagidullin (e.asphyx@gmail.com) + * + * This program is free software; you can redistribute it and/or modify + * it under the terms of the GNU General Public License as published by + * the Free Software Foundation; either version 2 of the License, or + * (at your option) any later version. + * + * 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 General Public License for more details. + * You should have received a copy of the GNU General Public License + * along with this program; if not, write to the Free Software + * Foundation, Inc., 59 Temple Place, Suite 330, Boston, MA 02111-1307 USA + */ + +#include "common.h" +#include "buffer.h" +#include "dither.h" + +/* buffer ops: */ +/********** + * 8-bit * + **********/ + +/* signed */ +static sad_sint32 get_s8_i_sample (void *buf, int nch, int ch, int i) { + return ((sad_sint8*)buf)[i*nch+ch]; +} + +static sad_sint32 get_s8_s_sample (void *buf, int nch, int ch, int i) { + return ((sad_sint8**)buf)[ch][i]; +} + +static void put_s8_i_sample (void *buf, sad_sint32 sample, int nch, int ch, int i) { + ((sad_sint8*)buf)[i*nch+ch] = (sad_sint8)sample; +} + +static void put_s8_s_sample (void *buf, sad_sint32 sample, int nch, int ch, int i) { + ((sad_sint8**)buf)[ch][i] = (sad_sint8)sample; +} + +/* unsigned */ +static sad_sint32 get_u8_i_sample (void *buf, int nch, int ch, int i) { + return (sad_sint32)(((sad_uint8*)buf)[i*nch+ch]) - 128; +} + +static sad_sint32 get_u8_s_sample (void *buf, int nch, int ch, int i) { + return (sad_sint32)(((sad_uint8**)buf)[ch][i]) - 128; +} + +static void put_u8_i_sample (void *buf, sad_sint32 sample, int nch, int ch, int i) { + ((sad_uint8*)buf)[i*nch+ch] = (sad_uint8)sample + 128; +} + +static void put_u8_s_sample (void *buf, sad_sint32 sample, int nch, int ch, int i) { + ((sad_uint8**)buf)[ch][i] = (sad_uint8)sample + 128; +} + +static SAD_buffer_ops buf_s8_i_ops = { + &get_s8_i_sample, + &put_s8_i_sample +}; + +static SAD_buffer_ops buf_s8_s_ops = { + &get_s8_s_sample, + &put_s8_s_sample +}; + +static SAD_buffer_ops buf_u8_i_ops = { + &get_u8_i_sample, + &put_u8_i_sample +}; + +static SAD_buffer_ops buf_u8_s_ops = { + &get_u8_s_sample, + &put_u8_s_sample +}; + +/********** + * 16-bit * + **********/ + +/* signed */ +static sad_sint32 get_s16_i_sample (void *buf, int nch, int ch, int i) { + return (sad_sint32)(((sad_sint16*)buf)[i*nch+ch]); +} + +static sad_sint32 get_s16_s_sample (void *buf, int nch, int ch, int i) { + return (sad_sint32)(((sad_sint16**)buf)[ch][i]); +} + +static void put_s16_i_sample (void *buf, sad_sint32 sample, int nch, int ch, int i) { +/*#ifdef DEEP_DEBUG + printf("f: put_s16_i_sample\n"); +#endif*/ + ((sad_sint16*)buf)[i*nch+ch] = (sad_sint16)sample; +} + +static void put_s16_s_sample (void *buf, sad_sint32 sample, int nch, int ch, int i) { +/*#ifdef DEEP_DEBUG + printf("f: put_s16_s_sample\n"); +#endif*/ + ((sad_sint16**)buf)[ch][i] = (sad_sint16)sample; +} + +/* unsigned */ +static sad_sint32 get_u16_i_sample (void *buf, int nch, int ch, int i) { + return ((sad_sint32)(((sad_uint16*)buf)[i*nch+ch])) - 32768; +} + +static sad_sint32 get_u16_s_sample (void *buf, int nch, int ch, int i) { + return ((sad_sint32)(((sad_uint16**)buf)[ch][i])) - 32768; +} + +static void put_u16_i_sample (void *buf, sad_sint32 sample, int nch, int ch, int i) { + ((sad_uint16*)buf)[i*nch+ch] = (sad_uint16)(sample + 32768); +} + +static void put_u16_s_sample (void *buf, sad_sint32 sample, int nch, int ch, int i) { + ((sad_uint16**)buf)[ch][i] = (sad_uint16)(sample + 32768); +} + +static SAD_buffer_ops buf_s16_i_ops = { + &get_s16_i_sample, + &put_s16_i_sample +}; + +static SAD_buffer_ops buf_s16_s_ops = { + &get_s16_s_sample, + &put_s16_s_sample +}; + +static SAD_buffer_ops buf_u16_i_ops = { + &get_u16_i_sample, + &put_u16_i_sample +}; + +static SAD_buffer_ops buf_u16_s_ops = { + &get_u16_s_sample, + &put_u16_s_sample +}; + +/********** + * 24-bit * + **********/ + +/*expand 24-bit signed value to 32-bit*/ +#define EXPAND_24_TO_32(x) (((sad_sint32)(((x) & 0x00ffffff) << 8)) >> 8) + +/* signed */ +static sad_sint32 get_s24_i_sample (void *buf, int nch, int ch, int i) { + return (sad_sint32)EXPAND_24_TO_32(((sad_sint32*)buf)[i*nch+ch]); +} + +static sad_sint32 get_s24_s_sample (void *buf, int nch, int ch, int i) { + return (sad_sint32)EXPAND_24_TO_32(((sad_sint32**)buf)[ch][i]); +} + +static void put_s24_i_sample (void *buf, sad_sint32 sample, int nch, int ch, int i) { + ((sad_sint32*)buf)[i*nch+ch] = (sad_sint32)sample & 0x00ffffff; +} + +static void put_s24_s_sample (void *buf, sad_sint32 sample, int nch, int ch, int i) { + ((sad_sint32**)buf)[ch][i] = (sad_sint32)sample & 0x00ffffff; +} + +/* unsigned */ +static sad_sint32 get_u24_i_sample (void *buf, int nch, int ch, int i) { + return (sad_sint32)EXPAND_24_TO_32(((sad_uint32*)buf)[i*nch+ch]) - 8388608; +} + +static sad_sint32 get_u24_s_sample (void *buf, int nch, int ch, int i) { + return (sad_sint32)EXPAND_24_TO_32(((sad_uint32**)buf)[ch][i]) - 8388608; +} + +static void put_u24_i_sample (void *buf, sad_sint32 sample, int nch, int ch, int i) { + ((sad_uint32*)buf)[i*nch+ch] = ((sad_uint32)sample + 8388608) & 0x00ffffff; +} + +static void put_u24_s_sample (void *buf, sad_sint32 sample, int nch, int ch, int i) { + ((sad_uint32**)buf)[ch][i] = ((sad_uint32)sample + 8388608) & 0x00ffffff; +} + +static SAD_buffer_ops buf_s24_i_ops = { + &get_s24_i_sample, + &put_s24_i_sample +}; + +static SAD_buffer_ops buf_s24_s_ops = { + &get_s24_s_sample, + &put_s24_s_sample +}; + +static SAD_buffer_ops buf_u24_i_ops = { + &get_u24_i_sample, + &put_u24_i_sample +}; + +static SAD_buffer_ops buf_u24_s_ops = { + &get_u24_s_sample, + &put_u24_s_sample +}; + +/********** + * 32-bit * + **********/ + +/* signed */ +static sad_sint32 get_s32_i_sample (void *buf, int nch, int ch, int i) { + return ((sad_sint32*)buf)[i*nch+ch]; +} + +static sad_sint32 get_s32_s_sample (void *buf, int nch, int ch, int i) { + return ((sad_sint32**)buf)[ch][i]; +} + +static void put_s32_i_sample (void *buf, sad_sint32 sample, int nch, int ch, int i) { + ((sad_sint32*)buf)[i*nch+ch] = (sad_sint32)sample; +} + +static void put_s32_s_sample (void *buf, sad_sint32 sample, int nch, int ch, int i) { + ((sad_sint32**)buf)[ch][i] = (sad_sint32)sample; +} + +/* unsigned */ +static sad_sint32 get_u32_i_sample (void *buf, int nch, int ch, int i) { + return ((sad_sint32*)buf)[i*nch+ch] - (sad_sint32)(1L<<31); +} + +static sad_sint32 get_u32_s_sample (void *buf, int nch, int ch, int i) { + return ((sad_sint32**)buf)[ch][i] - (sad_sint32)(1L<<31); +} + +static void put_u32_i_sample (void *buf, sad_sint32 sample, int nch, int ch, int i) { + ((sad_uint32*)buf)[i*nch+ch] = (sad_uint32)(sample + (sad_sint32)(1L<<31)); +} + +static void put_u32_s_sample (void *buf, sad_sint32 sample, int nch, int ch, int i) { + ((sad_uint32**)buf)[ch][i] = (sad_uint32)(sample + (sad_sint32)(1L<<31)); +} + +static SAD_buffer_ops buf_s32_i_ops = { + &get_s32_i_sample, + &put_s32_i_sample +}; + +static SAD_buffer_ops buf_s32_s_ops = { + &get_s32_s_sample, + &put_s32_s_sample +}; + +static SAD_buffer_ops buf_u32_i_ops = { + &get_u32_i_sample, + &put_u32_i_sample +}; + +static SAD_buffer_ops buf_u32_s_ops = { + &get_u32_s_sample, + &put_u32_s_sample +}; + +static SAD_buffer_ops *SAD_buffer_optable[SAD_SAMPLE_MAX][SAD_CHORDER_MAX] = { + {&buf_s8_i_ops, &buf_s8_s_ops}, /* SAD_SAMPLE_S8 */ + {&buf_u8_i_ops, &buf_u8_s_ops}, /* SAD_SAMPLE_U8 */ + {&buf_s16_i_ops, &buf_s16_s_ops}, /* SAD_SAMPLE_S16 */ + {NULL, NULL}, /* SAD_SAMPLE_S16_LE */ + {NULL, NULL}, /* SAD_SAMPLE_S16_BE */ + {&buf_u16_i_ops, &buf_u16_s_ops}, /* SAD_SAMPLE_U16 */ + {NULL, NULL}, /* SAD_SAMPLE_U16_LE */ + {NULL, NULL}, /* SAD_SAMPLE_U16_BE */ + {&buf_s24_i_ops, &buf_s24_s_ops}, /* SAD_SAMPLE_S24 */ + {NULL, NULL}, /* SAD_SAMPLE_S24_LE */ + {NULL, NULL}, /* SAD_SAMPLE_S24_BE */ + {&buf_u24_i_ops, &buf_u24_s_ops}, /* SAD_SAMPLE_U24 */ + {NULL, NULL}, /* SAD_SAMPLE_U24_LE */ + {NULL, NULL}, /* SAD_SAMPLE_U24_BE */ + {&buf_s32_i_ops, &buf_s32_s_ops}, /* SAD_SAMPLE_S32 */ + {NULL, NULL}, /* SAD_SAMPLE_S32_LE */ + {NULL, NULL}, /* SAD_SAMPLE_S32_BE */ + {&buf_u32_i_ops, &buf_u32_s_ops}, /* SAD_SAMPLE_U32 */ + {NULL, NULL}, /* SAD_SAMPLE_U32_LE */ + {NULL, NULL}, /* SAD_SAMPLE_U32_BE */ + {&buf_s32_i_ops, &buf_s32_s_ops}, /* SAD_SAMPLE_FIXED32*/ + {NULL, NULL} /* SAD_SAMPLE_FLOAT */ +}; + +SAD_buffer_ops* SAD_assign_buf_ops (SAD_buffer_format *format) { +#ifdef DEBUG + printf("f: SAD_assign_buf_ops\n"); +#endif + if (format->sample_format < SAD_SAMPLE_MAX && format->channels_order < SAD_CHORDER_MAX) { + return SAD_buffer_optable[format->sample_format][format->channels_order]; + } else { + return NULL; + } +} +
--- /dev/null Thu Jan 01 00:00:00 1970 +0000 +++ b/src/libSAD/dither_ops.h Wed Jan 30 01:22:37 2008 +0300 @@ -0,0 +1,28 @@ +/* Scale & Dither library (libSAD) + * High-precision bit depth converter with ReplayGain support + * + * (c)2007 by Eugene Zagidullin (e.asphyx@gmail.com) + * + * This program is free software; you can redistribute it and/or modify + * it under the terms of the GNU General Public License as published by + * the Free Software Foundation; either version 2 of the License, or + * (at your option) any later version. + * + * 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 General Public License for more details. + * You should have received a copy of the GNU General Public License + * along with this program; if not, write to the Free Software + * Foundation, Inc., 59 Temple Place, Suite 330, Boston, MA 02111-1307 USA + */ + +#ifndef BUFFER_H +#define BUFFER_H + +#include "common.h" +#include "dither.h" + +SAD_buffer_ops* SAD_assign_buf_ops (SAD_buffer_format *format); + +#endif /*BUFFER_H*/
--- /dev/null Thu Jan 01 00:00:00 1970 +0000 +++ b/src/libSAD/libSAD.h Wed Jan 30 01:22:37 2008 +0300 @@ -0,0 +1,180 @@ +/* Scale & Dither library (libSAD) + * High-precision bit depth converter with ReplayGain support + * + * (c)2007 by Eugene Zagidullin (e.asphyx@gmail.com) + * + * This program is free software; you can redistribute it and/or modify + * it under the terms of the GNU General Public License as published by + * the Free Software Foundation; either version 2 of the License, or + * (at your option) any later version. + * + * 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 General Public License for more details. + * You should have received a copy of the GNU General Public License + * along with this program; if not, write to the Free Software + * Foundation, Inc., 59 Temple Place, Suite 330, Boston, MA 02111-1307 USA + */ + +#ifndef COMMON_H +#define COMMON_H + +#include <stdio.h> +#include <stdlib.h> +#include <sys/types.h> +#include <math.h> + +#ifndef TRUE +#define TRUE 1 +#endif + +#ifndef FALSE +#define FALSE 0 +#endif + +#include "../config.h" + +#ifdef ENABLE_NLS +# include <libintl.h> +# include <locale.h> +# define _(String) dgettext(PACKAGE,String) +#else +# define _(String) (String) +#endif + +typedef u_int8_t sad_uint8; +typedef int8_t sad_sint8; + +#if SIZEOF_SHORT == 2 + typedef unsigned short sad_uint16; + typedef short sad_sint16; +#else +# error "Unsupported sizeof(short)" +#endif + +#if SIZEOF_INT == 4 + typedef unsigned int sad_uint32; + typedef int sad_sint32; +#else +# error "Unsupported sizeof(int)" +#endif + +typedef size_t sad_size_t; + +typedef int SAD_error; + +typedef enum { + SAD_SAMPLE_S8, + SAD_SAMPLE_U8, + SAD_SAMPLE_S16, + SAD_SAMPLE_S16_LE, + SAD_SAMPLE_S16_BE, + SAD_SAMPLE_U16, + SAD_SAMPLE_U16_LE, + SAD_SAMPLE_U16_BE, + SAD_SAMPLE_S24, + SAD_SAMPLE_S24_LE, + SAD_SAMPLE_S24_BE, + SAD_SAMPLE_U24, + SAD_SAMPLE_U24_LE, + SAD_SAMPLE_U24_BE, + SAD_SAMPLE_S32, + SAD_SAMPLE_S32_LE, + SAD_SAMPLE_S32_BE, + SAD_SAMPLE_U32, + SAD_SAMPLE_U32_LE, + SAD_SAMPLE_U32_BE, + SAD_SAMPLE_FIXED32, + SAD_SAMPLE_FLOAT, + SAD_SAMPLE_MAX /*EOF*/ +} SAD_sample_format; + +/* sample format -> sample size */ +static inline sad_size_t sf2ss(SAD_sample_format fmt) { + switch(fmt) { + case SAD_SAMPLE_S8: + case SAD_SAMPLE_U8: return sizeof(sad_sint8); + case SAD_SAMPLE_S16: + case SAD_SAMPLE_S16_LE: + case SAD_SAMPLE_S16_BE: + case SAD_SAMPLE_U16: + case SAD_SAMPLE_U16_LE: + case SAD_SAMPLE_U16_BE: return sizeof(sad_sint16); + case SAD_SAMPLE_S24: + case SAD_SAMPLE_S24_LE: + case SAD_SAMPLE_S24_BE: + case SAD_SAMPLE_U24: + case SAD_SAMPLE_U24_LE: + case SAD_SAMPLE_U24_BE: + case SAD_SAMPLE_S32: + case SAD_SAMPLE_S32_LE: + case SAD_SAMPLE_S32_BE: + case SAD_SAMPLE_U32: + case SAD_SAMPLE_U32_LE: + case SAD_SAMPLE_U32_BE: + case SAD_SAMPLE_FIXED32: return sizeof(sad_sint32); + case SAD_SAMPLE_FLOAT: return sizeof(float); + default: return 0; + } +} + +typedef enum { + SAD_CHORDER_INTERLEAVED, + SAD_CHORDER_SEPARATED, + SAD_CHORDER_MAX /*EOF*/ +} SAD_channels_order; + +typedef struct { + SAD_sample_format sample_format; + int fracbits; /* for fixed-point only */ + int channels; + SAD_channels_order channels_order; + int samplerate; +} SAD_buffer_format; + +static inline sad_size_t bytes2frames(SAD_buffer_format *fmt, sad_size_t bytes) { + return bytes / sf2ss(fmt->sample_format) / fmt->channels; +} + +static inline sad_size_t frames2bytes(SAD_buffer_format *fmt, sad_size_t frames) { + return frames * sf2ss(fmt->sample_format) * fmt->channels; +} + +static inline float db2scale(float db) { + return pow(10, db / 20); +} + +enum { + SAD_RG_NONE, + SAD_RG_TRACK, + SAD_RG_ALBUM +}; + +#define SAD_ERROR_OK 0 +#define SAD_ERROR_FAIL -1 + +#ifdef DEBUG +#define DEBUG_MSG(f,x) {printf("debug: "f, x);} +#else +#define DEBUG_MSG(f,x) {} +#endif + +typedef struct { + int present; + float track_gain; // in dB !!! + float track_peak; + float album_gain; + float album_peak; +} SAD_replaygain_info; + +typedef struct { + int mode; + int clipping_prevention; + int hard_limit; + float preamp; +} SAD_replaygain_mode; + + +#endif /* COMMON_H */ +
--- /dev/null Thu Jan 01 00:00:00 1970 +0000 +++ b/src/libSAD/noicegen.c Wed Jan 30 01:22:37 2008 +0300 @@ -0,0 +1,35 @@ +#include <stdio.h> +#include <assert.h> +#include "../../config.h" + +#define MEXP 19937 + +#ifdef HAVE_SSE2 +#define SSE2 1 +#endif +#ifdef HAVE_ALTIVEC +#define ALTIVEC 1 +#endif + +#include "SFMT.h" +#include "SFMT.c" + +#include "noicegen.h" + +int triangular_dither_noise(int nbits) +{ + // parameter nbits : the peak-to-peak amplitude desired (in bits) + // use with nbits set to 2 + nber of bits to be trimmed. + // (because triangular is made from two uniformly distributed processes, + // it starts at 2 bits peak-to-peak amplitude) + // see The Theory of Dithered Quantization by Robert Alexander Wannamaker + // for complete proof of why that's optimal + + int v = (gen_rand32() / 2 - gen_rand32() / 2); // in ]-2^31, 2^31[ + //int signe = (v>0) ? 1 : -1; + int P = 1 << (32 - nbits); // the power of 2 + v /= P; + // now v in ]-2^(nbits-1), 2^(nbits-1) [ + + return v; +}