WebSVN – dashGPS – Diff – /trunk/src/display.cpp

 displayDial_t dial (display1, 96, 32, 32, 180);
 // debouncer for the button
 char buttonState;
 char buttonCount;
+char rmc_flag = 0;
+extern "C" uint8_t
+rmc_callback (uint8_t *data, uint16_t length)
+{
+  rmc_flag = 1;
+  HAL_GPIO_TogglePin (Green_LED_GPIO_Port, Green_LED_Pin);
+  return CDC_Transmit_FS (data, length);
+}
 extern "C" void
 cc_init ()
+{
   display1.reset ();
   display1.display ();
   memset (loc.time, '-', 6);
   // every time we receive GPRMC, forward the text line to the USB driver
-  setRmcCallback (&CDC_Transmit_FS);
+  setRmcCallback (&rmc_callback);
   // initialise IMU operations
   IMU.begin ();
+}
 char fontBuf[] = "01234567";
 extern "C" void
 cc_run (struct bmp280_dev *bmp, struct bmp280_dev *bmp2)
+{
-  display1.clearDisplay ();
-  dial.draw_scale (0, 360, 8, 1, 45);
-  while (1)
-    {
-      bool stat = updateLocation (&loc, &uc1);
+  bool stat = updateLocation (&loc, &uc1);
-      if (!stat)
-        break;
-      if (stat && loc.good)
-        {
-          heading = loc.heading;
-          // add in time * speed to give "distance"
-          if (loc.valid == 'A')
-            {
-              if (lastLocTime != 0)
-                {
-                  double delta = difftime (loc.utc, lastLocTime);
-                  // believe the speed .
-                  if (delta > 0 && delta < 2)
-                    {
-                      speedAvgSum += loc.speed * delta;
-                      speedAvgTime += delta;
-                      lastLocTime = loc.utc;
-                    }
-                  else
-                    lastLocTime = loc.utc;
-                }
-              else
-                {
-                  lastLocTime = loc.utc;
-                }
-            }
-        }
-      else
-        {
-          memset (loc.time, '-', 6);
-        }
-    }
-  // process button press
+  // process button press : done by polling loop
-  uint8_t const buttonLimit = 3;
+    uint8_t const buttonLimit = 3;
-  uint8_t newPush = HAL_GPIO_ReadPin ( encoder_push_GPIO_Port,
+    uint8_t newPush = HAL_GPIO_ReadPin ( encoder_push_GPIO_Port,
-  encoder_push_Pin);
+        encoder_push_Pin);
-  if (newPush == buttonState)
+    if (newPush == buttonState)
     buttonCount = 0;
-  else if (buttonCount < buttonLimit)
+    else if (buttonCount < buttonLimit)
     buttonCount++;
-  if (buttonCount == buttonLimit)
+    if (buttonCount == buttonLimit)
-    {
+      {
-      buttonState = newPush;
+        buttonState = newPush;
-      buttonCount = 0;
+        buttonCount = 0;
-      // if the button is held down , we set the average speed
+        // if the button is held down , we set the average speed
-      if (buttonState == GPIO_PIN_RESET)
+        if (buttonState == GPIO_PIN_RESET)
-        {
+          {
-          speedAvgSum = 0.0;
+            speedAvgSum = 0.0;
-          speedAvgTime = 0.0;
+            speedAvgTime = 0.0;
-        }
+          }
-    }
+      }
-  // update the display once per second
-  if (HAL_GetTick () > nextPosTime)
-    {
-      nextPosTime += 1000;
+  if(rmc_flag)
+  {
+    rmc_flag = 0;
+    display1.clearDisplay ();
+    dial.draw_scale (0, 360, 8, 1, 45);
+    if ( loc.good)
+      {
+        heading = loc.heading;
+        // add in time * speed to give "distance"
+        if (loc.valid == 'A')
+          {
+            if (lastLocTime != 0)
+              {
+                double delta = difftime (loc.utc, lastLocTime);
+                // believe the speed .
+                if (delta > 0 && delta < 2)
+                  {
+                    speedAvgSum += loc.speed * delta;
+                    speedAvgTime += delta;
+                    lastLocTime = loc.utc;
+                  }
+                else
+                lastLocTime = loc.utc;
+              }
+            else
+              {
+                lastLocTime = loc.utc;
+              }
+          }
+      }
+    else
+      {
+        memset (loc.time, '-', 6);
+      }
+    // update the display once per second
-      // slow down the output of ata
+        // slow down the output of ata
-      if (speedAvgTime > 0)
+        if (speedAvgTime > 0)
         speedAvg = (speedAvgSum / speedAvgTime) * KNOTS_TO_MPH;
-      else
+        else
         speedAvg = 0.0;
-      // print out the GMT time at the top of the screen
+        // print out the GMT time at the top of the screen
-      display1.gotoxy (0, 0);
+        display1.gotoxy (0, 0);
-      display1.printString (small_font, &loc.time[0], 2, WHITE);
+        display1.printString (small_font, &loc.time[0], 2, WHITE);
-      display1.printString (small_font, ":", 1, WHITE);
+        display1.printString (small_font, ":", 1, WHITE);
-      display1.printString (small_font, &loc.time[2], 2, WHITE);
+        display1.printString (small_font, &loc.time[2], 2, WHITE);
-      display1.printString (small_font, ":", 1, WHITE);
+        display1.printString (small_font, ":", 1, WHITE);
-      display1.printString (small_font, &loc.time[4], 2, WHITE);
+        display1.printString (small_font, &loc.time[4], 2, WHITE);
-      int dial_ang = heading + 180;
+        int dial_ang = heading + 180;
-      dial.draw_needle (dial_ang);
+        dial.draw_needle (dial_ang);
-      display1.gotoxy (70, 25);
+        display1.gotoxy (70, 25);
-      if (loc.valid == 'A')
+        if (loc.valid == 'A')
-        {
+          {
-          display1.fontDigits (large_font, 3, -1, heading);
+            display1.fontDigits (large_font, 3, -1, heading);
-        }
+          }
-      else
+        else
         display1.printString (large_font, "GPS?", 4, WHITE);
-      if (loc.valid == 'A')
+        if (loc.valid == 'A')
         speedMPH = loc.speed * KNOTS_TO_MPH;
-      else
+        else
         speedMPH = 0.0;
-      display1.gotoxy (0, 8);
+        display1.gotoxy (0, 8);
-      display1.fontDigits (large_font, 4,1, speedMPH * 10 );
+        display1.fontDigits (large_font, 4,1, speedMPH * 10 );
-      display1.printString (small_font, "c", 2, WHITE);
+        display1.printString (small_font, "c", 2, WHITE);
-      display1.gotoxy (0,24);
+        display1.gotoxy (0,24);
-      display1.fontDigits (large_font, 4, 1, speedAvg * 10);
+        display1.fontDigits (large_font, 4, 1, speedAvg * 10);
-      display1.printString (small_font, "av", 2, WHITE);
+        display1.printString (small_font, "av", 2, WHITE);
-      float x, y, z;
+        float x, y, z;
-      if (IMU.magneticFieldAvailable ())
+        if (IMU.magneticFieldAvailable ())
-        {
+          {
-          IMU.readMagneticField (x, y, z);
+            IMU.readMagneticField (x, y, z);
-        }
+          }
-      if (IMU.accelerationAvailable ())
+        if (IMU.accelerationAvailable ())
-        {
+          {
-          IMU.readAcceleration (x, y, z);
+            IMU.readAcceleration (x, y, z);
-        }
+          }
-      struct bmp280_uncomp_data ucomp_data, ucomp_data2;
+        struct bmp280_uncomp_data ucomp_data, ucomp_data2;
-      if (HAL_GetTick () - lastTick > 100)
+        if (HAL_GetTick () - lastTick > 100)
-        {
+          {
-          lastTick = HAL_GetTick ();
+            lastTick = HAL_GetTick ();
-          /* Reading the raw data from sensor */
+            /* Reading the raw data from sensor */
-          rslt = bmp280_get_uncomp_data (&ucomp_data, bmp);
+            rslt = bmp280_get_uncomp_data (&ucomp_data, bmp);
-          /* reading the raw data from the second sensor */
+            /* reading the raw data from the second sensor */
-          rslt2 = bmp280_get_uncomp_data (&ucomp_data2, bmp2);
+            rslt2 = bmp280_get_uncomp_data (&ucomp_data2, bmp2);
-          if (rslt2 == BMP280_OK)
+            if (rslt2 == BMP280_OK)
-            {
+              {
-              rslt2 = bmp280_get_comp_temp_32bit (&temp32_out,
+                rslt2 = bmp280_get_comp_temp_32bit (&temp32_out,
-                                                  ucomp_data2.uncomp_temp, bmp2);
+                    ucomp_data2.uncomp_temp, bmp2);
-            }
+              }
-              if (rslt == BMP280_OK)
+            if (rslt == BMP280_OK)
-                {
+              {
-                  /* Getting the 32 bit compensated temperature */
+                /* Getting the 32 bit compensated temperature */
-                  rslt = bmp280_get_comp_temp_32bit (&temp32,
+                rslt = bmp280_get_comp_temp_32bit (&temp32,
-                                                     ucomp_data.uncomp_temp,
+                    ucomp_data.uncomp_temp,
-                                                     bmp);
+                    bmp);
-                  rslt = bmp280_get_comp_pres_32bit (&pres32,
+                rslt = bmp280_get_comp_pres_32bit (&pres32,
-                                                     ucomp_data.uncomp_press,
+                    ucomp_data.uncomp_press,
-                                                     bmp);
+                    bmp);
 #if defined USB_DEVICE
-/*
+                /*
-          *  $--XDR,a,x.x,a,c--c, ..... *hh<CR><LF> \\
+                 *  $--XDR,a,x.x,a,c--c, ..... *hh<CR><LF> \\
               Field Number:
 ) Transducer Type
 ) Measurement Data
 ) Units of measurement
 ) Name of transducer
-              x) More of the same
+                 x) More of the same
-              n) Checksum
+                 n) Checksum
-              Example:
+                 Example:
-              $IIXDR,C,19.52,C,TempAir*19
+                 $IIXDR,C,19.52,C,TempAir*19
-              $IIXDR,P,1.02481,B,Barometer*29
+                 $IIXDR,P,1.02481,B,Barometer*29
-              Currently, OpenCPN recognizes the following transducers:
+                 Currently, OpenCPN recognizes the following transducers:
-          Measured Value | Transducer Type | Measured Data   | Unit of measure | Transducer Name
+                 Measured Value | Transducer Type | Measured Data   | Unit of measure | Transducer Name
-          ------------------------------------------------------------------------------------------------------
+                 ------------------------------------------------------------------------------------------------------
-          barometric     | "P" pressure    | 0.8..1.1 or 800..1100           | "B" bar         | "Barometer"
+                 barometric     | "P" pressure    | 0.8..1.1 or 800..1100           | "B" bar         | "Barometer"
-          air temperature| "C" temperature |   2 decimals                    | "C" celsius     | "TempAir" or "ENV_OUTAIR_T"
+                 air temperature| "C" temperature |   2 decimals                    | "C" celsius     | "TempAir" or "ENV_OUTAIR_T"
-          pitch          | "A" angle       |-180..0 nose down 0..180 nose up | "D" degrees     | "PTCH" or "PITCH"
+                 pitch          | "A" angle       |-180..0 nose down 0..180 nose up | "D" degrees     | "PTCH" or "PITCH"
-          rolling        | "A" angle       |-180..0 L         0..180 R       | "D" degrees     | "ROLL"
+                 rolling        | "A" angle       |-180..0 L         0..180 R       | "D" degrees     | "ROLL"
-          water temp     | "C" temperature |   2 decimals                    | "C" celsius     | "ENV_WATER_T"
+                 water temp     | "C" temperature |   2 decimals                    | "C" celsius     | "ENV_WATER_T"
-*/
+                 */
-          // compile a logger message over USB
+                // compile a logger message over USB
-           char buffer[200];
+                char buffer[200];
-           int cnt = small_sprintf(buffer,"$MJXDR,C,%ld.%02ld,C,AirTemp,P,%01ld.%05ld,B,AirPres",temp32/100,temp32%100,pres32/100000,pres32%100000);
+                int cnt = small_sprintf(buffer,"$MJXDR,C,%ld.%02ld,C,AirTemp,P,%01ld.%05ld,B,AirPres",temp32/100,temp32%100,pres32/100000,pres32%100000);
-           uint8_t sum=0;
+                uint8_t sum=0;
-           for(int i=1; i<cnt; i++)
+                for(int i=1; i<cnt; i++)
-             sum += buffer[i];
+                sum += buffer[i];
-           cnt+= small_sprintf(buffer+cnt,"*%02X\n",sum);
+                cnt+= small_sprintf(buffer+cnt,"*%02X\n",sum);
-           CDC_Transmit_FS(reinterpret_cast<uint8_t*>(&buffer[0]),cnt);
+                CDC_Transmit_FS(reinterpret_cast<uint8_t*>(&buffer[0]),cnt);
 #endif
-            }
+              }
-        }
+          }
-      display1.gotoxy (0,40);
+        display1.gotoxy (0,40);
-      display1.fontDigits (large_font, 4, 1, temp32_out / 10, WHITE);
+        display1.fontDigits (large_font, 4, 1, temp32_out / 10, WHITE);
-      display1.printString (small_font, "C", 1, WHITE);
+        display1.printString (small_font, "C", 1, WHITE);
-      display1.gotoxy (0, 56);
-      display1.fontDigits (small_font, 3, 1, temp32 / 10, WHITE);
-      display1.printString (small_font, "C", 2, WHITE);
+        display1.gotoxy (0, 56);
-      display1.fontDigits (small_font, 4, -1, pres32 / 100, WHITE);
+        display1.fontDigits (small_font, 3, 1, temp32 / 10, WHITE);
-      display1.printString (small_font, "mb ", 2, WHITE);
+        display1.printString (small_font, "C", 2, WHITE);
+        display1.fontDigits (small_font, 4, -1, pres32 / 100, WHITE);
-      display1.display ();
+        display1.printString (small_font, "mb ", 2, WHITE);
+        display1.display ();
-    }
+      }
-}
+    HAL_Delay(10);
+  }

Subversion Repositories dashGPS

(root)/trunk/src/display.cpp – Rev 26 → 27