Achllle / dual_quaternions_ros

Dual Quaternion conversions from/to ROS messages
MIT License
31 stars 7 forks source link

Speed up dual quaternion inverse #11

Closed Achllle closed 5 years ago

Achllle commented 5 years ago

For the inverse of a dual quaternion q = [qwr, qxr, qyr, qzr] + e[qwd, qxd, qyd, qzd] simply is

q^-1 = [qwr, -qxr, -qyr, -qzr] + e[qwd, -qxd, -qyd, -qzd]

I make use of numpy's inverse method instead of just flipping, which normalizes the quaternion.