add loading of pc map, add simulation on cisarsky ostrov, add text aligning, fixed types, tune parameters

 change back from Linear to NonLinear icp, add previous approach to make available compare them (and leave iterative)

1) optimize the code, reduce speed by half, 2) analyze two algorithms, iterative and straight forward