Implements a rudimentary waypoint following algorithm using odometry provided by /odom/filtered and a simplistic PID for tracking into the waypoints by turn and movement forward. This addresses https://github.com/BCLab-UNM/SC2/issues/13
To make a world flat did you just spawn a level surface and then remove the lunar surface? Did you do that through the console and if so could you share the commands you ran?
Implements a rudimentary waypoint following algorithm using odometry provided by
/odom/filtered
and a simplistic PID for tracking into the waypoints by turn and movement forward. This addresses https://github.com/BCLab-UNM/SC2/issues/13To run:
Note: This does not yet handle obstacles.