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
Stack Of Tasks
pinocchio
Commits
8e0f3891
Commit
8e0f3891
authored
Apr 26, 2018
by
jcarpent
Browse files
[Model] Use new neutral accessor algo to retrive the neutral configuration
parent
3834a6d8
Changes
1
Hide whitespace changes
Inline
Side-by-side
src/multibody/model.hxx
View file @
8e0f3891
...
...
@@ -21,6 +21,7 @@
#include "pinocchio/spatial/fwd.hpp"
#include "pinocchio/tools/string-generator.hpp"
#include "pinocchio/algorithm/joint-configuration.hpp"
#include <boost/bind.hpp>
#include <boost/utility.hpp>
...
...
@@ -89,16 +90,16 @@ namespace se3
// However, this option is not compiling in Travis (why?).
// As efficiency of Model::addJoint is not critical, the dynamic bottomRows is used here.
effortLimit
.
conservativeResize
(
nv
);
jmodel
.
joint
Config
Selector
(
effortLimit
)
=
max_effort
;
jmodel
.
joint
Velocity
Selector
(
effortLimit
)
=
max_effort
;
velocityLimit
.
conservativeResize
(
nv
);
jmodel
.
jointVelocitySelector
(
effort
Limit
)
=
max_velocity
;
jmodel
.
jointVelocitySelector
(
velocity
Limit
)
=
max_velocity
;
lowerPositionLimit
.
conservativeResize
(
nq
);
jmodel
.
jointConfigSelector
(
lowerPositionLimit
)
=
min_config
;
upperPositionLimit
.
conservativeResize
(
nq
);
jmodel
.
jointConfigSelector
(
upperPositionLimit
)
=
max_config
;
neutralConfiguration
.
conservativeResize
(
nq
);
n
eutral
Configuration
.
tail
(
j
oint
_m
odel
.
nq
())
=
joint_
model
.
neutralConfiguration
(
);
N
eutral
StepAlgo
<
LieGroupTpl
,
J
oint
M
odel
Derived
>::
run
(
j
model
,
neutralConfiguration
);
rotorInertia
.
conservativeResize
(
nv
);
jmodel
.
jointVelocitySelector
(
rotorInertia
).
setZero
();
...
...
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