23306a746361667401c223b7226f44357e07230e
[sdk] / ecere / src / gfx / 3D / Object.ec
1 namespace gfx3D;
2
3 import "Display"
4
5 public enum FrustumPlacement { outside, inside, intersecting };
6
7 public class ObjectFormat
8 {
9    class_data const char * extension;
10    class_property const char * extension
11    {
12       set { class_data(extension) = value; }
13       get { return class_data(extension); }
14    }
15
16    virtual bool ::Load(Object object, const char * fileName, DisplaySystem displaySystem);
17 };
18
19 // TODO: Review these:
20 public class ObjectFlags
21 {
22 public:
23    bool root:1, viewSpace:1, ownMesh:1, translucent:1, flipWindings:1, keysLoaded:1, transform:1, mesh:1, light:1, camera:1, localMatrixSet:1;
24    int hierarchy:16:16;
25 };
26
27 public struct Transform
28 {
29    Vector3D position;
30    Quaternion orientation;
31    Vector3Df scaling;
32 };
33
34 /*static float ease(float t, float a, float b)
35 {
36    float k;
37    float s = a + b;
38
39    if (s == 0.0f) return t;
40    if (s > 1.0f)
41    {
42       a /= s;
43       b /= s;
44    }
45    k = 1.0f/(2.0f-a-b);
46    if (t < a) return (k/a)*t*t;
47    if (t < 1.0f - b) return k*(2.0f * t - a);
48    t = 1.0f - t;
49    return 1.0f - (k/b)*t*t;
50 }*/
51
52 public enum FrameTrackType : uint16 { position = 1, rotation, scaling, fov, roll, colorChange, morph, hotSpot, fallOff, hide };
53
54 public class FrameTrackBits
55 {
56    FrameTrackType type;
57    bool loop:1;
58 };
59
60 public struct FrameKey
61 {
62    unsigned int frame;
63    float tension, continuity, bias;
64    float easeFrom, easeTo;
65    union
66    {
67       Vector3Df position;
68       Quaternion orientation;
69       Vector3Df scaling;
70       float roll;
71       float fov;
72       ColorRGB color;
73       float hotSpot;
74       float fallOff;
75    };
76 };
77
78 enum SplinePart { splinePoint, splineA, splineB };
79
80 public class FrameTrack : struct
81 {
82    FrameTrack prev, next;
83    FrameTrackBits type;
84    unsigned int numKeys;
85    FrameKey * keys;
86
87    void Free(void)
88    {
89       delete keys;
90    }
91
92    ~FrameTrack()
93    {
94       Free();
95    }
96
97    float GetFloat(SplinePart what, unsigned int n)
98    {
99       float value;
100       FrameKey *kn_1, *kn, *kn1;
101       float pn_1, pn, pn1;
102       int d1, d2;
103
104       kn = &keys[n];
105       pn = kn->roll;
106
107       if(what == splinePoint)
108          value = pn;
109       else
110       {
111          if(n == 0)
112          {
113             kn1 = &keys[1];
114             pn1 = kn1->roll;
115
116             if(numKeys == 2)
117             {
118                value = pn1 - pn;
119                value *= 1.0f - kn->tension;
120                return value;
121             }
122             if(type.loop)
123             {
124                kn_1 = &keys[numKeys-2];
125                d1 = keys[numKeys-1].frame - kn_1->frame;
126                d2 = kn1->frame - kn->frame;
127             }
128             else
129             {
130                float a1;
131                value = pn1 - pn;
132                value *= 1.5f;
133
134                a1 = GetFloat(splineA, 1);
135                a1 *= 0.5f;
136
137                value -= a1;
138                value *= 1.0f - kn->tension;
139                return value;
140             }
141          }
142          else if(n == numKeys-1)
143          {
144             kn_1 = &keys[n-1];
145             pn_1 = kn_1->roll;
146
147             if(numKeys == 2)
148             {
149                value = pn - pn_1;
150                value *= 1.0f - kn->tension;
151                return value;
152             }
153             if(type.loop)
154             {
155                kn1 = &keys[1];
156                d1 = kn->frame - kn_1->frame;
157                d2 = kn1->frame - keys[0].frame;
158             }
159             else
160             {
161                float bn_1;
162                value = pn - pn_1;
163                value *= 1.5f;
164
165                bn_1 = GetFloat(splineB, n-1);
166                bn_1 *= 0.5f;
167
168                value -= bn_1;
169                value *= 1.0f - kn->tension;
170                return value;
171             }
172          }
173          else
174          {
175             kn_1 = &keys[n-1];
176             kn1 = &keys[n+1];
177             d1 = kn->frame - kn_1->frame;
178             d2 = kn1->frame - kn->frame;
179          }
180          {
181             float C, adjust;
182             float part1, part2;
183
184             pn_1 = kn_1->roll;
185             pn1 = kn1->roll;
186
187             if(what == splineA)
188             {
189                C = kn->continuity;
190                adjust = (float)d1;
191             }
192             else
193             {
194                C = -kn->continuity;
195                adjust = (float)d2;
196             }
197             adjust /= d1 + d2;
198             adjust = 0.5f + (1.0f - Abs(C))*(adjust - 0.5f);
199
200             part1 = pn - pn_1;
201             part1 *= (1.0f + kn->bias)*(1.0f - C);
202
203             part2 = pn1 - pn;
204             part2 *= (1.0f - kn->bias)*(1.0f + C);
205
206             value = part1 + part2;
207             value *= (1.0f - kn->tension)*adjust;
208          }
209       }
210       return value;
211    }
212
213    void GetVector(Vector3Df vector, SplinePart what, unsigned int n)
214    {
215       FrameKey *kn_1, *kn, *kn1;
216       Vector3Df *pn_1, *pn, *pn1;
217       int d1, d2;
218
219       kn = &keys[n];
220       pn = &kn->position;
221
222       if(what == splinePoint)
223          vector = *pn;
224       else
225       {
226          if(n == 0)
227          {
228             kn1 = &keys[1];
229             pn1 = &kn1->position;
230
231             if(numKeys == 2)
232             {
233                vector.Subtract(pn1, pn);
234                vector.Scale(vector, 1.0f - kn->tension);
235                return;
236             }
237             if(type.loop)
238             {
239                kn_1 = &keys[numKeys-2];
240                d1 = keys[numKeys-1].frame - kn_1->frame;
241                d2 = kn1->frame - kn->frame;
242             }
243             else
244             {
245                Vector3Df a1;
246                vector.Subtract(pn1, pn);
247                vector.Scale(vector, 1.5f);
248
249                GetVector(a1, splineA, 1);
250                a1.Scale(a1, 0.5f);
251
252                vector.Subtract(vector, a1);
253                vector.Scale(vector, 1.0f - kn->tension);
254                return;
255             }
256          }
257          else if(n == numKeys-1)
258          {
259             kn_1 = &keys[n-1];
260             pn_1 = &kn_1->position;
261
262             if(numKeys == 2)
263             {
264                vector.Subtract(pn, pn_1);
265                vector.Scale(vector, 1.0f - kn->tension);
266                return;
267             }
268             if(type.loop)
269             {
270                kn1 = &keys[1];
271                d1 = kn->frame - kn_1->frame;
272                d2 = kn1->frame - keys[0].frame;
273             }
274             else
275             {
276                Vector3Df bn_1;
277                vector.Subtract(pn, pn_1);
278                vector.Scale(vector, 1.5f);
279
280                GetVector(&bn_1, splineB, n-1);
281                bn_1.Scale(bn_1, 0.5f);
282
283                vector.Subtract(vector, bn_1);
284                vector.Scale(vector, 1.0f - kn->tension);
285                return;
286             }
287          }
288          else
289          {
290             kn_1 = &keys[n-1];
291             kn1 = &keys[n+1];
292             d1 = kn->frame - kn_1->frame;
293             d2 = kn1->frame - kn->frame;
294          }
295          {
296             float C, adjust;
297             Vector3Df part1, part2;
298
299             pn_1 = &kn_1->position;
300             pn1 = &kn1->position;
301
302             if(what == splineA)
303             {
304                C = kn->continuity;
305                adjust = (float)d1;
306             }
307             else
308             {
309                C = -kn->continuity;
310                adjust = (float)d2;
311             }
312             adjust /= d1 + d2;
313             adjust = 0.5f + (1.0f - Abs(C))*(adjust - 0.5f);
314
315             part1.Subtract(pn, pn_1);
316             part1.Scale(part1, (1.0f + kn->bias)*(1.0f - C));
317
318             part2.Subtract(pn1, pn);
319             part2.Scale(part2, (1.0f - kn->bias)*(1.0f + C));
320
321             vector.Add(part1, part2);
322             vector.Scale(vector, (1.0f - kn->tension)*adjust);
323          }
324       }
325    }
326
327    void GetQuaternion(Quaternion quat, SplinePart what, unsigned int n)
328    {
329       FrameKey *kn_1, *kn, *kn1;
330       Quaternion *qn_1, *qn, *qn1;
331       int d1, d2;
332
333       kn = &keys[n];
334       qn = &kn->orientation;
335
336       if (what == splinePoint)
337          quat = *qn;
338       else
339       {
340          if(n == 0)
341          {
342             kn1 = &keys[1];
343
344             if (!(type.loop) || numKeys <= 2)
345             {
346                qn1 = &kn1->orientation;
347                quat.Slerp(qn, qn1, (1.0f - kn->tension)*(1.0f + kn->continuity*kn->bias)/3.0f);
348                return;
349             }
350             else
351             {
352                kn_1= &keys[numKeys-2];
353                d1 = keys[numKeys-1].frame - kn_1->frame;
354                d2 = kn1->frame - kn->frame;
355             }
356          }
357          else if (n == numKeys-1)
358          {
359             kn_1 = &keys[n-1];
360
361             if (!(type.loop) || numKeys <= 2)
362             {
363                qn_1 = &kn_1->orientation;
364                quat.Slerp(qn, qn_1, (1.0f - kn->tension)*(1.0f - kn->continuity*kn->bias)/3.0f);
365                return;
366             }
367             else
368             {
369                kn1 = &keys[1];
370                d1 = kn->frame - kn_1->frame;
371                d2 = kn1->frame - keys[0].frame;
372             }
373          }
374          else
375          {
376             kn_1 = &keys[n-1];
377             kn1 = &keys[n+1];
378             d1 = kn->frame - kn_1->frame;
379             d2 = kn1->frame - kn->frame;
380          }
381          {
382             float f, adjust;
383             Quaternion g1, g2, tmp;
384
385             qn_1 = &kn_1->orientation;
386             qn1 = &kn1->orientation;
387
388             if (what == splineA)
389             {
390                f = 1.0f;
391                adjust = (float)d1;
392             }
393             else
394             {
395                f = -1.0f;
396                adjust = (float)d2;
397             }
398             adjust /= d1 + d2;
399             adjust = 0.5f + (1.0f - Abs(kn->continuity))*(adjust - 0.5f);
400
401             g1.Slerp(qn, qn_1,-(1.0f + kn->bias)/3.0f);
402             g2.Slerp(qn, qn1 , (1.0f - kn->bias)/3.0f);
403             tmp.Slerp(g1, g2, 0.5f + f*0.5f*kn->continuity);
404             quat.Slerp(qn, &tmp, f*(kn->tension - 1.0f)*adjust*2.0f);
405          }
406       }
407    }
408
409    void Interpolate(Vector3Df vector, Vector3Df prevVector, Vector3Df nextVector, int prev, int next, float t)
410    {
411       if(!t)
412          vector = prevVector;
413       else
414       {
415          Vector3Df p1 = prevVector, p2 = nextVector;
416          Vector3Df r1, r2;
417
418          GetVector(r1, splineB, prev);
419          GetVector(r2, splineA, next);
420
421          p1.Scale(p1, 2*t*t*t - 3*t*t + 1);
422          p2.Scale(p2,-2*t*t*t + 3*t*t);
423
424          r1.Scale(r1, t*t*t - 2*t*t + t);
425          r2.Scale(r2, t*t*t -   t*t);
426
427          vector = p1;
428          vector.Add(vector, r1);
429          vector.Add(vector, p2);
430          vector.Add(vector, r2);
431       }
432    }
433
434    void InterpolateQuat(Quaternion quat, Quaternion prevQuat, Quaternion nextQuat, int prev, int next, float t)
435    {
436       if(!t)
437          quat = prevQuat;
438       else
439       {
440          Quaternion a, b;
441          Quaternion q0, q1, q2;
442
443          GetQuaternion(b, splineB, prev);
444          GetQuaternion(a, splineA, next);
445
446          q0.Slerp(prevQuat, b, t);
447          q1.Slerp(b, a, t);
448          q2.Slerp(a, nextQuat, t);
449
450          q0.Slerp(q0, q1, t);
451          q1.Slerp(q1, q2, t);
452
453          quat.Slerp(q0, q1, t);
454       }
455    }
456
457    float InterpolateFloat(float prevValue, float nextValue, int prev, int next, float t)
458    {
459       float value;
460       if(!t)
461          value = prevValue;
462       else
463       {
464          float p1 = prevValue, p2 = nextValue;
465
466          float r1 = GetFloat(splineB, prev);
467          float r2 = GetFloat(splineA, next);
468
469          p1 *= 2*t*t*t - 3*t*t + 1;
470          p2 *= -2*t*t*t + 3*t*t;
471
472          r1 *= t*t*t - 2*t*t + t;
473          r2 *= t*t*t -   t*t;
474
475          value = p1 + r1 + p2 + r2;
476       }
477       return value;
478    }
479 };
480
481 static bool FindMaterialAndType(Mesh mesh, Material material, PrimitiveGroupType type)
482 {
483    PrimitiveGroup group;
484    for(group = mesh.groups.first; group; group = group.next)
485       if(group.material == material && group.type == type)
486          return true;
487    return false;
488 }
489
490 public class Object
491 {
492 public:
493    void SetMinMaxRadius(bool processMesh)
494    {
495       Object child;
496
497       if(flags.mesh && mesh)
498       {
499          if(processMesh)
500             mesh.SetMinMaxRadius();
501          min = mesh.min;
502          max = mesh.max;
503          volume = (max.x >= min.x && max.y >= min.y && max.z >= min.z);
504       }
505       else
506       {
507          min = { MAXFLOAT, MAXFLOAT, MAXFLOAT };
508          max = { -MAXFLOAT, -MAXFLOAT, -MAXFLOAT };
509          volume = false;
510       }
511       for(child = children.first; child; child = child.next)
512       {
513          child.SetMinMaxRadius(processMesh);
514
515          if(child.volume)
516          {
517             // Child Local + Child Object Transform
518             Vector3Df points[8] =
519             {
520                { child.min.x, child.min.y, child.min.z },
521                { child.min.x, child.min.y, child.max.z },
522                { child.min.x, child.max.y, child.min.z },
523                { child.min.x, child.max.y, child.max.z },
524                { child.max.x, child.min.y, child.min.z },
525                { child.max.x, child.min.y, child.max.z },
526                { child.max.x, child.max.y, child.min.z },
527                { child.max.x, child.max.y, child.max.z }
528             };
529             int c;
530             for(c = 0; c<8; c++)
531             {
532                Vector3Df point;
533                point.MultMatrix(points[c], child.localMatrix);
534
535                if(point.x < min.x) min.x = point.x;
536                if(point.y < min.y) min.y = point.y;
537                if(point.z < min.z) min.z = point.z;
538
539                if(point.x > max.x) max.x = point.x;
540                if(point.y > max.y) max.y = point.y;
541                if(point.z > max.z) max.z = point.z;
542             }
543             volume = true;
544          }
545       }
546
547       if(volume)
548       {
549          Vector3Df points[8] =
550          {
551             { min.x, min.y, min.z },
552             { min.x, min.y, max.z },
553             { min.x, max.y, min.z },
554             { min.x, max.y, max.z },
555             { max.x, min.y, min.z },
556             { max.x, min.y, max.z },
557             { max.x, max.y, min.z },
558             { max.x, max.y, max.z }
559          };
560          Vector3Df halfExtent;
561          Vector3D halfExtentd;
562
563          // Local
564          center.Add(min, max);
565          center.Scale(center, 0.5f);
566          halfExtent.Subtract(max, min);
567          halfExtent.Scale(halfExtent, 0.5f);
568          radius = halfExtent.length;
569
570          // World
571          {
572             Vector3D min { MAXFLOAT, MAXFLOAT, MAXFLOAT };
573             Vector3D max { -MAXFLOAT, -MAXFLOAT, -MAXFLOAT };
574             int c;
575             for(c = 0; c<8; c++)
576             {
577                Vector3D point;
578                point.MultMatrixf(points[c], matrix);
579
580                if(point.x < min.x) min.x = point.x;
581                if(point.y < min.y) min.y = point.y;
582                if(point.z < min.z) min.z = point.z;
583
584                if(point.x > max.x) max.x = point.x;
585                if(point.y > max.y) max.y = point.y;
586                if(point.z > max.z) max.z = point.z;
587             }
588             wmin = min;
589             wmax = max;
590          }
591          wcenter.Add(wmin, wmax);
592          wcenter.Scale(wcenter, 0.5f);
593
594          halfExtentd.Subtract(wmax, wmin);
595          halfExtentd.Scale(halfExtentd, 0.5);
596          wradius = halfExtentd.length;
597       }
598    }
599
600    void Duplicate(Object model)
601    {
602       if(model)
603       {
604          Object modelChild;
605
606          name = CopyString(model.name);
607          flags = model.flags;
608          flags.ownMesh = false;
609          flags.transform = false;
610          mesh = model.mesh;
611          /*
612          min = model.min;
613          max = model.max;
614          radius = model.radius;
615          */
616          if(parent && !flags.root)
617             matrix.Multiply(localMatrix, parent.matrix);
618          else
619             matrix = localMatrix;
620
621          for(modelChild = model.children.first; modelChild; modelChild = modelChild.next)
622          {
623             Object child { parent = this };
624             child.localMatrix = modelChild.localMatrix;
625             child.transform = modelChild.transform;
626             child.Duplicate(modelChild);
627             children.AddName(child);
628          }
629       }
630    }
631
632    void Free(DisplaySystem displaySystem)
633    {
634       if(this)
635       {
636          Object child;
637
638          while((child = children.first))
639          {
640             children.Remove(child);
641             child.Free(displaySystem);
642
643             // We did not do this before so as to keep transform on reloading for new DisplaySystem
644             // However since children are removed, it seems that purpose has been gone, we'd need
645             // a new mechanism to handle lost resources reloading...
646             delete child;
647          }
648          if(flags.ownMesh && mesh)
649          {
650             DisplaySystem meshDisplaySystem = mesh.displaySystem;
651             mesh.Free(0);
652             if(meshDisplaySystem)
653                meshDisplaySystem.RemoveMesh(mesh);
654             delete mesh;
655          }
656
657          tracks.Free(FrameTrack::Free);
658
659          delete name;
660       }
661    }
662
663    bool Load(const char * fileName, const char * type, DisplaySystem displaySystem)
664    {
665       char ext[MAX_EXTENSION];
666       subclass(ObjectFormat) format;
667       OldLink link;
668       bool result = false;
669
670       if(!type && fileName)
671          type = strlwr(GetExtension(fileName, ext));
672
673       for(link = class(ObjectFormat).derivatives.first; link; link = link.next)
674       {
675          format = link.data;
676          if(format.extension && !strcmp(format.extension, type))
677             break;
678       }
679       if(!link) format = null;
680
681       if(format)
682       {
683          if((format.Load(this, fileName, displaySystem)))
684             result = true;
685       }
686       /*if(!result)
687           ErrorLogCode(GERR_LOAD_OBJECT_FAILED, fileName);*/
688       return result;
689    }
690
691    void FreeMesh(DisplaySystem displaySystem)
692    {
693       if(this)
694       {
695          Object child;
696          mesh.Free(0);
697          for(child = children.first; child; child = child.next)
698             child.FreeMesh(displaySystem);
699       }
700    }
701
702    Object Find(const char * name)
703    {
704       if(this && name)
705       {
706          Object child;
707
708          if(this.name && !strcmp(this.name, name))
709             return this;
710          else
711          {
712             for(child = children.first; child; child = child.next)
713             {
714                Object result = child.Find(name);
715                if(result)
716                   return result;
717             }
718          }
719       }
720       return null;
721    }
722
723    void Initialize(void)
724    {
725       if(this)
726       {
727          transform.scaling = { 1, 1, 1 };
728          transform.orientation = { 1,0,0,0 };
729          flags.root = true;
730          flags.transform = true;
731          matrix.Identity();
732       }
733    }
734
735    Mesh InitializeMesh(DisplaySystem displaySystem)
736    {
737       if(this)
738       {
739          flags.mesh = true;
740          if(!mesh)
741          {
742             mesh = Mesh { };
743             flags.ownMesh = true;
744          }
745          if(mesh)
746          {
747             FillBytes(mesh, 0, sizeof(class Mesh));
748             displaySystem.AddMesh(mesh);
749          }
750          matrix.Identity();
751          return mesh;
752       }
753       return null;
754    }
755
756    bool AddName(Object object, const char * name)
757    {
758       bool result = false;
759       if(this)
760       {
761          char * newName = CopyString(name);
762          object.name = newName;
763          result = children.AddName(object);
764          if(result)
765             object.parent = this;
766          object.flags.transform = true;
767       }
768       return result;
769    }
770
771    // TODO: Add support to Merge Vertex Colors mesh feature
772    bool Merge(DisplaySystem displaySystem)
773    {
774       bool result = false;
775
776       if(!this.flags.mesh || (!children.first && this.flags.ownMesh))
777          result = true;
778       else
779       {
780          Object child, nextChild;
781          int nVertices = 0;
782          MeshFeatures flags = 0;
783          Mesh objectMesh = mesh;
784          bool freeMesh = this.flags.ownMesh;
785
786          mesh = Mesh { };
787          this.flags.ownMesh = true;
788          this.flags.mesh = true;
789          displaySystem.AddMesh(mesh);
790
791          // Count total number of vertices
792          if(objectMesh)
793          {
794             flags |= objectMesh.flags;
795             nVertices += objectMesh.nVertices;
796          }
797
798          for(child = children.first; child; child = child.next)
799          {
800             child.Merge(displaySystem);
801             if(child.mesh)
802             {
803                nVertices += child.mesh.nVertices;
804                flags |= child.mesh.flags;
805             }
806          }
807
808          if(mesh.Allocate(flags, nVertices, displaySystem))
809          {
810             int c;
811             int nTriangles = 0;
812             int vertexOffset = 0;
813             PrimitiveGroup group = null;
814
815             // Merge vertices
816
817             nVertices = 0;
818             if(objectMesh)
819             {
820                for(c = 0; c<objectMesh.nVertices; c++)
821                {
822                   mesh.vertices[nVertices] = objectMesh.vertices[c];
823
824                   if(objectMesh.normals)
825                      mesh.normals[nVertices] = objectMesh.normals[c];
826                   if(objectMesh.texCoords)
827                      mesh.texCoords[nVertices] = objectMesh.texCoords[c];
828
829                   nVertices++;
830                }
831             }
832
833             for(child = children.first; child; child = child.next)
834             {
835                Matrix matrix, normalMatrix;
836
837                matrix = child.localMatrix;
838                /*
839                matrix.Identity();
840                matrix.Scale(child.transform.scaling.x, child.transform.scaling.y, child.transform.scaling.z);
841                matrix.Rotate(child.transform.orientation);
842                */
843
844                normalMatrix = matrix;
845
846                normalMatrix.m[3][0] = 0;
847                normalMatrix.m[3][1] = 0;
848                normalMatrix.m[3][2] = 0;
849
850                // matrix.Translate(child.transform.position.x, child.transform.position.y, child.transform.position.z);
851
852                if(child.mesh)
853                {
854                   for(c = 0; c<child.mesh.nVertices; c++)
855                   {
856                      mesh.vertices[nVertices].MultMatrix(child.mesh.vertices[c], matrix);
857                      if(child.mesh.normals)
858                         mesh.normals[nVertices].MultMatrix(child.mesh.normals[c], normalMatrix);
859                      if(child.mesh.texCoords)
860                         mesh.texCoords[nVertices] = child.mesh.texCoords[c];
861                      nVertices++;
862                   }
863                }
864             }
865
866             // Merge Indexed Primitive Groups
867             while(true)
868             {
869                int nIndices = 0;
870                PrimitiveGroupType type = (PrimitiveGroupType)-1;
871                Material material = null;
872                bool foundGroup = false;
873
874                // Find first group type/material to process and determine how many indices are required
875                if(objectMesh)
876                {
877                   for(group = objectMesh.groups.first; group; group = group.next)
878                   {
879                      if(!foundGroup && !(group.type.vertexRange))
880                      {
881                         if(!FindMaterialAndType(mesh, group.material, group.type))
882                         {
883                            material = group.material;
884                            type = group.type;
885                            nIndices += group.nIndices;
886                            foundGroup = true;
887                         }
888                      }
889                      else if(material == group.material && type == group.type)
890                         nIndices += group.nIndices;
891                   }
892                }
893
894                for(child = children.first; child; child = child.next)
895                {
896                   if(child.mesh)
897                   {
898                      for(group = child.mesh.groups.first; group; group = group.next)
899                      {
900                         if(!foundGroup && !(group.type.vertexRange))
901                         {
902                            if(!FindMaterialAndType(mesh, group.material ? group.material : child.material, group.type))
903                            {
904                               material = group.material ? group.material : child.material;
905                               type = group.type;
906                               nIndices += group.nIndices;
907                               foundGroup = true;
908                            }
909                         }
910                         else if(material == (group.material ? group.material : child.material) && type == group.type)
911                            nIndices += group.nIndices;
912                      }
913                   }
914                }
915
916                // Merge with all similar groups
917                if(foundGroup)
918                {
919                   PrimitiveGroup newGroup = mesh.AddPrimitiveGroup(type, nIndices);
920                   if(newGroup)
921                   {
922                      newGroup.material = material;
923                      nIndices = 0;
924
925                      vertexOffset = 0;
926
927                      if(objectMesh)
928                      {
929                         for(group = objectMesh.groups.first; group; group = group.next)
930                         {
931                            if(newGroup.material == group.material && newGroup.type == group.type)
932                            {
933                               int c;
934                               if(group.type.indices32bit)
935                                  for(c = 0; c<group.nIndices; c++)
936                                     newGroup.indices32[nIndices++] = group.indices32[c] + vertexOffset;
937                               else
938                                  for(c = 0; c<group.nIndices; c++)
939                                     newGroup.indices[nIndices++] = (uint16)(group.indices[c] + vertexOffset);
940                            }
941                         }
942                         vertexOffset += objectMesh.nVertices;
943                      }
944
945                      for(child = children.first; child; child = child.next)
946                      {
947                         if(child.mesh)
948                         {
949                            for(group = child.mesh.groups.first; group; group = group.next)
950                            {
951                               if(newGroup.material == (group.material ? group.material : child.material) &&
952                                  newGroup.type == group.type)
953                               {
954                                  int c;
955                                  if(group.type.indices32bit)
956                                     for(c = 0; c<group.nIndices; c++)
957                                        newGroup.indices32[nIndices++] = group.indices32[c] + vertexOffset;
958                                  else
959                                     for(c = 0; c<group.nIndices; c++)
960                                        newGroup.indices[nIndices++] = (uint16)(group.indices[c] + vertexOffset);
961                               }
962                            }
963                            vertexOffset += child.mesh.nVertices;
964                         }
965                      }
966                      mesh.UnlockPrimitiveGroup(newGroup);
967                   }
968                }
969                else
970                   break;
971             }
972
973             // Merge Non-Indexed Primitive Groups
974             vertexOffset = 0;
975
976             if(objectMesh)
977             {
978                for(group = objectMesh.groups.first; group; group = group.next)
979                {
980                   if(group.type.vertexRange)
981                   {
982                      PrimitiveGroup newGroup = mesh.AddPrimitiveGroup(group.type, 0);
983                      if(newGroup)
984                      {
985                         newGroup.material = group.material;
986                         newGroup.nVertices = group.nVertices;
987                         newGroup.first = group.first + vertexOffset;
988                      }
989                   }
990                }
991                vertexOffset += objectMesh.nVertices;
992             }
993
994             for(child = children.first; child; child = child.next)
995             {
996                if(child.mesh)
997                {
998                   for(group = child.mesh.groups.first; group; group = group.next)
999                   {
1000                      if(group.type.vertexRange)
1001                      {
1002                         PrimitiveGroup newGroup = mesh.AddPrimitiveGroup(group.type, 0);
1003                         if(newGroup)
1004                         {
1005                            newGroup.material = group.material ? group.material : child.material;
1006                            newGroup.nVertices = group.nVertices;
1007                            newGroup.first = group.first + vertexOffset;
1008                         }
1009                      }
1010                   }
1011                   vertexOffset += child.mesh.nVertices;
1012                }
1013             }
1014
1015             // Merge Triangles
1016             if(objectMesh)
1017                nTriangles = objectMesh.nPrimitives;
1018
1019             for(child = children.first; child; child = child.next)
1020             {
1021                if(child.mesh)
1022                   nTriangles += child.mesh.nPrimitives;
1023             }
1024             mesh.primitives = new PrimitiveSingle[nTriangles];
1025             mesh.nPrimitives = 0;
1026             vertexOffset = 0;
1027             if(objectMesh)
1028             {
1029                for(c = 0; c<objectMesh.nPrimitives; c++)
1030                {
1031                   int i;
1032                   PrimitiveSingle * triangle = &mesh.primitives[mesh.nPrimitives++];
1033
1034                   mesh.AllocatePrimitive(triangle, objectMesh.primitives[c].type, objectMesh.primitives[c].nIndices);
1035                   triangle->material = objectMesh.primitives[c].material;
1036                   triangle->middle = objectMesh.primitives[c].middle;
1037                   triangle->plane = objectMesh.primitives[c].plane;
1038
1039                   memcpy(triangle->indices, objectMesh.primitives[c].indices, objectMesh.primitives[c].nIndices * sizeof(uint16));
1040
1041                   /*
1042                   *triangle = objectMesh.primitives[c];
1043                   objectMesh.primitives[c].indices = null;
1044                   objectMesh.primitives[c].data = null;
1045                   */
1046
1047                   if(triangle->type.indices32bit)
1048                      for(i = 0; i<triangle->nIndices; i++)
1049                         triangle->indices32[i] += vertexOffset;
1050                   else
1051                      for(i = 0; i<triangle->nIndices; i++)
1052                         triangle->indices[i] += (uint16)vertexOffset;
1053                   mesh.UnlockPrimitive(triangle);
1054                }
1055                vertexOffset += objectMesh.nVertices;
1056             }
1057             for(child = children.first; child; child = child.next)
1058             {
1059                if(child.mesh)
1060                {
1061                   for(c = 0; c<child.mesh.nPrimitives; c++)
1062                   {
1063                      int i;
1064                      PrimitiveSingle * triangle = &mesh.primitives[mesh.nPrimitives++];
1065
1066                      mesh.AllocatePrimitive(triangle, child.mesh.primitives[c].type, child.mesh.primitives[c].nIndices);
1067                      triangle->material = child.mesh.primitives[c].material ? child.mesh.primitives[c].material : child.material;
1068                      triangle->middle = child.mesh.primitives[c].middle;
1069                      triangle->plane = child.mesh.primitives[c].plane;
1070                      memcpy(triangle->indices, child.mesh.primitives[c].indices, child.mesh.primitives[c].nIndices * sizeof(uint16));
1071
1072                      /*
1073                      *triangle = child.mesh.primitives[c];
1074                      child.mesh.primitives[c].indices = null;
1075                      child.mesh.primitives[c].data = null;
1076                      */
1077
1078                      if(triangle->type.indices32bit)
1079                         for(i = 0; i<triangle->nIndices; i++)
1080                            triangle->indices[i] += (uint16)vertexOffset;
1081                      else
1082                         for(i = 0; i<triangle->nIndices; i++)
1083                            triangle->indices32[i] += vertexOffset;
1084                      mesh.UnlockPrimitive(triangle);
1085                   }
1086                   vertexOffset += child.mesh.nVertices;
1087                }
1088             }
1089
1090             // Free children
1091             for(child = children.first; child; child = nextChild)
1092             {
1093                nextChild = child.next;
1094                children.Remove(child);
1095                child.Free(displaySystem);
1096                delete child;
1097             }
1098
1099             mesh.ApplyTranslucency(this);
1100             // this.flags.translucent = true;
1101
1102             result = true;
1103
1104             mesh.Unlock(flags);
1105          }
1106          if(freeMesh && objectMesh)
1107          {
1108             if(objectMesh.displaySystem)
1109                objectMesh.displaySystem.RemoveMesh(objectMesh);
1110             delete objectMesh;
1111          }
1112          SetMinMaxRadius(true);
1113       }
1114       return result;
1115    }
1116
1117    void RotateEuler(Euler rotation, Euler min, Euler max)
1118    {
1119       // WARNING: 'eulerOrientation' is only updated by this function
1120       Euler euler = eulerOrientation;//transform.orientation;
1121       euler.Add(euler, rotation);
1122
1123       if(min && max)
1124       {
1125          if(min.pitch && max.pitch)
1126             euler.pitch = Min(Max(euler.pitch, min.pitch), max.pitch);
1127          if(min.yaw && max.yaw)
1128             euler.yaw = Min(Max(euler.yaw, min.yaw), max.yaw);
1129          if(min.roll && max.roll)
1130             euler.roll = Min(Max(euler.roll, min.roll), max.roll);
1131       }
1132
1133       eulerOrientation = euler;
1134       transform.orientation = euler;
1135       UpdateTransform();
1136    }
1137
1138    void Move(Vector3D direction)
1139    {
1140       Matrix matrix;
1141       Vector3D offset;
1142
1143       matrix.RotationQuaternion(transform.orientation);
1144       offset.MultMatrix(direction, matrix);
1145       transform.position.Add(transform.position, offset);
1146       UpdateTransform();
1147    }
1148
1149    void UpdateTransform(void)
1150    {
1151       SetTransformDirty();
1152       _UpdateTransform();
1153       SetMinMaxRadius(false);
1154    }
1155
1156    void Animate(unsigned int frame)
1157    {
1158       if(this && startFrame != endFrame)
1159       {
1160          while(frame < startFrame) frame += (endFrame - startFrame + 1);
1161          while(frame > endFrame)   frame -= (endFrame - startFrame + 1);
1162
1163          this.frame = frame;
1164          _Animate(frame);
1165          _UpdateTransform();
1166          SetMinMaxRadius(false);
1167       }
1168    }
1169
1170    void DoubleSided(bool flag)
1171    {
1172       if(this)
1173       {
1174          Object child;
1175          mesh.DoubleSided(flag);
1176          for(child = children.first; child; child = child.next)
1177             child.DoubleSided(flag);
1178       }
1179    }
1180
1181    bool IntersectsGroundPolygon(int count, Pointf * pointfs)
1182    {
1183       bool result = false;
1184
1185       Pointf * p1;
1186       Pointf * p2;
1187       double minX = wmin.x, maxX = wmax.x;
1188       double minY = wmin.z, maxY = wmax.z;
1189       double delta = (maxX - minX)/2;
1190       double x = (maxX + minX)/2, y = (maxY + minY)/2;
1191       int c;
1192       for(c = 0; c<count; c++)
1193       {
1194          double d;
1195          p1 = &pointfs[c];
1196          p2 = &pointfs[(c == count-1) ? 0 : (c+1)];
1197
1198          if( (p1->x < minX) &&  (p2->x < minX) )
1199          {
1200             if((p1->y <= y) && (p2->y >  y) )
1201                result ^= true;
1202             else if( (p1->y >  y) && (p2->y <= y) )
1203                result ^= true;
1204          }
1205          else if(!((p1->x > maxX && p2->x > maxX) || (p1->y < minY && p2->y < minY) || (p1->y > maxY && p2->y > maxY)))
1206          {
1207             if(p1->y == p2->y)
1208             {
1209                d = y - p1->y;
1210                if (d < 0) d = -d;
1211                if (d < delta) return true;
1212             }
1213             else if(p1->x == p2->x)
1214             {
1215                d = x - p1->x;
1216                if(d < 0) d = -d;
1217                if(d < delta) return true;
1218                else if(p1->x > x) ;
1219                else if( (p1->y <= y) && (p2->y >  y) )
1220                   result ^= true;
1221                else if( (p1->y >  y) && (p2->y <= y) )
1222                   result ^= true;
1223             }
1224             else
1225             {
1226                float a, b, dy, dx;
1227
1228                a = p2->y - p1->y;
1229                b = p1->x - p2->x;
1230                dy =  a;
1231                dx = -b;
1232                d = a * x + b * y + (p2->x * p1->y) - (p2->y * p1->x);
1233                if (a < 0) a = -a;
1234                if (b < 0) b = -b;
1235                if (d < 0) d = -d;
1236
1237                if(d < a * delta)
1238                   return true;
1239                else if (d < b * delta)
1240                   return true;
1241                else if( ( (p1->y <= y) && (p2->y >  y) ) || ( (p1->y >  y) && (p2->y <= y) ) )
1242                {
1243                   double xdy;
1244
1245                   xdy = (dx * (y - p1->y)) + (dy * p1->x);
1246                   if(dy < 0)
1247                   {
1248                      if(xdy > x * dy)
1249                         result ^= true;
1250                   }
1251                   else if(xdy < x * dy)
1252                      result ^= true;
1253                }
1254             }
1255          }
1256       }
1257       return result;
1258    }
1259
1260    property Transform transform { set { transform = value; eulerOrientation = transform.orientation; } get { value = transform; } };
1261    property Material material { set { material = value; } get { return material; } };
1262    property Vector3Df max { get { value = max; } };
1263    property Vector3Df min { get { value = min; } };
1264    property Vector3Df center { get { value = center; } };
1265    property float radius { get { return radius; } };
1266
1267    property Vector3D wmax { get { value = wmax; } };
1268    property Vector3D wmin { get { value = wmin; } };
1269    property Vector3D wcenter { get { value = wcenter; } };
1270    property double wradius { get { return wradius; } };
1271
1272    property void * tag { set { tag = value; } get { return tag; } };
1273    property int frame { set { Animate(value); } get { return frame; } };
1274    property int startFrame { set { startFrame = value; } get { return startFrame; } };
1275    property int endFrame { set { endFrame = value; } get { return endFrame; } };
1276
1277    property Mesh mesh { set { mesh = value; } get { return mesh; } };
1278    property Camera camera { get { return camera; } }; // Fix this with inheritance? camera inherit from Object?
1279    property Object firstChild { get { return children.first; } };
1280    property Object next { get { return next; } };
1281    property const char * name { get { return name; } };
1282    property Matrix matrix { get { value = matrix; } };
1283    property Object cameraTarget { set { cameraTarget = value; } get { return cameraTarget; } };
1284    property OldList * tracks { /* set { tracks = value; } */ get { return &tracks; } };
1285    property ObjectFlags flags { set { flags = value; } get { return flags; } };
1286
1287 private:
1288    Object()
1289    {
1290       children.offset = (uint)(uintptr)&((Object)0).prev;
1291       transform.scaling = { 1, 1, 1 };
1292       transform.orientation = { 1,0,0,0 };
1293       flags.transform = true;
1294       localMatrix.Identity();
1295    }
1296
1297    ~Object()
1298    {
1299       Free(null);
1300    }
1301
1302    void SetTransformDirty()
1303    {
1304       Object child;
1305       flags.transform = true;
1306       for(child = children.first; child; child = child.next)
1307          child.SetTransformDirty();
1308    }
1309
1310    void _UpdateTransform()
1311    {
1312       if(flags.transform)
1313       {
1314          Object child;
1315
1316          // Cameras / Spot Lights must update their target first
1317          if(flags.camera && cameraTarget && cameraTarget.flags.transform)
1318             cameraTarget.UpdateTransform();
1319          else if(flags.light && light.flags.spot && light.target && light.target.flags.transform)
1320             light.target._UpdateTransform();
1321
1322          if(flags.camera && cameraTarget)
1323          {
1324             // Determine angle to look at target
1325             Vector3D position, direction;
1326             if(flags.root || !parent)
1327                position = transform.position;
1328             else
1329                position.MultMatrix(transform.position, parent.matrix);
1330
1331             direction.Subtract((Vector3D *)cameraTarget.matrix.m[3], position);
1332             transform.orientation.RotationDirection(direction);
1333
1334             // Add the roll
1335             transform.orientation.RotateRoll(roll);
1336          }
1337
1338          if(flags.light && light.flags.spot)
1339          {
1340             // Determine angle to look at target
1341             Vector3D position;
1342             if(flags.root || !parent)
1343                position = transform.position;
1344             else
1345                position.MultMatrix(transform.position, parent.matrix);
1346
1347             if(light.target)
1348                light.direction.Subtract((Vector3D *) light.target.matrix.m[3], position);
1349             else
1350                light.direction = position; // TOCHECK: Why does this happen?
1351
1352             light.direction.Normalize(light.direction);
1353             transform.orientation.RotationDirection(light.direction);
1354          }
1355
1356          if(!flags.localMatrixSet)
1357          {
1358             localMatrix.Identity();
1359             localMatrix.Scale(transform.scaling.x, transform.scaling.y, transform.scaling.z);
1360             localMatrix.Rotate(transform.orientation);
1361             localMatrix.Translate(transform.position.x, transform.position.y, transform.position.z);
1362          }
1363
1364          // Compute transform (with ancestors)
1365          if(flags.root || !parent)
1366             matrix = localMatrix;
1367          else
1368             matrix.Multiply(localMatrix, parent.matrix);
1369
1370          flags.transform = false;
1371
1372          for(child = children.first; child; child = child.next)
1373          {
1374             if(child.flags.transform)
1375                child._UpdateTransform();
1376          }
1377       }
1378    }
1379
1380    void _Animate(unsigned int frame)
1381    {
1382       Object child;
1383       FrameTrack track;
1384
1385       for(track = tracks.first; track; track = track.next)
1386       {
1387          unsigned int c;
1388
1389          if(track.numKeys)
1390          {
1391             unsigned int prev = 0, next = track.numKeys - 1;
1392             FrameKey * prevKey = &track.keys[prev], * nextKey = &track.keys[next];
1393             float t = 0;
1394
1395             for(c = 0; c<track.numKeys; c++)
1396             {
1397                FrameKey * key = track.keys + c;
1398                if(key->frame <= frame) { prevKey = key; prev = c; }
1399                if(key->frame >= frame) { nextKey = key; next = c; break; }
1400             }
1401
1402             if(nextKey->frame != prevKey->frame)
1403                t = ease((float) (frame - prevKey->frame) / (nextKey->frame - prevKey->frame), prevKey->easeFrom, nextKey->easeTo);
1404
1405             switch(track.type.type)
1406             {
1407                case position:
1408                {
1409                   Vector3Df position;
1410                   track.Interpolate(position, prevKey->position, nextKey->position, prev, next, t);
1411                   transform.position = { (double)position.x, (double)position.y, (double)position.z };
1412                   break;
1413                }
1414                case scaling:
1415                   track.Interpolate(transform.scaling, prevKey->scaling, &nextKey->scaling, prev, next, t);
1416                   break;
1417                case rotation:
1418                   track.InterpolateQuat(transform.orientation, prevKey->orientation, nextKey->orientation, prev, next, t);
1419                   break;
1420                // Cameras
1421                case roll:
1422                   roll = track.InterpolateFloat(prevKey->roll, nextKey->roll, prev, next, t);
1423                   break;
1424                case fov:
1425                {
1426                   camera.fov = track.InterpolateFloat(prevKey->fov, nextKey->fov, prev, next, t);
1427                   /*
1428                   double mm = (camera.fov - 5.05659508373109) / 1.13613250717301;
1429                   camera.fov = 1248.58921609766 * pow(mm, -0.895625414990581);
1430                   */
1431                   //camera.Setup(camera.width, camera.height, camera.origin);
1432                   break;
1433                }
1434                // Lights
1435                case colorChange:
1436                {
1437                   track.Interpolate((Vector3Df *)&light.diffuse,
1438                      (Vector3Df *)&prevKey->color, (Vector3Df *)&nextKey->color, prev, next, t);
1439                   light.specular = light.diffuse;
1440                   break;
1441                }
1442                case fallOff:
1443                {
1444                   light.fallOff = track.InterpolateFloat(prevKey->fallOff, nextKey->fallOff, prev, next, t);
1445                   break;
1446                }
1447                case hotSpot:
1448                {
1449                   light.hotSpot = track.InterpolateFloat(prevKey->hotSpot, nextKey->hotSpot, prev, next, t);
1450                   break;
1451                }
1452             }
1453          }
1454       }
1455
1456       for(child = children.first; child; child = child.next)
1457          child._Animate(frame);
1458
1459       flags.transform = true;
1460    }
1461
1462    // Private for now
1463    FrustumPlacement InsideFrustum(Plane * planes)
1464    {
1465       FrustumPlacement result = inside;
1466
1467       int p;
1468       // First test: Sphere
1469       for(p = 0; p<6; p++)
1470       {
1471          Plane * plane = &planes[p];
1472          double dot = plane->normal.DotProduct(wcenter);
1473          double distance = dot + plane->d;
1474          if(distance < -wradius)
1475          {
1476             result = outside;
1477             break;
1478          }
1479          if(Abs(distance) < wradius)
1480             result = intersecting;
1481       }
1482
1483       if(result == intersecting)
1484       {
1485          // Second test: Bounding Box
1486          Vector3D box[8] =
1487          {
1488             { wmin.x, wmin.y, wmin.z },
1489             { wmin.x, wmin.y, wmax.z },
1490             { wmin.x, wmax.y, wmin.z },
1491             { wmin.x, wmax.y, wmax.z },
1492             { wmax.x, wmin.y, wmin.z },
1493             { wmax.x, wmin.y, wmax.z },
1494             { wmax.x, wmax.y, wmin.z },
1495             { wmax.x, wmax.y, wmax.z }
1496          };
1497            int numPlanesAllIn = 0;
1498          for(p = 0; p < 6; p++)
1499          {
1500             Plane * plane = &planes[p];
1501             int i;
1502             int numGoodPoints = 0;
1503             for(i = 0; i < 8; ++i)
1504             {
1505                double dot = plane->normal.DotProduct(box[i]);
1506                double distance = dot + plane->d;
1507                            if(distance > -1)
1508                   numGoodPoints++;
1509                    }
1510                    if(!numGoodPoints)
1511             {
1512                result = outside;
1513                break;
1514             }
1515             if(numGoodPoints == 8)
1516                numPlanesAllIn++;
1517            }
1518            if(numPlanesAllIn == 6)
1519                    result = inside;
1520       }
1521       return result;
1522    }
1523
1524    Object prev, next;
1525    char * name;
1526    public Object parent;
1527    public OldList children;
1528
1529    ObjectFlags flags;
1530
1531    OldList tracks;
1532    unsigned startFrame, endFrame;
1533    int frame;
1534    Vector3Df pivot;
1535
1536    public Transform transform;
1537    public Matrix matrix;
1538    public Matrix localMatrix;
1539    void * tag;
1540    Vector3Df min, max, center;
1541    Vector3D wmin, wmax, wcenter;
1542
1543    bool volume;
1544    float radius;
1545    double wradius;
1546    ColorRGB ambient;
1547
1548    /*public */union
1549    {
1550       // Mesh
1551       struct
1552       {
1553          Mesh mesh;
1554          Material material;
1555       };
1556
1557       // Light
1558       Light light;
1559
1560       // Camera
1561       struct
1562       {
1563          Camera camera;
1564          Object cameraTarget;
1565          double roll;
1566       };
1567    };
1568
1569    public property Light light
1570    {
1571       set
1572       {
1573          light = value;
1574       }
1575       get
1576       {
1577          value = light;
1578       }
1579    }
1580
1581    Euler eulerOrientation;
1582 };