#include <footcoords.h>
Public Types | |
typedef message_filters::sync_policies::ExactTime< nav_msgs::Odometry, sensor_msgs::Imu > | OdomImuSyncPolicy |
enum | OdomStatus { UNINITIALIZED, INITIALIZING, LLEG_SUPPORT, RLEG_SUPPORT } |
enum | SupportLegStatus { LLEG_GROUND, RLEG_GROUND, AIR, BOTH_GROUND } |
typedef message_filters::sync_policies::ExactTime< geometry_msgs::WrenchStamped, geometry_msgs::WrenchStamped, sensor_msgs::JointState, geometry_msgs::PointStamped > | SyncPolicy |
Public Member Functions | |
Footcoords () | |
virtual | ~Footcoords () |
Protected Member Functions | |
virtual bool | allValueLargerThan (TimeStampedVector< ValueStamped::Ptr > &values, double threshold) |
virtual bool | allValueSmallerThan (TimeStampedVector< ValueStamped::Ptr > &values, double threshold) |
virtual double | applyLowPassFilter (double current_val, double prev_val) const |
virtual bool | computeMidCoords (const ros::Time &stamp) |
virtual bool | computeMidCoordsFromSingleLeg (const ros::Time &stamp, bool use_left_leg) |
virtual void | computeVelicity (double dt, std::map< std::string, double > &joint_angles, KDL::Chain &chain, geometry_msgs::Twist &output) |
virtual void | estimateOdometry () |
virtual void | estimateOdometryMainSupportLeg () |
virtual void | estimateOdometryNaive () |
virtual void | estimateOdometryZMPSupportLeg () |
virtual void | estimateVelocity (const ros::Time &stamp, std::map< std::string, double > &joint_angles) |
virtual void | filter (const jsk_footstep_controller::SynchronizedForces::ConstPtr &msg) |
virtual void | floorCoeffsCallback (const pcl_msgs::ModelCoefficients &coeffs) |
virtual void | getRollPitch (const Eigen::Affine3d &pose, float &roll, float &pitch) |
virtual float | getYaw (const Eigen::Affine3d &pose) |
virtual void | odomImuCallback (const nav_msgs::Odometry::ConstPtr &odom_msg, const sensor_msgs::Imu::ConstPtr &imu_msg) |
virtual void | odomInitTriggerCallback (const std_msgs::Empty &trigger) |
virtual void | periodicTimerCallback (const ros::TimerEvent &event) |
virtual void | publishContactState (const ros::Time &stamp) |
virtual void | publishState (const std::string &state) |
virtual void | publishTF (const ros::Time &stamp) |
virtual bool | resolveForceTf (const geometry_msgs::WrenchStamped &lfoot, const geometry_msgs::WrenchStamped &rfoot, tf::Vector3 &lfoot_force, tf::Vector3 &rfoot_force) |
virtual void | synchronizeForces (const geometry_msgs::WrenchStamped::ConstPtr &lfoot, const geometry_msgs::WrenchStamped::ConstPtr &rfoot, const sensor_msgs::JointState::ConstPtr &joint_states, const geometry_msgs::PointStamped::ConstPtr &zmp) |
virtual void | updateChain (std::map< std::string, double > &joint_angles, KDL::Chain &chain, tf::Pose &output_pose) |
virtual bool | updateGroundTF () |
virtual void | updateLegDiagnostics (diagnostic_updater::DiagnosticStatusWrapper &stat) |
virtual void | updateRobotModel (std::map< std::string, double > &joint_angles) |
virtual bool | waitForEndEffectorTransformation (const ros::Time &stamp) |
virtual bool | waitForSensorFrameTransformation (const ros::Time &lstamp, const ros::Time &rstamp, const std::string &lsensor_frame, const std::string &rsensor_frame) |
Definition at line 129 of file footcoords.h.
typedef message_filters::sync_policies::ExactTime< nav_msgs::Odometry, sensor_msgs::Imu> jsk_footstep_controller::Footcoords::OdomImuSyncPolicy |
Definition at line 139 of file footcoords.h.
typedef message_filters::sync_policies::ExactTime< geometry_msgs::WrenchStamped, geometry_msgs::WrenchStamped, sensor_msgs::JointState, geometry_msgs::PointStamped> jsk_footstep_controller::Footcoords::SyncPolicy |
Definition at line 136 of file footcoords.h.
Enumerator | |
---|---|
UNINITIALIZED | |
INITIALIZING | |
LLEG_SUPPORT | |
RLEG_SUPPORT |
Definition at line 149 of file footcoords.h.
Enumerator | |
---|---|
LLEG_GROUND | |
RLEG_GROUND | |
AIR | |
BOTH_GROUND |
Definition at line 144 of file footcoords.h.
jsk_footstep_controller::Footcoords::Footcoords | ( | ) |
Definition at line 83 of file footcoords.cpp.
|
virtual |
Definition at line 183 of file footcoords.cpp.
|
protectedvirtual |
Definition at line 213 of file footcoords.cpp.
|
protectedvirtual |
Definition at line 224 of file footcoords.cpp.
|
protectedvirtual |
Definition at line 208 of file footcoords.cpp.
|
protectedvirtual |
Definition at line 838 of file footcoords.cpp.
|
protectedvirtual |
Definition at line 793 of file footcoords.cpp.
|
protectedvirtual |
Definition at line 395 of file footcoords.cpp.
|
protectedvirtual |
Definition at line 506 of file footcoords.cpp.
|
protectedvirtual |
Definition at line 574 of file footcoords.cpp.
|
protectedvirtual |
Definition at line 512 of file footcoords.cpp.
|
protectedvirtual |
Definition at line 653 of file footcoords.cpp.
|
protectedvirtual |
Definition at line 420 of file footcoords.cpp.
|
protectedvirtual |
Definition at line 437 of file footcoords.cpp.
|
protectedvirtual |
Definition at line 1083 of file footcoords.cpp.
|
protectedvirtual |
Definition at line 969 of file footcoords.cpp.
|
protectedvirtual |
Definition at line 977 of file footcoords.cpp.
|
protectedvirtual |
Definition at line 1115 of file footcoords.cpp.
|
protectedvirtual |
Definition at line 1053 of file footcoords.cpp.
|
protectedvirtual |
Definition at line 281 of file footcoords.cpp.
|
protectedvirtual |
Definition at line 741 of file footcoords.cpp.
|
protectedvirtual |
Definition at line 734 of file footcoords.cpp.
|
protectedvirtual |
Definition at line 986 of file footcoords.cpp.
|
protectedvirtual |
Definition at line 235 of file footcoords.cpp.
|
protectedvirtual |
Definition at line 330 of file footcoords.cpp.
|
protectedvirtual |
Definition at line 360 of file footcoords.cpp.
|
protectedvirtual |
Definition at line 938 of file footcoords.cpp.
|
protectedvirtual |
Definition at line 188 of file footcoords.cpp.
|
protectedvirtual |
Definition at line 383 of file footcoords.cpp.
|
protectedvirtual |
Definition at line 909 of file footcoords.cpp.
|
protectedvirtual |
Definition at line 886 of file footcoords.cpp.
|
protected |
Definition at line 276 of file footcoords.h.
|
protected |
Definition at line 256 of file footcoords.h.
|
protected |
Definition at line 266 of file footcoords.h.
|
protected |
Definition at line 273 of file footcoords.h.
|
protected |
Definition at line 234 of file footcoords.h.
|
protected |
Definition at line 227 of file footcoords.h.
|
protected |
Definition at line 226 of file footcoords.h.
|
protected |
Definition at line 255 of file footcoords.h.
|
protected |
Definition at line 269 of file footcoords.h.
|
protected |
Definition at line 218 of file footcoords.h.
|
protected |
Definition at line 268 of file footcoords.h.
|
protected |
Definition at line 260 of file footcoords.h.
|
protected |
Definition at line 228 of file footcoords.h.
|
protected |
Definition at line 261 of file footcoords.h.
|
protected |
Definition at line 230 of file footcoords.h.
|
protected |
Definition at line 263 of file footcoords.h.
|
protected |
Definition at line 232 of file footcoords.h.
|
protected |
Definition at line 272 of file footcoords.h.
|
protected |
Definition at line 270 of file footcoords.h.
|
protected |
Definition at line 251 of file footcoords.h.
|
protected |
Definition at line 211 of file footcoords.h.
|
protected |
Definition at line 219 of file footcoords.h.
|
protected |
Definition at line 267 of file footcoords.h.
|
protected |
Definition at line 213 of file footcoords.h.
|
protected |
Definition at line 215 of file footcoords.h.
|
protected |
Definition at line 212 of file footcoords.h.
|
protected |
Definition at line 253 of file footcoords.h.
|
protected |
Definition at line 217 of file footcoords.h.
|
protected |
Definition at line 249 of file footcoords.h.
|
protected |
Definition at line 250 of file footcoords.h.
|
protected |
Definition at line 214 of file footcoords.h.
|
protected |
Definition at line 257 of file footcoords.h.
|
protected |
Definition at line 274 of file footcoords.h.
|
protected |
Definition at line 275 of file footcoords.h.
|
protected |
Definition at line 236 of file footcoords.h.
|
protected |
Definition at line 239 of file footcoords.h.
|
protected |
Definition at line 240 of file footcoords.h.
|
protected |
Definition at line 241 of file footcoords.h.
|
protected |
Definition at line 237 of file footcoords.h.
|
protected |
Definition at line 244 of file footcoords.h.
|
protected |
Definition at line 243 of file footcoords.h.
|
protected |
Definition at line 235 of file footcoords.h.
|
protected |
Definition at line 238 of file footcoords.h.
|
protected |
Definition at line 242 of file footcoords.h.
|
protected |
Definition at line 278 of file footcoords.h.
|
protected |
Definition at line 229 of file footcoords.h.
|
protected |
Definition at line 262 of file footcoords.h.
|
protected |
Definition at line 231 of file footcoords.h.
|
protected |
Definition at line 264 of file footcoords.h.
|
protected |
Definition at line 233 of file footcoords.h.
|
protected |
Definition at line 265 of file footcoords.h.
|
protected |
Definition at line 271 of file footcoords.h.
|
protected |
Definition at line 277 of file footcoords.h.
|
protected |
Definition at line 223 of file footcoords.h.
|
protected |
Definition at line 221 of file footcoords.h.
|
protected |
Definition at line 222 of file footcoords.h.
|
protected |
Definition at line 224 of file footcoords.h.
|
protected |
Definition at line 252 of file footcoords.h.
|
protected |
Definition at line 225 of file footcoords.h.
|
protected |
Definition at line 220 of file footcoords.h.
|
protected |
Definition at line 246 of file footcoords.h.
|
protected |
Definition at line 245 of file footcoords.h.
|
protected |
Definition at line 258 of file footcoords.h.
|
protected |
Definition at line 259 of file footcoords.h.
|
protected |
Definition at line 254 of file footcoords.h.
|
protected |
Definition at line 248 of file footcoords.h.