"waypoint loitering" added to wp 4Dset

Code now deals appropriately with times greater than 255