Commit | Line | Data |
---|---|---|
e28f168c | 1 | //---------------------------------------------------------------------------------------------------------------------------------- |
4404e6b8 | 2 | xyz mMax, mCtr, mHalf; |
596f331f | 3 | int NumApcRows=4, NumApcCols=8; |
e28f168c | 4 | |
4404e6b8 | 5 | boolean btwn (int a,int b,int c) { return a >= b && a <= c; } |
6 | boolean btwn (double a,double b,double c) { return a >= b && a <= c; } | |
7 | float interp (float a, float b, float c) { return (1-a)*b + a*c; } | |
8 | float randctr (float a) { return random(a) - a*.5; } | |
9 | float min (float a, float b, float c, float d) { return min(min(a,b),min(c,d)); } | |
935819e6 | 10 | float pointDist(Point p1, Point p2) { return dist(p1.x,p1.y,p1.z,p2.x,p2.y,p2.z); } |
11 | float distToSeg(float x, float y, float x1, float y1, float x2, float y2) { | |
4404e6b8 | 12 | float A = x - x1, B = y - y1, C = x2 - x1, D = y2 - y1; |
13 | float dot = A * C + B * D, len_sq = C * C + D * D; | |
14 | float xx, yy,param = dot / len_sq; | |
15 | ||
16 | if (param < 0 || (x1 == x2 && y1 == y2)) { xx = x1; yy = y1; } | |
17 | else if (param > 1) { xx = x2; yy = y2; } | |
18 | else { xx = x1 + param * C; | |
19 | yy = y1 + param * D; } | |
20 | float dx = x - xx, dy = y - yy; | |
21 | return sqrt(dx * dx + dy * dy); | |
22 | } | |
23 | ||
e28f168c AG |
24 | |
25 | public class Pick { | |
596f331f | 26 | int NumPicks, Default , |
27 | CurRow , CurCol , | |
6680a94a | 28 | StartRow, EndRow ; |
29 | String tag , Desc[] ; | |
596f331f | 30 | |
32986078 | 31 | Pick (String label, int _Def, int _Num, int nStart, String d[]) { |
32 | NumPicks = _Num; Default = _Def; | |
33 | StartRow = nStart; EndRow = StartRow + floor((NumPicks-1) / NumApcCols); | |
6680a94a | 34 | tag = label; Desc = d; |
35 | reset(); | |
36 | } | |
3661fcee | 37 | |
38 | int Cur() { return (CurRow-StartRow)*NumApcCols + CurCol; } | |
39 | String CurDesc() { return Desc[Cur()]; } | |
40 | void reset() { CurCol = Default % NumApcCols; CurRow = StartRow + Default / NumApcCols; } | |
41 | ||
42 | boolean set(int r, int c) { | |
43 | if (!btwn(r,StartRow,EndRow) || !btwn(c,0,NumApcCols-1) || | |
44 | !btwn((r-StartRow)*NumApcCols + c,0,NumPicks-1)) return false; | |
45 | CurRow=r; CurCol=c; return true; | |
46 | } | |
e28f168c | 47 | } |
6680a94a | 48 | |
49 | public class DBool { | |
50 | boolean def, b; | |
51 | String tag; | |
52 | int row, col; | |
53 | void reset() { b = def; } | |
3661fcee | 54 | boolean set (int r, int c, boolean val) { if (r != row || c != col) return false; b = val; return true; } |
6680a94a | 55 | DBool(String _tag, boolean _def, int _row, int _col) { |
56 | def = _def; b = _def; tag = _tag; row = _row; col = _col; | |
57 | } | |
58 | } | |
59 | ||
60 | public class DParam extends BasicParameter { | |
ef52f20b | 61 | double dflt; |
6680a94a | 62 | DParam (String label, double value) { super(label,value); dflt=value; } |
3661fcee | 63 | void set (double value) { super.setValue(value); } |
e28f168c | 64 | float Val () { return getValuef(); } |
e28f168c | 65 | } |
e28f168c | 66 | //---------------------------------------------------------------------------------------------------------------------------------- |
41f26e8f | 67 | public class xyz { float x,y,z; // extends pVector; eliminate half of the functions |
e28f168c | 68 | xyz() {x=y=z=0;} |
190d91c2 | 69 | xyz(Point p ) {x=p.x ; y=p.y; z=p.z;} |
4404e6b8 | 70 | xyz(xyz p ) {set(p); } |
e28f168c | 71 | xyz(float _x,float _y,float _z) {x=_x ; y=_y ; z=_z ;} |
190d91c2 | 72 | void set(Point p ) {x=p.x ; y=p.y; z=p.z;} |
3661fcee | 73 | void set(xyz p ) {x=p.x ; y=p.y ; z=p.z ;} |
e28f168c | 74 | void set(float _x,float _y,float _z) {x=_x ; y=_y ; z=_z ;} |
3661fcee | 75 | |
4404e6b8 | 76 | void zoomX (float zx) {x = x*zx - mMax.x*(zx-1)/2; } |
77 | void zoomY (float zy) {y = y*zy - mMax.y*(zy-1)/2; } | |
3661fcee | 78 | |
c9e7c456 | 79 | float distance(xyz b) {return dist(x,y,z,b.x,b.y,b.z); } |
4404e6b8 | 80 | float distance(float _x, float _y) {return dist(x,y,_x,_y); } |
c9e7c456 | 81 | float dot (xyz b) {return x*b.x + y*b.y + z*b.z; } |
6680a94a | 82 | void add (xyz b) {x += b.x; y += b.y; z += b.z; } |
83 | void add (float b) {x += b ; y += b ; z += b ; } | |
3661fcee | 84 | void subtract(xyz b) {x -= b.x; y -= b.y; z -= b.z; } |
4404e6b8 | 85 | void scale (float b) {x *= b ; y *= b ; z *= b ; } |
c9e7c456 | 86 | |
596f331f | 87 | void rotateZ (xyz o, float nSin, float nCos) { |
c9e7c456 | 88 | float nX = nCos*(x-o.x) - nSin*(y-o.y) + o.x; |
89 | float nY = nSin*(x-o.x) + nCos*(y-o.y) + o.y; | |
90 | x = nX; y = nY; | |
91 | } | |
dd00b10f | 92 | |
596f331f | 93 | void rotateX (xyz o, float nSin, float nCos) { |
c9e7c456 | 94 | float nY = nCos*(y-o.y) - nSin*(z-o.z) + o.y; |
95 | float nZ = nSin*(y-o.y) + nCos*(z-o.z) + o.z; | |
96 | y = nY; z = nZ; | |
97 | } | |
98 | ||
596f331f | 99 | void rotateY (xyz o, float nSin, float nCos) { |
c9e7c456 | 100 | float nZ = nCos*(z-o.z) - nSin*(x-o.x) + o.z; |
101 | float nX = nSin*(z-o.z) + nCos*(x-o.x) + o.x; | |
102 | z = nZ; x = nX; | |
dd00b10f | 103 | } |
104 | ||
4404e6b8 | 105 | void setRand () { x = random(mMax.x); y = random(mMax.y); z = random(mMax.z); } |
106 | void setNorm () { x /= mMax.x; y /= mMax.y; z /= mMax.z; } | |
3661fcee | 107 | void interpolate(float i, xyz d) { x = interp(i,x,d.x); y = interp(i,y,d.y); z = interp(i,z,d.z); } |
e28f168c AG |
108 | } |
109 | //---------------------------------------------------------------------------------------------------------------------------------- | |
935819e6 | 110 | public class DPat extends SCPattern |
111 | { | |
935819e6 | 112 | ArrayList<Pick> picks = new ArrayList<Pick> (); |
113 | ArrayList<DBool> bools = new ArrayList<DBool> (); | |
114 | ArrayList<DParam> params = new ArrayList<DParam>(); | |
73687629 | 115 | |
596f331f | 116 | MidiOutput APCOut; |
3661fcee | 117 | int nMaxRow = 53; |
6680a94a | 118 | float LastQuant = -1, LastJog = -1; |
32986078 | 119 | float[] xWaveNz, yWaveNz; |
dd00b10f | 120 | int nPoint , nPoints; |
4404e6b8 | 121 | xyz xyzJog = new xyz(), vT1 = new xyz(), vT2 = new xyz(); |
122 | xyz modmin; | |
af83f61c | 123 | |
dd00b10f | 124 | float NoiseMove = random(10000); |
935819e6 | 125 | DParam pSpark, pWave, pRotX, pRotY, pRotZ, pSpin, pTransX, pTransY; |
935819e6 | 126 | DBool pXsym, pYsym, pRsym, pXdup, pXtrip, pJog, pGrey; |
596f331f | 127 | |
e5308763 | 128 | float lxh () { return lx.getBaseHuef(); } |
32986078 | 129 | int c1c (float a) { return round(100*constrain(a,0,1)); } |
130 | float interpWv(float i, float[] vals) { return interp(i-floor(i), vals[floor(i)], vals[ceil(i)]); } | |
131 | ||
4404e6b8 | 132 | float CalcCone (xyz v1, xyz v2, xyz c) { vT1.set(v1); vT2.set(v2); vT1.subtract(c); vT2.subtract(c); |
133 | return degrees( acos ( vT1.dot(vT2) / (sqrt(vT1.dot(vT1)) * sqrt(vT2.dot(vT2)) ) )); } | |
32986078 | 134 | |
dd00b10f | 135 | void StartRun(double deltaMs) { } |
e5308763 | 136 | color CalcPoint(xyz p) { return lx.hsb(0,0,0); } |
4404e6b8 | 137 | color blend3(color c1, color c2, color c3){ return blendColor(c1,blendColor(c2,c3,ADD),ADD); } |
e28f168c | 138 | |
6680a94a | 139 | DParam addParam(String label, double value) { |
140 | DParam P = new DParam(label, value); | |
e28f168c | 141 | super.addParameter(P); |
6680a94a | 142 | params.add(P); return P; |
e28f168c | 143 | } |
af83f61c | 144 | |
596f331f | 145 | Pick addPick(String name, int def, int _max, String[] desc) { |
32986078 | 146 | Pick P = new Pick(name, def, _max+1, nMaxRow, desc); |
e28f168c | 147 | nMaxRow = P.EndRow + 1; |
dd00b10f | 148 | picks.add(P); |
e28f168c AG |
149 | return P; |
150 | } | |
3661fcee | 151 | |
596f331f | 152 | boolean noteOff(Note note) { |
153 | int row = note.getPitch(), col = note.getChannel(); | |
a1396b9e | 154 | for (int i=0; i<bools.size(); i++) if (bools.get(i).set(row, col, false)) { presetManager.dirty(this); return true; } |
596f331f | 155 | updateLights(); return false; |
156 | } | |
157 | ||
158 | boolean noteOn(Note note) { | |
159 | int row = note.getPitch(), col = note.getChannel(); | |
a1396b9e MS |
160 | for (int i=0; i<picks.size(); i++) if (picks.get(i).set(row, col)) { presetManager.dirty(this); return true; } |
161 | for (int i=0; i<bools.size(); i++) if (bools.get(i).set(row, col, true)) { presetManager.dirty(this); return true; } | |
596f331f | 162 | if (row == 84 && col==0) { onReset(); return true; } |
163 | println("row: " + row + " col: " + col); return false; | |
164 | } | |
165 | ||
166 | void onInactive() { uiDebugText.setText(""); } | |
167 | void onReset() { | |
168 | for (int i=0; i<params.size(); i++) params.get(i).reset(); | |
169 | for (int i=0; i<bools .size(); i++) bools.get(i).reset(); | |
170 | for (int i=0; i<picks .size(); i++) picks.get(i).reset(); | |
a1396b9e | 171 | presetManager.dirty(this); |
596f331f | 172 | updateLights(); |
173 | } | |
174 | ||
dd00b10f | 175 | DPat(GLucose glucose) { |
176 | super(glucose); | |
af83f61c | 177 | |
935819e6 | 178 | pSpark = addParam("Sprk", 0); |
179 | pWave = addParam("Wave", 0); | |
af83f61c | 180 | pTransX = addParam("TrnX", .5); |
181 | pTransY = addParam("TrnY", .5); | |
182 | pRotX = addParam("RotX", .5); | |
183 | pRotY = addParam("RotY", .5); | |
184 | pRotZ = addParam("RotZ", .5); | |
185 | pSpin = addParam("Spin", .5); | |
186 | ||
4404e6b8 | 187 | nPoints = model.points.size(); |
935819e6 | 188 | pXsym = new DBool("X-SYM", false, 48, 0); bools.add(pXsym ); |
189 | pYsym = new DBool("Y-SYM", false, 48, 1); bools.add(pYsym ); | |
190 | pRsym = new DBool("R-SYM", false, 48, 2); bools.add(pRsym ); | |
191 | pXdup = new DBool("X-DUP", false, 48, 3); bools.add(pXdup ); | |
192 | pJog = new DBool("JOG" , false, 48, 4); bools.add(pJog ); | |
193 | pGrey = new DBool("GREY" , false, 48, 5); bools.add(pGrey ); | |
73687629 | 194 | |
4404e6b8 | 195 | modmin = new xyz(model.xMin, model.yMin, model.zMin); |
196 | mMax = new xyz(model.xMax, model.yMax, model.zMax); mMax.subtract(modmin); | |
197 | mCtr = new xyz(mMax); mCtr.scale(.5); | |
198 | mHalf = new xyz(.5,.5,.5); | |
32986078 | 199 | xWaveNz = new float[ceil(mMax.y)+1]; |
200 | yWaveNz = new float[ceil(mMax.x)+1]; | |
73687629 | 201 | |
4404e6b8 | 202 | //println (model.xMin + " " + model.yMin + " " + model.zMin); |
203 | //println (model.xMax + " " + model.yMax + " " + model.zMax); | |
1b65b8ce MS |
204 | //for (MidiOutputDevice o: RWMidi.getOutputDevices()) { if (o.toString().contains("APC")) { APCOut = o.createOutput(); break;}} |
205 | } | |
206 | ||
207 | void setAPCOutput(MidiOutput output) { | |
208 | APCOut = output; | |
dd00b10f | 209 | } |
210 | ||
596f331f | 211 | void updateLights() { if (APCOut == null) return; |
212 | for (int i = 0; i < NumApcRows; ++i) | |
1b65b8ce MS |
213 | for (int j = 0; j < 8; ++j) APCOut.sendNoteOn(j, 53+i, 0); |
214 | for (int i=0; i<picks .size(); i++) APCOut.sendNoteOn(picks.get(i).CurCol, picks.get(i).CurRow, 3); | |
596f331f | 215 | for (int i=0; i<bools .size(); i++) if (bools.get(i).b) APCOut.sendNoteOn (bools.get(i).col, bools.get(i).row, 1); |
216 | else APCOut.sendNoteOff (bools.get(i).col, bools.get(i).row, 0); | |
217 | } | |
218 | ||
dd00b10f | 219 | void run(double deltaMs) |
220 | { | |
935819e6 | 221 | if (deltaMs > 100) return; |
596f331f | 222 | |
223 | if (this == midiEngine.getFocusedDeck().getActivePattern()) { | |
224 | String Text1="", Text2=""; | |
225 | for (int i=0; i<bools.size(); i++) if (bools.get(i).b) Text1 += " " + bools.get(i).tag + " "; | |
226 | for (int i=0; i<picks.size(); i++) Text1 += picks.get(i).tag + ": " + picks.get(i).CurDesc() + " "; | |
227 | uiDebugText.setText(Text1, Text2); | |
228 | } | |
229 | ||
32986078 | 230 | NoiseMove += deltaMs; NoiseMove = NoiseMove % 1e7; |
dd00b10f | 231 | StartRun (deltaMs); |
3661fcee | 232 | xyz P = new xyz(), tP = new xyz(), pSave = new xyz(); |
af83f61c | 233 | xyz pTrans = new xyz(pTransX.Val()*200-100, pTransY.Val()*100-50,0); |
dd00b10f | 234 | nPoint = 0; |
af83f61c | 235 | |
6680a94a | 236 | if (pJog.b) { |
237 | float tRamp = (lx.tempo.rampf() % .25); | |
4404e6b8 | 238 | if (tRamp < LastJog) xyzJog.set(randctr(mMax.x*.2), randctr(mMax.y*.2), randctr(mMax.z*.2)); |
6680a94a | 239 | LastJog = tRamp; |
240 | } | |
241 | ||
32986078 | 242 | // precalculate this stuff |
935819e6 | 243 | float wvAmp = pWave.Val(), sprk = pSpark.Val(); |
244 | if (wvAmp > 0) { | |
245 | for (int i=0; i<ceil(mMax.x)+1; i++) | |
246 | yWaveNz[i] = wvAmp * (noise(i/(mMax.x*.3)-(2e3+NoiseMove)/1500.) - .5) * (mMax.y/2.); | |
32986078 | 247 | |
935819e6 | 248 | for (int i=0; i<ceil(mMax.y)+1; i++) |
249 | xWaveNz[i] = wvAmp * (noise(i/(mMax.y*.3)-(1e3+NoiseMove)/1500.) - .5) * (mMax.x/2.); | |
250 | } | |
e5308763 | 251 | |
32986078 | 252 | for (Point p : model.points) { nPoint++; |
dd00b10f | 253 | P.set(p); |
4404e6b8 | 254 | P.subtract(modmin); |
af83f61c | 255 | P.subtract(pTrans); |
935819e6 | 256 | if (sprk > 0) {P.y += sprk*randctr(50); P.x += sprk*randctr(50); P.z += sprk*randctr(50); } |
257 | if (wvAmp > 0) P.y += interpWv(p.x-modmin.x, yWaveNz); | |
258 | if (wvAmp > 0) P.x += interpWv(p.y-modmin.y, xWaveNz); | |
32986078 | 259 | if (pJog.b) P.add(xyzJog); |
260 | ||
dd00b10f | 261 | |
4404e6b8 | 262 | color cNew, cOld = colors[p.index]; |
263 | { tP.set(P); cNew = CalcPoint(tP); } | |
264 | if (pXsym.b) { tP.set(mMax.x-P.x,P.y,P.z); cNew = blendColor(cNew, CalcPoint(tP), ADD); } | |
265 | if (pYsym.b) { tP.set(P.x,mMax.y-P.y,P.z); cNew = blendColor(cNew, CalcPoint(tP), ADD); } | |
266 | if (pRsym.b) { tP.set(mMax.x-P.x,mMax.y-P.y,mMax.z-P.z); cNew = blendColor(cNew, CalcPoint(tP), ADD); } | |
267 | if (pXdup.b) { tP.set((P.x+mMax.x*.5)%mMax.x,P.y,P.z); cNew = blendColor(cNew, CalcPoint(tP), ADD); } | |
935819e6 | 268 | if (pGrey.b) { cNew = lx.hsb(0, 0, lx.b(cNew)); } |
269 | colors[p.index] = cNew; | |
dd00b10f | 270 | } |
271 | } | |
e28f168c | 272 | } |
190d91c2 | 273 | //---------------------------------------------------------------------------------------------------------------------------------- |
0fbf977b | 274 | class dTurn { |
275 | dVertex v; | |
e5308763 | 276 | int pos0, pos1; |
0fbf977b | 277 | dTurn(int _pos0, dVertex _v, int _pos1) { v = _v; pos0 = _pos0; pos1 = _pos1; } |
278 | } | |
279 | ||
280 | class dVertex { | |
e5308763 | 281 | dVertex c0, c1, // connections on the cube |
282 | opp, same; // opp - same strip, opp direction | |
283 | // same - same strut, diff strip, dir | |
0fbf977b | 284 | dTurn t0, t1; |
0f9ea23f | 285 | Strip s; |
286 | int dir, ci; // dir -- 1 or -1. | |
287 | // ci -- color index | |
0fbf977b | 288 | |
0f9ea23f | 289 | dVertex(Strip _s, Point _p) { s = _s; ci = _p.index; } |
290 | Point getPoint(int i) { return s.points.get(dir>0 ? i : 15-i); } | |
0fbf977b | 291 | void setOpp(dVertex _opp) { opp = _opp; dir = (ci < opp.ci ? 1 : -1); } |
292 | } | |
0fbf977b | 293 | //---------------------------------------------------------------------------------------------------------------------------------- |
e5308763 | 294 | class dPixel { dVertex v; int pos; dPixel(dVertex _v, int _pos) { v=_v; pos=_pos; } } |
0fbf977b | 295 | class dLattice { |
0fbf977b | 296 | void addTurn(dVertex v0, int pos0, dVertex v1, int pos1) { dTurn t = new dTurn(pos0, v1, pos1); if (v0.t0 == null) v0.t0=t; else v0.t1=t; } |
935819e6 | 297 | float dist2 (Strip s1, int pos1, Strip s2, int pos2) { return pointDist(s1.points.get(pos1), s2.points.get(pos2)); } |
298 | float pd2 (Point p1, float x, float y, float z) { return dist(p1.x,p1.y,p1.z,x,y,z); } | |
299 | boolean sameSame (Strip s1, Strip s2) { return max(dist2(s1, 0, s2, 0), dist2(s1,15, s2,15)) < 5 ; } // same strut, same direction | |
300 | boolean sameOpp (Strip s1, Strip s2) { return max(dist2(s1, 0, s2,15), dist2(s1,15, s2,0 )) < 5 ; } // same strut, opp direction | |
301 | boolean sameBar (Strip s1, Strip s2) { return sameSame(s1,s2) || sameOpp(s1,s2); } // 2 strips on same strut | |
302 | void addJoint (dVertex v1, dVertex v2) { | |
0fbf977b | 303 | // should probably replace parallel but further with the new one |
0f9ea23f | 304 | if (v1.c0 != null && sameBar(v2.s, v1.c0.s)) return; |
305 | if (v1.c1 != null && sameBar(v2.s, v1.c1.s)) return; | |
0fbf977b | 306 | if (v1.c0 == null) v1.c0 = v2; |
307 | else if (v1.c1 == null) v1.c1 = v2; | |
308 | } | |
309 | ||
0f9ea23f | 310 | dVertex v0(Strip s) { return (dVertex)s.obj1; } |
311 | dVertex v1(Strip s) { return (dVertex)s.obj2; } | |
312 | ||
41f26e8f | 313 | dPixel getClosest(xyz p) { |
314 | dVertex v = null; int pos=0; float d = 500; | |
0f9ea23f | 315 | |
316 | for (Strip s : glucose.model.strips) { | |
317 | float nd = pd2(s.points.get(0),p.x,p.y,p.z); if (nd < d) { v=v0(s); d=nd; pos=0; } | |
41f26e8f | 318 | if (nd > 30) continue; |
319 | for (int k=0; k<=15; k++) { | |
0f9ea23f | 320 | nd = pd2(s.points.get(k),p.x,p.y,p.z); if (nd < d) { v =v0(s); d=nd; pos=k; } |
41f26e8f | 321 | } |
322 | } | |
323 | return random(2) < 1 ? new dPixel(v,pos) : new dPixel(v.opp,15-pos); | |
324 | } | |
325 | ||
0fbf977b | 326 | dLattice() { |
41f26e8f | 327 | lattice=this; |
0f9ea23f | 328 | |
329 | for (Strip s : glucose.model.strips) { | |
330 | dVertex vrtx0 = new dVertex(s,s.points.get(0 )); s.obj1=vrtx0; | |
331 | dVertex vrtx1 = new dVertex(s,s.points.get(15)); s.obj2=vrtx1; | |
332 | vrtx0.setOpp(vrtx1); vrtx1.setOpp(vrtx0); | |
0fbf977b | 333 | } |
334 | ||
0f9ea23f | 335 | for (Strip s1 : glucose.model.strips) { for (Strip s2 : glucose.model.strips) { |
336 | if (s1.points.get(0).index < s2.points.get(0).index) continue; | |
0fbf977b | 337 | int c=0; |
0f9ea23f | 338 | if (sameSame(s1,s2)) { v0(s1).same = v0(s2); v1(s1).same = v1(s2); |
339 | v0(s2).same = v0(s1); v1(s2).same = v1(s1); continue; } // parallel | |
340 | if (sameOpp (s1,s2)) { v0(s1).same = v1(s2); v1(s1).same = v0(s2); | |
341 | v0(s2).same = v1(s1); v1(s2).same = v0(s1); continue; } // parallel | |
342 | if (dist2(s1, 0, s2, 0) < 5) { c++; addJoint(v1(s1), v0(s2)); addJoint(v1(s2), v0(s1)); } | |
343 | if (dist2(s1, 0, s2,15) < 5) { c++; addJoint(v1(s1), v1(s2)); addJoint(v0(s2), v0(s1)); } | |
344 | if (dist2(s1,15, s2, 0) < 5) { c++; addJoint(v0(s1), v0(s2)); addJoint(v1(s2), v1(s1)); } | |
345 | if (dist2(s1,15, s2,15) < 5) { c++; addJoint(v0(s1), v1(s2)); addJoint(v0(s2), v1(s1)); } | |
0fbf977b | 346 | if (c>0) continue; |
347 | ||
348 | // Are they touching at all? | |
349 | int pos1=0, pos2=0; float d = 100; | |
350 | ||
351 | while (pos1 < 15 || pos2 < 15) { | |
352 | float oldD = d; | |
0f9ea23f | 353 | if (pos1<15) { float d2 = dist2(s1, pos1+1, s2, pos2+0); if (d2 < d) { d=d2; pos1++; } } |
354 | if (pos2<15) { float d2 = dist2(s1, pos1+0, s2, pos2+1); if (d2 < d) { d=d2; pos2++; } } | |
0fbf977b | 355 | if (d > 50 || oldD == d) break ; |
356 | } | |
357 | ||
358 | if (d>5) continue; | |
0f9ea23f | 359 | addTurn(v0(s1), pos1, v0(s2), pos2); addTurn(v1(s1), 15-pos1, v0(s2), pos2); |
360 | addTurn(v0(s2), pos2, v0(s1), pos1); addTurn(v1(s2), 15-pos2, v0(s1), pos1); | |
0fbf977b | 361 | |
362 | }} | |
363 | } | |
364 | } | |
365 | ||
41f26e8f | 366 | dLattice lattice; |
0fbf977b | 367 | //---------------------------------------------------------------------------------------------------------------------------------- |