* If-else statement fixed in kin_planner that prevents proper operation.