Moved msgs to another ros module to avoid catkin_make msg dependency bug
Enabled debugging and added debug print statements