Added a sorting function for poles by ASC IDs
Added a class for egomotion estimation from poles movement