mawei/MoreTore
1
0
Fork 0
mirror of https://github.com/MoreTore/openpilot.git synced 2026-08-07 01:06:01 +08:00
Code Issues Packages Projects Releases Wiki Activity

FrogPilot community - Display model path in map

Browse Source 
Co-Authored-By: pencilpusher <83676301+jakethesnake420@users.noreply.github.com>
This commit is contained in:
FrogAi
2024-06-04 11:57:28 -07:00
parent 40ccab9e1c
commit d1caa48911
2 changed files with 14 additions and 0 deletions
Download Patch File Download Diff File Expand all files Collapse all files
selfdrive/ui/qt/maps/map.cc
+12
View File
@@ -293,6 +293,18 @@ void MapWindow::updateState(const UIState &s) {
route_rcv_frame = sm.rcv_frame("navRoute");
updateDestinationMarker();
}
// Credit to jakethesnake420
if (loaded_once && (sm.rcv_frame("uiPlan") != model_rcv_frame)) {
auto locationd_location = sm["liveLocationKalman"].getLiveLocationKalman();
auto model_path = model_to_collection(locationd_location.getCalibratedOrientationECEF(), locationd_location.getPositionECEF(), sm["uiPlan"].getUiPlan().getPosition());
QMapLibre::Feature model_path_feature(QMapLibre::Feature::LineStringType, model_path, {}, {});
QVariantMap modelV2Path;
modelV2Path["type"] = "geojson";
modelV2Path["data"] = QVariant::fromValue<QMapLibre::Feature>(model_path_feature);
m_map->updateSource("modelPathSource", modelV2Path);
model_rcv_frame = sm.rcv_frame("uiPlan");
}
}
void MapWindow::setError(const QString &err_str) {
selfdrive/ui/qt/maps/map.h
+2
View File
@@ -82,6 +82,8 @@ private:
// FrogPilot variables
Params params;
uint64_t model_rcv_frame = 0;
private slots:
void updateState(const UIState &s);