Added setWaypoints method to UnitManagerExt and replaced code in Squad.cpp to use that method.