open source pkg v1

2020-08-04 19:12:31 -04:00
parent bef213dba9
commit c389fc2c47
3708 changed files with 1624220 additions and 1 deletions
--- a/pkg/OpenFace/matlab_version/PDM_helpers/AxisAngle2Rot.m
+++ b/pkg/OpenFace/matlab_version/PDM_helpers/AxisAngle2Rot.m
@@ -0,0 +1,11 @@
+function [Rot] = AxisAngle2Rot(axisAngle)
+
+    theta = norm(axisAngle, 2);
+    
+    nx = axisAngle / theta;
+    
+    nx = [    0  -nx(3)  nx(2);
+           nx(3)     0  -nx(1);
+          -nx(2)  nx(1)     0 ];
+    
+    Rot = eye(3) + sin(theta) * nx + (1-cos(theta))*nx^2;