#include <fsfw_hal/devicehandlers/devicedefinitions/gyroL3gHelpers.h>

float l3gd20h::ctrlReg4ToSensitivity(uint8_t reg) {
  bool fsH = reg & l3gd20h::SET_FS_1;
  bool fsL = reg & l3gd20h::SET_FS_0;

  if (not fsH and not fsL) {
    return l3gd20h::SENSITIVITY_00;
  } else if (not fsH and fsL) {
    return l3gd20h::SENSITIVITY_01;
  } else {
    return l3gd20h::SENSITIVITY_11;
  }
}