Include path segment type in pose

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

diff --git a/src/rrtext16.cc b/src/rrtext16.cc
index fae21d4740e0b890d48a239b17fd34a46cc362b5..c2235ad16b8ef455b45c1eed44036b3b0de52f98 100644 (file)
--- a/src/rrtext16.cc
+++ b/src/rrtext16.cc
@@ -1,3 +1,9 @@
+/*
+ * SPDX-FileCopyrightText: 2021 Jiri Vlasak <jiri.vlasak.2@cvut.cz>
+ *
+ * SPDX-License-Identifier: GPL-3.0-only
+ */
+
 #include "reeds_shepp.h"
 #include "rrtext.hh"
 
@@ -12,6 +18,7 @@ cb_steer(double q[4], void *w)
        st->back().y(q[1]);
        st->back().h(q[2]);
        st->back().sp(q[3]);
+       st->back().segment_type = q[4];
        return 0;
 }