fly316/PX4-Autopilot
7
0
Fork 0
mirror of https://gitee.com/mirrors_PX4/PX4-Autopilot.git synced 2026-04-14 10:07:39 +08:00
Code Issues Packages Projects Releases Wiki Activity

drivers: up_udelay -> px4_usleep

Browse Source
This commit is contained in:
rfu 2020-03-31 15:16:32 +02:00 committed by Beat Küng
parent 8787780de4
commit adb032d2e5
4 changed files with 12 additions and 8 deletions
Show Stats Download Patch File Download Diff File Expand all files Collapse all files

4
src/drivers/imu/bmi088/BMI088_accel.cpp
View File

@ -120,7 +120,7 @@ int BMI088_accel::reset()
* Setting it to 5ms.
*/
up_udelay(5000);
px4_usleep(5000);
// Perform a dummy read here to put the accelerometer part of the BMI088 back into SPI mode after the reset
// The dummy read basically pulls the chip select line low and then high
@ -134,7 +134,7 @@ int BMI088_accel::reset()
* Any communication with the sensor during this time should be avoided
* (see section "Power Modes: Acceleromter" in the BMI datasheet) */
up_udelay(5000);
px4_usleep(5000);
// Set the PWR CONF to be active
write_checked_reg(BMI088_ACC_PWR_CONF, BMI088_ACC_PWR_CONF_ACTIVE); // Sets the accelerometer to active mode

3
src/drivers/imu/bmi088/BMI088_gyro.cpp
View File

@ -104,7 +104,8 @@ int BMI088_gyro::reset()
//Enable Gyroscope in normal mode
write_reg(BMI088_GYR_LPM1, BMI088_GYRO_NORMAL);
up_udelay(1000);
px4_usleep(1000);
uint8_t retries = 10;

3
src/drivers/imu/icm20948/ICM20948_mag.cpp
View File

@ -311,7 +311,8 @@ ICM20948_mag::ak09916_setup(void)
retries--;
PX4_WARN("AK09916: bad id %d retries %d", id, retries);
_parent->modify_reg(ICMREG_20948_USER_CTRL, 0, BIT_I2C_MST_RST);
up_udelay(100);
px4_usleep(100) ;
} while (retries > 0);
if (retries == 0) {

10
src/drivers/magnetometer/bmm150/bmm150.cpp
View File

@ -96,8 +96,8 @@ int BMM150::init()
/* Bring the device to sleep mode */
modify_reg(BMM150_POWER_CTRL_REG, 1, 1);
up_udelay(10000);
px4_usleep(10000);
/* check id*/
if (read_reg(BMM150_CHIP_ID_REG) != BMM150_CHIP_ID) {
@ -115,7 +115,7 @@ int BMM150::init()
return -EIO;
}
up_udelay(10000);
px4_usleep(10000);
if (collect()) {
return -EIO;
@ -342,11 +342,13 @@ int BMM150::reset()
/* Soft-reset */
modify_reg(BMM150_POWER_CTRL_REG, BMM150_SOFT_RESET_MASK, BMM150_SOFT_RESET_VALUE);
up_udelay(5000);
px4_usleep(5000);
/* Enable Magnetometer in normal mode */
ret += set_power_mode(BMM150_DEFAULT_POWER_MODE);
up_udelay(1000);
px4_usleep(1000);
/* Set the data rate to default */
ret += set_data_rate(BMM150_DEFAULT_ODR);