477 |
|
"initial quaternion error (q0^2 + q1^2 + q2^2 + q3^2 ~ 0).\n"); |
478 |
|
painCave.isFatal = 1; |
479 |
|
simError(); |
480 |
– |
|
481 |
– |
} else if (fabs(qlen - 1.0) > oopse::epsilon) { // check that the quaternion vector is normalized |
482 |
– |
sprintf(painCave.errMsg, |
483 |
– |
"initial quaternion error (q0^2 + q1^2 + q2^2 + q3^2 != 1.0).\n"); |
484 |
– |
painCave.isFatal = 0; |
485 |
– |
simError(); |
480 |
|
|
481 |
< |
q.normalize(); |
482 |
< |
} |
481 |
> |
} |
482 |
> |
|
483 |
> |
q.normalize(); |
484 |
> |
|
485 |
|
integrableObject->setQ(q); |
486 |
|
|
487 |
|
ji[0] = tokenizer.nextTokenAsFloat(); |