Thanks for your clear solution. That's what I want. But I don't know d1 is parallel to the floor or not. Lidar sceneDepth are just some distance points, not including angles.