Basic ransac lib included. Cleaned code from laserstop.