From 9b363aa7e9b1b081b3bd3d073aa359f8e3fbd004 Mon Sep 17 00:00:00 2001
From: Joan Sola <jsola@iri.upc.edu>
Date: Tue, 8 Nov 2016 15:20:16 +0100
Subject: [PATCH] Resize state_block_vec in SensorGPS constructor
---
src/sensor_gps.cpp | 1 +
1 file changed, 1 insertion(+)
diff --git a/src/sensor_gps.cpp b/src/sensor_gps.cpp
index 28a9a40dd..0321f21e3 100644
--- a/src/sensor_gps.cpp
+++ b/src/sensor_gps.cpp
@@ -13,6 +13,7 @@ SensorGPS::SensorGPS(StateBlockPtr _p_ptr, //GPS sensor position with respect to
:
SensorBase("GPS", _p_ptr, _o_ptr, _bias_ptr, 0)
{
+ getStateBlockVec().resize(5);
setStateBlockPtr(3, _map_p_ptr); // Map position
setStateBlockPtr(4, _map_o_ptr); // Map orientation
//
--
GitLab