Added garbage collection
Organising code, removed superfluous GraspProgram data structure