affine3 and small tweaks
add internal Jacobian for SE3