Planning to a joint-space goal
Fixed print method