speed when passing a waypoint is now based on the turn happening with it
also hopefully fixed the double chain-add problem now