  // VAR INITIALIZATION
     encoder0_cnt = 0;
     encoder1_cnt = 0;
-    data_raw.data_length = DATA_LENGTH; // The number of output message entries
+    data_raw.data_length = DATA_SIZE; // The number of output message entries
     data_raw.data = (float *)malloc(sizeof(float)*data_raw.data_length);
  //MOTORS           
     md.init();

 //SERVOS
    srv_carpet.attach(SERVO1_PIN);
    srv_clapper.attach(SERVO2_PIN);
 //MISCELLANEOUS
    pinMode(25, OUTPUT); // BLUE LED
    pinMode(26, OUTPUT); // YELLOW LED

#define ENC_DATA_0 11 // Speed on encoder 0
#define ENC_DATA_1 12 // Speed on encoder 1
#define BTN_STATE  13 // Power button state
#define DATA_SIZE  14 // Overall array size
           
//FUNCTIONS
void setup();
