Add FreeIMUTest