Changed node to handle a list of Cartesian goal positions