took out imu filter, which helped fixed gravity compensation. Now using /imu/data_raw instead of /imu/data