Seperate the task from main.c
Create structure "imu_data_t" and "ahrs_data_t"
Get the accelermeter inertial frame data