public int GetCpNum()
{
ColorCompare left = RecognitionTools.CompareColors(LUB, LUF);
ColorCompare front = RecognitionTools.CompareColors(FUL, FUR);
if (left == ColorCompare.Same && front == ColorCompare.Same)
{
return(5);
}
else if (left == ColorCompare.Opposite && front == ColorCompare.Opposite)
{
return(4);
}
else if (left == ColorCompare.Same)
{
return(1);
}
else if (left == ColorCompare.Opposite)
{
return(0);
}
else if (front == ColorCompare.Same)
{
return(3);
}
else
{
return(2);
}
}
/// <summary>
/// Gets the number of the PLL on this cube if there is an adjacent corner swap, idnoring location of the swap
/// </summary>
/// <returns></returns>
public int GetAdjSwapNum()
{
ColorCompare left = RecognitionTools.CompareColors(LUB, LU);
ColorCompare front = RecognitionTools.CompareColors(FUL, FU);
if (left == ColorCompare.Same)
{
if (front == ColorCompare.Same)
{
return(8);
}
if (front == ColorCompare.Opposite)
{
return(3);
}
return(9);
}
if (left == ColorCompare.Opposite)
{
if (front == ColorCompare.Same)
{
return(2);
}
if (front == ColorCompare.Opposite)
{
return(4);
}
return(7);
}
if (left == ColorCompare.Right)
{
if (front == ColorCompare.Right)
{
return(1);
}
if (front == ColorCompare.Left)
{
return(10);
}
return(6);
}
if (front == ColorCompare.Right)
{
return(5);
}
if (front == ColorCompare.Left)
{
return(0);
}
return(11);
}
/// <summary>
/// Gets the number of the PLL position on this cube if there is no corner swap
/// </summary>
/// <returns></returns>
public int GetEpllNum()
{
ColorCompare front = RecognitionTools.CompareColors(FUR, FU);
ColorCompare right = RecognitionTools.CompareColors(RUF, RU);
if (front == ColorCompare.Same)
{
if (right == ColorCompare.Same)
{
return(61);
}
if (right == ColorCompare.Opposite)
{
return(66);
}
return(68);
}
if (front == ColorCompare.Opposite)
{
if (right == ColorCompare.Same)
{
return(71);
}
if (right == ColorCompare.Opposite)
{
return(60);
}
return(67);
}
if (front == ColorCompare.Right)
{
if (right == ColorCompare.Right)
{
return(69);
}
if (right == ColorCompare.Left)
{
return(63);
}
return(70);
}
if (right == ColorCompare.Right)
{
return(62);
}
if (right == ColorCompare.Left)
{
return(64);
}
return(65);
}
/// <summary>
/// Gets the numbr of a PLL position if there is a diagonal corner swap
/// </summary>
/// <returns></returns>
public int GetDiagSwapNum()
{
ColorCompare front = RecognitionTools.CompareColors(FUL, FU);
ColorCompare right = RecognitionTools.CompareColors(RUF, RU);
if (front == ColorCompare.Same)
{
if (right == ColorCompare.Same)
{
return(51);
}
if (right == ColorCompare.Opposite)
{
return(56);
}
return(52);
}
if (front == ColorCompare.Opposite)
{
if (right == ColorCompare.Same)
{
return(55);
}
if (right == ColorCompare.Opposite)
{
return(50);
}
return(57);
}
if (front == ColorCompare.Right)
{
if (right == ColorCompare.Right)
{
return(58);
}
if (right == ColorCompare.Left)
{
return(48);
}
return(59);
}
if (right == ColorCompare.Right)
{
return(49);
}
if (right == ColorCompare.Left)
{
return(53);
}
return(54);
}
/// <summary>
/// Gets the PLL number of a PLL position
/// </summary>
/// <returns></returns>
public int GetPllNum()
{
try
{
ColorCompare left = RecognitionTools.CompareColors(LUB, LUF);
ColorCompare front = RecognitionTools.CompareColors(FUL, FUR);
if (left == ColorCompare.Same && front == ColorCompare.Same)
{
return(GetEpllNum());
}
else if (left == ColorCompare.Opposite && front == ColorCompare.Opposite)
{
return(GetDiagSwapNum());
}
else if (left == ColorCompare.Same)
{
return(GetAdjSwapNum());
}
else if (left == ColorCompare.Opposite)
{
U2();
int num = GetAdjSwapNum();
U2();
return(num + 24);
}
else if (front == ColorCompare.Same)
{
U();
int num = GetAdjSwapNum();
Ui();
return(num + 36);
}
else
{
Ui();
int num = GetAdjSwapNum();
U();
return(num + 12);
}
}
catch (ArgumentException)
{
return(-1);
}
}
/// <summary>
/// AUFs to default angle for the OLL on this cube
/// </summary>
/// <returns>The number of U moves made</returns>
public int AufToDefault()
{
int coNum = GetCornerOrientationNum();
int numAufs = 0;
if (coNum == 0)
{
while (RUB != CubeColor.Yellow)
{
if (numAufs > 4)
{
throw new InvalidOperationException("the cube dos not have the expected corner orientation.");
}
U();
numAufs++;
}
}
else if (coNum == 1)
{
while (BUR != CubeColor.Yellow)
{
if (numAufs > 4)
{
throw new InvalidOperationException("the cube dos not have the expected corner orientation.");
}
U();
numAufs++;
}
}
else if (coNum == 2)
{
while (BUR != CubeColor.Yellow)
{
if (numAufs > 4)
{
throw new InvalidOperationException("the cube dos not have the expected corner orientation.");
}
U();
numAufs++;
}
}
else if (coNum == 3)
{
while (URF != CubeColor.Yellow)
{
if (numAufs > 4)
{
throw new InvalidOperationException("the cube dos not have the expected corner orientation.");
}
U();
numAufs++;
}
}
else if (coNum == 4)
{
while (ULF != CubeColor.Yellow)
{
if (numAufs > 4)
{
throw new InvalidOperationException("the cube dos not have the expected corner orientation.");
}
U();
numAufs++;
}
}
else if (coNum == 5)
{
while (LUB != CubeColor.Yellow || LUF != CubeColor.Yellow)
{
if (numAufs > 4)
{
throw new InvalidOperationException("the cube dos not have the expected corner orientation.");
}
U();
numAufs++;
}
}
else if (coNum == 6)
{
if (RUF != CubeColor.Yellow)
{
U();
numAufs++;
}
if ((UF == CubeColor.Yellow && UR == CubeColor.Yellow && UL == CubeColor.Yellow) || (UF != CubeColor.Yellow && UR != CubeColor.Yellow && UL != CubeColor.Yellow)) // ZBLL or dot
{
if (RecognitionTools.CompareColors(URB, ULB) == ColorCompare.Same && RecognitionTools.CompareColors(URF, ULF) == ColorCompare.Opposite)
{
U2();
numAufs += 2;
}
if (RecognitionTools.CompareColors(URB, URF) == ColorCompare.Opposite && RecognitionTools.CompareColors(ULB, ULF) == ColorCompare.Same)
{
U2();
numAufs += 2;
}
}
else if (UL == CubeColor.Yellow && UF == CubeColor.Yellow)
{
U2();
numAufs += 2;
}
else if (UL == CubeColor.Yellow && UB == CubeColor.Yellow)
{
U2();
numAufs += 2;
}
else if ((UL == CubeColor.Yellow && UR == CubeColor.Yellow) || (UF == CubeColor.Yellow && UB == CubeColor.Yellow))
{
if (RecognitionTools.CompareColors(URB, ULB) == ColorCompare.Same && RecognitionTools.CompareColors(URF, ULF) == ColorCompare.Opposite)
{
U2();
numAufs += 2;
}
else if (RecognitionTools.CompareColors(URB, URF) == ColorCompare.Opposite && RecognitionTools.CompareColors(ULB, ULF) == ColorCompare.Same)
{
U2();
numAufs += 2;
}
else if ((RecognitionTools.CompareColors(URB, URF) == ColorCompare.Same && RecognitionTools.CompareColors(ULB, ULF) == ColorCompare.Opposite) ||
(RecognitionTools.CompareColors(URB, ULB) == ColorCompare.Opposite && RecognitionTools.CompareColors(URF, ULF) == ColorCompare.Same))
{
return(numAufs);
}
else if (UL == CubeColor.Yellow)
{
if ((RecognitionTools.CompareColors(ULF, UF) == ColorCompare.Left || RecognitionTools.CompareColors(ULF, UF) == ColorCompare.Right) &&
(RecognitionTools.CompareColors(ULB, UB) == ColorCompare.Same || RecognitionTools.CompareColors(ULB, UB) == ColorCompare.Opposite))
{
U2();
numAufs += 2;
}
}
else
{
if ((RecognitionTools.CompareColors(URF, UR) == ColorCompare.Left || RecognitionTools.CompareColors(URF, UR) == ColorCompare.Right) &&
(RecognitionTools.CompareColors(ULF, UL) == ColorCompare.Same || RecognitionTools.CompareColors(ULF, UL) == ColorCompare.Opposite))
{
U2();
numAufs += 2;
}
}
}
}
else // ellcp
{
List <CubeColor> edgeColors = new List <CubeColor>()
{
UB, UR, UF, UL
};
int flippedCount = edgeColors.Count(x => x != CubeColor.Yellow);
if (flippedCount == 2)
{
if ((UF == CubeColor.Yellow && UB == CubeColor.Yellow) || (UR == CubeColor.Yellow && UL == CubeColor.Yellow)) // opp flip
{
if (UL != CubeColor.Yellow)
{
U();
numAufs++;
}
if (RecognitionTools.CompareColors(RUF, RUB) == ColorCompare.Same && RecognitionTools.CompareColors(LUF, LUB) == ColorCompare.Opposite)
{
U2();
numAufs += 2;
}
else if (RecognitionTools.CompareColors(FUR, FUL) == ColorCompare.Opposite && RecognitionTools.CompareColors(BUR, BUL) == ColorCompare.Same)
{
U2();
numAufs += 2;
}
// ELL
else if (RecognitionTools.CompareColors(RUF, RUB) == ColorCompare.Same && RecognitionTools.CompareColors(LUF, LUB) == ColorCompare.Same)
{
if (RecognitionTools.CompareColors(UF, FUR) == ColorCompare.Same || RecognitionTools.CompareColors(UF, FUR) == ColorCompare.Opposite)
{
U2();
numAufs += 2;
}
}
// diag swap
else if (RecognitionTools.CompareColors(RUF, RUB) == ColorCompare.Opposite && RecognitionTools.CompareColors(LUF, LUB) == ColorCompare.Opposite)
{
if (RecognitionTools.CompareColors(UF, UB) != ColorCompare.Opposite)
{
bool opposites = RecognitionTools.CompareColors(RU, RUF) == ColorCompare.Same || RecognitionTools.CompareColors(RU, RUF) == ColorCompare.Opposite;
bool backOpp = RecognitionTools.CompareColors(RU, UB) == ColorCompare.Opposite;
if (opposites != backOpp)
{
U2();
numAufs += 2;
}
}
}
}
else if (UF == CubeColor.Yellow || UB == CubeColor.Yellow) // adj flip
{
while (UF != CubeColor.Yellow || UR != CubeColor.Yellow)
{
U();
numAufs++;
}
}
}
else // 4 flip
{
if (RecognitionTools.CompareColors(FUR, FUL) == RecognitionTools.CompareColors(RUF, RUB))
{
if (RecognitionTools.CompareColors(FUR, FUL) == ColorCompare.Opposite) // diag swap
{
if (RecognitionTools.CompareColors(UF, UB) == ColorCompare.Opposite) // E or N perm
{
if (RecognitionTools.CompareColors(UR, FUR) == ColorCompare.Opposite)
{
U();
numAufs++;
}
}
else // V or Y perm
{
while (RecognitionTools.CompareColors(UF, FUR) != ColorCompare.Opposite)
{
U();
numAufs++;
}
}
}
else // ELL
{
if (RecognitionTools.CompareColors(UF, UB) == ColorCompare.Opposite) // Z, H, or pure
{
if (RecognitionTools.CompareColors(UF, RUF) == ColorCompare.Same)
{
U();
numAufs++;
}
}
else // U perm
{
while (RecognitionTools.CompareColors(BUL, UB) != ColorCompare.Same)
{
U();
numAufs++;
}
}
}
}
else // adj swap
{
while (RecognitionTools.CompareColors(LUF, LUB) != ColorCompare.Same)
{
U();
numAufs++;
}
}
}
}
return(numAufs);
}
/// <summary>
/// Gets the number of the current position on this cube
/// </summary>
/// <returns></returns>
public int GetPosNum()
{
int auf = AufToDefault();
int num = (int)UR;
// zbll and dot cases
if (((UF == CubeColor.Yellow && UR == CubeColor.Yellow && UL == CubeColor.Yellow && UB == CubeColor.Yellow) ||
(FU == CubeColor.Yellow && RU == CubeColor.Yellow && LU == CubeColor.Yellow && BU == CubeColor.Yellow)) &&
GetCornerOrientationNum() < 7)
{
bool zbll = UF == CubeColor.Yellow;
int posNum;
int coNum = GetCornerOrientationNum();
if (coNum < 6)
{
Orient();
posNum = 72 * coNum + GetPllNum();
}
else
{
Orient();
int pllNum = GetPllNum();
if (pllNum >= 12)
{
pllNum -= 24;
}
posNum = 72 * coNum + pllNum;
}
if (!zbll)
{
posNum += 480;
}
return(posNum);
}
else
{
int coNum = GetCornerOrientationNum();
// standard 2 edge case
if (coNum < 6)
{
int ollNum;
int eoNum = GetEdgeOrientationNum();
ollNum = coNum * 432 + eoNum * 72;
Orient();
return(960 + ollNum + GetPllNum());
}
else if (coNum == 6) // H orientation
{
int num2 = (int)UR;
int posNum = 3552;
int eoNum = GetEdgeOrientationNum();
if (eoNum == 1 || eoNum == 3)
{
if (eoNum == 1)
{
posNum += 72;
}
Orient();
return(posNum + GetPllNum());
}
else if (eoNum == 4 || eoNum == 5)
{
posNum += 144;
if (eoNum == 5)
{
posNum += 40;
}
var cmp = RecognitionTools.CompareColors(URF, URB);
Orient();
int pllNum = GetPllNum();
if (pllNum >= 12)
{
pllNum -= 24;
}
posNum += pllNum;
if (eoNum == 4 || eoNum == 5)
{
// not all pll nums will be covered for no corner swap and diag corner swap
if (eoNum == 4)
{
if (posNum >= 3727 && posNum <= 3729)
{
posNum -= 2;
}
if (posNum >= 3731 && posNum <= 3735)
{
posNum -= 4;
}
if (posNum >= 3736 && posNum <= 3740)
{
posNum -= 6;
}
if (posNum >= 3741 && posNum <= 3743)
{
posNum -= 8;
}
}
else
{
if (posNum == 3769)
{
posNum -= 2;
}
if (posNum >= 3770 && posNum <= 3778)
{
posNum -= 4;
}
if (posNum >= 3779 && posNum <= 3781)
{
posNum -= 6;
}
}
}
return(posNum);
}
else
{
return(eoNum);
}
}
else // ELLCP
{
int eoNum = GetEdgeOrientationNum();
if (eoNum == 1)
{
Orient();
return(3776 + GetPllNum());
}
else if (eoNum == 4)
{
Orient();
int pllNum = GetPllNum();
int total = 3848 + pllNum;
if (pllNum > 12)
{
total -= 24;
}
if (total >= 3879 && total <= 3882)
{
total -= 2;
}
if (total >= 3883 && total <= 3889)
{
total -= 4;
}
if (total >= 3890 && total <= 3893)
{
total -= 6;
}
if (total >= 3894 && total <= 3895)
{
total -= 8;
}
return(total);
}
else
{
Orient();
int pllNum = GetPllNum();
if (pllNum < 12)
{
return(3888 + pllNum);
}
if (pllNum < 50)
{
return(3900);
}
else if (pllNum == 50)
{
return(3901);
}
else if (pllNum == 51)
{
return(3902);
}
else if (pllNum < 56)
{
return(3903);
}
else if (pllNum < 60)
{
return(3904);
}
else if (pllNum == 60)
{
return(3906);
}
else if (pllNum == 61)
{
return(3905);
}
else if (pllNum < 64)
{
return(3907);
}
else if (pllNum < 68)
{
return(3908);
}
else
{
return(3909);
}
}
}
}
}
