Updated Assignment1 to take initial and goal nodes from the initial and goal ASVConfigs
Added addPoint() as a variant to addPoints in PRMGraph
Added Methods to Node to support the "Pose" of it's ASV's