Integrate wheel_velocity into program