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