From ab74c44a34150fc8f6fb44b1e65cb80f4d493346 Mon Sep 17 00:00:00 2001
From: FrogAi <91348155+FrogAi@users.noreply.github.com>
Date: Tue, 27 Feb 2024 16:34:47 -0700
Subject: [PATCH] Navigate on Chill Mode

Co-Authored-By: garrettpall <76917194+garrettpall@users.noreply.github.com>
---
 common/params.cc                           | 1 +
 selfdrive/frogpilot/ui/control_settings.cc | 1 +
 selfdrive/frogpilot/ui/control_settings.h  | 2 +-
 selfdrive/modeld/modeld.py                 | 2 +-
 4 files changed, 4 insertions(+), 2 deletions(-)

diff --git a/common/params.cc b/common/params.cc
index 2b6962c..6eb55c2 100644
--- a/common/params.cc
+++ b/common/params.cc
@@ -298,6 +298,7 @@ std::unordered_map<std::string, uint32_t> keys = {
     {"MTSCEnabled", PERSISTENT},
     {"MTSCLimit", PERSISTENT},
     {"MuteOverheated", PERSISTENT},
+    {"NavChill", PERSISTENT},
     {"NoLogging", PERSISTENT},
     {"NoUploads", PERSISTENT},
     {"PathEdgeWidth", PERSISTENT},
diff --git a/selfdrive/frogpilot/ui/control_settings.cc b/selfdrive/frogpilot/ui/control_settings.cc
index 6f56e64..d074283 100644
--- a/selfdrive/frogpilot/ui/control_settings.cc
+++ b/selfdrive/frogpilot/ui/control_settings.cc
@@ -44,6 +44,7 @@ FrogPilotControlsPanel::FrogPilotControlsPanel(SettingsWindow *parent) : FrogPil
     {"QOLControls", "Quality of Life", "Miscellaneous quality of life changes to improve your overall openpilot experience.", "../frogpilot/assets/toggle_icons/quality_of_life.png"},
     {"DisableOnroadUploads", "Disable Onroad Uploads", "Prevent large data uploads when onroad.", ""},
     {"HigherBitrate", "Higher Bitrate Recording", "Increases the quality of the footage uploaded to comma connect.", ""},
+    {"NavChill", "Navigate on Chill Mode", "Allows cars without longitudinal support to navigate. Allows navigation without experimental mode.", ""},
     {"ReverseCruise", "Reverse Cruise Increase", "Reverses the 'long press' functionality when increasing the max set speed. Useful to increase the max speed quickly.", ""},
   };
 
diff --git a/selfdrive/frogpilot/ui/control_settings.h b/selfdrive/frogpilot/ui/control_settings.h
index c69a8d8..dfa27ff 100644
--- a/selfdrive/frogpilot/ui/control_settings.h
+++ b/selfdrive/frogpilot/ui/control_settings.h
@@ -44,7 +44,7 @@ private:
   std::set<QString> lateralTuneKeys = {"ForceAutoTune"};
   std::set<QString> longitudinalTuneKeys = {"AccelerationProfile", "DecelerationProfile", "AggressiveAcceleration", "StoppingDistance"};
   std::set<QString> mtscKeys = {"DisableMTSCSmoothing", "MTSCAggressiveness", "MTSCCurvatureCheck", "MTSCLimit"};
-  std::set<QString> qolKeys = {"DisableOnroadUploads", "HigherBitrate", "ReverseCruise"};
+  std::set<QString> qolKeys = {"DisableOnroadUploads", "HigherBitrate", "NavChill", "ReverseCruise"};
   std::set<QString> speedLimitControllerKeys = {};
   std::set<QString> speedLimitControllerControlsKeys = {};
   std::set<QString> speedLimitControllerQOLKeys = {};
diff --git a/selfdrive/modeld/modeld.py b/selfdrive/modeld/modeld.py
index 9d13f68..ffba1df 100755
--- a/selfdrive/modeld/modeld.py
+++ b/selfdrive/modeld/modeld.py
@@ -246,7 +246,7 @@ def main(demo=False):
     # Enable/disable nav features
     timestamp_llk = sm["navModel"].locationMonoTime
     nav_valid = sm.valid["navModel"] # and (nanos_since_boot() - timestamp_llk < 1e9)
-    nav_enabled = nav_valid and params.get_bool("ExperimentalMode")
+    nav_enabled = nav_valid and (params.get_bool("ExperimentalMode") or params.get_bool("NavChill"))
 
     if not nav_enabled:
       nav_features[:] = 0