commit
ff60ea8dbc
|
@ -153,7 +153,7 @@ def plot_3d_points(fignum, values, linespec="g*", marginals=None):
|
||||||
# I guess it's not a Point3
|
# I guess it's not a Point3
|
||||||
|
|
||||||
|
|
||||||
def plot_pose3_on_axes(axes, pose, P=None, scale=1, axis_length=0.1):
|
def plot_pose3_on_axes(axes, pose, axis_length=0.1, P=None, scale=1):
|
||||||
"""Plot a 3D pose on given axis 'axes' with given 'axis_length'."""
|
"""Plot a 3D pose on given axis 'axes' with given 'axis_length'."""
|
||||||
# get rotation and translation (center)
|
# get rotation and translation (center)
|
||||||
gRp = pose.rotation().matrix() # rotation from pose to global
|
gRp = pose.rotation().matrix() # rotation from pose to global
|
||||||
|
@ -181,7 +181,7 @@ def plot_pose3_on_axes(axes, pose, P=None, scale=1, axis_length=0.1):
|
||||||
plot_covariance_ellipse_3d(axes, origin, gPp)
|
plot_covariance_ellipse_3d(axes, origin, gPp)
|
||||||
|
|
||||||
|
|
||||||
def plot_pose3(fignum, pose, P, axis_length=0.1):
|
def plot_pose3(fignum, pose, axis_length=0.1, P=None):
|
||||||
"""Plot a 3D pose on given figure with given 'axis_length'."""
|
"""Plot a 3D pose on given figure with given 'axis_length'."""
|
||||||
# get figure object
|
# get figure object
|
||||||
fig = plt.figure(fignum)
|
fig = plt.figure(fignum)
|
||||||
|
|
Loading…
Reference in New Issue