Robot.RippelGate6.CalculateNextStepRotation C# (CSharp) Method

        private void CalculateNextStepRotation(Leg leg, double degrees, double yDistance, FromPoint fromPoint, double centerX, double centerZ)
        {
            double newX;
            double newZ;
            double newY;

            Leg.CalculateNewCoordinatesForRotation(leg.DistanceToX + fromPoint.FromX, leg.DistanceToZ + fromPoint.FromZ, centerX, centerZ, degrees, out newX, out newZ);

            newY = fromPoint.FromY - yDistance;
            leg.SetRealXYZ(newX, newZ, newY);
        }