Closed arenas7307979 closed 2 years ago
p = np.array([2.0, 0.0, 0.0]) euler = [0, 0, 0] euler[axis] = angle R = pr.matrix_from_quaternion([1,0,0,0])
pr.plot_basis(ax, R, p)
I'm a bit confused, but I guess you are looking for something like this: https://dfki-ric.github.io/pytransform3d/_auto_examples/plots/plot_camera_trajectory.html#sphx-glr-auto-examples-plots-plot-camera-trajectory-py
hii, I have seen the example of drawing through Euler Angle, if there is a way to directly draw path use quaternion or convert function active_matrix_from_extrinsic_quaternion?
tum is pose format : tx ty tz qx qy qz qw
example: https://github.com/dfki-ric/pytransform3d/blob/master/examples/plots/plot_euler_angles.py