robot refactoring

started multi goal action client