Added ability to re-plan during simulation
Added true virtual Grasp Center Point (GCP)
Further changes to online re-planning
Major improvements ahead of replanning implementation