#include <velocity_smoother_nodelet.hpp>
Public Member Functions | |
| bool | init (ros::NodeHandle &nh) |
| void | shutdown () |
| void | spin () |
| VelocitySmoother (const std::string &name) | |
| ~VelocitySmoother () | |
Private Types | |
| enum | RobotFeedbackType { NONE, ODOMETRY, COMMANDS } |
Private Member Functions | |
| double | median (std::vector< double > values) |
| void | odometryCB (const nav_msgs::Odometry::ConstPtr &msg) |
| void | reconfigCB (yocs_velocity_smoother::paramsConfig &config, uint32_t unused_level) |
| void | robotVelCB (const geometry_msgs::Twist::ConstPtr &msg) |
| double | sign (double x) |
| void | velocityCB (const geometry_msgs::Twist::ConstPtr &msg) |
Private Attributes | |
| double | accel_lim_v |
| double | accel_lim_w |
| double | cb_avg_time |
| geometry_msgs::Twist | current_vel |
| ros::Subscriber | current_vel_sub |
| double | decel_factor |
| double | decel_lim_v |
| double | decel_lim_w |
| dynamic_reconfigure::Server < yocs_velocity_smoother::paramsConfig > ::CallbackType | dynamic_reconfigure_callback |
| dynamic_reconfigure::Server < yocs_velocity_smoother::paramsConfig > * | dynamic_reconfigure_server |
| double | frequency |
| bool | input_active |
| ros::Time | last_cb_time |
| geometry_msgs::Twist | last_cmd_vel |
| std::string | name |
| ros::Subscriber | odometry_sub |
| std::vector< double > | period_record |
| unsigned int | pr_next |
| ros::Subscriber | raw_in_vel_sub |
| enum yocs_velocity_smoother::VelocitySmoother::RobotFeedbackType | robot_feedback |
| bool | shutdown_req |
| ros::Publisher | smooth_vel_pub |
| double | speed_lim_v |
| double | speed_lim_w |
| geometry_msgs::Twist | target_vel |
Definition at line 33 of file velocity_smoother_nodelet.hpp.
enum yocs_velocity_smoother::VelocitySmoother::RobotFeedbackType [private] |
Definition at line 50 of file velocity_smoother_nodelet.hpp.
| yocs_velocity_smoother::VelocitySmoother::VelocitySmoother | ( | const std::string & | name | ) | [inline] |
Definition at line 36 of file velocity_smoother_nodelet.hpp.
Definition at line 39 of file velocity_smoother_nodelet.hpp.
Initialise from a nodelet's private nodehandle.
| nh | : private nodehandle |
Definition at line 239 of file velocity_smoother_nodelet.cpp.
| double yocs_velocity_smoother::VelocitySmoother::median | ( | std::vector< double > | values | ) | [inline, private] |
Definition at line 86 of file velocity_smoother_nodelet.hpp.
| void yocs_velocity_smoother::VelocitySmoother::odometryCB | ( | const nav_msgs::Odometry::ConstPtr & | msg | ) | [private] |
Definition at line 93 of file velocity_smoother_nodelet.cpp.
| void yocs_velocity_smoother::VelocitySmoother::reconfigCB | ( | yocs_velocity_smoother::paramsConfig & | config, |
| uint32_t | unused_level | ||
| ) | [private] |
Definition at line 42 of file velocity_smoother_nodelet.cpp.
| void yocs_velocity_smoother::VelocitySmoother::robotVelCB | ( | const geometry_msgs::Twist::ConstPtr & | msg | ) | [private] |
Definition at line 101 of file velocity_smoother_nodelet.cpp.
| void yocs_velocity_smoother::VelocitySmoother::shutdown | ( | ) | [inline] |
Definition at line 47 of file velocity_smoother_nodelet.hpp.
| double yocs_velocity_smoother::VelocitySmoother::sign | ( | double | x | ) | [inline, private] |
Definition at line 84 of file velocity_smoother_nodelet.hpp.
Definition at line 109 of file velocity_smoother_nodelet.cpp.
| void yocs_velocity_smoother::VelocitySmoother::velocityCB | ( | const geometry_msgs::Twist::ConstPtr & | msg | ) | [private] |
Definition at line 56 of file velocity_smoother_nodelet.cpp.
double yocs_velocity_smoother::VelocitySmoother::accel_lim_v [private] |
Definition at line 58 of file velocity_smoother_nodelet.hpp.
double yocs_velocity_smoother::VelocitySmoother::accel_lim_w [private] |
Definition at line 59 of file velocity_smoother_nodelet.hpp.
double yocs_velocity_smoother::VelocitySmoother::cb_avg_time [private] |
Definition at line 70 of file velocity_smoother_nodelet.hpp.
geometry_msgs::Twist yocs_velocity_smoother::VelocitySmoother::current_vel [private] |
Definition at line 65 of file velocity_smoother_nodelet.hpp.
Current velocity from commands sent to the robot, not necessarily by this node
Definition at line 76 of file velocity_smoother_nodelet.hpp.
double yocs_velocity_smoother::VelocitySmoother::decel_factor [private] |
Definition at line 60 of file velocity_smoother_nodelet.hpp.
double yocs_velocity_smoother::VelocitySmoother::decel_lim_v [private] |
Definition at line 58 of file velocity_smoother_nodelet.hpp.
double yocs_velocity_smoother::VelocitySmoother::decel_lim_w [private] |
Definition at line 59 of file velocity_smoother_nodelet.hpp.
dynamic_reconfigure::Server<yocs_velocity_smoother::paramsConfig>::CallbackType yocs_velocity_smoother::VelocitySmoother::dynamic_reconfigure_callback [private] |
Definition at line 96 of file velocity_smoother_nodelet.hpp.
dynamic_reconfigure::Server<yocs_velocity_smoother::paramsConfig>* yocs_velocity_smoother::VelocitySmoother::dynamic_reconfigure_server [private] |
Definition at line 90 of file velocity_smoother_nodelet.hpp.
double yocs_velocity_smoother::VelocitySmoother::frequency [private] |
Definition at line 62 of file velocity_smoother_nodelet.hpp.
bool yocs_velocity_smoother::VelocitySmoother::input_active [private] |
Definition at line 69 of file velocity_smoother_nodelet.hpp.
Definition at line 71 of file velocity_smoother_nodelet.hpp.
geometry_msgs::Twist yocs_velocity_smoother::VelocitySmoother::last_cmd_vel [private] |
Definition at line 64 of file velocity_smoother_nodelet.hpp.
std::string yocs_velocity_smoother::VelocitySmoother::name [private] |
Definition at line 57 of file velocity_smoother_nodelet.hpp.
Current velocity from odometry
Definition at line 75 of file velocity_smoother_nodelet.hpp.
std::vector<double> yocs_velocity_smoother::VelocitySmoother::period_record [private] |
Historic of latest periods between velocity commands
Definition at line 72 of file velocity_smoother_nodelet.hpp.
unsigned int yocs_velocity_smoother::VelocitySmoother::pr_next [private] |
Next position to fill in the periods record buffer
Definition at line 73 of file velocity_smoother_nodelet.hpp.
Incoming raw velocity commands
Definition at line 77 of file velocity_smoother_nodelet.hpp.
enum yocs_velocity_smoother::VelocitySmoother::RobotFeedbackType yocs_velocity_smoother::VelocitySmoother::robot_feedback [private] |
What source to use as robot velocity feedback
bool yocs_velocity_smoother::VelocitySmoother::shutdown_req [private] |
Shutdown requested by nodelet; kill worker thread
Definition at line 68 of file velocity_smoother_nodelet.hpp.
Outgoing smoothed velocity commands
Definition at line 78 of file velocity_smoother_nodelet.hpp.
double yocs_velocity_smoother::VelocitySmoother::speed_lim_v [private] |
Definition at line 58 of file velocity_smoother_nodelet.hpp.
double yocs_velocity_smoother::VelocitySmoother::speed_lim_w [private] |
Definition at line 59 of file velocity_smoother_nodelet.hpp.
geometry_msgs::Twist yocs_velocity_smoother::VelocitySmoother::target_vel [private] |
Definition at line 66 of file velocity_smoother_nodelet.hpp.