Include path segment type in pose

[hubacji1/rrts.git] / src / rrtext13.cc

diff --git a/src/rrtext13.cc b/src/rrtext13.cc
index cbb1e96e229a84607412ca74d1fea600a69ac577..aa6e7c0a588543cee8a229884fbb3d93642d7be4 100644 (file)
--- a/src/rrtext13.cc
+++ b/src/rrtext13.cc
@@ -263,6 +263,7 @@ RRTExt13::json() const
                jvo["opath"][i][0] = n->x();
                jvo["opath"][i][1] = n->y();
                jvo["opath"][i][2] = n->h();
+               jvo["opath"][i][3] = n->sp();
                i++;
        }
        jvo["ogoal_cc"] = this->ogoal_cc_;