Arduino.ru

Здравствуйте, мой скетч не выполняется, а точнее просто замораживается. Есть следующий код

#include <QList.h>
#include "QList.cpp" 

#include <TimerOne.h>

volatile QList <byte> mySignal;

// This example uses the timer interrupt to blink an LED
// and also demonstrates how to share a variable between
// the interrupt and the main program.


void setup(void)
{
  pinMode(LED_BUILTIN, OUTPUT);
  //Timer1.initialize(100000);// в микросекундах
  Timer1.initialize(300000);// в микросекундах
  Timer1.attachInterrupt(blinkLED); // blinkLED to run every 0.10 seconds
  Serial.begin(9600);
}


// The interrupt will blink the LED, and keep
// track of how many times it has blinked.
int ledState = LOW;
volatile unsigned long blinkCount = 0; // use volatile for shared variables

void blinkLED(void)
{
  if (ledState == LOW) {
    ledState = HIGH;
    blinkCount = blinkCount + 1;  // increase when LED turns on
  } else {
    ledState = LOW;
  }
  digitalWrite(LED_BUILTIN, ledState);
  addItemSignal();
}


// The main program will print the blink count
// to the Arduino Serial Monitor
void loop(void)
{
  QList <byte> signalCopy;  // holds a copy of the mySignal

  // to read a variable which the interrupt code writes, we
  // must temporarily disable interrupts, to be sure it will
  // not change while we are reading.  To minimize the time
  // with interrupts off, just quickly make a copy, and then
  // use the copy while allowing the interrupt to keep working.

  //int m1=millis();
  noInterrupts();
  // тут прочитать стек
  int signalSize=mySignal.size();
  for (int i=0;i<signalSize;i++){
    signalCopy.push_back(mySignal.get(i));
  }
  interrupts();
   //int m2=millis();
  //Serial.println(m2-m1);
  
 /*
  for (int i=0;i<signalSize;i++){
    //Serial.print(signalCopy.get(signalSize-i-1));
    Serial.print(signalCopy.get(i));
    Serial.print(" ");
  }
  */
  Serial.println();
  
  //тут будет DTW
  noInterrupts();
  Serial.print("num - ");
  Serial.print(signalCopy.size());
  interrupts();
  int disctance=DTWrun(signalCopy,signalCopy);
  noInterrupts();
  Serial.print(" distance ");
   Serial.print(disctance);
    Serial.println();
interrupts();

}
void addItemSignal(){
  int curSig=analogRead(A0);
  if(curSig>255){
    curSig=255;
  }
  Serial.println("aaa");
  //Serial.println(mySignal.size());
  if (mySignal.size()>5){
    mySignal.pop_back();
  }
  mySignal.push_front((byte)curSig);
}

int DTWrun( QList <byte> v, QList <byte>  w ) {
  int cost;
  int mGamma [v.size()+1][w.size()+1];
  for( int i = 1; i <= w.size(); i++ ) {
    mGamma[0][i] = 0;
  }
  for( int i = 1; i <= v.size(); i++ ) {
    mGamma[i][0] = 0;
  }
  mGamma[0][0] = 0;
  
  for( int i = 1; i <= v.size(); i++ ) {
    for( int j = 1; j <= w.size(); j++ ) {
    //  cost = abs( v[i] - w[j] ) * abs( v[i] - w[j] );
      if( v.get(i - 1) == w.get(j - 1) ) {
        cost = 0;
      }
      else {
        cost = 1;
      }
      mGamma[i][j] = cost + min( mGamma[i-1][j], min(mGamma[i][j-1], mGamma[i-1][j-1]) );
    }
  }
  return 10;
}

Вывод:

Ошибка происходить на 78 строчке. После этого перестают работать прерывания (не мигает светодиод, не добывляются новые элементы в список). Если убрать блок кода на 78 строке, все работает как часы. Во время. Стоит отметить что скетч крашится после того как в списке появляется первый элемент. Что я делаю не так?

Плата: Arduino Nano, процессор: ATmega 328P