libs/ardour/kmeterdsp.cc

   1 /*
   2     Copyright (C) 2008-2011 Fons Adriaensen <fons@linuxaudio.org>
   3     Adopted for Ardour 2013 by Robin Gareus <robin@gareus.org>
   4
   5     This program is free software; you can redistribute it and/or modify
   6     it under the terms of the GNU General Public License as published by
   7     the Free Software Foundation; either version 2 of the License, or
   8     (at your option) any later version.
   9
  10     This program is distributed in the hope that it will be useful,
  11     but WITHOUT ANY WARRANTY; without even the implied warranty of
  12     MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE.  See the
  13     GNU General Public License for more details.
  14
  15     You should have received a copy of the GNU General Public License
  16     along with this program; if not, write to the Free Software
  17     Foundation, Inc., 675 Mass Ave, Cambridge, MA 02139, USA.
  18 */
  19
  20 #include <math.h>
  21 #include "ardour/kmeterdsp.h"
  22
  23
  24 float  Kmeterdsp::_omega;
  25
  26
  27 Kmeterdsp::Kmeterdsp (void) :
  28     _z1 (0),
  29     _z2 (0),
  30     _rms (0),
  31     _flag (false)
  32 {
  33 }
  34
  35
  36 Kmeterdsp::~Kmeterdsp (void)
  37 {
  38 }
  39
  40 void Kmeterdsp::init (int fsamp)
  41 {
  42     _omega = 9.72f / fsamp; // ballistic filter coefficient
  43 }
  44
  45 void Kmeterdsp::process (float *p, int n)
  46 {
  47     // Called by JACK's process callback.
  48     //
  49     // p : pointer to sample buffer
  50     // n : number of samples to process
  51
  52     float  s, z1, z2;
  53
  54     // Get filter state.
  55     z1 = _z1;
  56     z2 = _z2;
  57
  58     // Perform filtering. The second filter is evaluated
  59     // only every 4th sample - this is just an optimisation.
  60     n /= 4;  // Loop is unrolled by 4.
  61     while (n--)
  62     {
  63         s = *p++;
  64         s *= s;
  65         z1 += _omega * (s - z1);      // Update first filter.
  66         s = *p++;
  67         s *= s;
  68         z1 += _omega * (s - z1);      // Update first filter.
  69         s = *p++;
  70         s *= s;
  71         z1 += _omega * (s - z1);      // Update first filter.
  72         s = *p++;
  73         s *= s;
  74         z1 += _omega * (s - z1);      // Update first filter.
  75         z2 += 4 * _omega * (z1 - z2); // Update second filter.
  76     }
  77
  78     // Save filter state. The added constants avoid denormals.
  79     _z1 = z1 + 1e-20f;
  80     _z2 = z2 + 1e-20f;
  81
  82     s = sqrtf (2.0f * z2);
  83
  84     if (_flag) // Display thread has read the rms value.
  85     {
  86         _rms  = s;
  87         _flag = false;
  88     }
  89     else
  90     {
  91         // Adjust RMS value and update maximum since last read().
  92         if (s > _rms) _rms = s;
  93     }
  94 }
  95
  96 /* Returns highest _rms value since last call */
  97 float Kmeterdsp::read ()
  98 {
  99     float rv= _rms;
 100     _flag = true; // Resets _rms in next process().
 101     return rv;
 102 }
 103
 104 void Kmeterdsp::reset ()
 105 {
 106     _z1 = _z2 = _rms = .0f;
 107     _flag = false;
 108 }
 109
 110 /* vi:set ts=8 sts=8 sw=4: */