symforce-org / symforce

Fast symbolic computation, code generation, and nonlinear optimization for robotics
https://symforce.org
Apache License 2.0
1.44k stars 147 forks source link

Add heuristics for tangent_jacobians #50

Open aaron-skydio opened 2 years ago

aaron-skydio commented 2 years ago

For example, if a and b are geo.Rot3s, then tangent_jacobians(a * b, [b])[0] should be the identity matrix, but our current answer doesn't yield that.

Find ways to get expressions for jacobians with fewer ops than we currently use (using things like unit norm constraints and whatnot).