Advance in the IMU code, and create a complete imu preintegration toolbox with imu_tools.h
merged
mentioned in commit 1b2fa60f