gtest imu and mocap

Implement a gtest fusing simulated mocap with extrinsics + imu measurements

added Doing label

created merge request !29 (merged) to address this issue

mentioned in merge request !29 (merged)

closed with merge request !29 (merged)

mentioned in commit abf66640