KIWI now balances, and can drive around in response to a /cmd_vel
message, which are currently being sent from the keyboard_controller.
Next steps will be adding a basic LQR feedback controller, then nav2 integration.