Changeset 15 in flair-src for trunk/lib/FlairSensorActuator/src/Novatel.cpp

Timestamp:

Apr 8, 2016, 3:40:57 PM (9 years ago)

Author:

Bayard Gildas

Message:

sources reformatted with flair-format-dir script

File:

• trunk/lib/FlairSensorActuator/src/Novatel.cpp (modified) (1 diff)

trunk/lib/FlairSensorActuator/src/Novatel.cpp

@@ -24 +24 @@
 using namespace flair::core;
 
-namespace flair
-{
-namespace sensor
-{
+namespace flair {
+namespace sensor {
 
-Novatel::Novatel(const FrameworkManager* parent,string name,SerialPort *serialport,Gps::NMEAFlags_t NMEAFlags,uint8_t priority) : Gps(parent,name,NMEAFlags), Thread(parent,name,priority)
-{
-    this->serialport=serialport;
+Novatel::Novatel(const FrameworkManager *parent, string name,
+                 SerialPort *serialport, Gps::NMEAFlags_t NMEAFlags,
+                 uint8_t priority)
+    : Gps(parent, name, NMEAFlags), Thread(parent, name, priority) {
+  this->serialport = serialport;
 }
 
-Novatel::~Novatel()
-{
-    SafeStop();
-    Join();
+Novatel::~Novatel() {
+  SafeStop();
+  Join();
 }
 
-void Novatel::Run(void)
-{
-    char response[200] = {0};
-    int size;
-    ssize_t written;
+void Novatel::Run(void) {
+  char response[200] = {0};
+  int size;
+  ssize_t written;
 
-    WarnUponSwitches(true);
+  WarnUponSwitches(true);
 
-    char to_send[]="log gpggalong ontime 0.05\n";
-    written=serialport->Write(to_send, sizeof(to_send));
-    if(written<0)
-    {
-        Thread::Err("erreur write (%s)\n",strerror(-written));
+  char to_send[] = "log gpggalong ontime 0.05\n";
+  written = serialport->Write(to_send, sizeof(to_send));
+  if (written < 0) {
+    Thread::Err("erreur write (%s)\n", strerror(-written));
+  }
+  char to_send2[] = "log gpvtg ontime 0.05\n";
+  written = serialport->Write(to_send2, sizeof(to_send2));
+  if (written < 0) {
+    Thread::Err("erreur write (%s)\n", strerror(-written));
+  }
+
+  Sync();
+
+  while (!ToBeStopped()) {
+    size = 0;
+    while (1) {
+      // ssize_t read = rt_dev_read(uart_fd, &response[size],1);
+      ssize_t Read = serialport->Read(&response[size], 1);
+      if (Read < 0) {
+        Thread::Err("erreur Read (%s)\n", strerror(-Read));
+      }
+      if (response[size] == 0x0a)
+        break;
+      size++;
     }
-    char to_send2[]="log gpvtg ontime 0.05\n";
-    written=serialport->Write(to_send2, sizeof(to_send2));
-    if(written<0)
-    {
-        Thread::Err("erreur write (%s)\n",strerror(-written));
-    }
+    size++;
+    parseFrame(response, size);
+  }
 
-    Sync();
-
-    while(!ToBeStopped())
-    {
-        size=0;
-        while(1)
-        {
-            //ssize_t read = rt_dev_read(uart_fd, &response[size],1);
-            ssize_t Read = serialport->Read(&response[size],1);
-            if(Read<0)
-            {
-                Thread::Err("erreur Read (%s)\n",strerror(-Read));
-            }
-            if(response[size]==0x0a) break;
-            size++;
-        }
-        size++;
-        parseFrame(response, size);
-    }
-
-    WarnUponSwitches(false);
+  WarnUponSwitches(false);
 }
 
-void Novatel::Sync(void)
-{
-    char data=0;
-    ssize_t Read = 0;
+void Novatel::Sync(void) {
+  char data = 0;
+  ssize_t Read = 0;
 
-    //attente fin trame
-    while(data!=0x0a)
-    {
-        Read = serialport->Read(&data,1);
-        if(Read<0)
-        {
-            Thread::Err("erreur Read (%s)\n",strerror(-Read));
-        }
+  // attente fin trame
+  while (data != 0x0a) {
+    Read = serialport->Read(&data, 1);
+    if (Read < 0) {
+      Thread::Err("erreur Read (%s)\n", strerror(-Read));
     }
+  }
 }