~nbriere/GrafreeD.git - Noware Git Repository

..	..	@@ -26,6 +26,577 @@
26	26	public class Mocap extends Object3D
27	27	{
28	28	static final long serialVersionUID = 7437391692559853707L;
	29	+
	30	+ void Fade()
	31	+ {
	32	+ if (currentbones == null \|\| CameraPane.fullreset)
	33	+ return;
	34	+
	35	+ cVector temp = new cVector();
	36	+
	37	+ int numframes = bvh.animation.getNumFrames();
	38	+
	39	+ int b;
	40	+ float[] data;
	41	+ Quat4d quatstart = new Quat4d();
	42	+ Quat4d quatend = new Quat4d();
	43	+ Quat4d quat = new Quat4d();
	44	+ Matrix4d mat4d = new Matrix4d();
	45	+ double[][] rot = new double[4][4];
	46	+ for (b=numbones; --b>=0;) // HIP ROTATION: 0;)
	47	+ {
	48	+ // int hipindex = get(0)._index;
	49	+
	50	+// assert(get(0).get(0)._isHip);
	51	+
	52	+ // if (b == hipindex)
	53	+ // continue;
	54	+
	55	+ data = bvh.animation.getBoneData(b);
	56	+
	57	+ int dof = 3; // data.length/numframes;
	58	+
	59	+ if (b == 0)
	60	+ {
	61	+ dof = 6;
	62	+ }
	63	+ // assert(dof == 3);
	64	+
	65	+ int boneframe3 = (b-1)*3; // dof;
	66	+
	67	+ // System.err.println("Bone #" + b + ": dof = " + dof);
	68	+ int fadein = 45; // 120;
	69	+
	70	+ // if (b == hipindex)
	71	+ // fadein *= 5;
	72	+
	73	+ if (fadein > numframes)
	74	+ fadein = 0; // numframes;
	75	+
	76	+ for (int fi=fadein; --fi>=0;)
	77	+ //for (int f=numframes; --f>=0;)
	78	+ {
	79	+ int f = fi + GetFirstFrame();
	80	+
	81	+ int f3 = f*dof;
	82	+
	83	+ float k = fi;
	84	+
	85	+ k /= fadein - 1;
	86	+
	87	+ if (Float.isNaN(k))
	88	+ k = 1; // 0/0
	89	+
	90	+ k = (float) (-Math.cos(k*Math.PI));
	91	+ k += 1;
	92	+ k /= 2;
	93	+
	94	+ int start = 3;
	95	+ int end = 0;
	96	+
	97	+ if (dof == 6)
	98	+ {
	99	+ start = 6;
	100	+ end = 3;
	101	+ }
	102	+
	103	+ if (b == 0)
	104	+ {
	105	+ for (int i=start; --i>=end;)
	106	+ {
	107	+ //data[f3 + i] += pos[i] - data[frame3 + i];
	108	+// data[f3 + i] = kdata[f3+i] + (1-k)
	109	+// currentbones[boneframe3 + i-end];
	110	+// data[f3 + i] = (float)CurveAngle(data[f3+i], currenthip[i], 1-k);
	111	+ }
	112	+
	113	+ // TODO: translation
	114	+
	115	+// _t1.setIdentity();
	116	+// _t2.setIdentity();
	117	+// _t2.rotZ(currentbones[boneframe3 + start-1-end]);
	118	+// _t1.mul(_t2);
	119	+// _t2.setIdentity();
	120	+// if (b == 0)
	121	+// {
	122	+// _t2.rotY(currentbones[boneframe3 + start-2-end]);
	123	+// _t1.mul(_t2);
	124	+// _t2.setIdentity();
	125	+// _t2.rotX(currentbones[boneframe3 + start-3-end]);
	126	+// }
	127	+// else
	128	+// {
	129	+// _t2.rotX(currentbones[boneframe3 + start-2-end]);
	130	+// _t1.mul(_t2);
	131	+// _t2.setIdentity();
	132	+// _t2.rotY(currentbones[boneframe3 + start-3-end]);
	133	+// }
	134	+// _t1.mul(_t2);
	135	+// _t2.setIdentity();
	136	+//
	137	+// _t1.get(mat4d);
	138	+//
	139	+// mat4d.get(quatstart);
	140	+//
	141	+// _t1.setIdentity();
	142	+// _t2.setIdentity();
	143	+// _t2.rotZ(data[f3 + start-1]);
	144	+// _t1.mul(_t2);
	145	+// _t2.setIdentity();
	146	+// if (b == 0)
	147	+// {
	148	+// _t2.rotY(data[f3 + start-2]);
	149	+// _t1.mul(_t2);
	150	+// _t2.setIdentity();
	151	+// _t2.rotX(data[f3 + start-3]);
	152	+// }
	153	+// else
	154	+// {
	155	+// _t2.rotX(data[f3 + start-2]);
	156	+// _t1.mul(_t2);
	157	+// _t2.setIdentity();
	158	+// _t2.rotY(data[f3 + start-3]);
	159	+// }
	160	+//
	161	+// _t1.mul(_t2);
	162	+// _t2.setIdentity();
	163	+//
	164	+// _t1.get(mat4d);
	165	+//
	166	+// mat4d.get(quatend);
	167	+//
	168	+// double dot = quatstart.x*quatend.x +
	169	+// quatstart.y*quatend.y +
	170	+// quatstart.z*quatend.z +
	171	+// quatstart.w*quatend.w
	172	+// ;
	173	+//
	174	+// if (dot < 0)
	175	+// {
	176	+// quatend.x *= -1;
	177	+// quatend.y *= -1;
	178	+// quatend.z *= -1;
	179	+// quatend.w *= -1;
	180	+// }
	181	+//
	182	+// // k = 1-k;
	183	+//
	184	+// quat.x = (1-k)quatstart.x + kquatend.x;
	185	+// quat.y = (1-k)quatstart.y + kquatend.y;
	186	+// quat.z = (1-k)quatstart.z + kquatend.z;
	187	+// quat.w = (1-k)quatstart.w + kquatend.w;
	188	+//
	189	+// quat.normalize();
	190	+//
	191	+// mat4d.set(quat);
	192	+//
	193	+// cJ3D.SetTransform(rot, mat4d);
	194	+//
	195	+// matrixToEulerXYZ(rot, temp);
	196	+//
	197	+// data[f3 + start-1] = -(float)temp.z;
	198	+//
	199	+// if (b == 0)
	200	+// {
	201	+// data[f3 + start-2] = -(float)temp.y;
	202	+// data[f3 + start-3] = -(float)temp.x;
	203	+// }
	204	+// else
	205	+// {
	206	+// data[f3 + start-2] = -(float)temp.x;
	207	+// data[f3 + start-3] = -(float)temp.y;
	208	+// }
	209	+ }
	210	+ else
	211	+ {
	212	+ for (int i=start; --i>=end;)
	213	+ {
	214	+ //data[f3 + i] += pos[i] - data[frame3 + i];
	215	+// data[f3 + i] = kdata[f3+i] + (1-k)
	216	+// currentbones[boneframe3 + i-end];
	217	+ data[f3 + i] = (float)CurveAngle(data[f3+i], currentbones[boneframe3 + i/-end/], 1-k);
	218	+ }
	219	+ }
	220	+ }
	221	+ }
	222	+ }
	223	+
	224	+ // Updates the toParent matrix to keep the same position and orientation
	225	+ // before resetting the mocap data.
	226	+ void SetGlobalTransform()
	227	+ {
	228	+ //SetCurrentBones(frame);
	229	+
	230	+ cVector temp = new cVector();
	231	+ cVector pos = new cVector();
	232	+ cVector poship = new cVector();
	233	+
	234	+ double angleY = 0;
	235	+ double angleYhip = 0;
	236	+
	237	+ Object3D hip = get(0);
	238	+
	239	+ if (hip.get(0).toParent == null)
	240	+ {
	241	+ hip.get(0).toParent = LA.newMatrix();
	242	+ hip.get(0).fromParent = LA.newMatrix();
	243	+ }
	244	+
	245	+ LA.matConcat(toParent, hip.get(0).toParent, matrix);
	246	+ poship.x = matrix[3][0];
	247	+ poship.y = matrix[3][1];
	248	+ poship.z = matrix[3][2];
	249	+
	250	+ temp.x = 1;
	251	+ temp.y = 0;
	252	+ temp.z = 0;
	253	+
	254	+ LA.xformDir(temp, matrix, temp);
	255	+
	256	+ angleYhip = Math.atan2(-temp.z, temp.x);
	257	+
	258	+ LA.matIdentity(toParent);
	259	+ LA.matYRotate(toParent, angleYhip);
	260	+ LA.matTranslate(toParent, poship.x, poship.y, poship.z);
	261	+
	262	+// LA.matConcat(toParent, hip.get(0).toParent, toParent);
	263	+
	264	+ CameraPane.CreateSelectedPoint();
	265	+
	266	+ CameraPane.debugpointG.toParent[3][0] = poship.x;
	267	+ CameraPane.debugpointG.toParent[3][1] = poship.y;
	268	+ CameraPane.debugpointG.toParent[3][2] = poship.z;
	269	+
	270	+ LA.matInvert(toParent, fromParent);
	271	+
	272	+ LA.matIdentity(hip.get(0).toParent);
	273	+ LA.matIdentity(hip.get(0).fromParent);
	274	+
	275	+// if (true)
	276	+// return;
	277	+
	278	+ // Updates hip.get(0).toParent
	279	+ setPose(hip, GetFirstFrame(), bvh.animation.getBoneData(hip._index));
	280	+
	281	+ // A = toParent; B = hip.get(0).toParent
	282	+ // A'*B = A
	283	+ // A' = A * B-1
	284	+
	285	+ poship.x = hip.get(0).toParent[3][0];
	286	+ poship.y = hip.get(0).toParent[3][1];
	287	+ poship.z = hip.get(0).toParent[3][2];
	288	+
	289	+ temp.x = 1;
	290	+ temp.y = 0;
	291	+ temp.z = 0;
	292	+
	293	+ LA.xformDir(temp, hip.get(0).toParent, temp);
	294	+
	295	+ angleYhip = Math.atan2(-temp.z, temp.x);
	296	+
	297	+ LA.matIdentity(matrix);
	298	+ LA.matYRotate(matrix, angleYhip);
	299	+ LA.matTranslate(matrix, poship.x, poship.y, poship.z);
	300	+
	301	+ //LA.matInvert(hip.get(0).toParent, matrix);
	302	+ LA.matInvert(matrix, matrix);
	303	+
	304	+ //LA.matIdentity(matrix);
	305	+ //LA.matTranslate(matrix, -poship.x, -poship.y, -poship.z);
	306	+
	307	+ LA.matConcat(toParent, matrix, toParent);
	308	+
	309	+
	310	+ LA.matConcat(toParent, hip.get(0).toParent, matrix);
	311	+ pos.x = hip.get(0).toParent[3][0];
	312	+ pos.y = hip.get(0).toParent[3][1];
	313	+ pos.z = hip.get(0).toParent[3][2];
	314	+ LA.xformPos(new cVector(), hip.get(0).toParent, pos);
	315	+ LA.xformPos(pos, toParent, pos);
	316	+
	317	+// temp.x = 1;
	318	+// temp.y = 0;
	319	+// temp.z = 0;
	320	+//
	321	+// LA.xformDir(temp, toParent, temp);
	322	+//
	323	+// angleY = Math.atan2(-temp.z, temp.x);
	324	+//
	325	+// LA.matIdentity(toParent);
	326	+// LA.matYRotate(toParent, angleY - angleYhip);
	327	+// LA.matTranslate(toParent, pos.x - poship.x, pos.y - poship.y, pos.z - poship.z);
	328	+
	329	+ CameraPane.debugpointP.toParent[3][0] = pos.x;
	330	+ CameraPane.debugpointP.toParent[3][1] = pos.y;
	331	+ CameraPane.debugpointP.toParent[3][2] = pos.z;
	332	+
	333	+ CameraPane.debugpointC.toParent[3][0] = poship.x;
	334	+ CameraPane.debugpointC.toParent[3][1] = poship.y;
	335	+ CameraPane.debugpointC.toParent[3][2] = poship.z;
	336	+
	337	+ poship.x = toParent[3][0];
	338	+ poship.y = toParent[3][1];
	339	+ poship.z = toParent[3][2];
	340	+
	341	+ CameraPane.debugpointR.toParent[3][0] = poship.x;
	342	+ CameraPane.debugpointR.toParent[3][1] = poship.y;
	343	+ CameraPane.debugpointR.toParent[3][2] = poship.z;
	344	+
	345	+ LA.matInvert(toParent, fromParent);
	346	+ }
	347	+
	348	+ void LoadData()
	349	+ {
	350	+ float[] thedata = bvh.animation.getBoneData(0);
	351	+
	352	+// thedata[0] = 0;
	353	+// thedata[1] = 0;
	354	+// thedata[2] = 0;
	355	+// thedata[3] = 0;
	356	+// thedata[4] = 0;
	357	+// thedata[5] = 0;
	358	+
	359	+ if (true)
	360	+ return;
	361	+
	362	+ for (int b=numbones; --b>=0;)
	363	+ //int b = 0;
	364	+ {
	365	+ thedata = bvh.animation.getBoneData(b);
	366	+
	367	+ int numframes = bvh.animation.getNumFrames();
	368	+
	369	+ int dof = 6; // thedata.length/numframes;
	370	+
	371	+ if (b > 0)
	372	+ dof = 3;
	373	+
	374	+ if (dof != thedata.length/numframes)
	375	+ {
	376	+ System.err.println("Bone #" + b + ": dof = " + dof + " ---> " + (thedata.length/numframes));
	377	+ dof = thedata.length/numframes;
	378	+ }
	379	+
	380	+ //for (int f=numframes; --f>=offset;)
	381	+ int firstframe = GetFirstFrame();
	382	+ for (int f=0; f<numframes-firstframe; f++)
	383	+ {
	384	+ int f3 = f*dof;
	385	+
	386	+ //for (int i=3/dof/; --i>=0;)
	387	+ for (int i=dof; --i>=0;)
	388	+ {
	389	+ //thedata[f3 + i] += thedata[i] - thedata[offset*dof + i];
	390	+ thedata[f3 + i] = thedata[f3 + firstframe*dof + i];
	391	+ }
	392	+ }
	393	+ }
	394	+ }
	395	+
	396	+ void ResetZero()
	397	+ {
	398	+ for (int b=numbones; --b>=0;)
	399	+ {
	400	+ float[] thedata = bvh.animation.getBoneData(b);
	401	+
	402	+ int numframes = bvh.animation.getNumFrames();
	403	+
	404	+ int dof = 6;
	405	+
	406	+ if (b > 0)
	407	+ dof = 3;
	408	+
	409	+ for (int i=dof; --i>=0;)
	410	+ {
	411	+ thedata[i] = 0;
	412	+ }
	413	+ }
	414	+ }
	415	+
	416	+ void SetCurrentBones(int frame)
	417	+ {
	418	+ if (frame == 0)
	419	+ {
	420	+ //frame = 1;
	421	+ }
	422	+
	423	+ if (currentbones == null)
	424	+ {
	425	+ currentbones = new double[(numbones-1)*3];
	426	+ currenthip = new double[6];
	427	+ }
	428	+
	429	+ for (int b=numbones; --b>=1;) // HIP ROTATION: 0;)
	430	+ //int b = 0;
	431	+ {
	432	+ float[] data = bvh.animation.getBoneData(b);
	433	+
	434	+ // int numframes = bvh.animation.getNumFrames();
	435	+
	436	+ int dof = 6; // data.length/numframes;
	437	+
	438	+ if (b > 0)
	439	+ dof = 3;
	440	+
	441	+ //assert(dof == 3);
	442	+
	443	+ // System.err.println("Bone #" + b + ": dof = " + dof);
	444	+ int theframe = // 1; // baseframe;
	445	+ frame;
	446	+
	447	+ int frame3 = theframe*dof;
	448	+ int bone3 = (b-1)*dof;
	449	+
	450	+ int start = 3;
	451	+ int end = 0;
	452	+
	453	+ if (dof == 6)
	454	+ {
	455	+ start = 6;
	456	+ //end = 3;
	457	+ }
	458	+
	459	+ for (int i=start; --i>=end;)
	460	+ {
	461	+ currentbones[bone3 + i/-end/] = data[frame3 + i];
	462	+ }
	463	+ }
	464	+
	465	+ float[] data = bvh.animation.getBoneData(0);
	466	+
	467	+ int dof = 6;
	468	+
	469	+ int theframe = frame;
	470	+
	471	+ int frame3 = theframe*dof;
	472	+
	473	+ int start = 6;
	474	+ int end = 0;
	475	+
	476	+ for (int i=start; --i>=end;)
	477	+ {
	478	+ currenthip[i] = data[frame3 + i];
	479	+ }
	480	+ }
	481	+
	482	+ static cVector centroid = new cVector();
	483	+ static cVector mocaporigin = new cVector();
	484	+
	485	+ void SetHipOrientation()
	486	+ {
	487	+ Object3D hip = get(0);
	488	+
	489	+ if (toParent == null)
	490	+ {
	491	+ toParent = LA.newMatrix();
	492	+ fromParent = LA.newMatrix();
	493	+ }
	494	+
	495	+ LA.matConcat(toParent, hip.get(0).toParent, matrix);
	496	+
	497	+ mocaporigin.x = matrix[3][0];
	498	+ mocaporigin.y = matrix[3][1];
	499	+ mocaporigin.z = matrix[3][2];
	500	+
	501	+ centroid.x = matrix[3][0];
	502	+ centroid.y = matrix[3][1];
	503	+ centroid.z = matrix[3][2];
	504	+// this.getCentroid(centroid, true);
	505	+
	506	+ CameraPane.CreateSelectedPoint();
	507	+ CameraPane.debugpointG.name = "";
	508	+ CameraPane.debugpointG.toParent[3][0] = mocaporigin.x;
	509	+ CameraPane.debugpointG.toParent[3][1] = mocaporigin.y;
	510	+ CameraPane.debugpointG.toParent[3][2] = mocaporigin.z;
	511	+
	512	+ CameraPane.debugpointP.name = "";
	513	+ CameraPane.debugpointP.toParent[3][0] = centroid.x;
	514	+ CameraPane.debugpointP.toParent[3][1] = centroid.y;
	515	+ CameraPane.debugpointP.toParent[3][2] = centroid.z;
	516	+
	517	+ cVector goal = GetGoal(centroid);
	518	+ if (goal != null)
	519	+ {
	520	+ System.err.println("GOAL change (" + this + "): " + goal + " (was " + goalposx + ", " + goalposz + ")");
	521	+
	522	+ goalposx = goal.x;
	523	+ goalposz = goal.z;
	524	+ targetdirx = targetdirz = 0;
	525	+ }
	526	+
	527	+ if (goalposx == 0 && goalposz == 0)
	528	+ {
	529	+ // No target
	530	+ if (ScriptNode.speaker != null)
	531	+ {
	532	+ Object3D sourcenode = GetFileRoot();
	533	+ Object3D speakernode = ScriptNode.speaker.GetFileRoot();
	534	+
	535	+ //System.err.println("speaker is " + speakernode + "; last was " + ScriptNode.lastspeaker);
	536	+
	537	+ Object3D speaker = ScriptNode.speaker;
	538	+
	539	+ if (speakernode == sourcenode)
	540	+ {
	541	+ if (ScriptNode.lastspeaker != null)
	542	+ {
	543	+ speakernode = ScriptNode.lastspeaker.GetFileRoot();
	544	+ speaker = ScriptNode.lastspeaker;
	545	+ }
	546	+ else
	547	+ return;
	548	+ }
	549	+
	550	+ cVector dst = new cVector();
	551	+
	552	+ boolean success = speakernode.getCentroid(dst); // , true);
	553	+
	554	+ if (!success)
	555	+ new Exception().printStackTrace();
	556	+
	557	+ //speakernode.parent.TransformToWorld(dst);
	558	+ //sourcenode.parent.TransformToLocal(dst);
	559	+ this.parent.TransformToLocal(dst);
	560	+
	561	+ goalposx = dst.x;
	562	+ goalposz = dst.z;
	563	+ }
	564	+ else
	565	+ return;
	566	+ }
	567	+
	568	+ cVector temp = new cVector();
	569	+
	570	+ temp.x = 1;
	571	+ temp.y = 0;
	572	+ temp.z = 0;
	573	+
	574	+ LA.xformDir(temp, matrix, temp);
	575	+
	576	+ double angleYhip = Math.atan2(-temp.z, temp.x);
	577	+
	578	+ double angleYtarget = Math.atan2(goalposx - centroid.x, goalposz - centroid.z);
	579	+
	580	+ LA.matIdentity(matrix);
	581	+ LA.matTranslate(matrix, -centroid.x, -centroid.y, -centroid.z);
	582	+ double angle = CurveAngle(0, angleYtarget - angleYhip, 0.1f);
	583	+ LA.matYRotate(matrix, angle);
	584	+ LA.matTranslate(matrix, centroid.x, centroid.y, centroid.z);
	585	+
	586	+ LA.matConcat(matrix, toParent, toParent);
	587	+
	588	+ LA.matInvert(toParent, fromParent);
	589	+
	590	+ LA.matConcat(toParent, hip.get(0).toParent, matrix);
	591	+
	592	+ centroid.x = matrix[3][0];
	593	+ centroid.y = matrix[3][1];
	594	+ centroid.z = matrix[3][2];
	595	+
	596	+ double dist = LA.distance(centroid, mocaporigin);
	597	+
	598	+ CheckForAction(centroid);
	599	+ }
29	600
30	601	void WriteTo(java.io.Writer writer) throws Exception
31	602	{
..	..	@@ -76,6 +647,24 @@
76	647	// transient // aout 2013
77	648	Object3D skeleton;
78	649
	650	+ void ExtractBigData(Object3D o)
	651	+ {
	652	+ super.ExtractBigData(o);
	653	+
	654	+ o.savebvh = this.bvh;
	655	+ o.saveskeleton = this.skeleton;
	656	+ this.bvh = null;
	657	+ this.skeleton = null;
	658	+ }
	659	+
	660	+ void RestoreBigData(Object3D o)
	661	+ {
	662	+ super.RestoreBigData(o);
	663	+
	664	+ this.bvh = o.savebvh;
	665	+ this.skeleton = o.saveskeleton;
	666	+ }
	667	+
79	668	boolean smoothed;
80	669
81	670	//boolean touched;
..	..	@@ -99,11 +688,11 @@
99	688	double pinx;
100	689	double pinz;
101	690
102		- double targetx;
103		- double targetz;
	691	+ double targetdirx;
	692	+ double targetdirz;
104	693
105		- double goalx;
106		- double goalz;
	694	+ double goalposx = 0; // -20;
	695	+ double goalposz = 0; // -10;
107	696
108	697	boolean followpath;
109	698
..	..	@@ -174,7 +763,7 @@
174	763	scriptactions.clear();
175	764	}
176	765
177		- static double EPSACTION = 0.1; // 0.075; // 0.1;
	766	+ static double EPSACTION = 0.1; // 0.075; // 0.1;Came
178	767
179	768	void AddFromTo(cVector from, cVector to)
180	769	{
..	..	@@ -359,7 +948,7 @@
359	948	// //GetFileRoot();
360	949
361	950	// sept 2014: //
362		- GraphreeD.RENDERME = 3; // patch for Merge objects
	951	+ Grafreed.RENDERME = 3; // patch for Merge objects
363	952	float[] thedata = bvh.animation.getBoneData(0);
364	953
365	954	os.x = (float) (path.get(i).toParent[3][0]); // - thedata[frame*6]);
..	..	@@ -409,7 +998,7 @@
409	998
410	999	get(0).link2master = path.size() > 1; // hip orientation
411	1000
412		- if (get(0).link2master)
	1001	+ if (get(0).Link2Support())
413	1002	{
414	1003	rotateonce = 2;
415	1004	}
..	..	@@ -460,6 +1049,8 @@
460	1049	testvect.set(from);
461	1050	testvect.sub(fromto.from);
462	1051
	1052	+ testvect.y = 0; // PATCH
	1053	+
463	1054	int factor = 1;
464	1055
465	1056	//if (CameraPane.FAST)
..	..	@@ -501,6 +1092,8 @@
501	1092
502	1093	testvect.set(from);
503	1094	testvect.sub(fromto.from);
	1095	+
	1096	+ testvect.y = 0; // PATCH
504	1097
505	1098	int factor = 1;
506	1099
..	..	@@ -705,7 +1298,7 @@
705	1298	// skip first node: translation
706	1299	// Object3D b = input.get(0);
707	1300
708		- setPose(input, f, data.getBoneData(input._index), false); //, null);
	1301	+ setPose(input, f, data.getBoneData(input._index)); //, false); //, null);
709	1302	}
710	1303
711	1304	//mocap.figure.Bone[] children = b.getChildren();
..	..	@@ -736,6 +1329,7 @@
736	1329
737	1330	void SetPosition(Object3D sourcenode, cVector floor, long floorid, cVector centroid)
738	1331	{
	1332	+ assert(false);
739	1333	//assert(CameraPane.drawMode == CameraPane.SHADOW);
740	1334
741	1335	Object3D transformnode = new Object3D();
..	..	@@ -833,7 +1427,7 @@
833	1427	double w = 0.00015;
834	1428
835	1429	//if (!sourcenode.link2master) // strong pin on floor
836		- if (parent.link2master) // strong pin on floor
	1430	+ if (parent.Link2Support()) // strong pin on floor
837	1431	{
838	1432	w = 0.005; // .001;
839	1433	}
..	..	@@ -921,7 +1515,7 @@
921	1515	//groundz += sourcenode.parent.toParent[3][2] - posz;
922	1516	}
923	1517
924		- boolean footcontact = CameraPane.FOOTCONTACT; // false;
	1518	+ boolean footcontact = false; // CameraPane.FOOTCONTACT; // false;
925	1519
926	1520	if (footcontact && ground != -123456)
927	1521	{
..	..	@@ -938,9 +1532,10 @@
938	1532
939	1533	groundid = floorid;
940	1534
941		- CameraPane.debugpoint.toParent[3][0] = groundx;
942		- CameraPane.debugpoint.toParent[3][1] = floor.y;
943		- CameraPane.debugpoint.toParent[3][2] = groundz;
	1535	+ // green
	1536	+ CameraPane.debugpointG.toParent[3][0] = groundx;
	1537	+ CameraPane.debugpointG.toParent[3][1] = floor.y;
	1538	+ CameraPane.debugpointG.toParent[3][2] = groundz;
944	1539
945	1540	if (true) // slow && stepout && onein)
946	1541	{
..	..	@@ -951,7 +1546,7 @@
951	1546	// mywave = currentwave++;
952	1547	// }
953	1548	// sound
954		- cVector eye = CameraPane.theRenderer.eyeCamera.location;
	1549	+ cVector eye = Globals.theRenderer.EyeCamera().location;
955	1550
956	1551	// if (sourcenode.parent.parent != null)
957	1552	// sourcenode.parent.parent.TransformToWorld(floor, tmp);
..	..	@@ -996,9 +1591,9 @@
996	1591	//GraphreeD.
997	1592	wav.play(volume * usedvolume); //, mywave);
998	1593
999		- lastsoundtime = CameraPane.framecount;
	1594	+ lastsoundtime = Globals.framecount;
1000	1595
1001		- GraphreeD.hassound = true;
	1596	+ Grafreed.hassound = true;
1002	1597	}
1003	1598	// else
1004	1599	// System.out.println("skipped");
..	..	@@ -1016,9 +1611,10 @@
1016	1611	// floor.z += posz;
1017	1612
1018	1613	// System.out.println("Allo " + sourcenode);
1019		- CameraPane.debugpoint2.toParent[3][0] = floor.x;// + posx;
1020		- CameraPane.debugpoint2.toParent[3][1] = ground; // floor.y;// + sourcenode.parent.toParent[3][1];
1021		- CameraPane.debugpoint2.toParent[3][2] = floor.z;// + posz;
	1614	+ // purple
	1615	+ CameraPane.debugpointP.toParent[3][0] = floor.x;// + posx;
	1616	+ CameraPane.debugpointP.toParent[3][1] = ground; // floor.y;// + sourcenode.parent.toParent[3][1];
	1617	+ CameraPane.debugpointP.toParent[3][2] = floor.z;// + posz;
1022	1618
1023	1619
1024	1620	if (false) // dist2 > 0.1)
..	..	@@ -1045,14 +1641,14 @@
1045	1641	// sourcenode.parent.toParent[3][1] = ground - floor.y;
1046	1642	// sourcenode.parent.toParent[3][2] += groundz - floor.z;
1047	1643	// sourcenode.parent.toParent[3][1] = K * (ground - floor.y) + (1 - K) * oldposy;
1048		- if (footcontact && (sourcenode.parent != null && !sourcenode.parent.link2master)) // strong pin on floor
	1644	+ if (footcontact && (sourcenode.parent != null && !sourcenode.parent.Link2Support())) // strong pin on floor
1049	1645	{
1050	1646	v0.x = groundx - floor.x;
1051	1647	v0.y = 0; // groundx - floor.x;
1052	1648	v0.z = groundz - floor.z;
1053	1649
1054	1650	double distance = Math.sqrt(v0.dot(v0));
1055		- double maxdist = 0.004;
	1651	+ double maxdist = 0.04;
1056	1652
1057	1653	if (distance > maxdist)
1058	1654	{
..	..	@@ -1078,8 +1674,27 @@
1078	1674	sourcenode.toParent = LA.newMatrix();
1079	1675	sourcenode.fromParent = LA.newMatrix();
1080	1676	}
	1677	+
	1678	+ v0.x = v0.z = 0;
	1679	+
	1680	+ this.get(0).TransformToWorld(v0);
	1681	+
	1682	+ // cyan
	1683	+ CameraPane.debugpointC.toParent[3][0] = v0.x;
	1684	+ CameraPane.debugpointC.toParent[3][1] = ground;
	1685	+ CameraPane.debugpointC.toParent[3][2] = v0.z;
	1686	+
1081	1687	LA.matConcat(sourcenode.toParent, transformnode.toParent, sourcenode.toParent);
1082	1688	LA.matInvert(sourcenode.toParent, sourcenode.fromParent);
	1689	+
	1690	+ v0.x = v0.z = 0;
	1691	+
	1692	+ this.get(0).TransformToWorld(v0);
	1693	+
	1694	+ // red
	1695	+ CameraPane.debugpointR.toParent[3][0] = v0.x;
	1696	+ CameraPane.debugpointR.toParent[3][1] = ground;
	1697	+ CameraPane.debugpointR.toParent[3][2] = v0.z;
1083	1698	}
1084	1699	}
1085	1700
..	..	@@ -1119,11 +1734,11 @@
1119	1734
1120	1735	if (goal != null)
1121	1736	{
1122		- System.err.println("GOAL change (" + sourcenode + "): " + goal + " (was " + goalx + ", " + goalz + ")");
	1737	+ System.err.println("GOAL change (" + sourcenode + "): " + goal + " (was " + goalposx + ", " + goalposz + ")");
1123	1738	//sourcenode.parent.parent.Dump();
1124		- goalx = goal.x;
1125		- goalz = goal.z;
1126		- targetx = targetz = 0;
	1739	+ goalposx = goal.x;
	1740	+ goalposz = goal.z;
	1741	+ targetdirx = targetdirz = 0;
1127	1742
1128	1743	followpath = true;
1129	1744	}
..	..	@@ -1174,16 +1789,16 @@
1174	1789	// }
1175	1790	if (false) // !uselast)
1176	1791	{
1177		- CameraPane.debugpoint.toParent[3][0] = dst.x;
1178		- CameraPane.debugpoint.toParent[3][1] = dst.y;
1179		- CameraPane.debugpoint.toParent[3][2] = dst.z;
	1792	+ CameraPane.debugpointG.toParent[3][0] = dst.x;
	1793	+ CameraPane.debugpointG.toParent[3][1] = dst.y;
	1794	+ CameraPane.debugpointG.toParent[3][2] = dst.z;
1180	1795	}
1181	1796	}
1182	1797
1183		- if (goalx != 0 \|\| goalz != 0) // TODO
	1798	+ if (goalposx != 0 \|\| goalposz != 0) // TODO
1184	1799	{
1185	1800	// overwrite speaker orientation
1186		- dst.set(goalx,0,goalz);
	1801	+ dst.set(goalposx,0,goalposz);
1187	1802	if (sourcenode.parent != null) // july 2014
1188	1803	sourcenode.parent.
1189	1804	TransformToLocal(dst);
..	..	@@ -1199,6 +1814,7 @@
1199	1814	src.x = 0;
1200	1815	src.y = 0;
1201	1816	src.z = 0;
	1817	+ LA.xformPos(src, get(0).get(0).toParent, src);
1202	1818	LA.xformPos(src, get(0).toParent, src);
1203	1819	LA.xformPos(src, toParent, src);
1204	1820	// LA.xformPos(src, rotsourcenode.toParent, src);
..	..	@@ -1234,26 +1850,26 @@
1234	1850	// mars 2014
1235	1851	if (false) // goalx != 0 \|\| goalz != 0)
1236	1852	{
1237		- targetx = dst.x - src.x;
1238		- targetz = dst.z - src.z;
	1853	+ targetdirx = dst.x - src.x;
	1854	+ targetdirz = dst.z - src.z;
1239	1855
1240		- if (Math.abs(targetx) > 0.1 \|\| Math.abs(targetz) > 0.1)
	1856	+ if (Math.abs(targetdirx) > 0.1 \|\| Math.abs(targetdirz) > 0.1)
1241	1857	{
1242	1858	// far enough from goal. keep the goal position.
1243		- targetx = 0;
1244		- targetz = 0;
	1859	+ targetdirx = 0;
	1860	+ targetdirz = 0;
1245	1861	}
1246	1862	else
1247	1863	{
1248	1864	// too close to goal. switch to target direction instead.
1249		- goalx = 0;
1250		- goalz = 0;
	1865	+ goalposx = 0;
	1866	+ goalposz = 0;
1251	1867	}
1252	1868	}
1253	1869
1254	1870	//sourcenode.getCentroid(src, true);
1255	1871
1256		- if (speakernode == sourcenode && goalx == 0 && goalz == 0)
	1872	+ if (speakernode == sourcenode && goalposx == 0 && goalposz == 0)
1257	1873	{
1258	1874	if (ScriptNode.lastspeaker != null)
1259	1875	new Exception().printStackTrace();
..	..	@@ -1262,13 +1878,13 @@
1262	1878
1263	1879	// LA.xformPos(src, fromParent, src);
1264	1880
1265		- if ((ScriptNode.speaker != null && CameraPane.SPEAKERMOCAP \|\| goalx != 0 \|\| goalz != 0) && targetx == 0 && targetz == 0)
	1881	+ if ((ScriptNode.speaker != null && CameraPane.SPEAKERMOCAP \|\| goalposx != 0 \|\| goalposz != 0) && targetdirx == 0 && targetdirz == 0)
1266	1882	dst.sub(src);
1267	1883	else
1268	1884	// vector mode
1269	1885	{
1270		- dst.x = targetx;
1271		- dst.z = targetz;
	1886	+ dst.x = targetdirx;
	1887	+ dst.z = targetdirz;
1272	1888
1273	1889	// TEST TARGET
1274	1890	// dst.x = CameraPane.selectedpoint.toParent[3][0];
..	..	@@ -1390,7 +2006,7 @@
1390	2006	// if (sourcenode.link2master)
1391	2007	// if (goalx != 0 \|\| goalz != 0)
1392	2008	// K = 0.02; // .0625;
1393		- if (parent.link2master) // strong pin on floor
	2009	+ if (parent.Link2Support()) // strong pin on floor
1394	2010	{
1395	2011	K = 0.05; // 0.02;
1396	2012	}
..	..	@@ -1542,6 +2158,7 @@
1542	2158	toParent = LA.newMatrix();
1543	2159	fromParent = LA.newMatrix();
1544	2160	}
	2161	+
1545	2162	LA.matConcat(toParent, rotsourcenode.toParent, toParent);
1546	2163	LA.matInvert(toParent, fromParent);
1547	2164
..	..	@@ -1677,7 +2294,7 @@
1677	2294	}
1678	2295
1679	2296	if (!smoothed)
1680		- for (int i=4; --i>=0;)
	2297	+ for (int i=10; --i>=0;)
1681	2298	SmoothAnimData(); // much reduces shakiness
1682	2299
1683	2300	smoothed = true;
..	..	@@ -1715,9 +2332,16 @@
1715	2332	toVector.x = LA.cos(to);
1716	2333	toVector.y = LA.sin(to);
1717	2334
	2335	+ double fromA = Math.atan2(fromVector.y, fromVector.x);
	2336	+ double toA = Math.atan2(toVector.y, toVector.x);
	2337	+
1718	2338	Vector2d currentVector = Slerp(fromVector, toVector, step);
1719	2339
1720		- return Math.atan2(currentVector.y, currentVector.x);
	2340	+ double angle = Math.atan2(currentVector.y, currentVector.x);
	2341	+
	2342	+ double angle2 = (1-step) * fromA + step * toA;
	2343	+
	2344	+ return angle;
1721	2345	}
1722	2346
1723	2347	public static Vector2d Slerp(Vector2d from, Vector2d to, double step)
..	..	@@ -1759,12 +2383,28 @@
1759	2383	if (!live) // aout 2013
1760	2384	return;
1761	2385
1762		- cVector centroid = new cVector();
1763		- cVector floor = new cVector();
1764		-
1765		- Object3D sourcenode = GetFileRoot();
	2386	+ //bvh.skeleton.setPose(f, bvh.animation.getBoneData(bvh.skeleton.getIndex()), null);
	2387	+ try
	2388	+ {
	2389	+ SetPose(GetSkeleton(), bvh.animation, f);
	2390	+ SetCurrentBones(frame);
	2391	+ }
	2392	+ catch (Exception e)
	2393	+ {
	2394	+ e.printStackTrace();
	2395	+ }
1766	2396
1767		- boolean success; // = sourcenode.getCentroid(centroid);
	2397	+ SetHipOrientation();
	2398	+
	2399	+ if (true)
	2400	+ return;
	2401	+
	2402	+ cVector centroid = new cVector();
	2403	+ cVector floor = new cVector();
	2404	+
	2405	+ Object3D sourcenode = GetFileRoot();
	2406	+
	2407	+ boolean success; // = sourcenode.getCentroid(centroid);
1768	2408	// if (!success)
1769	2409	// {
1770	2410	// //assert(success);
..	..	@@ -1772,16 +2412,6 @@
1772	2412	// System.out.println("No centroid for " + sourcenode);
1773	2413	// }
1774	2414
1775		- //bvh.skeleton.setPose(f, bvh.animation.getBoneData(bvh.skeleton.getIndex()), null);
1776		- try
1777		- {
1778		- SetPose(GetSkeleton(), bvh.animation, f);
1779		- }
1780		- catch (Exception e)
1781		- {
1782		- e.printStackTrace();
1783		- }
1784		-
1785	2415	if (sourcenode.parent == null && sourcenode.fileparent == null)
1786	2416	{
1787	2417	// No GFD
..	..	@@ -1793,9 +2423,9 @@
1793	2423	// SetBreakPoint(get(0).toParent[0], 0);
1794	2424	// }
1795	2425
1796		- boolean setrotation = get(0).link2master && !firsttimeafterload && frame > 0;
	2426	+ boolean setrotation = get(0).Link2Support() && !firsttimeafterload && frame > 0;
1797	2427	boolean setposition = sourcenode != null && // sourcenode.parent != null && // july 2014
1798		- sourcenode./parent./link2master && !firsttimeafterload && frame > 0;
	2428	+ sourcenode./parent./Link2Support() && !firsttimeafterload && frame > 0;
1799	2429
1800	2430	// cVector centroid = new cVector();
1801	2431	// cVector floor = new cVector();
..	..	@@ -1835,7 +2465,7 @@
1835	2465	{
1836	2466	SetRotation(sourcenode, new cVector(floor), new cVector(centroid));
1837	2467	}
1838		-
	2468	+
1839	2469	if (setposition)
1840	2470	{
1841	2471	if (floorobject != null)
..	..	@@ -2029,7 +2659,7 @@
2029	2659	* @param frame
2030	2660	* Frame number
2031	2661	*/
2032		- public void setPose(Object3D bone, int frame, float[] data, boolean fade) //, Point3d offsetTrans)
	2662	+ public void setPose(Object3D bone, int frame, float[] data) //, boolean fade) //, Point3d offsetTrans)
2033	2663	{
2034	2664	if (!live) // aout 2013
2035	2665	return;
..	..	@@ -2037,6 +2667,33 @@
2037	2667	cVector temp = new cVector();
2038	2668	cVector temp0 = new cVector();
2039	2669	double pos[] = new double[3];
	2670	+ double angleY = 0;
	2671	+ double sinY = 0;
	2672	+ double cosY = 0;
	2673	+
	2674	+ if (false) // bone._isRoot && firsttimeafterload && frame > 0)
	2675	+ {
	2676	+ bone.get(0).GlobalTransformInv();
	2677	+
	2678	+ temp.x = bone.get(0).globalTransform[3][0];
	2679	+ temp.y = bone.get(0).globalTransform[3][1];
	2680	+ temp.z = bone.get(0).globalTransform[3][2];
	2681	+
	2682	+ pos[0] = temp.x;
	2683	+ pos[1] = temp.y;
	2684	+ pos[2] = temp.z;
	2685	+
	2686	+ temp.x = 1;
	2687	+ temp.y = 0;
	2688	+ temp.z = 0;
	2689	+
	2690	+ LA.xformDir(temp, bone.get(0).globalTransform, temp);
	2691	+
	2692	+ sinY = temp.z;
	2693	+ cosY = temp.x;
	2694	+
	2695	+ angleY = Math.atan2(-sinY, cosY);
	2696	+ }
2040	2697
2041	2698	// Object3D obj = get(0);
2042	2699	// Object3D gp = this.parent;
..	..	@@ -2168,13 +2825,14 @@
2168	2825	if (//frame > 0 &&
2169	2826	!bone.skipmocap &&
2170	2827	!bone.name.contains("head") &&
	2828	+ !bone.name.contains("Head") // &&
2171	2829	// !bone.name.contains("rFoot") &&
2172	2830	// !bone.name.contains("lFoot") &&
2173		- !bone.name.contains("Pinky") &&
2174		- !bone.name.contains("Ring") &&
2175		- !bone.name.contains("Mid") &&
2176		- !bone.name.contains("Index") &&
2177		- !bone.name.contains("Thumb")
	2831	+// !bone.name.contains("Pinky") &&
	2832	+// !bone.name.contains("Ring") &&
	2833	+// !bone.name.contains("Mid") &&
	2834	+// !bone.name.contains("Index") &&
	2835	+// !bone.name.contains("Thumb")
2178	2836	)
2179	2837	{
2180	2838	//_rotTG.setTransform(_t1);
..	..	@@ -2200,22 +2858,24 @@
2200	2858
2201	2859	// set translation
2202	2860	// (currently only possible for root bone! see mocapdata.com data)
2203		- if (bone._isRoot && link2master) // && !GetFileRoot().link2master)
	2861	+ if (bone._isRoot && Link2Support()) // && !GetFileRoot().link2master)
2204	2862	{
2205	2863	if (hasTranslation) // && _translationEnabled)
2206	2864	{
2207	2865	// CROWD
2208	2866	//cJ3D.GetTranslation(bone, _trans0);
2209	2867	//_trans.add(_trans0);
2210		- _transTF.setIdentity();
	2868	+ //_transTF.setIdentity();
	2869	+ _transTF.set(_t1);
2211	2870	_transTF.setTranslation(_trans);
2212	2871	// System.err.println("Translate: " + _transTF);
2213	2872	//_transTG.setTransform(_transTF);
2214		- cJ3D.ResetTransform(bone, _transTF, true); // translation node
	2873	+ cJ3D.ResetTransform(bone.get(0), _transTF, true); // translation node
	2874	+ //cJ3D.ResetTransform(bone, _transTF, true); // translation node
2215	2875	}
2216	2876	}
2217	2877
2218		- if (bone._isRoot && firsttimeafterload && frame > 0)
	2878	+ if (false) // bone._isRoot && firsttimeafterload && frame > 0)
2219	2879	{
2220	2880	assert(bone == get(0));
2221	2881
..	..	@@ -2231,17 +2891,17 @@
2231	2891	// LA.matConcat(originmatrixinv, tempmatrixinv, fromParent); // ABC * (B'*C')^-1
2232	2892	//
2233	2893
2234		- Invariants();
2235		- bone.Invariants();
2236		- bone.get(0).Invariants();
2237		- // if (origin == null)
2238		- // origin = null;
2239		- origin.Invariants();
2240		- origin0.Invariants();
	2894	+ Invariants();
	2895	+ bone.Invariants();
	2896	+ bone.get(0).Invariants();
	2897	+ // if (origin == null)
	2898	+ // origin = null;
	2899	+ origin.Invariants();
	2900	+ origin0.Invariants();
2241	2901
2242		-
2243		- LA.matConcat(bone.get(0).fromParent, bone.fromParent, tempmatrix); // B' * C'
2244		- LA.matConcat(origin.toParent, tempmatrix, toParent);
	2902	+
	2903	+//?? LA.matConcat(bone.get(0).fromParent, bone.fromParent, tempmatrix); // B' * C'
	2904	+//?? LA.matConcat(origin.toParent, tempmatrix, toParent);
2245	2905
2246	2906	// matrixToEulerXYZ(toParent, temp);
2247	2907	// matrixToEulerXYZ(bone.get(0).toParent, temp);
..	..	@@ -2275,7 +2935,7 @@
2275	2935	//
2276	2936	// mat4d.get(quat);
2277	2937
2278		- if (true) // hip correction
	2938	+ if (false) // hip correction
2279	2939	{
2280	2940	_t2.setIdentity();
2281	2941
..	..	@@ -2316,13 +2976,13 @@
2316	2976	//????? LA.matConcat(bone.get(0).toParent, bone.toParent, tempmatrix); // B' * C'
2317	2977	// LA.matConcat(origin.fromParent, tempmatrix, fromParent);
2318	2978
2319		- LA.matInvert(toParent, fromParent);
	2979	+//?? LA.matInvert(toParent, fromParent);
2320	2980
2321		- Invariants();
2322		- bone.Invariants();
2323		- bone.get(0).Invariants();
2324		- origin.Invariants();
2325		- origin0.Invariants();
	2981	+ Invariants();
	2982	+ bone.Invariants();
	2983	+ bone.get(0).Invariants();
	2984	+ origin.Invariants();
	2985	+ origin0.Invariants();
2326	2986
2327	2987	// LA.matInvert(fromParent, tempmatrix);
2328	2988	//
..	..	@@ -2343,33 +3003,39 @@
2343	3003	// temp.x = data[0];
2344	3004	// temp.y = data[1];
2345	3005	// temp.z = data[2];
2346		- LA.xformPos(temp, origin0.toParent, temp0);
	3006	+ LA.xformPos(temp, origin0.toParent, temp0); // NU
2347	3007
2348		-// bone.GlobalTransformInv();
2349		-
2350		- temp0.x = bone.globalTransform[3][0];
2351		- temp0.y = bone.globalTransform[3][1];
2352		- temp0.z = bone.globalTransform[3][2];
2353		-
	3008	+// bone.get(0).GlobalTransformInv();
	3009	+//
	3010	+// temp0.x = bone.get(0).globalTransform[3][0];
	3011	+// temp0.y = bone.get(0).globalTransform[3][1];
	3012	+// temp0.z = bone.get(0).globalTransform[3][2];
	3013	+//
2354	3014	// MEGA TEST // june 2014: necessary for precision? otherwise comment works
2355		-fromParent[3][0] = 0;
2356		-fromParent[3][1] = 0;
2357		-fromParent[3][2] = 0;
2358		-LA.matInvert(fromParent, toParent);
	3015	+//fromParent[3][0] = 0;
	3016	+//fromParent[3][1] = 0;
	3017	+//fromParent[3][2] = 0;
	3018	+//LA.matInvert(fromParent, toParent);
2359	3019
2360		- LA.xformPos(temp0, fromParent, temp);
	3020	+ LA.xformPos(temp0, fromParent, temp); // NU
2361	3021	//LA.xformPos(temp, bone.fromParent, temp);
2362	3022	// float[] data;
2363	3023
2364		- pos[0] = temp.x;
2365		- pos[1] = temp.y;
2366		- pos[2] = temp.z;
	3024	+// pos[0] = temp.x;
	3025	+// pos[1] = temp.y;
	3026	+// pos[2] = temp.z;
	3027	+//
	3028	+// temp.x = 1;
	3029	+// temp.y = 0;
	3030	+// temp.z = 0;
	3031	+//
	3032	+// LA.xformDir(temp, bone.get(0).globalTransform, temp);
2367	3033
2368	3034	// CameraPane.selectedpoint.toParent[3][0] = temp0.x;
2369	3035	// CameraPane.selectedpoint.toParent[3][1] = temp0.y;
2370	3036	// CameraPane.selectedpoint.toParent[3][2] = temp0.z;
2371	3037
2372		- int numframes = bvh.animation.getNumFrames();
	3038	+ int numframes = bvh.animation.getNumFrames();
2373	3039
2374	3040	int b = 0;
2375	3041	{
..	..	@@ -2377,12 +3043,12 @@
2377	3043
2378	3044	int dof = 6; /// data.length/numframes;
2379	3045
2380		- // july 2014
2381		- if (dof != data.length/numframes)
2382		- {
2383		- System.err.println("Bone #" + b + ": dof = " + dof + " ---> " + (data.length/numframes));
2384		- dof = data.length/numframes;
2385		- }
	3046	+ // july 2014
	3047	+ if (dof != data.length/numframes)
	3048	+ {
	3049	+ System.err.println("Bone #" + b + ": dof = " + dof + " ---> " + (data.length/numframes));
	3050	+ dof = data.length/numframes;
	3051	+ }
2386	3052
2387	3053
2388	3054	int theframe = 0; // baseframe;
..	..	@@ -2434,17 +3100,26 @@
2434	3100	// }
2435	3101	// }
2436	3102
2437		- data[f3 + i] += pos[i] - data[frame3 + i];
	3103	+ data[f3 + i] += /pos[i]/ - data[frame3 + i];
2438	3104
2439	3105	// if (f < 3)
2440	3106	// {
2441	3107	// System.out.print(data[f3 + i] + " ");
2442	3108	// }
2443	3109	}
2444		-// if (f < 3)
2445		-// {
2446		-// System.out.println();
2447		-// }
	3110	+
	3111	+ double t1 = data[f3 + 0];
	3112	+ double t2 = data[f3 + 2];
	3113	+
	3114	+ data[f3 + 0] = (float)(cosYt1 - sinYt2);
	3115	+ data[f3 + 2] = (float)(sinYt1 + cosYt2);
	3116	+
	3117	+ for (int i=3/dof/; --i>=0;)
	3118	+ {
	3119	+ data[f3 + i] += pos[i];
	3120	+ }
	3121	+
	3122	+ data[f3 + 4] += angleY - data[frame3 + 4];
2448	3123	}
2449	3124	}
2450	3125
..	..	@@ -2458,186 +3133,17 @@
2458	3133	// temp.y = data[1];
2459	3134	// temp.z = data[2];
2460	3135
2461		- if (fade && currentbones != null && !CameraPane.fullreset)
2462		- {
2463		- Quat4d quatstart = new Quat4d();
2464		- Quat4d quatend = new Quat4d();
2465		- Quat4d quat = new Quat4d();
2466		- Matrix4d mat4d = new Matrix4d();
2467		- double[][] rot = new double[4][4];
2468		-
2469		- for (b=numbones; --b>=1;) // HIP ROTATION: 0;)
2470		- {
2471		- int hipindex = get(0)._index;
2472		-
2473		-// assert(get(0).get(0)._isHip);
2474		-
2475		- // if (b == hipindex)
2476		- // continue;
2477		-
2478		- data = bvh.animation.getBoneData(b);
2479		-
2480		- int dof = 3; // data.length/numframes;
2481		-
2482		- // assert(dof == 3);
2483		-
2484		- int boneframe3 = b*3; // dof;
2485		-
2486		- // System.err.println("Bone #" + b + ": dof = " + dof);
2487		- int fadein = 45; // 120;
2488		-
2489		- // if (b == hipindex)
2490		- // fadein *= 5;
2491		-
2492		- if (fadein > numframes)
2493		- fadein = 0; // numframes;
2494		-
2495		- for (int fi=fadein; --fi>=0;)
2496		- //for (int f=numframes; --f>=0;)
2497		- {
2498		- int f = fi + GetFirstFrame();
2499		-
2500		- int f3 = f*dof;
2501		-
2502		- float k = fi;
2503		-
2504		- k /= fadein - 1;
2505		-
2506		- if (Float.isNaN(k))
2507		- k = 1; // 0/0
2508		-
2509		- k = (float) (-Math.cos(k*Math.PI));
2510		- k += 1;
2511		- k /= 2;
2512		-
2513		- int start = 3;
2514		- int end = 0;
2515		-
2516		- if (dof == 6)
2517		- {
2518		- start = 6;
2519		- end = 3;
2520		- }
2521		-
2522		- if (b == 0)
2523		- {
2524		- _t1.setIdentity();
2525		- _t2.setIdentity();
2526		- _t2.rotZ(currentbones[boneframe3 + start-1-end]);
2527		- _t1.mul(_t2);
2528		- _t2.setIdentity();
2529		- if (b == 0)
2530		- {
2531		- _t2.rotY(currentbones[boneframe3 + start-2-end]);
2532		- _t1.mul(_t2);
2533		- _t2.setIdentity();
2534		- _t2.rotX(currentbones[boneframe3 + start-3-end]);
2535		- }
2536		- else
2537		- {
2538		- _t2.rotX(currentbones[boneframe3 + start-2-end]);
2539		- _t1.mul(_t2);
2540		- _t2.setIdentity();
2541		- _t2.rotY(currentbones[boneframe3 + start-3-end]);
2542		- }
2543		- _t1.mul(_t2);
2544		- _t2.setIdentity();
2545		-
2546		- _t1.get(mat4d);
2547		-
2548		- mat4d.get(quatstart);
2549		-
2550		- _t1.setIdentity();
2551		- _t2.setIdentity();
2552		- _t2.rotZ(data[f3 + start-1]);
2553		- _t1.mul(_t2);
2554		- _t2.setIdentity();
2555		- if (b == 0)
2556		- {
2557		- _t2.rotY(data[f3 + start-2]);
2558		- _t1.mul(_t2);
2559		- _t2.setIdentity();
2560		- _t2.rotX(data[f3 + start-3]);
2561		- }
2562		- else
2563		- {
2564		- _t2.rotX(data[f3 + start-2]);
2565		- _t1.mul(_t2);
2566		- _t2.setIdentity();
2567		- _t2.rotY(data[f3 + start-3]);
2568		- }
2569		-
2570		- _t1.mul(_t2);
2571		- _t2.setIdentity();
2572		-
2573		- _t1.get(mat4d);
2574		-
2575		- mat4d.get(quatend);
2576		-
2577		- double dot = quatstart.x*quatend.x +
2578		- quatstart.y*quatend.y +
2579		- quatstart.z*quatend.z +
2580		- quatstart.w*quatend.w
2581		- ;
2582		-
2583		- if (dot < 0)
2584		- {
2585		- quatend.x *= -1;
2586		- quatend.y *= -1;
2587		- quatend.z *= -1;
2588		- quatend.w *= -1;
2589		- }
2590		-
2591		- // k = 1-k;
2592		-
2593		- quat.x = (1-k)quatstart.x + kquatend.x;
2594		- quat.y = (1-k)quatstart.y + kquatend.y;
2595		- quat.z = (1-k)quatstart.z + kquatend.z;
2596		- quat.w = (1-k)quatstart.w + kquatend.w;
2597		-
2598		- quat.normalize();
2599		-
2600		- mat4d.set(quat);
2601		-
2602		- cJ3D.SetTransform(rot, mat4d);
2603		-
2604		- matrixToEulerXYZ(rot, temp);
2605		-
2606		- data[f3 + start-1] = -(float)temp.z;
2607		-
2608		- if (b == 0)
2609		- {
2610		- data[f3 + start-2] = -(float)temp.y;
2611		- data[f3 + start-3] = -(float)temp.x;
2612		- }
2613		- else
2614		- {
2615		- data[f3 + start-2] = -(float)temp.x;
2616		- data[f3 + start-3] = -(float)temp.y;
2617		- }
2618		- }
2619		- else
2620		- {
2621		- for (int i=start; --i>=end;)
2622		- {
2623		- //data[f3 + i] += pos[i] - data[frame3 + i];
2624		- // data[f3 + i] = kdata[f3+i] + (1-k)
2625		- // currentbones[boneframe3 + i-end];
2626		- data[f3 + i] = (float)CurveAngle(data[f3+i], currentbones[boneframe3 + i-end], 1-k);
2627		- }
2628		- }
2629		-
2630		- }
2631		- }
2632		-
2633		- }
	3136	+// if (fade && currentbones != null && !CameraPane.fullreset)
	3137	+// {
	3138	+// Fade();
	3139	+// }
2634	3140	}
2635		-
	3141	+
2636	3142	if (false) // doesn't change anything bone._isRoot)
2637	3143	{
2638	3144	// Reset orientation
2639	3145	_t2.setIdentity();
2640		-
	3146	+
2641	3147	double tx = bone.toParent[3][0];
2642	3148	double ty = bone.toParent[3][1];
2643	3149	double tz = bone.toParent[3][2];
..	..	@@ -2646,9 +3152,9 @@
2646	3152	temp.y = 0;
2647	3153	temp.z = 0;
2648	3154	LA.xformDir(temp, bone.toParent, temp);
2649		-
	3155	+
2650	3156	double angle = Math.atan2(-temp.z, temp.x);
2651		-
	3157	+
2652	3158	_t2.rotY(angle);
2653	3159	// _t1.setIdentity();
2654	3160	// _t1.rotX(temp.x);
..	..	@@ -2661,56 +3167,21 @@
2661	3167	// _t1.setIdentity();
2662	3168	// _t1.rotZ(temp.z);
2663	3169	// _t2.mul(_t1);
2664		-
	3170	+
2665	3171	cJ3D.ResetTransform(bone, _t2, false);
2666		-
	3172	+
2667	3173	bone.toParent[3][0] = tx;
2668	3174	bone.toParent[3][1] = ty;
2669	3175	bone.toParent[3][2] = tz;
2670	3176	}
2671	3177	}
2672	3178
2673		- if (currentbones == null)
2674		- currentbones = new double[numbones*3];
2675		-
2676		- for (int b=numbones; --b>=1;) // 0;)
2677		- //int b = 0;
2678		- {
2679		- data = bvh.animation.getBoneData(b);
2680		-
2681		- int numframes = bvh.animation.getNumFrames();
2682		-
2683		- int dof = 6; // data.length/numframes;
2684		-
2685		- if (b > 0)
2686		- dof = 3;
2687		-
2688		- //assert(dof == 3);
2689		-
2690		- // System.err.println("Bone #" + b + ": dof = " + dof);
2691		- int theframe = // 1; // baseframe;
2692		- frame;
2693		-
2694		- int frame3 = theframe*dof;
2695		- int bone3 = b*3; // dof;
2696		-
2697		- int start = 3;
2698		- int end = 0;
2699		-
2700		- if (dof == 6)
2701		- {
2702		- start = 6;
2703		- end = 3;
2704		- }
2705		- for (int i=start; --i>=end;)
2706		- {
2707		- currentbones[bone3 + i-end] = data[frame3 + i];
2708		- }
2709		- }
	3179	+ // SetCurrentBones(frame);
2710	3180	}
2711	3181	}
2712	3182
2713		- static int offset = 1; // 5; // 10; // 5; // 100; // skip initial "T"
	3183	+ // skip initial "T"
	3184	+ static int offset = 1; // 5; // 10; // 5; // 100;
2714	3185
2715	3186	void ReadBVH()
2716	3187	{
..	..	@@ -2739,14 +3210,14 @@
2739	3210
2740	3211	void Reset()
2741	3212	{
2742		- if (fullname != null)
2743		- ReadBVH();
	3213	+// if (fullname != null)
	3214	+// ReadBVH();
2744	3215
2745	3216	Object3D hip = get(0);
2746	3217
2747	3218	// assert(obj.name.equals("hip"));
2748	3219
2749		- Object3D rot = hip.get(0);
	3220	+ //Object3D rot = hip.get(0);
2750	3221
2751	3222	// assert(obj.name == null); // .equals("hip#"));
2752	3223
..	..	@@ -2756,8 +3227,8 @@
2756	3227	hip.fromParent = LA.newMatrix();
2757	3228	}
2758	3229
2759		- hip.toParent[3][0] = hip.toParent[3][1] = hip.toParent[3][2] = 0;
2760		- hip.fromParent[3][0] = hip.fromParent[3][1] = hip.fromParent[3][2] = 0;
	3230	+ //hip.toParent[3][0] = hip.toParent[3][1] = hip.toParent[3][2] = 0;
	3231	+ //hip.fromParent[3][0] = hip.fromParent[3][1] = hip.fromParent[3][2] = 0;
2761	3232
2762	3233	if (toParent == null)
2763	3234	{
..	..	@@ -2769,26 +3240,29 @@
2769	3240	LA.matIdentity(fromParent);
2770	3241	// LA.matIdentity(hip.toParent);
2771	3242	// LA.matIdentity(hip.fromParent);
2772		- if (rot.toParent == null)
2773		- {
2774		- // june 2014
2775		- rot.toParent = LA.newMatrix();
2776		- rot.fromParent = LA.newMatrix();
2777		- }
2778		- LA.matIdentity(rot.toParent);
2779		- LA.matIdentity(rot.fromParent);
	3243	+// if (rot.toParent == null)
	3244	+// {
	3245	+// // june 2014
	3246	+// rot.toParent = LA.newMatrix();
	3247	+// rot.fromParent = LA.newMatrix();
	3248	+// }
	3249	+// LA.matIdentity(rot.toParent);
	3250	+// LA.matIdentity(rot.fromParent);
2780	3251
2781	3252	// july 2014
2782		- goalx = goalz = 0;
2783		- targetx = targetz = 0;
	3253	+// goalx = goalz = 0;
	3254	+ targetdirx = targetdirz = 0;
2784	3255
2785		- SetPositionDelta(true, true, true, false);
	3256	+ //SetPositionDelta(true, true, true, false);
	3257	+// LoadData();
	3258	+// Rewind();
2786	3259
2787	3260	baseframe = frame = 0; // T pose. No offset.
2788	3261
2789	3262	// aout 2013 endframe = 0; // june 2013
2790	3263
2791		- setPose(frame);
	3264	+ ResetZero();
	3265	+ //setPose(frame);
2792	3266	}
2793	3267
2794	3268	static int mocapsupport = 0;
..	..	@@ -2806,12 +3280,13 @@
2806	3280
2807	3281	int step = 1;
2808	3282
	3283	+ // patch for running hare
2809	3284	if (speedup) // fev 2014
2810	3285	step *= 2; // 4;
2811	3286	if (rewind) // mars 2014
2812	3287	step *= 4;
2813	3288
2814		- if (CameraPane.FAST) // && !CameraPane.HOLD)
	3289	+ //if (CameraPane.FAST) // && !CameraPane.HOLD)
2815	3290	step *= CameraPane.STEP;
2816	3291
2817	3292	//System.err.println("Step Mocap frame # " + frame);
..	..	@@ -2819,7 +3294,7 @@
2819	3294	baseframe += step;
2820	3295
2821	3296	//frame = baseframe;
2822		- frame += step;
	3297	+ //frame += step;
2823	3298
2824	3299	// if (frame != baseframe)
2825	3300	// {
..	..	@@ -2833,6 +3308,7 @@
2833	3308	if (lastframetest == 0)
2834	3309	lastframetest = bvh.animation.getNumFrames();
2835	3310
	3311	+ // WARNING: RESET DESTROYS EVERYTHING
2836	3312	if (baseframe >= lastframetest) // july 2013 // - GetFirstFrame())
2837	3313	{
2838	3314	System.out.println("MOCAP reset: " + this.GetFileRoot() +
..	..	@@ -2842,7 +3318,7 @@
2842	3318	"; fullname = " + fullname);
2843	3319
2844	3320	//int delta = frame - baseframe;
2845		- if (CameraPane.CROWD)
	3321	+ if (Globals.CROWD)
2846	3322	{
2847	3323	baseframe = GetFirstFrame(); // 0 initial point
2848	3324	}
..	..	@@ -2851,29 +3327,53 @@
2851	3327	// SetPositionDelta(false, true, false); // ?? false);
2852	3328	{
2853	3329	if (support == null)
2854		- ObjEditor.LoadBVHFile(fullname, this, false, beginframe, lastframetest);
2855		- else
2856	3330	{
2857		- try
	3331	+ if (bvh == null && new File(fullname).exists())
	3332	+ ObjEditor.LoadBVHFile(fullname, this, false, beginframe, lastframetest);
	3333	+ else
2858	3334	{
2859		- bvh = ((Mocap)support.get(mocapsupport++ % support.Size())).bvh;
2860		-
2861		- SetPositionDelta(false, true, true, true);
2862		- }
2863		- catch (Exception e)
2864		- {
2865		- e.printStackTrace();
2866		- ObjEditor.LoadBVHFile(fullname, this, false, beginframe, lastframetest);
	3335	+ SetGlobalTransform();
	3336	+ Rewind();
	3337	+ Fade();
2867	3338	}
2868	3339	}
	3340	+ else
	3341	+ {
	3342	+// try
	3343	+// {
	3344	+ bvh = ((Mocap)support.get(mocapsupport++ % support.Size())).bvh;
	3345	+
	3346	+ // SetPositionDelta(false, true, true, true);
	3347	+ LoadData();
	3348	+ Rewind();
	3349	+ Fade();
	3350	+// }
	3351	+// catch (Exception e)
	3352	+// {
	3353	+// System.err.println("An error occured while loading data. Use fallback by loading the file.");
	3354	+// //e.printStackTrace();
	3355	+// try
	3356	+// {
	3357	+// ObjEditor.LoadBVHFile(fullname, this, false, beginframe, lastframetest);
	3358	+// }
	3359	+// catch (Exception e2)
	3360	+// {
	3361	+// System.err.println("Motion file not found: " + fullname);
	3362	+// }
	3363	+// }
	3364	+ }
2869	3365	}
	3366	+
	3367	+ frame = GetFirstFrame();
2870	3368	}
	3369	+ else
	3370	+ frame += step;
2871	3371
2872	3372	//SetPositionDelta(false);
2873	3373
2874		- if (frame >= bvh.animation.getNumFrames())
2875		- //baseframe =
2876		- frame = GetFirstFrame(); // 0; // offset; // initial point
	3374	+// if (frame >= bvh.animation.getNumFrames())
	3375	+// //baseframe =
	3376	+// frame = GetFirstFrame(); // 0; // offset; // initial point
2877	3377
2878	3378	//System.err.println("frame = " + frame);
2879	3379	if (lastframe != 0)
..	..	@@ -3042,6 +3542,7 @@
3042	3542	// filters out bad input data
3043	3543	void FilterAnimData()
3044	3544	{
	3545	+ new Exception().printStackTrace();
3045	3546	System.exit(0);
3046	3547
3047	3548	float[] data; // = bvh.animation.getBoneData(0);
..	..	@@ -3171,6 +3672,8 @@
3171	3672	//static
3172	3673	transient
3173	3674	double[] currentbones;
	3675	+ double[] currenthip;
	3676	+
3174	3677	transient boolean inbetween;
3175	3678
3176	3679	void SetPositionDelta(boolean reset, boolean rewind, boolean load, boolean fade)
..	..	@@ -3181,38 +3684,9 @@
3181	3684	//assert(dim == numframes*6);
3182	3685
3183	3686	if (load)
3184		- for (int b=numbones; --b>=0;)
3185		- //int b = 0;
3186		- {
3187		- float[] thedata = bvh.animation.getBoneData(b);
3188		-
3189		- int numframes = bvh.animation.getNumFrames();
3190		-
3191		- int dof = 6; // thedata.length/numframes;
3192		-
3193		- if (b > 0)
3194		- dof = 3;
3195		-
3196		- if (dof != thedata.length/numframes)
3197		- {
3198		- System.err.println("Bone #" + b + ": dof = " + dof + " ---> " + (thedata.length/numframes));
3199		- dof = thedata.length/numframes;
3200		- }
3201		-
3202		- //for (int f=numframes; --f>=offset;)
3203		- int firstframe = GetFirstFrame();
3204		- for (int f=0; f<numframes-firstframe; f++)
3205		- {
3206		- int f3 = f*dof;
3207		-
3208		- //for (int i=3/dof/; --i>=0;)
3209		- for (int i=dof; --i>=0;)
3210		- {
3211		- //thedata[f3 + i] += thedata[i] - thedata[offset*dof + i];
3212		- thedata[f3 + i] = thedata[f3 + firstframe*dof + i];
3213		- }
3214		- }
3215		- }
	3687	+ {
	3688	+ LoadData();
	3689	+ }
3216	3690
3217	3691	// assert(thedata[0] == 0);
3218	3692	// assert(thedata[1] == 0);
..	..	@@ -3222,11 +3696,11 @@
3222	3696	// assert(thedata[7] == 0);
3223	3697	// assert(thedata[8] == 0);
3224	3698
3225		- Object3D obj = get(0);
	3699	+ Object3D hip = get(0);
3226	3700
3227	3701	// assert(obj.name.equals("hip"));
3228	3702
3229		- Object3D rot = obj.get(0);
	3703	+ Object3D rot = hip.get(0);
3230	3704
3231	3705	// if (toParent == null)
3232	3706	// {
..	..	@@ -3238,7 +3712,7 @@
3238	3712	// // assert(obj.name == null); // .equals("hip#"));
3239	3713
3240	3714	Invariants();
3241		- obj.Invariants();
	3715	+ hip.Invariants();
3242	3716	rot.Invariants();
3243	3717
3244	3718	if (origin == null)
..	..	@@ -3259,16 +3733,16 @@
3259	3733	fromParent = LA.newMatrix();
3260	3734	}
3261	3735
3262		- if (obj.toParent == null) // june 2014
	3736	+ if (hip.toParent == null) // june 2014
3263	3737	{
3264		- obj.toParent = LA.newMatrix();
3265		- obj.fromParent = LA.newMatrix();
	3738	+ hip.toParent = LA.newMatrix();
	3739	+ hip.fromParent = LA.newMatrix();
3266	3740	}
3267	3741
3268		- LA.matConcat(toParent, obj.toParent, origin0.toParent); // AB
	3742	+ LA.matConcat(toParent, hip.toParent, origin0.toParent); // AB
3269	3743	Object3D gp = this.parent;
3270	3744	this.parent = null;
3271		- obj.GlobalTransformInv();
	3745	+ hip.GlobalTransformInv();
3272	3746	this.parent = gp;
3273	3747
3274	3748	if (rot.toParent == null)
..	..	@@ -3291,41 +3765,41 @@
3291	3765	LA.matInvert(origin.toParent, origin.fromParent);
3292	3766
3293	3767	Invariants();
3294		- obj.Invariants();
	3768	+ hip.Invariants();
3295	3769	rot.Invariants();
3296	3770	origin.Invariants();
3297	3771	origin0.Invariants();
3298	3772
3299		- firsttimeafterload = true;
	3773	+ firsttimeafterload = false; // true;
3300	3774
3301	3775	if (rewind)
3302	3776	Rewind();
3303	3777
3304		- setPose(obj, frame, bvh.animation.getBoneData(obj._index), fade);
	3778	+ setPose(hip, frame, bvh.animation.getBoneData(hip._index)); //, fade);
3305	3779
3306		- if (true)
3307		- return;
	3780	+ if (true)
	3781	+ return;
3308	3782
3309	3783	double pos[] = new double[6];
3310	3784
3311	3785	if (!reset)
3312	3786	{
3313		- assert(obj.tx == obj.toParent[3][0]);
3314		- assert(obj.ty == obj.toParent[3][1]);
3315		- assert(obj.tz == obj.toParent[3][2]);
	3787	+ assert(hip.tx == hip.toParent[3][0]);
	3788	+ assert(hip.ty == hip.toParent[3][1]);
	3789	+ assert(hip.tz == hip.toParent[3][2]);
3316	3790
3317		- pos[0] = obj.tx; // obj.toParent[3][0];
3318		- pos[1] = obj.ty; // obj.toParent[3][1];
3319		- pos[2] = obj.tz; // obj.toParent[3][2];
3320		- pos[3] = obj.rz;
3321		- pos[4] = obj.ry;
3322		- pos[5] = obj.rx;
	3791	+ pos[0] = hip.tx; // obj.toParent[3][0];
	3792	+ pos[1] = hip.ty; // obj.toParent[3][1];
	3793	+ pos[2] = hip.tz; // obj.toParent[3][2];
	3794	+ pos[3] = hip.rz;
	3795	+ pos[4] = hip.ry;
	3796	+ pos[5] = hip.rx;
3323	3797	}
3324	3798
3325	3799	cVector temp = new cVector();
3326		- temp.x = obj.globalTransform[3][0];
3327		- temp.y = obj.globalTransform[3][1];
3328		- temp.z = obj.globalTransform[3][2];
	3800	+ temp.x = hip.globalTransform[3][0];
	3801	+ temp.y = hip.globalTransform[3][1];
	3802	+ temp.z = hip.globalTransform[3][2];
3329	3803	// LA.xformPos(temp, origin0.toParent, temp);
3330	3804	// System.err.println("POS0 = " + temp.x + ", " + temp.y + ", " + temp.z + ";");
3331	3805
..	..	@@ -3409,7 +3883,7 @@
3409	3883	}
3410	3884
3411	3885	// Rewind();
3412		- setPose(obj, frame, bvh.animation.getBoneData(obj._index), true);
	3886	+ setPose(hip, frame, bvh.animation.getBoneData(hip._index)); // , true);
3413	3887	}
3414	3888
3415	3889	void Rewind()
..	..	@@ -3426,7 +3900,7 @@
3426	3900
3427	3901	transient boolean restarted; // CROWD issue?
3428	3902
3429		- void drawSelf(CameraPane display, Object3D /Composite/ root, boolean selected, boolean blocked)
	3903	+ void drawSelf(iCameraPane display, Object3D /Composite/ root, boolean selected, boolean blocked)
3430	3904	{
3431	3905	//System.err.println("drawSelf Mocap frame # " + frame);
3432	3906	//System.err.println("drawSelf Mocap baseframe # " + baseframe);
..	..	@@ -3443,17 +3917,24 @@
3443	3917	// if (firstframe)
3444	3918	// return;
3445	3919
3446		- if (!restarted && /display.restartframe &&/
3447		- display.isLIVE() && live && display.drawMode == display.SHADOW) // FUCK
	3920	+ if (//!restarted && /display.restartframe &&/
	3921	+ Globals.isLIVE() && live && (display.DrawMode() == iCameraPane.SHADOW \|\| !Globals.RENDERSHADOW \|\| !Globals.COMPUTESHADOWWHENLIVE))
3448	3922	{
3449	3923	//display.restartframe = false;
3450	3924	restarted = true;
	3925	+ //System.err.println("restarted = true");
3451	3926	Step();
	3927	+
	3928	+ Globals.lighttouched = true;
3452	3929	}
3453	3930	else
3454	3931	{
3455		- if (display.isLIVE() && live && display.drawMode != display.SHADOW)
	3932	+ //System.err.println("restarted");
	3933	+ if (Globals.isLIVE() && live && display.DrawMode() != iCameraPane.SHADOW)
	3934	+ {
3456	3935	restarted = false;
	3936	+ //System.err.println("restarted = false");
	3937	+ }
3457	3938	}
3458	3939
3459	3940	super.drawSelf(display, root, selected, blocked);
..	..	@@ -3513,6 +3994,11 @@
3513	3994	// GetObject().release(i);
3514	3995	}
3515	3996
	3997	+ boolean HasBigData()
	3998	+ {
	3999	+ return skeleton != null;
	4000	+ }
	4001	+
3516	4002	public Object3D get(int i)
3517	4003	{
3518	4004	if (i != 0)