Zap KinematicPlanner and test