From f9b2306ee1926c986a6b878a66f4249d8c2f6998 Mon Sep 17 00:00:00 2001
From: "HW.Zhang" <zhanghuiwen@cvte.com>
Date: Thu, 27 Oct 2022 20:52:34 +0800
Subject: [PATCH] fix missing function

---
 fcts/quatnormalize.m | 6 ++++++
 1 file changed, 6 insertions(+)
 create mode 100644 fcts/quatnormalize.m

diff --git a/fcts/quatnormalize.m b/fcts/quatnormalize.m
new file mode 100644
index 0000000..4902da9
--- /dev/null
+++ b/fcts/quatnormalize.m
@@ -0,0 +1,6 @@
+function [ qnorm ] = quatnormalize ( q )
+% normalize of a quaternion
+m = norm(q)
+qnorm = q / m;
+end
+