andreika-git
/
ChibiOS
mirror of https://github.com/andreika-git/ChibiOS.git
1
0
Fork 0
Code Issues Packages Projects Releases Wiki Activity

Added new assets 

git-svn-id: svn://svn.code.sf.net/p/chibios/svn/trunk@9458 35acf78f-673a-0410-8e92-d51de3d6d3f4
This commit is contained in:
Rocco Marco Guglielmi 2016-05-10 17:05:39 +00:00
parent 77a32a7b37
commit b8983060bb
3 changed files with 15 additions and 1 deletions
Show Stats Download Patch File Download Diff File Expand all files Collapse all files

4
os/ex/ST/l3gd20.c
View File

@ -332,6 +332,10 @@ static msg_t reset_sensivity(void *ip) {
else if(((L3GD20Driver *)ip)->config->fullscale == L3GD20_FS_2000DPS)
for(i = 0; i < L3GD20_NUMBER_OF_AXES; i++)
((L3GD20Driver *)ip)->sensitivity[i] = L3GD20_SENS_2000DPS;
else {
osalDbgAssert(FALSE, "reset_sensivity(), full scale issue");
return MSG_RESET;
}
return MSG_OK;
}

4
os/ex/ST/lis3mdl.c
View File

@ -313,8 +313,10 @@ static msg_t reset_sensivity(void *ip) {
else if(((LIS3MDLDriver *)ip)->config->fullscale == LIS3MDL_FS_16GA)
for(i = 0; i < LIS3MDL_NUMBER_OF_AXES; i++)
((LIS3MDLDriver *)ip)->sensitivity[i] = LIS3MDL_SENS_16GA;
else
else {
osalDbgAssert(FALSE, "reset_sensivity(), compass full scale issue");
return MSG_RESET;
}
return MSG_OK;
}

8
os/ex/ST/lsm6ds0.c
View File

@ -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;
}