Milestone 1 isn't fundamentally complex, but here's some proof that it works! Most of the effort spent on this milestone actually went into discovery and experimentation with things beyond the milestone goal, like figuring out data formats and available information, how the LIDAR device works in practice, and so on.

Have a look at it working to profile a straight wall below: