Support for dual APC40s
[SugarCubes.git] / DanUtil.pde
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 //----------------------------------------------------------------------------------------------------------------------------------