Skip to content
GitLab
Menu
Projects
Groups
Snippets
Help
Help
Support
Community forum
Keyboard shortcuts
?
Submit feedback
Contribute to GitLab
Sign in / Register
Toggle navigation
Menu
Open sidebar
Humanoid Path Planner
hpp-rbprm-corba
Commits
993c64c2
Commit
993c64c2
authored
Sep 03, 2020
by
Pierre Fernbach
Browse files
[Scenario] init_viewer take optionnal argument min_area used by affordance
parent
3030735b
Changes
1
Hide whitespace changes
Inline
Side-by-side
src/hpp/corbaserver/rbprm/scenarios/abstract_path_planner.py
View file @
993c64c2
...
@@ -113,7 +113,8 @@ class AbstractPathPlanner:
...
@@ -113,7 +113,8 @@ class AbstractPathPlanner:
# sample only configuration with null velocity and acceleration :
# sample only configuration with null velocity and acceleration :
self
.
ps
.
setParameter
(
"ConfigurationShooter/sampleExtraDOF"
,
False
)
self
.
ps
.
setParameter
(
"ConfigurationShooter/sampleExtraDOF"
,
False
)
def
init_viewer
(
self
,
env_name
,
env_package
=
"hpp_environments"
,
reduce_sizes
=
[
0
,
0
,
0
],
visualize_affordances
=
[]):
def
init_viewer
(
self
,
env_name
,
env_package
=
"hpp_environments"
,
reduce_sizes
=
[
0
,
0
,
0
],
visualize_affordances
=
[],
min_area
=
None
):
"""
"""
Build an instance of hpp-gepetto-viewer from the current problemSolver
Build an instance of hpp-gepetto-viewer from the current problemSolver
:param env_name: name of the urdf describing the environment
:param env_name: name of the urdf describing the environment
...
@@ -121,6 +122,7 @@ class AbstractPathPlanner:
...
@@ -121,6 +122,7 @@ class AbstractPathPlanner:
:param reduce_sizes: Distance used to reduce the affordances plan toward the center of the plane
:param reduce_sizes: Distance used to reduce the affordances plan toward the center of the plane
(in order to avoid putting contacts closes to the edges of the surface)
(in order to avoid putting contacts closes to the edges of the surface)
:param visualize_affordances: list of affordances type to visualize, default to none
:param visualize_affordances: list of affordances type to visualize, default to none
:param min_area: list of couple [affordanceType, size]. If provided set the minimal area for each affordance
"""
"""
vf
=
ViewerFactory
(
self
.
ps
)
vf
=
ViewerFactory
(
self
.
ps
)
if
self
.
context
:
if
self
.
context
:
...
@@ -130,11 +132,13 @@ class AbstractPathPlanner:
...
@@ -130,11 +132,13 @@ class AbstractPathPlanner:
else
:
else
:
self
.
afftool
=
AffordanceTool
()
self
.
afftool
=
AffordanceTool
()
self
.
afftool
.
setAffordanceConfig
(
'Support'
,
[
0.5
,
0.03
,
0.00005
])
self
.
afftool
.
setAffordanceConfig
(
'Support'
,
[
0.5
,
0.03
,
0.00005
])
if
min_area
is
not
None
:
for
(
aff_type
,
min_size
)
in
min_area
:
self
.
afftool
.
setMinimumArea
(
aff_type
,
min_size
)
self
.
afftool
.
loadObstacleModel
(
"package://"
+
env_package
+
"/urdf/"
+
env_name
+
".urdf"
,
self
.
afftool
.
loadObstacleModel
(
"package://"
+
env_package
+
"/urdf/"
+
env_name
+
".urdf"
,
"planning"
,
"planning"
,
vf
,
vf
,
reduceSizes
=
reduce_sizes
)
reduceSizes
=
reduce_sizes
)
self
.
v
=
vf
.
createViewer
(
ghost
=
True
,
displayArrows
=
True
)
self
.
v
=
vf
.
createViewer
(
ghost
=
True
,
displayArrows
=
True
)
self
.
pp
=
PathPlayer
(
self
.
v
)
self
.
pp
=
PathPlayer
(
self
.
v
)
for
aff_type
in
visualize_affordances
:
for
aff_type
in
visualize_affordances
:
...
...
Write
Preview
Markdown
is supported
0%
Try again
or
attach a new file
.
Attach a file
Cancel
You are about to add
0
people
to the discussion. Proceed with caution.
Finish editing this message first!
Cancel
Please
register
or
sign in
to comment