Add quaternionDistance.

ckguo · Feb 13, 2015 · 743c196 · 743c196
1 parent fdca11f
commit 743c196
Showing 1 changed file with 4 additions and 0 deletions.
diff --git a/util/quaternionDistance.m b/util/quaternionDistance.m
@@ -0,0 +1,4 @@
+function quat_norm = quaternionDistance(quat1,quat2)
+lambda = sum(bsxfun(@times,quat1,quat2),1);
+quat_norm = 1-abs(lambda);
+end