Lin_ACorr_RT_Teensy.hpp

Go to the documentation of this file.

#pragma once
 
 
#include "./../types.hpp"
#include "simpler_circular_buffer.hpp"
#ifdef CORR_SIMULATOR
  #include "pseudoSerial.hpp"
#else
  #include <Arduino.h>
#endif
 
template <index_t Series_Size, bool hasMonitorChannel>
class LinACorrRTTeensy
{
 
public:
 
  //MonitorChannel<float_t, hasMonitorChannel> Monitor;
 
  //MonitorChannel<hasMonitorChannel> Mean_monitor; //!< Mean monitor object
  channel_t Channel_array[Series_Size] = {0}; 
  Simpler_Circular_Buffer<counter_t, Series_Size> Series_array; 
 
  index_t Series_index = 0; 
 
  //0
  LinACorrRTTeensy()
  {
  }
 
  //1
  void inline push_datum(counter_t datum)
  {
    Series_array.push_back(datum);
 
    unsigned int LoopFor = (Series_index > Series_Size) ? Series_Size-1 : Series_index;
    //LoopFor = (Series_index > Series_Size) * Series_Size +
    //          !(Series_index > Series_Size) * Series_index;
    
    for(unsigned int i = 0; i <= LoopFor; i++)
    {
      //Channel_array[i] += (Series_array[Series_index] * 
      //                    Series_array[Series_index - i]);
 
      Channel_array[i] += (datum * Series_array[Series_index - i]);
    }
 
    Series_index++;
  }
 
 
  //2
  void push_data(const counter_t *container, const index_t size) __attribute__((flatten))
  {
    for (int i = 0; i < size; i++)
    {
      push_datum(container[i]);
    }
  }
 
 
  //3
  float_t inline norm() {return 1;}
 
 
  //4
  void ch_out() const __attribute__((always_inline))
  {
     //                                              ↓ Which is usually uint32_t. 
    Serial.write((char8cast_t*)&(Channel_array), sizeof(channel_t)*Series_Size);
  }
 
 
 
  //5
  void  ch_out_norm() const __attribute__((flatten))
  {
    // TODO - Try to unroll
    for(unsigned int i = 0; i < Series_Size; i++)
    {
      Serial.write((char8cast_t*)&(float_t(Channel_array[i])/norm()), sizeof(float_t));
    }
  }
 
 
  //6
/*  channel_t* get_ch_array()
  {
    return (Channel_array);
  }*/
  
};