Most tests for MultiGoalActionClient and Server now work, just feedback left to test :P