Open rachelholladay opened 9 years ago
The functionality has been enabled in tsr.py
in https://github.com/personalrobotics/prpy/pull/159. @psigen promises to update or_trajopt
with the new functionality.
@rachelholladay: I've taken a first cut at implementing this here, if you want to try it out: https://github.com/personalrobotics/or_trajopt/tree/feature/tsr_projection
Inside constraints.py the function _TsrCostFn can't project onto TSR Chains.