Refactored various control methods so they are more robust to being run at the same time, created jaco_msgs package to clean up dependencies between jaco packages