Added plot support for velocity controllers.
Updated test scripts for belugas for velocity control