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
Gepetto
ospi
Commits
1ddd1ec1
Commit
1ddd1ec1
authored
May 31, 2018
by
Galo Maldonado
Browse files
show joint frames
parent
f3ecb732
Changes
1
Hide whitespace changes
Inline
Side-by-side
example.py
View file @
1ddd1ec1
import
sys
import
sys
sys
.
path
.
append
(
'src'
)
sys
.
path
.
append
(
'ospi'
)
import
subprocess
import
time
#from ospi
import
viewer_utils
as
vw
import
viewer_utils
as
vw
import
wrapper
as
wr
import
wrapper
as
wr
import
motion_parser
as
mtp
import
motion_parser
as
mtp
...
@@ -11,6 +15,13 @@ filename='/local/gmaldona/devel/Models/data/whole_body/wholebody.osim'
...
@@ -11,6 +15,13 @@ filename='/local/gmaldona/devel/Models/data/whole_body/wholebody.osim'
# Create a wrapper specific to the whole-body model
# Create a wrapper specific to the whole-body model
# The wrapper parse the OpenSim model and builds pinocchio model and data
# The wrapper parse the OpenSim model and builds pinocchio model and data
wb_model
=
wr
.
Wrapper
(
filename
,
mesh_path
,
name
=
'whole-body_model1'
)
wb_model
=
wr
.
Wrapper
(
filename
,
mesh_path
,
name
=
'whole-body_model1'
)
# call the gepetto viewer server
gvs
=
subprocess
.
Popen
([
"./gepetto-viewer.sh"
,
"&"
])
print
'Loading the viewer ...'
time
.
sleep
(
2
)
# Init the viewer and add the model to it
# Init the viewer and add the model to it
viewer
=
vw
.
Viewer
(
'viewer'
,
wb_model
)
viewer
=
vw
.
Viewer
(
'viewer'
,
wb_model
)
viewer
.
setVisibility
(
wb_model
.
name
+
"/floor"
,
"OFF"
)
viewer
.
setVisibility
(
wb_model
.
name
+
"/floor"
,
"OFF"
)
...
@@ -18,6 +29,11 @@ viewer.display(wb_model.q0, wb_model.name)
...
@@ -18,6 +29,11 @@ viewer.display(wb_model.q0, wb_model.name)
# See kinematic ranges of motion
# See kinematic ranges of motion
# See markers
# See axis
viewer
.
JointFrames
(
wb_model
.
name
)
# parse motion:
# parse motion:
time
,
q
,
colheaders
,
qOsim
=
mtp
.
parseMotion
(
wb_model
.
model
,
wb_model
.
joint_transformations
,
'/home/gmaldona/Dropbox/kv03_filtered_ik.mot'
,
'quat'
)
time
,
q
,
colheaders
,
qOsim
=
mtp
.
parseMotion
(
wb_model
.
model
,
wb_model
.
joint_transformations
,
'/home/gmaldona/Dropbox/kv03_filtered_ik.mot'
,
'quat'
)
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