ARGoS  3
A parallel, multi-engine simulator for swarm robotics
pointmass3d_box_model.cpp
Go to the documentation of this file.
1 
8 #include <argos3/core/utility/logging/argos_log.h>
9 #include <argos3/core/utility/math/box.h>
10 #include <argos3/core/simulator/simulator.h>
11 #include <argos3/core/simulator/space/space.h>
12 #include <argos3/plugins/simulator/physics_engines/pointmass3d/pointmass3d_engine.h>
13 
14 namespace argos {
15 
17  CBoxEntity& c_box) :
18  CPointMass3DModel(c_engine, c_box.GetEmbodiedEntity()),
19  m_cBoxEntity(c_box) {}
20 
21  /****************************************/
22  /****************************************/
23 
25  CVector3 cHalfSize = 0.5f * m_cBoxEntity.GetSize();
27  GetEmbodiedEntity().GetOriginAnchor().Position.GetX() - cHalfSize.GetX(),
28  GetEmbodiedEntity().GetOriginAnchor().Position.GetY() - cHalfSize.GetY(),
29  GetEmbodiedEntity().GetOriginAnchor().Position.GetZ());
31  GetEmbodiedEntity().GetOriginAnchor().Position.GetX() + cHalfSize.GetX(),
32  GetEmbodiedEntity().GetOriginAnchor().Position.GetY() + cHalfSize.GetY(),
33  GetEmbodiedEntity().GetOriginAnchor().Position.GetZ() + m_cBoxEntity.GetSize().GetZ());
34  }
35 
36  /****************************************/
37  /****************************************/
38 
40  const CRay3& c_ray) const {
41  CBox m_cShape(m_cBoxEntity.GetSize(),
42  GetEmbodiedEntity().GetOriginAnchor().Position,
43  GetEmbodiedEntity().GetOriginAnchor().Orientation);
44  return m_cShape.Intersects(f_t_on_ray, c_ray);
45  }
46 
47  /****************************************/
48  /****************************************/
49 
51 
52  /****************************************/
53  /****************************************/
54 
55 }
argos::CVector3::Set
void Set(const Real f_x, const Real f_y, const Real f_z)
Sets the vector contents from Cartesian coordinates.
Definition: vector3.h:143
argos::CVector3::GetZ
Real GetZ() const
Returns the z coordinate of this vector.
Definition: vector3.h:125
argos
The namespace containing all the ARGoS related code.
Definition: ci_actuator.h:12
argos::CVector3
A 3D vector class.
Definition: vector3.h:29
argos::SBoundingBox::MinCorner
CVector3 MinCorner
Definition: physics_model.h:88
argos::SBoundingBox::MaxCorner
CVector3 MaxCorner
Definition: physics_model.h:89
argos::CRay3
Definition: ray3.h:19
argos::CBoxEntity
Definition: box_entity.h:20
argos::CBox
Definition: box.h:20
argos::CPointMass3DModel
Definition: pointmass3d_model.h:21
argos::CVector3::GetX
Real GetX() const
Returns the x coordinate of this vector.
Definition: vector3.h:93
argos::CPointMass3DBoxModel::CPointMass3DBoxModel
CPointMass3DBoxModel(CPointMass3DEngine &c_engine, CBoxEntity &c_box)
Definition: pointmass3d_box_model.cpp:16
argos::CPhysicsModel::GetBoundingBox
const SBoundingBox & GetBoundingBox() const
Returns an axis-aligned box that contains the physics model.
Definition: physics_model.h:198
argos::CPointMass3DBoxModel::CalculateBoundingBox
virtual void CalculateBoundingBox()
Calculates the axis-aligned box that contains the entire physics model.
Definition: pointmass3d_box_model.cpp:24
argos::CPointMass3DBoxModel
Definition: pointmass3d_box_model.h:22
argos::CPointMass3DBoxModel::CheckIntersectionWithRay
virtual bool CheckIntersectionWithRay(Real &f_t_on_ray, const CRay3 &c_ray) const
Definition: pointmass3d_box_model.cpp:39
argos::CVector3::GetY
Real GetY() const
Returns the y coordinate of this vector.
Definition: vector3.h:109
argos::CBoxEntity::GetSize
const CVector3 & GetSize() const
Definition: box_entity.h:80
argos::CPointMass3DEngine
Definition: pointmass3d_engine.h:22
argos::CBox::Intersects
bool Intersects(Real &f_t_on_ray, const CRay3 &c_ray)
Definition: box.cpp:9
Real
float Real
Collects all ARGoS code.
Definition: datatypes.h:39
argos::REGISTER_STANDARD_POINTMASS3D_OPERATIONS_ON_ENTITY
REGISTER_STANDARD_POINTMASS3D_OPERATIONS_ON_ENTITY(CEyeBotEntity, CPointMass3DEyeBotModel)
pointmass3d_box_model.h
argos::CPhysicsModel::GetEmbodiedEntity
CEmbodiedEntity & GetEmbodiedEntity()
Returns the embodied entity associated to this physics model.
Definition: physics_model.h:133