Full slam Imu refactoring

- created new class FullSlamImu
- other classes inherit from this class