1 #ifndef hpp_core_idl__path__planners_hxx__
2 #define hpp_core_idl__path__planners_hxx__
24 template <
typename _Base,
typename _Storage>
31 template <
typename _Base,
typename _Storage>
39 template <
typename _Base,
typename _Storage>
44 _ServantBase::deleteThis();
45 }
catch (
const std::exception& e) {
46 throw ::hpp::Error (e.what());
50 template <
typename _Base,
typename _Storage>
55 return _ServantBase::deleteIfExpired();
56 }
catch (
const std::exception& e) {
57 throw ::hpp::Error (e.what());
61 template <
typename _Base,
typename _Storage>
66 _ServantBase::persistantStorage(persistant);
67 }
catch (
const std::exception& e) {
68 throw ::hpp::Error (e.what());
72 template <
typename _Base,
typename _Storage>
79 nodes[0]->configuration().size());
81 for (hpp::core::NodeVector_t::const_iterator _node = nodes.begin();
82 _node != nodes.end(); ++_node)
83 configs.row(i++) = (*_node)->configuration();
86 }
catch (
const std::exception& e) {
87 throw ::hpp::Error (e.what());
101 namespace core_impl {
102 template <
typename _Base,
typename _Storage>
105 :
hpp::corbaServer::ServantBase<
hpp::core::
Roadmap, _Storage> (server, s)
109 template <
typename _Base,
typename _Storage>
117 template <
typename _Base,
typename _Storage>
122 _ServantBase::deleteThis();
123 }
catch (
const std::exception& e) {
124 throw ::hpp::Error (e.what());
128 template <
typename _Base,
typename _Storage>
133 return _ServantBase::deleteIfExpired();
134 }
catch (
const std::exception& e) {
135 throw ::hpp::Error (e.what());
139 template <
typename _Base,
typename _Storage>
144 _ServantBase::persistantStorage(persistant);
145 }
catch (
const std::exception& e) {
146 throw ::hpp::Error (e.what());
150 template <
typename _Base,
typename _Storage>
159 }
catch (
const std::exception& e) {
160 throw ::hpp::Error (e.what());
164 template <
typename _Base,
typename _Storage>
170 (getT()->addNode (_config));
173 }
catch (
const std::exception& e) {
174 throw ::hpp::Error (e.what());
178 template <
typename _Base,
typename _Storage>
183 core::PathPtr_t path (corbaServer::reference_to_servant_base<core::Path>(server_, path_)->get());
187 }
catch (
const std::exception& e) {
188 throw ::hpp::Error (e.what());
192 template <
typename _Base,
typename _Storage>
197 core::PathPtr_t path (corbaServer::reference_to_servant_base<core::Path>(server_, path_)->get());
201 }
catch (
const std::exception& e) {
202 throw ::hpp::Error (e.what());
206 template <
typename _Base,
typename _Storage>
214 }
catch (
const std::exception& e) {
215 throw ::hpp::Error (e.what());
219 template <
typename _Base,
typename _Storage>
228 for (hpp::core::Nodes_t::const_iterator _node = nodes.begin(); _node != nodes.end(); ++_node)
229 configs.row(i++) = (*_node)->configuration();
232 }
catch (
const std::exception& e) {
233 throw ::hpp::Error (e.what());
237 template <
typename _Base,
typename _Storage>
242 return getT()->nodes().size();
244 }
catch (
const std::exception& e) {
245 throw ::hpp::Error (e.what());
249 template <
typename _Base,
typename _Storage>
256 }
catch (
const std::exception& e) {
257 throw ::hpp::Error (e.what());
261 template <
typename _Base,
typename _Storage>
266 return getT()->edges().size();
268 }
catch (
const std::exception& e) {
269 throw ::hpp::Error (e.what());
273 template <
typename _Base,
typename _Storage>
278 return corbaServer::makeServant<hpp::core_idl::Path_ptr> (server_,
279 new Path (server_, (*std::next(getT()->edges().begin(),i))->path()));
281 }
catch (
const std::exception& e) {
282 throw ::hpp::Error (e.what());
286 template <
typename _Base,
typename _Storage>
295 }
catch (
const std::exception& e) {
296 throw ::hpp::Error (e.what());
310 namespace core_impl {
311 template <
typename _Base,
typename _Storage>
318 template <
typename _Base,
typename _Storage>
326 template <
typename _Base,
typename _Storage>
331 _ServantBase::deleteThis();
332 }
catch (
const std::exception& e) {
333 throw ::hpp::Error (e.what());
337 template <
typename _Base,
typename _Storage>
342 return _ServantBase::deleteIfExpired();
343 }
catch (
const std::exception& e) {
344 throw ::hpp::Error (e.what());
348 template <
typename _Base,
typename _Storage>
353 _ServantBase::persistantStorage(persistant);
354 }
catch (
const std::exception& e) {
355 throw ::hpp::Error (e.what());
359 template <
typename _Base,
typename _Storage>
367 return ::hpp::corbaServer::makeServantDownCast<hpp::core_impl::Path,hpp::core_impl::PathVector>(server_, __return__)._retn();
368 }
catch (
const std::exception& e) {
369 throw ::hpp::Error (e.what());
373 template <
typename _Base,
typename _Storage>
379 (getT()->startSolve ());
382 }
catch (
const std::exception& e) {
383 throw ::hpp::Error (e.what());
387 template <
typename _Base,
typename _Storage>
393 (getT()->tryConnectInitAndGoals ());
396 }
catch (
const std::exception& e) {
397 throw ::hpp::Error (e.what());
401 template <
typename _Base,
typename _Storage>
407 (getT()->oneStep ());
410 }
catch (
const std::exception& e) {
411 throw ::hpp::Error (e.what());
415 template <
typename _Base,
typename _Storage>
423 return ::hpp::corbaServer::makeServantDownCast<hpp::core_impl::Path,hpp::core_impl::PathVector>(server_, __return__)._retn();
424 }
catch (
const std::exception& e) {
425 throw ::hpp::Error (e.what());
429 template <
typename _Base,
typename _Storage>
437 return ::hpp::corbaServer::makeServantDownCast<hpp::core_impl::Path,hpp::core_impl::PathVector>(server_, __return__)._retn();
438 }
catch (
const std::exception& e) {
439 throw ::hpp::Error (e.what());
443 template <
typename _Base,
typename _Storage>
449 (getT()->interrupt ());
452 }
catch (
const std::exception& e) {
453 throw ::hpp::Error (e.what());
457 template <
typename _Base,
typename _Storage>
463 (getT()->maxIterations (n));
466 }
catch (
const std::exception& e) {
467 throw ::hpp::Error (e.what());
471 template <
typename _Base,
typename _Storage>
477 (getT()->timeOut (seconds));
480 }
catch (
const std::exception& e) {
481 throw ::hpp::Error (e.what());
485 template <
typename _Base,
typename _Storage>
491 hpp::core::RoadmapPtr_t __return__ (getT()->roadmap ());
493 return ::hpp::corbaServer::makeServantDownCast<hpp::core_impl::Roadmap,hpp::core_impl::Roadmap>(server_, __return__)._retn();
494 }
catch (
const std::exception& e) {
495 throw ::hpp::Error (e.what());
499 template <
typename _Base,
typename _Storage>
505 (getT()->stopWhenProblemIsSolved (enable));
508 }
catch (
const std::exception& e) {
509 throw ::hpp::Error (e.what());
523 namespace core_impl {
524 template <
typename _Base,
typename _Storage>
531 template <
typename _Base,
typename _Storage>
539 template <
typename _Base,
typename _Storage>
544 _ServantBase::deleteThis();
545 }
catch (
const std::exception& e) {
546 throw ::hpp::Error (e.what());
550 template <
typename _Base,
typename _Storage>
555 return _ServantBase::deleteIfExpired();
556 }
catch (
const std::exception& e) {
557 throw ::hpp::Error (e.what());
561 template <
typename _Base,
typename _Storage>
566 _ServantBase::persistantStorage(persistant);
567 }
catch (
const std::exception& e) {
568 throw ::hpp::Error (e.what());
572 template <
typename _Base,
typename _Storage>
580 return ::hpp::corbaServer::makeServantDownCast<hpp::core_impl::Path,hpp::core_impl::PathVector>(server_, __return__)._retn();
581 }
catch (
const std::exception& e) {
582 throw ::hpp::Error (e.what());
586 template <
typename _Base,
typename _Storage>
592 (getT()->interrupt ());
595 }
catch (
const std::exception& e) {
596 throw ::hpp::Error (e.what());
600 template <
typename _Base,
typename _Storage>
606 (getT()->maxIterations (n));
609 }
catch (
const std::exception& e) {
610 throw ::hpp::Error (e.what());
614 template <
typename _Base,
typename _Storage>
620 (getT()->timeOut (seconds));
623 }
catch (
const std::exception& e) {
624 throw ::hpp::Error (e.what());
637 #endif // hpp_core_idl__path__planners_hxx__