libs/ardour/vumeterdsp.cc

   1 /*
   2  * Copyright (C) 2012 Fons Adriaensen <fons@linuxaudio.org>
   3  * Copyright (C) 2013 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 along
  16  * with this program; if not, write to the Free Software Foundation, Inc.,
  17  * 51 Franklin Street, Fifth Floor, Boston, MA 02110-1301 USA.
  18  */
  19
  20 #include <math.h>
  21 #include "ardour/vumeterdsp.h"
  22
  23
  24 float Vumeterdsp::_w;
  25 float Vumeterdsp::_g;
  26
  27
  28 Vumeterdsp::Vumeterdsp (void) :
  29     _z1 (0),
  30     _z2 (0),
  31     _m (0),
  32     _res (true)
  33 {
  34 }
  35
  36
  37 Vumeterdsp::~Vumeterdsp (void)
  38 {
  39 }
  40
  41
  42 void Vumeterdsp::process (float const *p, int n)
  43 {
  44     float z1, z2, m, t1, t2;
  45
  46     z1 = _z1 > 20 ? 20 : (_z1 < -20 ? -20 : _z1);
  47     z2 = _z2 > 20 ? 20 : (_z2 < -20 ? -20 : _z2);
  48     m = _res ? 0: _m;
  49     _res = false;
  50
  51     n /= 4;
  52     while (n--)
  53     {
  54         t2 = z2 / 2;
  55         t1 = fabsf (*p++) - t2;
  56         z1 += _w * (t1 - z1);
  57         t1 = fabsf (*p++) - t2;
  58         z1 += _w * (t1 - z1);
  59         t1 = fabsf (*p++) - t2;
  60         z1 += _w * (t1 - z1);
  61         t1 = fabsf (*p++) - t2;
  62         z1 += _w * (t1 - z1);
  63         z2 += 4 * _w * (z1 - z2);
  64         if (z2 > m) m = z2;
  65     }
  66
  67     if (isnan(z1)) z1 = 0;
  68     if (isnan(z2)) z2 = 0;
  69     _z1 = z1;
  70     _z2 = z2 + 1e-10f;
  71     _m = m;
  72 }
  73
  74
  75 float Vumeterdsp::read (void)
  76 {
  77     _res = true;
  78     return _g * _m;
  79 }
  80
  81 void Vumeterdsp::reset ()
  82 {
  83     _z1 = _z2 = _m = .0f;
  84     _res = true;
  85 }
  86
  87 void Vumeterdsp::init (float fsamp)
  88 {
  89     _w = 11.1f / fsamp;
  90     _g = 1.5f * 1.571f;
  91 }