#include <ego_entity.hpp>

Inheritance diagram for traffic_simulator::entity::EgoEntity:

Collaboration diagram for traffic_simulator::entity::EgoEntity:

Public Member Functions
	EgoEntity ()=delete

	EgoEntity (const std::string &name, const CanonicalizedEntityStatus &, const std::shared_ptr< hdmap_utils::HdMapUtils > &, const traffic_simulator_msgs::msg::VehicleParameters &, const Configuration &, const rclcpp::node_interfaces::NodeParametersInterface::SharedPtr &)

	EgoEntity (EgoEntity &&)=delete

	EgoEntity (const EgoEntity &)=delete

	~EgoEntity () override=default

auto	operator= (EgoEntity &&) -> EgoEntity &=delete

auto	operator= (const EgoEntity &) -> EgoEntity &=delete

auto	asFieldOperatorApplication () const -> concealer::FieldOperatorApplication &override

auto	getCurrentAction () const -> std::string override

auto	getCurrentPose () const -> geometry_msgs::msg::Pose

auto	getDefaultDynamicConstraints () const -> const traffic_simulator_msgs::msg::DynamicConstraints &override

auto	getBehaviorParameter () const -> traffic_simulator_msgs::msg::BehaviorParameter override

auto	getEntityStatus (const double, const double) const -> const CanonicalizedEntityStatus

auto	getEntityType () const -> const traffic_simulator_msgs::msg::EntityType &override

auto	getEntityTypename () const -> const std::string &override

auto	getObstacle () -> std::optional< traffic_simulator_msgs::msg::Obstacle > override

auto	getRouteLanelets (double horizon=100) -> lanelet::Ids override

auto	getWaypoints () -> const traffic_simulator_msgs::msg::WaypointsArray override

void	onUpdate (double current_time, double step_time) override

void	requestAcquirePosition (const CanonicalizedLaneletPose &) override

void	requestAcquirePosition (const geometry_msgs::msg::Pose &map_pose) override

void	requestAssignRoute (const std::vector< CanonicalizedLaneletPose > &) override

void	requestAssignRoute (const std::vector< geometry_msgs::msg::Pose > &) override

auto	requestFollowTrajectory (const std::shared_ptr< traffic_simulator_msgs::msg::PolylineTrajectory > &) -> void override

void	requestLaneChange (const lanelet::Id) override

auto	requestLaneChange (const traffic_simulator::lane_change::Parameter &) -> void override

auto	requestSpeedChange (const double, const speed_change::Transition, const speed_change::Constraint, const bool continuous) -> void override

auto	requestSpeedChange (const speed_change::RelativeTargetSpeed &, const speed_change::Transition, const speed_change::Constraint, const bool continuous) -> void override

void	requestClearRoute () override

auto	isControlledBySimulator () const -> bool override

auto	setControlledBySimulator (bool state) -> void override

auto	setBehaviorParameter (const traffic_simulator_msgs::msg::BehaviorParameter &) -> void override

void	requestSpeedChange (double, bool continuous) override

void	requestSpeedChange (const speed_change::RelativeTargetSpeed &target_speed, bool continuous) override

auto	setVelocityLimit (double) -> void override

auto	setMapPose (const geometry_msgs::msg::Pose &map_pose) -> void override

auto	fillLaneletPose (CanonicalizedEntityStatus &status) -> void override

Public Member Functions inherited from traffic_simulator::entity::VehicleEntity
	VehicleEntity (const std::string &name, const CanonicalizedEntityStatus &, const std::shared_ptr< hdmap_utils::HdMapUtils > &, const traffic_simulator_msgs::msg::VehicleParameters &, const std::string &plugin_name=BuiltinBehavior::defaultBehavior())

	~VehicleEntity () override=default

void	appendDebugMarker (visualization_msgs::msg::MarkerArray &marker_array) override

void	cancelRequest () override

auto	getCurrentAction () const -> std::string override

auto	getDefaultDynamicConstraints () const -> const traffic_simulator_msgs::msg::DynamicConstraints &override

auto	getDefaultMatchingDistanceForLaneletPoseCalculation () const -> double override

auto	getBehaviorParameter () const -> traffic_simulator_msgs::msg::BehaviorParameter override

auto	getMaxAcceleration () const -> double override

auto	getMaxDeceleration () const -> double override

auto	getEntityType () const -> const traffic_simulator_msgs::msg::EntityType &override

auto	getEntityTypename () const -> const std::string &override

auto	getGoalPoses () -> std::vector< CanonicalizedLaneletPose > override

auto	getObstacle () -> std::optional< traffic_simulator_msgs::msg::Obstacle > override

auto	getRouteLanelets (double horizon=100) -> lanelet::Ids override

auto	getWaypoints () -> const traffic_simulator_msgs::msg::WaypointsArray override

void	onUpdate (double current_time, double step_time) override

void	requestAcquirePosition (const CanonicalizedLaneletPose &)

void	requestAcquirePosition (const geometry_msgs::msg::Pose &map_pose) override

void	requestAssignRoute (const std::vector< geometry_msgs::msg::Pose > &) override

void	requestAssignRoute (const std::vector< CanonicalizedLaneletPose > &) override

auto	requestFollowTrajectory (const std::shared_ptr< traffic_simulator_msgs::msg::PolylineTrajectory > &) -> void override

void	requestLaneChange (const lanelet::Id to_lanelet_id) override

void	requestLaneChange (const traffic_simulator::lane_change::Parameter &) override

void	setVelocityLimit (double linear_velocity) override

void	setAccelerationLimit (double acceleration) override

void	setAccelerationRateLimit (double acceleration_rate) override

void	setDecelerationLimit (double deceleration) override

void	setDecelerationRateLimit (double deceleration_rate) override

void	setBehaviorParameter (const traffic_simulator_msgs::msg::BehaviorParameter &) override

void	setTrafficLightManager (const std::shared_ptr< traffic_simulator::TrafficLightManager > &) override

auto	fillLaneletPose (CanonicalizedEntityStatus &status) -> void override

Public Member Functions inherited from traffic_simulator::entity::EntityBase
	EntityBase (const std::string &name, const CanonicalizedEntityStatus &, const std::shared_ptr< hdmap_utils::HdMapUtils > &)

virtual	~EntityBase ()=default

auto	getBoundingBox () const noexcept -> traffic_simulator_msgs::msg::BoundingBox
	Get BoundingBox of the entity. More...

auto	getCurrentAccel () const noexcept -> geometry_msgs::msg::Accel
	Get CurrentAccel of the entity. More...

auto	getCurrentTwist () const noexcept -> geometry_msgs::msg::Twist
	Get CurrentTwist of the entity. More...

auto	getDynamicConstraints () const noexcept -> traffic_simulator_msgs::msg::DynamicConstraints
	Get DynamicConstraints of the entity. More...

auto	getEntityStatusBeforeUpdate () const noexcept -> const CanonicalizedEntityStatus &
	Get EntityStatusBeforeUpdate of the entity. More...

auto	getEntitySubtype () const noexcept -> traffic_simulator_msgs::msg::EntitySubtype
	Get EntitySubtype of the entity. More...

auto	getLinearJerk () const noexcept -> double
	Get LinearJerk of the entity. More...

auto	getMapPose () const noexcept -> geometry_msgs::msg::Pose
	Get MapPose of the entity. More...

auto	getStandStillDuration () const noexcept -> double
	Get StandStillDuration of the entity. More...

auto	getStatus () const noexcept -> const CanonicalizedEntityStatus &
	Get Status of the entity. More...

auto	getTraveledDistance () const noexcept -> double
	Get TraveledDistance of the entity. More...

auto	isNpcLogicStarted () const -> bool

auto	laneMatchingSucceed () const -> bool

auto	get2DPolygon () const -> std::vector< geometry_msgs::msg::Point >

auto	getLaneletPose () const -> std::optional< CanonicalizedLaneletPose >

auto	getLaneletPose (double matching_distance) const -> std::optional< CanonicalizedLaneletPose >

auto	getMapPoseFromRelativePose (const geometry_msgs::msg::Pose &) const -> geometry_msgs::msg::Pose

virtual void	onPostUpdate (double current_time, double step_time)

void	resetDynamicConstraints ()

void	requestLaneChange (const lane_change::AbsoluteTarget &, const lane_change::TrajectoryShape, const lane_change::Constraint &)

void	requestLaneChange (const lane_change::RelativeTarget &, const lane_change::TrajectoryShape, const lane_change::Constraint &)

virtual void	requestWalkStraight ()

void	setDynamicConstraints (const traffic_simulator_msgs::msg::DynamicConstraints &)

void	setOtherStatus (const std::unordered_map< std::string, CanonicalizedEntityStatus > &)

virtual auto	setStatus (const CanonicalizedEntityStatus &) -> void

virtual auto	setLinearAcceleration (const double linear_acceleration) -> void

virtual auto	setLinearVelocity (const double linear_velocity) -> void

virtual auto	activateOutOfRangeJob (double min_velocity, double max_velocity, double min_acceleration, double max_acceleration, double min_jerk, double max_jerk) -> void

auto	setTwist (const geometry_msgs::msg::Twist &twist) -> void

auto	setAcceleration (const geometry_msgs::msg::Accel &accel) -> void

auto	setLinearJerk (const double liner_jerk) -> void

virtual void	startNpcLogic (const double current_time)

void	stopAtCurrentPosition ()

void	updateEntityStatusTimestamp (const double current_time)

auto	updateStandStillDuration (const double step_time) -> double

auto	updateTraveledDistance (const double step_time) -> double

bool	reachPosition (const geometry_msgs::msg::Pose &target_pose, const double tolerance) const

bool	reachPosition (const CanonicalizedLaneletPose &lanelet_pose, const double tolerance) const

bool	reachPosition (const std::string &target_name, const double tolerance) const

auto	requestSynchronize (const std::string &target_name, const CanonicalizedLaneletPose &target_sync_pose, const CanonicalizedLaneletPose &entity_target, const double target_speed, const double tolerance) -> bool

virtual auto	fillLaneletPose (CanonicalizedEntityStatus &status, bool include_crosswalk) -> void final

Additional Inherited Members
Public Attributes inherited from traffic_simulator::entity::VehicleEntity
const traffic_simulator_msgs::msg::VehicleParameters	vehicle_parameters

Public Attributes inherited from traffic_simulator::entity::EntityBase
const std::string	name

bool	verbose

Protected Attributes inherited from traffic_simulator::entity::EntityBase
CanonicalizedEntityStatus	status_

CanonicalizedEntityStatus	status_before_update_

std::shared_ptr< hdmap_utils::HdMapUtils >	hdmap_utils_ptr_

std::shared_ptr< traffic_simulator::TrafficLightManager >	traffic_light_manager_

bool	npc_logic_started_ = false

double	stand_still_duration_ = 0.0

double	traveled_distance_ = 0.0

double	prev_job_duration_ = 0.0

double	step_time_ = 0.0

std::unordered_map< std::string, CanonicalizedEntityStatus >	other_status_

std::optional< double >	target_speed_

traffic_simulator::job::JobList	job_list_

std::unique_ptr< traffic_simulator::longitudinal_speed_planning::LongitudinalSpeedPlanner >	speed_planner_

Constructor & Destructor Documentation

◆ EgoEntity() [1/4]

traffic_simulator::entity::EgoEntity::EgoEntity ( )

explicitdelete

◆ EgoEntity() [2/4]

traffic_simulator::entity::EgoEntity::EgoEntity	(	const std::string &	name,
		const CanonicalizedEntityStatus &	entity_status,
		const std::shared_ptr< hdmap_utils::HdMapUtils > &	hdmap_utils_ptr,
		const traffic_simulator_msgs::msg::VehicleParameters &	parameters,
		const Configuration &	configuration,
		const rclcpp::node_interfaces::NodeParametersInterface::SharedPtr &	node_parameters
	)

explicit

◆ EgoEntity() [3/4]

traffic_simulator::entity::EgoEntity::EgoEntity ( EgoEntity && )

explicitdelete

◆ EgoEntity() [4/4]

traffic_simulator::entity::EgoEntity::EgoEntity ( const EgoEntity & )

explicitdelete

◆ ~EgoEntity()

traffic_simulator::entity::EgoEntity::~EgoEntity ( )

overridedefault

Member Function Documentation

◆ asFieldOperatorApplication()

auto traffic_simulator::entity::EgoEntity::asFieldOperatorApplication ( ) const -> concealer::FieldOperatorApplication &

overridevirtual

Reimplemented from traffic_simulator::entity::EntityBase.

◆ fillLaneletPose()

auto traffic_simulator::entity::EgoEntity::fillLaneletPose ( CanonicalizedEntityStatus & status ) -> void

overridevirtual

Implements traffic_simulator::entity::EntityBase.

◆ getBehaviorParameter()

auto traffic_simulator::entity::EgoEntity::getBehaviorParameter ( ) const -> traffic_simulator_msgs::msg::BehaviorParameter

overridevirtual

TODO, Input values get from autoware.

Implements traffic_simulator::entity::EntityBase.

◆ getCurrentAction()

auto traffic_simulator::entity::EgoEntity::getCurrentAction ( ) const -> std::string

overridevirtual

Implements traffic_simulator::entity::EntityBase.

◆ getCurrentPose()

auto traffic_simulator::entity::EgoEntity::getCurrentPose ( ) const -> geometry_msgs::msg::Pose

◆ getDefaultDynamicConstraints()

auto traffic_simulator::entity::EgoEntity::getDefaultDynamicConstraints ( ) const -> const traffic_simulator_msgs::msg::DynamicConstraints &

overridevirtual

Implements traffic_simulator::entity::EntityBase.

◆ getEntityStatus()

auto traffic_simulator::entity::EgoEntity::getEntityStatus	(	const double	,
		const double
	)		const -> const CanonicalizedEntityStatus

◆ getEntityType()

auto traffic_simulator::entity::EgoEntity::getEntityType ( ) const -> const traffic_simulator_msgs::msg::EntityType &

overridevirtual

Implements traffic_simulator::entity::EntityBase.

◆ getEntityTypename()

auto traffic_simulator::entity::EgoEntity::getEntityTypename ( ) const -> const std::string &

overridevirtual

Implements traffic_simulator::entity::EntityBase.

◆ getObstacle()

auto traffic_simulator::entity::EgoEntity::getObstacle ( ) -> std::optional<traffic_simulator_msgs::msg::Obstacle>

overridevirtual

Implements traffic_simulator::entity::EntityBase.

◆ getRouteLanelets()

auto traffic_simulator::entity::EgoEntity::getRouteLanelets ( double horizon = 100 ) -> lanelet::Ids

overridevirtual

Implements traffic_simulator::entity::EntityBase.

◆ getWaypoints()

auto traffic_simulator::entity::EgoEntity::getWaypoints ( ) -> const traffic_simulator_msgs::msg::WaypointsArray

overridevirtual

Implements traffic_simulator::entity::EntityBase.

◆ isControlledBySimulator()

auto traffic_simulator::entity::EgoEntity::isControlledBySimulator ( ) const -> bool

overridevirtual

Reimplemented from traffic_simulator::entity::EntityBase.

◆ onUpdate()

void traffic_simulator::entity::EgoEntity::onUpdate	(	double	current_time,
		double	step_time
	)

overridevirtual

Reimplemented from traffic_simulator::entity::EntityBase.

◆ operator=() [1/2]

auto traffic_simulator::entity::EgoEntity::operator= ( const EgoEntity & ) -> EgoEntity &=delete

delete

◆ operator=() [2/2]

auto traffic_simulator::entity::EgoEntity::operator= ( EgoEntity && ) -> EgoEntity &=delete

delete

◆ requestAcquirePosition() [1/2]

void traffic_simulator::entity::EgoEntity::requestAcquirePosition ( const CanonicalizedLaneletPose & lanelet_pose )

overridevirtual

Implements traffic_simulator::entity::EntityBase.

◆ requestAcquirePosition() [2/2]

void traffic_simulator::entity::EgoEntity::requestAcquirePosition ( const geometry_msgs::msg::Pose & map_pose )

overridevirtual

Implements traffic_simulator::entity::EntityBase.

◆ requestAssignRoute() [1/2]

void traffic_simulator::entity::EgoEntity::requestAssignRoute ( const std::vector< CanonicalizedLaneletPose > & waypoints )

overridevirtual

Implements traffic_simulator::entity::EntityBase.

◆ requestAssignRoute() [2/2]

void traffic_simulator::entity::EgoEntity::requestAssignRoute ( const std::vector< geometry_msgs::msg::Pose > & waypoints )

overridevirtual

Implements traffic_simulator::entity::EntityBase.

◆ requestClearRoute()

void traffic_simulator::entity::EgoEntity::requestClearRoute ( )

overridevirtual

Reimplemented from traffic_simulator::entity::EntityBase.

◆ requestFollowTrajectory()

auto traffic_simulator::entity::EgoEntity::requestFollowTrajectory ( const std::shared_ptr< traffic_simulator_msgs::msg::PolylineTrajectory > & parameter ) -> void

overridevirtual

Reimplemented from traffic_simulator::entity::EntityBase.

◆ requestLaneChange() [1/2]

void traffic_simulator::entity::EgoEntity::requestLaneChange ( const lanelet::Id )

overridevirtual

Reimplemented from traffic_simulator::entity::EntityBase.

◆ requestLaneChange() [2/2]

auto traffic_simulator::entity::EgoEntity::requestLaneChange ( const traffic_simulator::lane_change::Parameter & ) -> void

overridevirtual

Reimplemented from traffic_simulator::entity::EntityBase.

◆ requestSpeedChange() [1/4]

auto traffic_simulator::entity::EgoEntity::requestSpeedChange	(	const double	target_speed,
		const speed_change::Transition	,
		const speed_change::Constraint	,
		const bool	continuous
	)		-> void

overridevirtual

Reimplemented from traffic_simulator::entity::EntityBase.

◆ requestSpeedChange() [2/4]

auto traffic_simulator::entity::EgoEntity::requestSpeedChange	(	const speed_change::RelativeTargetSpeed &	,
		const speed_change::Transition	,
		const speed_change::Constraint	,
		const bool	continuous
	)		-> void

overridevirtual

Reimplemented from traffic_simulator::entity::EntityBase.

◆ requestSpeedChange() [3/4]

void traffic_simulator::entity::EgoEntity::requestSpeedChange	(	const speed_change::RelativeTargetSpeed &	target_speed,
		bool	continuous
	)

overridevirtual

Reimplemented from traffic_simulator::entity::EntityBase.

◆ requestSpeedChange() [4/4]

void traffic_simulator::entity::EgoEntity::requestSpeedChange	(	double	value,
		bool	continuous
	)

overridevirtual

Reimplemented from traffic_simulator::entity::EntityBase.

◆ setBehaviorParameter()

auto traffic_simulator::entity::EgoEntity::setBehaviorParameter ( const traffic_simulator_msgs::msg::BehaviorParameter & behavior_parameter ) -> void

overridevirtual

Implements traffic_simulator::entity::EntityBase.

◆ setControlledBySimulator()

auto traffic_simulator::entity::EgoEntity::setControlledBySimulator ( bool state ) -> void

inlineoverridevirtual

Reimplemented from traffic_simulator::entity::EntityBase.

◆ setMapPose()

auto traffic_simulator::entity::EgoEntity::setMapPose ( const geometry_msgs::msg::Pose & map_pose ) -> void

overridevirtual

Reimplemented from traffic_simulator::entity::EntityBase.

◆ setVelocityLimit()

auto traffic_simulator::entity::EgoEntity::setVelocityLimit ( double value ) -> void

overridevirtual

Implements traffic_simulator::entity::EntityBase.

The documentation for this class was generated from the following files:

simulation/traffic_simulator/include/traffic_simulator/entity/ego_entity.hpp
simulation/traffic_simulator/src/entity/ego_entity.cpp

Public Member Functions

Additional Inherited Members

Constructor & Destructor Documentation

◆ EgoEntity() [1/4]

◆ EgoEntity() [2/4]

◆ EgoEntity() [3/4]

◆ EgoEntity() [4/4]

◆ ~EgoEntity()

Member Function Documentation

◆ asFieldOperatorApplication()

◆ fillLaneletPose()

◆ getBehaviorParameter()

◆ getCurrentAction()

◆ getCurrentPose()

◆ getDefaultDynamicConstraints()

◆ getEntityStatus()

◆ getEntityType()

◆ getEntityTypename()

◆ getObstacle()

◆ getRouteLanelets()

◆ getWaypoints()

◆ isControlledBySimulator()

◆ onUpdate()

◆ operator=() [1/2]

◆ operator=() [2/2]

◆ requestAcquirePosition() [1/2]

◆ requestAcquirePosition() [2/2]

◆ requestAssignRoute() [1/2]

◆ requestAssignRoute() [2/2]

◆ requestClearRoute()

◆ requestFollowTrajectory()

◆ requestLaneChange() [1/2]

◆ requestLaneChange() [2/2]

◆ requestSpeedChange() [1/4]

◆ requestSpeedChange() [2/4]

◆ requestSpeedChange() [3/4]

◆ requestSpeedChange() [4/4]

◆ setBehaviorParameter()

◆ setControlledBySimulator()

◆ setMapPose()

◆ setVelocityLimit()