Move time update to sensor base class

test/sensor_simulator/baro.cpp

@@ -16,7 +16,6 @@ Baro::~Baro()
 void Baro::send(uint32_t time)
 {
 	_ekf->setBaroData(time,_baro_data);
-	_time_last_data_sent = time;
 }
 
 void Baro::setData(float baro)

test/sensor_simulator/imu.cpp

@@ -24,7 +24,6 @@ void Imu::send(uint32_t time)
 	imu_sample.delta_vel = _accel_data * imu_sample.delta_vel_dt;
 
 	_ekf->setIMUData(imu_sample);
-	_time_last_data_sent = time;
 }
 
 void Imu::setData(const Vector3f& accel, const Vector3f& gyro)

test/sensor_simulator/mag.cpp

@@ -18,7 +18,6 @@ void Mag::send(uint32_t time)
 	float mag[3];
 	_mag_data.copyTo(mag);
 	_ekf->setMagData(time,mag);
-	_time_last_data_sent = time;
 }
 
 void Mag::setData(const Vector3f& mag)

test/sensor_simulator/sensor.cpp

@@ -16,6 +16,7 @@ void Sensor::update(uint32_t time)
 	if(should_send(time))
 	{
 		send(time);
+		_time_last_data_sent = time;
 	}
 }