diff --git a/src/modules/ekf2/test/sensor_simulator/sensor_simulator.cpp b/src/modules/ekf2/test/sensor_simulator/sensor_simulator.cpp
index d9b60b538f..6a6feee5c1 100644
--- a/src/modules/ekf2/test/sensor_simulator/sensor_simulator.cpp
+++ b/src/modules/ekf2/test/sensor_simulator/sensor_simulator.cpp
@@ -15,6 +15,12 @@ SensorSimulator::SensorSimulator(std::shared_ptr<Ekf> ekf):
 	setSensorRateToDefault();
 	setSensorDataToDefault();
 	startBasicSensor();
+
+	for (int i = 0; i < 3; i++) {
+		_trajectory[i].setMaxJerk(22.f);
+		_trajectory[i].setMaxAccel(8.f);
+		_trajectory[i].setMaxVel(6.f);
+	}
 }
 
 void SensorSimulator::loadSensorDataFromFile(std::string file_name)
diff --git a/src/modules/ekf2/test/sensor_simulator/sensor_simulator.h b/src/modules/ekf2/test/sensor_simulator/sensor_simulator.h
index ee6a651e3a..5d1f41abb4 100644
--- a/src/modules/ekf2/test/sensor_simulator/sensor_simulator.h
+++ b/src/modules/ekf2/test/sensor_simulator/sensor_simulator.h
@@ -146,7 +146,7 @@ private:
 	bool _has_replay_data{false};
 
 	uint64_t _current_replay_data_index{0};
-	uint64_t _time{0};	// microseconds
+	uint64_t _time{0}; // microseconds
 
 	Dcmf _R_body_to_world{};
 };