XYZ Trajectory

Still needs set box command