Remove unused code
Add missing test data for IMU test
Rectification for RGB and depth images.
Update README