Merge remote-tracking branch 'origin/s2025_summoning_planning' into s2025_summoning_webapp

Author: nmashchenko

.github/workflows/python-app.yml

@@ -0,0 +1,62 @@
+# This workflow will install Python dependencies, run tests and lint with a single version of Python
+# For more information see: https://docs.github.com/en/actions/automating-builds-and-tests/building-and-testing-python
+
+name: Python application
+
+on:
+  push:
+    branches: 
+    - '**'
+
+
+permissions:
+  contents: read
+
+jobs:
+  PEP-Guidelines:
+
+    runs-on: ubuntu-latest
+
+    steps:
+    - uses: actions/checkout@v3
+    - name: Set up Python 3.10
+      uses: actions/setup-python@v3
+      with:
+        python-version: "3.10"
+    - name: Install dependencies
+      run: |
+        python -m pip install --upgrade pip
+        pip install flake8 flake8-docstrings pep8-naming
+    - name: Lint with flake8
+      run: |
+        # stop the build if there are Python syntax errors or undefined names
+        flake8 ./GEMstack --count --select=E9,F63,F7,F82 --show-source --statistics --exclude=__init__.py || exit 1
+        # to enable more advanced checks on the repo, uncomment the lines below (There are around 3000 violations)
+        # flake8 ./GEMstack --ignore=D,C901,E402,E231 --count --max-complexity=10 --max-line-length=127 --statistics --exclude=__init__.py || exit 1
+        # if we want to enable documentation checks, uncomment the line below
+        # flake8 ./GEMstack --ignore=E128,E402,E501,F401 --docstring-convention pep257 --max-line-length=120 --exclude=__init__.py || exit 1
+      continue-on-error: false
+
+  Documentation:
+
+    runs-on: ubuntu-latest
+
+    steps:
+    - uses: actions/checkout@v3
+    - name: Set up Python 3.10
+      uses: actions/setup-python@v3
+      with:
+        python-version: "3.10"
+    - name: Install dependencies
+      run: |
+        python -m pip install --upgrade pip
+        pip install sphinx sphinx-rtd-theme
+    - name: Generate Documentation
+      run: |
+        # stop the build if there are Python syntax errors or undefined names
+        sphinx-build -b html docs docs/build
+    - name: Save Documentation as Artifact
+      uses: actions/upload-artifact@v4
+      with:
+        name: documentation
+        path: docs/build

.gitignore

@@ -165,3 +165,20 @@ cython_debug/
 #  and can be added to the global gitignore or merged into this file.  For a more nuclear
 #  option (not recommended) you can uncomment the following to ignore the entire idea folder.
 #.idea/
+
+# ZED run files
+**/*.run
+.vscode/
+setup/zed_sdk.run
+cuda/
+onedrive_config.json
+zed_sdk.run
+ZED_SDK_Ubuntu20_cuda11.8_v4.0.8.zstd.run
+ros.asc
+
+homework/yolov8n.pt
+homework/yolo11n.pt
+GEMstack/knowledge/detection/yolov8n.pt
+GEMstack/knowledge/detection/yolo11n.pt
+yolov8n.pt
+yolo11n.pt

GEMstack/knowledge/calibration/extrinsics.npz

@@ -1,7 +1,63 @@
-calibration_date: "2024-03-05"  # Date of calibration YYYY-MM-DD
-reference: rear_axle_center  # rear axle center
-rear_axle_height: 0.33      # height of rear axle center above flat ground
-gnss_location: [1.10,0,1.62] # meters, taken from https://github.com/hangcui1201/POLARIS_GEM_e2_Real/blob/main/vehicle_drivers/gem_gnss_control/scripts/gem_gnss_tracker_stanley_rtk.py.  Note conflict with pure pursuit location?
-gnss_yaw: 0.0 # radians
+T_frontcamera_vehicle:
+- - 0.04979815921110274
+  - -0.02889308605338095
+  - 0.998341277156963
+  - 0.6874899022540225
+- - -0.9986898492450907
+  - 0.010343220052680617
+  - 0.05011489006575621
+  - -0.006750728511462573
+- - -0.011774038000135968
+  - -0.9995289850272167
+  - -0.02834016107658961
+  - -0.07694233627246522
+- - 0.0
+  - 0.0
+  - 0.0
+  - 1.0
+T_toplidar_frontcamera:
+- - 0.029096143490519977
+  - -0.9995463314295703
+  - -0.007781115579835407
+  - -0.045768971801312515
+- - -0.005777780139254174
+  - 0.007616104089319731
+  - -0.999954305063568
+  - -0.3868171492765085
+- - 0.9995599190096819
+  - 0.02913977151915098
+  - -0.005553559684576381
+  - -0.6975440651652165
+- - 0.0
+  - 0.0
+  - 0.0
+  - 1.0
+T_toplidar_vehicle:
+- - 0.9995177984237671
+  - -0.020904183387756348
+  - 0.022959932684898376
+  - 0.0
+- - 0.020975051447749138
+  - 0.9997758865356445
+  - -0.0028501423075795174
+  - 0.0
+- - -0.0228952094912529
+  - 0.003330353880301118
+  - 0.9997323155403137
+  - 0.33000001311302185
+- - 0.0
+  - 0.0
+  - 0.0
+  - 1.0
+date: '2025-02-25 22:31:02.057447'
+calibration_type: absolute_vehicle_calibration
+gnss_location:
+- 1.1
+- 0
+- 1.62
+gnss_yaw: 0.0
+rear_axle_height: 0.33
+reference: rear_axle_center
+vehicle: gem_e4
 top_lidar: !include "gem_e4_ouster.yaml"
 front_camera: !include "gem_e4_oak.yaml"

GEMstack/knowledge/calibration/gem_e4.yaml

@@ -0,0 +1,7 @@
+{
+    "fx": 684.8333129882812,
+    "fy": 684.6096801757812,
+    "cx": 573.37109375,
+    "cy": 363.700927734375
+  }
+  

GEMstack/knowledge/calibration/intrinsic.json

@@ -44,11 +44,26 @@ components:
       inputs: [vehicle, roadgraph, mission]
       outputs: route
   - driving_logic:
-      inputs: all
+      inputs: 
       outputs: intent
+  - parking_component: # one way
+      inputs: all
+      outputs: mission_plan
+  - summon_component: # one way
+      inputs: all
+      outputs: route
+  - summoning_mission_planning:
+      inputs: all
+      outputs: mission_plan
+  - route_planning_component: # one way
+      inputs: all
+      outputs: route
   - motion_planning:
       inputs: all
       outputs: trajectory
   - trajectory_tracking:
       inputs: [vehicle, trajectory]
       outputs: 
+  - signaling:
+      inputs: [intent]
+      outputs:

GEMstack/knowledge/defaults/computation_graph.yaml

@@ -14,10 +14,10 @@ control:
     pure_pursuit:
         lookahead: 2.0
         lookahead_scale: 3.0
-        crosstrack_gain: 1.0
+        crosstrack_gain: 0.5 # default: 1
         desired_speed: trajectory
     longitudinal_control:
-        pid_p: 1.0
+        pid_p: 1.5
         pid_i: 0.1
         pid_d: 0.0
 

GEMstack/knowledge/defaults/current.yaml

@@ -0,0 +1,16 @@
+# arguments for BiRRT* algorithm
+# map boundary in meter
+map:
+    lower_x: -5 
+    upper_x: 20 
+    lower_y: -5
+    upper_y: 20
+# vehicle info 
+vehicle:
+    heading_limit: 0.5235987756  # pi/6 in radians
+    half_width: 0.8 # in meter
+# algorithm parameters
+rrt:
+    time_limit: 10 # in sec
+    step_size: 0.5 # length in meter for local planner to explore
+    search_r: 1.4 # radius in meter for rewiring

GEMstack/knowledge/defaults/rrt_param.yaml

@@ -0,0 +1 @@
+{"type": "Roadgraph", "data": {"frame": 0, "curves": {}, "lanes": {"0": {"type": 0, "surface": 0, "route_name": "", "left": {"type": 0, "segments": [[[-88.236129, 40.09275451039261, 0.0], [-88.235527, 40.09275451039261, 0.0]]], "crossable": true, "elevation": null, "height": null}, "right": {"type": 0, "segments": [[[-88.236129, 40.092727489607384, 0.0], [-88.235527, 40.092727489607384, 0.0]]], "crossable": true, "elevation": null, "height": null}, "center": null, "begin": null, "end": null}, "1": {"type": 0, "surface": 0, "route_name": "", "left": {"type": 0, "segments": [[[-88.235527, 40.09275451039261, 0.0], [-88.235527, 40.092805489607386, 0.0]]], "crossable": true, "elevation": null, "height": null}, "right": {"type": 0, "segments": [[[-88.235527, 40.09272748960739, 0.0], [-88.235527, 40.092832510392604, 0.0]]], "crossable": true, "elevation": null, "height": null}, "center": null, "begin": null, "end": null}, "2": {"type": 0, "surface": 0, "route_name": "", "left": {"type": 0, "segments": [[[-88.235527, 40.092805489607386, 0.0], [-88.236129, 40.092805489607386, 0.0]]], "crossable": true, "elevation": null, "height": null}, "right": {"type": 0, "segments": [[[-88.235527, 40.09283251039261, 0.0], [-88.236129, 40.09283251039261, 0.0]]], "crossable": true, "elevation": null, "height": null}, "center": null, "begin": null, "end": null}, "4": {"type": 0, "surface": 0, "route_name": "", "left": {"type": 0, "segments": [[[-88.236129, 40.092805489607386, 0.0], [-88.236129, 40.09275451039261, 0.0]]], "crossable": true, "elevation": null, "height": null}, "right": {"type": 0, "segments": [[[-88.236129, 40.092832510392604, 0.0], [-88.236129, 40.09272748960739, 0.0]]], "crossable": true, "elevation": null, "height": null}, "center": null, "begin": null, "end": null}}, "regions": {}, "signs": {}, "static_obstacles": {}, "connections": []}}