96 lines
2.4 KiB
C++
96 lines
2.4 KiB
C++
/*
|
|
* This file is part of the Owl Positioning System (OwlPS) project.
|
|
* It is subject to the copyright notice and license terms in the
|
|
* COPYRIGHT.t2t file found in the top-level directory of this
|
|
* distribution and at
|
|
* https://code.lm7.fr/mcy/owlps/src/master/COPYRIGHT.t2t
|
|
* No part of the OwlPS Project, including this file, may be copied,
|
|
* modified, propagated, or distributed except according to the terms
|
|
* contained in the COPYRIGHT.t2t file; the COPYRIGHT.t2t file must be
|
|
* distributed along with this file, either separately or by replacing
|
|
* this notice by the COPYRIGHT.t2t file's contents.
|
|
*/
|
|
|
|
|
|
#include "trilaterationalgorithm.hh"
|
|
#include "minmax.hh"
|
|
#include "mobile.hh"
|
|
#include "configuration.hh"
|
|
#include "posexcept.hh"
|
|
|
|
using namespace std ;
|
|
|
|
|
|
|
|
/* *** Constructors *** */
|
|
|
|
|
|
TrilaterationAlgorithm::TrilaterationAlgorithm():
|
|
request(nullptr)
|
|
{
|
|
// Will be changed when other trilateration methods will be
|
|
// implemented.
|
|
|
|
if (! Configuration::is_configured("positioning.area-start") ||
|
|
! Configuration::is_configured("positioning.area-stop"))
|
|
throw missing_configuration(
|
|
"You want to use MinMax, but either positioning.area-start or"
|
|
" positioning.area-stop is not defined!") ;
|
|
|
|
Point3D minmax_start(
|
|
Configuration::string_value("positioning.area-start")) ;
|
|
Point3D minmax_stop(
|
|
Configuration::string_value("positioning.area-stop")) ;
|
|
|
|
trilateration_method = new MinMax(minmax_start, minmax_stop) ;
|
|
}
|
|
|
|
|
|
TrilaterationAlgorithm::~TrilaterationAlgorithm()
|
|
{
|
|
delete trilateration_method ;
|
|
}
|
|
|
|
|
|
|
|
/* *** Operations *** */
|
|
|
|
|
|
double TrilaterationAlgorithm::
|
|
make_constant_term(const Measurement &measurement)
|
|
{
|
|
assert(request) ;
|
|
const Mobile *mobile = request->get_mobile() ;
|
|
assert(mobile) ;
|
|
const CapturePoint *cp = measurement.get_cp() ;
|
|
assert(cp) ;
|
|
|
|
return
|
|
cp->friis_constant_term() +
|
|
mobile->get_antenna_gain() +
|
|
mobile->get_trx_power() ;
|
|
}
|
|
|
|
|
|
Result TrilaterationAlgorithm::compute(const Request &_request)
|
|
{
|
|
request = &_request ;
|
|
|
|
compute_cp_distance_circles() ;
|
|
Point3D position(trilaterate()) ;
|
|
|
|
return Result(request, name, position) ;
|
|
}
|
|
|
|
|
|
void TrilaterationAlgorithm::compute_cp_distance_circles()
|
|
{
|
|
cp_distances.clear() ;
|
|
|
|
const unordered_map<string, Measurement> &measurements =
|
|
request->get_measurements() ;
|
|
|
|
for (auto i = measurements.begin() ; i != measurements.end() ; ++i)
|
|
cp_distances[i->second.get_cp()] = estimate_distance(i->second) ;
|
|
}
|