Some minor changes

Sorry, I couldn't come up with a better name. These are some changes that did not fit into any open MR.

Changes:

• VelocityControllerHelper: changing VectorXf to Vector6f (VectorXf is not guaranted to have 6 elements.)
• typos
• viz::Box: initializing pose if not set explicitly