Added ability to replan; added visualization of virtual GCP; added path shorteners that shorten all individual paths; some extra cleaning