6 from std_vector
import printVectorOfMatrix, printVectorOf3x3, copyStdVector
10 l1 = [np.random.randn(3), np.random.randn(2)]
11 l2 = eigenpy.StdVec_VectorXd(l1)
12 l3 = [np.random.randn(2, 2), np.random.randn(3, 1)]
13 l3.append(np.asfortranarray(np.eye(2)))
15 l4 = [np.random.randn(3, 3).T
for _
in range(3)]
17 l5 = [np.random.randn(2, 2).T
for _
in range(3)]
21 assert len(li1) == len(li2)
24 assert np.array_equal(li1[i], li2[i])
31 assert np.allclose(l2[0][:2], 0.0)
41 l4_copy = copyStdVector(l4)
42 assert isinstance(l4_copy, eigenpy.StdVec_MatrixXd)
44 assert "StdVec_Mat3d" in printVectorOf3x3.__doc__
47 l4_copy2 = std_vector.copyStdVec_3x3(l4)
48 assert isinstance(l4_copy2, std_vector.StdVec_Mat3d)
53 assert np.allclose(x, 0.0),
"x = {}".format(x)
56 print(
"Check setZero() works:")
57 std_vector.setZero(l1)
61 print(
"-----------------")
65 std_vector.setZero(l2_py)
68 print(
"-----------------")
70 l3_copy = copyStdVector(l3)
72 std_vector.setZero(l3_copy)
73 pprint.pprint(list(l3_copy))
75 print(
"-----------------")
92 l5_copy = std_vector.StdVec_Mat2d(l5)
93 l5_py = l5_copy.tolist()
99 assert np.allclose(l5[0], 0.0)