Added the waitForCommand node. This will help in measuring error next week. It will listen for trajectories or twist messages.