Refactored stdr_robot code
Fixed robot reposition from gui bug