1 |
bbc6da6c
|
Leszek Koltunski
|
///////////////////////////////////////////////////////////////////////////////////////////////////
|
2 |
|
|
// Copyright 2020 Leszek Koltunski //
|
3 |
|
|
// //
|
4 |
|
|
// This file is part of Magic Cube. //
|
5 |
|
|
// //
|
6 |
|
|
// Magic Cube is free software: you can redistribute it and/or modify //
|
7 |
|
|
// it under the terms of the GNU General Public License as published by //
|
8 |
|
|
// the Free Software Foundation, either version 2 of the License, or //
|
9 |
|
|
// (at your option) any later version. //
|
10 |
|
|
// //
|
11 |
|
|
// Magic Cube is distributed in the hope that it will be useful, //
|
12 |
|
|
// but WITHOUT ANY WARRANTY; without even the implied warranty of //
|
13 |
|
|
// MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE. See the //
|
14 |
|
|
// GNU General Public License for more details. //
|
15 |
|
|
// //
|
16 |
|
|
// You should have received a copy of the GNU General Public License //
|
17 |
|
|
// along with Magic Cube. If not, see <http://www.gnu.org/licenses/>. //
|
18 |
|
|
///////////////////////////////////////////////////////////////////////////////////////////////////
|
19 |
|
|
|
20 |
|
|
package org.distorted.objects;
|
21 |
|
|
|
22 |
|
|
import org.distorted.library.type.Static3D;
|
23 |
bb11be2a
|
Leszek Koltunski
|
import static org.distorted.objects.TwistyMinx.C2;
|
24 |
|
|
import static org.distorted.objects.TwistyMinx.LEN;
|
25 |
|
|
import static org.distorted.objects.TwistyMinx.SIN54;
|
26 |
|
|
import static org.distorted.objects.TwistyMinx.COS54;
|
27 |
12313693
|
Leszek Koltunski
|
import static org.distorted.objects.TwistyObject.SQ5;
|
28 |
bbc6da6c
|
Leszek Koltunski
|
|
29 |
|
|
///////////////////////////////////////////////////////////////////////////////////////////////////
|
30 |
|
|
|
31 |
a64e07d0
|
Leszek Koltunski
|
class MovementMinx extends Movement
|
32 |
bbc6da6c
|
Leszek Koltunski
|
{
|
33 |
12313693
|
Leszek Koltunski
|
static final float DIST3D = (float)Math.sqrt(0.625f+0.275f*SQ5)/3;
|
34 |
|
|
static final float DIST2D = (0.5f*SIN54/COS54)/3;
|
35 |
bbc6da6c
|
Leszek Koltunski
|
|
36 |
|
|
static final Static3D[] FACE_AXIS = new Static3D[]
|
37 |
|
|
{
|
38 |
bb11be2a
|
Leszek Koltunski
|
new Static3D( C2/LEN, SIN54/LEN, 0 ),
|
39 |
|
|
new Static3D( C2/LEN,-SIN54/LEN, 0 ),
|
40 |
|
|
new Static3D( -C2/LEN, SIN54/LEN, 0 ),
|
41 |
|
|
new Static3D( -C2/LEN,-SIN54/LEN, 0 ),
|
42 |
|
|
new Static3D( 0 , C2/LEN, SIN54/LEN ),
|
43 |
|
|
new Static3D( 0 , C2/LEN,-SIN54/LEN ),
|
44 |
|
|
new Static3D( 0 , -C2/LEN, SIN54/LEN ),
|
45 |
|
|
new Static3D( 0 , -C2/LEN,-SIN54/LEN ),
|
46 |
|
|
new Static3D( SIN54/LEN, 0 , C2/LEN ),
|
47 |
|
|
new Static3D( SIN54/LEN, 0 , -C2/LEN ),
|
48 |
|
|
new Static3D(-SIN54/LEN, 0 , C2/LEN ),
|
49 |
|
|
new Static3D(-SIN54/LEN, 0 , -C2/LEN )
|
50 |
bbc6da6c
|
Leszek Koltunski
|
};
|
51 |
|
|
|
52 |
|
|
///////////////////////////////////////////////////////////////////////////////////////////////////
|
53 |
|
|
|
54 |
a64e07d0
|
Leszek Koltunski
|
MovementMinx()
|
55 |
bbc6da6c
|
Leszek Koltunski
|
{
|
56 |
ede1b68c
|
Leszek Koltunski
|
super(TwistyMinx.ROT_AXIS, FACE_AXIS, DIST3D, DIST2D);
|
57 |
bbc6da6c
|
Leszek Koltunski
|
}
|
58 |
|
|
|
59 |
|
|
///////////////////////////////////////////////////////////////////////////////////////////////////
|
60 |
|
|
|
61 |
1ded8771
|
Leszek Koltunski
|
int computeRowFromOffset(int face, int axisIndex, int numLayers, float offset)
|
62 |
bbc6da6c
|
Leszek Koltunski
|
{
|
63 |
1ded8771
|
Leszek Koltunski
|
if( numLayers==3 )
|
64 |
ede1b68c
|
Leszek Koltunski
|
{
|
65 |
|
|
return offset<DIST2D ? 0:2;
|
66 |
|
|
}
|
67 |
1ded8771
|
Leszek Koltunski
|
if( numLayers==5 )
|
68 |
ede1b68c
|
Leszek Koltunski
|
{
|
69 |
30bc2d91
|
Leszek Koltunski
|
float quot = offset / DIST2D;
|
70 |
ede1b68c
|
Leszek Koltunski
|
|
71 |
30bc2d91
|
Leszek Koltunski
|
if( quot>0.00f && quot<=0.34f ) return 0;
|
72 |
|
|
if( quot>0.34f && quot<=1.00f ) return 1;
|
73 |
|
|
if( quot>1.00f && quot<=1.66f ) return 3;
|
74 |
|
|
if( quot>1.66f && quot<=2.00f ) return 4;
|
75 |
ede1b68c
|
Leszek Koltunski
|
}
|
76 |
|
|
|
77 |
|
|
return 0;
|
78 |
bbc6da6c
|
Leszek Koltunski
|
}
|
79 |
|
|
|
80 |
|
|
///////////////////////////////////////////////////////////////////////////////////////////////////
|
81 |
|
|
|
82 |
1ded8771
|
Leszek Koltunski
|
public float returnRotationFactor(int numLayers, int row)
|
83 |
bbc6da6c
|
Leszek Koltunski
|
{
|
84 |
|
|
return 1.0f;
|
85 |
|
|
}
|
86 |
|
|
|
87 |
|
|
///////////////////////////////////////////////////////////////////////////////////////////////////
|
88 |
451c6c36
|
Leszek Koltunski
|
// return angle (in radians) that the line connecting the center C of the pentagonal face and the
|
89 |
|
|
// first vertex of the pentagon makes with a vertical line coming upwards from the center C.
|
90 |
|
|
|
91 |
|
|
private float returnAngle(int face)
|
92 |
|
|
{
|
93 |
|
|
switch(face)
|
94 |
|
|
{
|
95 |
|
|
case 0:
|
96 |
|
|
case 2:
|
97 |
|
|
case 6:
|
98 |
|
|
case 7: return 0.0f;
|
99 |
|
|
case 1:
|
100 |
|
|
case 3:
|
101 |
|
|
case 4:
|
102 |
|
|
case 5: return (float)(36*Math.PI/180);
|
103 |
|
|
case 9:
|
104 |
|
|
case 10: return (float)(54*Math.PI/180);
|
105 |
|
|
case 8:
|
106 |
|
|
case 11: return (float)(18*Math.PI/180);
|
107 |
|
|
}
|
108 |
|
|
|
109 |
|
|
return 0.0f;
|
110 |
|
|
}
|
111 |
|
|
|
112 |
|
|
///////////////////////////////////////////////////////////////////////////////////////////////////
|
113 |
|
|
// The pair (distance,angle) defines a point P in R^2 in polar coordinate system. Let V be the vector
|
114 |
|
|
// from the center of the coordinate system to P.
|
115 |
|
|
// Let P' be the point defined by polar (distance,angle+PI/2). Let Lh be the half-line starting at
|
116 |
|
|
// P' and going in the direction of V.
|
117 |
|
|
// Return true iff point 'point' lies on the left of Lh, i.e. when we rotate (using the center of
|
118 |
|
|
// the coordinate system as the center of rotation) 'point' and Lh in such a way that Lh points
|
119 |
|
|
// directly upwards, is 'point' on the left or the right of it?
|
120 |
|
|
|
121 |
|
|
private boolean isOnTheLeft(float[] point, float distance, float angle)
|
122 |
|
|
{
|
123 |
|
|
float sin = (float)Math.sin(angle);
|
124 |
|
|
float cos = (float)Math.cos(angle);
|
125 |
|
|
|
126 |
|
|
float vx = point[0] + sin*distance;
|
127 |
|
|
float vy = point[1] - cos*distance;
|
128 |
|
|
|
129 |
|
|
return vx*sin < vy*cos;
|
130 |
|
|
}
|
131 |
|
|
|
132 |
|
|
///////////////////////////////////////////////////////////////////////////////////////////////////
|
133 |
|
|
// Return 1,2,3,4,5 - the vertex of the pentagon to which point 'point' is the closest, if the
|
134 |
|
|
// 'point' is inside the pentagon - or 0 otherwise.
|
135 |
|
|
// The 'first' vertex is the one we meet the first when we rotate clockwise starting from 12:00.
|
136 |
|
|
// This vertex makes angle 'returnAngle()' with the line coming out upwards from the center of the
|
137 |
|
|
// pentagon.
|
138 |
|
|
// Distance from the center to a vertex of the pentagon = 1/(6*COS54)
|
139 |
|
|
|
140 |
|
|
private int returnPartOfThePentagon(float[] point, int face)
|
141 |
|
|
{
|
142 |
|
|
float angle = returnAngle(face);
|
143 |
|
|
float A = (float)(Math.PI/5);
|
144 |
|
|
|
145 |
|
|
for(int i=0; i<5; i++)
|
146 |
|
|
{
|
147 |
|
|
if( isOnTheLeft(point, DIST2D, (9-2*i)*A-angle) ) return 0;
|
148 |
|
|
}
|
149 |
|
|
|
150 |
|
|
if( isOnTheLeft(point, 0, 2.5f*A-angle) )
|
151 |
|
|
{
|
152 |
|
|
if( isOnTheLeft(point, 0, 3.5f*A-angle) )
|
153 |
|
|
{
|
154 |
|
|
return isOnTheLeft(point, 0, 5.5f*A-angle) ? 4 : 5;
|
155 |
|
|
}
|
156 |
|
|
else return 1;
|
157 |
|
|
}
|
158 |
|
|
else
|
159 |
|
|
{
|
160 |
|
|
if( isOnTheLeft(point, 0, 4.5f*A-angle) )
|
161 |
|
|
{
|
162 |
|
|
return 3;
|
163 |
|
|
}
|
164 |
|
|
else
|
165 |
|
|
{
|
166 |
|
|
return isOnTheLeft(point, 0, 6.5f*A-angle) ? 2 : 1;
|
167 |
|
|
}
|
168 |
|
|
}
|
169 |
|
|
}
|
170 |
|
|
|
171 |
|
|
///////////////////////////////////////////////////////////////////////////////////////////////////
|
172 |
bbc6da6c
|
Leszek Koltunski
|
|
173 |
|
|
boolean isInsideFace(int face, float[] p)
|
174 |
|
|
{
|
175 |
451c6c36
|
Leszek Koltunski
|
return returnPartOfThePentagon(p,face) > 0;
|
176 |
bbc6da6c
|
Leszek Koltunski
|
}
|
177 |
|
|
|
178 |
|
|
///////////////////////////////////////////////////////////////////////////////////////////////////
|
179 |
|
|
|
180 |
|
|
void computeEnabledAxis(int face, float[] touchPoint, int[] enabled)
|
181 |
|
|
{
|
182 |
451c6c36
|
Leszek Koltunski
|
int part = returnPartOfThePentagon(touchPoint,face);
|
183 |
bbc6da6c
|
Leszek Koltunski
|
|
184 |
451c6c36
|
Leszek Koltunski
|
if( part>0 )
|
185 |
bbc6da6c
|
Leszek Koltunski
|
{
|
186 |
451c6c36
|
Leszek Koltunski
|
enabled[0] = 2;
|
187 |
|
|
|
188 |
|
|
switch(face)
|
189 |
|
|
{
|
190 |
|
|
case 0: switch(part)
|
191 |
|
|
{
|
192 |
|
|
case 1: enabled[1]=2; enabled[2]=3; break;
|
193 |
|
|
case 2: enabled[1]=3; enabled[2]=5; break;
|
194 |
|
|
case 3: enabled[1]=5; enabled[2]=1; break;
|
195 |
|
|
case 4: enabled[1]=1; enabled[2]=4; break;
|
196 |
|
|
case 5: enabled[1]=4; enabled[2]=2; break;
|
197 |
|
|
}
|
198 |
|
|
break;
|
199 |
|
|
|
200 |
|
|
case 1: switch(part)
|
201 |
|
|
{
|
202 |
|
|
case 1: enabled[1]=0; enabled[2]=5; break;
|
203 |
|
|
case 2: enabled[1]=5; enabled[2]=2; break;
|
204 |
|
|
case 3: enabled[1]=2; enabled[2]=3; break;
|
205 |
|
|
case 4: enabled[1]=3; enabled[2]=4; break;
|
206 |
|
|
case 5: enabled[1]=4; enabled[2]=0; break;
|
207 |
|
|
}
|
208 |
|
|
break;
|
209 |
|
|
|
210 |
|
|
case 2: switch(part)
|
211 |
|
|
{
|
212 |
|
|
case 1: enabled[1]=3; enabled[2]=2; break;
|
213 |
|
|
case 2: enabled[1]=2; enabled[2]=5; break;
|
214 |
|
|
case 3: enabled[1]=5; enabled[2]=0; break;
|
215 |
|
|
case 4: enabled[1]=0; enabled[2]=4; break;
|
216 |
|
|
case 5: enabled[1]=4; enabled[2]=3; break;
|
217 |
|
|
}
|
218 |
|
|
break;
|
219 |
|
|
|
220 |
|
|
case 3: switch(part)
|
221 |
|
|
{
|
222 |
|
|
case 1: enabled[1]=1; enabled[2]=5; break;
|
223 |
|
|
case 2: enabled[1]=5; enabled[2]=3; break;
|
224 |
|
|
case 3: enabled[1]=3; enabled[2]=2; break;
|
225 |
|
|
case 4: enabled[1]=2; enabled[2]=4; break;
|
226 |
|
|
case 5: enabled[1]=4; enabled[2]=1; break;
|
227 |
|
|
}
|
228 |
|
|
break;
|
229 |
|
|
|
230 |
|
|
case 4: switch(part)
|
231 |
|
|
{
|
232 |
|
|
case 1: enabled[1]=3; enabled[2]=0; break;
|
233 |
|
|
case 2: enabled[1]=0; enabled[2]=4; break;
|
234 |
|
|
case 3: enabled[1]=4; enabled[2]=5; break;
|
235 |
|
|
case 4: enabled[1]=5; enabled[2]=1; break;
|
236 |
|
|
case 5: enabled[1]=1; enabled[2]=3; break;
|
237 |
|
|
}
|
238 |
|
|
break;
|
239 |
|
|
|
240 |
|
|
case 5: switch(part)
|
241 |
|
|
{
|
242 |
|
|
case 1: enabled[1]=2; enabled[2]=1; break;
|
243 |
|
|
case 2: enabled[1]=1; enabled[2]=4; break;
|
244 |
|
|
case 3: enabled[1]=4; enabled[2]=5; break;
|
245 |
|
|
case 4: enabled[1]=5; enabled[2]=0; break;
|
246 |
|
|
case 5: enabled[1]=0; enabled[2]=2; break;
|
247 |
|
|
}
|
248 |
|
|
break;
|
249 |
|
|
|
250 |
|
|
case 6: switch(part)
|
251 |
|
|
{
|
252 |
|
|
case 1: enabled[1]=5; enabled[2]=4; break;
|
253 |
|
|
case 2: enabled[1]=4; enabled[2]=1; break;
|
254 |
|
|
case 3: enabled[1]=1; enabled[2]=2; break;
|
255 |
|
|
case 4: enabled[1]=2; enabled[2]=0; break;
|
256 |
|
|
case 5: enabled[1]=0; enabled[2]=5; break;
|
257 |
|
|
}
|
258 |
|
|
break;
|
259 |
|
|
|
260 |
|
|
case 7: switch(part)
|
261 |
|
|
{
|
262 |
|
|
case 1: enabled[1]=5; enabled[2]=4; break;
|
263 |
|
|
case 2: enabled[1]=4; enabled[2]=0; break;
|
264 |
|
|
case 3: enabled[1]=0; enabled[2]=3; break;
|
265 |
|
|
case 4: enabled[1]=3; enabled[2]=1; break;
|
266 |
|
|
case 5: enabled[1]=1; enabled[2]=5; break;
|
267 |
|
|
}
|
268 |
|
|
break;
|
269 |
|
|
|
270 |
|
|
case 8: switch(part)
|
271 |
|
|
{
|
272 |
|
|
case 1: enabled[1]=2; enabled[2]=0; break;
|
273 |
|
|
case 2: enabled[1]=0; enabled[2]=1; break;
|
274 |
|
|
case 3: enabled[1]=1; enabled[2]=3; break;
|
275 |
|
|
case 4: enabled[1]=3; enabled[2]=5; break;
|
276 |
|
|
case 5: enabled[1]=5; enabled[2]=2; break;
|
277 |
|
|
}
|
278 |
|
|
break;
|
279 |
|
|
|
280 |
|
|
case 9: switch(part)
|
281 |
|
|
{
|
282 |
|
|
case 1: enabled[1]=3; enabled[2]=4; break;
|
283 |
|
|
case 2: enabled[1]=4; enabled[2]=2; break;
|
284 |
|
|
case 3: enabled[1]=2; enabled[2]=1; break;
|
285 |
|
|
case 4: enabled[1]=1; enabled[2]=0; break;
|
286 |
|
|
case 5: enabled[1]=0; enabled[2]=3; break;
|
287 |
|
|
}
|
288 |
|
|
break;
|
289 |
|
|
|
290 |
|
|
case 10: switch(part)
|
291 |
|
|
{
|
292 |
|
|
case 1: enabled[1]=2; enabled[2]=4; break;
|
293 |
|
|
case 2: enabled[1]=4; enabled[2]=3; break;
|
294 |
|
|
case 3: enabled[1]=3; enabled[2]=0; break;
|
295 |
|
|
case 4: enabled[1]=0; enabled[2]=1; break;
|
296 |
|
|
case 5: enabled[1]=1; enabled[2]=2; break;
|
297 |
|
|
}
|
298 |
|
|
break;
|
299 |
|
|
|
300 |
|
|
case 11: switch(part)
|
301 |
|
|
{
|
302 |
|
|
case 1: enabled[1]=3; enabled[2]=1; break;
|
303 |
|
|
case 2: enabled[1]=1; enabled[2]=0; break;
|
304 |
|
|
case 3: enabled[1]=0; enabled[2]=2; break;
|
305 |
|
|
case 4: enabled[1]=2; enabled[2]=5; break;
|
306 |
|
|
case 5: enabled[1]=5; enabled[2]=3; break;
|
307 |
|
|
}
|
308 |
|
|
break;
|
309 |
|
|
}
|
310 |
|
|
}
|
311 |
|
|
else
|
312 |
|
|
{
|
313 |
|
|
enabled[0] = 0;
|
314 |
bbc6da6c
|
Leszek Koltunski
|
}
|
315 |
|
|
}
|
316 |
|
|
}
|