File tree 4 files changed +12
-12
lines changed
perception/multi_object_tracker/src/tracker/model
4 files changed +12
-12
lines changed Original file line number Diff line number Diff line change @@ -127,9 +127,9 @@ BicycleTracker::BicycleTracker(
127
127
constexpr double p0_stddev_y = 0.5 ; // in object coordinate [m]
128
128
constexpr double p0_stddev_yaw =
129
129
tier4_autoware_utils::deg2rad (25 ); // in map coordinate [rad]
130
- constexpr double p0_cov_x = std::pow ( p0_stddev_x, 2.0 ) ;
131
- constexpr double p0_cov_y = std::pow ( p0_stddev_y, 2.0 ) ;
132
- constexpr double p0_cov_yaw = std::pow ( p0_stddev_yaw, 2.0 ) ;
130
+ constexpr double p0_cov_x = p0_stddev_x * p0_stddev_x ;
131
+ constexpr double p0_cov_y = p0_stddev_y * p0_stddev_y ;
132
+ constexpr double p0_cov_yaw = p0_stddev_yaw * p0_stddev_yaw ;
133
133
134
134
const double cos_yaw = std::cos (yaw);
135
135
const double sin_yaw = std::sin (yaw);
Original file line number Diff line number Diff line change @@ -147,9 +147,9 @@ BigVehicleTracker::BigVehicleTracker(
147
147
constexpr double p0_stddev_y = 0.5 ; // in object coordinate [m]
148
148
constexpr double p0_stddev_yaw =
149
149
tier4_autoware_utils::deg2rad (25 ); // in map coordinate [rad]
150
- constexpr double p0_cov_x = std::pow ( p0_stddev_x, 2.0 ) ;
151
- constexpr double p0_cov_y = std::pow ( p0_stddev_y, 2.0 ) ;
152
- constexpr double p0_cov_yaw = std::pow ( p0_stddev_yaw, 2.0 ) ;
150
+ constexpr double p0_cov_x = p0_stddev_x * p0_stddev_x ;
151
+ constexpr double p0_cov_y = p0_stddev_y * p0_stddev_y ;
152
+ constexpr double p0_cov_yaw = p0_stddev_yaw * p0_stddev_yaw ;
153
153
154
154
const double cos_yaw = std::cos (yaw);
155
155
const double sin_yaw = std::sin (yaw);
Original file line number Diff line number Diff line change @@ -148,9 +148,9 @@ NormalVehicleTracker::NormalVehicleTracker(
148
148
constexpr double p0_stddev_y = 0.3 ; // in object coordinate [m]
149
149
constexpr double p0_stddev_yaw =
150
150
tier4_autoware_utils::deg2rad (25 ); // in map coordinate [rad]
151
- constexpr double p0_cov_x = std::pow ( p0_stddev_x, 2.0 ) ;
152
- constexpr double p0_cov_y = std::pow ( p0_stddev_y, 2.0 ) ;
153
- constexpr double p0_cov_yaw = std::pow ( p0_stddev_yaw, 2.0 ) ;
151
+ constexpr double p0_cov_x = p0_stddev_x * p0_stddev_x ;
152
+ constexpr double p0_cov_y = p0_stddev_y * p0_stddev_y ;
153
+ constexpr double p0_cov_yaw = p0_stddev_yaw * p0_stddev_yaw ;
154
154
155
155
const double cos_yaw = std::cos (yaw);
156
156
const double sin_yaw = std::sin (yaw);
Original file line number Diff line number Diff line change @@ -122,9 +122,9 @@ PedestrianTracker::PedestrianTracker(
122
122
constexpr double p0_stddev_y = 2.0 ; // in object coordinate [m]
123
123
constexpr double p0_stddev_yaw =
124
124
tier4_autoware_utils::deg2rad (1000 ); // in map coordinate [rad]
125
- constexpr double p0_cov_x = std::pow ( p0_stddev_x, 2.0 ) ;
126
- constexpr double p0_cov_y = std::pow ( p0_stddev_y, 2.0 ) ;
127
- constexpr double p0_cov_yaw = std::pow ( p0_stddev_yaw, 2.0 ) ;
125
+ constexpr double p0_cov_x = p0_stddev_x * p0_stddev_x ;
126
+ constexpr double p0_cov_y = p0_stddev_y * p0_stddev_y ;
127
+ constexpr double p0_cov_yaw = p0_stddev_yaw * p0_stddev_yaw ;
128
128
129
129
const double cos_yaw = std::cos (yaw);
130
130
const double sin_yaw = std::sin (yaw);
You can’t perform that action at this time.
0 commit comments