Fix for bundle adjusting with motion restricted

Was a bug introduced in previous commit, which
was trying to set parameterization for non-existing
camera->t parameter block.

Replaced with subset parameterization.

Also added basic synthetic unit test for modal solver.