forked from brownan/Rubiks-Cube-Solver
-
Notifications
You must be signed in to change notification settings - Fork 0
/
cube.c
246 lines (229 loc) · 8.67 KB
/
cube.c
1
2
3
4
5
6
7
8
9
10
11
12
13
14
15
16
17
18
19
20
21
22
23
24
25
26
27
28
29
30
31
32
33
34
35
36
37
38
39
40
41
42
43
44
45
46
47
48
49
50
51
52
53
54
55
56
57
58
59
60
61
62
63
64
65
66
67
68
69
70
71
72
73
74
75
76
77
78
79
80
81
82
83
84
85
86
87
88
89
90
91
92
93
94
95
96
97
98
99
100
101
102
103
104
105
106
107
108
109
110
111
112
113
114
115
116
117
118
119
120
121
122
123
124
125
126
127
128
129
130
131
132
133
134
135
136
137
138
139
140
141
142
143
144
145
146
147
148
149
150
151
152
153
154
155
156
157
158
159
160
161
162
163
164
165
166
167
168
169
170
171
172
173
174
175
176
177
178
179
180
181
182
183
184
185
186
187
188
189
190
191
192
193
194
195
196
197
198
199
200
201
202
203
204
205
206
207
208
209
210
211
212
213
214
215
216
217
218
219
220
221
222
223
224
225
226
227
228
229
230
231
232
233
234
235
236
237
238
239
240
241
242
243
244
245
246
/*
This program is free software: you can redistribute it and/or modify
it under the terms of the GNU General Public License as published by
the Free Software Foundation, either version 3 of the License, or
(at your option) any later version.
This program is distributed in the hope that it will be useful,
but WITHOUT ANY WARRANTY; without even the implied warranty of
MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE. See the
GNU General Public License for more details.
You should have received a copy of the GNU General Public License
along with this program. If not, see <http://www.gnu.org/licenses/>.
Copyright © 2009 Andrew Brown <[email protected]>
*/
#include <stdio.h>
#include <string.h>
#include "cube.h"
#include "common.h"
/*
* See helpful description of the cube representation and description of other
* conventions I use in cube.h
*/
/*
* Default "solved" cube definition
*/
const cube_type cube_solved = "\x00\x00" "\x01\x00" "\x02\x00" "\x03\x00" \
"\x04\x00" "\x05\x00" "\x06\x00" "\x07\x00" \
"\x08\x00" "\x09\x00" "\x0A\x00" "\x0B\x00" \
"\x0C\x00" "\x0D\x00" "\x0E\x00" "\x0F\x00" \
"\x10\x00" "\x11\x00" "\x12\x00" "\x13\x00";
/*
* Avoids: Turning the same face in any direction that was just turned.
* Also: for turns on the back, right, or bottom, avoids turns on the opposite
* face.
* See more detailed explanation in cube.h, along with the macro to use it
*/
const long cube_turn_avoid[] = {
/* |17<----------->0| */
0010101, /* 000001000001000001 */
0020202, /* 000010000010000010 */
0040404, /* 000100000100000100 */
0111111, /* 001001001001001001 */
0222222, /* 010010010010010010 */
0444444, /* 100100100100100100 */
0010101, /* 000001000001000001 */
0020202, /* 000010000010000010 */
0040404, /* 000100000100000100 */
0111111, /* 001001001001001001 */
0222222, /* 010010010010010010 */
0444444, /* 100100100100100100 */
0010101, /* 000001000001000001 */
0020202, /* 000010000010000010 */
0040404, /* 000100000100000100 */
0111111, /* 001001001001001001 */
0222222, /* 010010010010010010 */
0444444, /* 100100100100100100 */
};
/*
* This table is used by cube_turn to determine the cubie position id after a
* turn
* It is two dimensional:
* The first dimension goes from 0 to 19 representing the old position id
* The second dimension ranges from 0 to 17 for the turn being performed
* The value in the table is the new position.
*/
static char turn_position_lookup[20][18] = {
/* clockwise */ /* counter */ /* half-turn */
/* 0 */ { 0,0,5,2,12,0, 0,0,12,5,2,0, 0,0,17,7,14,0},
{ 1,1,1,4,8,1, 1,1,1,3,9,1, 1,1,1,6,13,1},
{ 2,2,2,7,0,14, 2,2,2,0,14,7, 2,2,2,5,12,19},
/* 3 */ { 3,3,10,1,3,3, 3,3,8,6,3,3, 3,3,15,4,3,3},
{ 4,4,4,6,4,9, 4,4,4,1,4,11, 4,4,4,3,4,16},
/* 5 */ { 5,7,17,0,5,5, 5,17,0,7,5,5, 5,19,12,2,5,5},
{ 6,11,6,3,6,6, 6,10,6,4,6,6, 6,18,6,1,6,6},
{ 7,19,7,5,7,2, 7,5,7,2,7,19, 7,17,7,0,7,14},
/* 8 */ { 8,8,3,8,13,8, 8,8,15,8,1,8, 8,8,10,8,9,8},
{ 9,9,9,9,1,16, 9,9,9,9,13,4, 9,9,9,9,8,11},
{ 10,6,15,10,10,10, 10,18,3,10,10,10, 10,11,8,10,10,10},
{ 11,18,11,11,11,4, 11,6,11,11,11,16, 11,10,11,11,11,9},
/* 12 */{ 17,12,0,12,14,12, 14,12,17,12,0,12, 19,12,5,12,2,12},
{ 15,13,13,13,9,13, 16,13,13,13,8,13, 18,13,13,13,1,13},
{ 12,14,14,14,2,19, 19,14,14,14,12,2, 17,14,14,14,0,7},
/* 15 */{ 18,15,8,15,15,15, 13,15,10,15,15,15, 16,15,3,15,15,15},
{ 13,16,16,16,16,11, 18,16,16,16,16,9, 15,16,16,16,16,4},
/* 17 */{ 19,5,12,17,17,17, 12,19,5,17,17,17, 14,7,0,17,17,17},
{ 16,10,18,18,18,18, 15,11,18,18,18,18, 13,6,18,18,18,18},
{ 14,17,19,19,19,7, 17,7,19,19,19,14, 12,5,19,19,19,2},
};
/*
* I love tables.
* This table is for determining which cubies should be turned for any
* particular face turn. The first dimension is the cubie you're considering,
* and the second dimenstion is the face of the cube being turned (0-5).
* The result is either a yes (1, turn this face), or a no (0, don't turn)
*/
static char turn_this_cubie[20][6] = {
/* 0 */ { 0,0,1,1,1,0 },
{ 0,0,0,1,1,0 },
{ 0,0,0,1,1,1 },
{ 0,0,1,1,0,0 },
{ 0,0,0,1,0,1 },
/* 5 */ { 0,1,1,1,0,0 },
{ 0,1,0,1,0,0 },
{ 0,1,0,1,0,1 },
/* 8 */ { 0,0,1,0,1,0 },
{ 0,0,0,0,1,1 },
{ 0,1,1,0,0,0 },
{ 0,1,0,0,0,1 },
/* 12 */{ 1,0,1,0,1,0 },
{ 1,0,0,0,1,0 },
{ 1,0,0,0,1,1 },
{ 1,0,1,0,0,0 },
{ 1,0,0,0,0,1 },
{ 1,1,1,0,0,0 },
{ 1,1,0,0,0,0 },
{ 1,1,0,0,0,1 }
};
/*
* I REALLY love tables (I have to think it beats a big if statement for things
* like this)
* This one maps cubie IDs to if it's a corner cubie or not
* 1 for yes, 0 for no
*/
static char corner_cubies[] = {1,0,1,0,0,1,0,1,0,0,0,0,1,0,1,0,0,1,0,1};
/*
* Table that maps a cube face and a corner cubie rotation
* to a new rotation. This should be consulted for a corner cubie
* that is on a face being rotated a quarter turn to find its new
* rotation
*/
static char corner_rotation[6][3] = {
/* FRONT */ {0, 2, 1},
/* TOP */ {1, 0, 2},
/* LEFT */ {2, 1, 0},
/* BACK */ {0, 2, 1},
/* DOWN */ {1, 0, 2},
/* RIGHT */ {2, 1, 0},
};
/*
* This method takes a pointer to the traditional 120 byte cube string, and a
* pointer to a cube_type where the new cube type will be put.
*/
int cube_120convert(const char *input, char *output)
{
int i;
for (i=0; i<20; ++i) {
/* put in the position byte */
CUBIE(output, i)[0] = (char) whichpos(input+i*6);
/* put in the rotation byte */
CUBIE(output, i)[1] = (char) whichrot(input+i*6);
}
return 1;
}
/*
* Cube Twists:
* Twists are numbered from 0 to 17, there are 18 possible twists.
* 0 through 5 are 90 degree clockwise twists of each of the faces (in order)
* Twists 6 through 11 are counterclockwise 90 degree twists of the
* corresponding face (subtract 6 from the twist to get the face it operates
* on)
* And twists 12 through 17 are 180 degree twists of the corresponding face
* (twist minus 12)
*
* Edits the cube string in-place
*
* Returns a pointer to the cube to_twist on success
* null on failure
*/
char *cube_turn(char *to_twist, int turn)
{
int i, c;
int face;
char *cubie;
if (turn >= 12) {
/* half turn */
// half turns don't change rotation, so do a tight loop
// just changing positions
for (i=0; i<20; i++) {
cubie = CUBIE(to_twist,i);
cubie[0] = turn_position_lookup[(int)cubie[0]][turn];
}
return to_twist;
} else if (turn >= 6) {
/* CC-wise turn */
face = turn - 6;
} else {
/* C-wise turn */
face = turn;
}
for (i=0,c=0; i<20 && c<8; ++i) {
/* turn each cubie */
cubie = CUBIE(to_twist,i);
if (turn_this_cubie[(int)cubie[0]][face]) {
/* Yes, we're turning this one */
++c;
if (corner_cubies[i]) {
/* And it's a corner cubie */
/* update rotation */
cubie[1] = corner_rotation[face][(int)cubie[1]];
} else {
/* it's an edge cubie */
if (face == LEFT || face == RIGHT) {
cubie[1] = (!cubie[1]);
}
}
/* now update position */
cubie[0] = turn_position_lookup[(int)cubie[0]][turn];
}
}
return to_twist;
}
/*
* I thought it'd be good to have a print method, since most debuggers try to
* interpret the characters literally which makes it hard to read. Pass in the
* cube type, and the output stream, and this prints out the cube with hex
* digits for each byte
*/
int cube_print(FILE *output, const char *cube)
{
int i;
int c;
for (i=0,c=0; i<20; ++i,++c) {
fprintf(output, "%.2X,%.2X ", (unsigned int) cube[i<<1], (unsigned int) cube[(i<<1)+1]);
if (c == 7 || c == 11) {
fprintf(output, "\n");
}
}
fprintf(output, "\n\n");
return 1;
}