private FromPoint GetFromPoint(LegPosition homeLegPosition, int startPosition, Leg leg)
{
FromPoint point;
switch ((step + startPosition) % 6)
{
case 0:
case 5:
point = new FromPoint(homeLegPosition.X, homeLegPosition.Z, homeLegPosition.Y);
break;
default:
point = new FromPoint(leg.X, leg.Z, homeLegPosition.Y);
break;
}
return point;
}