1 files changed, 86 insertions, 0 deletions
diff --git a/src/plugins/Effect/stereo/stereoplugin.cpp b/src/plugins/Effect/stereo/stereoplugin.cpp
new file mode 100644
index 000000000..ee96a0aa0
--- /dev/null
+++ b/src/plugins/Effect/stereo/stereoplugin.cpp
@@ -0,0 +1,86 @@
+/***************************************************************************
+ *   Copyright (C) 1999 by Johan Levin                                     *
+ *                                                                         *
+ *   Copyright (C) 2011 by Ilya Kotov                                      *
+ *   forkotov02@hotmail.ru                                                 *
+ *                                                                         *
+ *   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 <QSettings>
+#include <math.h>
+#include <stdlib.h>
+#include <qmmp/qmmp.h>
+#include "stereoplugin.h"
+
+StereoPlugin *StereoPlugin::m_instance = 0;
+
+StereoPlugin::StereoPlugin() : Effect()
+{
+    m_instance = this;
+    m_avg = 0;
+    m_ldiff = 0;
+    m_rdiff = 0;
+    m_tmp = 0;
+    m_mul = 2.0;
+    m_chan = 0;
+    QSettings settings(Qmmp::configFile(), QSettings::IniFormat);
+    m_mul = settings.value("extra_stereo/intensity", 1.0).toDouble();
+}
+
+StereoPlugin::~StereoPlugin()
+{
+    m_instance = 0;
+}
+
+void StereoPlugin::applyEffect(Buffer *b)
+{
+    if(m_chan != 2)
+        return;
+
+    m_mutex.lock();
+    short *data = (short *)b->data;
+    for (uint i = 0; i < b->nbytes >> 1; i += 2)
+    {
+        m_avg = (data[i] + data[i + 1]) / 2;
+        m_ldiff = data[i] - m_avg;
+        m_rdiff = data[i + 1] - m_avg;
+
+        m_tmp = m_avg + m_ldiff * m_mul;
+        data[i] = qBound(-32768.0, m_tmp, 32767.0);
+        m_tmp = m_avg + m_rdiff * m_mul;
+        data[i + 1] = qBound(-32768.0, m_tmp, 32767.0);
+    }
+    m_mutex.unlock();
+}
+
+void StereoPlugin::configure(quint32 freq, int chan, Qmmp::AudioFormat format)
+{
+    m_chan = chan;
+    Effect::configure(freq, chan, format);
+}
+
+void StereoPlugin::setIntensity(double level)
+{
+    m_mutex.lock();
+    m_mul = level;
+    m_mutex.unlock();
+}
+
+StereoPlugin* StereoPlugin::instance()
+{
+    return m_instance;
+}