15 lines
386 B
C++
15 lines
386 B
C++
|
#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;
|
||
|
|
}
|
||
|
|
}
|