MichalisPapadakis

Display Trajectory Message has less wp & wrong timing

1

### Description When I am publishing a trajectory in `display_planned_path` with 307 waypoints, of total duration of around 32.5s (which i can check by printing 1. `time_from_start` of the last...

### Issue Type - [ ] 🐛 Bug / Problem - [ ] ✏️ Typo / Grammar - [ ] 📖 Outdated Content - [x] 🚀 Enhancement ### Generated by...