DirconDynamicConstraint was creating a new MultibodyPlant context inside the evaluation loop. On the Cassie squatting test, this was ~15% of total runtime. Removed this to make use of a single context.
Also added a helper function (setContext) to support this.l
DirconDynamicConstraint
was creating a new MultibodyPlant context inside the evaluation loop. On the Cassie squatting test, this was ~15% of total runtime. Removed this to make use of a single context.Also added a helper function (setContext) to support this.l