Added struct transfer communication for closed loop control. Used #define DEBUG_MODE to operate in debug-mode without struct-based communication. Remove the #define to operate in struct mode.