Bilateral 3d constraints, minor documentation update
Fix bug in rigid bilateral 3d, update derivation for H

- Computation with H involves only matrix multiplication, not a special
case with cross products in the solver.