First part of refactoring of IMU
Merge pull request #4 from yashunsky/wp/refactoring/4

First part of refactoring of IMU