slight modification to pathGenerationTrial.java, integration into robot now