Changeset 15 in flair-src for trunk/lib/FlairMeta/src/XAir.cpp
- Timestamp:
- 04/08/16 15:40:57 (7 years ago)
- File:
-
- 1 edited
Legend:
- Unmodified
- Added
- Removed
-
trunk/lib/FlairMeta/src/XAir.cpp
r10 r15 35 35 using namespace flair::actuator; 36 36 37 namespace flair { namespace meta { 37 namespace flair { 38 namespace meta { 38 39 39 XAir::XAir(FrameworkManager* parent,string uav_name,filter::UavMultiplex *multiplex) : Uav(parent,uav_name,multiplex) { 40 RTDM_I2cPort* i2cport=new RTDM_I2cPort(parent,"rtdm_i2c","rti2c3"); 41 RTDM_SerialPort* imu_port=new RTDM_SerialPort(parent,"imu_port","rtser1"); 40 XAir::XAir(FrameworkManager *parent, string uav_name, 41 filter::UavMultiplex *multiplex) 42 : Uav(parent, uav_name, multiplex) { 43 RTDM_I2cPort *i2cport = new RTDM_I2cPort(parent, "rtdm_i2c", "rti2c3"); 44 RTDM_SerialPort *imu_port = new RTDM_SerialPort(parent, "imu_port", "rtser1"); 42 45 43 if(multiplex==NULL) SetMultiplex(new X4X8Multiplex(parent,"motors",X4X8Multiplex::X8)); 46 if (multiplex == NULL) 47 SetMultiplex(new X4X8Multiplex(parent, "motors", X4X8Multiplex::X8)); 44 48 45 SetBldc(new AfroBldc(GetUavMultiplex(),GetUavMultiplex()->GetLayout(),"motors",GetUavMultiplex()->MotorsCount(),i2cport)); 46 SetUsRangeFinder(new Srf08(parent,"SRF08",i2cport,0x70,60)); 47 SetAhrs(new Gx3_25_ahrs(parent,"imu",imu_port,Gx3_25_imu::EulerAnglesAndAngularRates,70)); 48 Tab* bat_tab=new Tab(parent->GetTabWidget(),"battery"); 49 SetBatteryMonitor(new BatteryMonitor(bat_tab->NewRow(),"battery")); 50 GetBatteryMonitor()->SetBatteryValue(12); 49 SetBldc(new AfroBldc(GetUavMultiplex(), GetUavMultiplex()->GetLayout(), 50 "motors", GetUavMultiplex()->MotorsCount(), i2cport)); 51 SetUsRangeFinder(new Srf08(parent, "SRF08", i2cport, 0x70, 60)); 52 SetAhrs(new Gx3_25_ahrs(parent, "imu", imu_port, 53 Gx3_25_imu::EulerAnglesAndAngularRates, 70)); 54 Tab *bat_tab = new Tab(parent->GetTabWidget(), "battery"); 55 SetBatteryMonitor(new BatteryMonitor(bat_tab->NewRow(), "battery")); 56 GetBatteryMonitor()->SetBatteryValue(12); 51 57 52 /* 53 if(VRPNType==Auto || VRPNType==AutoSerialPort) 54 { 55 RTDM_SerialPort* vrpn_port=new RTDM_SerialPort(parent,"vrpn_port","rtser3"); 58 /* 59 if(VRPNType==Auto || VRPNType==AutoSerialPort) 60 { 61 RTDM_SerialPort* vrpn_port=new 62 RTDM_SerialPort(parent,"vrpn_port","rtser3"); 56 63 57 vrpnclient=new VrpnClient(parent,"vrpn",vrpn_port,10000,80); 58 uav_vrpn=new MetaVrpnObject(vrpnclient,uav_name,VRPNSerialObjectId); 59 } 60 */ 61 SetVerticalCamera(new Ps3Eye(parent,"camv",0,50)); 64 vrpnclient=new VrpnClient(parent,"vrpn",vrpn_port,10000,80); 65 uav_vrpn=new 66 MetaVrpnObject(vrpnclient,uav_name,VRPNSerialObjectId); 67 } 68 */ 69 SetVerticalCamera(new Ps3Eye(parent, "camv", 0, 50)); 62 70 } 63 71 64 XAir::~XAir() { 65 66 } 72 XAir::~XAir() {} 67 73 68 74 void XAir::StartSensors(void) { 69 ((Gx3_25_ahrs*)GetAhrs())->Start();70 ((Srf08*)GetUsRangeFinder())->Start();71 72 75 ((Gx3_25_ahrs *)GetAhrs())->Start(); 76 ((Srf08 *)GetUsRangeFinder())->Start(); 77 ((Ps3Eye *)GetVerticalCamera())->Start(); 78 Uav::StartSensors(); 73 79 } 74 80
Note:
See TracChangeset
for help on using the changeset viewer.