Apolo update with interface RobotSimGoTo

Updating RobotSimGoTo to check robots movement with different interpolators