[BUG?] fail to check if `T.n() != num_poses()`

[RonghaiHe]

Thanks for your sharing at first.
I have noticed that maybe there is a bug in the initialize function in these lines. If T.n() != num_poses(), then initialization_successful is set to false. But after that, initialization_successful is set to true, which makes the check above is no used.