Changeset 55 in flair-src for trunk/lib/FlairSensorActuator/src/NmeaGps.cpp

Timestamp:

Jul 28, 2016, 5:55:31 PM (5 years ago)

Author:

Sanahuja Guillaume

Message:

simu gps

File:

• trunk/lib/FlairSensorActuator/src/NmeaGps.cpp (modified) (11 diffs)

trunk/lib/FlairSensorActuator/src/NmeaGps.cpp

@@ -47 +47 @@
   nmea_zero_INFO(&info);
   nmea_parser_init(&parser);
-  alt_ref = 0;
+  altRef = 0;
 
   if ((NMEAFlags & GGA) == 0) {
@@ -63 +63 @@
 
   // station sol
-  main_tab = new Tab(parent->GetTabWidget(), name);
-  tab = new TabWidget(main_tab->NewRow(), name);
-  sensor_tab = new Tab(tab, "Reglages");
-  GroupBox *reglages_groupbox = new GroupBox(sensor_tab->NewRow(), name);
-  button_ref = new PushButton(reglages_groupbox->NewRow(), "set ref");
-  nb_sat_label = new Label(reglages_groupbox->NewRow(), "nb_sat");
-  fix_label = new Label(reglages_groupbox->LastRowLastCol(), "fix");
+  mainTab = new Tab(parent->GetTabWidget(), name);
+  tab = new TabWidget(mainTab->NewRow(), name);
+  sensorTab = new Tab(tab, "Setup");
+  setupGroupbox = new GroupBox(sensorTab->NewRow(), name);
+  buttonRef = new PushButton(setupGroupbox->NewRow(), "set ref");
+  nbSatLabel = new Label(setupGroupbox->NewRow(), "nb_sat");
+  fixLabel = new Label(setupGroupbox->LastRowLastCol(), "fix");
 
   position = new GeoCoordinate((IODevice *)this, "position", 0, 0, 0);
 
-  take_ref = false;
+  takeRef = false;
 
   gpsData = new GpsData(this);
   AddDataToLog(gpsData);
 
-  nb_sat_label->SetText("nb_sat: %i", gpsData->GetNumberOfSatellites());
-  fix_label->SetText("fix: %i", gpsData->GetFixQuality());
+  nbSatLabel->SetText("number of satellies: %i", gpsData->GetNumberOfSatellites());
+  fixLabel->SetText("fix quality: %i", gpsData->GetFixQuality());
+}
+
+NmeaGps::NmeaGps(const IODevice *parent, std::string name) : IODevice(parent, name) {
+  gpsData = new GpsData(this);
+  mainTab = NULL;
+  tab = NULL;
+  sensorTab = NULL;
 }
 
 NmeaGps::~NmeaGps() {
-  nmea_parser_destroy(&parser);
-  delete main_tab;
-}
+  if (mainTab != NULL) {
+    nmea_parser_destroy(&parser);
+    delete mainTab;
+  }
+}
+
+GroupBox *NmeaGps::GetGroupBox(void) const { return setupGroupbox; }
 
 const GpsData *NmeaGps::GetDatas(void) const {
@@ -96 +107 @@
 
 void NmeaGps::UseDefaultPlot(void) {
-  plot_tab = new Tab(tab, "Mesures");
-
-  if ((NMEAFlags & GGA) != 0) {
-    e_plot = new DataPlot1D(plot_tab->NewRow(), "e", -10, 10);
-    e_plot->AddCurve(gpsData->Element(GpsData::East));
-    n_plot = new DataPlot1D(plot_tab->LastRowLastCol(), "n", -10, 10);
-    n_plot->AddCurve(gpsData->Element(GpsData::North));
-    u_plot = new DataPlot1D(plot_tab->LastRowLastCol(), "u", -10, 10);
-    u_plot->AddCurve(gpsData->Element(GpsData::Up));
+  plotTab = new Tab(tab, "Mesures");
+
+  if ((NMEAFlags & GGA) != 0) {
+    ePlot = new DataPlot1D(plotTab->NewRow(), "e", -10, 10);
+    ePlot->AddCurve(gpsData->Element(GpsData::East));
+    nPlot = new DataPlot1D(plotTab->LastRowLastCol(), "n", -10, 10);
+    nPlot->AddCurve(gpsData->Element(GpsData::North));
+    uPlot = new DataPlot1D(plotTab->LastRowLastCol(), "u", -10, 10);
+    uPlot->AddCurve(gpsData->Element(GpsData::Up));
   }
   if ((NMEAFlags & VTG) != 0) {
-    ve_plot = new DataPlot1D(plot_tab->NewRow(), "ve", -10, 10);
-    ve_plot->AddCurve(gpsData->Element(GpsData::EastVelocity));
-    vn_plot = new DataPlot1D(plot_tab->LastRowLastCol(), "vn", -10, 10);
-    vn_plot->AddCurve(gpsData->Element(GpsData::NorthVelocity));
+    vePlot = new DataPlot1D(plotTab->NewRow(), "ve", -10, 10);
+    vePlot->AddCurve(gpsData->Element(GpsData::EastVelocity));
+    vnPlot = new DataPlot1D(plotTab->LastRowLastCol(), "vn", -10, 10);
+    vnPlot->AddCurve(gpsData->Element(GpsData::NorthVelocity));
   }
 
@@ -120 +131 @@
 DataPlot1D *NmeaGps::EPlot(void) const {
   if ((NMEAFlags & GGA) != 0) {
-    return e_plot;
+    return ePlot;
   } else {
     Err("GGA sentence not requested\n");
@@ -129 +140 @@
 DataPlot1D *NmeaGps::NPlot(void) const {
   if ((NMEAFlags & GGA) != 0) {
-    return n_plot;
+    return nPlot;
   } else {
     Err("GGA sentence not requested\n");
@@ -138 +149 @@
 DataPlot1D *NmeaGps::UPlot(void) const {
   if ((NMEAFlags & GGA) != 0) {
-    return u_plot;
+    return uPlot;
   } else {
     Err("GGA sentence not requested\n");
@@ -147 +158 @@
 DataPlot1D *NmeaGps::VEPlot(void) const {
   if ((NMEAFlags & VTG) != 0) {
-    return ve_plot;
+    return vePlot;
   } else {
     Err("GGA sentence not requested\n");
@@ -156 +167 @@
 DataPlot1D *NmeaGps::VNPlot(void) const {
   if ((NMEAFlags & VTG) != 0) {
-    return vn_plot;
-  } else {
-    Err("GGA sentence not requested\n");
-    return NULL;
-  }
-}
-
-Layout *NmeaGps::GetLayout(void) const { return sensor_tab; }
-
-Tab *NmeaGps::GetPlotTab(void) const { return plot_tab; }
+    return vnPlot;
+  } else {
+    Err("GGA sentence not requested\n");
+    return NULL;
+  }
+}
+
+Layout *NmeaGps::GetLayout(void) const { return sensorTab; }
+
+Tab *NmeaGps::GetPlotTab(void) const { return plotTab; }
 
 TabWidget *NmeaGps::GetTab(void) const { return tab; }
 
-void NmeaGps::SetRef(void) { take_ref = true; }
+void NmeaGps::SetRef(void) { takeRef = true; }
 
 void NmeaGps::GetEnu(Vector3D *point) {
@@ -197 +208 @@
     if (gpsData->GetFixQuality() != (GpsData::FixQuality_t)pack.sig) {
       gpsData->SetFixQuality((GpsData::FixQuality_t)pack.sig);
-      fix_label->SetText("fix: %i", pack.sig);
+      fixLabel->SetText("fix: %i", pack.sig);
     }
     if (gpsData->GetNumberOfSatellites() != pack.satinuse) {
       gpsData->SetNumberOfSatellites(pack.satinuse) ;
-      nb_sat_label->SetText("nb_sat: %i", pack.satinuse);
+      nbSatLabel->SetText("nb_sat: %i", pack.satinuse);
     }
     gpsData->ReleaseMutex();
@@ -209 +220 @@
                              info.elv);
 
-    if ((info.sig == 2 && alt_ref == 0) || button_ref->Clicked() == true ||
-        take_ref == true) {
+    if ((info.sig == 2 && altRef == 0) || buttonRef->Clicked() == true ||
+        takeRef == true) {
       Printf("prise pos ref\n");
-      lat_ref = pos.lat;
-      long_ref = pos.lon;
-      alt_ref = info.elv;
-      take_ref = false;
+      latRef = pos.lat;
+      longRef = pos.lon;
+      altRef = info.elv;
+      takeRef = false;
     }
     // if(alt_ref!=0)
@@ -222 +233 @@
       double e, n, u;
       Geographique_2_ECEF(pos.lon, pos.lat, info.elv, x, y, z);
-      ECEF_2_ENU(x, y, z, e, n, u, long_ref, lat_ref, alt_ref);
+      ECEF_2_ENU(x, y, z, e, n, u, longRef, latRef, altRef);
       // Printf("lon:%f lat:%f elv:%f\n",pos.lon,pos.lat,info.elv);