Modified to use compute_cartesian_path function
Remove the limit of the operating range