Update agv-testenv, add line and point map