/*
  An LV2 plugin to generate a bandlimited variable pulse waveform.
  Copyright 2011 David Robillard
  Copyright 2002 Mike Rawes

  This 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 3 of the License, or
  (at your option) any later version.

  This software 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 software.  If not, see <http://www.gnu.org/licenses/>.
*/

#include <stdlib.h>
#include "lv2/lv2plug.in/ns/lv2core/lv2.h"
#include "wavedata.h"

#define PULSE_FREQUENCY  0
#define PULSE_PULSEWIDTH 1
#define PULSE_OUTPUT     2

typedef struct {
	float*   frequency;
	float*   pulsewidth;
	float*   output;
	float    phase;
	Wavedata wdat;
} Pulse;

static void
connect_port(LV2_Handle instance,
             uint32_t   port,
             void*      data)
{
	Pulse* plugin = (Pulse*)instance;

	switch (port) {
	case PULSE_FREQUENCY:
		plugin->frequency = data;
		break;
	case PULSE_PULSEWIDTH:
		plugin->pulsewidth = data;
		break;
	case PULSE_OUTPUT:
		plugin->output = data;
		break;
	}
}

static LV2_Handle
instantiate(const LV2_Descriptor*     descriptor,
            double                    sample_rate,
            const char*               bundle_path,
            const LV2_Feature* const* features)
{
	Pulse* plugin = (Pulse*)malloc(sizeof(Pulse));

	if (wavedata_load(&plugin->wdat, bundle_path, "sawtooth_data",
	                  BLOP_DLSYM_SAWTOOTH, sample_rate)) {
		free(plugin);
		return 0;
	}

	return (LV2_Handle)plugin;
}

static void
cleanup(LV2_Handle instance)
{
	Pulse* plugin = (Pulse*)instance;

	wavedata_unload(&plugin->wdat);
	free(instance);
}

static void
activate(LV2_Handle instance)
{
	Pulse* plugin = (Pulse*)instance;

	plugin->phase = 0.0f;
}

static void
runPulse_fapa_oa(LV2_Handle instance,
                 uint32_t   sample_count)
{
	Pulse* plugin = (Pulse*)instance;

	/* Frequency (array of float of length sample_count) */
	float* frequency = plugin->frequency;

	/* Pulse Width (array of float of length sample_count) */
	float* pulsewidth = plugin->pulsewidth;

	/* Output (pointer to float value) */
	float* output = plugin->output;

	/* Instance data */
	Wavedata* wdat  = &plugin->wdat;
	float     phase = plugin->phase;

	float freq;
	float pwidth;
	float phase_shift;

	for (uint32_t s = 0; s < sample_count; ++s) {
		freq        = frequency[s];
		pwidth      = f_clip(pulsewidth[s], 0.0f, 1.0f);
		phase_shift = pwidth * wdat->sample_rate;

		/* Lookup which table to use from frequency */
		wavedata_get_table(wdat, freq);

		/* Get samples from sawtooth and phase shifted inverted sawtooth,
		   with approriate DC offset */
		output[s] = wavedata_get_sample(wdat, phase)
		    - wavedata_get_sample(wdat, phase + phase_shift)
		    + 1.0f - (2.0f * pwidth);

		/* Update phase, wrapping if necessary */
		phase += wdat->frequency;
		if (phase < 0.0f) {
			phase += wdat->sample_rate;
		} else if (phase > wdat->sample_rate) {
			phase -= wdat->sample_rate;
		}
	}
	plugin->phase = phase;
}

static void
runPulse_fapc_oa(LV2_Handle instance,
                 uint32_t   sample_count)
{
	Pulse* plugin = (Pulse*)instance;

	/* Frequency (array of float of length sample_count) */
	float* frequency = plugin->frequency;

	/* Pulse Width (float value) */
	float pulsewidth = f_clip(*(plugin->pulsewidth), 0.0f, 1.0f);

	/* Output (pointer to float value) */
	float* output = plugin->output;

	/* Instance data */
	Wavedata* wdat  = &plugin->wdat;
	float     phase = plugin->phase;

	float freq;
	float dc_shift    = 1.0 - (2.0 * pulsewidth);
	float phase_shift = pulsewidth * wdat->sample_rate;

	for (uint32_t s = 0; s < sample_count; ++s) {
		freq = frequency[s];

		/* Lookup which table to use from frequency */
		wavedata_get_table(wdat, freq);

		/* Get samples from sawtooth and phase shifted inverted sawtooth,
		   with approriate DC offset */
		output[s] = wavedata_get_sample(wdat, phase)
		    - wavedata_get_sample(wdat, phase + phase_shift)
		    + dc_shift;

		/* Update phase, wrapping if necessary */
		phase += wdat->frequency;
		if (phase < 0.0f) {
			phase += wdat->sample_rate;
		} else if (phase > wdat->sample_rate) {
			phase -= wdat->sample_rate;
		}
	}
	plugin->phase = phase;
}

static void
runPulse_fcpa_oa(LV2_Handle instance,
                 uint32_t   sample_count)
{
	Pulse* plugin = (Pulse*)instance;

	/* Frequency (float value) */
	float frequency = *(plugin->frequency);

	/* Pulse Width (array of float of length sample_count) */
	float* pulsewidth = plugin->pulsewidth;

	/* Output (pointer to float value) */
	float* output = plugin->output;

	/* Instance data */
	Wavedata* wdat  = &plugin->wdat;
	float     phase = plugin->phase;

	float pwidth;
	float phase_shift;

	wavedata_get_table(wdat, frequency);

	for (uint32_t s = 0; s < sample_count; ++s) {
		pwidth      = f_clip(pulsewidth[s], 0.0f, 1.0f);
		phase_shift = pwidth * wdat->sample_rate;

		/* Get samples from sawtooth and phase shifted inverted sawtooth,
		   with approriate DC offset */
		output[s] = wavedata_get_sample(wdat, phase)
		    - wavedata_get_sample(wdat, phase + phase_shift)
		    + 1.0f - (2.0f * pwidth);

		/* Update phase, wrapping if necessary */
		phase += wdat->frequency;
		if (phase < 0.0f) {
			phase += wdat->sample_rate;
		} else if (phase > wdat->sample_rate) {
			phase -= wdat->sample_rate;
		}
	}
	plugin->phase = phase;
}

static void
runPulse_fcpc_oa(LV2_Handle instance,
                 uint32_t   sample_count)
{
	Pulse* plugin = (Pulse*)instance;

	/* Frequency (float value) */
	float frequency = *(plugin->frequency);

	/* Pulse Width (float value) */
	float pulsewidth = f_clip(*(plugin->pulsewidth), 0.0f, 1.0f);

	/* Output (pointer to float value) */
	float* output = plugin->output;

	/* Instance data */
	Wavedata* wdat  = &plugin->wdat;
	float     phase = plugin->phase;

	float dc_shift    = 1.0f - (2.0f * pulsewidth);
	float phase_shift = pulsewidth * wdat->sample_rate;

	wavedata_get_table(wdat, frequency);

	for (uint32_t s = 0; s < sample_count; ++s) {
		/* Get samples from sawtooth and phase shifted inverted sawtooth,
		   with approriate DC offset */
		output[s] = wavedata_get_sample(wdat, phase)
		    - wavedata_get_sample(wdat, phase + phase_shift)
		    + dc_shift;

		/* Update phase, wrapping if necessary */
		phase += wdat->frequency;
		if (phase < 0.0f) {
			phase += wdat->sample_rate;
		} else if (phase > wdat->sample_rate) {
			phase -= wdat->sample_rate;
		}
	}
	plugin->phase = phase;
}

static const LV2_Descriptor descriptor = {
	"http://drobilla.net/plugins/blip/pulse",
	instantiate,
	connect_port,
	activate,
	runPulse_fcpc_oa,
	NULL,
	cleanup,
	NULL,
};

LV2_SYMBOL_EXPORT const LV2_Descriptor*
lv2_descriptor(uint32_t index)
{
	switch (index) {
	case 0:  return &descriptor;
	default: return NULL;
	}
}