Got everything working I think! The program will not wait for for the robot programt os ubcribe to our publisher and then wait for the robot program to start publishign movement data before proceeding. It compiled but I don't have any test data atm