Fixed merge issues
Block store implementation
Refactored code into Geometry.h
Introduced ARBlockFilter instead of old pointer based OpenCV KalmanFilter
Fixed layout interface
Working top side calculation using quaternion vector differences.
Finishing .rosinstall. Topside calculation remaining. Final debugging tests required.