Are there smoothness evaluation methods/algorithms of 3 dimensional cartesian trajectorys in the field of robotics

8 次查看(过去 30 天)
I was wondering if there are any methods of determining 3 dimensional cartesian trajectory smoothness for the end effector of a robot for example.
I have heard that in the ROS MoveIt framework a smoothness metric is proposed which looks at the angle formed between three consecutive waypoints for 2 dimensional paths.
  • Smoothness:Looks at three consecutive waypoints and the angle formed between them. Value is calculated as a square of sum of all the angles calculated that way. Formula:S = sumi=2n-1{(2 * (pi - arccos((di-2,i-12+di-1,i2-di-2,i2)/(2 * di-2,i-1 * di-1,i))))2}, where:n - number of waypoints on the path,dx,y - distance between waypoints with index x and y.Aligned points result in S = 0.The lower the value, the smoother plan.
It seems however that, this calculation method is limmited to 2 dimensional paths.
A proposed way of calculating smoothness is to look at the standard deviation of the time series data.
Could this suggestion be extended to the x, y, z, roll, pitch, yaw representation of trajectories by perhaps adding the standard deviations together?

回答(1 个)

Amrtanshu Raj
Amrtanshu Raj 2022-4-12
Hi Timling,
Great to see your intererst in calculating smoothness for 3 dimensional path. We are actively working on this.
Thanks
Amrtanshu

类别

Help CenterFile Exchange 中查找有关 Specialized Messages 的更多信息

Community Treasure Hunt

Find the treasures in MATLAB Central and discover how the community can help you!

Start Hunting!

Translated by