Remove warnings from code
Add calibration and rigid body transformation estimation
Merge branch 'master' of github.com:8ware/KP-GDV