robot_state.cpp
Go to the documentation of this file.
1 
18 #include "model/robot_state.hpp"
19 
20 namespace directSearchWS {
21 
22 
23 RobotState::RobotState(PosePtr robotPosePtr, PtuTuplePtrVecPtr ptuTuplePtrVecPtr):
24  robotPosePtr(robotPosePtr), ptuTuplePtrVecPtr(ptuTuplePtrVecPtr){
25 }
26 
27 //Getter
29  return robotPosePtr;
30 }
31 
33  return ptuTuplePtrVecPtr->front();
34 }
35 
37  return ptuTuplePtrVecPtr;
38 }
39 
41  ptuTuplePtrVecPtr->erase(ptuTuplePtrVecPtr->begin());
42 }
43 
45  return ptuTuplePtrVecPtr->size();
46 }
47 
48 
49 std::ostream& operator<<(std::ostream &strm, const RobotState &robot_state) {
50  strm << "RobotPose:\n" << robot_state.getRobotPosePtr();
51  strm << "PtuTuples:\n" << robot_state.getPtuTuplePtrVecPtr();
52  return strm;
53 }
54 
55 std::ostream& operator<<(std::ostream &strm, const RobotStatePtr &robot_state_ptr) {
56  return strm << *robot_state_ptr;
57 }
58 
59 std::ostream& operator<<(std::ostream &strm, const RobotStatePtrVec &robot_state_ptr_vec) {
60  for (const RobotStatePtr &robot_state_ptr : robot_state_ptr_vec) {
61  strm << robot_state_ptr;
62  }
63  return strm;
64 }
65 
66 std::ostream& operator<<(std::ostream &strm, const RobotStatePtrVecPtr &robot_state_ptr_vec_ptr) {
67  return strm << *robot_state_ptr_vec_ptr;
68 }
69 
70 }
PtuTuplePtr getTopPtuTuplePtr() const
Definition: robot_state.cpp:32
std::ostream & operator<<(std::ostream &strm, const SearchedObjectTypes &already_searched_object_types)
Definition: ptu_tuple.cpp:88
PosePtr getRobotPosePtr() const
Definition: robot_state.cpp:28
PtuTuplePtrVecPtr ptuTuplePtrVecPtr
Definition: robot_state.hpp:32
std::vector< RobotStatePtr > RobotStatePtrVec
Definition: robot_state.hpp:51
RobotState(PosePtr robotPosePtr, PtuTuplePtrVecPtr ptuTuplePtrVecPtr)
Definition: robot_state.cpp:23
PtuTuplePtrVecPtr getPtuTuplePtrVecPtr() const
Definition: robot_state.cpp:36


asr_direct_search_manager
Author(s): Borella Jocelyn, Karrenbauer Oliver, Mei├čner Pascal
autogenerated on Wed Jan 8 2020 03:15:41