adding velocity pid based following