Changeset 157 in flair-src for trunk/lib/FlairSensorActuator/src

Timestamp:

Mar 4, 2017, 3:29:18 PM (8 years ago)

Author:

Sanahuja Guillaume

Message:

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

Location:

trunk/lib/FlairSensorActuator/src

Files:

• AfroBldc.cpp (modified) (1 diff)
• BlCtrlV2.cpp (modified) (1 diff)
• BlCtrlV2_x4_speed.cpp (modified) (1 diff)
• Bldc.cpp (modified) (1 diff)
• Camera.cpp (modified) (1 diff)
• EmulatedController.cpp (modified) (1 diff)
• Gx3_25_imu_impl.cpp (modified) (3 diffs)
• HokuyoUTM30Lx.cpp (modified) (1 diff)
• Mb800.cpp (modified) (1 diff)
• Novatel.cpp (modified) (1 diff)
• Ps3Eye.cpp (modified) (1 diff)
• RadioReceiver.cpp (modified) (1 diff)
• SimuBldc.cpp (modified) (2 diffs)
• SimuCamera.cpp (modified) (2 diffs)
• SimuGps.cpp (modified) (2 diffs)
• SimuImu.cpp (modified) (2 diffs)
• SimuLaser.cpp (modified) (2 diffs)
• SimuUs.cpp (modified) (2 diffs)
• Srf08.cpp (modified) (1 diff)
• VrpnObject.cpp (modified) (2 diffs)
• XBldc.cpp (modified) (1 diff)

trunk/lib/FlairSensorActuator/src/AfroBldc.cpp

@@ -37 +37 @@
     : Bldc(parent, layout, name, motors_count) {
   pimpl_ = new AfroBldc_impl(this, layout, i2cport);
+  
+  SetIsReady(true);
 }
 

trunk/lib/FlairSensorActuator/src/BlCtrlV2.cpp

@@ -38 +38 @@
     : Bldc(parent, layout, name, motors_count) {
   pimpl_ = new BlCtrlV2_impl(this, layout, i2cport);
+  
+  SetIsReady(true);
 }
 

trunk/lib/FlairSensorActuator/src/BlCtrlV2_x4_speed.cpp

@@ -134 +134 @@
   delete desc;
   
+  SetIsReady(true);
+  
   /*
 

trunk/lib/FlairSensorActuator/src/Bldc.cpp

@@ -61 +61 @@
     : IODevice(parent, name) {
   pimpl_ = new Bldc_impl(this, motors_count);
+  
+  SetIsReady(true);
 }
 

trunk/lib/FlairSensorActuator/src/Camera.cpp

@@ -50 +50 @@
   setup_groupbox = new GroupBox(sensor_tab->NewRow(), name);
   setup_layout = new GridLayout(sensor_tab->NewRow(), "setup");
+  
 }
 

trunk/lib/FlairSensorActuator/src/EmulatedController.cpp

@@ -30 +30 @@
 EmulatedController::EmulatedController(string name,uint8_t priority) :
     TargetController(name,priority) {
+  SetIsReady(true);
 }
 

trunk/lib/FlairSensorActuator/src/Gx3_25_imu_impl.cpp

@@ -96 +96 @@
   SamplingSettings();
   GyrosBias();
+  self->SetIsReady(true);
   // RealignUpNorth(true,true);
 
@@ -265 +266 @@
     ssize_t written = 0;
 
-    Printf("Gx3_25_imu::gyros_bias: %s\n",
-           self->IODevice::ObjectName().c_str());
+    Printf("Gx3_25_imu::calibrating gyros, do not move imu\n");
 
     command[0] = 0xcd; // entete
@@ -296 +296 @@
     }
 
-    Printf("Gx3_25_imu::gyros_bias: %s ok\n",
-           self->IODevice::ObjectName().c_str());
+    Printf("Gx3_25_imu::calibration done\n");
 
   } else {

trunk/lib/FlairSensorActuator/src/HokuyoUTM30Lx.cpp

@@ -50 +50 @@
   this->serialport = serialport;
   serialport->SetRxTimeout(100000000);
+  
+  SetIsReady(true);
 }
 

trunk/lib/FlairSensorActuator/src/Mb800.cpp

@@ -33 +33 @@
   this->serialport = serialport;
   serialport->SetRxTimeout(100000000);
+  
+  SetIsReady(true);
 }
 

trunk/lib/FlairSensorActuator/src/Novatel.cpp

@@ -32 +32 @@
     : NmeaGps(name, NMEAFlags), Thread(getFrameworkManager(), name, priority) {
   this->serialport = serialport;
+  
+  SetIsReady(true);
 }
 

trunk/lib/FlairSensorActuator/src/Ps3Eye.cpp

@@ -27 +27 @@
                uint8_t priority)
     : V4LCamera( name, camera_index, 320, 240,
-                cvimage::Type::Format::YUYV, priority) {}
+                cvimage::Type::Format::YUYV, priority) {
+  SetIsReady(true);                  
+}
 
 Ps3Eye::~Ps3Eye() {}

trunk/lib/FlairSensorActuator/src/RadioReceiver.cpp

@@ -53 +53 @@
 
   AddDataToLog(output);
+  
+  SetIsReady(true);
 }
 

trunk/lib/FlairSensorActuator/src/SimuBldc.cpp

@@ -42 +42 @@
   GroupBox *groupbox = new GroupBox(layout->NewRow(), "simubldc");
   k = new DoubleSpinBox(groupbox->NewRow(), "k driver:", 0, 10000, 1);
+  
+  SetIsReady(true);
 }
 
@@ -58 +60 @@
 
   shmem->Write((char *)&values, motors_count * sizeof(float));
+  
+  SetIsReady(true);
 }
 

trunk/lib/FlairSensorActuator/src/SimuCamera.cpp

@@ -45 +45 @@
   dev_name << "simu_cam_" << dev_id;
   shmem = new SharedMem((Thread *)this, dev_name.str().c_str(), buf_size, SharedMem::Type::producerConsumer);
+  
+  SetIsReady(true);
 }
 
@@ -59 +61 @@
                         buf_size, SharedMem::Type::producerConsumer);
   shmemReadBuf=NULL;
+  
+  SetIsReady(true);
 }
 

trunk/lib/FlairSensorActuator/src/SimuGps.cpp

@@ -53 +53 @@
   shmem = new SharedMem((Thread *)this, dev_name.str().c_str(),
                         sizeof(gps_states_t));
+                        
+  SetIsReady(true);
 }
 
@@ -64 +66 @@
   shmem = new SharedMem((Thread *)this, dev_name.str().c_str(),
                         sizeof(gps_states_t));
+  
+  SetIsReady(true);
 }
 

trunk/lib/FlairSensorActuator/src/SimuImu.cpp

@@ -45 +45 @@
   shmem = new SharedMem((Thread *)this, dev_name.str().c_str(),
                         sizeof(imu_states_t));
+  SetIsReady(true);
 }
 
@@ -55 +56 @@
   shmem = new SharedMem((Thread *)this, dev_name.str().c_str(),
                         sizeof(imu_states_t));
+  SetIsReady(true);
 }
 

trunk/lib/FlairSensorActuator/src/SimuLaser.cpp

@@ -41 +41 @@
   dev_name << "simu_Laser_" << dev_id;
   shmem = new SharedMem((Thread *)this, dev_name.str().c_str(),
-                        360 * sizeof(float)); //****
+                        360 * sizeof(float));
+  SetIsReady(true);
 }
 
@@ -52 +53 @@
   shmem = new SharedMem((Thread *)this, dev_name.str().c_str(),
                         360 * sizeof(float));
+  SetIsReady(true);
 }
 

trunk/lib/FlairSensorActuator/src/SimuUs.cpp

@@ -41 +41 @@
   dev_name << "simu_us_" << dev_id;
   shmem = new SharedMem((Thread *)this, dev_name.str().c_str(), sizeof(float));
+
+  SetIsReady(true);
 }
 
@@ -50 +52 @@
   dev_name << "simu_us_" << dev_id;
   shmem = new SharedMem((Thread *)this, dev_name.str().c_str(), sizeof(float));
+  
+  SetIsReady(true);
 }
 

trunk/lib/FlairSensorActuator/src/Srf08.cpp

@@ -53 +53 @@
   SetRange();
   SetMaxGain();
+  
+  SetIsReady(true);
 }
 

trunk/lib/FlairSensorActuator/src/VrpnObject.cpp

@@ -35 +35 @@
   pimpl_ = new VrpnObject_impl(this, name, -1, tab);
   AddDataToLog(pimpl_->output);
+  
+  SetIsReady(true);
 }
 
@@ -43 +45 @@
   pimpl_ = new VrpnObject_impl(this, name, id, tab);
   AddDataToLog(pimpl_->output);
+  
+  SetIsReady(true);
 }
 

trunk/lib/FlairSensorActuator/src/XBldc.cpp

@@ -30 +30 @@
     : Bldc(parent, layout, name, 4) {
   pimpl_ = new XBldc_impl(this, i2cport);
+  
+  SetIsReady(true);
 }