template<typename T>
class delphyne::RightOfWaySystem< T >
RightOfWaySystem evaluates the current RightOfWayRule state that applies to the agent's location.
It acts interfering the target velocity that is expected to be injected to the speed controller.
- The velocity output is zero when the rule indicates to stop.
- The velocity output pass through the input velocity when the rule indicates to go.
Assumptions: 1) Only "Stop" and "Go" states are targeted.
Input Port 0: a LaneDirection representing the requested lane and direction of travel. (InputPort getter: lane_state_input())
Input Port 1: A PoseVector for the ego car. (InputPort getter: pose_input())
Input Port 2: The target velocity to be injected to the plant. (InputPort getter: velocity_input())
Output Port 0: Filtered velocity that could be either zero or velocity_input depending on the state of the right-of-way rule. (OutputPort getter: velocity_output())