diff options
| author | Rocco Marco Guglielmi <roccomarco.guglielmi@live.com> | 2016-05-10 17:05:39 +0000 |
|---|---|---|
| committer | Rocco Marco Guglielmi <roccomarco.guglielmi@live.com> | 2016-05-10 17:05:39 +0000 |
| commit | b8983060bba2e5e7728eca8bd495f1911405bb2b (patch) | |
| tree | 52764e8feb13b8aac2304a7f1061b50be0a30043 /os/ex/ST/lsm6ds0.c | |
| parent | 77a32a7b37dd537e42ef5093326658e00fd3b457 (diff) | |
| download | ChibiOS-b8983060bba2e5e7728eca8bd495f1911405bb2b.tar.gz ChibiOS-b8983060bba2e5e7728eca8bd495f1911405bb2b.tar.bz2 ChibiOS-b8983060bba2e5e7728eca8bd495f1911405bb2b.zip | |
Added new assets
git-svn-id: svn://svn.code.sf.net/p/chibios/svn/trunk@9458 35acf78f-673a-0410-8e92-d51de3d6d3f4
Diffstat (limited to 'os/ex/ST/lsm6ds0.c')
| -rw-r--r-- | os/ex/ST/lsm6ds0.c | 8 |
1 files changed, 8 insertions, 0 deletions
diff --git a/os/ex/ST/lsm6ds0.c b/os/ex/ST/lsm6ds0.c index 5afed9ef7..f657ad879 100644 --- a/os/ex/ST/lsm6ds0.c +++ b/os/ex/ST/lsm6ds0.c @@ -591,6 +591,10 @@ static msg_t acc_reset_sensivity(void *ip) { else if(((LSM6DS0Driver *)ip)->config->acccfg->fullscale == LSM6DS0_ACC_FS_16G) for(i = 0; i < LSM6DS0_ACC_NUMBER_OF_AXES; i++) ((LSM6DS0Driver *)ip)->accsensitivity[i] = LSM6DS0_ACC_SENS_16G; + else { + osalDbgAssert(FALSE, "reset_sensivity(), accelerometer full scale issue"); + return MSG_RESET; + } return MSG_OK; } @@ -611,6 +615,10 @@ static msg_t gyro_reset_sensivity(void *ip) { else if(((LSM6DS0Driver *)ip)->config->gyrocfg->fullscale == LSM6DS0_GYRO_FS_2000DSP) for(i = 0; i < LSM6DS0_ACC_NUMBER_OF_AXES; i++) ((LSM6DS0Driver *)ip)->gyrosensitivity[i] = LSM6DS0_GYRO_SENS_2000DPS; + else { + osalDbgAssert(FALSE, "reset_sensivity(), gyroscope full scale issue"); + return MSG_RESET; + } return MSG_OK; } |