hpp-core
4.10.1
Implement basic classes for canonical path planning for kinematic chains.
|
Go to the documentation of this file.
19 #ifndef HPP_CORE_CONTINUOUS_VALIDATION_HH
20 # define HPP_CORE_CONTINUOUS_VALIDATION_HH
22 # include <hpp/pinocchio/pool.hh>
33 using continuousValidation::IntervalValidation;
103 virtual void doExecute()
const;
137 virtual bool validate (
const PathPtr_t& path,
bool reverse,
151 virtual void removeObstacleFromJoint
164 virtual void setSecurityMargins(
const matrix_t& securityMatrix);
186 template <
class Delegate>
void add(
const Delegate& delegate);
190 template <
class Delegate>
void reset();
194 void addIntervalValidation
233 virtual bool validateConfiguration
252 bool validateIntervals
255 typename IntervalValidations_t::iterator& smallestInterval,
256 pinocchio::DeviceData& data)
258 typename IntervalValidations_t::iterator itMin = validations.begin();
259 for (IntervalValidations_t::iterator itVal (validations.begin());
260 itVal != validations.end(); ++itVal)
266 if (!(*itVal)->validateConfiguration(t, tmpInt, report, data))
269 pathReport->configurationReport = report;
270 pathReport->parameter = t;
275 if (interval.second > tmpInt.second)
278 smallestInterval = itVal;
280 interval.first = std::max(interval.first, tmpInt.first);
281 interval.second = std::min(interval.second, tmpInt.second);
282 assert((*itVal)->path()->length() == 0 || interval.second > interval.first);
283 assert(interval.first <= t);
284 assert(t <= interval.second);
294 void init (ContinuousValidationWkPtr_t weak);
306 ContinuousValidationWkPtr_t weak_;
308 virtual bool validateStraightPath
313 std::vector<Initialize> initialize_;
314 std::vector<AddObstacle> addObstacle_;
318 void ContinuousValidation::add<ContinuousValidation::AddObstacle>
322 void ContinuousValidation::reset<ContinuousValidation::AddObstacle>();
325 void ContinuousValidation::add<ContinuousValidation::Initialize>
329 void ContinuousValidation::reset<ContinuousValidation::Initialize>();
332 (
const Delegate& delegate)
335 "No delegate of this type in class ContinuousValidation.");
340 "No delegate of this type in class ContinuousValidation.");
345 #endif // HPP_CORE_CONTINUOUS_VALIDATION_HH
DevicePtr_t robot_
Definition: continuous-validation.hh:290
ContinuousValidation * owner_
Definition: continuous-validation.hh:107
pinocchio::Configuration_t Configuration_t
Definition: fwd.hh:96
value_type tolerance() const
Get tolerance value.
Definition: continuous-validation.hh:197
pinocchio::JointPtr_t JointPtr_t
Definition: fwd.hh:133
std::pair< value_type, value_type > interval_t
Definition: fwd.hh:158
IntervalValidations_t intervalValidations_
All BodyPairValidation to validate.
Definition: continuous-validation.hh:297
ContinuousValidation & owner() const
Definition: continuous-validation.hh:104
Definition: continuous-validation.hh:94
Definition: continuous-validation.hh:86
void add(const Delegate &delegate)
Definition: continuous-validation.hh:332
continuousValidation::IntervalValidations_t IntervalValidations_t
Definition: continuous-validation.hh:212
boost::shared_ptr< IntervalValidation > IntervalValidationPtr_t
Definition: fwd.hh:242
value_type tolerance_
Definition: continuous-validation.hh:291
Definition: path-validation.hh:35
pinocchio::Pool< IntervalValidations_t > bodyPairCollisionPool_
Definition: continuous-validation.hh:301
ContinuousValidation * owner_
Definition: continuous-validation.hh:124
ContinuousValidation & owner() const
Definition: continuous-validation.hh:121
void reset()
Definition: continuous-validation.hh:337
virtual ~Initialize()
Definition: continuous-validation.hh:105
Definition: obstacle-user.hh:35
pinocchio::DeviceWkPtr_t DeviceWkPtr_t
Definition: fwd.hh:115
DevicePtr_t robot() const
Definition: continuous-validation.hh:202
std::vector< IntervalValidationPtr_t > IntervalValidations_t
Definition: fwd.hh:243
pinocchio::CollisionObjectConstPtr_t CollisionObjectConstPtr_t
Definition: fwd.hh:90
Definition: basic-configuration-shooter.hh:26
boost::shared_ptr< ValidationReport > ValidationReportPtr_t
Definition: fwd.hh:206
DeviceWkPtr_t robot_
Definition: continuous-validation.hh:125
Eigen::Matrix< RelativeMotionType, Eigen::Dynamic, Eigen::Dynamic > matrix_type
Definition: relative-motion.hh:51
virtual ~AddObstacle()
Definition: continuous-validation.hh:122
IntervalValidations_t disabledBodyPairCollisions_
BodyPairCollision for which collision is disabled.
Definition: continuous-validation.hh:299
pinocchio::matrix_t matrix_t
Definition: fwd.hh:145
pinocchio::DevicePtr_t DevicePtr_t
Definition: fwd.hh:114
Definition: path-validation-report.hh:34
Definition: continuous-validation.hh:112
boost::shared_ptr< PathValidationReport > PathValidationReportPtr_t
Definition: fwd.hh:298
value_type stepSize_
Definition: continuous-validation.hh:303
pinocchio::value_type value_type
Definition: fwd.hh:157
#define HPP_CORE_DLLAPI
Definition: config.hh:64
boost::shared_ptr< Path > PathPtr_t
Definition: fwd.hh:170