wave.h

//wave generator
#ifndef ___KAL_WAVE_H
#define ___KAL_WAVW_H
#include "config.h"
#include "utilize.h"

//type
#define CONST 0
#define SIN 1
#define TRIANGLE 2
#define CHARPSIN 3
#define RECTANGLE 4

namespace kal{

class wave{
  public:
    double t;
    int type;//@todo:色々な波形を追加
    double ave;
    double amp;
    double f;
    double phase;
    double output;
    wave();
    wave(double ave_in,double amp_in,double f_in,double phase_in,int type);
    double update();
};

wave::wave(){
  t=0.0;
  ave=0.0;
  amp=0.0;
  f=0.0;
  output=0.0;
  phase=0.0;
  type = SIN;
}

wave::wave(double ave_in,double amp_in,double f_in,double phase_in=0.0,int type_in = SIN){
  ave=ave_in;
  amp=fabs(amp_in);
  f=f_in;
  output=0.0;
  type = type_in;
  if(type == CHARPSIN){
    f = 0.0;
  }
  phase = phase_in;
  range(-2.0*PI,2.0*PI,phase);
  if(phase<0.0){
    phase = 2.0*PI+phase;
  }
  t = phase/2.0/PI/f;
}

double wave::update(){
  t+=Ts;
  //t = t%((int)(1.0/f));//tの∞積分を防止
  switch (type){
  case CONST:
    output = ave;
    break;

  case SIN:
    if(t>=1.0/f){
      t = 0.0;
    }
    output = amp*sin(2.0*PI*f*t) + ave;
    break;
  
  case TRIANGLE:
    if(t>=1.0/f){
      t = 0.0;
    }
    if(0.0<=t && t<=1.0/4.0/f){
      output = amp/(1.0/f/4) * t + ave;  
    }
    else if(1.0/4.0/f<t && t<=3.0/4.0/f){
      output = -amp/(1.0/f/4.0) * t + (ave + 2.0*amp);  
    }
    else if(3.0/4.0/f<t && t<=1.0/f){
      output = amp/(1.0/f/4.0) * t + (ave - 4.0*amp);
    }
    break;
  
  case CHARPSIN:
    f += 0.0005;
    output = amp*sin(2.0*PI*f*t) + ave;
    if(f>5.0){
      f = 0.0;
      t = 0.0;
    }
    break;

  case RECTANGLE:
    if(t>=1.0/f){
      t = 0.0;
    }
    if(0.0<=t && t<=1.0/2.0/f){
      output = amp + ave;  
    }
    else if(1.0/2.0/f<t && t<=1.0/f){
      output = -amp + ave;
    }
    break;


  default:
    break;
  }

  return output;
}

}

#endif