Further development

clean to PVectors rather than X,Y,Z coords etc