Added a PRINT_FREQ flag to enable printing every x value. Kalman still has timing issues due to blocking while loop for printing. Need to add queues to rectify this issue. Consolidated framework looks to be working well.