The Ecere SDK - sdk/blob - 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;
  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          mesh = model.mesh;
 610          /*
 611          min = model.min;
 612          max = model.max;
 613          radius = model.radius;
 614          */
 615          transform = model.transform;
 616
 617          for(modelChild = model.children.first; modelChild; modelChild = modelChild.next)
 618          {
 619             Object child { parent = this };
 620             child.Duplicate(modelChild);
 621             children.AddName(child);
 622          }
 623       }
 624    }
 625
 626    void Free(DisplaySystem displaySystem)
 627    {
 628       if(this)
 629       {
 630          Object child;
 631
 632          while((child = children.first))
 633          {
 634             children.Remove(child);
 635             child.Free(displaySystem);
 636
 637             // We did not do this before so as to keep transform on reloading for new DisplaySystem
 638             // However since children are removed, it seems that purpose has been gone, we'd need
 639             // a new mechanism to handle lost resources reloading...
 640             delete child;
 641          }
 642          if(flags.ownMesh && mesh)
 643          {
 644             DisplaySystem meshDisplaySystem = mesh.displaySystem;
 645             mesh.Free(0);
 646             if(meshDisplaySystem)
 647                meshDisplaySystem.RemoveMesh(mesh);
 648             delete mesh;
 649          }
 650
 651          tracks.Free(FrameTrack::Free);
 652
 653          delete name;
 654       }
 655    }
 656
 657    bool Load(const char * fileName, const char * type, DisplaySystem displaySystem)
 658    {
 659       char ext[MAX_EXTENSION];
 660       subclass(ObjectFormat) format;
 661       OldLink link;
 662       bool result = false;
 663
 664       if(!type && fileName)
 665          type = strlwr(GetExtension(fileName, ext));
 666
 667       for(link = class(ObjectFormat).derivatives.first; link; link = link.next)
 668       {
 669          format = link.data;
 670          if(format.extension && !strcmp(format.extension, type))
 671             break;
 672       }
 673       if(!link) format = null;
 674
 675       if(format)
 676       {
 677          if((format.Load(this, fileName, displaySystem)))
 678             result = true;
 679       }
 680       /*if(!result)
 681           ErrorLogCode(GERR_LOAD_OBJECT_FAILED, fileName);*/
 682       return result;
 683    }
 684
 685    void FreeMesh(DisplaySystem displaySystem)
 686    {
 687       if(this)
 688       {
 689          Object child;
 690          mesh.Free(0);
 691          for(child = children.first; child; child = child.next)
 692             child.FreeMesh(displaySystem);
 693       }
 694    }
 695
 696    Object Find(const char * name)
 697    {
 698       if(this && name)
 699       {
 700          Object child;
 701
 702          if(this.name && !strcmp(this.name, name))
 703             return this;
 704          else
 705          {
 706             for(child = children.first; child; child = child.next)
 707             {
 708                Object result = child.Find(name);
 709                if(result)
 710                   return result;
 711             }
 712          }
 713       }
 714       return null;
 715    }
 716
 717    void Initialize(void)
 718    {
 719       if(this)
 720       {
 721          transform.scaling = { 1, 1, 1 };
 722          transform.orientation = { 1,0,0,0 };
 723          flags.root = true;
 724          flags.transform = true;
 725          matrix.Identity();
 726       }
 727    }
 728
 729    Mesh InitializeMesh(DisplaySystem displaySystem)
 730    {
 731       if(this)
 732       {
 733          flags.mesh = true;
 734          if(!mesh)
 735          {
 736             mesh = Mesh { };
 737             flags.ownMesh = true;
 738          }
 739          if(mesh)
 740          {
 741             FillBytes(mesh, 0, sizeof(class Mesh));
 742             displaySystem.AddMesh(mesh);
 743          }
 744          matrix.Identity();
 745          return mesh;
 746       }
 747       return null;
 748    }
 749
 750    bool AddName(Object object, const char * name)
 751    {
 752       bool result = false;
 753       if(this)
 754       {
 755          char * newName = CopyString(name);
 756          object.name = newName;
 757          result = children.AddName(object);
 758          if(result)
 759             object.parent = this;
 760          object.flags.transform = true;
 761       }
 762       return result;
 763    }
 764
 765    // TODO: Add support to Merge Vertex Colors mesh feature
 766    bool Merge(DisplaySystem displaySystem)
 767    {
 768       bool result = false;
 769
 770       if(!this.flags.mesh || (!children.first && this.flags.ownMesh))
 771          result = true;
 772       else
 773       {
 774          Object child, nextChild;
 775          int nVertices = 0;
 776          MeshFeatures flags = 0;
 777          Mesh objectMesh = mesh;
 778          bool freeMesh = this.flags.ownMesh;
 779
 780          mesh = Mesh { };
 781          this.flags.ownMesh = true;
 782          this.flags.mesh = true;
 783          displaySystem.AddMesh(mesh);
 784
 785          // Count total number of vertices
 786          if(objectMesh)
 787          {
 788             flags |= objectMesh.flags;
 789             nVertices += objectMesh.nVertices;
 790          }
 791
 792          for(child = children.first; child; child = child.next)
 793          {
 794             child.Merge(displaySystem);
 795             if(child.mesh)
 796             {
 797                nVertices += child.mesh.nVertices;
 798                flags |= child.mesh.flags;
 799             }
 800          }
 801
 802          if(mesh.Allocate(flags, nVertices, displaySystem))
 803          {
 804             int c;
 805             int nTriangles = 0;
 806             int vertexOffset = 0;
 807             PrimitiveGroup group = null;
 808
 809             // Merge vertices
 810
 811             nVertices = 0;
 812             if(objectMesh)
 813             {
 814                for(c = 0; c<objectMesh.nVertices; c++)
 815                {
 816                   mesh.vertices[nVertices] = objectMesh.vertices[c];
 817
 818                   if(objectMesh.normals)
 819                      mesh.normals[nVertices] = objectMesh.normals[c];
 820                   if(objectMesh.texCoords)
 821                      mesh.texCoords[nVertices] = objectMesh.texCoords[c];
 822
 823                   nVertices++;
 824                }
 825             }
 826
 827             for(child = children.first; child; child = child.next)
 828             {
 829                Matrix matrix, normalMatrix;
 830
 831                matrix.Identity();
 832                matrix.Scale(child.transform.scaling.x, child.transform.scaling.y, child.transform.scaling.z);
 833
 834                matrix.Rotate(child.transform.orientation);
 835
 836                normalMatrix = matrix;
 837
 838                matrix.Translate(child.transform.position.x, child.transform.position.y, child.transform.position.z);
 839                if(child.mesh)
 840                {
 841                   for(c = 0; c<child.mesh.nVertices; c++)
 842                   {
 843                      mesh.vertices[nVertices].MultMatrix(child.mesh.vertices[c], matrix);
 844                      if(child.mesh.normals)
 845                         mesh.normals[nVertices].MultMatrix(child.mesh.normals[c], normalMatrix);
 846                      if(child.mesh.texCoords)
 847                         mesh.texCoords[nVertices] = child.mesh.texCoords[c];
 848                      nVertices++;
 849                   }
 850                }
 851             }
 852
 853             // Merge Indexed Primitive Groups
 854             while(true)
 855             {
 856                int nIndices = 0;
 857                PrimitiveGroupType type = (PrimitiveGroupType)-1;
 858                Material material = null;
 859                bool foundGroup = false;
 860
 861                // Find first group type/material to process and determine how many indices are required
 862                if(objectMesh)
 863                {
 864                   for(group = objectMesh.groups.first; group; group = group.next)
 865                   {
 866                      if(!foundGroup && !(group.type.vertexRange))
 867                      {
 868                         if(!FindMaterialAndType(mesh, group.material, group.type))
 869                         {
 870                            material = group.material;
 871                            type = group.type;
 872                            nIndices += group.nIndices;
 873                            foundGroup = true;
 874                         }
 875                      }
 876                      else if(material == group.material && type == group.type)
 877                         nIndices += group.nIndices;
 878                   }
 879                }
 880
 881                for(child = children.first; child; child = child.next)
 882                {
 883                   if(child.mesh)
 884                   {
 885                      for(group = child.mesh.groups.first; group; group = group.next)
 886                      {
 887                         if(!foundGroup && !(group.type.vertexRange))
 888                         {
 889                            if(!FindMaterialAndType(mesh, group.material ? group.material : child.material, group.type))
 890                            {
 891                               material = group.material ? group.material : child.material;
 892                               type = group.type;
 893                               nIndices += group.nIndices;
 894                               foundGroup = true;
 895                            }
 896                         }
 897                         else if(material == (group.material ? group.material : child.material) && type == group.type)
 898                            nIndices += group.nIndices;
 899                      }
 900                   }
 901                }
 902
 903                // Merge with all similar groups
 904                if(foundGroup)
 905                {
 906                   PrimitiveGroup newGroup = mesh.AddPrimitiveGroup(type, nIndices);
 907                   if(newGroup)
 908                   {
 909                      newGroup.material = material;
 910                      nIndices = 0;
 911
 912                      vertexOffset = 0;
 913
 914                      if(objectMesh)
 915                      {
 916                         for(group = objectMesh.groups.first; group; group = group.next)
 917                         {
 918                            if(newGroup.material == group.material && newGroup.type == group.type)
 919                            {
 920                               int c;
 921                               if(group.type.indices32bit)
 922                                  for(c = 0; c<group.nIndices; c++)
 923                                     newGroup.indices32[nIndices++] = group.indices32[c] + vertexOffset;
 924                               else
 925                                  for(c = 0; c<group.nIndices; c++)
 926                                     newGroup.indices[nIndices++] = (uint16)(group.indices[c] + vertexOffset);
 927                            }
 928                         }
 929                         vertexOffset += objectMesh.nVertices;
 930                      }
 931
 932                      for(child = children.first; child; child = child.next)
 933                      {
 934                         if(child.mesh)
 935                         {
 936                            for(group = child.mesh.groups.first; group; group = group.next)
 937                            {
 938                               if(newGroup.material == (group.material ? group.material : child.material) &&
 939                                  newGroup.type == group.type)
 940                               {
 941                                  int c;
 942                                  if(group.type.indices32bit)
 943                                     for(c = 0; c<group.nIndices; c++)
 944                                        newGroup.indices32[nIndices++] = group.indices32[c] + vertexOffset;
 945                                  else
 946                                     for(c = 0; c<group.nIndices; c++)
 947                                        newGroup.indices[nIndices++] = (uint16)(group.indices[c] + vertexOffset);
 948                               }
 949                            }
 950                            vertexOffset += child.mesh.nVertices;
 951                         }
 952                      }
 953                      mesh.UnlockPrimitiveGroup(newGroup);
 954                   }
 955                }
 956                else
 957                   break;
 958             }
 959
 960             // Merge Non-Indexed Primitive Groups
 961             vertexOffset = 0;
 962
 963             if(objectMesh)
 964             {
 965                for(group = objectMesh.groups.first; group; group = group.next)
 966                {
 967                   if(group.type.vertexRange)
 968                   {
 969                      PrimitiveGroup newGroup = mesh.AddPrimitiveGroup(group.type, 0);
 970                      if(newGroup)
 971                      {
 972                         newGroup.material = group.material;
 973                         newGroup.nVertices = group.nVertices;
 974                         newGroup.first = group.first + vertexOffset;
 975                      }
 976                   }
 977                }
 978                vertexOffset += objectMesh.nVertices;
 979             }
 980
 981             for(child = children.first; child; child = child.next)
 982             {
 983                if(child.mesh)
 984                {
 985                   for(group = child.mesh.groups.first; group; group = group.next)
 986                   {
 987                      if(group.type.vertexRange)
 988                      {
 989                         PrimitiveGroup newGroup = mesh.AddPrimitiveGroup(group.type, 0);
 990                         if(newGroup)
 991                         {
 992                            newGroup.material = group.material ? group.material : child.material;
 993                            newGroup.nVertices = group.nVertices;
 994                            newGroup.first = group.first + vertexOffset;
 995                         }
 996                      }
 997                   }
 998                   vertexOffset += child.mesh.nVertices;
 999                }
1000             }
1001
1002             // Merge Triangles
1003             if(objectMesh)
1004                nTriangles = objectMesh.nPrimitives;
1005
1006             for(child = children.first; child; child = child.next)
1007             {
1008                if(child.mesh)
1009                   nTriangles += child.mesh.nPrimitives;
1010             }
1011             mesh.primitives = new PrimitiveSingle[nTriangles];
1012             mesh.nPrimitives = 0;
1013             vertexOffset = 0;
1014             if(objectMesh)
1015             {
1016                for(c = 0; c<objectMesh.nPrimitives; c++)
1017                {
1018                   int i;
1019                   PrimitiveSingle * triangle = &mesh.primitives[mesh.nPrimitives++];
1020
1021                   mesh.AllocatePrimitive(triangle, objectMesh.primitives[c].type, objectMesh.primitives[c].nIndices);
1022                   triangle->material = objectMesh.primitives[c].material;
1023                   triangle->middle = objectMesh.primitives[c].middle;
1024                   triangle->plane = objectMesh.primitives[c].plane;
1025
1026                   memcpy(triangle->indices, objectMesh.primitives[c].indices, objectMesh.primitives[c].nIndices * sizeof(uint16));
1027
1028                   /*
1029                   *triangle = objectMesh.primitives[c];
1030                   objectMesh.primitives[c].indices = null;
1031                   objectMesh.primitives[c].data = null;
1032                   */
1033
1034                   if(triangle->type.indices32bit)
1035                      for(i = 0; i<triangle->nIndices; i++)
1036                         triangle->indices32[i] += vertexOffset;
1037                   else
1038                      for(i = 0; i<triangle->nIndices; i++)
1039                         triangle->indices[i] += (uint16)vertexOffset;
1040                   mesh.UnlockPrimitive(triangle);
1041                }
1042                vertexOffset += objectMesh.nVertices;
1043             }
1044             for(child = children.first; child; child = child.next)
1045             {
1046                if(child.mesh)
1047                {
1048                   for(c = 0; c<child.mesh.nPrimitives; c++)
1049                   {
1050                      int i;
1051                      PrimitiveSingle * triangle = &mesh.primitives[mesh.nPrimitives++];
1052
1053                      mesh.AllocatePrimitive(triangle, child.mesh.primitives[c].type, child.mesh.primitives[c].nIndices);
1054                      triangle->material = child.mesh.primitives[c].material ? child.mesh.primitives[c].material : child.material;
1055                      triangle->middle = child.mesh.primitives[c].middle;
1056                      triangle->plane = child.mesh.primitives[c].plane;
1057                      memcpy(triangle->indices, child.mesh.primitives[c].indices, child.mesh.primitives[c].nIndices * sizeof(uint16));
1058
1059                      /*
1060                      *triangle = child.mesh.primitives[c];
1061                      child.mesh.primitives[c].indices = null;
1062                      child.mesh.primitives[c].data = null;
1063                      */
1064
1065                      if(triangle->type.indices32bit)
1066                         for(i = 0; i<triangle->nIndices; i++)
1067                            triangle->indices[i] += (uint16)vertexOffset;
1068                      else
1069                         for(i = 0; i<triangle->nIndices; i++)
1070                            triangle->indices32[i] += vertexOffset;
1071                      mesh.UnlockPrimitive(triangle);
1072                   }
1073                   vertexOffset += child.mesh.nVertices;
1074                }
1075             }
1076
1077             // Free children
1078             for(child = children.first; child; child = nextChild)
1079             {
1080                nextChild = child.next;
1081                children.Remove(child);
1082                child.Free(displaySystem);
1083                delete child;
1084             }
1085
1086             mesh.ApplyTranslucency(this);
1087             // this.flags.translucent = true;
1088
1089             result = true;
1090
1091             mesh.Unlock(flags);
1092          }
1093          if(freeMesh && objectMesh)
1094          {
1095             if(objectMesh.displaySystem)
1096                objectMesh.displaySystem.RemoveMesh(objectMesh);
1097             delete objectMesh;
1098          }
1099          SetMinMaxRadius(true);
1100       }
1101       return result;
1102    }
1103
1104    void RotateEuler(Euler rotation, Euler min, Euler max)
1105    {
1106       // WARNING: 'eulerOrientation' is only updated by this function
1107       Euler euler = eulerOrientation;//transform.orientation;
1108       euler.Add(euler, rotation);
1109
1110       if(min && max)
1111       {
1112          if(min.pitch && max.pitch)
1113             euler.pitch = Min(Max(euler.pitch, min.pitch), max.pitch);
1114          if(min.yaw && max.yaw)
1115             euler.yaw = Min(Max(euler.yaw, min.yaw), max.yaw);
1116          if(min.roll && max.roll)
1117             euler.roll = Min(Max(euler.roll, min.roll), max.roll);
1118       }
1119
1120       eulerOrientation = euler;
1121       transform.orientation = euler;
1122       UpdateTransform();
1123    }
1124
1125    void Move(Vector3D direction)
1126    {
1127       Matrix matrix;
1128       Vector3D offset;
1129
1130       matrix.RotationQuaternion(transform.orientation);
1131       offset.MultMatrix(direction, matrix);
1132       transform.position.Add(transform.position, offset);
1133       UpdateTransform();
1134    }
1135
1136    void UpdateTransform(void)
1137    {
1138       SetTransformDirty();
1139       _UpdateTransform();
1140       SetMinMaxRadius(false);
1141    }
1142
1143    void Animate(unsigned int frame)
1144    {
1145       if(this && startFrame != endFrame)
1146       {
1147          while(frame < startFrame) frame += (endFrame - startFrame + 1);
1148          while(frame > endFrame)   frame -= (endFrame - startFrame + 1);
1149
1150          this.frame = frame;
1151          _Animate(frame);
1152          _UpdateTransform();
1153          SetMinMaxRadius(false);
1154       }
1155    }
1156
1157    void DoubleSided(bool flag)
1158    {
1159       if(this)
1160       {
1161          Object child;
1162          mesh.DoubleSided(flag);
1163          for(child = children.first; child; child = child.next)
1164             child.DoubleSided(flag);
1165       }
1166    }
1167
1168    bool IntersectsGroundPolygon(int count, Pointf * pointfs)
1169    {
1170       bool result = false;
1171
1172       Pointf * p1;
1173       Pointf * p2;
1174       double minX = wmin.x, maxX = wmax.x;
1175       double minY = wmin.z, maxY = wmax.z;
1176       double delta = (maxX - minX)/2;
1177       double x = (maxX + minX)/2, y = (maxY + minY)/2;
1178       int c;
1179       for(c = 0; c<count; c++)
1180       {
1181          double d;
1182          p1 = &pointfs[c];
1183          p2 = &pointfs[(c == count-1) ? 0 : (c+1)];
1184
1185          if( (p1->x < minX) &&  (p2->x < minX) )
1186          {
1187             if((p1->y <= y) && (p2->y >  y) )
1188                result ^= true;
1189             else if( (p1->y >  y) && (p2->y <= y) )
1190                result ^= true;
1191          }
1192          else if(!((p1->x > maxX && p2->x > maxX) || (p1->y < minY && p2->y < minY) || (p1->y > maxY && p2->y > maxY)))
1193          {
1194             if(p1->y == p2->y)
1195             {
1196                d = y - p1->y;
1197                if (d < 0) d = -d;
1198                if (d < delta) return true;
1199             }
1200             else if(p1->x == p2->x)
1201             {
1202                d = x - p1->x;
1203                if(d < 0) d = -d;
1204                if(d < delta) return true;
1205                else if(p1->x > x) ;
1206                else if( (p1->y <= y) && (p2->y >  y) )
1207                   result ^= true;
1208                else if( (p1->y >  y) && (p2->y <= y) )
1209                   result ^= true;
1210             }
1211             else
1212             {
1213                float a, b, dy, dx;
1214
1215                a = p2->y - p1->y;
1216                b = p1->x - p2->x;
1217                dy =  a;
1218                dx = -b;
1219                d = a * x + b * y + (p2->x * p1->y) - (p2->y * p1->x);
1220                if (a < 0) a = -a;
1221                if (b < 0) b = -b;
1222                if (d < 0) d = -d;
1223
1224                if(d < a * delta)
1225                   return true;
1226                else if (d < b * delta)
1227                   return true;
1228                else if( ( (p1->y <= y) && (p2->y >  y) ) || ( (p1->y >  y) && (p2->y <= y) ) )
1229                {
1230                   double xdy;
1231
1232                   xdy = (dx * (y - p1->y)) + (dy * p1->x);
1233                   if(dy < 0)
1234                   {
1235                      if(xdy > x * dy)
1236                         result ^= true;
1237                   }
1238                   else if(xdy < x * dy)
1239                      result ^= true;
1240                }
1241             }
1242          }
1243       }
1244       return result;
1245    }
1246
1247    property Transform transform { set { transform = value; eulerOrientation = transform.orientation; } get { value = transform; } };
1248    property Material material { set { material = value; } get { return material; } };
1249    property Vector3Df max { get { value = max; } };
1250    property Vector3Df min { get { value = min; } };
1251    property Vector3Df center { get { value = center; } };
1252    property float radius { get { return radius; } };
1253
1254    property Vector3D wmax { get { value = wmax; } };
1255    property Vector3D wmin { get { value = wmin; } };
1256    property Vector3D wcenter { get { value = wcenter; } };
1257    property double wradius { get { return wradius; } };
1258
1259    property void * tag { set { tag = value; } get { return tag; } };
1260    property int frame { set { Animate(value); } get { return frame; } };
1261    property int startFrame { set { startFrame = value; } get { return startFrame; } };
1262    property int endFrame { set { endFrame = value; } get { return endFrame; } };
1263
1264    property Mesh mesh { set { mesh = value; } get { return mesh; } };
1265    property Camera camera { get { return camera; } }; // Fix this with inheritance? camera inherit from Object?
1266    property Object firstChild { get { return children.first; } };
1267    property Object next { get { return next; } };
1268    property const char * name { get { return name; } };
1269    property Matrix matrix { get { value = matrix; } };
1270    property Object cameraTarget { set { cameraTarget = value; } get { return cameraTarget; } };
1271    property OldList * tracks { /* set { tracks = value; } */ get { return &tracks; } };
1272    property ObjectFlags flags { set { flags = value; } get { return flags; } };
1273
1274 private:
1275    Object()
1276    {
1277       children.offset = (uint)(uintptr)&((Object)0).prev;
1278       transform.scaling = { 1, 1, 1 };
1279       transform.orientation = { 1,0,0,0 };
1280       flags.transform = true;
1281    }
1282
1283    ~Object()
1284    {
1285       Free(null);
1286    }
1287
1288    void SetTransformDirty()
1289    {
1290       Object child;
1291       flags.transform = true;
1292       for(child = children.first; child; child = child.next)
1293          child.SetTransformDirty();
1294    }
1295
1296    void _UpdateTransform()
1297    {
1298       if(flags.transform)
1299       {
1300          Object child;
1301          Matrix matrix;
1302
1303          // Cameras / Spot Lights must update their target first
1304          if(flags.camera && cameraTarget && cameraTarget.flags.transform)
1305             cameraTarget.UpdateTransform();
1306          else if(flags.light && light.flags.spot && light.target.flags.transform)
1307             light.target._UpdateTransform();
1308
1309          if(flags.camera && cameraTarget)
1310          {
1311             // Determine angle to look at target
1312             Vector3D position, direction;
1313             if(flags.root || !parent)
1314                position = transform.position;
1315             else
1316                position.MultMatrix(transform.position, parent.matrix);
1317
1318             direction.Subtract((Vector3D *)cameraTarget.matrix.m[3], position);
1319             transform.orientation.RotationDirection(direction);
1320
1321             // Add the roll
1322             transform.orientation.RotateRoll(roll);
1323          }
1324
1325          if(flags.light && light.flags.spot)
1326          {
1327             // DeterMine angle to look at target
1328             Vector3D position;
1329             if(flags.root || !parent)
1330                position = transform.position;
1331             else
1332                position.MultMatrix(transform.position, parent.matrix);
1333
1334             light.direction.Subtract((Vector3D *) light.target.matrix.m[3], position);
1335             light.direction.Normalize(light.direction);
1336             transform.orientation.RotationDirection(light.direction);
1337          }
1338
1339          matrix.Identity();
1340          matrix.Scale(transform.scaling.x, transform.scaling.y, transform.scaling.z);
1341          matrix.Rotate(transform.orientation);
1342          matrix.Translate(transform.position.x, transform.position.y, transform.position.z);
1343
1344          localMatrix = matrix;
1345
1346          // Compute transform (with ancestors)
1347          if(flags.root || !parent)
1348             this.matrix = matrix;
1349          else
1350             this.matrix.Multiply(matrix, parent.matrix);
1351
1352          flags.transform = false;
1353
1354          for(child = children.first; child; child = child.next)
1355          {
1356             if(child.flags.transform)
1357                child._UpdateTransform();
1358          }
1359       }
1360    }
1361
1362    void _Animate(unsigned int frame)
1363    {
1364       Object child;
1365       FrameTrack track;
1366
1367       for(track = tracks.first; track; track = track.next)
1368       {
1369          unsigned int c;
1370
1371          if(track.numKeys)
1372          {
1373             unsigned int prev = 0, next = track.numKeys - 1;
1374             FrameKey * prevKey = &track.keys[prev], * nextKey = &track.keys[next];
1375             float t = 0;
1376
1377             for(c = 0; c<track.numKeys; c++)
1378             {
1379                FrameKey * key = track.keys + c;
1380                if(key->frame <= frame) { prevKey = key; prev = c; }
1381                if(key->frame >= frame) { nextKey = key; next = c; break; }
1382             }
1383
1384             if(nextKey->frame != prevKey->frame)
1385                t = ease((float) (frame - prevKey->frame) / (nextKey->frame - prevKey->frame), prevKey->easeFrom, nextKey->easeTo);
1386
1387             switch(track.type.type)
1388             {
1389                case position:
1390                {
1391                   Vector3Df position;
1392                   track.Interpolate(position, prevKey->position, nextKey->position, prev, next, t);
1393                   transform.position = { (double)position.x, (double)position.y, (double)position.z };
1394                   break;
1395                }
1396                case scaling:
1397                   track.Interpolate(transform.scaling, prevKey->scaling, &nextKey->scaling, prev, next, t);
1398                   break;
1399                case rotation:
1400                   track.InterpolateQuat(transform.orientation, prevKey->orientation, nextKey->orientation, prev, next, t);
1401                   break;
1402                // Cameras
1403                case roll:
1404                   roll = track.InterpolateFloat(prevKey->roll, nextKey->roll, prev, next, t);
1405                   break;
1406                case fov:
1407                {
1408                   camera.fov = track.InterpolateFloat(prevKey->fov, nextKey->fov, prev, next, t);
1409                   /*
1410                   double mm = (camera.fov - 5.05659508373109) / 1.13613250717301;
1411                   camera.fov = 1248.58921609766 * pow(mm, -0.895625414990581);
1412                   */
1413                   //camera.Setup(camera.width, camera.height, camera.origin);
1414                   break;
1415                }
1416                // Lights
1417                case colorChange:
1418                {
1419                   track.Interpolate((Vector3Df *)&light.diffuse,
1420                      (Vector3Df *)&prevKey->color, (Vector3Df *)&nextKey->color, prev, next, t);
1421                   light.specular = light.diffuse;
1422                   break;
1423                }
1424                case fallOff:
1425                {
1426                   light.fallOff = track.InterpolateFloat(prevKey->fallOff, nextKey->fallOff, prev, next, t);
1427                   break;
1428                }
1429                case hotSpot:
1430                {
1431                   light.hotSpot = track.InterpolateFloat(prevKey->hotSpot, nextKey->hotSpot, prev, next, t);
1432                   break;
1433                }
1434             }
1435          }
1436       }
1437
1438       for(child = children.first; child; child = child.next)
1439          child._Animate(frame);
1440
1441       flags.transform = true;
1442    }
1443
1444    // Private for now
1445    FrustumPlacement InsideFrustum(Plane * planes)
1446    {
1447       FrustumPlacement result = inside;
1448
1449       int p;
1450       // First test: Sphere
1451       for(p = 0; p<6; p++)
1452       {
1453          Plane * plane = &planes[p];
1454          double dot = plane->normal.DotProduct(wcenter);
1455          double distance = dot + plane->d;
1456          if(distance < -wradius)
1457          {
1458             result = outside;
1459             break;
1460          }
1461          if(Abs(distance) < wradius)
1462             result = intersecting;
1463       }
1464
1465       if(result == intersecting)
1466       {
1467          // Second test: Bounding Box
1468          Vector3D box[8] =
1469          {
1470             { wmin.x, wmin.y, wmin.z },
1471             { wmin.x, wmin.y, wmax.z },
1472             { wmin.x, wmax.y, wmin.z },
1473             { wmin.x, wmax.y, wmax.z },
1474             { wmax.x, wmin.y, wmin.z },
1475             { wmax.x, wmin.y, wmax.z },
1476             { wmax.x, wmax.y, wmin.z },
1477             { wmax.x, wmax.y, wmax.z }
1478          };
1479            int numPlanesAllIn = 0;
1480          for(p = 0; p < 6; p++)
1481          {
1482             Plane * plane = &planes[p];
1483             int i;
1484             int numGoodPoints = 0;
1485             for(i = 0; i < 8; ++i)
1486             {
1487                double dot = plane->normal.DotProduct(box[i]);
1488                double distance = dot + plane->d;
1489                            if(distance > -1)
1490                   numGoodPoints++;
1491                    }
1492                    if(!numGoodPoints)
1493             {
1494                result = outside;
1495                break;
1496             }
1497             if(numGoodPoints == 8)
1498                numPlanesAllIn++;
1499            }
1500            if(numPlanesAllIn == 6)
1501                    result = inside;
1502       }
1503       return result;
1504    }
1505
1506    Object prev, next;
1507    char * name;
1508    Object parent;
1509    OldList children;
1510
1511    ObjectFlags flags;
1512
1513    OldList tracks;
1514    unsigned startFrame, endFrame;
1515    int frame;
1516    Vector3Df pivot;
1517
1518    public Transform transform;
1519    public Matrix matrix;
1520    Matrix localMatrix;
1521    void * tag;
1522    Vector3Df min, max, center;
1523    Vector3D wmin, wmax, wcenter;
1524
1525    bool volume;
1526    float radius;
1527    double wradius;
1528    ColorRGB ambient;
1529
1530    /*public */union
1531    {
1532       // Mesh
1533       struct
1534       {
1535          Mesh mesh;
1536          Material material;
1537       };
1538
1539       // Light
1540       Light light;
1541
1542       // Camera
1543       struct
1544       {
1545          Camera camera;
1546          Object cameraTarget;
1547          double roll;
1548       };
1549    };
1550
1551    public property Light light
1552    {
1553       set
1554       {
1555          light = value;
1556       }
1557       get
1558       {
1559          value = light;
1560       }
1561    }
1562
1563    Euler eulerOrientation;
1564 };