예제 #1
0
    def norm(self):
        """Return norm of this quaternion

        Returns
        -------
        quaternion_norm(self.q) : float
            norm of this quaternion

        Examples
        --------
        >>> from skrobot.coordinates.quaternion import Quaternion
        >>> q = Quaternion()
        >>> q.norm
        1.0
        >>> q = Quaternion([1, 2, 3, 4])
        >>> q.norm
        5.477225575051661
        >>> q.normalized.norm
        0.9999999999999999
        """
        return quaternion_norm(self.q)
예제 #2
0
 def test_random_quaternion(self):
     testing.assert_almost_equal(quaternion_norm(random_quaternion()), 1.0)
예제 #3
0
    def test_quaternion_norm(self):
        q = np.array([1, 0, 0, 0])
        self.assertEqual(quaternion_norm(q), 1.0)

        q = np.array([0, 0, 0, 0])
        self.assertEqual(quaternion_norm(q), 0.0)