         0.09354893,  0.09836316,  0.1       ,  0.09836316,  0.09354893,
         0.08583937,  0.07568267,  0.06366198,  0.05045512,  0.0367883 };
   filt_2nd_stage.setFilterCoeffs(fir_coeffs);
+  tprofile.reset(); // Start the temperature profile
 }
 
 void loop() {

 */
FIR<double, 15> filt_2nd_stage;

void plot_callback(void) {
  // plotting thread
  plotter.Plot();


void control_callback(void) {
  // control thread
  PID_setpoint = tprofile.getval();
  PID_in = measure_temperature();

  control_PID.Compute();
