added profiling into main loop

GPSSpeedMultiCore.ino

@@ -12,6 +12,7 @@
 #define GPS_UPDATE_FREQUENCY 10  //GPS update frequency per sec
 #define DEBOUNCE_DELAY 250       //time in ms
 #define MIDDLE_SCREEN_BRIGHTNESS 5
+//#define PROFILE true 
 
 //GPS
 SFE_UBLOX_GPS myGPS;
@@ -23,18 +24,27 @@ std::atomic_int gpsFixType(0);
 //screen
 Adafruit_AlphaNum4 disp = Adafruit_AlphaNum4();
 unsigned long timeOfLastFix = 0UL;
+unsigned long timer = millis();
+bool setInitBrightness = false;
+unsigned long brightnessTimer = millis();
 
 //button
 volatile bool buttonPushed = false;
 volatile int ScreenBrightnessUser = 15;
 volatile int screenBrightnessCurrent = ScreenBrightnessUser;
 volatile unsigned long lastButtonPush = 0UL;
+volatile bool manualBrightness = false;
+
+//profiler
+int runCounter = 0;
+unsigned long profileTimer = millis();
 
 
 void chageBrightness() {
   if (millis() - lastButtonPush > DEBOUNCE_DELAY) {
     buttonPushed = true;
     lastButtonPush = millis();
+    manualBrightness = true;
   }
 }
 
@@ -57,15 +67,27 @@ void connectGPS() {  //need to do this everytime the GPS turns back on
   myGPS.setAutoPVT(true);
   myGPS.setUART1Output(COM_TYPE_UBX);                  //Set the UART1 port to output UBX only (turn off NMEA noise)
   myGPS.setNavigationFrequency(GPS_UPDATE_FREQUENCY);  //set frequency of updates to 10/sec
-  myGPS.setDynamicModel(DYN_MODEL_AUTOMOTIVE);         //set dynamic model of GPS to automotive to more accutate results
+  //myGPS.setDynamicModel(DYN_MODEL_AUTOMOTIVE);         //set dynamic model of GPS to automotive to more accutate results
 }
 
 bool setStartBrightness() {
-  while (!(myGPS.getFixType() > 0)) {} //wait here untill gps gets a fix
-  double az, el;
-  setTime(myGPS.getHour(),myGPS.getMinute(),myGPS.getSecond(),myGPS.getDay(),myGPS.getMonth(),myGPS.getYear());
+  double az = 0;
+  double el = 0;
+  int hour = myGPS.getHour();
+  int min = myGPS.getMinute();
+  int sec = myGPS.getSecond();
+  int day = myGPS.getDay();
+  int month = myGPS.getMonth();
+  int year = myGPS.getYear();
+  setTime(hour, min, sec, day, month, year);
   time_t timeUtc = now();
-  calcHorizontalCoordinates(timeUtc,myGPS.getLatitude(),myGPS.getLongitude(),az,el);
+  double lat = myGPS.getLatitude();
+  lat = lat / 10000000;
+  double lng = myGPS.getLongitude();
+  lng = lng / 10000000;
+  calcHorizontalCoordinates(timeUtc, lat, lng, az, el);
+
+  //el = el - 180;
 
   if (el > SUNRISESET_STD_ALTITUDE) {
     screenBrightnessCurrent = 15;
@@ -74,6 +96,7 @@ bool setStartBrightness() {
   } else if (el < CIVIL_DAWNDUSK_STD_ALTITUDE) {
     screenBrightnessCurrent = 0;
   }
+  ScreenBrightnessUser = screenBrightnessCurrent;
   disp.setBrightness(screenBrightnessCurrent);
   return true;
 }
@@ -97,10 +120,17 @@ void setup1() {
   Serial1.setRX(1);
   Serial1.setTX(0);
   connectGPS();
-  setStartBrightness();
+  //setStartBrightness();
 }
 
 void loop() {
+  //set init brightness
+  if ((!setInitBrightness && gpsFixType.load() > 0) || ((!manualBrightness && millis() > brightnessTimer + 6000) && gpsFixType.load() > 0)) {  //fire every minute
+    setStartBrightness();
+    setInitBrightness = true;
+    brightnessTimer = millis();
+  }
+
   //change brightness
   if (buttonPushed == true) {
     if (ScreenBrightnessUser == 15) {
@@ -159,7 +189,20 @@ void loop() {
   }
   disp.writeDisplay();
   rp2040.wdt_reset();  //rest watchdog timer
+
+  #if PROFILE 
+  //profiling
+  runCounter++;
+
+  if(millis() > profileTimer + 1000){
+    Serial.println(runCounter);
+    runCounter=0;
+    profileTimer=millis();
   }
+  #endif
+
+}
+
 
 void loop1() {
   //myGPS.getPVT(GPS_WAIT_TIME);