You can not select more than 25 topics
Topics must start with a letter or number, can include dashes ('-') and can be up to 35 characters long.
|
|
|
|
#include "range_finder.h"
|
|
|
|
|
|
|
|
|
|
namespace sensor_simulator
|
|
|
|
|
{
|
|
|
|
|
namespace sensor
|
|
|
|
|
{
|
|
|
|
|
|
|
|
|
|
RangeFinder::RangeFinder(std::shared_ptr<Ekf> ekf):Sensor(ekf)
|
|
|
|
|
{
|
|
|
|
|
}
|
|
|
|
|
|
|
|
|
|
RangeFinder::~RangeFinder()
|
|
|
|
|
{
|
|
|
|
|
}
|
|
|
|
|
|
|
|
|
|
void RangeFinder::send(uint64_t time)
|
|
|
|
|
{
|
|
|
|
|
_range_sample.time_us = time;
|
|
|
|
|
_ekf->setRangeData(_range_sample);
|
|
|
|
|
}
|
|
|
|
|
|
|
|
|
|
void RangeFinder::setData(float range_data_meters, int8_t range_quality)
|
|
|
|
|
{
|
|
|
|
|
_range_sample.rng = range_data_meters;
|
|
|
|
|
_range_sample.quality = range_quality;
|
|
|
|
|
}
|
|
|
|
|
|
|
|
|
|
} // namespace sensor
|
|
|
|
|
} // namespace sensor_simulator
|
