creating 100mm per s estimations for the paper

timestamp estimation improved (new method)
sorting method improved
Idea about rotation vector, Did I screw that up somewhere?