Integer graph search... doesn't work.
Working solution. It just ramps down the speeds for the first few seconds.
Final solution. Including velocity ramping and min/max speeds.
Working waypoints.