public void CalculateTargetSpeed() { Autoaim testAuto = new Autoaim(); Vector3 targetPosition = new Vector3(0f, 0f, 0f); Vector3 turretPosition = new Vector3(2f, 2f, 0f); testAuto.SetPositions(targetPosition, targetPosition); testAuto.SetTurretPosition(turretPosition); float test = (float)Math.Sqrt(Math.Pow(2, 2) + Math.Pow(2, 2)); Assert.True(testAuto.CalculateTargetSpeed() == test); }