Add a Bounding Box to an Actor on Gazebo [closed]

asked 2021-04-01 13:13:10 -0500

bach gravatar image

updated 2021-04-02 02:06:29 -0500


I'm working with AutonomousActorPlugin to create a natural human simulation. I'm trying to modify the HandleObstacles function in order to use the bounding box to detect possible collitions in place of the distance. This is my function now:

    void AutoActorPlugin::HandleObstacles(ignition::math::Vector3d &_pos)
  for (unsigned int i = 0; i < this->world->ModelCount(); ++i)
    physics::ModelPtr model = this->world->ModelByIndex(i);
    if (std::find(this->ignoreModels.begin(), this->ignoreModels.end(),
                  model->GetName()) == this->ignoreModels.end())

      ignition::math::Vector3d offset = model->WorldPose().Pos() -
      double modelDist = offset.Length();

#ifdef DEBUG_
      // For debug
      gzdbg << "....................OBSTACLE HANDLING................." << std::endl;
      gzdbg << "OBSTACLE: " << model->BoundingBox() << std::endl;
          gzdbg << "HUMAN BOX: " << this->actor->BoundingBox() << std::endl;
          gzdbg << "......................................................" << std::endl;

          if (model->BoundingBox().Intersects(this->actor->BoundingBox()))
#ifdef DEBUG_

        // For debug
        gzdbg << "!!!!! POSSIBLE COLLISION DETECTED  !!!!!!!" << std::endl;
        double invModelDist = this->obstacleWeight / modelDist;
        offset *= invModelDist;
        _pos -= offset;

The problem is that the bounding box attached to the actor is no sense:

[Dbg] [] HUMAN BOX: Min[3.40282e+38 3.40282e+38 3.40282e+38] Max[0 0 0]

In Gazebo GUI it seems very different (if I interpret correctly the with box aroud the man)

image description

Is it possible to change the bounding box? How?

I tried also to use a collision bounding box, by attaching it to the actor using this. It works because I can see the Collision Box in orange on the Gazebo GUI, but when I try to call the function CollisionBoundingBox() in place of CollisionBoundingBox(), I get a segmentation fault.

image description

Can someone help me with some advices? Thanks a lot.

edit retag flag offensive reopen merge delete

Closed for the following reason Gazebo Question: The Gazebo community prefers to answer questions at: by gvdhoorn
close date 2021-04-01 13:39:39.661316


As you are working on a Gazebo plugin, you should ask this question on, not here.

If/when you post there, please post a comment here with a link to your new post, so we keep things connected.

gvdhoorn gravatar image gvdhoorn  ( 2021-04-01 13:40:38 -0500 )edit
bach gravatar image bach  ( 2021-04-02 02:06:34 -0500 )edit