I intend to implement a localization algorithm from scratch but I need to extract the map features so I can use it as landmarks for localization using my laser scan.

Do you know any existing package do to this task or any ideia?