added remaining methods for planning in cartesian space and publishing joint states