Velocity controller running with low level beluga. Need to check arithmatic