Feature request

Follow up from the discussion in #3165 (comment)

Feature description

• Currently, we do not show how long did the robot took to complete the entire waypoint following. We just show the time taken for a specific waypoint and reset the time and move to the next. Maybe we need to have "total time taken" for showing how long the robot took to complete.
• Additionally have an info stating about the "time taken for the last waypoint".
• Also I think it would be a nice idea for logging the time taken for each waypoint, which might be used for some sort of analysis later.