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