- changed if cases for setup_gyro and setup_acc to more easier form