Heights: Filter depth map pending
Heights:
- Add comments (Doxygen)
- Filter depth map finished (Eliminate zeros)