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
214 static void setPath(IntervalValidations_t& intervalValidations,
233 virtual bool validateConfiguration
234 (IntervalValidations_t& intervalValidations,
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
309 (IntervalValidations_t& intervalValidations,
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 value_type tolerance() const
Get tolerance value.
Definition: continuous-validation.hh:197
boost::shared_ptr< Path > PathPtr_t
Definition: fwd.hh:170
IntervalValidations_t intervalValidations_
All BodyPairValidation to validate.
Definition: continuous-validation.hh:297
DevicePtr_t robot_
Definition: continuous-validation.hh:290
boost::shared_ptr< ValidationReport > ValidationReportPtr_t
Definition: fwd.hh:206
Definition: continuous-validation.hh:94
pinocchio::DevicePtr_t DevicePtr_t
Definition: fwd.hh:114
void add(const Delegate &delegate)
Definition: continuous-validation.hh:332
boost::shared_ptr< IntervalValidation > IntervalValidationPtr_t
Definition: fwd.hh:242
Definition: basic-configuration-shooter.hh:26
value_type tolerance_
Definition: continuous-validation.hh:291
pinocchio::Pool< IntervalValidations_t > bodyPairCollisionPool_
Definition: continuous-validation.hh:301
ContinuousValidation & owner() const
Definition: continuous-validation.hh:121
std::pair< value_type, value_type > interval_t
Definition: fwd.hh:158
pinocchio::DeviceWkPtr_t DeviceWkPtr_t
Definition: fwd.hh:115
Definition: continuous-validation.hh:86
std::vector< IntervalValidationPtr_t > IntervalValidations_t
Definition: fwd.hh:243
ContinuousValidation * owner_
Definition: continuous-validation.hh:107
pinocchio::JointPtr_t JointPtr_t
Definition: fwd.hh:133
DevicePtr_t robot() const
Definition: continuous-validation.hh:202
continuousValidation::IntervalValidations_t IntervalValidations_t
Definition: continuous-validation.hh:212
ContinuousValidation * owner_
Definition: continuous-validation.hh:124
Definition: continuous-validation.hh:112
ContinuousValidation & owner() const
Definition: continuous-validation.hh:104
void reset()
Definition: continuous-validation.hh:337
pinocchio::matrix_t matrix_t
Definition: fwd.hh:145
Definition: path-validation.hh:35
pinocchio::value_type value_type
Definition: fwd.hh:157
virtual ~AddObstacle()
Definition: continuous-validation.hh:122
Definition: path-validation-report.hh:34
Definition: obstacle-user.hh:35
boost::shared_ptr< PathValidationReport > PathValidationReportPtr_t
Definition: fwd.hh:298
virtual ~Initialize()
Definition: continuous-validation.hh:105
IntervalValidations_t disabledBodyPairCollisions_
BodyPairCollision for which collision is disabled.
Definition: continuous-validation.hh:299
value_type stepSize_
Definition: continuous-validation.hh:303
#define HPP_CORE_DLLAPI
Definition: config.hh:64
pinocchio::Configuration_t Configuration_t
Definition: fwd.hh:96
Eigen::Matrix< RelativeMotionType, Eigen::Dynamic, Eigen::Dynamic > matrix_type
Definition: relative-motion.hh:51
pinocchio::CollisionObjectConstPtr_t CollisionObjectConstPtr_t
Definition: fwd.hh:90
DeviceWkPtr_t robot_
Definition: continuous-validation.hh:125