Reports of IMM not working

[vkorotkine]

From Phil:
"imm se3 throw an error: ValueError: x and y must have same first dimension, but have shapes (98,) and (2,)
and the vector case is sensitive to initialization, sometimes the estimation is not good"

[vkorotkine]

Fixed by #116