Calculate the path length of motion planning on Moveit/ROS?

I have algorithm in Moveit and I need to calculate the path length of motion planning (RRTConnect) anyone have any idea how I can start to write this code?

03 March 2019 4,055 1 View