pathplanner
pathplanner copied to clipboard
Draw robot perimeter
Add a robot length and width to the configuration. Draw a rectangle of those dimensions centered on each waypoint and angled based on the waypoint's angle, to show the robot position at that waypoint.
TODO:
- [ ] New section "Robot Dimensions"
- [x] New source traj level "Waypoints, Source, and Robot Bounds"