Skip to content

Commit 6eeb1e8

Browse files
committed
fix linear acceleration scope bug
1 parent c17b251 commit 6eeb1e8

1 file changed

Lines changed: 4 additions & 5 deletions

File tree

  • src/software/embedded/services

src/software/embedded/services/imu.cpp

Lines changed: 4 additions & 5 deletions
Original file line numberDiff line numberDiff line change
@@ -134,11 +134,10 @@ std::optional<ImuData> ImuService::poll(){
134134
std::optional<AngularAcceleration> angular_acceleration = pollAngularAcceleration(angular_velocity);
135135
std::optional<Eigen::Vector2d> imu_linear_acceleration = pollLinearAcceleration();
136136

137-
if (angular_velocity.has_value() || angular_acceleration.has_value() || imu_linear_acceleration.has_value()){
138-
std::optional<Eigen::Vector2d> linear_acceleration = transformLinearAcceleration(angular_velocity.value(), angular_acceleration.value(), imu_linear_acceleration.value());
139-
}
140-
else{
141-
std::optional<Eigen::Vector2d> linear_acceleration = std::nullopt;
137+
std::optional<Eigen::Vector2d> linear_acceleration;
138+
if (angular_velocity && angular_acceleration && imu_linear_acceleration) {
139+
linear_acceleration = transformLinearAcceleration(
140+
*angular_velocity, *angular_acceleration, *imu_linear_acceleration);
142141
}
143142

144143

0 commit comments

Comments
 (0)