-! Copyright (C) 2005, 2007 Slava Pestov.
+! Copyright (C) 2005, 2010 Joe Groff, Slava Pestov.
! See http://factorcode.org/license.txt for BSD license.
-USING: arrays combinators kernel math math.functions math.libm math.vectors sequences ;
+USING: arrays combinators kernel math
+math.libm math.order math.vectors sequences ;
IN: math.quaternions
: q+ ( u v -- u+v )
} 2cleave (q*sign) ; inline
GENERIC: qconjugate ( u -- u' )
-M: object qconjugate ( u -- u' )
+M: object qconjugate
{ 1 -1 -1 -1 } v* ; inline
: qrecip ( u -- 1/u )
: q/ ( u v -- u/v )
qrecip q* ; inline
-: n*q ( q n -- q )
- v*n ; inline
+: n*q ( n q -- r )
+ n*v ; inline
-: q*n ( q n -- q )
+: q*n ( q n -- r )
v*n ; inline
: n>q ( n -- q )
: euler ( phi theta psi -- q )
{ } euler-like ; inline
+
+:: slerp ( q0 q1 t -- qt )
+ q0 q1 vdot -1.0 1.0 clamp :> dot
+ dot facos t * :> omega
+ q1 dot q0 n*v v- normalize :> qt'
+ omega fcos q0 n*v omega fsin qt' n*v v+ ; inline