new method: HSwarm.addGoal(x,y,z) (#16)