source: flair-src/trunk/lib/FlairMeta/src/UavFactory.cpp@ 175

Last change on this file since 175 was 157, checked in by Sanahuja Guillaume, 8 years ago

iadded isready to iodevice:
avoid problem of imu not ready in ardrone2

File size: 2.6 KB
RevLine 
[10]1// %flair:license{
[15]2// This file is part of the Flair framework distributed under the
3// CECILL-C License, Version 1.0.
[10]4// %flair:license}
[7]5// created: 2016/02/05
6// filename: UavFactory.cpp
7//
8// author: Guillaume Sanahuja
9// Copyright Heudiasyc UMR UTC/CNRS 7253
10//
11// version: $Id: $
12//
13// purpose: construct a Uav based on the type name
14//
15//
16/*********************************************************************/
17
18#include "UavFactory.h"
19#include "FrameworkManager.h"
20#include "SimuX4.h"
21#include "SimuX8.h"
22#include "HdsX8.h"
23#include "XAir.h"
[45]24#include "compile_info.h"
[7]25
26using namespace std;
27using namespace flair::core;
28using namespace flair::filter;
29using namespace flair::meta;
30
[41]31namespace { // anonymous
[157]32 vector<flair::meta::Uav* (*)(string,string,string,UavMultiplex*)> *vectoroffunctions=NULL;
[41]33}
34
[45]35
36static void constructor() __attribute__((constructor));
37
38void constructor() {
39 compile_info("FlairMeta");
40}
41
42
[157]43Uav *CreateUav(string name, string type,string options,
[15]44 UavMultiplex *multiplex) {
[41]45
46 Uav *uav;
[45]47
48 if(vectoroffunctions!=NULL) {
49 for(int i=0;i<vectoroffunctions->size();i++) {
[157]50 uav=vectoroffunctions->at(i)(name,type,options,multiplex);
[45]51 if(uav!=NULL) {
52 free(vectoroffunctions);
53 vectoroffunctions=NULL;
54 return uav;
55 }
56 }
[41]57 }
58
[157]59 if (type == "hds_x4") {
60 getFrameworkManager()->Err("UAV type %s not yet implemented\n", type.c_str());
[15]61 return NULL;
[157]62 } else if (type == "hds_x8") {
63 return new HdsX8(name,options, multiplex);
64 } else if (type == "xair") {
65 return new XAir(name,options, multiplex);
66 } else if (type == "hds_xufo") {
67 getFrameworkManager()->Err("UAV type %s not yet implemented\n", type.c_str());
[15]68 return NULL;
[157]69 } else if (type.compare(0, 7, "x4_simu") == 0) {
[15]70 int simu_id = 0;
[157]71 if (type.size() > 7) {
72 simu_id = atoi(type.substr(7, type.size() - 7).c_str());
[7]73 }
[157]74 return new SimuX4(name, simu_id,options, multiplex);
75 } else if (type.compare(0, 7, "x8_simu") == 0) {
[15]76 int simu_id = 0;
[157]77 if (type.size() > 7) {
78 simu_id = atoi(type.substr(7, type.size() - 7).c_str());
[15]79 }
[157]80 return new SimuX8(name, simu_id,options, multiplex);
[15]81 } else {
[157]82 getFrameworkManager()->Err("UAV type %s unknown\n", type.c_str());
[15]83 return NULL;
84 }
[7]85}
[41]86
[157]87void RegisterUavCreator(flair::meta::Uav*(*func)(string,string,string,UavMultiplex*)) {
88 if(vectoroffunctions==NULL) vectoroffunctions=(vector<flair::meta::Uav* (*)(string,string,string,UavMultiplex*)>*)malloc(sizeof(vector<flair::meta::Uav* (*)(string,string,string,UavMultiplex*)>));
[41]89
[45]90 vectoroffunctions->push_back(func);
[41]91}
Note: See TracBrowser for help on using the repository browser.