@@ -209,8 +209,9 @@ void PoseWithCovarianceHistory::update_shapes()
209209 lines_->setColor (color_line.r , color_line.g , color_line.b , color_line.a );
210210
211211 while (spheres_.size () < history_.size ()) {
212- spheres_.emplace_back (std::make_unique<rviz_rendering::Shape>(
213- rviz_rendering::Shape::Sphere, scene_manager_, scene_node_));
212+ spheres_.emplace_back (
213+ std::make_unique<rviz_rendering::Shape>(
214+ rviz_rendering::Shape::Sphere, scene_manager_, scene_node_));
214215 }
215216 while (arrows_.size () < history_.size ()) {
216217 arrows_.emplace_back (std::make_unique<rviz_rendering::Arrow>(scene_manager_, scene_node_));
@@ -260,13 +261,14 @@ void PoseWithCovarianceHistory::update_shapes()
260261 sphere->setPosition (position);
261262 sphere->setOrientation (orientation);
262263 sphere->setColor (color_sphere.r , color_sphere.g , color_sphere.b , color_sphere.a );
263- sphere->setScale (Ogre::Vector3 (
264- static_cast <float >(
265- property_sphere_scale_->getFloat () * 2 * std::sqrt (covariance_3d_base_link (0 , 0 ))),
266- static_cast <float >(
267- property_sphere_scale_->getFloat () * 2 * std::sqrt (covariance_3d_base_link (1 , 1 ))),
268- static_cast <float >(
269- property_sphere_scale_->getFloat () * 2 * std::sqrt (covariance_3d_base_link (2 , 2 )))));
264+ sphere->setScale (
265+ Ogre::Vector3 (
266+ static_cast <float >(
267+ property_sphere_scale_->getFloat () * 2 * std::sqrt (covariance_3d_base_link (0 , 0 ))),
268+ static_cast <float >(
269+ property_sphere_scale_->getFloat () * 2 * std::sqrt (covariance_3d_base_link (1 , 1 ))),
270+ static_cast <float >(
271+ property_sphere_scale_->getFloat () * 2 * std::sqrt (covariance_3d_base_link (2 , 2 )))));
270272 }
271273
272274 if (property_path_view_->getBool ()) {
0 commit comments