Add SincResampler ported from WebKit.

media/base/sinc_resampler.cc

Index: media/base/sinc_resampler.cc
diff --git a/media/base/sinc_resampler.cc b/media/base/sinc_resampler.cc
new file mode 100644
index 0000000000000000000000000000000000000000..98938ff866aaef34da6024841ae75c1c806cbf39
--- /dev/null
+++ b/media/base/sinc_resampler.cc
@@ -0,0 +1,188 @@
+// Copyright (c) 2012 The Chromium Authors. All rights reserved.
+// Use of this source code is governed by a BSD-style license that can be
+// found in the LICENSE file.
+//
+// Input buffer layout, dividing the total buffer into regions (r0 - r5):
+//
+// |----------------|-----------------------------------------|----------------|
+//
+//                                   kBlockSize + kKernelSize / 2
+//                   <--------------------------------------------------------->
+//                                               r0
+//
+//  kKernelSize / 2   kKernelSize / 2         kKernelSize / 2   kKernelSize / 2
+// <---------------> <--------------->       <---------------> <--------------->
+//         r1                r2                      r3                r4
+//
+//                                                     kBlockSize
+//                                     <--------------------------------------->
+//                                                         r5
+//
+// The algorithm:
+//
+// 1) Consume input frames into r0 (r1 is zero-initialized).
+// 2) Position kernel centered at start of r0 (r2) and generate output frames
+//    until kernel is centered at start of r4 or we've finished generating all
+//    the output frames.
+// 3) Copy r3 to r1 and r4 to r2.
+// 4) Consume input frames into r5 (zero-pad if we run out of input).
+// 5) Goto (2) until all of input is consumed.
+//
+// Note: we're glossing over how the sub-sample handling works with
+// |virtual_source_idx_|, etc.

[Chris Rogers, 2012/07/09 21:51:42]

I'd add an extra blank line here

[DaleCurtis, 2012/07/10 01:00:25]

Done.

+// MSVC++ requires this to be set before any other includes to get M_PI.
+#define _USE_MATH_DEFINES
+
+#include "media/base/sinc_resampler.h"
+
+#include <cmath>
+
+#include "base/logging.h"
+
+namespace media {
+
+COMPILE_ASSERT(SincResampler::kKernelSize % 2 == 0, kKernelSize_must_be_even);
+COMPILE_ASSERT(SincResampler::kBlockSize > SincResampler::kKernelSize,
+               kBlockSize_must_be_gt_kKernelSize);
+
+SincResampler::SincResampler(const ReadCB& read_cb, double io_sample_rate_ratio)
+    : io_sample_rate_ratio_(io_sample_rate_ratio),
+      virtual_source_idx_(0),
+      buffer_primed_(false),
+      read_cb_(read_cb),
+      // TODO(dalecurtis): When we switch to AVX/SSE optimization, we'll need to
+      // allocate with 32-byte alignment and ensure they're sized % 32 bytes.
+      kernel_storage_(new float[kKernelStorageSize]),
+      input_buffer_(new float[kBufferSize]) {
+  memset(kernel_storage_.get(), 0,
+         sizeof(*kernel_storage_.get()) * kKernelStorageSize);
+  memset(input_buffer_.get(), 0, sizeof(*input_buffer_.get()) * kBufferSize);
+
+  InitializeKernel();
+}
+
+SincResampler::~SincResampler() {}
+
+void SincResampler::InitializeKernel() {

[Ami GONE FROM CHROMIUM, 2012/07/03 20:54:42]

Any reason this needs to be a function separate from the ctor?

[DaleCurtis, 2012/07/10 01:00:25]

Just clarity.  It's a bit large to stuff into the constructor.

+  // Blackman window parameters.
+  double alpha = 0.16;
+  double a0 = 0.5 * (1.0 - alpha);
+  double a1 = 0.5;
+  double a2 = 0.5 * alpha;
+
+  // |sinc_scale_factor| is basically the normalized cutoff frequency of the
+  // low-pass filter.
+  double sinc_scale_factor =
+      io_sample_rate_ratio_ > 1.0 ? 1.0 / io_sample_rate_ratio_ : 1.0;
+
+  // The sinc function is an idealized brick-wall filter, but since we're
+  // windowing it the transition from pass to stop does not happen right away.
+  // So we should adjust the lowpass filter cutoff slightly downward to avoid
+  // some aliasing at the very high-end.
+  // TODO(crogers): this value is empirical and to be more exact should vary
+  // depending on kKernelSize.
+  sinc_scale_factor *= 0.9;
+
+  // Generates a set of windowed sinc() kernels.
+  // We generate a range of sub-sample offsets from 0.0 to 1.0.
+  for (int offset_idx = 0; offset_idx <= kKernelOffsetCount; ++offset_idx) {

[Ami GONE FROM CHROMIUM, 2012/07/03 20:54:42]

FWIW this could be a double as well and avoid the cast two lines down.

[DaleCurtis, 2012/07/10 01:00:25]

Then it needs a static_cast<int> when indexing into kernel_storage_[]

+    double subsample_offset =
+        static_cast<double>(offset_idx) / kKernelOffsetCount;
+
+    for (int i = 0; i < kKernelSize; ++i) {
+      // Compute the sinc with offset.
+      double s =
+          sinc_scale_factor * M_PI * (i - kKernelSize / 2 - subsample_offset);
+      double sinc = (!s ? 1.0 : sin(s) / s) * sinc_scale_factor;
+
+      // Compute Blackman window, matching the offset of the sinc().
+      double x = (i - subsample_offset) / kKernelSize;
+      double window = a0 - a1 * cos(2.0 * M_PI * x) + a2 * cos(4.0 * M_PI * x);
+
+      // Window the sinc() function and store at the correct offset.
+      kernel_storage_[i + offset_idx * kKernelSize] = sinc * window;
+    }
+  }
+}
+
+void SincResampler::Resample(float* destination, int frames) {
+  int remaining_frames = frames;
+
+  // Setup various region pointers in the buffer (see diagram above).
+  float* r0 = input_buffer_.get() + kKernelSize / 2;
+  float* r1 = input_buffer_.get();
+  float* r2 = r0;
+  float* r3 = r0 + kBlockSize - kKernelSize / 2;
+  float* r4 = r0 + kBlockSize;
+  float* r5 = r0 + kKernelSize / 2;
+
+  // Step (1) -- Prime the input buffer at the start of the input stream.
+  if (!buffer_primed_) {
+    read_cb_.Run(r0, kBlockSize + kKernelSize / 2);

[Ami GONE FROM CHROMIUM, 2012/07/03 20:54:42]

How does this not violate your expectations in the multi-channel resampler about
the read_cb_ only being called once per channel-sweep?

[DaleCurtis, 2012/07/10 01:00:25]

remaining_frames will be 0 before the next call occurs.

+    buffer_primed_ = true;
+  }
+
+  // Step (2) -- Resample!
+  while (remaining_frames) {
+    while (virtual_source_idx_ < kBlockSize) {
+      // |virtual_source_idx_| lies in between two kernel offsets so figure out
+      // what they are.
+      int source_idx = static_cast<int>(virtual_source_idx_);
+      double subsample_remainder = virtual_source_idx_ - source_idx;
+
+      double virtual_offset_idx = subsample_remainder * kKernelOffsetCount;
+      int offset_idx = static_cast<int>(virtual_offset_idx);
+
+      float* k1 = kernel_storage_.get() + offset_idx * kKernelSize;
+      float* k2 = k1 + kKernelSize;
+
+      // Initialize input pointer based on quantized |virtual_source_idx_|.
+      float* input_ptr = r1 + source_idx;
+
+      // We'll compute "convolutions" for the two kernels which straddle
+      // |virtual_source_idx_|.
+      float sum1 = 0;
+      float sum2 = 0;
+
+      // Figure out how much to weight each kernel's "convolution".
+      double kernel_interpolation_factor = virtual_offset_idx - offset_idx;
+
+      // Generate a single output sample.
+      int n = kKernelSize;
+      float input;
+      // TODO(dalecurtis): For initial commit, I've ripped out all the SSE
+      // optimizations, these definitely need to go back in before release.
+      while (n--) {
+        input = *input_ptr++;
+        sum1 += input * *k1++;
+        sum2 += input * *k2++;
+      }
+
+      // Linearly interpolate the two "convolutions".
+      double result = (1.0 - kernel_interpolation_factor) * sum1
+          + kernel_interpolation_factor * sum2;
+
+      *destination++ = result;
+
+      // Advance the virtual index.
+      virtual_source_idx_ += io_sample_rate_ratio_;
+
+      if (!--remaining_frames)
+        return;
+    }
+
+    // Wrap back around to the start.
+    virtual_source_idx_ -= kBlockSize;
+
+    // Step (3) Copy r3 to r1 and r4 to r2.
+    // This wraps the last input frames back to the start of the buffer.
+    memcpy(r1, r3, sizeof(*input_buffer_.get()) * (kKernelSize / 2));
+    memcpy(r2, r4, sizeof(*input_buffer_.get()) * (kKernelSize / 2));
+
+    // Step (4)
+    // Refresh the buffer with more input.
+    read_cb_.Run(r5, kBlockSize);
+  }
+}
+
+}  // namespace media