summaryrefslogtreecommitdiffstats
path: root/firmware/pcm_sw_volume.c
diff options
context:
space:
mode:
Diffstat (limited to 'firmware/pcm_sw_volume.c')
-rw-r--r--firmware/pcm_sw_volume.c121
1 files changed, 79 insertions, 42 deletions
diff --git a/firmware/pcm_sw_volume.c b/firmware/pcm_sw_volume.c
index 473e63c7cb..eb77fe0c6b 100644
--- a/firmware/pcm_sw_volume.c
+++ b/firmware/pcm_sw_volume.c
@@ -26,63 +26,91 @@
#include "fixedpoint.h"
#include "pcm_sw_volume.h"
-/* source buffer from client */
-static const void * volatile src_buf_addr = NULL;
-static size_t volatile src_buf_rem = 0;
+/* volume factors set by pcm_set_master_volume */
+static uint32_t vol_factor_l = 0, vol_factor_r = 0;
-#define PCM_PLAY_DBL_BUF_SIZE (PCM_PLAY_DBL_BUF_SAMPLE*PCM_SAMPLE_SIZE)
-
-/* double buffer and frame length control */
-static int16_t pcm_dbl_buf[2][PCM_PLAY_DBL_BUF_SAMPLES*2]
- PCM_DBL_BUF_BSS MEM_ALIGN_ATTR;
-static size_t pcm_dbl_buf_size[2];
-static int pcm_dbl_buf_num = 0;
-static size_t frame_size;
-static unsigned int frame_count, frame_err, frame_frac;
-
-static int32_t vol_factor_l = 0, vol_factor_r = 0;
#ifdef AUDIOHW_HAVE_PRESCALER
-static int32_t prescale_factor = PCM_FACTOR_UNITY;
+/* prescale factor set by pcm_set_prescaler */
+static uint32_t prescale_factor = PCM_FACTOR_UNITY;
#endif /* AUDIOHW_HAVE_PRESCALER */
-/* pcm scaling factors */
-static int32_t pcm_factor_l = 0, pcm_factor_r = 0;
-
-#define PCM_FACTOR_CLIP(f) \
- MAX(MIN((f), PCM_FACTOR_MAX), PCM_FACTOR_MIN)
-#define PCM_SCALE_SAMPLE(f, s) \
- (((f) * (s) + PCM_FACTOR_UNITY/2) >> PCM_FACTOR_BITS)
+/* final pcm scaling factors */
+static uint32_t pcm_factor_l = 0, pcm_factor_r = 0;
+/***
+ ** Volume scaling routine
+ ** If unbuffered, called externally by pcm driver
+ **/
/* TODO: #include CPU-optimized routines and move this to /firmware/asm */
-static inline void pcm_copy_buffer(int16_t *dst, const int16_t *src,
- size_t size)
+
+#if PCM_SW_VOLUME_FRACBITS <= 16
+#define PCM_F_T int32_t
+#else
+#define PCM_F_T int64_t /* Requires large integer math */
+#endif /* PCM_SW_VOLUME_FRACBITS */
+
+static inline int32_t pcm_scale_sample(PCM_F_T f, int32_t s)
{
- int32_t factor_l = pcm_factor_l;
- int32_t factor_r = pcm_factor_r;
+ return (f * s + (PCM_F_T)PCM_FACTOR_UNITY/2) >> PCM_SW_VOLUME_FRACBITS;
+}
- if (LIKELY(factor_l <= PCM_FACTOR_UNITY && factor_r <= PCM_FACTOR_UNITY))
+/* Copies buffer with volume scaling applied */
+#ifndef PCM_SW_VOLUME_UNBUFFERED
+static inline
+#endif
+void pcm_sw_volume_copy_buffer(void *dst, const void *src, size_t size)
+{
+ int16_t *d = dst;
+ const int16_t *s = src;
+ uint32_t factor_l = pcm_factor_l;
+ uint32_t factor_r = pcm_factor_r;
+
+ if (factor_l == PCM_FACTOR_UNITY && factor_r == PCM_FACTOR_UNITY)
+ {
+ /* Both unity */
+ memcpy(dst, src, size);
+ }
+ else if (LIKELY(factor_l <= PCM_FACTOR_UNITY &&
+ factor_r <= PCM_FACTOR_UNITY))
{
- /* All cut or unity */
+ /* Either cut, both <= UNITY */
while (size)
{
- *dst++ = PCM_SCALE_SAMPLE(factor_l, *src++);
- *dst++ = PCM_SCALE_SAMPLE(factor_r, *src++);
+ *d++ = pcm_scale_sample(factor_l, *s++);
+ *d++ = pcm_scale_sample(factor_r, *s++);
size -= PCM_SAMPLE_SIZE;
}
}
else
{
- /* Any positive gain requires clipping */
+ /* Either positive gain, requires clipping */
while (size)
{
- *dst++ = clip_sample_16(PCM_SCALE_SAMPLE(factor_l, *src++));
- *dst++ = clip_sample_16(PCM_SCALE_SAMPLE(factor_r, *src++));
+ *d++ = clip_sample_16(pcm_scale_sample(factor_l, *s++));
+ *d++ = clip_sample_16(pcm_scale_sample(factor_r, *s++));
size -= PCM_SAMPLE_SIZE;
}
}
}
+#ifndef PCM_SW_VOLUME_UNBUFFERED
+/* source buffer from client */
+static const void * volatile src_buf_addr = NULL;
+static size_t volatile src_buf_rem = 0;
+
+#define PCM_PLAY_DBL_BUF_SIZE (PCM_PLAY_DBL_BUF_SAMPLE*PCM_SAMPLE_SIZE)
+
+/* double buffer and frame length control */
+static int16_t pcm_dbl_buf[2][PCM_PLAY_DBL_BUF_SAMPLES*2]
+ PCM_DBL_BUF_BSS MEM_ALIGN_ATTR;
+static size_t pcm_dbl_buf_size[2];
+static int pcm_dbl_buf_num = 0;
+static size_t frame_size;
+static unsigned int frame_count, frame_err, frame_frac;
+
+/** Overrides of certain functions in pcm.c and pcm-internal.h **/
+
bool pcm_play_dma_complete_callback(enum pcm_dma_status status,
const void **addr, size_t *size)
{
@@ -155,7 +183,7 @@ pcm_play_dma_status_callback_int(enum pcm_dma_status status)
pcm_dbl_buf_num ^= 1;
pcm_dbl_buf_size[pcm_dbl_buf_num] = size;
- pcm_copy_buffer(pcm_dbl_buf[pcm_dbl_buf_num], addr, size);
+ pcm_sw_volume_copy_buffer(pcm_dbl_buf[pcm_dbl_buf_num], addr, size);
return PCM_DMAST_OK;
}
@@ -216,27 +244,36 @@ const void * pcm_play_dma_get_peak_buffer_int(int *count)
return NULL;
}
+#endif /* PCM_SW_VOLUME_UNBUFFERED */
+
+
+/** Internal **/
+
/* Return the scale factor corresponding to the centibel level */
-static int32_t pcm_centibels_to_factor(int volume)
+static uint32_t pcm_centibels_to_factor(int volume)
{
if (volume == PCM_MUTE_LEVEL)
return 0; /* mute */
/* Centibels -> fixedpoint */
- return fp_factor(fp_div(volume, 10, PCM_FACTOR_BITS), PCM_FACTOR_BITS);
+ return (uint32_t)fp_factor(fp_div(volume, 10, PCM_SW_VOLUME_FRACBITS),
+ PCM_SW_VOLUME_FRACBITS);
}
+
+/** Public functions **/
+
/* Produce final pcm scale factor */
static void pcm_sync_prescaler(void)
{
- int32_t factor_l = vol_factor_l;
- int32_t factor_r = vol_factor_r;
+ uint32_t factor_l = vol_factor_l;
+ uint32_t factor_r = vol_factor_r;
#ifdef AUDIOHW_HAVE_PRESCALER
- factor_l = fp_mul(prescale_factor, factor_l, PCM_FACTOR_BITS);
- factor_r = fp_mul(prescale_factor, factor_r, PCM_FACTOR_BITS);
+ factor_l = fp_mul(prescale_factor, factor_l, PCM_SW_VOLUME_FRACBITS);
+ factor_r = fp_mul(prescale_factor, factor_r, PCM_SW_VOLUME_FRACBITS);
#endif
- pcm_factor_l = PCM_FACTOR_CLIP(factor_l);
- pcm_factor_r = PCM_FACTOR_CLIP(factor_r);
+ pcm_factor_l = MIN(factor_l, PCM_FACTOR_MAX);
+ pcm_factor_r = MIN(factor_r, PCM_FACTOR_MAX);
}
#ifdef AUDIOHW_HAVE_PRESCALER
generated by cgit v1.2.2 (git 2.25.0) at 2021-02-26 03:41:01 +0000