statically declare comb array
[software/lv2-mdametapiano.git] / src / mdaPianoVoice.cpp
index 633fb5a..322b534 100644 (file)
@@ -31,6 +31,8 @@ void mdaPianoVoice::reset() {
   muff = 160.0f;
   volume = 0.2f;
   sustain = 0;
+  cpos = 0;
+  m_key = LV2::INVALID_KEY;
 }
 
 
@@ -42,12 +44,13 @@ float mdaPianoVoice::p_helper(unsigned short id, Param d) {
 }
 
 
-mdaPianoVoice::on(unsigned char note, unsigned char velocity)
+void mdaPianoVoice::on(unsigned char note, unsigned char velocity)
 {
-  // TODO: replace with this voice's local copy
-  float * param = programs[curProgram].param;
+  // store key that turned this voice on (used in 'get_key')
+  m_key = note;
+
   float l=99.0f;
-  uint32_t  v, vl=0, k, s;
+  uint32_t k, s;
 
   if(velocity>0)
   {
@@ -79,43 +82,137 @@ mdaPianoVoice::on(unsigned char note, unsigned char velocity)
 
     l += (float)(note - kgrp[k].root); //pitch
     l = 22050.0f * iFs * (float)exp(0.05776226505 * l);
-    voice[vl].delta = (uint32_t)(65536.0f * l);
-    voice[vl].frac = 0;
-    voice[vl].pos = kgrp[k].pos;
-    voice[vl].end = kgrp[k].end;
-    voice[vl].loop = kgrp[k].loop;
+    delta = (uint32_t)(65536.0f * l);
+    frac = 0;
+    pos = kgrp[k].pos;
+    end = kgrp[k].end;
+    loop = kgrp[k].loop;
 
-    voice[vl].env = (0.5f + velsens) * (float)pow(0.0078f * velocity, velsens); //velocity
+    env = (0.5f + velsens) * (float)pow(0.0078f * velocity, velsens); //velocity
 
-    l = 50.0f + param[4] * param[4] * muff + muffvel * (float)(velocity - 64); //muffle
+    l = 50.0f + *p(p_muffling_filter) * *p(p_muffling_filter) * muff + muffvel * (float)(velocity - 64); //muffle
     if(l < (55.0f + 0.25f * (float)note)) l = 55.0f + 0.25f * (float)note;
     if(l > 210.0f) l = 210.0f;
-    voice[vl].ff = l * l * iFs;
-    voice[vl].f0 = voice[vl].f1 = 0.0f;
+    ff = l * l * iFs;
+    f0 = f1 = 0.0f;
 
-    voice[vl].note = note; //note->pan
     if(note <  12) note = 12;
     if(note > 108) note = 108;
     l = volume * trim;
-    voice[vl].outr = l + l * width * (float)(note - 60);
-    voice[vl].outl = l + l - voice[vl].outr;
+    outr = l + l * width * (float)(note - 60);
+    outl = l + l - outr;
 
     if(note < 44) note = 44; //limit max decay length
-    l = 2.0f * param[0];
-    if(l < 1.0f) l += 0.25f - 0.5f * param[0];
-    voice[vl].dec = (float)exp(-iFs * exp(-0.6 + 0.033 * (double)note - l));
+    l = 2.0f * *p(p_envelope_decay);
+    if(l < 1.0f) l += 0.25f - 0.5f * *p(p_envelope_decay);
+    dec = (float)exp(-iFs * exp(-0.6 + 0.033 * (double)note - l));
   }
   else //note off
   {
     // TODO: move the loop to mdaPiano.cpp
-    for(v=0; v<NVOICES; v++) if(voice[v].note==note) //any voices playing that note?
-    {
-      if(sustain==0)
-      {
-        if(note < 94 || note == SUSTAIN) //no release on highest notes
-          voice[v].dec = (float)exp(-iFs * exp(2.0 + 0.017 * (double)note - 2.0 * param[1]));
-      }
-      else voice[v].note = SUSTAIN;
+    //for(v=0; v<NVOICES; v++) if(voice[v].note==note) //any voices playing that note?
+    //{
+      release(0);
+    //}
+  }
+}
+
+
+void mdaPianoVoice::release(unsigned char velocity)
+{
+  if(sustain==0) {
+    //no release on highest notes
+    if(note < 94 || note == SUSTAIN) {
+      dec = (float)exp(-iFs * exp(2.0 + 0.017 * (double)note - 2.0 * *p(p_envelope_release)));
     }
+  } else {
+    note = SUSTAIN;
+  }
+
+  //Mark the voice to be turned off later. It may not be set to
+  //INVALID_KEY yet, because the release sound still needs to be
+  //rendered.  m_key is finally set to INVALID_KEY by 'render' when
+  //env < SILENCE
+  m_key = SUSTAIN;
+}
+
+
+void mdaPianoVoice::render(uint32_t from, uint32_t to)
+{
+  float x, l, r;
+  uint32_t i;
+
+  for (uint32_t frame = from; frame < to; ++frame) {
+    l = r = 0.0f;
+
+    frac += delta;  //integer-based linear interpolation
+    pos += frac >> 16;
+    frac &= 0xFFFF;
+    if(pos > end) pos -= loop;
+
+    i = waves[pos];
+    i = (i << 7) + (frac >> 9) * (waves[pos + 1] - i) + 0x40400000;
+    x = env * (*(float *)&i - 3.0f);  //fast int->float
+
+    /////////////////////
+    //TODO: This was used in processReplacing instead of the above
+    /*
+    //i = (i << 7) + (frac >> 9) * (waves[pos + 1] - i) + 0x40400000;   //not working on intel mac !?!
+i = waves[pos] + ((frac * (waves[pos + 1] - waves[pos])) >> 16);
+x = env * (float)i / 32768.0f;
+    //x = env * (*(float *)&i - 3.0f);  //fast int->float
+    */
+    /////////////////////
+
+    env = env * dec;  //envelope
+    f0 += ff * (x + f1 - f0);  //muffle filter
+    f1 = x;
+
+    l += outl * f0;
+    r += outr * f0;
+
+    //TODO: this was used in processReplacing
+    /////////////////////
+    /*
+if(!(l > -2.0f) || !(l < 2.0f))
+{
+printf("what is this shit?   %d,  %f,  %f\n", i, x, f0);
+l = 0.0f;
+}
+if(!(r > -2.0f) || !(r < 2.0f))
+{
+r = 0.0f;
+}
+    */
+    /////////////////////
+    comb[cpos] = l + r;
+    ++cpos &= 0x7F;
+    x = cdep * comb[cpos];  //stereo simulator
+
+    // TODO: processReplacing simply assigned instead of adding
+    // write to output
+    p(p_left)[frame] += l + x;
+    p(p_right)[frame] += r - x;
   }
 }
+
+
+void mdaPianoVoice::update(Param par)
+{
+  size = (uint32_t)(12.0f * p_helper(p_hardness_offset, par) - 6.0f);
+  sizevel = 0.12f * p_helper(p_velocity_to_hardness, par);
+  muffvel = p_helper(p_velocity_to_muffling, par) * p_helper(p_velocity_to_muffling, par) * 5.0f;
+
+  velsens = 1.0f + p_helper(p_velocity_sensitivity, par) + p_helper(p_velocity_sensitivity, par);
+  if(p_helper(p_velocity_sensitivity, par) < 0.25f) velsens -= 0.75f - 3.0f * p_helper(p_velocity_sensitivity, par);
+
+  fine = p_helper(p_fine_tuning, par) - 0.5f;
+  random = 0.077f * p_helper(p_random_detuning, par) * p_helper(p_random_detuning, par);
+  stretch = 0.000434f * (p_helper(p_stretch_tuning, par) - 0.5f);
+
+  cdep = p_helper(p_stereo_width, par) * p_helper(p_stereo_width, par);
+  trim = 1.50f - 0.79f * cdep;
+  width = 0.04f * p_helper(p_stereo_width, par);  if(width > 0.03f) width = 0.03f;
+
+  poly = 8 + (uint32_t)(24.9f * p_helper(p_polyphony, par));
+}