Add go to zero and change command
Remove Joint velocity port connection