owlps/owlps-positioning/src/topologyreadercsv.cc

#include "topologyreadercsv.hh"
#include "posexcept.hh"
#include "stock.hh"
#include "area.hh"
#include "waypoint.hh"

using namespace std ;



/* *** Constructors *** */


TopologyReaderCSV::TopologyReaderCSV(
  const string &areas_file_name, const string &waypoints_file_name):
  areas_file(areas_file_name), waypoints_file(waypoints_file_name)
{
  read_topology() ;
}



/* *** Operations *** */


void TopologyReaderCSV::read_topology()
{
  while (areas_file.next_line())
    process_area_line() ;

  while (waypoints_file.next_line())
    process_waypoint_line() ;
}


void TopologyReaderCSV::process_area_line()
{
  string building_name ;
  if (! areas_file.read_field(building_name))
    throw malformed_topology("Cannot read building name!") ;
  Building &building = const_cast<Building&>(
                         Stock::find_create_building(building_name)) ;

  string name ;
  if (! areas_file.read_field(name))
    throw malformed_topology("Cannot read area name!") ;

  Point3D p_min(read_point(areas_file)) ;
  Point3D p_max(read_point(areas_file)) ;

  Area *area = new Area(&building, name, p_min, p_max) ;
  building.add_area(area) ;
}


void TopologyReaderCSV::process_waypoint_line()
{
  Point3D coordinates(read_point(waypoints_file)) ;
  Waypoint &waypoint_ref =
    const_cast<Waypoint&>(Stock::find_create_waypoint(coordinates)) ;

  vector<Building*> buildings ;
  string building_name ;
  while (waypoints_file.read_field(building_name))
    buildings.push_back(const_cast<Building*>(
                          &Stock::find_create_building(building_name))) ;
  if (buildings.empty())
    throw malformed_topology("Cannot read building name!") ;

  for (vector<Building*>::iterator i = buildings.begin() ;
       i != buildings.end() ; ++i)
    {
      waypoint_ref.add_building(*i) ;
      (*i)->add_waypoint(&waypoint_ref) ;
    }
}


Point3D TopologyReaderCSV::read_point(CSVFileReader &file)
{
  float coord[3] ;
  for (unsigned int i = 0 ; i < 3 ; ++i)
    if (! file.read_field(coord[i]))
      throw malformed_topology("Cannot read a whole Point3D!") ;

  return Point3D(coord) ;
}