test_imu

added test_imu function and initialize_imu to robotics cape library