Add check on max joint vel