Creation of IMUcontroller_test with angular velocity correction (PID)