Kalman filter prototype

This PR is an early preview of Kalman filtering to 6D tag pose. Comes with hardcore c++11 `std::map::emplace()` and related syntax :)

Is a partial solution to #19.

For now, the quick & dirty covariance calibration seems to work decent enough. Please test further.

~~A huge issue now is gimbal lock and discontinuities in angle. We need quaternions to fix this.~~ done

In the near future, more goodies such as 

- ~~Calibration API~~ done
- ~~Enable/disable on demand API~~ done
- ~~Quaternions~~ done
- ~~IMU integration~~ done, see also https://github.com/chili-epfl/qml-imu
- ~~Optimizations~~ pretty much done
- ~~Sample~~ done
- ~~Remove `Filter` completely~~ done
- ~~Add tag discard mechanism~~ done
- ~~Fully document all math involved~~ done

will follow. 
Yes, I'm one of those guys who looks stupid in the middle of an argument by making stupid mistakes as mixing up indices, d'oh :)

And also yes, I'm really afraid of any kind of overhead after having to deal with Java, you can think of my paranoia level as close to Linux kernel developer :)

And finally, that really hurt, I try to provide tests as much as I can :)