goat3d

annotate src/xform_node.cc @ 47:498ca7ac7047

- placed all the implementation stuff in the g3dimpl namespace - added animation stuff to the public API - started writing animation saving/loading
author John Tsiombikas <nuclear@member.fsf.org>
date Sat, 28 Dec 2013 06:47:39 +0200
parents 0fe02696fb1e
children 9ef9de80649c
rev   line source
nuclear@1 1 #include <assert.h>
nuclear@1 2 #include <algorithm>
nuclear@1 3 #include "xform_node.h"
nuclear@47 4 #include "anim/anim.h"
nuclear@47 5 #include "anim/track.h"
nuclear@47 6
nuclear@47 7 using namespace g3dimpl;
nuclear@1 8
nuclear@1 9 static inline anm_interpolator track_interpolator(Interp in);
nuclear@1 10 static inline anm_extrapolator track_extrapolator(Extrap ex);
nuclear@1 11
nuclear@1 12 XFormNode::XFormNode()
nuclear@1 13 {
nuclear@1 14 anm = new anm_node;
nuclear@1 15 anm_init_node(anm);
nuclear@47 16 parent = 0;
nuclear@30 17
nuclear@47 18 // TODO read them from anm to get the correct initial values
nuclear@47 19 interp = INTERP_LINEAR;
nuclear@47 20 extrap = EXTRAP_EXTEND;
nuclear@1 21 }
nuclear@1 22
nuclear@1 23 XFormNode::~XFormNode()
nuclear@1 24 {
nuclear@1 25 anm_destroy_node(anm);
nuclear@1 26 delete anm;
nuclear@1 27 }
nuclear@1 28
nuclear@47 29 struct anm_node *XFormNode::get_libanim_node() const
nuclear@47 30 {
nuclear@47 31 return anm;
nuclear@47 32 }
nuclear@47 33
nuclear@1 34 void XFormNode::set_name(const char *name)
nuclear@1 35 {
nuclear@1 36 anm_set_node_name(anm, name);
nuclear@1 37 }
nuclear@1 38
nuclear@1 39 const char *XFormNode::get_name() const
nuclear@1 40 {
nuclear@1 41 return anm_get_node_name(anm);
nuclear@1 42 }
nuclear@1 43
nuclear@1 44 void XFormNode::set_interpolator(Interp in)
nuclear@1 45 {
nuclear@1 46 anm_set_interpolator(anm, track_interpolator(in));
nuclear@1 47 interp = in;
nuclear@1 48 }
nuclear@1 49
nuclear@1 50 Interp XFormNode::get_interpolator() const
nuclear@1 51 {
nuclear@1 52 return interp;
nuclear@1 53 }
nuclear@1 54
nuclear@1 55 void XFormNode::set_extrapolator(Extrap ex)
nuclear@1 56 {
nuclear@1 57 anm_set_extrapolator(anm, track_extrapolator(ex));
nuclear@1 58 extrap = ex;
nuclear@1 59 }
nuclear@1 60
nuclear@1 61 Extrap XFormNode::get_extrapolator() const
nuclear@1 62 {
nuclear@1 63 return extrap;
nuclear@1 64 }
nuclear@1 65
nuclear@47 66 XFormNode *XFormNode::get_parent()
nuclear@47 67 {
nuclear@47 68 return parent;
nuclear@47 69 }
nuclear@47 70
nuclear@47 71 const XFormNode *XFormNode::get_parent() const
nuclear@47 72 {
nuclear@47 73 return parent;
nuclear@47 74 }
nuclear@47 75
nuclear@1 76 void XFormNode::add_child(XFormNode *child)
nuclear@1 77 {
nuclear@1 78 children.push_back(child);
nuclear@1 79 anm_link_node(anm, child->anm);
nuclear@30 80 child->parent = this;
nuclear@1 81 }
nuclear@1 82
nuclear@1 83 void XFormNode::remove_child(XFormNode *child)
nuclear@1 84 {
nuclear@1 85 std::vector<XFormNode*>::iterator it;
nuclear@1 86 it = std::find(children.begin(), children.end(), child);
nuclear@1 87 if(it != children.end()) {
nuclear@1 88 children.erase(it);
nuclear@1 89 anm_unlink_node(anm, child->anm);
nuclear@47 90
nuclear@47 91 if(child->parent == this) {
nuclear@47 92 child->parent = 0;
nuclear@47 93 }
nuclear@1 94 }
nuclear@1 95 }
nuclear@1 96
nuclear@1 97 int XFormNode::get_children_count() const
nuclear@1 98 {
nuclear@1 99 return (int)children.size();
nuclear@1 100 }
nuclear@1 101
nuclear@1 102 XFormNode *XFormNode::get_child(int idx)
nuclear@1 103 {
nuclear@1 104 if(idx >= 0 && idx < get_children_count()) {
nuclear@1 105 return children[idx];
nuclear@1 106 }
nuclear@1 107 return 0;
nuclear@1 108 }
nuclear@1 109
nuclear@1 110 const XFormNode *XFormNode::get_child(int idx) const
nuclear@1 111 {
nuclear@1 112 if(idx >= 0 && idx < get_children_count()) {
nuclear@1 113 return children[idx];
nuclear@1 114 }
nuclear@1 115 return 0;
nuclear@1 116 }
nuclear@1 117
nuclear@47 118
nuclear@47 119 void XFormNode::use_animation(int idx)
nuclear@30 120 {
nuclear@47 121 if(idx >= 0) {
nuclear@47 122 anm_use_animation(anm, idx);
nuclear@47 123 }
nuclear@30 124 }
nuclear@30 125
nuclear@47 126 void XFormNode::use_animation(const char *name)
nuclear@47 127 {
nuclear@47 128 anm_use_animation(anm, anm_find_animation(anm, name));
nuclear@47 129 }
nuclear@47 130
nuclear@47 131 void XFormNode::use_animation(int aidx, int bidx, float t)
nuclear@47 132 {
nuclear@47 133 anm_use_animations(anm, aidx, bidx, t);
nuclear@47 134 }
nuclear@47 135
nuclear@47 136 void XFormNode::use_animation(const char *aname, const char *bname, float t)
nuclear@47 137 {
nuclear@47 138 int aidx = anm_find_animation(anm, aname);
nuclear@47 139 int bidx = anm_find_animation(anm, bname);
nuclear@47 140
nuclear@47 141 if(aidx == -1) {
nuclear@47 142 use_animation(bidx);
nuclear@47 143 }
nuclear@47 144 if(bidx == -1) {
nuclear@47 145 use_animation(aidx);
nuclear@47 146 }
nuclear@47 147 anm_use_animations(anm, aidx, bidx, t);
nuclear@47 148 }
nuclear@47 149
nuclear@47 150 int XFormNode::get_active_animation_index(int which) const
nuclear@47 151 {
nuclear@47 152 return anm_get_active_animation_index(anm, which);
nuclear@47 153 }
nuclear@47 154
nuclear@47 155 float XFormNode::get_active_animation_mix() const
nuclear@47 156 {
nuclear@47 157 return anm_get_active_animation_mix(anm);
nuclear@47 158 }
nuclear@47 159
nuclear@47 160 int XFormNode::get_animation_count() const
nuclear@47 161 {
nuclear@47 162 return anm_get_animation_count(anm);
nuclear@47 163 }
nuclear@47 164
nuclear@47 165 void XFormNode::add_animation(const char *name)
nuclear@47 166 {
nuclear@47 167 int idx = get_animation_count();
nuclear@47 168
nuclear@47 169 anm_add_animation(anm);
nuclear@47 170 use_animation(idx);
nuclear@47 171
nuclear@47 172 if(name) {
nuclear@47 173 set_animation_name(name);
nuclear@47 174 }
nuclear@47 175 }
nuclear@47 176
nuclear@47 177 void XFormNode::set_animation_name(const char *name)
nuclear@47 178 {
nuclear@47 179 anm_set_active_animation_name(anm, name);
nuclear@47 180 }
nuclear@47 181
nuclear@47 182 const char *XFormNode::get_animation_name() const
nuclear@47 183 {
nuclear@47 184 return anm_get_active_animation_name(anm);
nuclear@47 185 }
nuclear@47 186
nuclear@47 187
nuclear@47 188
nuclear@1 189 void XFormNode::set_position(const Vector3 &pos, long tmsec)
nuclear@1 190 {
nuclear@1 191 anm_set_position(anm, v3_cons(pos.x, pos.y, pos.z), ANM_MSEC2TM(tmsec));
nuclear@1 192 }
nuclear@1 193
nuclear@1 194 Vector3 XFormNode::get_node_position(long tmsec) const
nuclear@1 195 {
nuclear@1 196 vec3_t p = anm_get_node_position(anm, ANM_MSEC2TM(tmsec));
nuclear@1 197 return Vector3(p.x, p.y, p.z);
nuclear@1 198 }
nuclear@1 199
nuclear@1 200 void XFormNode::set_rotation(const Quaternion &quat, long tmsec)
nuclear@1 201 {
nuclear@1 202 anm_set_rotation(anm, quat_cons(quat.s, quat.v.x, quat.v.y, quat.v.z), ANM_MSEC2TM(tmsec));
nuclear@1 203 }
nuclear@1 204
nuclear@1 205 Quaternion XFormNode::get_node_rotation(long tmsec) const
nuclear@1 206 {
nuclear@1 207 quat_t q = anm_get_node_rotation(anm, ANM_MSEC2TM(tmsec));
nuclear@1 208 return Quaternion(q.w, q.x, q.y, q.z);
nuclear@1 209 }
nuclear@1 210
nuclear@1 211 void XFormNode::set_scaling(const Vector3 &pos, long tmsec)
nuclear@1 212 {
nuclear@1 213 anm_set_scaling(anm, v3_cons(pos.x, pos.y, pos.z), ANM_MSEC2TM(tmsec));
nuclear@1 214 }
nuclear@1 215
nuclear@1 216 Vector3 XFormNode::get_node_scaling(long tmsec) const
nuclear@1 217 {
nuclear@1 218 vec3_t s = anm_get_node_scaling(anm, ANM_MSEC2TM(tmsec));
nuclear@1 219 return Vector3(s.x, s.y, s.z);
nuclear@1 220 }
nuclear@1 221
nuclear@1 222 // these take hierarchy into account
nuclear@1 223 Vector3 XFormNode::get_position(long tmsec) const
nuclear@1 224 {
nuclear@1 225 vec3_t v = anm_get_position(anm, ANM_MSEC2TM(tmsec));
nuclear@1 226 return Vector3(v.x, v.y, v.z);
nuclear@1 227 }
nuclear@1 228
nuclear@1 229 Quaternion XFormNode::get_rotation(long tmsec) const
nuclear@1 230 {
nuclear@1 231 quat_t q = anm_get_rotation(anm, tmsec);
nuclear@1 232 return Quaternion(q.w, q.x, q.y, q.z);
nuclear@1 233 }
nuclear@1 234
nuclear@1 235 Vector3 XFormNode::get_scaling(long tmsec) const
nuclear@1 236 {
nuclear@1 237 vec3_t v = anm_get_scaling(anm, ANM_MSEC2TM(tmsec));
nuclear@1 238 return Vector3(v.x, v.y, v.z);
nuclear@1 239 }
nuclear@1 240
nuclear@1 241 void XFormNode::set_pivot(const Vector3 &pivot)
nuclear@1 242 {
nuclear@1 243 anm_set_pivot(anm, v3_cons(pivot.x, pivot.y, pivot.z));
nuclear@1 244 }
nuclear@1 245
nuclear@1 246 Vector3 XFormNode::get_pivot() const
nuclear@1 247 {
nuclear@1 248 vec3_t p = anm_get_pivot(anm);
nuclear@1 249 return Vector3(p.x, p.y, p.z);
nuclear@1 250 }
nuclear@1 251
nuclear@1 252 void XFormNode::set_local_matrix(const Matrix4x4 &mat)
nuclear@1 253 {
nuclear@1 254 local_matrix = mat;
nuclear@1 255 }
nuclear@1 256
nuclear@1 257 const Matrix4x4 &XFormNode::get_local_matrix() const
nuclear@1 258 {
nuclear@1 259 return local_matrix;
nuclear@1 260 }
nuclear@1 261
nuclear@1 262 void XFormNode::set_bone_matrix(const Matrix4x4 &bmat)
nuclear@1 263 {
nuclear@1 264 bone_matrix = bmat;
nuclear@1 265 }
nuclear@1 266
nuclear@1 267 const Matrix4x4 &XFormNode::get_bone_matrix() const
nuclear@1 268 {
nuclear@1 269 return bone_matrix;
nuclear@1 270 }
nuclear@1 271
nuclear@1 272 #define FOO
nuclear@1 273
nuclear@1 274 void XFormNode::get_node_xform(long tmsec, Matrix4x4 *mat, Matrix4x4 *inv_mat) const
nuclear@1 275 {
nuclear@1 276 anm_time_t tm = ANM_MSEC2TM(tmsec);
nuclear@1 277
nuclear@1 278 if(mat) {
nuclear@1 279 anm_get_node_matrix(anm, (scalar_t(*)[4])mat, tm);
nuclear@1 280 #ifdef FOO
nuclear@1 281 *mat = local_matrix * *mat;
nuclear@1 282 #else
nuclear@1 283 *mat = *mat * local_matrix;
nuclear@1 284 #endif
nuclear@1 285 }
nuclear@1 286 if(inv_mat) {
nuclear@1 287 anm_get_inv_matrix(anm, (scalar_t(*)[4])inv_mat, tm);
nuclear@1 288 }
nuclear@1 289 }
nuclear@1 290
nuclear@1 291 void XFormNode::get_xform(long tmsec, Matrix4x4 *mat, Matrix4x4 *inv_mat) const
nuclear@1 292 {
nuclear@1 293 anm_time_t tm = ANM_MSEC2TM(tmsec);
nuclear@1 294
nuclear@1 295 if(mat) {
nuclear@1 296 anm_get_matrix(anm, (scalar_t(*)[4])mat, tm);
nuclear@1 297 #ifdef FOO
nuclear@1 298 *mat = local_matrix * *mat;
nuclear@1 299 #else
nuclear@1 300 *mat = *mat * local_matrix;
nuclear@1 301 #endif
nuclear@1 302 }
nuclear@1 303 if(inv_mat) {
nuclear@1 304 anm_get_inv_matrix(anm, (scalar_t(*)[4])inv_mat, tm);
nuclear@1 305 }
nuclear@1 306 }
nuclear@1 307
nuclear@1 308
nuclear@1 309 // ---- Track ----
nuclear@1 310
nuclear@1 311 Track::Track()
nuclear@1 312 {
nuclear@1 313 trk = new anm_track;
nuclear@1 314 anm_init_track(trk);
nuclear@1 315 }
nuclear@1 316
nuclear@1 317 Track::~Track()
nuclear@1 318 {
nuclear@1 319 anm_destroy_track(trk);
nuclear@1 320 delete trk;
nuclear@1 321 }
nuclear@1 322
nuclear@1 323 Track::Track(const Track &rhs)
nuclear@1 324 {
nuclear@1 325 trk = new anm_track;
nuclear@1 326 anm_init_track(trk);
nuclear@1 327 anm_copy_track(trk, rhs.trk);
nuclear@1 328 interp = rhs.interp;
nuclear@1 329 extrap = rhs.extrap;
nuclear@1 330 }
nuclear@1 331
nuclear@1 332 Track &Track::operator =(const Track &rhs)
nuclear@1 333 {
nuclear@1 334 if(&rhs == this) {
nuclear@1 335 return *this;
nuclear@1 336 }
nuclear@1 337
nuclear@1 338 anm_copy_track(trk, rhs.trk);
nuclear@1 339 interp = rhs.interp;
nuclear@1 340 extrap = rhs.extrap;
nuclear@1 341 return *this;
nuclear@1 342 }
nuclear@1 343
nuclear@1 344
nuclear@1 345 void Track::set_interpolator(Interp in)
nuclear@1 346 {
nuclear@1 347 anm_set_track_interpolator(trk, track_interpolator(in));
nuclear@1 348 interp = in;
nuclear@1 349 }
nuclear@1 350
nuclear@1 351 Interp Track::get_interpolator() const
nuclear@1 352 {
nuclear@1 353 return interp;
nuclear@1 354 }
nuclear@1 355
nuclear@1 356 void Track::set_extrapolator(Extrap ex)
nuclear@1 357 {
nuclear@1 358 anm_set_track_extrapolator(trk, track_extrapolator(ex));
nuclear@1 359 extrap = ex;
nuclear@1 360 }
nuclear@1 361
nuclear@1 362 Extrap Track::get_extrapolator() const
nuclear@1 363 {
nuclear@1 364 return extrap;
nuclear@1 365 }
nuclear@1 366
nuclear@1 367 void Track::set_default(double def)
nuclear@1 368 {
nuclear@1 369 anm_set_track_default(trk, def);
nuclear@1 370 }
nuclear@1 371
nuclear@1 372 void Track::set_value(float val, long tmsec)
nuclear@1 373 {
nuclear@1 374 anm_set_value(trk, ANM_MSEC2TM(tmsec), val);
nuclear@1 375 }
nuclear@1 376
nuclear@1 377 float Track::get_value(long tmsec) const
nuclear@1 378 {
nuclear@1 379 return anm_get_value(trk, ANM_MSEC2TM(tmsec));
nuclear@1 380 }
nuclear@1 381
nuclear@1 382 float Track::operator ()(long tmsec) const
nuclear@1 383 {
nuclear@1 384 return anm_get_value(trk, ANM_MSEC2TM(tmsec));
nuclear@1 385 }
nuclear@1 386
nuclear@1 387
nuclear@1 388 // ---- Track3 ----
nuclear@1 389
nuclear@1 390 void Track3::set_interpolator(Interp in)
nuclear@1 391 {
nuclear@1 392 for(int i=0; i<3; i++) {
nuclear@1 393 track[i].set_interpolator(in);
nuclear@1 394 }
nuclear@1 395 }
nuclear@1 396
nuclear@1 397 Interp Track3::get_interpolator() const
nuclear@1 398 {
nuclear@1 399 return track[0].get_interpolator();
nuclear@1 400 }
nuclear@1 401
nuclear@1 402 void Track3::set_extrapolator(Extrap ex)
nuclear@1 403 {
nuclear@1 404 for(int i=0; i<3; i++) {
nuclear@1 405 track[i].set_extrapolator(ex);
nuclear@1 406 }
nuclear@1 407 }
nuclear@1 408
nuclear@1 409 Extrap Track3::get_extrapolator() const
nuclear@1 410 {
nuclear@1 411 return track[0].get_extrapolator();
nuclear@1 412 }
nuclear@1 413
nuclear@1 414 void Track3::set_default(const Vector3 &def)
nuclear@1 415 {
nuclear@1 416 for(int i=0; i<3; i++) {
nuclear@1 417 track[i].set_default(def[i]);
nuclear@1 418 }
nuclear@1 419 }
nuclear@1 420
nuclear@1 421 void Track3::set_value(const Vector3 &val, long tmsec)
nuclear@1 422 {
nuclear@1 423 for(int i=0; i<3; i++) {
nuclear@1 424 track[i].set_value(val[i], tmsec);
nuclear@1 425 }
nuclear@1 426 }
nuclear@1 427
nuclear@1 428 Vector3 Track3::get_value(long tmsec) const
nuclear@1 429 {
nuclear@1 430 return Vector3(track[0](tmsec), track[1](tmsec), track[2](tmsec));
nuclear@1 431 }
nuclear@1 432
nuclear@1 433 Vector3 Track3::operator ()(long tmsec) const
nuclear@1 434 {
nuclear@1 435 return Vector3(track[0](tmsec), track[1](tmsec), track[2](tmsec));
nuclear@1 436 }
nuclear@1 437
nuclear@1 438
nuclear@1 439 static inline anm_interpolator track_interpolator(Interp in)
nuclear@1 440 {
nuclear@1 441 switch(in) {
nuclear@1 442 case INTERP_STEP:
nuclear@1 443 return ANM_INTERP_STEP;
nuclear@1 444 case INTERP_LINEAR:
nuclear@1 445 return ANM_INTERP_LINEAR;
nuclear@1 446 case INTERP_CUBIC:
nuclear@1 447 return ANM_INTERP_CUBIC;
nuclear@1 448 }
nuclear@1 449
nuclear@1 450 assert(0);
nuclear@1 451 return ANM_INTERP_STEP;
nuclear@1 452 }
nuclear@1 453
nuclear@1 454 static inline anm_extrapolator track_extrapolator(Extrap ex)
nuclear@1 455 {
nuclear@1 456 switch(ex) {
nuclear@1 457 case EXTRAP_EXTEND:
nuclear@1 458 return ANM_EXTRAP_EXTEND;
nuclear@1 459 case EXTRAP_CLAMP:
nuclear@1 460 return ANM_EXTRAP_CLAMP;
nuclear@1 461 case EXTRAP_REPEAT:
nuclear@1 462 return ANM_EXTRAP_REPEAT;
nuclear@1 463 }
nuclear@1 464
nuclear@1 465 assert(0);
nuclear@1 466 return ANM_EXTRAP_EXTEND;
nuclear@1 467 }
nuclear@1 468