aboutsummaryrefslogtreecommitdiffstats
path: root/os/ex/ST/lsm6dsl.c
diff options
context:
space:
mode:
authorRocco Marco Guglielmi <roccomarco.guglielmi@gmail.com>2018-03-14 13:28:50 +0000
committerRocco Marco Guglielmi <roccomarco.guglielmi@gmail.com>2018-03-14 13:28:50 +0000
commitdc5651bf5260ca1b2829d1127e29dec1dee13156 (patch)
treefe923317dc8d679209e56f6e193442aa5c43c501 /os/ex/ST/lsm6dsl.c
parentac645ed6763094bb9fba7709de2e31e91d97a693 (diff)
downloadChibiOS-dc5651bf5260ca1b2829d1127e29dec1dee13156.tar.gz
ChibiOS-dc5651bf5260ca1b2829d1127e29dec1dee13156.tar.bz2
ChibiOS-dc5651bf5260ca1b2829d1127e29dec1dee13156.zip
Removed spaces before newline
git-svn-id: svn://svn.code.sf.net/p/chibios/svn/trunk@11745 110e8d01-0319-4d1e-a829-52ad28d1bb01
Diffstat (limited to 'os/ex/ST/lsm6dsl.c')
-rw-r--r--os/ex/ST/lsm6dsl.c96
1 files changed, 48 insertions, 48 deletions
diff --git a/os/ex/ST/lsm6dsl.c b/os/ex/ST/lsm6dsl.c
index 24b78c87f..c38a4c52d 100644
--- a/os/ex/ST/lsm6dsl.c
+++ b/os/ex/ST/lsm6dsl.c
@@ -15,7 +15,7 @@
You should have received a copy of the GNU General Public License
along with this program. If not, see <http://www.gnu.org/licenses/>.
-
+
*/
/**
@@ -94,7 +94,7 @@ msg_t lsm6dslI2CReadRegister(I2CDriver *i2cp, lsm6dsl_sad_t sad, uint8_t reg,
*/
static size_t acc_get_axes_number(void *ip) {
(void)ip;
-
+
return LSM6DSL_ACC_NUMBER_OF_AXES;
}
@@ -121,7 +121,7 @@ static msg_t acc_read_raw(void *ip, int32_t axes[]) {
msg_t msg;
osalDbgCheck((ip != NULL) && (axes != NULL));
-
+
/* Getting parent instance pointer.*/
devp = objGetInstance(LSM6DSLDriver*, (BaseAccelerometer*)ip);
@@ -137,8 +137,8 @@ static msg_t acc_read_raw(void *ip, int32_t axes[]) {
devp->config->i2ccfg);
#endif /* LSM6DSL_SHARED_I2C */
- msg = lsm6dslI2CReadRegister(devp->config->i2cp, devp->config->slaveaddress,
- LSM6DSL_AD_OUTX_L_XL, buff,
+ msg = lsm6dslI2CReadRegister(devp->config->i2cp, devp->config->slaveaddress,
+ LSM6DSL_AD_OUTX_L_XL, buff,
LSM6DSL_ACC_NUMBER_OF_AXES * 2);
#if LSM6DSL_SHARED_I2C
@@ -238,7 +238,7 @@ static msg_t acc_reset_bias(void *ip) {
msg_t msg = MSG_OK;
osalDbgCheck(ip != NULL);
-
+
/* Getting parent instance pointer.*/
devp = objGetInstance(LSM6DSLDriver*, (BaseAccelerometer*)ip);
@@ -297,7 +297,7 @@ static msg_t acc_reset_sensivity(void *ip) {
msg_t msg = MSG_OK;
osalDbgCheck(ip != NULL);
-
+
/* Getting parent instance pointer.*/
devp = objGetInstance(LSM6DSLDriver*, (BaseAccelerometer*)ip);
@@ -325,7 +325,7 @@ static msg_t acc_reset_sensivity(void *ip) {
/**
* @brief Changes the LSM6DSLDriver accelerometer fullscale value.
- * @note This function also rescale sensitivities and biases based on
+ * @note This function also rescale sensitivities and biases based on
* previous and next fullscale value.
* @note A recalibration is highly suggested after calling this function.
*
@@ -427,7 +427,7 @@ static msg_t acc_set_full_scale(LSM6DSLDriver *devp,
*/
static size_t gyro_get_axes_number(void *ip) {
(void)ip;
-
+
return LSM6DSL_GYRO_NUMBER_OF_AXES;
}
@@ -452,32 +452,32 @@ static msg_t gyro_read_raw(void *ip, int32_t axes[LSM6DSL_GYRO_NUMBER_OF_AXES])
int16_t tmp;
uint8_t i, buff [2 * LSM6DSL_GYRO_NUMBER_OF_AXES];
msg_t msg = MSG_OK;
-
+
osalDbgCheck((ip != NULL) && (axes != NULL));
/* Getting parent instance pointer.*/
devp = objGetInstance(LSM6DSLDriver*, (BaseGyroscope*)ip);
-
+
osalDbgAssert((devp->state == LSM6DSL_READY),
"gyro_read_raw(), invalid state");
#if LSM6DSL_USE_I2C
osalDbgAssert((devp->config->i2cp->state == I2C_READY),
"gyro_read_raw(), channel not ready");
-
+
#if LSM6DSL_SHARED_I2C
i2cAcquireBus(devp->config->i2cp);
i2cStart(devp->config->i2cp,
devp->config->i2ccfg);
#endif /* LSM6DSL_SHARED_I2C */
- msg = lsm6dslI2CReadRegister(devp->config->i2cp, devp->config->slaveaddress,
+ msg = lsm6dslI2CReadRegister(devp->config->i2cp, devp->config->slaveaddress,
LSM6DSL_AD_OUTX_L_G, buff,
LSM6DSL_GYRO_NUMBER_OF_AXES * 2);
#if LSM6DSL_SHARED_I2C
i2cReleaseBus(devp->config->i2cp);
-#endif /* LSM6DSL_SHARED_I2C */
-#endif /* LSM6DSL_USE_I2C */
+#endif /* LSM6DSL_SHARED_I2C */
+#endif /* LSM6DSL_USE_I2C */
for(i = 0; i < LSM6DSL_GYRO_NUMBER_OF_AXES; i++) {
tmp = buff[2 * i] + (buff[2 * i + 1] << 8);
@@ -485,7 +485,7 @@ static msg_t gyro_read_raw(void *ip, int32_t axes[LSM6DSL_GYRO_NUMBER_OF_AXES])
}
return msg;
}
-
+
/**
* @brief Retrieves cooked data from the BaseGyroscope.
* @note This data is manipulated according to the formula
@@ -513,7 +513,7 @@ static msg_t gyro_read_cooked(void *ip, float axes[]) {
/* Getting parent instance pointer.*/
devp = objGetInstance(LSM6DSLDriver*, (BaseGyroscope*)ip);
-
+
osalDbgAssert((devp->state == LSM6DSL_READY),
"gyro_read_cooked(), invalid state");
@@ -547,7 +547,7 @@ static msg_t gyro_sample_bias(void *ip) {
/* Getting parent instance pointer.*/
devp = objGetInstance(LSM6DSLDriver*, (BaseGyroscope*)ip);
-
+
osalDbgAssert((devp->state == LSM6DSL_READY),
"gyro_sample_bias(), invalid state");
#if LSM6DSL_USE_I2C
@@ -575,7 +575,7 @@ static msg_t gyro_sample_bias(void *ip) {
/**
* @brief Set bias values for the BaseGyroscope.
* @note Bias must be expressed as DPS.
- * @note The bias buffer must be at least the same size of the BaseGyroscope
+ * @note The bias buffer must be at least the same size of the BaseGyroscope
* axes number.
*
* @param[in] ip pointer to @p BaseGyroscope interface.
@@ -588,15 +588,15 @@ static msg_t gyro_set_bias(void *ip, float *bp) {
LSM6DSLDriver* devp;
uint32_t i;
msg_t msg = MSG_OK;
-
+
osalDbgCheck((ip != NULL) && (bp != NULL));
-
+
/* Getting parent instance pointer.*/
devp = objGetInstance(LSM6DSLDriver*, (BaseGyroscope*)ip);
-
+
osalDbgAssert((devp->state == LSM6DSL_READY),
"gyro_set_bias(), invalid state");
-
+
for(i = 0; i < LSM6DSL_GYRO_NUMBER_OF_AXES; i++) {
devp->gyrobias[i] = bp[i];
}
@@ -619,10 +619,10 @@ static msg_t gyro_reset_bias(void *ip) {
msg_t msg = MSG_OK;
osalDbgCheck(ip != NULL);
-
+
/* Getting parent instance pointer.*/
devp = objGetInstance(LSM6DSLDriver*, (BaseGyroscope*)ip);
-
+
osalDbgAssert((devp->state == LSM6DSL_READY),
"gyro_reset_bias(), invalid state");
@@ -647,15 +647,15 @@ static msg_t gyro_set_sensivity(void *ip, float *sp) {
LSM6DSLDriver* devp;
uint32_t i;
msg_t msg = MSG_OK;
-
+
osalDbgCheck((ip != NULL) && (sp !=NULL));
/* Getting parent instance pointer.*/
devp = objGetInstance(LSM6DSLDriver*, (BaseGyroscope*)ip);
-
+
osalDbgAssert((devp->state == LSM6DSL_READY),
"gyro_set_sensivity(), invalid state");
-
+
for(i = 0; i < LSM6DSL_GYRO_NUMBER_OF_AXES; i++) {
devp->gyrosensitivity[i] = sp[i];
}
@@ -676,12 +676,12 @@ static msg_t gyro_reset_sensivity(void *ip) {
LSM6DSLDriver* devp;
uint32_t i;
msg_t msg = MSG_OK;
-
+
osalDbgCheck(ip != NULL);
/* Getting parent instance pointer.*/
devp = objGetInstance(LSM6DSLDriver*, (BaseGyroscope*)ip);
-
+
osalDbgAssert((devp->state == LSM6DSL_READY),
"gyro_reset_sensivity(), invalid state");
if(devp->config->gyrofullscale == LSM6DSL_GYRO_FS_125DPS)
@@ -761,7 +761,7 @@ static msg_t gyro_set_full_scale(LSM6DSLDriver *devp, lsm6dsl_gyro_fs_t fs) {
i2cAcquireBus(devp->config->i2cp);
i2cStart(devp->config->i2cp,
devp->config->i2ccfg);
-#endif /* LSM6DSL_SHARED_I2C */
+#endif /* LSM6DSL_SHARED_I2C */
/* Updating register.*/
msg = lsm6dslI2CReadRegister(devp->config->i2cp,
@@ -770,26 +770,26 @@ static msg_t gyro_set_full_scale(LSM6DSLDriver *devp, lsm6dsl_gyro_fs_t fs) {
#if LSM6DSL_SHARED_I2C
i2cReleaseBus(devp->config->i2cp);
-#endif /* LSM6DSL_SHARED_I2C */
+#endif /* LSM6DSL_SHARED_I2C */
#endif /* LSM6DSL_USE_I2C */
buff[1] &= ~(LSMDSL_CTRL2_G_FS_MASK);
buff[1] |= fs;
buff[0] = LSM6DSL_AD_CTRL2_G;
-
-#if LSM6DSL_USE_I2C
+
+#if LSM6DSL_USE_I2C
#if LSM6DSL_SHARED_I2C
i2cAcquireBus(devp->config->i2cp);
i2cStart(devp->config->i2cp,
devp->config->i2ccfg);
-#endif /* LSM6DSL_SHARED_I2C */
+#endif /* LSM6DSL_SHARED_I2C */
lsm6dslI2CWriteRegister(devp->config->i2cp, devp->config->slaveaddress,
buff, 1);
-
+
#if LSM6DSL_SHARED_I2C
i2cReleaseBus(devp->config->i2cp);
-#endif /* LSM6DSL_SHARED_I2C */
+#endif /* LSM6DSL_SHARED_I2C */
#endif /* LSM6DSL_USE_I2C */
/* Scaling sensitivity and bias. Re-calibration is suggested anyway. */
@@ -834,9 +834,9 @@ void lsm6dslObjectInit(LSM6DSLDriver *devp) {
devp->vmt = &vmt_device;
devp->acc_if.vmt = &vmt_accelerometer;
devp->gyro_if.vmt = &vmt_gyroscope;
-
+
devp->config = NULL;
-
+
devp->accaxes = LSM6DSL_ACC_NUMBER_OF_AXES;
devp->gyroaxes = LSM6DSL_GYRO_NUMBER_OF_AXES;
@@ -856,9 +856,9 @@ void lsm6dslStart(LSM6DSLDriver *devp, const LSM6DSLConfig *config) {
uint8_t cr[11];
osalDbgCheck((devp != NULL) && (config != NULL));
- osalDbgAssert((devp->state == LSM6DSL_STOP) ||
+ osalDbgAssert((devp->state == LSM6DSL_STOP) ||
(devp->state == LSM6DSL_READY),
- "lsm6dslStart(), invalid state");
+ "lsm6dslStart(), invalid state");
devp->config = config;
@@ -953,7 +953,7 @@ void lsm6dslStart(LSM6DSLDriver *devp, const LSM6DSLConfig *config) {
{
cr[10] = 0;
}
-
+
#if LSM6DSL_USE_I2C
#if LSM6DSL_SHARED_I2C
i2cAcquireBus(devp->config->i2cp);
@@ -1012,7 +1012,7 @@ void lsm6dslStart(LSM6DSLDriver *devp, const LSM6DSLConfig *config) {
if(devp->config->accbias != NULL)
for(i = 0; i < LSM6DSL_ACC_NUMBER_OF_AXES; i++)
devp->accbias[i] = devp->config->accbias[i];
- else
+ else
for(i = 0; i < LSM6DSL_ACC_NUMBER_OF_AXES; i++)
devp->accbias[i] = LSM6DSL_ACC_BIAS;
@@ -1068,15 +1068,15 @@ void lsm6dslStart(LSM6DSLDriver *devp, const LSM6DSLConfig *config) {
if(devp->config->gyrobias != NULL)
for(i = 0; i < LSM6DSL_GYRO_NUMBER_OF_AXES; i++)
devp->gyrobias[i] = devp->config->gyrobias[i];
- else
+ else
for(i = 0; i < LSM6DSL_GYRO_NUMBER_OF_AXES; i++)
devp->gyrobias[i] = LSM6DSL_GYRO_BIAS;
-
+
/* This is the MEMS transient recovery time */
osalThreadSleepMilliseconds(5);
devp->state = LSM6DSL_READY;
-}
+}
/**
* @brief Deactivates the LSM6DSL Complex Driver peripheral.
@@ -1099,7 +1099,7 @@ void lsm6dslStop(LSM6DSLDriver *devp) {
i2cAcquireBus(devp->config->i2cp);
i2cStart(devp->config->i2cp, devp->config->i2ccfg);
#endif /* LSM6DSL_SHARED_I2C */
-
+
cr[0] = LSM6DSL_AD_CTRL1_XL;
/* Disabling accelerometer.*/
@@ -1114,7 +1114,7 @@ void lsm6dslStop(LSM6DSLDriver *devp) {
i2cReleaseBus(devp->config->i2cp);
#endif /* LSM6DSL_SHARED_I2C */
#endif /* LSM6DSL_USE_I2C */
- }
+ }
devp->state = LSM6DSL_STOP;
}
/** @} */