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