| # | Line 518 | Line 518 | char* InitializeFromFile::parseDumpLine(char* readLine | |
|---|---|---|
| 518 | ||
| 519 | qSqr = (q[0] * q[0]) + (q[1] * q[1]) + (q[2] * q[2]) + (q[3] * q[3]); | |
| 520 | ||
| 521 | + | if (fabs(qSqr) < 1e-6) { |
| 522 | + | sprintf(painCave.errMsg, |
| 523 | + | "initial quaternion error (q0^2 + q1^2 + q2^2 + q3^2 ~ 0).\n"); |
| 524 | + | return strdup(painCave.errMsg); |
| 525 | + | } |
| 526 | + | |
| 527 | qLength = sqrt( qSqr ); | |
| 528 | q[0] = q[0] / qLength; | |
| 529 | q[1] = q[1] / qLength; | |
| – | Removed lines |
| + | Added lines |
| < | Changed lines |
| > | Changed lines |