JointTrajectoryAdmittanceController Class
Declaration
class moveit_pro_controllers::JointTrajectoryAdmittanceController { ... }
#include <joint_trajectory_admittance_controller.hpp>
Base classes
Public Member Typedefs Index
Private Member Typedefs Index
Enumerations Index
Public Constructors Index
Public Member Functions Index
Private Member Functions Index
| void | initializePublisher () |
|
|
|
| rclcpp_action::GoalResponse | goal_received_callback (const rclcpp_action::GoalUUID &uuid, std::shared_ptr< const FollowJointTrajectory::Goal > goal) const |
|
|
|
| void | goal_accepted_callback (ActionGoalHandlePtr goal_handle) |
|
|
|
| rclcpp_action::CancelResponse | goal_cancelled_callback (const ActionGoalHandlePtr goal_handle) const |
|
|
|
| void | publish_state (const TimedJointState &state_desired, const TimedJointState &state_current, const TimedJointState &state_error) |
|
|
|
| bool | handleStopIfNecessary (RealtimeGoalHandlePtr active_goal_handle, const rclcpp::Time &time, const rclcpp::Duration &period) |
|
|
|
| void | applyAdmittanceIfConfigured (const RealtimeGoalHandlePtr &active_goal_handle, const std::shared_ptr< JointTrajectoryAdmittanceControllerCommand > &active_command, const TimedJointState &state_desired, const rclcpp::Time &time, const rclcpp::Duration &period) |
|
|
|
| void | publishFilteredWrench (size_t sensor_index, const rclcpp::Time &time) |
|
|
|
| void | updateTares () |
|
|
|
| void | resetTares () |
|
|
|
| void | removeActiveCommand () |
|
|
|
| bool | initTrajectorySamplerOrAbort (const RealtimeGoalHandlePtr &active_goal_handle, const std::shared_ptr< JointTrajectoryAdmittanceControllerCommand > &active_command) |
|
|
|
| bool | forwardKinematics (const Eigen::VectorNd &reference_joint_values, const Eigen::VectorNd ¤t_joint_values, AdmittanceState &state) |
|
|
|
| bool | differentialForwardKinematics (const Eigen::VectorNd &joint_values, const Eigen::VectorNd &joint_delta, std::vector< Eigen::Vector6d > &cartesian_deltas) |
|
|
|
| bool | differentialInverseKinematics (const Eigen::VectorNd &joint_values, const std::vector< Eigen::Vector6d > &cartesian_deltas, Eigen::VectorNd &joint_deltas) |
|
|
|
| double | firstOrderLagFilter (const double filter_input, double time_step_seconds) |
|
|
|
Private Member Attributes Index
Definition at line 87 of file joint_trajectory_admittance_controller.hpp.
Public Member Typedefs
JointTrajectoryPoint
| using moveit_pro_controllers::JointTrajectoryAdmittanceController::JointTrajectoryPoint = trajectory_msgs::msg::JointTrajectoryPoint |
|
Private Member Typedefs
ActionGoalHandlePtr
| using moveit_pro_controllers::JointTrajectoryAdmittanceController::ActionGoalHandlePtr = std::shared_ptr<rclcpp_action::ServerGoalHandle<FollowJointTrajectory> > |
|
FollowJointTrajectory
| using moveit_pro_controllers::JointTrajectoryAdmittanceController::FollowJointTrajectory = moveit_pro_controllers_msgs::action::FollowJointTrajectoryWithAdmittance |
|
RealtimeGoalHandle
| using moveit_pro_controllers::JointTrajectoryAdmittanceController::RealtimeGoalHandle = realtime_tools::RealtimeServerGoalHandle<FollowJointTrajectory> |
|
RealtimeGoalHandleBuffer
| using moveit_pro_controllers::JointTrajectoryAdmittanceController::RealtimeGoalHandleBuffer = realtime_tools::RealtimeBuffer<RealtimeGoalHandlePtr> |
|
RealtimeGoalHandlePtr
| using moveit_pro_controllers::JointTrajectoryAdmittanceController::RealtimeGoalHandlePtr = std::shared_ptr<RealtimeGoalHandle> |
|
RTWrenchPublisher
| using moveit_pro_controllers::JointTrajectoryAdmittanceController::RTWrenchPublisher = realtime_tools::RealtimePublisher<WrenchMsg> |
|
StatePublisher
| using moveit_pro_controllers::JointTrajectoryAdmittanceController::StatePublisher = realtime_tools::RealtimePublisher<ControllerStateMsg> |
|
StatePublisherPtr
| using moveit_pro_controllers::JointTrajectoryAdmittanceController::StatePublisherPtr = std::unique_ptr<StatePublisher> |
|
WrenchMsg
| using moveit_pro_controllers::JointTrajectoryAdmittanceController::WrenchMsg = geometry_msgs::msg::WrenchStamped |
|
Enumerations
State
| enum class moveit_pro_controllers::JointTrajectoryAdmittanceController::State |
|
strong
|
Public Constructors
JointTrajectoryAdmittanceController()
| moveit_pro_controllers::JointTrajectoryAdmittanceController::JointTrajectoryAdmittanceController () |
|
Public Member Functions
command_interface_configuration()
| controller_interface::InterfaceConfiguration moveit_pro_controllers::JointTrajectoryAdmittanceController::command_interface_configuration () |
|
getParams()
| joint_trajectory_admittance_controller::Params & moveit_pro_controllers::JointTrajectoryAdmittanceController::getParams () |
|
inline
|
getStateError()
| const trajectory_msgs::msg::JointTrajectoryPoint & moveit_pro_controllers::JointTrajectoryAdmittanceController::getStateError () |
|
getStateFeedback()
| const trajectory_msgs::msg::JointTrajectoryPoint & moveit_pro_controllers::JointTrajectoryAdmittanceController::getStateFeedback () |
|
getStateReference()
| const trajectory_msgs::msg::JointTrajectoryPoint & moveit_pro_controllers::JointTrajectoryAdmittanceController::getStateReference () |
|
getTipJointMap()
| const path_ik::TipJointMap & moveit_pro_controllers::JointTrajectoryAdmittanceController::getTipJointMap () |
|
on_activate()
| CallbackReturn moveit_pro_controllers::JointTrajectoryAdmittanceController::on_activate (const rclcpp_lifecycle::State & previous_state) |
|
on_configure()
| CallbackReturn moveit_pro_controllers::JointTrajectoryAdmittanceController::on_configure (const rclcpp_lifecycle::State & previous_state) |
|
on_deactivate()
| CallbackReturn moveit_pro_controllers::JointTrajectoryAdmittanceController::on_deactivate (const rclcpp_lifecycle::State & previous_state) |
|
on_init()
| CallbackReturn moveit_pro_controllers::JointTrajectoryAdmittanceController::on_init () |
|
state_interface_configuration()
| controller_interface::InterfaceConfiguration moveit_pro_controllers::JointTrajectoryAdmittanceController::state_interface_configuration () |
|
update()
| controller_interface::return_type moveit_pro_controllers::JointTrajectoryAdmittanceController::update (const rclcpp::Time & time, const rclcpp::Duration & period) |
|
Private Member Functions
applyAdmittanceIfConfigured()
| void moveit_pro_controllers::JointTrajectoryAdmittanceController::applyAdmittanceIfConfigured (const RealtimeGoalHandlePtr & active_goal_handle, const std::shared_ptr< JointTrajectoryAdmittanceControllerCommand > & active_command, const TimedJointState & state_desired, const rclcpp::Time & time, const rclcpp::Duration & period) |
|
differentialForwardKinematics()
| bool moveit_pro_controllers::JointTrajectoryAdmittanceController::differentialForwardKinematics (const Eigen::VectorNd & joint_values, const Eigen::VectorNd & joint_delta, std::vector< Eigen::Vector6d > & cartesian_deltas) |
|
differentialInverseKinematics()
| bool moveit_pro_controllers::JointTrajectoryAdmittanceController::differentialInverseKinematics (const Eigen::VectorNd & joint_values, const std::vector< Eigen::Vector6d > & cartesian_deltas, Eigen::VectorNd & joint_deltas) |
|
firstOrderLagFilter()
| double moveit_pro_controllers::JointTrajectoryAdmittanceController::firstOrderLagFilter (const double filter_input, double time_step_seconds) |
|
forwardKinematics()
| bool moveit_pro_controllers::JointTrajectoryAdmittanceController::forwardKinematics (const Eigen::VectorNd & reference_joint_values, const Eigen::VectorNd & current_joint_values, AdmittanceState & state) |
|
goal_accepted_callback()
| void moveit_pro_controllers::JointTrajectoryAdmittanceController::goal_accepted_callback (ActionGoalHandlePtr goal_handle) |
|
goal_cancelled_callback()
| rclcpp_action::CancelResponse moveit_pro_controllers::JointTrajectoryAdmittanceController::goal_cancelled_callback (const ActionGoalHandlePtr goal_handle) |
|
goal_received_callback()
| rclcpp_action::GoalResponse moveit_pro_controllers::JointTrajectoryAdmittanceController::goal_received_callback (const rclcpp_action::GoalUUID & uuid, std::shared_ptr< const FollowJointTrajectory::Goal > goal) |
|
handleStopIfNecessary()
| bool moveit_pro_controllers::JointTrajectoryAdmittanceController::handleStopIfNecessary (RealtimeGoalHandlePtr active_goal_handle, const rclcpp::Time & time, const rclcpp::Duration & period) |
|
initializePublisher()
| void moveit_pro_controllers::JointTrajectoryAdmittanceController::initializePublisher () |
|
initTrajectorySamplerOrAbort()
| bool moveit_pro_controllers::JointTrajectoryAdmittanceController::initTrajectorySamplerOrAbort (const RealtimeGoalHandlePtr & active_goal_handle, const std::shared_ptr< JointTrajectoryAdmittanceControllerCommand > & active_command) |
|
publish_state()
| void moveit_pro_controllers::JointTrajectoryAdmittanceController::publish_state (const TimedJointState & state_desired, const TimedJointState & state_current, const TimedJointState & state_error) |
|
publishFilteredWrench()
| void moveit_pro_controllers::JointTrajectoryAdmittanceController::publishFilteredWrench (size_t sensor_index, const rclcpp::Time & time) |
|
removeActiveCommand()
| void moveit_pro_controllers::JointTrajectoryAdmittanceController::removeActiveCommand () |
|
resetTares()
| void moveit_pro_controllers::JointTrajectoryAdmittanceController::resetTares () |
|
updateTares()
| void moveit_pro_controllers::JointTrajectoryAdmittanceController::updateTares () |
|
Private Member Attributes
acceleration_limits_
| Eigen::VectorNd moveit_pro_controllers::JointTrajectoryAdmittanceController::acceleration_limits_ |
|
action_server_
| rclcpp_action::Server<FollowJointTrajectory>::SharedPtr moveit_pro_controllers::JointTrajectoryAdmittanceController::action_server_ |
|
admittance_output_state_
| TimedJointState moveit_pro_controllers::JointTrajectoryAdmittanceController::admittance_output_state_ |
|
cached_lifecycle_id_
| std::atomic<uint8_t> moveit_pro_controllers::JointTrajectoryAdmittanceController::cached_lifecycle_id_ = lifecycle_msgs::msg::State::PRIMARY_STATE_UNKNOWN |
|
controller_state_publisher_
| rclcpp::Publisher<ControllerStateMsg>::SharedPtr moveit_pro_controllers::JointTrajectoryAdmittanceController::controller_state_publisher_ |
|
filtered_wrenches_
| std::vector<Eigen::Vector6d> moveit_pro_controllers::JointTrajectoryAdmittanceController::filtered_wrenches_ |
|
folag_max_change_rate_
| double moveit_pro_controllers::JointTrajectoryAdmittanceController::folag_max_change_rate_ = 180.0 |
|
folag_state_
| double moveit_pro_controllers::JointTrajectoryAdmittanceController::folag_state_ = 100.0 |
|
folag_tau_
| double moveit_pro_controllers::JointTrajectoryAdmittanceController::folag_tau_ = 0.2 |
|
force_torque_sensors_
| std::vector<std::unique_ptr<semantic_components::ForceTorqueSensor> > moveit_pro_controllers::JointTrajectoryAdmittanceController::force_torque_sensors_ |
|
ft_filters_
| std::vector<std::unique_ptr<SecondOrderButterworthFilter> > moveit_pro_controllers::JointTrajectoryAdmittanceController::ft_filters_ |
|
goal_monitor_timer_
| std::shared_ptr<rclcpp::TimerBase> moveit_pro_controllers::JointTrajectoryAdmittanceController::goal_monitor_timer_ |
|
goal_state_
| realtime_tools::RealtimeBuffer<State> moveit_pro_controllers::JointTrajectoryAdmittanceController::goal_state_ |
|
joint_command_interfaces_
| InterfaceReferences<hardware_interface::LoanedCommandInterface> moveit_pro_controllers::JointTrajectoryAdmittanceController::joint_command_interfaces_ |
|
joint_state_interfaces_
| InterfaceReferences<hardware_interface::LoanedStateInterface> moveit_pro_controllers::JointTrajectoryAdmittanceController::joint_state_interfaces_ |
|
last_commanded_state_
| TimedJointState moveit_pro_controllers::JointTrajectoryAdmittanceController::last_commanded_state_ |
|
last_state_publish_time_
| rclcpp::Time moveit_pro_controllers::JointTrajectoryAdmittanceController::last_state_publish_time_ |
|
param_listener_
| std::shared_ptr<joint_trajectory_admittance_controller::ParamListener> moveit_pro_controllers::JointTrajectoryAdmittanceController::param_listener_ |
|
params_
| joint_trajectory_admittance_controller::Params moveit_pro_controllers::JointTrajectoryAdmittanceController::params_ |
|
robot_description_
| std::string moveit_pro_controllers::JointTrajectoryAdmittanceController::robot_description_ |
|
robot_description_mutex_
| std::mutex moveit_pro_controllers::JointTrajectoryAdmittanceController::robot_description_mutex_ |
|
robot_description_subscription_
| rclcpp::Subscription<std_msgs::msg::String>::SharedPtr moveit_pro_controllers::JointTrajectoryAdmittanceController::robot_description_subscription_ |
|
rt_active_command_
| realtime_tools::RealtimeBuffer<std::shared_ptr<JointTrajectoryAdmittanceControllerCommand> > moveit_pro_controllers::JointTrajectoryAdmittanceController::rt_active_command_ |
|
rt_active_goal_handle_
| realtime_tools::RealtimeBuffer<RealtimeGoalHandlePtr> moveit_pro_controllers::JointTrajectoryAdmittanceController::rt_active_goal_handle_ |
|
rt_admittance_
| realtime_tools::RealtimeBuffer<std::shared_ptr<Admittance> > moveit_pro_controllers::JointTrajectoryAdmittanceController::rt_admittance_ |
|
rt_controller_state_publisher_
| StatePublisherPtr moveit_pro_controllers::JointTrajectoryAdmittanceController::rt_controller_state_publisher_ |
|
rt_has_pending_goal_
| realtime_tools::RealtimeBuffer<bool> moveit_pro_controllers::JointTrajectoryAdmittanceController::rt_has_pending_goal_ |
|
rt_trajectory_sampler_
| std::optional<TrajectorySampler> moveit_pro_controllers::JointTrajectoryAdmittanceController::rt_trajectory_sampler_ |
|
rt_wrench_publishers_
| std::vector<std::unique_ptr<RTWrenchPublisher> > moveit_pro_controllers::JointTrajectoryAdmittanceController::rt_wrench_publishers_ |
|
scaled_time_
| rclcpp::Time moveit_pro_controllers::JointTrajectoryAdmittanceController::scaled_time_ |
|
start_time_
| moveit_pro_controllers::Time moveit_pro_controllers::JointTrajectoryAdmittanceController::start_time_ |
|
stop_requested_time_
| rclcpp::Time moveit_pro_controllers::JointTrajectoryAdmittanceController::stop_requested_time_ |
|
stop_trajectory_
| StopTrajectory moveit_pro_controllers::JointTrajectoryAdmittanceController::stop_trajectory_ |
|
tare_accumulators_
| std::vector<WrenchTareAccumulator> moveit_pro_controllers::JointTrajectoryAdmittanceController::tare_accumulators_ |
|
tare_services_
| std::vector<std::unique_ptr<RealtimeTriggerServiceMonitor> > moveit_pro_controllers::JointTrajectoryAdmittanceController::tare_services_ |
|
tip_joint_map_
| path_ik::TipJointMap moveit_pro_controllers::JointTrajectoryAdmittanceController::tip_joint_map_ |
|
tip_offsets_
| std::vector<Eigen::Vector3d> moveit_pro_controllers::JointTrajectoryAdmittanceController::tip_offsets_ |
|
trajectory_updated_
| std::atomic<bool> moveit_pro_controllers::JointTrajectoryAdmittanceController::trajectory_updated_ { false } |
|
utilized_command_interfaces_
| UtilizedInterfaces moveit_pro_controllers::JointTrajectoryAdmittanceController::utilized_command_interfaces_ |
|
utilized_state_interfaces_
| UtilizedInterfaces moveit_pro_controllers::JointTrajectoryAdmittanceController::utilized_state_interfaces_ |
|
wrench_publishers_
| std::vector<rclcpp::Publisher<WrenchMsg>::SharedPtr> moveit_pro_controllers::JointTrajectoryAdmittanceController::wrench_publishers_ |
|
The documentation for this class was generated from the following files:
Generated via doxygen2docusaurus 2.2.2 by Doxygen 1.9.8.