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); }
public static void RotateLeg(Leg leg, double degrees, double direction,double xCenter,double zCenter) { double newX; double newZ; CalculateNewCoordinatesForRotation(leg.RealX, leg.RealZ, xCenter, zCenter, degrees, out newX, out newZ); leg.TotRotation = leg.TotRotation + degrees; leg.SetRealXYZ(newX, newZ, leg.Y); }