mirror of
https://github.com/nzp-team/dquakeplus.git
synced 2024-12-02 08:32:46 +00:00
12 lines
422 B
C
12 lines
422 B
C
|
#include "pspmath.h"
|
||
|
|
|
||
|
|
void vfpu_quaternion_normalize(ScePspQuatMatrix *res) {
|
||
|
|
__asm__ volatile (
|
||
|
|
"lv.q C000, %0\n" // load quaternion into C000
|
||
|
|
"vdot.q S010, C000, C000\n" // S010 = x^2 + y^2 + z^2 + w^2
|
||
|
|
"vrsq.s S010, S010\n" // S020 = 1.0 / sqrt(S100)
|
||
|
|
"vscl.q C000, C000, S010\n" // C000 = C000 * S010 (normalized quaternion)
|
||
|
|
"sv.q C000, %0\n" // store into quaternion result
|
||
|
|
: "+m"(*res));
|
||
|
|
}
|