master
[RECONSTRUCTION] Various fixes/improvements for unit test
remove empty destructor + code-format
Vectorization of Kalman operations on plane, plus other optimizations
Squashed commit of the following: