Filtering/extraction of terrain points from laser data