From cf39f1e70e727279d8d89476e19c8604ac81ed60 Mon Sep 17 00:00:00 2001 From: Ankit Agarwal Date: Wed, 3 Jun 2026 03:58:00 +0000 Subject: [PATCH 01/68] [SymForce] Update dependency pins GitOrigin-RevId: 30ba631fedfccf6e2efd588ed4b69f369b7773f7 --- requirements/dev_py310.txt | 20 ++++++++++---------- requirements/dev_py311.txt | 20 ++++++++++---------- requirements/dev_py312.txt | 20 ++++++++++---------- requirements/dev_py313.txt | 20 ++++++++++---------- requirements/dev_py314.txt | 20 ++++++++++---------- requirements/dev_py39.txt | 12 ++++++------ 6 files changed, 56 insertions(+), 56 deletions(-) diff --git a/requirements/dev_py310.txt b/requirements/dev_py310.txt index 4d1424a2..31663438 100644 --- a/requirements/dev_py310.txt +++ b/requirements/dev_py310.txt @@ -65,7 +65,7 @@ furo==2025.12.19 # via symforce (pyproject.toml) graphviz==0.21 # via symforce (pyproject.toml) -idna==3.11 +idna==3.15 # via requests imagesize==1.4.1 # via sphinx @@ -126,7 +126,7 @@ mdit-py-plugins==0.5.0 # via myst-parser mdurl==0.1.2 # via markdown-it-py -mistune==3.2.0 +mistune==3.2.1 # via nbconvert mpmath==1.3.0 # via sympy @@ -140,7 +140,7 @@ narwhals==2.16.0 # via plotly nbclient==0.10.4 # via nbconvert -nbconvert==7.17.0 +nbconvert==7.17.1 # via nbsphinx nbformat==5.10.4 # via @@ -185,9 +185,9 @@ pathspec==1.0.4 # via mypy pexpect==4.9.0 # via ipython -pillow==12.1.1 +pillow==12.2.0 # via matplotlib -pip==26.0.1 +pip==26.1 # via symforce (pyproject.toml) platformdirs==4.5.1 # via jupyter-core @@ -205,7 +205,7 @@ pure-eval==0.2.3 # via stack-data pybind11-stubgen==2.5.5 # via symforce (pyproject.toml) -pygments==2.19.2 +pygments==2.20.0 # via # accessible-pygments # furo @@ -231,7 +231,7 @@ referencing==0.37.0 # via # jsonschema # jsonschema-specifications -requests==2.32.5 +requests==2.33.0 # via sphinx rpds-py==0.30.0 # via @@ -302,7 +302,7 @@ tomli==2.4.0 # mypy # setuptools-scm # sphinx -tornado==6.5.4 +tornado==6.5.5 # via # ipykernel # jupyter-client @@ -336,11 +336,11 @@ typing-extensions==4.15.0 # sortedcontainers-stubs tzdata==2025.3 # via pandas -urllib3==2.6.3 +urllib3==2.7.0 # via # requests # types-requests -uv==0.10.2 +uv==0.11.15 # via symforce (pyproject.toml) wcwidth==0.6.0 # via prompt-toolkit diff --git a/requirements/dev_py311.txt b/requirements/dev_py311.txt index c19b3b61..3e26d400 100644 --- a/requirements/dev_py311.txt +++ b/requirements/dev_py311.txt @@ -63,7 +63,7 @@ furo==2025.12.19 # via symforce (pyproject.toml) graphviz==0.21 # via symforce (pyproject.toml) -idna==3.11 +idna==3.15 # via requests imagesize==1.4.1 # via sphinx @@ -126,7 +126,7 @@ mdit-py-plugins==0.5.0 # via myst-parser mdurl==0.1.2 # via markdown-it-py -mistune==3.2.0 +mistune==3.2.1 # via nbconvert mpmath==1.3.0 # via sympy @@ -140,7 +140,7 @@ narwhals==2.16.0 # via plotly nbclient==0.10.4 # via nbconvert -nbconvert==7.17.0 +nbconvert==7.17.1 # via nbsphinx nbformat==5.10.4 # via @@ -185,9 +185,9 @@ pathspec==1.0.4 # via mypy pexpect==4.9.0 # via ipython -pillow==12.1.1 +pillow==12.2.0 # via matplotlib -pip==26.0.1 +pip==26.1 # via symforce (pyproject.toml) platformdirs==4.5.1 # via jupyter-core @@ -205,7 +205,7 @@ pure-eval==0.2.3 # via stack-data pybind11-stubgen==2.5.5 # via symforce (pyproject.toml) -pygments==2.19.2 +pygments==2.20.0 # via # accessible-pygments # furo @@ -230,7 +230,7 @@ referencing==0.37.0 # via # jsonschema # jsonschema-specifications -requests==2.32.5 +requests==2.33.0 # via sphinx roman-numerals==4.1.0 # via sphinx @@ -298,7 +298,7 @@ sympy==1.13.3 # via symforce (pyproject.toml) tinycss2==1.4.0 # via bleach -tornado==6.5.4 +tornado==6.5.5 # via # ipykernel # jupyter-client @@ -328,11 +328,11 @@ typing-extensions==4.15.0 # mypy # referencing # sortedcontainers-stubs -urllib3==2.6.3 +urllib3==2.7.0 # via # requests # types-requests -uv==0.10.2 +uv==0.11.15 # via symforce (pyproject.toml) wcwidth==0.6.0 # via prompt-toolkit diff --git a/requirements/dev_py312.txt b/requirements/dev_py312.txt index 5eefe842..ceac8cf3 100644 --- a/requirements/dev_py312.txt +++ b/requirements/dev_py312.txt @@ -63,7 +63,7 @@ furo==2025.12.19 # via symforce (pyproject.toml) graphviz==0.21 # via symforce (pyproject.toml) -idna==3.11 +idna==3.15 # via requests imagesize==1.4.1 # via sphinx @@ -126,7 +126,7 @@ mdit-py-plugins==0.5.0 # via myst-parser mdurl==0.1.2 # via markdown-it-py -mistune==3.2.0 +mistune==3.2.1 # via nbconvert mpmath==1.3.0 # via sympy @@ -140,7 +140,7 @@ narwhals==2.16.0 # via plotly nbclient==0.10.4 # via nbconvert -nbconvert==7.17.0 +nbconvert==7.17.1 # via nbsphinx nbformat==5.10.4 # via @@ -185,9 +185,9 @@ pathspec==1.0.4 # via mypy pexpect==4.9.0 # via ipython -pillow==12.1.1 +pillow==12.2.0 # via matplotlib -pip==26.0.1 +pip==26.1 # via symforce (pyproject.toml) platformdirs==4.5.1 # via jupyter-core @@ -205,7 +205,7 @@ pure-eval==0.2.3 # via stack-data pybind11-stubgen==2.5.5 # via symforce (pyproject.toml) -pygments==2.19.2 +pygments==2.20.0 # via # accessible-pygments # furo @@ -230,7 +230,7 @@ referencing==0.37.0 # via # jsonschema # jsonschema-specifications -requests==2.32.5 +requests==2.33.0 # via sphinx roman-numerals==4.1.0 # via sphinx @@ -298,7 +298,7 @@ sympy==1.13.3 # via symforce (pyproject.toml) tinycss2==1.4.0 # via bleach -tornado==6.5.4 +tornado==6.5.5 # via # ipykernel # jupyter-client @@ -327,11 +327,11 @@ typing-extensions==4.15.0 # mypy # referencing # sortedcontainers-stubs -urllib3==2.6.3 +urllib3==2.7.0 # via # requests # types-requests -uv==0.10.2 +uv==0.11.15 # via symforce (pyproject.toml) wcwidth==0.6.0 # via prompt-toolkit diff --git a/requirements/dev_py313.txt b/requirements/dev_py313.txt index eae9764c..96163aa7 100644 --- a/requirements/dev_py313.txt +++ b/requirements/dev_py313.txt @@ -63,7 +63,7 @@ furo==2025.12.19 # via symforce (pyproject.toml) graphviz==0.21 # via symforce (pyproject.toml) -idna==3.11 +idna==3.15 # via requests imagesize==1.4.1 # via sphinx @@ -126,7 +126,7 @@ mdit-py-plugins==0.5.0 # via myst-parser mdurl==0.1.2 # via markdown-it-py -mistune==3.2.0 +mistune==3.2.1 # via nbconvert mpmath==1.3.0 # via sympy @@ -140,7 +140,7 @@ narwhals==2.16.0 # via plotly nbclient==0.10.4 # via nbconvert -nbconvert==7.17.0 +nbconvert==7.17.1 # via nbsphinx nbformat==5.10.4 # via @@ -185,9 +185,9 @@ pathspec==1.0.4 # via mypy pexpect==4.9.0 # via ipython -pillow==12.1.1 +pillow==12.2.0 # via matplotlib -pip==26.0.1 +pip==26.1 # via symforce (pyproject.toml) platformdirs==4.5.1 # via jupyter-core @@ -205,7 +205,7 @@ pure-eval==0.2.3 # via stack-data pybind11-stubgen==2.5.5 # via symforce (pyproject.toml) -pygments==2.19.2 +pygments==2.20.0 # via # accessible-pygments # furo @@ -230,7 +230,7 @@ referencing==0.37.0 # via # jsonschema # jsonschema-specifications -requests==2.32.5 +requests==2.33.0 # via sphinx roman-numerals==4.1.0 # via sphinx @@ -298,7 +298,7 @@ sympy==1.13.3 # via symforce (pyproject.toml) tinycss2==1.4.0 # via bleach -tornado==6.5.4 +tornado==6.5.5 # via # ipykernel # jupyter-client @@ -326,11 +326,11 @@ typing-extensions==4.15.0 # beautifulsoup4 # mypy # sortedcontainers-stubs -urllib3==2.6.3 +urllib3==2.7.0 # via # requests # types-requests -uv==0.10.2 +uv==0.11.15 # via symforce (pyproject.toml) wcwidth==0.6.0 # via prompt-toolkit diff --git a/requirements/dev_py314.txt b/requirements/dev_py314.txt index e6c56159..6b3430ec 100644 --- a/requirements/dev_py314.txt +++ b/requirements/dev_py314.txt @@ -63,7 +63,7 @@ furo==2025.12.19 # via symforce (pyproject.toml) graphviz==0.21 # via symforce (pyproject.toml) -idna==3.11 +idna==3.15 # via requests imagesize==1.4.1 # via sphinx @@ -126,7 +126,7 @@ mdit-py-plugins==0.5.0 # via myst-parser mdurl==0.1.2 # via markdown-it-py -mistune==3.2.0 +mistune==3.2.1 # via nbconvert mpmath==1.3.0 # via sympy @@ -140,7 +140,7 @@ narwhals==2.16.0 # via plotly nbclient==0.10.4 # via nbconvert -nbconvert==7.17.0 +nbconvert==7.17.1 # via nbsphinx nbformat==5.10.4 # via @@ -185,9 +185,9 @@ pathspec==1.0.4 # via mypy pexpect==4.9.0 # via ipython -pillow==12.1.1 +pillow==12.2.0 # via matplotlib -pip==26.0.1 +pip==26.1 # via symforce (pyproject.toml) platformdirs==4.5.1 # via jupyter-core @@ -205,7 +205,7 @@ pure-eval==0.2.3 # via stack-data pybind11-stubgen==2.5.5 # via symforce (pyproject.toml) -pygments==2.19.2 +pygments==2.20.0 # via # accessible-pygments # furo @@ -232,7 +232,7 @@ referencing==0.37.0 # via # jsonschema # jsonschema-specifications -requests==2.32.5 +requests==2.33.0 # via sphinx roman-numerals==4.1.0 # via sphinx @@ -300,7 +300,7 @@ sympy==1.13.3 # via symforce (pyproject.toml) tinycss2==1.4.0 # via bleach -tornado==6.5.4 +tornado==6.5.5 # via # ipykernel # jupyter-client @@ -330,11 +330,11 @@ typing-extensions==4.15.0 # sortedcontainers-stubs tzdata==2026.2 # via pandas -urllib3==2.6.3 +urllib3==2.7.0 # via # requests # types-requests -uv==0.10.2 +uv==0.11.15 # via symforce (pyproject.toml) wcwidth==0.6.0 # via prompt-toolkit diff --git a/requirements/dev_py39.txt b/requirements/dev_py39.txt index 5333ea0b..77bbf920 100644 --- a/requirements/dev_py39.txt +++ b/requirements/dev_py39.txt @@ -65,7 +65,7 @@ furo==2025.12.19 # via symforce (pyproject.toml) graphviz==0.21 # via symforce (pyproject.toml) -idna==3.11 +idna==3.15 # via requests imagesize==1.4.1 # via sphinx @@ -133,7 +133,7 @@ mdit-py-plugins==0.4.2 # via myst-parser mdurl==0.1.2 # via markdown-it-py -mistune==3.2.0 +mistune==3.2.1 # via nbconvert mpmath==1.3.0 # via sympy @@ -147,7 +147,7 @@ narwhals==2.16.0 # via plotly nbclient==0.10.2 # via nbconvert -nbconvert==7.17.0 +nbconvert==7.17.1 # via nbsphinx nbformat==5.10.4 # via @@ -212,7 +212,7 @@ pure-eval==0.2.3 # via stack-data pybind11-stubgen==2.5.5 # via symforce (pyproject.toml) -pygments==2.19.2 +pygments==2.20.0 # via # accessible-pygments # furo @@ -309,7 +309,7 @@ tomli==2.4.0 # mypy # setuptools-scm # sphinx -tornado==6.5.4 +tornado==6.5.5 # via # ipykernel # jupyter-client @@ -348,7 +348,7 @@ urllib3==2.6.3 # via # requests # types-requests -uv==0.10.2 +uv==0.11.15 # via symforce (pyproject.toml) wcwidth==0.6.0 # via prompt-toolkit From 83e3355493da567bf155992c5742e857b0130b4e Mon Sep 17 00:00:00 2001 From: Ankit Agarwal Date: Thu, 4 Jun 2026 05:06:46 +0000 Subject: [PATCH 02/68] [SymForce] Drop Python 3.9 support - Drop Python 3.9 support from symforce; minimum is now Python 3.10 - Python 3.9 reached EOL and security-patched packages (pip>=26.1, urllib3>=2.7.0, requests>=2.33.0) require Python >=3.10, making it impossible to resolve dependabot alerts while supporting py39 - No code changes to use new features, so you could still build SymForce from source on py3.9. This is unsupported though and will not continue to be checked. GitOrigin-RevId: 5886f72eadd864069fd6d87e160c5b57aab6dc53 --- .github/workflows/build_wheels.yml | 4 +- .github/workflows/ci.yml | 6 +- .github/workflows/docs.yml | 2 +- CMakeLists.txt | 2 +- README.md | 4 +- docs/development.rst | 2 +- pyproject.toml | 3 +- requirements/build_py39.txt | 34 --- requirements/dev_py39.txt | 364 -------------------------- test/symforce_requirements_test.py | 5 - third_party/skymarshal/pyproject.toml | 2 +- 11 files changed, 12 insertions(+), 416 deletions(-) delete mode 100644 requirements/build_py39.txt delete mode 100644 requirements/dev_py39.txt diff --git a/.github/workflows/build_wheels.yml b/.github/workflows/build_wheels.yml index 599b4330..0300fbf9 100644 --- a/.github/workflows/build_wheels.yml +++ b/.github/workflows/build_wheels.yml @@ -44,7 +44,7 @@ jobs: - deploy_target: 14.0 runner: macos-14 arch: arm64 - python-version: [cp39, cp310, cp311, cp312, cp313, cp314] + python-version: [cp310, cp311, cp312, cp313, cp314] steps: - name: Checkout @@ -89,7 +89,7 @@ jobs: fail-fast: false matrix: os: [ubuntu-latest] - python-version: [cp39, cp310, cp311, cp312, cp313, cp314] + python-version: [cp310, cp311, cp312, cp313, cp314] steps: - name: Checkout diff --git a/.github/workflows/ci.yml b/.github/workflows/ci.yml index 89d21c16..97713cb9 100644 --- a/.github/workflows/ci.yml +++ b/.github/workflows/ci.yml @@ -16,7 +16,7 @@ jobs: fail-fast: false matrix: os: [ubuntu-24.04] - python: ["3.9", "3.10", "3.11", "3.12", "3.13", "3.14"] + python: ["3.10", "3.11", "3.12", "3.13", "3.14"] compiler: # Newest gcc on 24.04 - C: gcc-14 @@ -29,7 +29,7 @@ jobs: include: # gcc 9 (Oldest gcc available on Ubuntu 22.04) - os: ubuntu-22.04 - python: "3.9" + python: "3.10" compiler: C: gcc-9 CXX: g++-9 @@ -45,7 +45,7 @@ jobs: warning_options: "-Wall;-Wextra;-Wno-dangling-reference;-Wno-array-bounds;-Werror;-DSYM_VALUES_DISALLOW_FROM_STORAGE_NON_EIGEN_TYPES" # Clang 11 (Oldest clang available on Ubuntu 22.04) - os: ubuntu-22.04 - python: "3.9" + python: "3.10" compiler: C: clang-11 CXX: clang++-11 diff --git a/.github/workflows/docs.yml b/.github/workflows/docs.yml index 44b3fc45..ced5d392 100644 --- a/.github/workflows/docs.yml +++ b/.github/workflows/docs.yml @@ -31,7 +31,7 @@ jobs: - uses: actions/setup-python@v6 with: - python-version: "3.9" + python-version: "3.10" - name: Install python dependencies run: | diff --git a/CMakeLists.txt b/CMakeLists.txt index d1573f8c..d25d2e3c 100644 --- a/CMakeLists.txt +++ b/CMakeLists.txt @@ -4,7 +4,7 @@ # ---------------------------------------------------------------------------- # NOTE(aaron): This will use NEW policies up to CMake 4.0; this should -# be the maximum tested CMake version, matching requirements/dev_py39.txt +# be the maximum tested CMake version, matching requirements/dev_py310.txt cmake_minimum_required(VERSION 3.19...4.0) project(symforce) diff --git a/README.md b/README.md index 48d5dadd..51d2d606 100644 --- a/README.md +++ b/README.md @@ -11,7 +11,7 @@ Documentation Source Code Issues -Python 3.9 | 3.10 | 3.11 | 3.12 +Python 3.10 | 3.11 | 3.12 C++17 PyPI Apache License @@ -540,7 +540,7 @@ To learn more, visit the SymForce tutorials [here](https://symforce.org/#guides) For best results, you should build from the [latest tagged release](https://github.com/symforce-org/symforce/releases/latest). You can also build from `main`, or from another branch, but everything is less guaranteed to work. -SymForce requires Python 3.9 or later. The build is currently tested on Linux and macOS, SymForce on Windows is untested (see [#145](https://github.com/symforce-org/symforce/issues/145)). We strongly suggest creating a virtual python environment. +SymForce requires Python 3.10 or later. The build is currently tested on Linux and macOS, SymForce on Windows is untested (see [#145](https://github.com/symforce-org/symforce/issues/145)). We strongly suggest creating a virtual python environment. Install the `gmp` package with one of: ```bash diff --git a/docs/development.rst b/docs/development.rst index 139a99cb..f2a0c429 100644 --- a/docs/development.rst +++ b/docs/development.rst @@ -14,7 +14,7 @@ See the `module reference `_ for the core package structure. ************************************************* Build ************************************************* -SymForce is primarily written in Python and C++, and is Python 3.9+ and C++17+ compatible. The build +SymForce is primarily written in Python and C++, and is Python 3.10+ and C++17+ compatible. The build system is CMake for the C++ components, and optionally pip / setuptools on top for Python packaging. See the Build section on the `Homepage `_ for build instructions. diff --git a/pyproject.toml b/pyproject.toml index bc56070d..a027a53a 100644 --- a/pyproject.toml +++ b/pyproject.toml @@ -29,7 +29,6 @@ classifiers = [ "Topic :: Software Development :: Libraries :: Python Modules", "Topic :: Education :: Computer Aided Instruction (CAI)", "Programming Language :: Python", - "Programming Language :: Python :: 3.9", "Programming Language :: Python :: 3.10", "Programming Language :: Python :: 3.11", "Programming Language :: Python :: 3.12", @@ -40,7 +39,7 @@ classifiers = [ "License :: OSI Approved :: Apache Software License", "Operating System :: OS Independent", ] -requires-python = ">=3.9" +requires-python = ">=3.10" dynamic = ["version", "readme", "dependencies", "optional-dependencies"] [project.urls] diff --git a/requirements/build_py39.txt b/requirements/build_py39.txt deleted file mode 100644 index 88033641..00000000 --- a/requirements/build_py39.txt +++ /dev/null @@ -1,34 +0,0 @@ -# This file was autogenerated by uv via the following command: -# python test/symforce_requirements_test.py --update -clang-format - # via symforce (pyproject.toml) -cmake - # via symforce (pyproject.toml) -cython - # via symforce (pyproject.toml) -graphviz - # via symforce (pyproject.toml) -jinja2 - # via symforce (pyproject.toml) -numpy - # via symforce (pyproject.toml) -pip - # via symforce (pyproject.toml) -ruff - # via symforce (pyproject.toml) -scipy - # via symforce (pyproject.toml) -setuptools - # via symforce (pyproject.toml) -setuptools-scm - # via symforce (pyproject.toml) -file:./third_party/skymarshal - # via symforce (pyproject.toml) -sortedcontainers - # via symforce (pyproject.toml) -file:./gen/python - # via symforce (pyproject.toml) -sympy - # via symforce (pyproject.toml) -wheel - # via symforce (pyproject.toml) diff --git a/requirements/dev_py39.txt b/requirements/dev_py39.txt deleted file mode 100644 index 77bbf920..00000000 --- a/requirements/dev_py39.txt +++ /dev/null @@ -1,364 +0,0 @@ -# This file was autogenerated by uv via the following command: -# python test/symforce_requirements_test.py --update -accessible-pygments==0.0.5 - # via furo -alabaster==0.7.16 - # via sphinx -argh==0.31.3 - # via - # symforce (pyproject.toml) - # skymarshal -asttokens==3.0.1 - # via stack-data -attrs==25.4.0 - # via - # jsonschema - # referencing -babel==2.18.0 - # via sphinx -beautifulsoup4==4.14.3 - # via - # furo - # nbconvert -bleach==6.2.0 - # via nbconvert -breathe==4.36.0 - # via symforce (pyproject.toml) -certifi==2026.1.4 - # via requests -charset-normalizer==3.4.4 - # via requests -clang-format==21.1.2 - # via symforce (pyproject.toml) -cmake==4.2.1 - # via symforce (pyproject.toml) -comm==0.2.3 - # via ipykernel -contourpy==1.3.0 - # via matplotlib -coverage==7.10.7 - # via symforce (pyproject.toml) -cycler==0.12.1 - # via matplotlib -cython==3.0.12 - # via symforce (pyproject.toml) -debugpy==1.8.20 - # via ipykernel -decorator==5.2.1 - # via ipython -defusedxml==0.7.1 - # via nbconvert -docutils==0.21.2 - # via - # myst-parser - # nbsphinx - # sphinx -exceptiongroup==1.3.1 - # via ipython -executing==2.2.1 - # via stack-data -fastjsonschema==2.21.2 - # via nbformat -fonttools==4.60.2 - # via matplotlib -furo==2025.12.19 - # via symforce (pyproject.toml) -graphviz==0.21 - # via symforce (pyproject.toml) -idna==3.15 - # via requests -imagesize==1.4.1 - # via sphinx -importlib-metadata==8.7.1 - # via - # jupyter-client - # nbconvert - # sphinx -importlib-resources==6.5.2 - # via matplotlib -ipykernel==6.31.0 - # via symforce (pyproject.toml) -ipython==8.18.1 - # via ipykernel -ipython-genutils==0.2.0 - # via symforce (pyproject.toml) -jedi==0.19.2 - # via ipython -jinja2==3.1.6 - # via - # symforce (pyproject.toml) - # myst-parser - # nbconvert - # nbsphinx - # skymarshal - # sphinx -jsonschema==4.25.1 - # via nbformat -jsonschema-specifications==2025.9.1 - # via jsonschema -jupyter-client==8.6.3 - # via - # ipykernel - # nbclient -jupyter-core==5.8.1 - # via - # ipykernel - # jupyter-client - # nbclient - # nbconvert - # nbformat -jupyterlab-pygments==0.3.0 - # via nbconvert -kiwisolver==1.4.7 - # via matplotlib -librt==0.7.8 - # via mypy -llvmlite==0.43.0 - # via numba -markdown-it-py==3.0.0 - # via - # mdit-py-plugins - # myst-parser -markupsafe==3.0.3 - # via - # jinja2 - # nbconvert -matplotlib==3.9.4 - # via symforce (pyproject.toml) -matplotlib-inline==0.2.1 - # via - # ipykernel - # ipython -mdit-py-plugins==0.4.2 - # via myst-parser -mdurl==0.1.2 - # via markdown-it-py -mistune==3.2.1 - # via nbconvert -mpmath==1.3.0 - # via sympy -mypy==1.19.1 - # via symforce (pyproject.toml) -mypy-extensions==1.1.0 - # via mypy -myst-parser==3.0.1 - # via symforce (pyproject.toml) -narwhals==2.16.0 - # via plotly -nbclient==0.10.2 - # via nbconvert -nbconvert==7.17.1 - # via nbsphinx -nbformat==5.10.4 - # via - # nbclient - # nbconvert - # nbsphinx - # nbstripout -nbsphinx==0.9.8 - # via symforce (pyproject.toml) -nbstripout==0.8.2 - # via symforce (pyproject.toml) -nest-asyncio==1.6.0 - # via ipykernel -numba==0.60.0 - # via symforce (pyproject.toml) -numpy==1.26.4 - # via - # symforce (pyproject.toml) - # contourpy - # matplotlib - # numba - # pandas - # scipy - # skymarshal - # symforce-sym -packaging==26.0 - # via - # ipykernel - # matplotlib - # nbconvert - # plotly - # setuptools-scm - # sphinx - # wheel -pandas==2.3.3 - # via symforce (pyproject.toml) -pandocfilters==1.5.1 - # via nbconvert -parso==0.8.6 - # via jedi -pathspec==1.0.4 - # via mypy -pexpect==4.9.0 - # via ipython -pillow==11.3.0 - # via matplotlib -pip==26.0.1 - # via symforce (pyproject.toml) -platformdirs==4.4.0 - # via jupyter-core -plotly==6.5.2 - # via symforce (pyproject.toml) -ply==3.11 - # via skymarshal -prompt-toolkit==3.0.52 - # via ipython -psutil==7.2.2 - # via ipykernel -ptyprocess==0.7.0 - # via pexpect -pure-eval==0.2.3 - # via stack-data -pybind11-stubgen==2.5.5 - # via symforce (pyproject.toml) -pygments==2.20.0 - # via - # accessible-pygments - # furo - # ipython - # nbconvert - # sphinx -pyparsing==3.3.2 - # via matplotlib -python-dateutil==2.9.0.post0 - # via - # jupyter-client - # matplotlib - # pandas -pytz==2025.2 - # via pandas -pyyaml==6.0.3 - # via myst-parser -pyzmq==27.1.0 - # via - # ipykernel - # jupyter-client -referencing==0.36.2 - # via - # jsonschema - # jsonschema-specifications -requests==2.32.5 - # via sphinx -rpds-py==0.27.1 - # via - # jsonschema - # referencing -ruff==0.9.10 - # via symforce (pyproject.toml) -scipy==1.13.1 - # via symforce (pyproject.toml) -setuptools==82.0.0 - # via - # symforce (pyproject.toml) - # setuptools-scm -setuptools-scm==9.2.2 - # via symforce (pyproject.toml) -six==1.17.0 - # via python-dateutil -file:./third_party/skymarshal - # via symforce (pyproject.toml) -snowballstemmer==3.0.1 - # via sphinx -sortedcontainers==2.4.0 - # via - # symforce (pyproject.toml) - # sortedcontainers-stubs -sortedcontainers-stubs==2.4.3 - # via symforce (pyproject.toml) -soupsieve==2.8.3 - # via beautifulsoup4 -sphinx==7.4.7 - # via - # symforce (pyproject.toml) - # breathe - # furo - # myst-parser - # nbsphinx - # sphinx-basic-ng - # sphinx-copybutton - # sphinxext-opengraph -sphinx-basic-ng==1.0.0b2 - # via furo -sphinx-copybutton==0.5.2 - # via symforce (pyproject.toml) -sphinxcontrib-applehelp==2.0.0 - # via sphinx -sphinxcontrib-devhelp==2.0.0 - # via sphinx -sphinxcontrib-htmlhelp==2.1.0 - # via sphinx -sphinxcontrib-jsmath==1.0.1 - # via sphinx -sphinxcontrib-qthelp==2.0.0 - # via sphinx -sphinxcontrib-serializinghtml==2.0.0 - # via sphinx -sphinxext-opengraph==0.13.0 - # via symforce (pyproject.toml) -stack-data==0.6.3 - # via ipython -file:./gen/python - # via symforce (pyproject.toml) -sympy==1.13.3 - # via symforce (pyproject.toml) -tinycss2==1.4.0 - # via bleach -tomli==2.4.0 - # via - # mypy - # setuptools-scm - # sphinx -tornado==6.5.5 - # via - # ipykernel - # jupyter-client -traitlets==5.14.3 - # via - # ipykernel - # ipython - # jupyter-client - # jupyter-core - # matplotlib-inline - # nbclient - # nbconvert - # nbformat - # nbsphinx -types-jinja2==2.11.9 - # via symforce (pyproject.toml) -types-markupsafe==1.1.10 - # via types-jinja2 -types-requests==2.32.4.20260107 - # via symforce (pyproject.toml) -types-setuptools==81.0.0.20260209 - # via symforce (pyproject.toml) -typing-extensions==4.15.0 - # via - # beautifulsoup4 - # exceptiongroup - # ipython - # mistune - # mypy - # referencing - # setuptools-scm - # sortedcontainers-stubs -tzdata==2025.3 - # via pandas -urllib3==2.6.3 - # via - # requests - # types-requests -uv==0.11.15 - # via symforce (pyproject.toml) -wcwidth==0.6.0 - # via prompt-toolkit -webencodings==0.5.1 - # via - # bleach - # tinycss2 -wheel==0.46.3 - # via symforce (pyproject.toml) -zipp==3.23.0 - # via - # importlib-metadata - # importlib-resources diff --git a/test/symforce_requirements_test.py b/test/symforce_requirements_test.py index 4998eea0..97bd48d5 100644 --- a/test/symforce_requirements_test.py +++ b/test/symforce_requirements_test.py @@ -174,11 +174,6 @@ def check_requirements_for_version(self, version: int) -> None: self.check_dev_requirements_for_version(version) self.check_build_requirements_for_version(version) - @requires_source_build - @sympy_only - def test_requirements_py39(self) -> None: - self.check_requirements_for_version(9) - @requires_source_build @sympy_only def test_requirements_py310(self) -> None: diff --git a/third_party/skymarshal/pyproject.toml b/third_party/skymarshal/pyproject.toml index ec7f0d76..c4861c4b 100644 --- a/third_party/skymarshal/pyproject.toml +++ b/third_party/skymarshal/pyproject.toml @@ -17,7 +17,7 @@ classifiers = [ "Topic :: Software Development :: Libraries :: Python Modules", "Operating System :: OS Independent", ] -requires-python = ">=3.9" +requires-python = ">=3.10" dependencies = ["argh", "jinja2", "numpy", "ply"] dynamic = ["version"] From 89e440d43756f8b019f3522b73972fbe369ba7f0 Mon Sep 17 00:00:00 2001 From: Tord Date: Fri, 12 Jun 2026 05:57:48 +0000 Subject: [PATCH 03/68] [SymForce-External] [Caspar] Minor fix: Export CASPAR_MIN_ARCH and fix CUDA architecture list in Caspar template [Caspar] Minor fix: Export CASPAR_MIN_ARCH and fix CUDA architecture list in Caspar template CASPAR_MIN_ARCH was previously a local CMake variable, invisible to parent projects consuming Caspar via FetchContent. This change makes it a CACHE INTERNAL variable so downstream consumers (e.g. COLMAP) can read it after FetchContent_MakeAvailable(caspar) without hardcoding the value. Also fixes the CMAKE_CUDA_ARCHITECTURES list: the previous 75 80 86 89 75-virtual generated PTX for all four architectures and emitted compute_75 twice. The corrected list 75 80-real 86-real 89-real generates SASS for all and PTX only from sm_75, matching the stated intent. Closes symforce-org/symforce#463 GitOrigin-RevId: bc4a9a1f02b41ec4b804bfdd5021e88d2bad1ee9 --- .../caspar/source/templates/buildfiles/CMakeLists.txt.jinja | 4 +++- 1 file changed, 3 insertions(+), 1 deletion(-) diff --git a/symforce/caspar/source/templates/buildfiles/CMakeLists.txt.jinja b/symforce/caspar/source/templates/buildfiles/CMakeLists.txt.jinja index c7b1c6eb..1f89d62c 100644 --- a/symforce/caspar/source/templates/buildfiles/CMakeLists.txt.jinja +++ b/symforce/caspar/source/templates/buildfiles/CMakeLists.txt.jinja @@ -10,9 +10,11 @@ endif() project(caspar_library LANGUAGES CXX CUDA) +set(CASPAR_MIN_ARCH 75 CACHE INTERNAL "Minimum CUDA arch required by Caspar") + # SASS for Turing/Ampere/Ada (sm_75–89) + PTX fallback for forward JIT-compatibility. sm_75 minimum required by cooperative_groups::reduce. if(NOT DEFINED CMAKE_CUDA_ARCHITECTURES) - set(CMAKE_CUDA_ARCHITECTURES 75 80 86 89 75-virtual) + set(CMAKE_CUDA_ARCHITECTURES ${CASPAR_MIN_ARCH} 80-real 86-real 89-real) endif() find_package(CUDAToolkit REQUIRED) From ecf0ae5183ca4e121dcc870a0fac02a64c208118 Mon Sep 17 00:00:00 2001 From: Jerry Date: Wed, 24 Jun 2026 07:47:29 +0000 Subject: [PATCH 04/68] skymarshal: Precompute recursive lcmtype hash at codegen time Move the recursive _get_hash_recursive / _computeHash algorithm out of each language template and onto Struct.compute_recursive_hash in syntax_tree.py. Templates now render the precomputed integer literal returned by the AST. Cross-package types are resolved via JSON files that thread {full_name -> hash_hex} through skymarshal via --hash-info-out / --hash-deps-info. GitOrigin-RevId: 4bff1b98a159fd7f5e9c28a36159690aba8ef244 --- CMakeLists.txt | 1 + symforce/codegen/codegen.py | 11 ++++- symforce/codegen/codegen_util.py | 38 +++++++++++++--- symforce/codegen/types_package_codegen.py | 3 +- symforce/path_util.py | 23 ++++++++++ symforce/util.py | 7 ++- .../lcmtypes/codegen_cpp_test/constants_t.hpp | 3 +- .../lcmtypes/codegen_cpp_test/states_t.hpp | 7 +-- .../codegen_cpp_test/values_vec_t.hpp | 9 +--- .../lcmtypes/codegen_cpp_test/_constants_t.py | 4 +- .../lcmtypes/codegen_cpp_test/_states_t.py | 5 +-- .../codegen_cpp_test/_values_vec_t.py | 5 +-- .../lcmtypes/codegen_test/my_dataclass_t.hpp | 7 +-- .../lcmtypes/codegen_test/_my_dataclass_t.py | 5 +-- .../constants_t.hpp | 3 +- .../states_t.hpp | 7 +-- .../values_vec_t.hpp | 9 +--- .../_constants_t.py | 4 +- .../_states_t.py | 5 +-- .../_values_vec_t.py | 5 +-- .../inputs_constants_t.hpp | 3 +- .../inputs_states_t.hpp | 7 +-- .../codegen_multi_function_test/inputs_t.hpp | 15 +------ .../outputs_1_t.hpp | 10 +---- .../outputs_2_t.hpp | 3 +- .../values_vec_t.hpp | 9 +--- .../_inputs_constants_t.py | 4 +- .../_inputs_states_t.py | 5 +-- .../codegen_multi_function_test/_inputs_t.py | 5 +-- .../_outputs_1_t.py | 5 +-- .../_outputs_2_t.py | 4 +- .../_values_vec_t.py | 5 +-- .../codegen_python_test/constants_t.hpp | 3 +- .../lcmtypes/codegen_python_test/states_t.hpp | 7 +-- .../codegen_python_test/values_vec_t.hpp | 9 +--- .../codegen_python_test/_constants_t.py | 4 +- .../lcmtypes/codegen_python_test/_states_t.py | 5 +-- .../codegen_python_test/_values_vec_t.py | 5 +-- .../cpp/lcmtypes/sym/d_out_t.hpp | 3 +- .../cpp/lcmtypes/sym/d_t.hpp | 7 +-- .../python/lcmtypes/sym/_d_out_t.py | 4 +- .../python/lcmtypes/sym/_d_t.py | 5 +-- .../lcmtypes/codegen_test/my_dataclass_t.hpp | 7 +-- .../lcmtypes/codegen_test/_my_dataclass_t.py | 5 +-- .../cpp/lcmtypes/sym/d_out_t.hpp | 3 +- .../cpp/lcmtypes/sym/d_t.hpp | 7 +-- .../python/lcmtypes/sym/_d_out_t.py | 4 +- .../python/lcmtypes/sym/_d_t.py | 5 +-- test/symforce_types_codegen_test.py | 19 ++++++++ .../cpp/lcmtypes/eigen_lcm/Matrix24d.hpp | 3 +- .../cpp/lcmtypes/eigen_lcm/Matrix2d.hpp | 3 +- .../cpp/lcmtypes/eigen_lcm/Matrix2f.hpp | 3 +- .../cpp/lcmtypes/eigen_lcm/Matrix2i.hpp | 3 +- .../cpp/lcmtypes/eigen_lcm/Matrix34d.hpp | 3 +- .../cpp/lcmtypes/eigen_lcm/Matrix3d.hpp | 3 +- .../cpp/lcmtypes/eigen_lcm/Matrix3f.hpp | 3 +- .../cpp/lcmtypes/eigen_lcm/Matrix3i.hpp | 3 +- .../cpp/lcmtypes/eigen_lcm/Matrix43f.hpp | 3 +- .../cpp/lcmtypes/eigen_lcm/Matrix4d.hpp | 3 +- .../cpp/lcmtypes/eigen_lcm/Matrix4f.hpp | 3 +- .../cpp/lcmtypes/eigen_lcm/Matrix4i.hpp | 3 +- .../cpp/lcmtypes/eigen_lcm/Matrix54d.hpp | 3 +- .../cpp/lcmtypes/eigen_lcm/Matrix68f.hpp | 3 +- .../cpp/lcmtypes/eigen_lcm/MatrixXd.hpp | 3 +- .../cpp/lcmtypes/eigen_lcm/MatrixXf.hpp | 3 +- .../cpp/lcmtypes/eigen_lcm/MatrixXi.hpp | 3 +- .../cpp/lcmtypes/eigen_lcm/Quaterniond.hpp | 3 +- .../cpp/lcmtypes/eigen_lcm/Quaternionf.hpp | 3 +- .../lcmtypes/eigen_lcm/SymmetricMatrix2d.hpp | 3 +- .../lcmtypes/eigen_lcm/SymmetricMatrix2f.hpp | 3 +- .../lcmtypes/eigen_lcm/SymmetricMatrix3d.hpp | 3 +- .../lcmtypes/eigen_lcm/SymmetricMatrix3f.hpp | 3 +- .../lcmtypes/eigen_lcm/SymmetricMatrix4d.hpp | 3 +- .../lcmtypes/eigen_lcm/SymmetricMatrix4f.hpp | 3 +- .../lcmtypes/eigen_lcm/SymmetricMatrixXd.hpp | 3 +- .../lcmtypes/eigen_lcm/SymmetricMatrixXf.hpp | 3 +- .../cpp/lcmtypes/eigen_lcm/Vector1d.hpp | 3 +- .../cpp/lcmtypes/eigen_lcm/Vector1f.hpp | 3 +- .../cpp/lcmtypes/eigen_lcm/Vector1i.hpp | 3 +- .../cpp/lcmtypes/eigen_lcm/Vector2d.hpp | 3 +- .../cpp/lcmtypes/eigen_lcm/Vector2f.hpp | 3 +- .../cpp/lcmtypes/eigen_lcm/Vector2i.hpp | 3 +- .../cpp/lcmtypes/eigen_lcm/Vector3d.hpp | 3 +- .../cpp/lcmtypes/eigen_lcm/Vector3f.hpp | 3 +- .../cpp/lcmtypes/eigen_lcm/Vector3i.hpp | 3 +- .../cpp/lcmtypes/eigen_lcm/Vector4d.hpp | 3 +- .../cpp/lcmtypes/eigen_lcm/Vector4f.hpp | 3 +- .../cpp/lcmtypes/eigen_lcm/Vector4i.hpp | 3 +- .../cpp/lcmtypes/eigen_lcm/Vector5d.hpp | 3 +- .../cpp/lcmtypes/eigen_lcm/Vector5f.hpp | 3 +- .../cpp/lcmtypes/eigen_lcm/Vector5i.hpp | 3 +- .../cpp/lcmtypes/eigen_lcm/Vector6d.hpp | 3 +- .../cpp/lcmtypes/eigen_lcm/Vector6f.hpp | 3 +- .../cpp/lcmtypes/eigen_lcm/Vector6i.hpp | 3 +- .../cpp/lcmtypes/eigen_lcm/Vector7d.hpp | 3 +- .../cpp/lcmtypes/eigen_lcm/Vector7f.hpp | 3 +- .../cpp/lcmtypes/eigen_lcm/Vector7i.hpp | 3 +- .../cpp/lcmtypes/eigen_lcm/Vector8d.hpp | 3 +- .../cpp/lcmtypes/eigen_lcm/Vector8f.hpp | 3 +- .../cpp/lcmtypes/eigen_lcm/Vector8i.hpp | 3 +- .../cpp/lcmtypes/eigen_lcm/VectorXd.hpp | 3 +- .../cpp/lcmtypes/eigen_lcm/VectorXf.hpp | 3 +- .../cpp/lcmtypes/eigen_lcm/VectorXi.hpp | 3 +- third_party/skymarshal/cmake/skymarshal.cmake | 31 +++++++++++-- .../skymarshal/skymarshal/emit_helpers.py | 8 ++++ .../skymarshal/skymarshal/skymarshal.py | 40 +++++++++++++++++ .../skymarshal/skymarshal/syntax_tree.py | 44 +++++++++++++++++++ .../templates/enumtype.hpp.template | 3 +- .../skymarshal/templates/lcmtype.hpp.template | 10 +---- .../templates/lcmtype.java.template | 10 +---- .../templates/python_enum.py.template | 4 +- .../templates/python_struct.py.template | 7 +-- .../templates/typescript_enum.ts.template | 5 +-- .../templates/typescript_struct.ts.template | 10 +---- 114 files changed, 315 insertions(+), 357 deletions(-) diff --git a/CMakeLists.txt b/CMakeLists.txt index d25d2e3c..f85cf488 100644 --- a/CMakeLists.txt +++ b/CMakeLists.txt @@ -211,6 +211,7 @@ else() add_skymarshal_bindings(symforce_lcmtypes ${CMAKE_CURRENT_BINARY_DIR}/lcmtypes ${CMAKE_CURRENT_SOURCE_DIR}/lcmtypes + DEP_LCMTYPES_DIRS ${CMAKE_CURRENT_SOURCE_DIR}/third_party/eigen_lcm/lcmtypes ) target_include_directories(symforce_lcmtypes_cpp diff --git a/symforce/codegen/codegen.py b/symforce/codegen/codegen.py index 9e5f8c4b..fd9be394 100644 --- a/symforce/codegen/codegen.py +++ b/symforce/codegen/codegen.py @@ -456,6 +456,7 @@ def generate_function( namespace: str = "sym", generated_file_name: T.Optional[str] = None, skip_directory_nesting: bool = False, + dep_hash_files: T.Optional[T.Sequence[T.Openable]] = None, ) -> GeneratedPaths: """ Generates a function that computes the given outputs from the given inputs. @@ -546,6 +547,7 @@ def generate_function( output_dir=os.fspath(output_dir), lcm_bindings_output_dir=os.fspath(lcm_bindings_output_dir), templates=templates, + dep_hash_files=dep_hash_files, ) # Maps typenames to generated types @@ -587,6 +589,7 @@ def generate_function( lcm_type_dir=types_codegen_data.lcm_type_dir, lcm_files=types_codegen_data.lcm_files, lcm_output_dir=types_codegen_data.lcm_bindings_output_dir, + dep_hash_files=dep_hash_files, ) return GeneratedPaths( @@ -946,13 +949,17 @@ def with_jacobians( docstring="\n".join(docstring_lines), ) - def lambdify(self) -> T.Callable: + def lambdify( + self, + dep_hash_files: T.Optional[T.Sequence[T.Openable]] = None, + ) -> T.Callable: """ Generates a numerical function from an existing codegen object. Wraps codegen generate function and load function methods. Args: self: Existing codegen object with a PythonConfig + dep_hash_files: See :meth:`Codegen.generate_function`. Returns: A numerical function generated from the codegen object @@ -968,7 +975,7 @@ def lambdify(self) -> T.Callable: self.name = "_lambda" name_was_none = True - data = self.generate_function(namespace="_lambda") + data = self.generate_function(namespace="_lambda", dep_hash_files=dep_hash_files) generated_function = codegen_util.load_generated_function( self.name, data.function_dir, evict=not self.config.use_numba ) diff --git a/symforce/codegen/codegen_util.py b/symforce/codegen/codegen_util.py index 34496bae..a0cfedae 100644 --- a/symforce/codegen/codegen_util.py +++ b/symforce/codegen/codegen_util.py @@ -13,7 +13,9 @@ import importlib.abc import importlib.util import itertools +import os import sys +import tempfile from pathlib import Path import sympy @@ -22,6 +24,7 @@ import symforce.symbolic as sf from symforce import _sympy_count_ops from symforce import ops +from symforce import path_util from symforce import typing as T from symforce import typing_util from symforce.codegen import codegen_config @@ -721,6 +724,7 @@ def generate_lcm_types( lcm_type_dir: T.Openable, lcm_files: T.Sequence[str], lcm_output_dir: T.Optional[T.Openable] = None, + dep_hash_files: T.Optional[T.Sequence[T.Openable]] = None, ) -> LcmBindingsDirs: """ Generates the language-specific type files for all symforce generated ".lcm" files. @@ -728,6 +732,8 @@ def generate_lcm_types( Args: lcm_type_dir: Directory containing symforce-generated .lcm files lcm_files: List of .lcm files to process + dep_hash_files: skymarshal --hash-info-out JSONs for cross-package types referenced by + the generated .lcm (e.g. eigen_lcm). Needed when referencing types outside lcm_type_dir. """ lcm_type_dir = Path(lcm_type_dir) @@ -751,9 +757,22 @@ def generate_lcm_types( from skymarshal.emit_cpp import SkymarshalCpp from skymarshal.emit_python import SkymarshalPython - skymarshal.main( - [SkymarshalPython, SkymarshalCpp], - args=[ + with tempfile.TemporaryDirectory() as hash_tmp_dir: + dep_hash_paths = [str(p) for p in dep_hash_files] if dep_hash_files else [] + + # Generated lcm references eigen_lcm types we don't emit; supply their hashes when the + # sources are locatable so callers don't have to. (Under Bazel callers pass them instead.) + eigen_lcm_dir = path_util.eigen_lcm_lcmtypes_dir() + if eigen_lcm_dir is not None: + eigen_lcm_hashes = os.path.join(hash_tmp_dir, "eigen_lcm_hashes.json") + skymarshal.main( + [], + args=[str(eigen_lcm_dir), "--hash-info-out", eigen_lcm_hashes, "--no-source-paths"], + print_generated=False, + ) + dep_hash_paths.append(eigen_lcm_hashes) + + args = [ str(lcm_type_dir), "--python", "--python-path", @@ -767,9 +786,16 @@ def generate_lcm_types( "--cpp-include", lcm_include_dir, "--no-source-paths", - ], - print_generated=False, - ) + ] + if dep_hash_paths: + args.append("--hash-deps-info") + args.extend(dep_hash_paths) + + skymarshal.main( + [SkymarshalPython, SkymarshalCpp], + args=args, + print_generated=False, + ) # Autoformat generated python files for f in python_types_dir.rglob("*.py"): diff --git a/symforce/codegen/types_package_codegen.py b/symforce/codegen/types_package_codegen.py index 1cec43f3..8f670b4f 100644 --- a/symforce/codegen/types_package_codegen.py +++ b/symforce/codegen/types_package_codegen.py @@ -53,6 +53,7 @@ def generate_types( output_dir: T.Optional[T.Openable] = None, lcm_bindings_output_dir: T.Optional[T.Openable] = None, templates: T.Optional[template_util.TemplateList] = None, + dep_hash_files: T.Optional[T.Sequence[T.Openable]] = None, ) -> TypesCodegenData: """ Generates LCM types from the given values_indices, including the necessary subtypes @@ -196,7 +197,7 @@ def generate_types( if not using_external_templates: templates.render() codegen_data.lcm_bindings_dirs = codegen_util.generate_lcm_types( - lcm_type_dir, lcm_files, lcm_bindings_output_dir + lcm_type_dir, lcm_files, lcm_bindings_output_dir, dep_hash_files=dep_hash_files ) return codegen_data diff --git a/symforce/path_util.py b/symforce/path_util.py index ad37c5ec..b2328856 100644 --- a/symforce/path_util.py +++ b/symforce/path_util.py @@ -67,6 +67,29 @@ def symforce_root() -> Path: return Path(__file__).parent.parent +def eigen_lcm_lcmtypes_dir() -> T.Optional[Path]: + """ + Directory of the eigen_lcm ``.lcm`` sources, or ``None`` if not found. + + Codegen feeds these to skymarshal's recursive-hash precompute. Standalone builds keep them under + ``third_party/eigen_lcm``; Bazel sets ``SYMFORCE_EIGEN_LCM_LCMTYPES_DIR`` (absolute, or relative + to the runfiles tree) to point elsewhere. + """ + override = os.environ.get("SYMFORCE_EIGEN_LCM_LCMTYPES_DIR") + if override: + candidates = [Path(override)] + runfiles_dir = os.environ.get("RUNFILES_DIR") or os.environ.get("TEST_SRCDIR") + if runfiles_dir and not os.path.isabs(override): + candidates.append(Path(runfiles_dir) / "_main" / override) + candidates.append(Path(runfiles_dir) / override) + for candidate in candidates: + if candidate.is_dir(): + return candidate + + candidate = symforce_root() / "third_party" / "eigen_lcm" / "lcmtypes" + return candidate if candidate.is_dir() else None + + def symforce_data_root(test_file_path: T.Optional[str]) -> Path: """ The root directory of the symforce project, for use accessing data that might need to be updated diff --git a/symforce/util.py b/symforce/util.py index e6a454aa..e7b14f94 100644 --- a/symforce/util.py +++ b/symforce/util.py @@ -39,6 +39,7 @@ def lambdify( expr: T.Element | T.Sequence[T.Element] | None = None, *, use_numba: bool = False, + dep_hash_files: T.Optional[T.Sequence[T.Openable]] = None, ) -> T.Callable: """ Convert a symbolic function, or expression(s), to a numerical function. @@ -90,12 +91,14 @@ def lambdify( inputs=inputs, outputs=outputs, config=codegen.PythonConfig(use_numba=use_numba) ) - return codegen_obj.lambdify() + return codegen_obj.lambdify(dep_hash_files=dep_hash_files) def numbify( f_or_args: T.Callable | T.Sequence[T.Element], expr: T.Element | T.Sequence[T.Element] | None = None, + *, + dep_hash_files: T.Optional[T.Sequence[T.Openable]] = None, ) -> T.Callable: """ Shorthand for ``lambdify(..., use_numba=True)`` @@ -103,7 +106,7 @@ def numbify( See Also: :func:`lambdify` """ - return lambdify(f_or_args, expr, use_numba=True) + return lambdify(f_or_args, expr, use_numba=True, dep_hash_files=dep_hash_files) SymbolicFunction = T.TypeVar("SymbolicFunction", bound=T.Callable) diff --git a/test/symforce_function_codegen_test_data/symengine/codegen_cpp_test_data/cpp/lcmtypes/codegen_cpp_test/constants_t.hpp b/test/symforce_function_codegen_test_data/symengine/codegen_cpp_test_data/cpp/lcmtypes/codegen_cpp_test/constants_t.hpp index b773ca24..bfe608a1 100644 --- a/test/symforce_function_codegen_test_data/symengine/codegen_cpp_test_data/cpp/lcmtypes/codegen_cpp_test/constants_t.hpp +++ b/test/symforce_function_codegen_test_data/symengine/codegen_cpp_test_data/cpp/lcmtypes/codegen_cpp_test/constants_t.hpp @@ -93,8 +93,7 @@ class constants_t inline __lcm_buffer_size _decodeNoHash(const void *buf, __lcm_buffer_size offset, __lcm_buffer_size maxlen); constexpr static uint64_t _computeHash(const __lcm_hash_ptr *) { - uint64_t hash = 0x152f505c823f2cbcLL; - return (hash<<1) + ((hash>>63)&1); + return 0x2a5ea0b9047e5978ULL; } // Comparison operators. diff --git a/test/symforce_function_codegen_test_data/symengine/codegen_cpp_test_data/cpp/lcmtypes/codegen_cpp_test/states_t.hpp b/test/symforce_function_codegen_test_data/symengine/codegen_cpp_test_data/cpp/lcmtypes/codegen_cpp_test/states_t.hpp index e7a4aa55..b6612f38 100644 --- a/test/symforce_function_codegen_test_data/symengine/codegen_cpp_test_data/cpp/lcmtypes/codegen_cpp_test/states_t.hpp +++ b/test/symforce_function_codegen_test_data/symengine/codegen_cpp_test_data/cpp/lcmtypes/codegen_cpp_test/states_t.hpp @@ -101,12 +101,7 @@ class states_t for(fp = p; fp != NULL; fp = fp->parent) if(fp->v == states_t::getHash) return 0; - const __lcm_hash_ptr cp = { p, states_t::getHash }; - - uint64_t hash = 0x0012345678017000LL + - ::eigen_lcm::Vector2d::_computeHash(&cp); - - return (hash<<1) + ((hash>>63)&1); + return 0xf8d125e8c0876fc1ULL; } // Comparison operators. diff --git a/test/symforce_function_codegen_test_data/symengine/codegen_cpp_test_data/cpp/lcmtypes/codegen_cpp_test/values_vec_t.hpp b/test/symforce_function_codegen_test_data/symengine/codegen_cpp_test_data/cpp/lcmtypes/codegen_cpp_test/values_vec_t.hpp index 8855dccd..5ce438c0 100644 --- a/test/symforce_function_codegen_test_data/symengine/codegen_cpp_test_data/cpp/lcmtypes/codegen_cpp_test/values_vec_t.hpp +++ b/test/symforce_function_codegen_test_data/symengine/codegen_cpp_test_data/cpp/lcmtypes/codegen_cpp_test/values_vec_t.hpp @@ -117,14 +117,7 @@ class values_vec_t for(fp = p; fp != NULL; fp = fp->parent) if(fp->v == values_vec_t::getHash) return 0; - const __lcm_hash_ptr cp = { p, values_vec_t::getHash }; - - uint64_t hash = 0xe7b60b55c8cf5417LL + - ::eigen_lcm::Vector4d::_computeHash(&cp) + - ::eigen_lcm::Vector4d::_computeHash(&cp) + - ::eigen_lcm::Vector4d::_computeHash(&cp); - - return (hash<<1) + ((hash>>63)&1); + return 0xb9724e5f032c5787ULL; } // Comparison operators. diff --git a/test/symforce_function_codegen_test_data/symengine/codegen_cpp_test_data/python/lcmtypes/codegen_cpp_test/_constants_t.py b/test/symforce_function_codegen_test_data/symengine/codegen_cpp_test_data/python/lcmtypes/codegen_cpp_test/_constants_t.py index 20367d56..c43c7f40 100644 --- a/test/symforce_function_codegen_test_data/symengine/codegen_cpp_test_data/python/lcmtypes/codegen_cpp_test/_constants_t.py +++ b/test/symforce_function_codegen_test_data/symengine/codegen_cpp_test_data/python/lcmtypes/codegen_cpp_test/_constants_t.py @@ -91,9 +91,7 @@ def _decode_one(buf: T.BinaryIO) -> constants_t: @staticmethod def _get_hash_recursive(parents: T.List[T.Type]) -> int: if constants_t in parents: return 0 - tmphash = (0x152f505c823f2cbc) & 0xffffffffffffffff - tmphash = (((tmphash<<1)&0xffffffffffffffff) + (tmphash>>63)) & 0xffffffffffffffff - return tmphash + return 0x2a5ea0b9047e5978 _packed_fingerprint: T.Optional[bytes] = None diff --git a/test/symforce_function_codegen_test_data/symengine/codegen_cpp_test_data/python/lcmtypes/codegen_cpp_test/_states_t.py b/test/symforce_function_codegen_test_data/symengine/codegen_cpp_test_data/python/lcmtypes/codegen_cpp_test/_states_t.py index d455b57d..e7700a71 100644 --- a/test/symforce_function_codegen_test_data/symengine/codegen_cpp_test_data/python/lcmtypes/codegen_cpp_test/_states_t.py +++ b/test/symforce_function_codegen_test_data/symengine/codegen_cpp_test_data/python/lcmtypes/codegen_cpp_test/_states_t.py @@ -96,10 +96,7 @@ def _decode_one(buf: T.BinaryIO) -> states_t: @staticmethod def _get_hash_recursive(parents: T.List[T.Type]) -> int: if states_t in parents: return 0 - newparents = parents + [states_t] - tmphash = (0x12345678017000+ Vector2d._get_hash_recursive(newparents)) & 0xffffffffffffffff - tmphash = (((tmphash<<1)&0xffffffffffffffff) + (tmphash>>63)) & 0xffffffffffffffff - return tmphash + return 0xf8d125e8c0876fc1 _packed_fingerprint: T.Optional[bytes] = None diff --git a/test/symforce_function_codegen_test_data/symengine/codegen_cpp_test_data/python/lcmtypes/codegen_cpp_test/_values_vec_t.py b/test/symforce_function_codegen_test_data/symengine/codegen_cpp_test_data/python/lcmtypes/codegen_cpp_test/_values_vec_t.py index d0fac242..0568f266 100644 --- a/test/symforce_function_codegen_test_data/symengine/codegen_cpp_test_data/python/lcmtypes/codegen_cpp_test/_values_vec_t.py +++ b/test/symforce_function_codegen_test_data/symengine/codegen_cpp_test_data/python/lcmtypes/codegen_cpp_test/_values_vec_t.py @@ -146,10 +146,7 @@ def _decode_one(buf: T.BinaryIO) -> values_vec_t: @staticmethod def _get_hash_recursive(parents: T.List[T.Type]) -> int: if values_vec_t in parents: return 0 - newparents = parents + [values_vec_t] - tmphash = (0xe7b60b55c8cf5417+ Vector4d._get_hash_recursive(newparents)+ Vector4d._get_hash_recursive(newparents)+ Vector4d._get_hash_recursive(newparents)) & 0xffffffffffffffff - tmphash = (((tmphash<<1)&0xffffffffffffffff) + (tmphash>>63)) & 0xffffffffffffffff - return tmphash + return 0xb9724e5f032c5787 _packed_fingerprint: T.Optional[bytes] = None diff --git a/test/symforce_function_codegen_test_data/symengine/codegen_dataclass_in_values_test_data/cpp/lcmtypes/codegen_test/my_dataclass_t.hpp b/test/symforce_function_codegen_test_data/symengine/codegen_dataclass_in_values_test_data/cpp/lcmtypes/codegen_test/my_dataclass_t.hpp index 9ab92537..84bef52b 100644 --- a/test/symforce_function_codegen_test_data/symengine/codegen_dataclass_in_values_test_data/cpp/lcmtypes/codegen_test/my_dataclass_t.hpp +++ b/test/symforce_function_codegen_test_data/symengine/codegen_dataclass_in_values_test_data/cpp/lcmtypes/codegen_test/my_dataclass_t.hpp @@ -101,12 +101,7 @@ class my_dataclass_t for(fp = p; fp != NULL; fp = fp->parent) if(fp->v == my_dataclass_t::getHash) return 0; - const __lcm_hash_ptr cp = { p, my_dataclass_t::getHash }; - - uint64_t hash = 0x34567803726f7424LL + - ::eigen_lcm::Vector4d::_computeHash(&cp); - - return (hash<<1) + ((hash>>63)&1); + return 0x6159ad42b5637810ULL; } // Comparison operators. diff --git a/test/symforce_function_codegen_test_data/symengine/codegen_dataclass_in_values_test_data/python/lcmtypes/codegen_test/_my_dataclass_t.py b/test/symforce_function_codegen_test_data/symengine/codegen_dataclass_in_values_test_data/python/lcmtypes/codegen_test/_my_dataclass_t.py index 0a1ae866..4ed001ce 100644 --- a/test/symforce_function_codegen_test_data/symengine/codegen_dataclass_in_values_test_data/python/lcmtypes/codegen_test/_my_dataclass_t.py +++ b/test/symforce_function_codegen_test_data/symengine/codegen_dataclass_in_values_test_data/python/lcmtypes/codegen_test/_my_dataclass_t.py @@ -96,10 +96,7 @@ def _decode_one(buf: T.BinaryIO) -> my_dataclass_t: @staticmethod def _get_hash_recursive(parents: T.List[T.Type]) -> int: if my_dataclass_t in parents: return 0 - newparents = parents + [my_dataclass_t] - tmphash = (0x34567803726f7424+ Vector4d._get_hash_recursive(newparents)) & 0xffffffffffffffff - tmphash = (((tmphash<<1)&0xffffffffffffffff) + (tmphash>>63)) & 0xffffffffffffffff - return tmphash + return 0x6159ad42b5637810 _packed_fingerprint: T.Optional[bytes] = None diff --git a/test/symforce_function_codegen_test_data/symengine/codegen_explicit_template_instantiation_test_data/cpp/lcmtypes/codegen_explicit_template_instantiation_test/constants_t.hpp b/test/symforce_function_codegen_test_data/symengine/codegen_explicit_template_instantiation_test_data/cpp/lcmtypes/codegen_explicit_template_instantiation_test/constants_t.hpp index 5684686e..8b543f8f 100644 --- a/test/symforce_function_codegen_test_data/symengine/codegen_explicit_template_instantiation_test_data/cpp/lcmtypes/codegen_explicit_template_instantiation_test/constants_t.hpp +++ b/test/symforce_function_codegen_test_data/symengine/codegen_explicit_template_instantiation_test_data/cpp/lcmtypes/codegen_explicit_template_instantiation_test/constants_t.hpp @@ -93,8 +93,7 @@ class constants_t inline __lcm_buffer_size _decodeNoHash(const void *buf, __lcm_buffer_size offset, __lcm_buffer_size maxlen); constexpr static uint64_t _computeHash(const __lcm_hash_ptr *) { - uint64_t hash = 0x152f505c823f2cbcLL; - return (hash<<1) + ((hash>>63)&1); + return 0x2a5ea0b9047e5978ULL; } // Comparison operators. diff --git a/test/symforce_function_codegen_test_data/symengine/codegen_explicit_template_instantiation_test_data/cpp/lcmtypes/codegen_explicit_template_instantiation_test/states_t.hpp b/test/symforce_function_codegen_test_data/symengine/codegen_explicit_template_instantiation_test_data/cpp/lcmtypes/codegen_explicit_template_instantiation_test/states_t.hpp index 4a088738..059a41c4 100644 --- a/test/symforce_function_codegen_test_data/symengine/codegen_explicit_template_instantiation_test_data/cpp/lcmtypes/codegen_explicit_template_instantiation_test/states_t.hpp +++ b/test/symforce_function_codegen_test_data/symengine/codegen_explicit_template_instantiation_test_data/cpp/lcmtypes/codegen_explicit_template_instantiation_test/states_t.hpp @@ -101,12 +101,7 @@ class states_t for(fp = p; fp != NULL; fp = fp->parent) if(fp->v == states_t::getHash) return 0; - const __lcm_hash_ptr cp = { p, states_t::getHash }; - - uint64_t hash = 0x0012345678017000LL + - ::eigen_lcm::Vector2d::_computeHash(&cp); - - return (hash<<1) + ((hash>>63)&1); + return 0xf8d125e8c0876fc1ULL; } // Comparison operators. diff --git a/test/symforce_function_codegen_test_data/symengine/codegen_explicit_template_instantiation_test_data/cpp/lcmtypes/codegen_explicit_template_instantiation_test/values_vec_t.hpp b/test/symforce_function_codegen_test_data/symengine/codegen_explicit_template_instantiation_test_data/cpp/lcmtypes/codegen_explicit_template_instantiation_test/values_vec_t.hpp index 2083bbf0..b2572db7 100644 --- a/test/symforce_function_codegen_test_data/symengine/codegen_explicit_template_instantiation_test_data/cpp/lcmtypes/codegen_explicit_template_instantiation_test/values_vec_t.hpp +++ b/test/symforce_function_codegen_test_data/symengine/codegen_explicit_template_instantiation_test_data/cpp/lcmtypes/codegen_explicit_template_instantiation_test/values_vec_t.hpp @@ -117,14 +117,7 @@ class values_vec_t for(fp = p; fp != NULL; fp = fp->parent) if(fp->v == values_vec_t::getHash) return 0; - const __lcm_hash_ptr cp = { p, values_vec_t::getHash }; - - uint64_t hash = 0xe7b60b55c8cf5417LL + - ::eigen_lcm::Vector4d::_computeHash(&cp) + - ::eigen_lcm::Vector4d::_computeHash(&cp) + - ::eigen_lcm::Vector4d::_computeHash(&cp); - - return (hash<<1) + ((hash>>63)&1); + return 0xb9724e5f032c5787ULL; } // Comparison operators. diff --git a/test/symforce_function_codegen_test_data/symengine/codegen_explicit_template_instantiation_test_data/python/lcmtypes/codegen_explicit_template_instantiation_test/_constants_t.py b/test/symforce_function_codegen_test_data/symengine/codegen_explicit_template_instantiation_test_data/python/lcmtypes/codegen_explicit_template_instantiation_test/_constants_t.py index 8ce58cdf..f74c169b 100644 --- a/test/symforce_function_codegen_test_data/symengine/codegen_explicit_template_instantiation_test_data/python/lcmtypes/codegen_explicit_template_instantiation_test/_constants_t.py +++ b/test/symforce_function_codegen_test_data/symengine/codegen_explicit_template_instantiation_test_data/python/lcmtypes/codegen_explicit_template_instantiation_test/_constants_t.py @@ -91,9 +91,7 @@ def _decode_one(buf: T.BinaryIO) -> constants_t: @staticmethod def _get_hash_recursive(parents: T.List[T.Type]) -> int: if constants_t in parents: return 0 - tmphash = (0x152f505c823f2cbc) & 0xffffffffffffffff - tmphash = (((tmphash<<1)&0xffffffffffffffff) + (tmphash>>63)) & 0xffffffffffffffff - return tmphash + return 0x2a5ea0b9047e5978 _packed_fingerprint: T.Optional[bytes] = None diff --git a/test/symforce_function_codegen_test_data/symengine/codegen_explicit_template_instantiation_test_data/python/lcmtypes/codegen_explicit_template_instantiation_test/_states_t.py b/test/symforce_function_codegen_test_data/symengine/codegen_explicit_template_instantiation_test_data/python/lcmtypes/codegen_explicit_template_instantiation_test/_states_t.py index 2a5ba362..2682d77a 100644 --- a/test/symforce_function_codegen_test_data/symengine/codegen_explicit_template_instantiation_test_data/python/lcmtypes/codegen_explicit_template_instantiation_test/_states_t.py +++ b/test/symforce_function_codegen_test_data/symengine/codegen_explicit_template_instantiation_test_data/python/lcmtypes/codegen_explicit_template_instantiation_test/_states_t.py @@ -96,10 +96,7 @@ def _decode_one(buf: T.BinaryIO) -> states_t: @staticmethod def _get_hash_recursive(parents: T.List[T.Type]) -> int: if states_t in parents: return 0 - newparents = parents + [states_t] - tmphash = (0x12345678017000+ Vector2d._get_hash_recursive(newparents)) & 0xffffffffffffffff - tmphash = (((tmphash<<1)&0xffffffffffffffff) + (tmphash>>63)) & 0xffffffffffffffff - return tmphash + return 0xf8d125e8c0876fc1 _packed_fingerprint: T.Optional[bytes] = None diff --git a/test/symforce_function_codegen_test_data/symengine/codegen_explicit_template_instantiation_test_data/python/lcmtypes/codegen_explicit_template_instantiation_test/_values_vec_t.py b/test/symforce_function_codegen_test_data/symengine/codegen_explicit_template_instantiation_test_data/python/lcmtypes/codegen_explicit_template_instantiation_test/_values_vec_t.py index 87a99b54..644bd3ec 100644 --- a/test/symforce_function_codegen_test_data/symengine/codegen_explicit_template_instantiation_test_data/python/lcmtypes/codegen_explicit_template_instantiation_test/_values_vec_t.py +++ b/test/symforce_function_codegen_test_data/symengine/codegen_explicit_template_instantiation_test_data/python/lcmtypes/codegen_explicit_template_instantiation_test/_values_vec_t.py @@ -146,10 +146,7 @@ def _decode_one(buf: T.BinaryIO) -> values_vec_t: @staticmethod def _get_hash_recursive(parents: T.List[T.Type]) -> int: if values_vec_t in parents: return 0 - newparents = parents + [values_vec_t] - tmphash = (0xe7b60b55c8cf5417+ Vector4d._get_hash_recursive(newparents)+ Vector4d._get_hash_recursive(newparents)+ Vector4d._get_hash_recursive(newparents)) & 0xffffffffffffffff - tmphash = (((tmphash<<1)&0xffffffffffffffff) + (tmphash>>63)) & 0xffffffffffffffff - return tmphash + return 0xb9724e5f032c5787 _packed_fingerprint: T.Optional[bytes] = None diff --git a/test/symforce_function_codegen_test_data/symengine/codegen_multi_function_test_data/cpp/lcmtypes/codegen_multi_function_test/inputs_constants_t.hpp b/test/symforce_function_codegen_test_data/symengine/codegen_multi_function_test_data/cpp/lcmtypes/codegen_multi_function_test/inputs_constants_t.hpp index 9c8471e7..4d6fa3f2 100644 --- a/test/symforce_function_codegen_test_data/symengine/codegen_multi_function_test_data/cpp/lcmtypes/codegen_multi_function_test/inputs_constants_t.hpp +++ b/test/symforce_function_codegen_test_data/symengine/codegen_multi_function_test_data/cpp/lcmtypes/codegen_multi_function_test/inputs_constants_t.hpp @@ -93,8 +93,7 @@ class inputs_constants_t inline __lcm_buffer_size _decodeNoHash(const void *buf, __lcm_buffer_size offset, __lcm_buffer_size maxlen); constexpr static uint64_t _computeHash(const __lcm_hash_ptr *) { - uint64_t hash = 0x152f505c823f2cbcLL; - return (hash<<1) + ((hash>>63)&1); + return 0x2a5ea0b9047e5978ULL; } // Comparison operators. diff --git a/test/symforce_function_codegen_test_data/symengine/codegen_multi_function_test_data/cpp/lcmtypes/codegen_multi_function_test/inputs_states_t.hpp b/test/symforce_function_codegen_test_data/symengine/codegen_multi_function_test_data/cpp/lcmtypes/codegen_multi_function_test/inputs_states_t.hpp index 9d8699f2..e4e7f33b 100644 --- a/test/symforce_function_codegen_test_data/symengine/codegen_multi_function_test_data/cpp/lcmtypes/codegen_multi_function_test/inputs_states_t.hpp +++ b/test/symforce_function_codegen_test_data/symengine/codegen_multi_function_test_data/cpp/lcmtypes/codegen_multi_function_test/inputs_states_t.hpp @@ -101,12 +101,7 @@ class inputs_states_t for(fp = p; fp != NULL; fp = fp->parent) if(fp->v == inputs_states_t::getHash) return 0; - const __lcm_hash_ptr cp = { p, inputs_states_t::getHash }; - - uint64_t hash = 0x0012345678017000LL + - ::eigen_lcm::Vector2d::_computeHash(&cp); - - return (hash<<1) + ((hash>>63)&1); + return 0xf8d125e8c0876fc1ULL; } // Comparison operators. diff --git a/test/symforce_function_codegen_test_data/symengine/codegen_multi_function_test_data/cpp/lcmtypes/codegen_multi_function_test/inputs_t.hpp b/test/symforce_function_codegen_test_data/symengine/codegen_multi_function_test_data/cpp/lcmtypes/codegen_multi_function_test/inputs_t.hpp index bbef4ff3..3bf3a082 100644 --- a/test/symforce_function_codegen_test_data/symengine/codegen_multi_function_test_data/cpp/lcmtypes/codegen_multi_function_test/inputs_t.hpp +++ b/test/symforce_function_codegen_test_data/symengine/codegen_multi_function_test_data/cpp/lcmtypes/codegen_multi_function_test/inputs_t.hpp @@ -140,20 +140,7 @@ class inputs_t for(fp = p; fp != NULL; fp = fp->parent) if(fp->v == inputs_t::getHash) return 0; - const __lcm_hash_ptr cp = { p, inputs_t::getHash }; - - uint64_t hash = 0x57fdecbc3532ce7fLL + - ::eigen_lcm::Vector4d::_computeHash(&cp) + - ::eigen_lcm::Vector4d::_computeHash(&cp) + - ::eigen_lcm::Vector4d::_computeHash(&cp) + - ::codegen_multi_function_test::values_vec_t::_computeHash(&cp) + - ::codegen_multi_function_test::values_vec_t::_computeHash(&cp) + - ::codegen_multi_function_test::inputs_constants_t::_computeHash(&cp) + - ::eigen_lcm::MatrixXd::_computeHash(&cp) + - ::eigen_lcm::Matrix4d::_computeHash(&cp) + - ::codegen_multi_function_test::inputs_states_t::_computeHash(&cp); - - return (hash<<1) + ((hash>>63)&1); + return 0xbaf4a87fdcc6ef9bULL; } // Comparison operators. diff --git a/test/symforce_function_codegen_test_data/symengine/codegen_multi_function_test_data/cpp/lcmtypes/codegen_multi_function_test/outputs_1_t.hpp b/test/symforce_function_codegen_test_data/symengine/codegen_multi_function_test_data/cpp/lcmtypes/codegen_multi_function_test/outputs_1_t.hpp index e279bc8a..2b4f378e 100644 --- a/test/symforce_function_codegen_test_data/symengine/codegen_multi_function_test_data/cpp/lcmtypes/codegen_multi_function_test/outputs_1_t.hpp +++ b/test/symforce_function_codegen_test_data/symengine/codegen_multi_function_test_data/cpp/lcmtypes/codegen_multi_function_test/outputs_1_t.hpp @@ -122,15 +122,7 @@ class outputs_1_t for(fp = p; fp != NULL; fp = fp->parent) if(fp->v == outputs_1_t::getHash) return 0; - const __lcm_hash_ptr cp = { p, outputs_1_t::getHash }; - - uint64_t hash = 0xa7f6beb7efb65a6fLL + - ::codegen_multi_function_test::values_vec_t::_computeHash(&cp) + - ::codegen_multi_function_test::values_vec_t::_computeHash(&cp) + - ::eigen_lcm::MatrixXd::_computeHash(&cp) + - ::eigen_lcm::Matrix4d::_computeHash(&cp); - - return (hash<<1) + ((hash>>63)&1); + return 0x2a8087805634c5b0ULL; } // Comparison operators. diff --git a/test/symforce_function_codegen_test_data/symengine/codegen_multi_function_test_data/cpp/lcmtypes/codegen_multi_function_test/outputs_2_t.hpp b/test/symforce_function_codegen_test_data/symengine/codegen_multi_function_test_data/cpp/lcmtypes/codegen_multi_function_test/outputs_2_t.hpp index fd0ae680..70923860 100644 --- a/test/symforce_function_codegen_test_data/symengine/codegen_multi_function_test_data/cpp/lcmtypes/codegen_multi_function_test/outputs_2_t.hpp +++ b/test/symforce_function_codegen_test_data/symengine/codegen_multi_function_test_data/cpp/lcmtypes/codegen_multi_function_test/outputs_2_t.hpp @@ -93,8 +93,7 @@ class outputs_2_t inline __lcm_buffer_size _decodeNoHash(const void *buf, __lcm_buffer_size offset, __lcm_buffer_size maxlen); constexpr static uint64_t _computeHash(const __lcm_hash_ptr *) { - uint64_t hash = 0x2acd1c65693943deLL; - return (hash<<1) + ((hash>>63)&1); + return 0x559a38cad27287bcULL; } // Comparison operators. diff --git a/test/symforce_function_codegen_test_data/symengine/codegen_multi_function_test_data/cpp/lcmtypes/codegen_multi_function_test/values_vec_t.hpp b/test/symforce_function_codegen_test_data/symengine/codegen_multi_function_test_data/cpp/lcmtypes/codegen_multi_function_test/values_vec_t.hpp index 657c863b..2d87fb1a 100644 --- a/test/symforce_function_codegen_test_data/symengine/codegen_multi_function_test_data/cpp/lcmtypes/codegen_multi_function_test/values_vec_t.hpp +++ b/test/symforce_function_codegen_test_data/symengine/codegen_multi_function_test_data/cpp/lcmtypes/codegen_multi_function_test/values_vec_t.hpp @@ -117,14 +117,7 @@ class values_vec_t for(fp = p; fp != NULL; fp = fp->parent) if(fp->v == values_vec_t::getHash) return 0; - const __lcm_hash_ptr cp = { p, values_vec_t::getHash }; - - uint64_t hash = 0xe7b60b55c8cf5417LL + - ::eigen_lcm::Vector4d::_computeHash(&cp) + - ::eigen_lcm::Vector4d::_computeHash(&cp) + - ::eigen_lcm::Vector4d::_computeHash(&cp); - - return (hash<<1) + ((hash>>63)&1); + return 0xb9724e5f032c5787ULL; } // Comparison operators. diff --git a/test/symforce_function_codegen_test_data/symengine/codegen_multi_function_test_data/python/lcmtypes/codegen_multi_function_test/_inputs_constants_t.py b/test/symforce_function_codegen_test_data/symengine/codegen_multi_function_test_data/python/lcmtypes/codegen_multi_function_test/_inputs_constants_t.py index 4c066f45..1eb83dc3 100644 --- a/test/symforce_function_codegen_test_data/symengine/codegen_multi_function_test_data/python/lcmtypes/codegen_multi_function_test/_inputs_constants_t.py +++ b/test/symforce_function_codegen_test_data/symengine/codegen_multi_function_test_data/python/lcmtypes/codegen_multi_function_test/_inputs_constants_t.py @@ -91,9 +91,7 @@ def _decode_one(buf: T.BinaryIO) -> inputs_constants_t: @staticmethod def _get_hash_recursive(parents: T.List[T.Type]) -> int: if inputs_constants_t in parents: return 0 - tmphash = (0x152f505c823f2cbc) & 0xffffffffffffffff - tmphash = (((tmphash<<1)&0xffffffffffffffff) + (tmphash>>63)) & 0xffffffffffffffff - return tmphash + return 0x2a5ea0b9047e5978 _packed_fingerprint: T.Optional[bytes] = None diff --git a/test/symforce_function_codegen_test_data/symengine/codegen_multi_function_test_data/python/lcmtypes/codegen_multi_function_test/_inputs_states_t.py b/test/symforce_function_codegen_test_data/symengine/codegen_multi_function_test_data/python/lcmtypes/codegen_multi_function_test/_inputs_states_t.py index b5386272..20160ce6 100644 --- a/test/symforce_function_codegen_test_data/symengine/codegen_multi_function_test_data/python/lcmtypes/codegen_multi_function_test/_inputs_states_t.py +++ b/test/symforce_function_codegen_test_data/symengine/codegen_multi_function_test_data/python/lcmtypes/codegen_multi_function_test/_inputs_states_t.py @@ -96,10 +96,7 @@ def _decode_one(buf: T.BinaryIO) -> inputs_states_t: @staticmethod def _get_hash_recursive(parents: T.List[T.Type]) -> int: if inputs_states_t in parents: return 0 - newparents = parents + [inputs_states_t] - tmphash = (0x12345678017000+ Vector2d._get_hash_recursive(newparents)) & 0xffffffffffffffff - tmphash = (((tmphash<<1)&0xffffffffffffffff) + (tmphash>>63)) & 0xffffffffffffffff - return tmphash + return 0xf8d125e8c0876fc1 _packed_fingerprint: T.Optional[bytes] = None diff --git a/test/symforce_function_codegen_test_data/symengine/codegen_multi_function_test_data/python/lcmtypes/codegen_multi_function_test/_inputs_t.py b/test/symforce_function_codegen_test_data/symengine/codegen_multi_function_test_data/python/lcmtypes/codegen_multi_function_test/_inputs_t.py index 0a990005..b37617f6 100644 --- a/test/symforce_function_codegen_test_data/symengine/codegen_multi_function_test_data/python/lcmtypes/codegen_multi_function_test/_inputs_t.py +++ b/test/symforce_function_codegen_test_data/symengine/codegen_multi_function_test_data/python/lcmtypes/codegen_multi_function_test/_inputs_t.py @@ -226,10 +226,7 @@ def _decode_one(buf: T.BinaryIO) -> inputs_t: @staticmethod def _get_hash_recursive(parents: T.List[T.Type]) -> int: if inputs_t in parents: return 0 - newparents = parents + [inputs_t] - tmphash = (0x57fdecbc3532ce7f+ Vector4d._get_hash_recursive(newparents)+ Vector4d._get_hash_recursive(newparents)+ Vector4d._get_hash_recursive(newparents)+ values_vec_t._get_hash_recursive(newparents)+ values_vec_t._get_hash_recursive(newparents)+ inputs_constants_t._get_hash_recursive(newparents)+ MatrixXd._get_hash_recursive(newparents)+ Matrix4d._get_hash_recursive(newparents)+ inputs_states_t._get_hash_recursive(newparents)) & 0xffffffffffffffff - tmphash = (((tmphash<<1)&0xffffffffffffffff) + (tmphash>>63)) & 0xffffffffffffffff - return tmphash + return 0xbaf4a87fdcc6ef9b _packed_fingerprint: T.Optional[bytes] = None diff --git a/test/symforce_function_codegen_test_data/symengine/codegen_multi_function_test_data/python/lcmtypes/codegen_multi_function_test/_outputs_1_t.py b/test/symforce_function_codegen_test_data/symengine/codegen_multi_function_test_data/python/lcmtypes/codegen_multi_function_test/_outputs_1_t.py index 16ef2c42..fc7c8961 100644 --- a/test/symforce_function_codegen_test_data/symengine/codegen_multi_function_test_data/python/lcmtypes/codegen_multi_function_test/_outputs_1_t.py +++ b/test/symforce_function_codegen_test_data/symengine/codegen_multi_function_test_data/python/lcmtypes/codegen_multi_function_test/_outputs_1_t.py @@ -159,10 +159,7 @@ def _decode_one(buf: T.BinaryIO) -> outputs_1_t: @staticmethod def _get_hash_recursive(parents: T.List[T.Type]) -> int: if outputs_1_t in parents: return 0 - newparents = parents + [outputs_1_t] - tmphash = (0xa7f6beb7efb65a6f+ values_vec_t._get_hash_recursive(newparents)+ values_vec_t._get_hash_recursive(newparents)+ MatrixXd._get_hash_recursive(newparents)+ Matrix4d._get_hash_recursive(newparents)) & 0xffffffffffffffff - tmphash = (((tmphash<<1)&0xffffffffffffffff) + (tmphash>>63)) & 0xffffffffffffffff - return tmphash + return 0x2a8087805634c5b0 _packed_fingerprint: T.Optional[bytes] = None diff --git a/test/symforce_function_codegen_test_data/symengine/codegen_multi_function_test_data/python/lcmtypes/codegen_multi_function_test/_outputs_2_t.py b/test/symforce_function_codegen_test_data/symengine/codegen_multi_function_test_data/python/lcmtypes/codegen_multi_function_test/_outputs_2_t.py index d2729bd2..0dd97336 100644 --- a/test/symforce_function_codegen_test_data/symengine/codegen_multi_function_test_data/python/lcmtypes/codegen_multi_function_test/_outputs_2_t.py +++ b/test/symforce_function_codegen_test_data/symengine/codegen_multi_function_test_data/python/lcmtypes/codegen_multi_function_test/_outputs_2_t.py @@ -91,9 +91,7 @@ def _decode_one(buf: T.BinaryIO) -> outputs_2_t: @staticmethod def _get_hash_recursive(parents: T.List[T.Type]) -> int: if outputs_2_t in parents: return 0 - tmphash = (0x2acd1c65693943de) & 0xffffffffffffffff - tmphash = (((tmphash<<1)&0xffffffffffffffff) + (tmphash>>63)) & 0xffffffffffffffff - return tmphash + return 0x559a38cad27287bc _packed_fingerprint: T.Optional[bytes] = None diff --git a/test/symforce_function_codegen_test_data/symengine/codegen_multi_function_test_data/python/lcmtypes/codegen_multi_function_test/_values_vec_t.py b/test/symforce_function_codegen_test_data/symengine/codegen_multi_function_test_data/python/lcmtypes/codegen_multi_function_test/_values_vec_t.py index 18910694..50c362ed 100644 --- a/test/symforce_function_codegen_test_data/symengine/codegen_multi_function_test_data/python/lcmtypes/codegen_multi_function_test/_values_vec_t.py +++ b/test/symforce_function_codegen_test_data/symengine/codegen_multi_function_test_data/python/lcmtypes/codegen_multi_function_test/_values_vec_t.py @@ -146,10 +146,7 @@ def _decode_one(buf: T.BinaryIO) -> values_vec_t: @staticmethod def _get_hash_recursive(parents: T.List[T.Type]) -> int: if values_vec_t in parents: return 0 - newparents = parents + [values_vec_t] - tmphash = (0xe7b60b55c8cf5417+ Vector4d._get_hash_recursive(newparents)+ Vector4d._get_hash_recursive(newparents)+ Vector4d._get_hash_recursive(newparents)) & 0xffffffffffffffff - tmphash = (((tmphash<<1)&0xffffffffffffffff) + (tmphash>>63)) & 0xffffffffffffffff - return tmphash + return 0xb9724e5f032c5787 _packed_fingerprint: T.Optional[bytes] = None diff --git a/test/symforce_function_codegen_test_data/symengine/codegen_python_test_data/cpp/lcmtypes/codegen_python_test/constants_t.hpp b/test/symforce_function_codegen_test_data/symengine/codegen_python_test_data/cpp/lcmtypes/codegen_python_test/constants_t.hpp index 1df0b502..046457ae 100644 --- a/test/symforce_function_codegen_test_data/symengine/codegen_python_test_data/cpp/lcmtypes/codegen_python_test/constants_t.hpp +++ b/test/symforce_function_codegen_test_data/symengine/codegen_python_test_data/cpp/lcmtypes/codegen_python_test/constants_t.hpp @@ -93,8 +93,7 @@ class constants_t inline __lcm_buffer_size _decodeNoHash(const void *buf, __lcm_buffer_size offset, __lcm_buffer_size maxlen); constexpr static uint64_t _computeHash(const __lcm_hash_ptr *) { - uint64_t hash = 0x152f505c823f2cbcLL; - return (hash<<1) + ((hash>>63)&1); + return 0x2a5ea0b9047e5978ULL; } // Comparison operators. diff --git a/test/symforce_function_codegen_test_data/symengine/codegen_python_test_data/cpp/lcmtypes/codegen_python_test/states_t.hpp b/test/symforce_function_codegen_test_data/symengine/codegen_python_test_data/cpp/lcmtypes/codegen_python_test/states_t.hpp index ca0c7872..c1497aec 100644 --- a/test/symforce_function_codegen_test_data/symengine/codegen_python_test_data/cpp/lcmtypes/codegen_python_test/states_t.hpp +++ b/test/symforce_function_codegen_test_data/symengine/codegen_python_test_data/cpp/lcmtypes/codegen_python_test/states_t.hpp @@ -101,12 +101,7 @@ class states_t for(fp = p; fp != NULL; fp = fp->parent) if(fp->v == states_t::getHash) return 0; - const __lcm_hash_ptr cp = { p, states_t::getHash }; - - uint64_t hash = 0x0012345678017000LL + - ::eigen_lcm::Vector2d::_computeHash(&cp); - - return (hash<<1) + ((hash>>63)&1); + return 0xf8d125e8c0876fc1ULL; } // Comparison operators. diff --git a/test/symforce_function_codegen_test_data/symengine/codegen_python_test_data/cpp/lcmtypes/codegen_python_test/values_vec_t.hpp b/test/symforce_function_codegen_test_data/symengine/codegen_python_test_data/cpp/lcmtypes/codegen_python_test/values_vec_t.hpp index 0dcd8381..26bff237 100644 --- a/test/symforce_function_codegen_test_data/symengine/codegen_python_test_data/cpp/lcmtypes/codegen_python_test/values_vec_t.hpp +++ b/test/symforce_function_codegen_test_data/symengine/codegen_python_test_data/cpp/lcmtypes/codegen_python_test/values_vec_t.hpp @@ -117,14 +117,7 @@ class values_vec_t for(fp = p; fp != NULL; fp = fp->parent) if(fp->v == values_vec_t::getHash) return 0; - const __lcm_hash_ptr cp = { p, values_vec_t::getHash }; - - uint64_t hash = 0xe7b60b55c8cf5417LL + - ::eigen_lcm::Vector4d::_computeHash(&cp) + - ::eigen_lcm::Vector4d::_computeHash(&cp) + - ::eigen_lcm::Vector4d::_computeHash(&cp); - - return (hash<<1) + ((hash>>63)&1); + return 0xb9724e5f032c5787ULL; } // Comparison operators. diff --git a/test/symforce_function_codegen_test_data/symengine/codegen_python_test_data/python/lcmtypes/codegen_python_test/_constants_t.py b/test/symforce_function_codegen_test_data/symengine/codegen_python_test_data/python/lcmtypes/codegen_python_test/_constants_t.py index 1336e16b..897a33cc 100644 --- a/test/symforce_function_codegen_test_data/symengine/codegen_python_test_data/python/lcmtypes/codegen_python_test/_constants_t.py +++ b/test/symforce_function_codegen_test_data/symengine/codegen_python_test_data/python/lcmtypes/codegen_python_test/_constants_t.py @@ -91,9 +91,7 @@ def _decode_one(buf: T.BinaryIO) -> constants_t: @staticmethod def _get_hash_recursive(parents: T.List[T.Type]) -> int: if constants_t in parents: return 0 - tmphash = (0x152f505c823f2cbc) & 0xffffffffffffffff - tmphash = (((tmphash<<1)&0xffffffffffffffff) + (tmphash>>63)) & 0xffffffffffffffff - return tmphash + return 0x2a5ea0b9047e5978 _packed_fingerprint: T.Optional[bytes] = None diff --git a/test/symforce_function_codegen_test_data/symengine/codegen_python_test_data/python/lcmtypes/codegen_python_test/_states_t.py b/test/symforce_function_codegen_test_data/symengine/codegen_python_test_data/python/lcmtypes/codegen_python_test/_states_t.py index 20cbc2ba..1fbd8098 100644 --- a/test/symforce_function_codegen_test_data/symengine/codegen_python_test_data/python/lcmtypes/codegen_python_test/_states_t.py +++ b/test/symforce_function_codegen_test_data/symengine/codegen_python_test_data/python/lcmtypes/codegen_python_test/_states_t.py @@ -96,10 +96,7 @@ def _decode_one(buf: T.BinaryIO) -> states_t: @staticmethod def _get_hash_recursive(parents: T.List[T.Type]) -> int: if states_t in parents: return 0 - newparents = parents + [states_t] - tmphash = (0x12345678017000+ Vector2d._get_hash_recursive(newparents)) & 0xffffffffffffffff - tmphash = (((tmphash<<1)&0xffffffffffffffff) + (tmphash>>63)) & 0xffffffffffffffff - return tmphash + return 0xf8d125e8c0876fc1 _packed_fingerprint: T.Optional[bytes] = None diff --git a/test/symforce_function_codegen_test_data/symengine/codegen_python_test_data/python/lcmtypes/codegen_python_test/_values_vec_t.py b/test/symforce_function_codegen_test_data/symengine/codegen_python_test_data/python/lcmtypes/codegen_python_test/_values_vec_t.py index 994477cc..424a037f 100644 --- a/test/symforce_function_codegen_test_data/symengine/codegen_python_test_data/python/lcmtypes/codegen_python_test/_values_vec_t.py +++ b/test/symforce_function_codegen_test_data/symengine/codegen_python_test_data/python/lcmtypes/codegen_python_test/_values_vec_t.py @@ -146,10 +146,7 @@ def _decode_one(buf: T.BinaryIO) -> values_vec_t: @staticmethod def _get_hash_recursive(parents: T.List[T.Type]) -> int: if values_vec_t in parents: return 0 - newparents = parents + [values_vec_t] - tmphash = (0xe7b60b55c8cf5417+ Vector4d._get_hash_recursive(newparents)+ Vector4d._get_hash_recursive(newparents)+ Vector4d._get_hash_recursive(newparents)) & 0xffffffffffffffff - tmphash = (((tmphash<<1)&0xffffffffffffffff) + (tmphash>>63)) & 0xffffffffffffffff - return tmphash + return 0xb9724e5f032c5787 _packed_fingerprint: T.Optional[bytes] = None diff --git a/test/symforce_function_codegen_test_data/symengine/with_jacobians_values/cpp/lcmtypes/sym/d_out_t.hpp b/test/symforce_function_codegen_test_data/symengine/with_jacobians_values/cpp/lcmtypes/sym/d_out_t.hpp index cc006b26..19d819a5 100644 --- a/test/symforce_function_codegen_test_data/symengine/with_jacobians_values/cpp/lcmtypes/sym/d_out_t.hpp +++ b/test/symforce_function_codegen_test_data/symengine/with_jacobians_values/cpp/lcmtypes/sym/d_out_t.hpp @@ -96,8 +96,7 @@ class d_out_t inline __lcm_buffer_size _decodeNoHash(const void *buf, __lcm_buffer_size offset, __lcm_buffer_size maxlen); constexpr static uint64_t _computeHash(const __lcm_hash_ptr *) { - uint64_t hash = 0xd259512e30b44885LL; - return (hash<<1) + ((hash>>63)&1); + return 0xa4b2a25c6168910bULL; } // Comparison operators. diff --git a/test/symforce_function_codegen_test_data/symengine/with_jacobians_values/cpp/lcmtypes/sym/d_t.hpp b/test/symforce_function_codegen_test_data/symengine/with_jacobians_values/cpp/lcmtypes/sym/d_t.hpp index 1b44d7c6..0a1dfa6c 100644 --- a/test/symforce_function_codegen_test_data/symengine/with_jacobians_values/cpp/lcmtypes/sym/d_t.hpp +++ b/test/symforce_function_codegen_test_data/symengine/with_jacobians_values/cpp/lcmtypes/sym/d_t.hpp @@ -104,12 +104,7 @@ class d_t for(fp = p; fp != NULL; fp = fp->parent) if(fp->v == d_t::getHash) return 0; - const __lcm_hash_ptr cp = { p, d_t::getHash }; - - uint64_t hash = 0x21f0a3980ff1bd27LL + - ::eigen_lcm::Vector2d::_computeHash(&cp); - - return (hash<<1) + ((hash>>63)&1); + return 0x3c8e046bf0680a0eULL; } // Comparison operators. diff --git a/test/symforce_function_codegen_test_data/symengine/with_jacobians_values/python/lcmtypes/sym/_d_out_t.py b/test/symforce_function_codegen_test_data/symengine/with_jacobians_values/python/lcmtypes/sym/_d_out_t.py index 2b2b9899..61e19a8f 100644 --- a/test/symforce_function_codegen_test_data/symengine/with_jacobians_values/python/lcmtypes/sym/_d_out_t.py +++ b/test/symforce_function_codegen_test_data/symengine/with_jacobians_values/python/lcmtypes/sym/_d_out_t.py @@ -96,9 +96,7 @@ def _decode_one(buf: T.BinaryIO) -> d_out_t: @staticmethod def _get_hash_recursive(parents: T.List[T.Type]) -> int: if d_out_t in parents: return 0 - tmphash = (0xd259512e30b44885) & 0xffffffffffffffff - tmphash = (((tmphash<<1)&0xffffffffffffffff) + (tmphash>>63)) & 0xffffffffffffffff - return tmphash + return 0xa4b2a25c6168910b _packed_fingerprint: T.Optional[bytes] = None diff --git a/test/symforce_function_codegen_test_data/symengine/with_jacobians_values/python/lcmtypes/sym/_d_t.py b/test/symforce_function_codegen_test_data/symengine/with_jacobians_values/python/lcmtypes/sym/_d_t.py index e835faa2..36bf9ab4 100644 --- a/test/symforce_function_codegen_test_data/symengine/with_jacobians_values/python/lcmtypes/sym/_d_t.py +++ b/test/symforce_function_codegen_test_data/symengine/with_jacobians_values/python/lcmtypes/sym/_d_t.py @@ -103,10 +103,7 @@ def _decode_one(buf: T.BinaryIO) -> d_t: @staticmethod def _get_hash_recursive(parents: T.List[T.Type]) -> int: if d_t in parents: return 0 - newparents = parents + [d_t] - tmphash = (0x21f0a3980ff1bd27+ Vector2d._get_hash_recursive(newparents)) & 0xffffffffffffffff - tmphash = (((tmphash<<1)&0xffffffffffffffff) + (tmphash>>63)) & 0xffffffffffffffff - return tmphash + return 0x3c8e046bf0680a0e _packed_fingerprint: T.Optional[bytes] = None diff --git a/test/symforce_function_codegen_test_data/sympy/codegen_dataclass_in_values_test_data/cpp/lcmtypes/codegen_test/my_dataclass_t.hpp b/test/symforce_function_codegen_test_data/sympy/codegen_dataclass_in_values_test_data/cpp/lcmtypes/codegen_test/my_dataclass_t.hpp index 9ab92537..84bef52b 100644 --- a/test/symforce_function_codegen_test_data/sympy/codegen_dataclass_in_values_test_data/cpp/lcmtypes/codegen_test/my_dataclass_t.hpp +++ b/test/symforce_function_codegen_test_data/sympy/codegen_dataclass_in_values_test_data/cpp/lcmtypes/codegen_test/my_dataclass_t.hpp @@ -101,12 +101,7 @@ class my_dataclass_t for(fp = p; fp != NULL; fp = fp->parent) if(fp->v == my_dataclass_t::getHash) return 0; - const __lcm_hash_ptr cp = { p, my_dataclass_t::getHash }; - - uint64_t hash = 0x34567803726f7424LL + - ::eigen_lcm::Vector4d::_computeHash(&cp); - - return (hash<<1) + ((hash>>63)&1); + return 0x6159ad42b5637810ULL; } // Comparison operators. diff --git a/test/symforce_function_codegen_test_data/sympy/codegen_dataclass_in_values_test_data/python/lcmtypes/codegen_test/_my_dataclass_t.py b/test/symforce_function_codegen_test_data/sympy/codegen_dataclass_in_values_test_data/python/lcmtypes/codegen_test/_my_dataclass_t.py index 0a1ae866..4ed001ce 100644 --- a/test/symforce_function_codegen_test_data/sympy/codegen_dataclass_in_values_test_data/python/lcmtypes/codegen_test/_my_dataclass_t.py +++ b/test/symforce_function_codegen_test_data/sympy/codegen_dataclass_in_values_test_data/python/lcmtypes/codegen_test/_my_dataclass_t.py @@ -96,10 +96,7 @@ def _decode_one(buf: T.BinaryIO) -> my_dataclass_t: @staticmethod def _get_hash_recursive(parents: T.List[T.Type]) -> int: if my_dataclass_t in parents: return 0 - newparents = parents + [my_dataclass_t] - tmphash = (0x34567803726f7424+ Vector4d._get_hash_recursive(newparents)) & 0xffffffffffffffff - tmphash = (((tmphash<<1)&0xffffffffffffffff) + (tmphash>>63)) & 0xffffffffffffffff - return tmphash + return 0x6159ad42b5637810 _packed_fingerprint: T.Optional[bytes] = None diff --git a/test/symforce_function_codegen_test_data/sympy/with_jacobians_values/cpp/lcmtypes/sym/d_out_t.hpp b/test/symforce_function_codegen_test_data/sympy/with_jacobians_values/cpp/lcmtypes/sym/d_out_t.hpp index cc006b26..19d819a5 100644 --- a/test/symforce_function_codegen_test_data/sympy/with_jacobians_values/cpp/lcmtypes/sym/d_out_t.hpp +++ b/test/symforce_function_codegen_test_data/sympy/with_jacobians_values/cpp/lcmtypes/sym/d_out_t.hpp @@ -96,8 +96,7 @@ class d_out_t inline __lcm_buffer_size _decodeNoHash(const void *buf, __lcm_buffer_size offset, __lcm_buffer_size maxlen); constexpr static uint64_t _computeHash(const __lcm_hash_ptr *) { - uint64_t hash = 0xd259512e30b44885LL; - return (hash<<1) + ((hash>>63)&1); + return 0xa4b2a25c6168910bULL; } // Comparison operators. diff --git a/test/symforce_function_codegen_test_data/sympy/with_jacobians_values/cpp/lcmtypes/sym/d_t.hpp b/test/symforce_function_codegen_test_data/sympy/with_jacobians_values/cpp/lcmtypes/sym/d_t.hpp index 1b44d7c6..0a1dfa6c 100644 --- a/test/symforce_function_codegen_test_data/sympy/with_jacobians_values/cpp/lcmtypes/sym/d_t.hpp +++ b/test/symforce_function_codegen_test_data/sympy/with_jacobians_values/cpp/lcmtypes/sym/d_t.hpp @@ -104,12 +104,7 @@ class d_t for(fp = p; fp != NULL; fp = fp->parent) if(fp->v == d_t::getHash) return 0; - const __lcm_hash_ptr cp = { p, d_t::getHash }; - - uint64_t hash = 0x21f0a3980ff1bd27LL + - ::eigen_lcm::Vector2d::_computeHash(&cp); - - return (hash<<1) + ((hash>>63)&1); + return 0x3c8e046bf0680a0eULL; } // Comparison operators. diff --git a/test/symforce_function_codegen_test_data/sympy/with_jacobians_values/python/lcmtypes/sym/_d_out_t.py b/test/symforce_function_codegen_test_data/sympy/with_jacobians_values/python/lcmtypes/sym/_d_out_t.py index 2b2b9899..61e19a8f 100644 --- a/test/symforce_function_codegen_test_data/sympy/with_jacobians_values/python/lcmtypes/sym/_d_out_t.py +++ b/test/symforce_function_codegen_test_data/sympy/with_jacobians_values/python/lcmtypes/sym/_d_out_t.py @@ -96,9 +96,7 @@ def _decode_one(buf: T.BinaryIO) -> d_out_t: @staticmethod def _get_hash_recursive(parents: T.List[T.Type]) -> int: if d_out_t in parents: return 0 - tmphash = (0xd259512e30b44885) & 0xffffffffffffffff - tmphash = (((tmphash<<1)&0xffffffffffffffff) + (tmphash>>63)) & 0xffffffffffffffff - return tmphash + return 0xa4b2a25c6168910b _packed_fingerprint: T.Optional[bytes] = None diff --git a/test/symforce_function_codegen_test_data/sympy/with_jacobians_values/python/lcmtypes/sym/_d_t.py b/test/symforce_function_codegen_test_data/sympy/with_jacobians_values/python/lcmtypes/sym/_d_t.py index e835faa2..36bf9ab4 100644 --- a/test/symforce_function_codegen_test_data/sympy/with_jacobians_values/python/lcmtypes/sym/_d_t.py +++ b/test/symforce_function_codegen_test_data/sympy/with_jacobians_values/python/lcmtypes/sym/_d_t.py @@ -103,10 +103,7 @@ def _decode_one(buf: T.BinaryIO) -> d_t: @staticmethod def _get_hash_recursive(parents: T.List[T.Type]) -> int: if d_t in parents: return 0 - newparents = parents + [d_t] - tmphash = (0x21f0a3980ff1bd27+ Vector2d._get_hash_recursive(newparents)) & 0xffffffffffffffff - tmphash = (((tmphash<<1)&0xffffffffffffffff) + (tmphash>>63)) & 0xffffffffffffffff - return tmphash + return 0x3c8e046bf0680a0e _packed_fingerprint: T.Optional[bytes] = None diff --git a/test/symforce_types_codegen_test.py b/test/symforce_types_codegen_test.py index 0961ce4d..b900ab1d 100644 --- a/test/symforce_types_codegen_test.py +++ b/test/symforce_types_codegen_test.py @@ -4,6 +4,8 @@ # ---------------------------------------------------------------------------- import copy +import json +from pathlib import Path import symforce @@ -57,6 +59,7 @@ def types_codegen_helper( scalar_type: str, shared_types: T.Mapping[str, str], expected_types: T.Sequence[str], + extra_dep_hash_files: T.Sequence[Path] = (), ) -> types_package_codegen.TypesCodegenData: """ Helper to test generation with less duplicated code. @@ -72,6 +75,7 @@ def types_codegen_helper( shared_types=shared_types, scalar_type=scalar_type, output_dir=output_dir, + dep_hash_files=[*extra_dep_hash_files], ) types_dict = codegen_data.types_dict @@ -190,11 +194,26 @@ def test_types_codegen_external(self) -> None: "external.vec_t", ) + # These external types are never emitted, so feed skymarshal synthetic hashes. Safe only + # because this test checks codegen structure and never builds the generated code. + dummy_dir = self.make_output_dir("sf_types_codegen_dummy_hashes_") + dummy_hash_path = dummy_dir / "dummy_external_hashes.json" + dummy_hash_path.write_text( + json.dumps( + { + "other_module.bar_t": "0x0000000000000001", + "external.zoomba_t": "0x0000000000000002", + "external.vec_t": "0x0000000000000003", + } + ) + ) + self.types_codegen_helper( name="external", scalar_type="double", shared_types=shared_types, expected_types=expected_types, + extra_dep_hash_files=[dummy_hash_path], ) def test_types_codegen_reuse(self) -> None: diff --git a/third_party/eigen_lcm/lcmtypes/eigen_lcm_lcm/cpp/lcmtypes/eigen_lcm/Matrix24d.hpp b/third_party/eigen_lcm/lcmtypes/eigen_lcm_lcm/cpp/lcmtypes/eigen_lcm/Matrix24d.hpp index 1820eeb7..910e4870 100644 --- a/third_party/eigen_lcm/lcmtypes/eigen_lcm_lcm/cpp/lcmtypes/eigen_lcm/Matrix24d.hpp +++ b/third_party/eigen_lcm/lcmtypes/eigen_lcm_lcm/cpp/lcmtypes/eigen_lcm/Matrix24d.hpp @@ -111,8 +111,7 @@ class Matrix24d : public Eigen::Matrix { inline __lcm_buffer_size _decodeNoHash(const void* buf, __lcm_buffer_size offset, __lcm_buffer_size maxlen); constexpr static uint64_t _computeHash(const __lcm_hash_ptr*) { - uint64_t hash = 0x7e2b2f4ef42123f6LL; - return (hash << 1) + ((hash >> 63) & 1); + return 0xb8f0546dd5ea48beULL; } }; diff --git a/third_party/eigen_lcm/lcmtypes/eigen_lcm_lcm/cpp/lcmtypes/eigen_lcm/Matrix2d.hpp b/third_party/eigen_lcm/lcmtypes/eigen_lcm_lcm/cpp/lcmtypes/eigen_lcm/Matrix2d.hpp index 06e605f1..936f18ff 100644 --- a/third_party/eigen_lcm/lcmtypes/eigen_lcm_lcm/cpp/lcmtypes/eigen_lcm/Matrix2d.hpp +++ b/third_party/eigen_lcm/lcmtypes/eigen_lcm_lcm/cpp/lcmtypes/eigen_lcm/Matrix2d.hpp @@ -111,8 +111,7 @@ class Matrix2d : public Eigen::Matrix { inline __lcm_buffer_size _decodeNoHash(const void* buf, __lcm_buffer_size offset, __lcm_buffer_size maxlen); constexpr static uint64_t _computeHash(const __lcm_hash_ptr*) { - uint64_t hash = 0x7e2b2f4ef42123f2LL; - return (hash << 1) + ((hash >> 63) & 1); + return 0xfc565e9de84247e4ULL; } }; diff --git a/third_party/eigen_lcm/lcmtypes/eigen_lcm_lcm/cpp/lcmtypes/eigen_lcm/Matrix2f.hpp b/third_party/eigen_lcm/lcmtypes/eigen_lcm_lcm/cpp/lcmtypes/eigen_lcm/Matrix2f.hpp index 8ce92cf5..474fdae8 100644 --- a/third_party/eigen_lcm/lcmtypes/eigen_lcm_lcm/cpp/lcmtypes/eigen_lcm/Matrix2f.hpp +++ b/third_party/eigen_lcm/lcmtypes/eigen_lcm_lcm/cpp/lcmtypes/eigen_lcm/Matrix2f.hpp @@ -111,8 +111,7 @@ class Matrix2f : public Eigen::Matrix { inline __lcm_buffer_size _decodeNoHash(const void* buf, __lcm_buffer_size offset, __lcm_buffer_size maxlen); constexpr static uint64_t _computeHash(const __lcm_hash_ptr*) { - uint64_t hash = 0x5c782a36eaf5245aLL; - return (hash << 1) + ((hash >> 63) & 1); + return 0xb8f0546dd5ea48b4ULL; } }; diff --git a/third_party/eigen_lcm/lcmtypes/eigen_lcm_lcm/cpp/lcmtypes/eigen_lcm/Matrix2i.hpp b/third_party/eigen_lcm/lcmtypes/eigen_lcm_lcm/cpp/lcmtypes/eigen_lcm/Matrix2i.hpp index 2c163a0e..35079591 100644 --- a/third_party/eigen_lcm/lcmtypes/eigen_lcm_lcm/cpp/lcmtypes/eigen_lcm/Matrix2i.hpp +++ b/third_party/eigen_lcm/lcmtypes/eigen_lcm_lcm/cpp/lcmtypes/eigen_lcm/Matrix2i.hpp @@ -111,8 +111,7 @@ class Matrix2i : public Eigen::Matrix { inline __lcm_buffer_size _decodeNoHash(const void* buf, __lcm_buffer_size offset, __lcm_buffer_size maxlen); constexpr static uint64_t _computeHash(const __lcm_hash_ptr*) { - uint64_t hash = 0xfbf54881202cbe2dLL; - return (hash << 1) + ((hash >> 63) & 1); + return 0xf7ea910240597c5bULL; } }; diff --git a/third_party/eigen_lcm/lcmtypes/eigen_lcm_lcm/cpp/lcmtypes/eigen_lcm/Matrix34d.hpp b/third_party/eigen_lcm/lcmtypes/eigen_lcm_lcm/cpp/lcmtypes/eigen_lcm/Matrix34d.hpp index 8b76914b..612b26d3 100644 --- a/third_party/eigen_lcm/lcmtypes/eigen_lcm_lcm/cpp/lcmtypes/eigen_lcm/Matrix34d.hpp +++ b/third_party/eigen_lcm/lcmtypes/eigen_lcm_lcm/cpp/lcmtypes/eigen_lcm/Matrix34d.hpp @@ -111,8 +111,7 @@ class Matrix34d : public Eigen::Matrix { inline __lcm_buffer_size _decodeNoHash(const void* buf, __lcm_buffer_size offset, __lcm_buffer_size maxlen); constexpr static uint64_t _computeHash(const __lcm_hash_ptr*) { - uint64_t hash = 0x2b2f4ef42124f02eLL; - return (hash << 1) + ((hash >> 63) & 1); + return 0xb8f0546dd5ea48beULL; } }; diff --git a/third_party/eigen_lcm/lcmtypes/eigen_lcm_lcm/cpp/lcmtypes/eigen_lcm/Matrix3d.hpp b/third_party/eigen_lcm/lcmtypes/eigen_lcm_lcm/cpp/lcmtypes/eigen_lcm/Matrix3d.hpp index 97319772..c2d243e5 100644 --- a/third_party/eigen_lcm/lcmtypes/eigen_lcm_lcm/cpp/lcmtypes/eigen_lcm/Matrix3d.hpp +++ b/third_party/eigen_lcm/lcmtypes/eigen_lcm_lcm/cpp/lcmtypes/eigen_lcm/Matrix3d.hpp @@ -111,8 +111,7 @@ class Matrix3d : public Eigen::Matrix { inline __lcm_buffer_size _decodeNoHash(const void* buf, __lcm_buffer_size offset, __lcm_buffer_size maxlen); constexpr static uint64_t _computeHash(const __lcm_hash_ptr*) { - uint64_t hash = 0x7e2b2f4ef42123f7LL; - return (hash << 1) + ((hash >> 63) & 1); + return 0xfc565e9de84247eeULL; } }; diff --git a/third_party/eigen_lcm/lcmtypes/eigen_lcm_lcm/cpp/lcmtypes/eigen_lcm/Matrix3f.hpp b/third_party/eigen_lcm/lcmtypes/eigen_lcm_lcm/cpp/lcmtypes/eigen_lcm/Matrix3f.hpp index 33cf850a..72696c14 100644 --- a/third_party/eigen_lcm/lcmtypes/eigen_lcm_lcm/cpp/lcmtypes/eigen_lcm/Matrix3f.hpp +++ b/third_party/eigen_lcm/lcmtypes/eigen_lcm_lcm/cpp/lcmtypes/eigen_lcm/Matrix3f.hpp @@ -111,8 +111,7 @@ class Matrix3f : public Eigen::Matrix { inline __lcm_buffer_size _decodeNoHash(const void* buf, __lcm_buffer_size offset, __lcm_buffer_size maxlen); constexpr static uint64_t _computeHash(const __lcm_hash_ptr*) { - uint64_t hash = 0x5c782a36eaf5245fLL; - return (hash << 1) + ((hash >> 63) & 1); + return 0xb8f0546dd5ea48beULL; } }; diff --git a/third_party/eigen_lcm/lcmtypes/eigen_lcm_lcm/cpp/lcmtypes/eigen_lcm/Matrix3i.hpp b/third_party/eigen_lcm/lcmtypes/eigen_lcm_lcm/cpp/lcmtypes/eigen_lcm/Matrix3i.hpp index 239f32a3..52f681d0 100644 --- a/third_party/eigen_lcm/lcmtypes/eigen_lcm_lcm/cpp/lcmtypes/eigen_lcm/Matrix3i.hpp +++ b/third_party/eigen_lcm/lcmtypes/eigen_lcm_lcm/cpp/lcmtypes/eigen_lcm/Matrix3i.hpp @@ -111,8 +111,7 @@ class Matrix3i : public Eigen::Matrix { inline __lcm_buffer_size _decodeNoHash(const void* buf, __lcm_buffer_size offset, __lcm_buffer_size maxlen); constexpr static uint64_t _computeHash(const __lcm_hash_ptr*) { - uint64_t hash = 0xfbf54881202cbe32LL; - return (hash << 1) + ((hash >> 63) & 1); + return 0xf7ea910240597c65ULL; } }; diff --git a/third_party/eigen_lcm/lcmtypes/eigen_lcm_lcm/cpp/lcmtypes/eigen_lcm/Matrix43f.hpp b/third_party/eigen_lcm/lcmtypes/eigen_lcm_lcm/cpp/lcmtypes/eigen_lcm/Matrix43f.hpp index 6057dda3..7db883da 100644 --- a/third_party/eigen_lcm/lcmtypes/eigen_lcm_lcm/cpp/lcmtypes/eigen_lcm/Matrix43f.hpp +++ b/third_party/eigen_lcm/lcmtypes/eigen_lcm_lcm/cpp/lcmtypes/eigen_lcm/Matrix43f.hpp @@ -111,8 +111,7 @@ class Matrix43f : public Eigen::Matrix { inline __lcm_buffer_size _decodeNoHash(const void* buf, __lcm_buffer_size offset, __lcm_buffer_size maxlen); constexpr static uint64_t _computeHash(const __lcm_hash_ptr*) { - uint64_t hash = 0x782a36eaf52557eaLL; - return (hash << 1) + ((hash >> 63) & 1); + return 0xb8f0546dd5ea48beULL; } }; diff --git a/third_party/eigen_lcm/lcmtypes/eigen_lcm_lcm/cpp/lcmtypes/eigen_lcm/Matrix4d.hpp b/third_party/eigen_lcm/lcmtypes/eigen_lcm_lcm/cpp/lcmtypes/eigen_lcm/Matrix4d.hpp index 0964ba3f..fbaebb5a 100644 --- a/third_party/eigen_lcm/lcmtypes/eigen_lcm_lcm/cpp/lcmtypes/eigen_lcm/Matrix4d.hpp +++ b/third_party/eigen_lcm/lcmtypes/eigen_lcm_lcm/cpp/lcmtypes/eigen_lcm/Matrix4d.hpp @@ -111,8 +111,7 @@ class Matrix4d : public Eigen::Matrix { inline __lcm_buffer_size _decodeNoHash(const void* buf, __lcm_buffer_size offset, __lcm_buffer_size maxlen); constexpr static uint64_t _computeHash(const __lcm_hash_ptr*) { - uint64_t hash = 0x2b2f4ef42124f032LL; - return (hash << 1) + ((hash >> 63) & 1); + return 0x565e9de84249e064ULL; } }; diff --git a/third_party/eigen_lcm/lcmtypes/eigen_lcm_lcm/cpp/lcmtypes/eigen_lcm/Matrix4f.hpp b/third_party/eigen_lcm/lcmtypes/eigen_lcm_lcm/cpp/lcmtypes/eigen_lcm/Matrix4f.hpp index 0d66b84f..60da1bae 100644 --- a/third_party/eigen_lcm/lcmtypes/eigen_lcm_lcm/cpp/lcmtypes/eigen_lcm/Matrix4f.hpp +++ b/third_party/eigen_lcm/lcmtypes/eigen_lcm_lcm/cpp/lcmtypes/eigen_lcm/Matrix4f.hpp @@ -111,8 +111,7 @@ class Matrix4f : public Eigen::Matrix { inline __lcm_buffer_size _decodeNoHash(const void* buf, __lcm_buffer_size offset, __lcm_buffer_size maxlen); constexpr static uint64_t _computeHash(const __lcm_hash_ptr*) { - uint64_t hash = 0x782a36eaf52557eeLL; - return (hash << 1) + ((hash >> 63) & 1); + return 0xf0546dd5ea4aafdcULL; } }; diff --git a/third_party/eigen_lcm/lcmtypes/eigen_lcm_lcm/cpp/lcmtypes/eigen_lcm/Matrix4i.hpp b/third_party/eigen_lcm/lcmtypes/eigen_lcm_lcm/cpp/lcmtypes/eigen_lcm/Matrix4i.hpp index 6b8fede0..1837d4fc 100644 --- a/third_party/eigen_lcm/lcmtypes/eigen_lcm_lcm/cpp/lcmtypes/eigen_lcm/Matrix4i.hpp +++ b/third_party/eigen_lcm/lcmtypes/eigen_lcm_lcm/cpp/lcmtypes/eigen_lcm/Matrix4i.hpp @@ -111,8 +111,7 @@ class Matrix4i : public Eigen::Matrix { inline __lcm_buffer_size _decodeNoHash(const void* buf, __lcm_buffer_size offset, __lcm_buffer_size maxlen); constexpr static uint64_t _computeHash(const __lcm_hash_ptr*) { - uint64_t hash = 0x0ab77edfd340d62dLL; - return (hash << 1) + ((hash >> 63) & 1); + return 0x156efdbfa681ac5aULL; } }; diff --git a/third_party/eigen_lcm/lcmtypes/eigen_lcm_lcm/cpp/lcmtypes/eigen_lcm/Matrix54d.hpp b/third_party/eigen_lcm/lcmtypes/eigen_lcm_lcm/cpp/lcmtypes/eigen_lcm/Matrix54d.hpp index cb1c06c8..d39d6527 100644 --- a/third_party/eigen_lcm/lcmtypes/eigen_lcm_lcm/cpp/lcmtypes/eigen_lcm/Matrix54d.hpp +++ b/third_party/eigen_lcm/lcmtypes/eigen_lcm_lcm/cpp/lcmtypes/eigen_lcm/Matrix54d.hpp @@ -111,8 +111,7 @@ class Matrix54d : public Eigen::Matrix { inline __lcm_buffer_size _decodeNoHash(const void* buf, __lcm_buffer_size offset, __lcm_buffer_size maxlen); constexpr static uint64_t _computeHash(const __lcm_hash_ptr*) { - uint64_t hash = 0x2b2f4ef42124f12cLL; - return (hash << 1) + ((hash >> 63) & 1); + return 0xb8f0546dd5ea48beULL; } }; diff --git a/third_party/eigen_lcm/lcmtypes/eigen_lcm_lcm/cpp/lcmtypes/eigen_lcm/Matrix68f.hpp b/third_party/eigen_lcm/lcmtypes/eigen_lcm_lcm/cpp/lcmtypes/eigen_lcm/Matrix68f.hpp index 50aacf88..bdac88a8 100644 --- a/third_party/eigen_lcm/lcmtypes/eigen_lcm_lcm/cpp/lcmtypes/eigen_lcm/Matrix68f.hpp +++ b/third_party/eigen_lcm/lcmtypes/eigen_lcm_lcm/cpp/lcmtypes/eigen_lcm/Matrix68f.hpp @@ -111,8 +111,7 @@ class Matrix68f : public Eigen::Matrix { inline __lcm_buffer_size _decodeNoHash(const void* buf, __lcm_buffer_size offset, __lcm_buffer_size maxlen); constexpr static uint64_t _computeHash(const __lcm_hash_ptr*) { - uint64_t hash = 0x782a36eaf5255af0LL; - return (hash << 1) + ((hash >> 63) & 1); + return 0xb8f0546dd5ea48beULL; } }; diff --git a/third_party/eigen_lcm/lcmtypes/eigen_lcm_lcm/cpp/lcmtypes/eigen_lcm/MatrixXd.hpp b/third_party/eigen_lcm/lcmtypes/eigen_lcm_lcm/cpp/lcmtypes/eigen_lcm/MatrixXd.hpp index 6efcaacb..2dfa8a71 100644 --- a/third_party/eigen_lcm/lcmtypes/eigen_lcm_lcm/cpp/lcmtypes/eigen_lcm/MatrixXd.hpp +++ b/third_party/eigen_lcm/lcmtypes/eigen_lcm_lcm/cpp/lcmtypes/eigen_lcm/MatrixXd.hpp @@ -110,8 +110,7 @@ class MatrixXd : public Eigen::Matrix> 63) & 1); + return 0xa4064a61f2c178f7ULL; } }; diff --git a/third_party/eigen_lcm/lcmtypes/eigen_lcm_lcm/cpp/lcmtypes/eigen_lcm/MatrixXf.hpp b/third_party/eigen_lcm/lcmtypes/eigen_lcm_lcm/cpp/lcmtypes/eigen_lcm/MatrixXf.hpp index 3f99ebf9..a94e92cd 100644 --- a/third_party/eigen_lcm/lcmtypes/eigen_lcm_lcm/cpp/lcmtypes/eigen_lcm/MatrixXf.hpp +++ b/third_party/eigen_lcm/lcmtypes/eigen_lcm_lcm/cpp/lcmtypes/eigen_lcm/MatrixXf.hpp @@ -110,8 +110,7 @@ class MatrixXf : public Eigen::Matrix> 63) & 1); + return 0xa560c3c8bd1d860ULL; } }; diff --git a/third_party/eigen_lcm/lcmtypes/eigen_lcm_lcm/cpp/lcmtypes/eigen_lcm/MatrixXi.hpp b/third_party/eigen_lcm/lcmtypes/eigen_lcm_lcm/cpp/lcmtypes/eigen_lcm/MatrixXi.hpp index 02e830b1..feace030 100644 --- a/third_party/eigen_lcm/lcmtypes/eigen_lcm_lcm/cpp/lcmtypes/eigen_lcm/MatrixXi.hpp +++ b/third_party/eigen_lcm/lcmtypes/eigen_lcm_lcm/cpp/lcmtypes/eigen_lcm/MatrixXi.hpp @@ -110,8 +110,7 @@ class MatrixXi : public Eigen::Matrix> 63) & 1); + return 0x5048bd2fa4e50ff1ULL; } }; diff --git a/third_party/eigen_lcm/lcmtypes/eigen_lcm_lcm/cpp/lcmtypes/eigen_lcm/Quaterniond.hpp b/third_party/eigen_lcm/lcmtypes/eigen_lcm_lcm/cpp/lcmtypes/eigen_lcm/Quaterniond.hpp index ea91e1ae..683acb85 100644 --- a/third_party/eigen_lcm/lcmtypes/eigen_lcm_lcm/cpp/lcmtypes/eigen_lcm/Quaterniond.hpp +++ b/third_party/eigen_lcm/lcmtypes/eigen_lcm_lcm/cpp/lcmtypes/eigen_lcm/Quaterniond.hpp @@ -116,8 +116,7 @@ class Quaterniond : public Eigen::Quaternion { inline __lcm_buffer_size _decodeNoHash(const void* buf, __lcm_buffer_size offset, __lcm_buffer_size maxlen); constexpr static uint64_t _computeHash(const __lcm_hash_ptr*) { - uint64_t hash = 0x7e535f5ac82123f2LL; - return (hash << 1) + ((hash >> 63) & 1); + return 0xfca6beb5904247e4ULL; } }; diff --git a/third_party/eigen_lcm/lcmtypes/eigen_lcm_lcm/cpp/lcmtypes/eigen_lcm/Quaternionf.hpp b/third_party/eigen_lcm/lcmtypes/eigen_lcm_lcm/cpp/lcmtypes/eigen_lcm/Quaternionf.hpp index ce96f867..d62afd5f 100644 --- a/third_party/eigen_lcm/lcmtypes/eigen_lcm_lcm/cpp/lcmtypes/eigen_lcm/Quaternionf.hpp +++ b/third_party/eigen_lcm/lcmtypes/eigen_lcm_lcm/cpp/lcmtypes/eigen_lcm/Quaternionf.hpp @@ -116,8 +116,7 @@ class Quaternionf : public Eigen::Quaternion { inline __lcm_buffer_size _decodeNoHash(const void* buf, __lcm_buffer_size offset, __lcm_buffer_size maxlen); constexpr static uint64_t _computeHash(const __lcm_hash_ptr*) { - uint64_t hash = 0x5c785266f6c9245aLL; - return (hash << 1) + ((hash >> 63) & 1); + return 0xb8f0a4cded9248b4ULL; } }; diff --git a/third_party/eigen_lcm/lcmtypes/eigen_lcm_lcm/cpp/lcmtypes/eigen_lcm/SymmetricMatrix2d.hpp b/third_party/eigen_lcm/lcmtypes/eigen_lcm_lcm/cpp/lcmtypes/eigen_lcm/SymmetricMatrix2d.hpp index 2c02e79c..c2d394fc 100644 --- a/third_party/eigen_lcm/lcmtypes/eigen_lcm_lcm/cpp/lcmtypes/eigen_lcm/SymmetricMatrix2d.hpp +++ b/third_party/eigen_lcm/lcmtypes/eigen_lcm_lcm/cpp/lcmtypes/eigen_lcm/SymmetricMatrix2d.hpp @@ -111,8 +111,7 @@ class SymmetricMatrix2d : public Eigen::Matrix { inline __lcm_buffer_size _decodeNoHash(const void* buf, __lcm_buffer_size offset, __lcm_buffer_size maxlen); constexpr static uint64_t _computeHash(const __lcm_hash_ptr*) { - uint64_t hash = 0x7e2b2f4ef42123f1LL; - return (hash << 1) + ((hash >> 63) & 1); + return 0xfc565e9de84247e2ULL; } }; diff --git a/third_party/eigen_lcm/lcmtypes/eigen_lcm_lcm/cpp/lcmtypes/eigen_lcm/SymmetricMatrix2f.hpp b/third_party/eigen_lcm/lcmtypes/eigen_lcm_lcm/cpp/lcmtypes/eigen_lcm/SymmetricMatrix2f.hpp index eb1d44f5..b17591b2 100644 --- a/third_party/eigen_lcm/lcmtypes/eigen_lcm_lcm/cpp/lcmtypes/eigen_lcm/SymmetricMatrix2f.hpp +++ b/third_party/eigen_lcm/lcmtypes/eigen_lcm_lcm/cpp/lcmtypes/eigen_lcm/SymmetricMatrix2f.hpp @@ -111,8 +111,7 @@ class SymmetricMatrix2f : public Eigen::Matrix { inline __lcm_buffer_size _decodeNoHash(const void* buf, __lcm_buffer_size offset, __lcm_buffer_size maxlen); constexpr static uint64_t _computeHash(const __lcm_hash_ptr*) { - uint64_t hash = 0x5c782a36eaf52459LL; - return (hash << 1) + ((hash >> 63) & 1); + return 0xb8f0546dd5ea48b2ULL; } }; diff --git a/third_party/eigen_lcm/lcmtypes/eigen_lcm_lcm/cpp/lcmtypes/eigen_lcm/SymmetricMatrix3d.hpp b/third_party/eigen_lcm/lcmtypes/eigen_lcm_lcm/cpp/lcmtypes/eigen_lcm/SymmetricMatrix3d.hpp index dd724305..7ea6a980 100644 --- a/third_party/eigen_lcm/lcmtypes/eigen_lcm_lcm/cpp/lcmtypes/eigen_lcm/SymmetricMatrix3d.hpp +++ b/third_party/eigen_lcm/lcmtypes/eigen_lcm_lcm/cpp/lcmtypes/eigen_lcm/SymmetricMatrix3d.hpp @@ -111,8 +111,7 @@ class SymmetricMatrix3d : public Eigen::Matrix { inline __lcm_buffer_size _decodeNoHash(const void* buf, __lcm_buffer_size offset, __lcm_buffer_size maxlen); constexpr static uint64_t _computeHash(const __lcm_hash_ptr*) { - uint64_t hash = 0x7e2b2f4ef42123f4LL; - return (hash << 1) + ((hash >> 63) & 1); + return 0xfc565e9de84247e8ULL; } }; diff --git a/third_party/eigen_lcm/lcmtypes/eigen_lcm_lcm/cpp/lcmtypes/eigen_lcm/SymmetricMatrix3f.hpp b/third_party/eigen_lcm/lcmtypes/eigen_lcm_lcm/cpp/lcmtypes/eigen_lcm/SymmetricMatrix3f.hpp index e04e65a0..da2dbe3c 100644 --- a/third_party/eigen_lcm/lcmtypes/eigen_lcm_lcm/cpp/lcmtypes/eigen_lcm/SymmetricMatrix3f.hpp +++ b/third_party/eigen_lcm/lcmtypes/eigen_lcm_lcm/cpp/lcmtypes/eigen_lcm/SymmetricMatrix3f.hpp @@ -111,8 +111,7 @@ class SymmetricMatrix3f : public Eigen::Matrix { inline __lcm_buffer_size _decodeNoHash(const void* buf, __lcm_buffer_size offset, __lcm_buffer_size maxlen); constexpr static uint64_t _computeHash(const __lcm_hash_ptr*) { - uint64_t hash = 0x5c782a36eaf5245cLL; - return (hash << 1) + ((hash >> 63) & 1); + return 0xb8f0546dd5ea48b8ULL; } }; diff --git a/third_party/eigen_lcm/lcmtypes/eigen_lcm_lcm/cpp/lcmtypes/eigen_lcm/SymmetricMatrix4d.hpp b/third_party/eigen_lcm/lcmtypes/eigen_lcm_lcm/cpp/lcmtypes/eigen_lcm/SymmetricMatrix4d.hpp index 01d5fe89..4373f607 100644 --- a/third_party/eigen_lcm/lcmtypes/eigen_lcm_lcm/cpp/lcmtypes/eigen_lcm/SymmetricMatrix4d.hpp +++ b/third_party/eigen_lcm/lcmtypes/eigen_lcm_lcm/cpp/lcmtypes/eigen_lcm/SymmetricMatrix4d.hpp @@ -111,8 +111,7 @@ class SymmetricMatrix4d : public Eigen::Matrix { inline __lcm_buffer_size _decodeNoHash(const void* buf, __lcm_buffer_size offset, __lcm_buffer_size maxlen); constexpr static uint64_t _computeHash(const __lcm_hash_ptr*) { - uint64_t hash = 0x2b2f4ef42124f02cLL; - return (hash << 1) + ((hash >> 63) & 1); + return 0x565e9de84249e058ULL; } }; diff --git a/third_party/eigen_lcm/lcmtypes/eigen_lcm_lcm/cpp/lcmtypes/eigen_lcm/SymmetricMatrix4f.hpp b/third_party/eigen_lcm/lcmtypes/eigen_lcm_lcm/cpp/lcmtypes/eigen_lcm/SymmetricMatrix4f.hpp index dc8834a8..b020b091 100644 --- a/third_party/eigen_lcm/lcmtypes/eigen_lcm_lcm/cpp/lcmtypes/eigen_lcm/SymmetricMatrix4f.hpp +++ b/third_party/eigen_lcm/lcmtypes/eigen_lcm_lcm/cpp/lcmtypes/eigen_lcm/SymmetricMatrix4f.hpp @@ -111,8 +111,7 @@ class SymmetricMatrix4f : public Eigen::Matrix { inline __lcm_buffer_size _decodeNoHash(const void* buf, __lcm_buffer_size offset, __lcm_buffer_size maxlen); constexpr static uint64_t _computeHash(const __lcm_hash_ptr*) { - uint64_t hash = 0x782a36eaf52557e8LL; - return (hash << 1) + ((hash >> 63) & 1); + return 0xf0546dd5ea4aafd0ULL; } }; diff --git a/third_party/eigen_lcm/lcmtypes/eigen_lcm_lcm/cpp/lcmtypes/eigen_lcm/SymmetricMatrixXd.hpp b/third_party/eigen_lcm/lcmtypes/eigen_lcm_lcm/cpp/lcmtypes/eigen_lcm/SymmetricMatrixXd.hpp index 853be47a..b4c6bf94 100644 --- a/third_party/eigen_lcm/lcmtypes/eigen_lcm_lcm/cpp/lcmtypes/eigen_lcm/SymmetricMatrixXd.hpp +++ b/third_party/eigen_lcm/lcmtypes/eigen_lcm_lcm/cpp/lcmtypes/eigen_lcm/SymmetricMatrixXd.hpp @@ -111,8 +111,7 @@ class SymmetricMatrixXd inline __lcm_buffer_size _decodeNoHash(const void* buf, __lcm_buffer_size offset, __lcm_buffer_size maxlen); constexpr static uint64_t _computeHash(const __lcm_hash_ptr*) { - uint64_t hash = 0x0f2cd494c850188bLL; - return (hash << 1) + ((hash >> 63) & 1); + return 0x1e59a92990a03116ULL; } }; diff --git a/third_party/eigen_lcm/lcmtypes/eigen_lcm_lcm/cpp/lcmtypes/eigen_lcm/SymmetricMatrixXf.hpp b/third_party/eigen_lcm/lcmtypes/eigen_lcm_lcm/cpp/lcmtypes/eigen_lcm/SymmetricMatrixXf.hpp index b196cada..c967c0d8 100644 --- a/third_party/eigen_lcm/lcmtypes/eigen_lcm_lcm/cpp/lcmtypes/eigen_lcm/SymmetricMatrixXf.hpp +++ b/third_party/eigen_lcm/lcmtypes/eigen_lcm_lcm/cpp/lcmtypes/eigen_lcm/SymmetricMatrixXf.hpp @@ -111,8 +111,7 @@ class SymmetricMatrixXf inline __lcm_buffer_size _decodeNoHash(const void* buf, __lcm_buffer_size offset, __lcm_buffer_size maxlen); constexpr static uint64_t _computeHash(const __lcm_hash_ptr*) { - uint64_t hash = 0x8151d60c7c2a63eeLL; - return (hash << 1) + ((hash >> 63) & 1); + return 0x2a3ac18f854c7ddULL; } }; diff --git a/third_party/eigen_lcm/lcmtypes/eigen_lcm_lcm/cpp/lcmtypes/eigen_lcm/Vector1d.hpp b/third_party/eigen_lcm/lcmtypes/eigen_lcm_lcm/cpp/lcmtypes/eigen_lcm/Vector1d.hpp index c7d184b1..0eb033eb 100644 --- a/third_party/eigen_lcm/lcmtypes/eigen_lcm_lcm/cpp/lcmtypes/eigen_lcm/Vector1d.hpp +++ b/third_party/eigen_lcm/lcmtypes/eigen_lcm_lcm/cpp/lcmtypes/eigen_lcm/Vector1d.hpp @@ -111,8 +111,7 @@ class Vector1d : public Eigen::Matrix { inline __lcm_buffer_size _decodeNoHash(const void* buf, __lcm_buffer_size offset, __lcm_buffer_size maxlen); constexpr static uint64_t _computeHash(const __lcm_hash_ptr*) { - uint64_t hash = 0x7e2b2f4ef42123efLL; - return (hash << 1) + ((hash >> 63) & 1); + return 0xfc565e9de84247deULL; } }; diff --git a/third_party/eigen_lcm/lcmtypes/eigen_lcm_lcm/cpp/lcmtypes/eigen_lcm/Vector1f.hpp b/third_party/eigen_lcm/lcmtypes/eigen_lcm_lcm/cpp/lcmtypes/eigen_lcm/Vector1f.hpp index 2d711e37..8f63a5f9 100644 --- a/third_party/eigen_lcm/lcmtypes/eigen_lcm_lcm/cpp/lcmtypes/eigen_lcm/Vector1f.hpp +++ b/third_party/eigen_lcm/lcmtypes/eigen_lcm_lcm/cpp/lcmtypes/eigen_lcm/Vector1f.hpp @@ -111,8 +111,7 @@ class Vector1f : public Eigen::Matrix { inline __lcm_buffer_size _decodeNoHash(const void* buf, __lcm_buffer_size offset, __lcm_buffer_size maxlen); constexpr static uint64_t _computeHash(const __lcm_hash_ptr*) { - uint64_t hash = 0x5c782a36eaf52457LL; - return (hash << 1) + ((hash >> 63) & 1); + return 0xb8f0546dd5ea48aeULL; } }; diff --git a/third_party/eigen_lcm/lcmtypes/eigen_lcm_lcm/cpp/lcmtypes/eigen_lcm/Vector1i.hpp b/third_party/eigen_lcm/lcmtypes/eigen_lcm_lcm/cpp/lcmtypes/eigen_lcm/Vector1i.hpp index e960edaa..654e8ba7 100644 --- a/third_party/eigen_lcm/lcmtypes/eigen_lcm_lcm/cpp/lcmtypes/eigen_lcm/Vector1i.hpp +++ b/third_party/eigen_lcm/lcmtypes/eigen_lcm_lcm/cpp/lcmtypes/eigen_lcm/Vector1i.hpp @@ -111,8 +111,7 @@ class Vector1i : public Eigen::Matrix { inline __lcm_buffer_size _decodeNoHash(const void* buf, __lcm_buffer_size offset, __lcm_buffer_size maxlen); constexpr static uint64_t _computeHash(const __lcm_hash_ptr*) { - uint64_t hash = 0xfbf54881202cbe2aLL; - return (hash << 1) + ((hash >> 63) & 1); + return 0xf7ea910240597c55ULL; } }; diff --git a/third_party/eigen_lcm/lcmtypes/eigen_lcm_lcm/cpp/lcmtypes/eigen_lcm/Vector2d.hpp b/third_party/eigen_lcm/lcmtypes/eigen_lcm_lcm/cpp/lcmtypes/eigen_lcm/Vector2d.hpp index 94c4a49b..dad4f9a2 100644 --- a/third_party/eigen_lcm/lcmtypes/eigen_lcm_lcm/cpp/lcmtypes/eigen_lcm/Vector2d.hpp +++ b/third_party/eigen_lcm/lcmtypes/eigen_lcm_lcm/cpp/lcmtypes/eigen_lcm/Vector2d.hpp @@ -111,8 +111,7 @@ class Vector2d : public Eigen::Matrix { inline __lcm_buffer_size _decodeNoHash(const void* buf, __lcm_buffer_size offset, __lcm_buffer_size maxlen); constexpr static uint64_t _computeHash(const __lcm_hash_ptr*) { - uint64_t hash = 0x7e2b2f4ef42123f0LL; - return (hash << 1) + ((hash >> 63) & 1); + return 0xfc565e9de84247e0ULL; } }; diff --git a/third_party/eigen_lcm/lcmtypes/eigen_lcm_lcm/cpp/lcmtypes/eigen_lcm/Vector2f.hpp b/third_party/eigen_lcm/lcmtypes/eigen_lcm_lcm/cpp/lcmtypes/eigen_lcm/Vector2f.hpp index 82154ac4..92745901 100644 --- a/third_party/eigen_lcm/lcmtypes/eigen_lcm_lcm/cpp/lcmtypes/eigen_lcm/Vector2f.hpp +++ b/third_party/eigen_lcm/lcmtypes/eigen_lcm_lcm/cpp/lcmtypes/eigen_lcm/Vector2f.hpp @@ -111,8 +111,7 @@ class Vector2f : public Eigen::Matrix { inline __lcm_buffer_size _decodeNoHash(const void* buf, __lcm_buffer_size offset, __lcm_buffer_size maxlen); constexpr static uint64_t _computeHash(const __lcm_hash_ptr*) { - uint64_t hash = 0x5c782a36eaf52458LL; - return (hash << 1) + ((hash >> 63) & 1); + return 0xb8f0546dd5ea48b0ULL; } }; diff --git a/third_party/eigen_lcm/lcmtypes/eigen_lcm_lcm/cpp/lcmtypes/eigen_lcm/Vector2i.hpp b/third_party/eigen_lcm/lcmtypes/eigen_lcm_lcm/cpp/lcmtypes/eigen_lcm/Vector2i.hpp index 23ebf175..a307a407 100644 --- a/third_party/eigen_lcm/lcmtypes/eigen_lcm_lcm/cpp/lcmtypes/eigen_lcm/Vector2i.hpp +++ b/third_party/eigen_lcm/lcmtypes/eigen_lcm_lcm/cpp/lcmtypes/eigen_lcm/Vector2i.hpp @@ -111,8 +111,7 @@ class Vector2i : public Eigen::Matrix { inline __lcm_buffer_size _decodeNoHash(const void* buf, __lcm_buffer_size offset, __lcm_buffer_size maxlen); constexpr static uint64_t _computeHash(const __lcm_hash_ptr*) { - uint64_t hash = 0xfbf54881202cbe2bLL; - return (hash << 1) + ((hash >> 63) & 1); + return 0xf7ea910240597c57ULL; } }; diff --git a/third_party/eigen_lcm/lcmtypes/eigen_lcm_lcm/cpp/lcmtypes/eigen_lcm/Vector3d.hpp b/third_party/eigen_lcm/lcmtypes/eigen_lcm_lcm/cpp/lcmtypes/eigen_lcm/Vector3d.hpp index 06ca50b0..7bdc1922 100644 --- a/third_party/eigen_lcm/lcmtypes/eigen_lcm_lcm/cpp/lcmtypes/eigen_lcm/Vector3d.hpp +++ b/third_party/eigen_lcm/lcmtypes/eigen_lcm_lcm/cpp/lcmtypes/eigen_lcm/Vector3d.hpp @@ -111,8 +111,7 @@ class Vector3d : public Eigen::Matrix { inline __lcm_buffer_size _decodeNoHash(const void* buf, __lcm_buffer_size offset, __lcm_buffer_size maxlen); constexpr static uint64_t _computeHash(const __lcm_hash_ptr*) { - uint64_t hash = 0x7e2b2f4ef42123f1LL; - return (hash << 1) + ((hash >> 63) & 1); + return 0xfc565e9de84247e2ULL; } }; diff --git a/third_party/eigen_lcm/lcmtypes/eigen_lcm_lcm/cpp/lcmtypes/eigen_lcm/Vector3f.hpp b/third_party/eigen_lcm/lcmtypes/eigen_lcm_lcm/cpp/lcmtypes/eigen_lcm/Vector3f.hpp index 2a6e0099..5ced087b 100644 --- a/third_party/eigen_lcm/lcmtypes/eigen_lcm_lcm/cpp/lcmtypes/eigen_lcm/Vector3f.hpp +++ b/third_party/eigen_lcm/lcmtypes/eigen_lcm_lcm/cpp/lcmtypes/eigen_lcm/Vector3f.hpp @@ -111,8 +111,7 @@ class Vector3f : public Eigen::Matrix { inline __lcm_buffer_size _decodeNoHash(const void* buf, __lcm_buffer_size offset, __lcm_buffer_size maxlen); constexpr static uint64_t _computeHash(const __lcm_hash_ptr*) { - uint64_t hash = 0x5c782a36eaf52459LL; - return (hash << 1) + ((hash >> 63) & 1); + return 0xb8f0546dd5ea48b2ULL; } }; diff --git a/third_party/eigen_lcm/lcmtypes/eigen_lcm_lcm/cpp/lcmtypes/eigen_lcm/Vector3i.hpp b/third_party/eigen_lcm/lcmtypes/eigen_lcm_lcm/cpp/lcmtypes/eigen_lcm/Vector3i.hpp index 87170ef5..38070f54 100644 --- a/third_party/eigen_lcm/lcmtypes/eigen_lcm_lcm/cpp/lcmtypes/eigen_lcm/Vector3i.hpp +++ b/third_party/eigen_lcm/lcmtypes/eigen_lcm_lcm/cpp/lcmtypes/eigen_lcm/Vector3i.hpp @@ -111,8 +111,7 @@ class Vector3i : public Eigen::Matrix { inline __lcm_buffer_size _decodeNoHash(const void* buf, __lcm_buffer_size offset, __lcm_buffer_size maxlen); constexpr static uint64_t _computeHash(const __lcm_hash_ptr*) { - uint64_t hash = 0xfbf54881202cbe2cLL; - return (hash << 1) + ((hash >> 63) & 1); + return 0xf7ea910240597c59ULL; } }; diff --git a/third_party/eigen_lcm/lcmtypes/eigen_lcm_lcm/cpp/lcmtypes/eigen_lcm/Vector4d.hpp b/third_party/eigen_lcm/lcmtypes/eigen_lcm_lcm/cpp/lcmtypes/eigen_lcm/Vector4d.hpp index ebe7f07c..46d1b400 100644 --- a/third_party/eigen_lcm/lcmtypes/eigen_lcm_lcm/cpp/lcmtypes/eigen_lcm/Vector4d.hpp +++ b/third_party/eigen_lcm/lcmtypes/eigen_lcm_lcm/cpp/lcmtypes/eigen_lcm/Vector4d.hpp @@ -111,8 +111,7 @@ class Vector4d : public Eigen::Matrix { inline __lcm_buffer_size _decodeNoHash(const void* buf, __lcm_buffer_size offset, __lcm_buffer_size maxlen); constexpr static uint64_t _computeHash(const __lcm_hash_ptr*) { - uint64_t hash = 0x7e2b2f4ef42123f2LL; - return (hash << 1) + ((hash >> 63) & 1); + return 0xfc565e9de84247e4ULL; } }; diff --git a/third_party/eigen_lcm/lcmtypes/eigen_lcm_lcm/cpp/lcmtypes/eigen_lcm/Vector4f.hpp b/third_party/eigen_lcm/lcmtypes/eigen_lcm_lcm/cpp/lcmtypes/eigen_lcm/Vector4f.hpp index 2490bae0..8d032243 100644 --- a/third_party/eigen_lcm/lcmtypes/eigen_lcm_lcm/cpp/lcmtypes/eigen_lcm/Vector4f.hpp +++ b/third_party/eigen_lcm/lcmtypes/eigen_lcm_lcm/cpp/lcmtypes/eigen_lcm/Vector4f.hpp @@ -111,8 +111,7 @@ class Vector4f : public Eigen::Matrix { inline __lcm_buffer_size _decodeNoHash(const void* buf, __lcm_buffer_size offset, __lcm_buffer_size maxlen); constexpr static uint64_t _computeHash(const __lcm_hash_ptr*) { - uint64_t hash = 0x5c782a36eaf5245aLL; - return (hash << 1) + ((hash >> 63) & 1); + return 0xb8f0546dd5ea48b4ULL; } }; diff --git a/third_party/eigen_lcm/lcmtypes/eigen_lcm_lcm/cpp/lcmtypes/eigen_lcm/Vector4i.hpp b/third_party/eigen_lcm/lcmtypes/eigen_lcm_lcm/cpp/lcmtypes/eigen_lcm/Vector4i.hpp index f3fa993c..7971aff2 100644 --- a/third_party/eigen_lcm/lcmtypes/eigen_lcm_lcm/cpp/lcmtypes/eigen_lcm/Vector4i.hpp +++ b/third_party/eigen_lcm/lcmtypes/eigen_lcm_lcm/cpp/lcmtypes/eigen_lcm/Vector4i.hpp @@ -111,8 +111,7 @@ class Vector4i : public Eigen::Matrix { inline __lcm_buffer_size _decodeNoHash(const void* buf, __lcm_buffer_size offset, __lcm_buffer_size maxlen); constexpr static uint64_t _computeHash(const __lcm_hash_ptr*) { - uint64_t hash = 0xfbf54881202cbe2dLL; - return (hash << 1) + ((hash >> 63) & 1); + return 0xf7ea910240597c5bULL; } }; diff --git a/third_party/eigen_lcm/lcmtypes/eigen_lcm_lcm/cpp/lcmtypes/eigen_lcm/Vector5d.hpp b/third_party/eigen_lcm/lcmtypes/eigen_lcm_lcm/cpp/lcmtypes/eigen_lcm/Vector5d.hpp index 9c72ad8f..901c303c 100644 --- a/third_party/eigen_lcm/lcmtypes/eigen_lcm_lcm/cpp/lcmtypes/eigen_lcm/Vector5d.hpp +++ b/third_party/eigen_lcm/lcmtypes/eigen_lcm_lcm/cpp/lcmtypes/eigen_lcm/Vector5d.hpp @@ -111,8 +111,7 @@ class Vector5d : public Eigen::Matrix { inline __lcm_buffer_size _decodeNoHash(const void* buf, __lcm_buffer_size offset, __lcm_buffer_size maxlen); constexpr static uint64_t _computeHash(const __lcm_hash_ptr*) { - uint64_t hash = 0x7e2b2f4ef42123f3LL; - return (hash << 1) + ((hash >> 63) & 1); + return 0xfc565e9de84247e6ULL; } }; diff --git a/third_party/eigen_lcm/lcmtypes/eigen_lcm_lcm/cpp/lcmtypes/eigen_lcm/Vector5f.hpp b/third_party/eigen_lcm/lcmtypes/eigen_lcm_lcm/cpp/lcmtypes/eigen_lcm/Vector5f.hpp index 35599dda..75d41948 100644 --- a/third_party/eigen_lcm/lcmtypes/eigen_lcm_lcm/cpp/lcmtypes/eigen_lcm/Vector5f.hpp +++ b/third_party/eigen_lcm/lcmtypes/eigen_lcm_lcm/cpp/lcmtypes/eigen_lcm/Vector5f.hpp @@ -111,8 +111,7 @@ class Vector5f : public Eigen::Matrix { inline __lcm_buffer_size _decodeNoHash(const void* buf, __lcm_buffer_size offset, __lcm_buffer_size maxlen); constexpr static uint64_t _computeHash(const __lcm_hash_ptr*) { - uint64_t hash = 0x5c782a36eaf5245bLL; - return (hash << 1) + ((hash >> 63) & 1); + return 0xb8f0546dd5ea48b6ULL; } }; diff --git a/third_party/eigen_lcm/lcmtypes/eigen_lcm_lcm/cpp/lcmtypes/eigen_lcm/Vector5i.hpp b/third_party/eigen_lcm/lcmtypes/eigen_lcm_lcm/cpp/lcmtypes/eigen_lcm/Vector5i.hpp index 8521bd30..8d19a67f 100644 --- a/third_party/eigen_lcm/lcmtypes/eigen_lcm_lcm/cpp/lcmtypes/eigen_lcm/Vector5i.hpp +++ b/third_party/eigen_lcm/lcmtypes/eigen_lcm_lcm/cpp/lcmtypes/eigen_lcm/Vector5i.hpp @@ -111,8 +111,7 @@ class Vector5i : public Eigen::Matrix { inline __lcm_buffer_size _decodeNoHash(const void* buf, __lcm_buffer_size offset, __lcm_buffer_size maxlen); constexpr static uint64_t _computeHash(const __lcm_hash_ptr*) { - uint64_t hash = 0xfbf54881202cbe2eLL; - return (hash << 1) + ((hash >> 63) & 1); + return 0xf7ea910240597c5dULL; } }; diff --git a/third_party/eigen_lcm/lcmtypes/eigen_lcm_lcm/cpp/lcmtypes/eigen_lcm/Vector6d.hpp b/third_party/eigen_lcm/lcmtypes/eigen_lcm_lcm/cpp/lcmtypes/eigen_lcm/Vector6d.hpp index 0b51b06b..0fd27933 100644 --- a/third_party/eigen_lcm/lcmtypes/eigen_lcm_lcm/cpp/lcmtypes/eigen_lcm/Vector6d.hpp +++ b/third_party/eigen_lcm/lcmtypes/eigen_lcm_lcm/cpp/lcmtypes/eigen_lcm/Vector6d.hpp @@ -111,8 +111,7 @@ class Vector6d : public Eigen::Matrix { inline __lcm_buffer_size _decodeNoHash(const void* buf, __lcm_buffer_size offset, __lcm_buffer_size maxlen); constexpr static uint64_t _computeHash(const __lcm_hash_ptr*) { - uint64_t hash = 0x7e2b2f4ef42123f4LL; - return (hash << 1) + ((hash >> 63) & 1); + return 0xfc565e9de84247e8ULL; } }; diff --git a/third_party/eigen_lcm/lcmtypes/eigen_lcm_lcm/cpp/lcmtypes/eigen_lcm/Vector6f.hpp b/third_party/eigen_lcm/lcmtypes/eigen_lcm_lcm/cpp/lcmtypes/eigen_lcm/Vector6f.hpp index b9a088d5..b22cffc0 100644 --- a/third_party/eigen_lcm/lcmtypes/eigen_lcm_lcm/cpp/lcmtypes/eigen_lcm/Vector6f.hpp +++ b/third_party/eigen_lcm/lcmtypes/eigen_lcm_lcm/cpp/lcmtypes/eigen_lcm/Vector6f.hpp @@ -111,8 +111,7 @@ class Vector6f : public Eigen::Matrix { inline __lcm_buffer_size _decodeNoHash(const void* buf, __lcm_buffer_size offset, __lcm_buffer_size maxlen); constexpr static uint64_t _computeHash(const __lcm_hash_ptr*) { - uint64_t hash = 0x5c782a36eaf5245cLL; - return (hash << 1) + ((hash >> 63) & 1); + return 0xb8f0546dd5ea48b8ULL; } }; diff --git a/third_party/eigen_lcm/lcmtypes/eigen_lcm_lcm/cpp/lcmtypes/eigen_lcm/Vector6i.hpp b/third_party/eigen_lcm/lcmtypes/eigen_lcm_lcm/cpp/lcmtypes/eigen_lcm/Vector6i.hpp index c80456da..47ca19a1 100644 --- a/third_party/eigen_lcm/lcmtypes/eigen_lcm_lcm/cpp/lcmtypes/eigen_lcm/Vector6i.hpp +++ b/third_party/eigen_lcm/lcmtypes/eigen_lcm_lcm/cpp/lcmtypes/eigen_lcm/Vector6i.hpp @@ -111,8 +111,7 @@ class Vector6i : public Eigen::Matrix { inline __lcm_buffer_size _decodeNoHash(const void* buf, __lcm_buffer_size offset, __lcm_buffer_size maxlen); constexpr static uint64_t _computeHash(const __lcm_hash_ptr*) { - uint64_t hash = 0xfbf54881202cbe2fLL; - return (hash << 1) + ((hash >> 63) & 1); + return 0xf7ea910240597c5fULL; } }; diff --git a/third_party/eigen_lcm/lcmtypes/eigen_lcm_lcm/cpp/lcmtypes/eigen_lcm/Vector7d.hpp b/third_party/eigen_lcm/lcmtypes/eigen_lcm_lcm/cpp/lcmtypes/eigen_lcm/Vector7d.hpp index 877d5584..5ed7d841 100644 --- a/third_party/eigen_lcm/lcmtypes/eigen_lcm_lcm/cpp/lcmtypes/eigen_lcm/Vector7d.hpp +++ b/third_party/eigen_lcm/lcmtypes/eigen_lcm_lcm/cpp/lcmtypes/eigen_lcm/Vector7d.hpp @@ -111,8 +111,7 @@ class Vector7d : public Eigen::Matrix { inline __lcm_buffer_size _decodeNoHash(const void* buf, __lcm_buffer_size offset, __lcm_buffer_size maxlen); constexpr static uint64_t _computeHash(const __lcm_hash_ptr*) { - uint64_t hash = 0x7e2b2f4ef42123f5LL; - return (hash << 1) + ((hash >> 63) & 1); + return 0xfc565e9de84247eaULL; } }; diff --git a/third_party/eigen_lcm/lcmtypes/eigen_lcm_lcm/cpp/lcmtypes/eigen_lcm/Vector7f.hpp b/third_party/eigen_lcm/lcmtypes/eigen_lcm_lcm/cpp/lcmtypes/eigen_lcm/Vector7f.hpp index 7d38decb..91cbb1e3 100644 --- a/third_party/eigen_lcm/lcmtypes/eigen_lcm_lcm/cpp/lcmtypes/eigen_lcm/Vector7f.hpp +++ b/third_party/eigen_lcm/lcmtypes/eigen_lcm_lcm/cpp/lcmtypes/eigen_lcm/Vector7f.hpp @@ -111,8 +111,7 @@ class Vector7f : public Eigen::Matrix { inline __lcm_buffer_size _decodeNoHash(const void* buf, __lcm_buffer_size offset, __lcm_buffer_size maxlen); constexpr static uint64_t _computeHash(const __lcm_hash_ptr*) { - uint64_t hash = 0x5c782a36eaf5245dLL; - return (hash << 1) + ((hash >> 63) & 1); + return 0xb8f0546dd5ea48baULL; } }; diff --git a/third_party/eigen_lcm/lcmtypes/eigen_lcm_lcm/cpp/lcmtypes/eigen_lcm/Vector7i.hpp b/third_party/eigen_lcm/lcmtypes/eigen_lcm_lcm/cpp/lcmtypes/eigen_lcm/Vector7i.hpp index 657fe72d..7a369789 100644 --- a/third_party/eigen_lcm/lcmtypes/eigen_lcm_lcm/cpp/lcmtypes/eigen_lcm/Vector7i.hpp +++ b/third_party/eigen_lcm/lcmtypes/eigen_lcm_lcm/cpp/lcmtypes/eigen_lcm/Vector7i.hpp @@ -111,8 +111,7 @@ class Vector7i : public Eigen::Matrix { inline __lcm_buffer_size _decodeNoHash(const void* buf, __lcm_buffer_size offset, __lcm_buffer_size maxlen); constexpr static uint64_t _computeHash(const __lcm_hash_ptr*) { - uint64_t hash = 0xfbf54881202cbe30LL; - return (hash << 1) + ((hash >> 63) & 1); + return 0xf7ea910240597c61ULL; } }; diff --git a/third_party/eigen_lcm/lcmtypes/eigen_lcm_lcm/cpp/lcmtypes/eigen_lcm/Vector8d.hpp b/third_party/eigen_lcm/lcmtypes/eigen_lcm_lcm/cpp/lcmtypes/eigen_lcm/Vector8d.hpp index b47006e9..7f1b54f2 100644 --- a/third_party/eigen_lcm/lcmtypes/eigen_lcm_lcm/cpp/lcmtypes/eigen_lcm/Vector8d.hpp +++ b/third_party/eigen_lcm/lcmtypes/eigen_lcm_lcm/cpp/lcmtypes/eigen_lcm/Vector8d.hpp @@ -111,8 +111,7 @@ class Vector8d : public Eigen::Matrix { inline __lcm_buffer_size _decodeNoHash(const void* buf, __lcm_buffer_size offset, __lcm_buffer_size maxlen); constexpr static uint64_t _computeHash(const __lcm_hash_ptr*) { - uint64_t hash = 0x7e2b2f4ef42123f6LL; - return (hash << 1) + ((hash >> 63) & 1); + return 0xfc565e9de84247ecULL; } }; diff --git a/third_party/eigen_lcm/lcmtypes/eigen_lcm_lcm/cpp/lcmtypes/eigen_lcm/Vector8f.hpp b/third_party/eigen_lcm/lcmtypes/eigen_lcm_lcm/cpp/lcmtypes/eigen_lcm/Vector8f.hpp index a13b4891..519d5d28 100644 --- a/third_party/eigen_lcm/lcmtypes/eigen_lcm_lcm/cpp/lcmtypes/eigen_lcm/Vector8f.hpp +++ b/third_party/eigen_lcm/lcmtypes/eigen_lcm_lcm/cpp/lcmtypes/eigen_lcm/Vector8f.hpp @@ -111,8 +111,7 @@ class Vector8f : public Eigen::Matrix { inline __lcm_buffer_size _decodeNoHash(const void* buf, __lcm_buffer_size offset, __lcm_buffer_size maxlen); constexpr static uint64_t _computeHash(const __lcm_hash_ptr*) { - uint64_t hash = 0x5c782a36eaf5245eLL; - return (hash << 1) + ((hash >> 63) & 1); + return 0xb8f0546dd5ea48bcULL; } }; diff --git a/third_party/eigen_lcm/lcmtypes/eigen_lcm_lcm/cpp/lcmtypes/eigen_lcm/Vector8i.hpp b/third_party/eigen_lcm/lcmtypes/eigen_lcm_lcm/cpp/lcmtypes/eigen_lcm/Vector8i.hpp index 3125b71d..6f76a372 100644 --- a/third_party/eigen_lcm/lcmtypes/eigen_lcm_lcm/cpp/lcmtypes/eigen_lcm/Vector8i.hpp +++ b/third_party/eigen_lcm/lcmtypes/eigen_lcm_lcm/cpp/lcmtypes/eigen_lcm/Vector8i.hpp @@ -111,8 +111,7 @@ class Vector8i : public Eigen::Matrix { inline __lcm_buffer_size _decodeNoHash(const void* buf, __lcm_buffer_size offset, __lcm_buffer_size maxlen); constexpr static uint64_t _computeHash(const __lcm_hash_ptr*) { - uint64_t hash = 0xfbf54881202cbe31LL; - return (hash << 1) + ((hash >> 63) & 1); + return 0xf7ea910240597c63ULL; } }; diff --git a/third_party/eigen_lcm/lcmtypes/eigen_lcm_lcm/cpp/lcmtypes/eigen_lcm/VectorXd.hpp b/third_party/eigen_lcm/lcmtypes/eigen_lcm_lcm/cpp/lcmtypes/eigen_lcm/VectorXd.hpp index 7d5c98d4..59ef8171 100644 --- a/third_party/eigen_lcm/lcmtypes/eigen_lcm_lcm/cpp/lcmtypes/eigen_lcm/VectorXd.hpp +++ b/third_party/eigen_lcm/lcmtypes/eigen_lcm_lcm/cpp/lcmtypes/eigen_lcm/VectorXd.hpp @@ -109,8 +109,7 @@ class VectorXd : public Eigen::Matrix> 63) & 1); + return 0xa20c8b8c647fa858ULL; } }; diff --git a/third_party/eigen_lcm/lcmtypes/eigen_lcm_lcm/cpp/lcmtypes/eigen_lcm/VectorXf.hpp b/third_party/eigen_lcm/lcmtypes/eigen_lcm_lcm/cpp/lcmtypes/eigen_lcm/VectorXf.hpp index e55fa1ef..c0dcd87a 100644 --- a/third_party/eigen_lcm/lcmtypes/eigen_lcm_lcm/cpp/lcmtypes/eigen_lcm/VectorXf.hpp +++ b/third_party/eigen_lcm/lcmtypes/eigen_lcm_lcm/cpp/lcmtypes/eigen_lcm/VectorXf.hpp @@ -109,8 +109,7 @@ class VectorXf : public Eigen::Matrix> 63) & 1); + return 0xa895f37d9f89a855ULL; } }; diff --git a/third_party/eigen_lcm/lcmtypes/eigen_lcm_lcm/cpp/lcmtypes/eigen_lcm/VectorXi.hpp b/third_party/eigen_lcm/lcmtypes/eigen_lcm_lcm/cpp/lcmtypes/eigen_lcm/VectorXi.hpp index e4418692..ae3254c2 100644 --- a/third_party/eigen_lcm/lcmtypes/eigen_lcm_lcm/cpp/lcmtypes/eigen_lcm/VectorXi.hpp +++ b/third_party/eigen_lcm/lcmtypes/eigen_lcm_lcm/cpp/lcmtypes/eigen_lcm/VectorXi.hpp @@ -109,8 +109,7 @@ class VectorXi : public Eigen::Matrix> 63) & 1); + return 0x268f734475056d8bULL; } }; diff --git a/third_party/skymarshal/cmake/skymarshal.cmake b/third_party/skymarshal/cmake/skymarshal.cmake index 6ec073d6..9cdf8eae 100644 --- a/third_party/skymarshal/cmake/skymarshal.cmake +++ b/third_party/skymarshal/cmake/skymarshal.cmake @@ -82,7 +82,11 @@ function(add_skymarshal_bindings target_name bindings_dir lcmtypes_dir) add_subdirectory(${CMAKE_CURRENT_FUNCTION_LIST_DIR}/.. EXCLUDE_FROM_ALL) endif() - cmake_parse_arguments(args "" "" "LANGUAGES" ${ARGN}) + # DEP_LCMTYPES_DIRS: directories of .lcm files for cross-package types referenced by + # ${lcmtypes_dir} (e.g. eigen_lcm). Each is compiled to a hash JSON and threaded into + # this invocation via --hash-deps-info so skymarshal's recursive-hash precompute can + # resolve cross-package references without emitting code for them here. + cmake_parse_arguments(args "" "" "LANGUAGES;DEP_LCMTYPES_DIRS" ${ARGN}) if(NOT args_LANGUAGES) set(args_LANGUAGES python cpp) endif() @@ -111,10 +115,31 @@ function(add_skymarshal_bindings target_name bindings_dir lcmtypes_dir) endif() endforeach() + # Compile each dep dir to a hash JSON for cross-package fingerprint resolution. + set(dep_hash_files) + set(dep_hash_outputs) + foreach(dep_dir ${args_DEP_LCMTYPES_DIRS}) + get_filename_component(dep_name ${dep_dir} NAME) + set(dep_hash_file ${bindings_dir}/${target_name}__${dep_name}__hash_info.json) + file(GLOB dep_lcm_sources CONFIGURE_DEPENDS ${dep_dir}/*.lcm) + add_custom_command( + OUTPUT ${dep_hash_file} + COMMAND ${SKYMARSHAL_PYTHON} -m skymarshal --hash-info-out ${dep_hash_file} -- ${dep_dir} + DEPENDS ${dep_lcm_sources} + ) + list(APPEND dep_hash_files ${dep_hash_file}) + list(APPEND dep_hash_outputs ${dep_hash_file}) + endforeach() + + if(dep_hash_files) + list(APPEND skymarshal_args --hash-deps-info ${dep_hash_files}) + endif() + file(GLOB lcm_sources CONFIGURE_DEPENDS ${lcmtypes_dir}/*.lcm) + # `--` terminates --hash-deps-info's nargs="*" capture so the source_path positional resolves. add_custom_command( OUTPUT ${outputs} - COMMAND ${SKYMARSHAL_PYTHON} -m skymarshal ${skymarshal_args} ${lcmtypes_dir} - DEPENDS ${lcm_sources} + COMMAND ${SKYMARSHAL_PYTHON} -m skymarshal ${skymarshal_args} -- ${lcmtypes_dir} + DEPENDS ${lcm_sources} ${dep_hash_outputs} ) endfunction() diff --git a/third_party/skymarshal/skymarshal/emit_helpers.py b/third_party/skymarshal/skymarshal/emit_helpers.py index 80bdd3ca..5b250ae9 100644 --- a/third_party/skymarshal/skymarshal/emit_helpers.py +++ b/third_party/skymarshal/skymarshal/emit_helpers.py @@ -83,6 +83,10 @@ def __init__(self, package, struct, args): def hash(self): return self.struct.compute_hash() + @property + def recursive_hash(self) -> int: + return self.struct.recursive_hash + class EnumBuilder(BaseBuilder): """Helper class for converting a 'lcm' enum into a destination code file.""" @@ -98,6 +102,10 @@ def __init__(self, package, enum, args): def hash(self): return self.enum.compute_hash() + @property + def recursive_hash(self) -> int: + return self.enum.recursive_hash + # TODO(matt): There are probably more shared methods and common patterns. diff --git a/third_party/skymarshal/skymarshal/skymarshal.py b/third_party/skymarshal/skymarshal/skymarshal.py index 9de67e85..424ecbb9 100644 --- a/third_party/skymarshal/skymarshal/skymarshal.py +++ b/third_party/skymarshal/skymarshal/skymarshal.py @@ -6,6 +6,7 @@ from __future__ import annotations import argparse +import json import os import shlex import sys @@ -43,6 +44,18 @@ def parse_args( help="Don't include the LCM source path in generated files", ) + parser.add_argument( + "--hash-deps-info", + nargs="*", + help="JSON files mapping cross-package lcmtype full names to their precomputed " + "recursive fingerprint hashes", + ) + + parser.add_argument( + "--hash-info-out", + help="Output path for a JSON map of full type name to recursive fingerprint hash", + ) + for lang in languages: lang.add_args(parser) @@ -88,11 +101,38 @@ def main( if options.print_def: print(packages) + # Precompute recursive hashes once; emitters render them as constants. + type_map = { + t.full_name: t + for package in packages + for t in package.type_definitions.values() + } + + # Cross-package hashes from upstream skymarshal invocations. + dep_hashes: T.Dict[str, int] = {} + for path in options.hash_deps_info or []: + with open(path) as f: + for full_name, hex_hash in json.load(f).items(): + dep_hashes[full_name] = int(hex_hash, 16) + + for t in type_map.values(): + t.recursive_hash = t.compute_recursive_hash(type_map, dep_hashes) + # Enum emitters operate on enum.equivalent_struct; mirror the hash there. + equivalent_struct = getattr(t, "equivalent_struct", None) + if equivalent_struct is not None: + equivalent_struct.recursive_hash = t.recursive_hash + files = {} for lang in languages: files.update(lang.create_files(packages, options)) + if options.hash_info_out: + files[options.hash_info_out] = json.dumps( + {full_name: f"0x{t.recursive_hash:016x}" for full_name, t in sorted(type_map.items())}, + indent=2, + ) + # Write any generated files that have changed. for filename, content in files.items(): dirname = os.path.dirname(filename) diff --git a/third_party/skymarshal/skymarshal/syntax_tree.py b/third_party/skymarshal/skymarshal/syntax_tree.py index f389eecd..9852756c 100644 --- a/third_party/skymarshal/skymarshal/syntax_tree.py +++ b/third_party/skymarshal/skymarshal/syntax_tree.py @@ -336,6 +336,8 @@ def __init__( self.notations = list(notations) self.reserved_ids = set(reserved_ids) self.source_file: T.Optional[str] = None + # Populated by skymarshal.main after cross-package hashes are loaded. + self.recursive_hash: int = 0 def set_source_file(self, source_file: str) -> None: self.source_file = source_file @@ -419,6 +421,14 @@ def reference_check(self) -> None: def compute_hash(self) -> Hash: return self.equivalent_struct.compute_hash() + def compute_recursive_hash( + self, + type_map: T.Mapping[str, T.Union[Struct, Enum]], + dep_hashes: T.Mapping[str, int], + parents: T.Optional[T.List[Struct]] = None, + ) -> int: + return self.equivalent_struct.compute_recursive_hash(type_map, dep_hashes, parents) + class EnumCase(AstNode): """A name/value case of an lcm enum type""" @@ -467,6 +477,8 @@ def __init__( self.type_ref = TypeRef(name) self.notations = list(notations) self.source_file: T.Optional[str] = None + # Populated by skymarshal.main after cross-package hashes are loaded. + self.recursive_hash: int = 0 def set_source_file(self, source_file: str) -> None: self.source_file = source_file @@ -605,6 +617,38 @@ def compute_hash(self) -> Hash: member.compute_hash(type_hash) return type_hash + def compute_recursive_hash( + self, + type_map: T.Mapping[str, T.Union[Struct, Enum]], + dep_hashes: T.Mapping[str, int], + parents: T.Optional[T.List[Struct]] = None, + ) -> int: + """Recursively compute the lcm fingerprint hash including referenced types. + + Cross-package types are resolved via dep_hashes from upstream skymarshal invocations. + """ + if parents is None: + parents = [] + if self in parents: + return 0 + h = self.compute_hash().int_value + new_parents = parents + [self] + for member in self.members: + if isinstance(member, ConstMember): + continue + if member.type_ref.is_primitive_type(): + continue + full_name = member.type_ref.full_name + sub = type_map.get(full_name) + if sub is not None: + sub_hash = sub.compute_recursive_hash(type_map, dep_hashes, new_parents) + elif full_name in dep_hashes: + sub_hash = dep_hashes[full_name] + else: + raise KeyError(f"compute_recursive_hash: cannot resolve {full_name}") + h = (h + sub_hash) & 0xFFFFFFFFFFFFFFFF + return ((h << 1) & 0xFFFFFFFFFFFFFFFF) | (h >> 63) + class ReservedFieldGroup(AstNode): """A group of reserved field ids""" diff --git a/third_party/skymarshal/skymarshal/templates/enumtype.hpp.template b/third_party/skymarshal/skymarshal/templates/enumtype.hpp.template index 757cee39..caa88657 100644 --- a/third_party/skymarshal/skymarshal/templates/enumtype.hpp.template +++ b/third_party/skymarshal/skymarshal/templates/enumtype.hpp.template @@ -216,8 +216,7 @@ constexpr const char * {{enumtype.name}}::getPackageName() constexpr uint64_t {{enumtype.name}}::_computeHash(const __lcm_hash_ptr *) { - uint64_t hash = {{enumtype.hash}}L; - return (hash<<1) + ((hash>>63)&1); + return {{ "0x%xULL" % enumtype.recursive_hash }}; } inline bool operator==(const {{enumtype.name}}& a, const {{enumtype.name}}& b) diff --git a/third_party/skymarshal/skymarshal/templates/lcmtype.hpp.template b/third_party/skymarshal/skymarshal/templates/lcmtype.hpp.template index 55ca8da8..3975e770 100644 --- a/third_party/skymarshal/skymarshal/templates/lcmtype.hpp.template +++ b/third_party/skymarshal/skymarshal/templates/lcmtype.hpp.template @@ -126,18 +126,12 @@ class {{lcmtype.name}} for(fp = p; fp != NULL; fp = fp->parent) if(fp->v == {{lcmtype.name}}::getHash) return 0; - const __lcm_hash_ptr cp = { p, {{lcmtype.name}}::getHash }; - - uint64_t hash = {{lcmtype.hash}}L + - {{ lcmtype.compute_hash() }}; - - return (hash<<1) + ((hash>>63)&1); + return {{ "0x%xULL" % lcmtype.recursive_hash }}; } {% else %} constexpr static uint64_t _computeHash(const __lcm_hash_ptr *) { - uint64_t hash = {{lcmtype.hash}}L; - return (hash<<1) + ((hash>>63)&1); + return {{ "0x%xULL" % lcmtype.recursive_hash }}; } {% endif %} {% if not lcmtype.args.cpp_no_operators %} diff --git a/third_party/skymarshal/skymarshal/templates/lcmtype.java.template b/third_party/skymarshal/skymarshal/templates/lcmtype.java.template index 22974bdf..2df2fd0b 100644 --- a/third_party/skymarshal/skymarshal/templates/lcmtype.java.template +++ b/third_party/skymarshal/skymarshal/templates/lcmtype.java.template @@ -47,15 +47,7 @@ public final class {{ lcmtype.name }} implements lcm.lcm.LCMEncodable { if (classes.contains({{ lcmtype.full_name }}.class)) return 0L; - - classes.add({{ lcmtype.full_name }}.class); - long hash = LCM_FINGERPRINT_BASE -{% for type_ref in lcmtype.complex_subtypes() %} - + {{ type_ref.full_name }}._hashRecursive(classes) -{% endfor %} - ; - classes.remove(classes.size() - 1); - return (hash<<1) + ((hash>>63)&1); + return {{ "0x%xL" % lcmtype.recursive_hash }}; } public void encode(DataOutput outs) throws IOException diff --git a/third_party/skymarshal/skymarshal/templates/python_enum.py.template b/third_party/skymarshal/skymarshal/templates/python_enum.py.template index 1cb233e7..c2b4d2ee 100644 --- a/third_party/skymarshal/skymarshal/templates/python_enum.py.template +++ b/third_party/skymarshal/skymarshal/templates/python_enum.py.template @@ -88,9 +88,7 @@ class {{enumtype.name}}(enum.Enum): def _get_hash_recursive(cls, parents: T.List[T.Type]) -> int: if cls in parents: return 0 - tmphash = ({{enumtype.hash.hex_no_padding()}}) & 0xffffffffffffffff - tmphash = (((tmphash<<1)&0xffffffffffffffff) + (tmphash>>63)) & 0xffffffffffffffff - return tmphash + return {{ "0x%x" % enumtype.recursive_hash }} @classmethod def _get_packed_fingerprint(cls) -> bytes: diff --git a/third_party/skymarshal/skymarshal/templates/python_struct.py.template b/third_party/skymarshal/skymarshal/templates/python_struct.py.template index 0c720e16..d90b14cd 100644 --- a/third_party/skymarshal/skymarshal/templates/python_struct.py.template +++ b/third_party/skymarshal/skymarshal/templates/python_struct.py.template @@ -127,12 +127,7 @@ class {{ lcmtype.name }}(object): @staticmethod def _get_hash_recursive(parents: T.List[T.Type]) -> int: if {{ lcmtype.name }} in parents: return 0 -{% if lcmtype.has_complex_members() %} - newparents = parents + [{{ lcmtype.name }}] -{% endif %} - tmphash = ({{ lcmtype.hash.hex_no_padding() }}{% for type_name, _ in lcmtype.complex_members() %}+ {{ type_name }}._get_hash_recursive(newparents){% endfor %}) & 0xffffffffffffffff - tmphash = (((tmphash<<1)&0xffffffffffffffff) + (tmphash>>63)) & 0xffffffffffffffff - return tmphash + return {{ "0x%x" % lcmtype.recursive_hash }} _packed_fingerprint: T.Optional[bytes] = None diff --git a/third_party/skymarshal/skymarshal/templates/typescript_enum.ts.template b/third_party/skymarshal/skymarshal/templates/typescript_enum.ts.template index 260651c5..1fdbe6af 100644 --- a/third_party/skymarshal/skymarshal/templates/typescript_enum.ts.template +++ b/third_party/skymarshal/skymarshal/templates/typescript_enum.ts.template @@ -20,7 +20,6 @@ enum option_t { {# -- Generate true lcm decoder -- #} export class {{enum_type.name}} extends LcmEnumMsg { public static override option_t = option_t; - private static _hash = Long.fromString("{{enum_type.hash.int_value}}", true); private static _packed_fingerprint?: Long; /** @internal */ @@ -36,9 +35,7 @@ export class {{enum_type.name}} extends LcmEnumMsg { if (parents.indexOf({{enum_type.name}}) > -1) { return Long.fromNumber(0, true); } - let tmp_hash = {{enum_type.name}}._hash; - tmp_hash = tmp_hash.shl(1).add(tmp_hash.shru(63)); - return tmp_hash; + return Long.fromString("{{enum_type.recursive_hash}}", true); } public override decode(array: Uint8Array): {{enum_type.name}} { diff --git a/third_party/skymarshal/skymarshal/templates/typescript_struct.ts.template b/third_party/skymarshal/skymarshal/templates/typescript_struct.ts.template index a546339b..0cb40ece 100644 --- a/third_party/skymarshal/skymarshal/templates/typescript_struct.ts.template +++ b/third_party/skymarshal/skymarshal/templates/typescript_struct.ts.template @@ -276,7 +276,6 @@ import ReflectionMeta from "{{typescript_library_path}}/reflection"; {# -- Define the lcm struct with decode methods -- #} export class {{struct_type.name}} extends LcmMsg { - private static _hash = Long.fromString("{{struct_type.hash.int_value}}", true); private static _packed_fingerprint?: Long; /** @internal */ @@ -292,14 +291,7 @@ export class {{struct_type.name}} extends LcmMsg { if (parents.indexOf({{struct_type.name}}) > -1) { return Long.fromNumber(0, true); } -{% if struct_type.has_complex_members() %} - const new_parents = parents.concat([{{struct_type.name}}]); -{% endif %} - let tmp_hash = {{struct_type.name}}._hash; -{% for member in struct_type.complex_members() %} - tmp_hash = tmp_hash.add({{member.type_ref.name}}._get_hash_recursive(new_parents)); -{% endfor %} - return tmp_hash.shl(1).add(tmp_hash.shru(63)); + return Long.fromString("{{struct_type.recursive_hash}}", true); } /** @internal */ From 50d4abc772bfe2fd446cf89d0a350905358fafa0 Mon Sep 17 00:00:00 2001 From: Ankit Agarwal Date: Wed, 24 Jun 2026 10:11:14 +0000 Subject: [PATCH 05/68] [SymForce] Update dependency pins GitOrigin-RevId: cf7b840faa103ec2f49dd47884a9329456cd5d0e --- requirements/dev_py310.txt | 2 +- requirements/dev_py311.txt | 2 +- requirements/dev_py312.txt | 2 +- requirements/dev_py313.txt | 2 +- requirements/dev_py314.txt | 2 +- 5 files changed, 5 insertions(+), 5 deletions(-) diff --git a/requirements/dev_py310.txt b/requirements/dev_py310.txt index 31663438..08662053 100644 --- a/requirements/dev_py310.txt +++ b/requirements/dev_py310.txt @@ -302,7 +302,7 @@ tomli==2.4.0 # mypy # setuptools-scm # sphinx -tornado==6.5.5 +tornado==6.5.7 # via # ipykernel # jupyter-client diff --git a/requirements/dev_py311.txt b/requirements/dev_py311.txt index 3e26d400..7f892aa5 100644 --- a/requirements/dev_py311.txt +++ b/requirements/dev_py311.txt @@ -298,7 +298,7 @@ sympy==1.13.3 # via symforce (pyproject.toml) tinycss2==1.4.0 # via bleach -tornado==6.5.5 +tornado==6.5.7 # via # ipykernel # jupyter-client diff --git a/requirements/dev_py312.txt b/requirements/dev_py312.txt index ceac8cf3..f89c1b77 100644 --- a/requirements/dev_py312.txt +++ b/requirements/dev_py312.txt @@ -298,7 +298,7 @@ sympy==1.13.3 # via symforce (pyproject.toml) tinycss2==1.4.0 # via bleach -tornado==6.5.5 +tornado==6.5.7 # via # ipykernel # jupyter-client diff --git a/requirements/dev_py313.txt b/requirements/dev_py313.txt index 96163aa7..5b79226e 100644 --- a/requirements/dev_py313.txt +++ b/requirements/dev_py313.txt @@ -298,7 +298,7 @@ sympy==1.13.3 # via symforce (pyproject.toml) tinycss2==1.4.0 # via bleach -tornado==6.5.5 +tornado==6.5.7 # via # ipykernel # jupyter-client diff --git a/requirements/dev_py314.txt b/requirements/dev_py314.txt index 6b3430ec..15a80eaa 100644 --- a/requirements/dev_py314.txt +++ b/requirements/dev_py314.txt @@ -300,7 +300,7 @@ sympy==1.13.3 # via symforce (pyproject.toml) tinycss2==1.4.0 # via bleach -tornado==6.5.5 +tornado==6.5.7 # via # ipykernel # jupyter-client From 58c81d10d2a386d64035dc589b5c83c193673496 Mon Sep 17 00:00:00 2001 From: William Almy Date: Tue, 30 Jun 2026 22:18:34 +0000 Subject: [PATCH 06/68] [SymForce] Update dependency pins GitOrigin-RevId: d878d26c0406581d45dab59260906d0be49ec319 --- requirements/dev_py310.txt | 2 +- requirements/dev_py311.txt | 2 +- requirements/dev_py312.txt | 2 +- requirements/dev_py313.txt | 2 +- requirements/dev_py314.txt | 2 +- 5 files changed, 5 insertions(+), 5 deletions(-) diff --git a/requirements/dev_py310.txt b/requirements/dev_py310.txt index 08662053..1b2d602c 100644 --- a/requirements/dev_py310.txt +++ b/requirements/dev_py310.txt @@ -20,7 +20,7 @@ beautifulsoup4==4.14.3 # via # furo # nbconvert -bleach==6.3.0 +bleach==6.4.0 # via nbconvert breathe==4.36.0 # via symforce (pyproject.toml) diff --git a/requirements/dev_py311.txt b/requirements/dev_py311.txt index 7f892aa5..b8376150 100644 --- a/requirements/dev_py311.txt +++ b/requirements/dev_py311.txt @@ -20,7 +20,7 @@ beautifulsoup4==4.14.3 # via # furo # nbconvert -bleach==6.3.0 +bleach==6.4.0 # via nbconvert breathe==4.36.0 # via symforce (pyproject.toml) diff --git a/requirements/dev_py312.txt b/requirements/dev_py312.txt index f89c1b77..f45dbf67 100644 --- a/requirements/dev_py312.txt +++ b/requirements/dev_py312.txt @@ -20,7 +20,7 @@ beautifulsoup4==4.14.3 # via # furo # nbconvert -bleach==6.3.0 +bleach==6.4.0 # via nbconvert breathe==4.36.0 # via symforce (pyproject.toml) diff --git a/requirements/dev_py313.txt b/requirements/dev_py313.txt index 5b79226e..5c8c7701 100644 --- a/requirements/dev_py313.txt +++ b/requirements/dev_py313.txt @@ -20,7 +20,7 @@ beautifulsoup4==4.14.3 # via # furo # nbconvert -bleach==6.3.0 +bleach==6.4.0 # via nbconvert breathe==4.36.0 # via symforce (pyproject.toml) diff --git a/requirements/dev_py314.txt b/requirements/dev_py314.txt index 15a80eaa..24ecddf6 100644 --- a/requirements/dev_py314.txt +++ b/requirements/dev_py314.txt @@ -20,7 +20,7 @@ beautifulsoup4==4.14.3 # via # furo # nbconvert -bleach==6.3.0 +bleach==6.4.0 # via nbconvert breathe==4.36.0 # via symforce (pyproject.toml) From c56ea51423c925862a8050efd545f5e98f67eb78 Mon Sep 17 00:00:00 2001 From: Ankit Agarwal Date: Mon, 13 Jul 2026 23:07:45 +0000 Subject: [PATCH 07/68] [SymForce] Update dependency pins GitOrigin-RevId: 2c848376c2a1f50b4976214ff9085c0d81c9c5fb --- requirements/dev_py310.txt | 4 ++-- requirements/dev_py311.txt | 4 ++-- requirements/dev_py312.txt | 4 ++-- requirements/dev_py313.txt | 4 ++-- requirements/dev_py314.txt | 4 ++-- 5 files changed, 10 insertions(+), 10 deletions(-) diff --git a/requirements/dev_py310.txt b/requirements/dev_py310.txt index 1b2d602c..748b52d6 100644 --- a/requirements/dev_py310.txt +++ b/requirements/dev_py310.txt @@ -126,7 +126,7 @@ mdit-py-plugins==0.5.0 # via myst-parser mdurl==0.1.2 # via markdown-it-py -mistune==3.2.1 +mistune==3.3.0 # via nbconvert mpmath==1.3.0 # via sympy @@ -259,7 +259,7 @@ sortedcontainers==2.4.0 # sortedcontainers-stubs sortedcontainers-stubs==2.4.3 # via symforce (pyproject.toml) -soupsieve==2.8.3 +soupsieve==2.8.4 # via beautifulsoup4 sphinx==8.1.3 # via diff --git a/requirements/dev_py311.txt b/requirements/dev_py311.txt index b8376150..35098276 100644 --- a/requirements/dev_py311.txt +++ b/requirements/dev_py311.txt @@ -126,7 +126,7 @@ mdit-py-plugins==0.5.0 # via myst-parser mdurl==0.1.2 # via markdown-it-py -mistune==3.2.1 +mistune==3.3.0 # via nbconvert mpmath==1.3.0 # via sympy @@ -260,7 +260,7 @@ sortedcontainers==2.4.0 # sortedcontainers-stubs sortedcontainers-stubs==2.4.3 # via symforce (pyproject.toml) -soupsieve==2.8.3 +soupsieve==2.8.4 # via beautifulsoup4 sphinx==9.0.4 # via diff --git a/requirements/dev_py312.txt b/requirements/dev_py312.txt index f45dbf67..d4876654 100644 --- a/requirements/dev_py312.txt +++ b/requirements/dev_py312.txt @@ -126,7 +126,7 @@ mdit-py-plugins==0.5.0 # via myst-parser mdurl==0.1.2 # via markdown-it-py -mistune==3.2.1 +mistune==3.3.0 # via nbconvert mpmath==1.3.0 # via sympy @@ -260,7 +260,7 @@ sortedcontainers==2.4.0 # sortedcontainers-stubs sortedcontainers-stubs==2.4.3 # via symforce (pyproject.toml) -soupsieve==2.8.3 +soupsieve==2.8.4 # via beautifulsoup4 sphinx==9.1.0 # via diff --git a/requirements/dev_py313.txt b/requirements/dev_py313.txt index 5c8c7701..5a7cf396 100644 --- a/requirements/dev_py313.txt +++ b/requirements/dev_py313.txt @@ -126,7 +126,7 @@ mdit-py-plugins==0.5.0 # via myst-parser mdurl==0.1.2 # via markdown-it-py -mistune==3.2.1 +mistune==3.3.0 # via nbconvert mpmath==1.3.0 # via sympy @@ -260,7 +260,7 @@ sortedcontainers==2.4.0 # sortedcontainers-stubs sortedcontainers-stubs==2.4.3 # via symforce (pyproject.toml) -soupsieve==2.8.3 +soupsieve==2.8.4 # via beautifulsoup4 sphinx==9.1.0 # via diff --git a/requirements/dev_py314.txt b/requirements/dev_py314.txt index 24ecddf6..a672c821 100644 --- a/requirements/dev_py314.txt +++ b/requirements/dev_py314.txt @@ -126,7 +126,7 @@ mdit-py-plugins==0.5.0 # via myst-parser mdurl==0.1.2 # via markdown-it-py -mistune==3.2.1 +mistune==3.3.0 # via nbconvert mpmath==1.3.0 # via sympy @@ -262,7 +262,7 @@ sortedcontainers==2.4.0 # sortedcontainers-stubs sortedcontainers-stubs==2.4.3 # via symforce (pyproject.toml) -soupsieve==2.8.3 +soupsieve==2.8.4 # via beautifulsoup4 sphinx==9.1.0 # via From 3cf33819311e714bc03f7f1a03a96e02099fcfa9 Mon Sep 17 00:00:00 2001 From: Aaron Date: Sat, 18 Jul 2026 01:25:09 +0000 Subject: [PATCH 08/68] [SymForce] Bundle eigen_lcm .lcm sources into wheels The recursive-hash precompute added in the skymarshal codegen change resolves cross-package types (e.g. eigen_lcm.Vector2d) via the eigen_lcm .lcm sources, located through path_util.eigen_lcm_lcmtypes_dir(). That lookup checks third_party/eigen_lcm/lcmtypes, which exists in source checkouts but is not shipped in wheels, so wheel codegen failed with: KeyError: compute_recursive_hash: cannot resolve eigen_lcm.Vector2d Copy the .lcm sources into the same third_party/eigen_lcm/lcmtypes path (relative to the install root) during the wheel build so the existing lookup finds them. Editable installs already have them in the source tree. Co-Authored-By: Claude Opus 4.8 Topic: sf-fix-lcm-hash-wheels Reviewers: jerry,nathan,ryan-br Assignees: jerry GitOrigin-RevId: ba89098baa1ae1013af6d0002e979fec4661419f --- setup.py | 13 +++++++++++++ 1 file changed, 13 insertions(+) diff --git a/setup.py b/setup.py index 096b92fb..a2af94de 100644 --- a/setup.py +++ b/setup.py @@ -184,6 +184,19 @@ def move_output(self, ext: CMakeExtension) -> None: str(build_temp_path / "lcmtypes" / "python2.7" / "lcmtypes"), str(dest_path), ) + + # NOTE(aaron): Codegen's recursive-hash precompute needs the eigen_lcm .lcm sources to + # resolve cross-package types (e.g. eigen_lcm.Vector2d). Wheels don't ship third_party, + # so copy those sources to the same third_party/eigen_lcm/lcmtypes path (relative to the + # install root) where path_util.eigen_lcm_lcmtypes_dir looks for them. Editable installs + # already have them in the source tree and skip this. + if not self.inplace: + eigen_lcm_src = SOURCE_DIR / "third_party" / "eigen_lcm" / "lcmtypes" + eigen_lcm_dest = dest_path_dir / "third_party" / "eigen_lcm" / "lcmtypes" + self.mkpath(str(eigen_lcm_dest)) + for lcm_file in eigen_lcm_src.glob("*.lcm"): + self.copy_file(str(lcm_file), str(eigen_lcm_dest / lcm_file.name)) + return build_temp = Path(self.build_temp).resolve() From 9e3dad677f926356afa1b191ed9be5942b06d7ab Mon Sep 17 00:00:00 2001 From: Ankit Agarwal Date: Sat, 18 Jul 2026 06:56:34 +0000 Subject: [PATCH 09/68] [SymForce] Update dependency pins GitOrigin-RevId: a2b0fe32d8ed52611e69bf9ab153e225dce0c087 --- requirements/dev_py310.txt | 2 +- requirements/dev_py311.txt | 2 +- requirements/dev_py312.txt | 2 +- requirements/dev_py313.txt | 2 +- requirements/dev_py314.txt | 2 +- 5 files changed, 5 insertions(+), 5 deletions(-) diff --git a/requirements/dev_py310.txt b/requirements/dev_py310.txt index 748b52d6..3e41bda9 100644 --- a/requirements/dev_py310.txt +++ b/requirements/dev_py310.txt @@ -187,7 +187,7 @@ pexpect==4.9.0 # via ipython pillow==12.2.0 # via matplotlib -pip==26.1 +pip==26.1.2 # via symforce (pyproject.toml) platformdirs==4.5.1 # via jupyter-core diff --git a/requirements/dev_py311.txt b/requirements/dev_py311.txt index 35098276..5b1d97a6 100644 --- a/requirements/dev_py311.txt +++ b/requirements/dev_py311.txt @@ -187,7 +187,7 @@ pexpect==4.9.0 # via ipython pillow==12.2.0 # via matplotlib -pip==26.1 +pip==26.1.2 # via symforce (pyproject.toml) platformdirs==4.5.1 # via jupyter-core diff --git a/requirements/dev_py312.txt b/requirements/dev_py312.txt index d4876654..e2ae1899 100644 --- a/requirements/dev_py312.txt +++ b/requirements/dev_py312.txt @@ -187,7 +187,7 @@ pexpect==4.9.0 # via ipython pillow==12.2.0 # via matplotlib -pip==26.1 +pip==26.1.2 # via symforce (pyproject.toml) platformdirs==4.5.1 # via jupyter-core diff --git a/requirements/dev_py313.txt b/requirements/dev_py313.txt index 5a7cf396..ce6b9106 100644 --- a/requirements/dev_py313.txt +++ b/requirements/dev_py313.txt @@ -187,7 +187,7 @@ pexpect==4.9.0 # via ipython pillow==12.2.0 # via matplotlib -pip==26.1 +pip==26.1.2 # via symforce (pyproject.toml) platformdirs==4.5.1 # via jupyter-core diff --git a/requirements/dev_py314.txt b/requirements/dev_py314.txt index a672c821..5ee417d6 100644 --- a/requirements/dev_py314.txt +++ b/requirements/dev_py314.txt @@ -187,7 +187,7 @@ pexpect==4.9.0 # via ipython pillow==12.2.0 # via matplotlib -pip==26.1 +pip==26.1.2 # via symforce (pyproject.toml) platformdirs==4.5.1 # via jupyter-core From 42326d1b29898d382aba31a158c76ac768cd6701 Mon Sep 17 00:00:00 2001 From: Ankit Agarwal Date: Wed, 22 Jul 2026 08:55:16 +0000 Subject: [PATCH 10/68] [SymForce] Update dependency pins GitOrigin-RevId: 1117a1a1729d393c11ac74870522900252cce1f8 --- requirements/dev_py310.txt | 2 +- requirements/dev_py311.txt | 2 +- requirements/dev_py312.txt | 2 +- requirements/dev_py313.txt | 2 +- requirements/dev_py314.txt | 2 +- 5 files changed, 5 insertions(+), 5 deletions(-) diff --git a/requirements/dev_py310.txt b/requirements/dev_py310.txt index 3e41bda9..9663d4e3 100644 --- a/requirements/dev_py310.txt +++ b/requirements/dev_py310.txt @@ -185,7 +185,7 @@ pathspec==1.0.4 # via mypy pexpect==4.9.0 # via ipython -pillow==12.2.0 +pillow==12.3.0 # via matplotlib pip==26.1.2 # via symforce (pyproject.toml) diff --git a/requirements/dev_py311.txt b/requirements/dev_py311.txt index 5b1d97a6..bff0587f 100644 --- a/requirements/dev_py311.txt +++ b/requirements/dev_py311.txt @@ -185,7 +185,7 @@ pathspec==1.0.4 # via mypy pexpect==4.9.0 # via ipython -pillow==12.2.0 +pillow==12.3.0 # via matplotlib pip==26.1.2 # via symforce (pyproject.toml) diff --git a/requirements/dev_py312.txt b/requirements/dev_py312.txt index e2ae1899..e1c25f6e 100644 --- a/requirements/dev_py312.txt +++ b/requirements/dev_py312.txt @@ -185,7 +185,7 @@ pathspec==1.0.4 # via mypy pexpect==4.9.0 # via ipython -pillow==12.2.0 +pillow==12.3.0 # via matplotlib pip==26.1.2 # via symforce (pyproject.toml) diff --git a/requirements/dev_py313.txt b/requirements/dev_py313.txt index ce6b9106..3e04c907 100644 --- a/requirements/dev_py313.txt +++ b/requirements/dev_py313.txt @@ -185,7 +185,7 @@ pathspec==1.0.4 # via mypy pexpect==4.9.0 # via ipython -pillow==12.2.0 +pillow==12.3.0 # via matplotlib pip==26.1.2 # via symforce (pyproject.toml) diff --git a/requirements/dev_py314.txt b/requirements/dev_py314.txt index 5ee417d6..b14930e9 100644 --- a/requirements/dev_py314.txt +++ b/requirements/dev_py314.txt @@ -185,7 +185,7 @@ pathspec==1.0.4 # via mypy pexpect==4.9.0 # via ipython -pillow==12.2.0 +pillow==12.3.0 # via matplotlib pip==26.1.2 # via symforce (pyproject.toml) From b181d61176ecdf640a598fb3e296a81cd3d48da8 Mon Sep 17 00:00:00 2001 From: Brian Kubisiak Date: Thu, 23 Jul 2026 18:02:38 +0000 Subject: [PATCH 11/68] skymarshal: Initialize hash during decode On gcc 13, building some lcm types is failing due to uninitialized hash. It should be pretty cheap to resolve the warning even if it is a false positive. Signed-off-by: Brian Kubisiak GitOrigin-RevId: 47a7f3ce300aa151d8833d918f647fd08747c286 --- .../cpp/lcmtypes/codegen_cpp_test/constants_t.hpp | 2 +- .../cpp/lcmtypes/codegen_cpp_test/states_t.hpp | 2 +- .../cpp/lcmtypes/codegen_cpp_test/values_vec_t.hpp | 2 +- .../cpp/lcmtypes/codegen_test/my_dataclass_t.hpp | 2 +- .../constants_t.hpp | 2 +- .../codegen_explicit_template_instantiation_test/states_t.hpp | 2 +- .../values_vec_t.hpp | 2 +- .../lcmtypes/codegen_multi_function_test/inputs_constants_t.hpp | 2 +- .../lcmtypes/codegen_multi_function_test/inputs_states_t.hpp | 2 +- .../cpp/lcmtypes/codegen_multi_function_test/inputs_t.hpp | 2 +- .../cpp/lcmtypes/codegen_multi_function_test/outputs_1_t.hpp | 2 +- .../cpp/lcmtypes/codegen_multi_function_test/outputs_2_t.hpp | 2 +- .../cpp/lcmtypes/codegen_multi_function_test/values_vec_t.hpp | 2 +- .../cpp/lcmtypes/codegen_python_test/constants_t.hpp | 2 +- .../cpp/lcmtypes/codegen_python_test/states_t.hpp | 2 +- .../cpp/lcmtypes/codegen_python_test/values_vec_t.hpp | 2 +- .../with_jacobians_values/cpp/lcmtypes/sym/d_out_t.hpp | 2 +- .../symengine/with_jacobians_values/cpp/lcmtypes/sym/d_t.hpp | 2 +- .../cpp/lcmtypes/codegen_test/my_dataclass_t.hpp | 2 +- .../sympy/with_jacobians_values/cpp/lcmtypes/sym/d_out_t.hpp | 2 +- .../sympy/with_jacobians_values/cpp/lcmtypes/sym/d_t.hpp | 2 +- .../lcmtypes/eigen_lcm_lcm/cpp/lcmtypes/eigen_lcm/Matrix24d.hpp | 2 +- .../lcmtypes/eigen_lcm_lcm/cpp/lcmtypes/eigen_lcm/Matrix2d.hpp | 2 +- .../lcmtypes/eigen_lcm_lcm/cpp/lcmtypes/eigen_lcm/Matrix2f.hpp | 2 +- .../lcmtypes/eigen_lcm_lcm/cpp/lcmtypes/eigen_lcm/Matrix2i.hpp | 2 +- .../lcmtypes/eigen_lcm_lcm/cpp/lcmtypes/eigen_lcm/Matrix34d.hpp | 2 +- .../lcmtypes/eigen_lcm_lcm/cpp/lcmtypes/eigen_lcm/Matrix3d.hpp | 2 +- .../lcmtypes/eigen_lcm_lcm/cpp/lcmtypes/eigen_lcm/Matrix3f.hpp | 2 +- .../lcmtypes/eigen_lcm_lcm/cpp/lcmtypes/eigen_lcm/Matrix3i.hpp | 2 +- .../lcmtypes/eigen_lcm_lcm/cpp/lcmtypes/eigen_lcm/Matrix43f.hpp | 2 +- .../lcmtypes/eigen_lcm_lcm/cpp/lcmtypes/eigen_lcm/Matrix4d.hpp | 2 +- .../lcmtypes/eigen_lcm_lcm/cpp/lcmtypes/eigen_lcm/Matrix4f.hpp | 2 +- .../lcmtypes/eigen_lcm_lcm/cpp/lcmtypes/eigen_lcm/Matrix4i.hpp | 2 +- .../lcmtypes/eigen_lcm_lcm/cpp/lcmtypes/eigen_lcm/Matrix54d.hpp | 2 +- .../lcmtypes/eigen_lcm_lcm/cpp/lcmtypes/eigen_lcm/Matrix68f.hpp | 2 +- .../lcmtypes/eigen_lcm_lcm/cpp/lcmtypes/eigen_lcm/MatrixXd.hpp | 2 +- .../lcmtypes/eigen_lcm_lcm/cpp/lcmtypes/eigen_lcm/MatrixXf.hpp | 2 +- .../lcmtypes/eigen_lcm_lcm/cpp/lcmtypes/eigen_lcm/MatrixXi.hpp | 2 +- .../eigen_lcm_lcm/cpp/lcmtypes/eigen_lcm/Quaterniond.hpp | 2 +- .../eigen_lcm_lcm/cpp/lcmtypes/eigen_lcm/Quaternionf.hpp | 2 +- .../eigen_lcm_lcm/cpp/lcmtypes/eigen_lcm/SymmetricMatrix2d.hpp | 2 +- .../eigen_lcm_lcm/cpp/lcmtypes/eigen_lcm/SymmetricMatrix2f.hpp | 2 +- .../eigen_lcm_lcm/cpp/lcmtypes/eigen_lcm/SymmetricMatrix3d.hpp | 2 +- .../eigen_lcm_lcm/cpp/lcmtypes/eigen_lcm/SymmetricMatrix3f.hpp | 2 +- .../eigen_lcm_lcm/cpp/lcmtypes/eigen_lcm/SymmetricMatrix4d.hpp | 2 +- .../eigen_lcm_lcm/cpp/lcmtypes/eigen_lcm/SymmetricMatrix4f.hpp | 2 +- .../eigen_lcm_lcm/cpp/lcmtypes/eigen_lcm/SymmetricMatrixXd.hpp | 2 +- .../eigen_lcm_lcm/cpp/lcmtypes/eigen_lcm/SymmetricMatrixXf.hpp | 2 +- .../lcmtypes/eigen_lcm_lcm/cpp/lcmtypes/eigen_lcm/Vector1d.hpp | 2 +- .../lcmtypes/eigen_lcm_lcm/cpp/lcmtypes/eigen_lcm/Vector1f.hpp | 2 +- .../lcmtypes/eigen_lcm_lcm/cpp/lcmtypes/eigen_lcm/Vector1i.hpp | 2 +- .../lcmtypes/eigen_lcm_lcm/cpp/lcmtypes/eigen_lcm/Vector2d.hpp | 2 +- .../lcmtypes/eigen_lcm_lcm/cpp/lcmtypes/eigen_lcm/Vector2f.hpp | 2 +- .../lcmtypes/eigen_lcm_lcm/cpp/lcmtypes/eigen_lcm/Vector2i.hpp | 2 +- .../lcmtypes/eigen_lcm_lcm/cpp/lcmtypes/eigen_lcm/Vector3d.hpp | 2 +- .../lcmtypes/eigen_lcm_lcm/cpp/lcmtypes/eigen_lcm/Vector3f.hpp | 2 +- .../lcmtypes/eigen_lcm_lcm/cpp/lcmtypes/eigen_lcm/Vector3i.hpp | 2 +- .../lcmtypes/eigen_lcm_lcm/cpp/lcmtypes/eigen_lcm/Vector4d.hpp | 2 +- .../lcmtypes/eigen_lcm_lcm/cpp/lcmtypes/eigen_lcm/Vector4f.hpp | 2 +- .../lcmtypes/eigen_lcm_lcm/cpp/lcmtypes/eigen_lcm/Vector4i.hpp | 2 +- .../lcmtypes/eigen_lcm_lcm/cpp/lcmtypes/eigen_lcm/Vector5d.hpp | 2 +- .../lcmtypes/eigen_lcm_lcm/cpp/lcmtypes/eigen_lcm/Vector5f.hpp | 2 +- .../lcmtypes/eigen_lcm_lcm/cpp/lcmtypes/eigen_lcm/Vector5i.hpp | 2 +- .../lcmtypes/eigen_lcm_lcm/cpp/lcmtypes/eigen_lcm/Vector6d.hpp | 2 +- .../lcmtypes/eigen_lcm_lcm/cpp/lcmtypes/eigen_lcm/Vector6f.hpp | 2 +- .../lcmtypes/eigen_lcm_lcm/cpp/lcmtypes/eigen_lcm/Vector6i.hpp | 2 +- .../lcmtypes/eigen_lcm_lcm/cpp/lcmtypes/eigen_lcm/Vector7d.hpp | 2 +- .../lcmtypes/eigen_lcm_lcm/cpp/lcmtypes/eigen_lcm/Vector7f.hpp | 2 +- .../lcmtypes/eigen_lcm_lcm/cpp/lcmtypes/eigen_lcm/Vector7i.hpp | 2 +- .../lcmtypes/eigen_lcm_lcm/cpp/lcmtypes/eigen_lcm/Vector8d.hpp | 2 +- .../lcmtypes/eigen_lcm_lcm/cpp/lcmtypes/eigen_lcm/Vector8f.hpp | 2 +- .../lcmtypes/eigen_lcm_lcm/cpp/lcmtypes/eigen_lcm/Vector8i.hpp | 2 +- .../lcmtypes/eigen_lcm_lcm/cpp/lcmtypes/eigen_lcm/VectorXd.hpp | 2 +- .../lcmtypes/eigen_lcm_lcm/cpp/lcmtypes/eigen_lcm/VectorXf.hpp | 2 +- .../lcmtypes/eigen_lcm_lcm/cpp/lcmtypes/eigen_lcm/VectorXi.hpp | 2 +- .../skymarshal/skymarshal/templates/lcmtype.hpp.template | 2 +- 76 files changed, 76 insertions(+), 76 deletions(-) diff --git a/test/symforce_function_codegen_test_data/symengine/codegen_cpp_test_data/cpp/lcmtypes/codegen_cpp_test/constants_t.hpp b/test/symforce_function_codegen_test_data/symengine/codegen_cpp_test_data/cpp/lcmtypes/codegen_cpp_test/constants_t.hpp index bfe608a1..efa6cadc 100644 --- a/test/symforce_function_codegen_test_data/symengine/codegen_cpp_test_data/cpp/lcmtypes/codegen_cpp_test/constants_t.hpp +++ b/test/symforce_function_codegen_test_data/symengine/codegen_cpp_test_data/cpp/lcmtypes/codegen_cpp_test/constants_t.hpp @@ -204,7 +204,7 @@ __lcm_buffer_size constants_t::decode(const void *buf, __lcm_buffer_size offset, { __lcm_buffer_size pos = 0, thislen; - uint64_t hash; + uint64_t hash = 0; thislen = __uint64_t_decode_array(buf, offset + pos, maxlen - pos, &hash, 1); if (thislen < 0) return thislen; else pos += thislen; if (hash != getHash()) return -1; diff --git a/test/symforce_function_codegen_test_data/symengine/codegen_cpp_test_data/cpp/lcmtypes/codegen_cpp_test/states_t.hpp b/test/symforce_function_codegen_test_data/symengine/codegen_cpp_test_data/cpp/lcmtypes/codegen_cpp_test/states_t.hpp index b6612f38..e7d3591a 100644 --- a/test/symforce_function_codegen_test_data/symengine/codegen_cpp_test_data/cpp/lcmtypes/codegen_cpp_test/states_t.hpp +++ b/test/symforce_function_codegen_test_data/symengine/codegen_cpp_test_data/cpp/lcmtypes/codegen_cpp_test/states_t.hpp @@ -212,7 +212,7 @@ __lcm_buffer_size states_t::decode(const void *buf, __lcm_buffer_size offset, __ { __lcm_buffer_size pos = 0, thislen; - uint64_t hash; + uint64_t hash = 0; thislen = __uint64_t_decode_array(buf, offset + pos, maxlen - pos, &hash, 1); if (thislen < 0) return thislen; else pos += thislen; if (hash != getHash()) return -1; diff --git a/test/symforce_function_codegen_test_data/symengine/codegen_cpp_test_data/cpp/lcmtypes/codegen_cpp_test/values_vec_t.hpp b/test/symforce_function_codegen_test_data/symengine/codegen_cpp_test_data/cpp/lcmtypes/codegen_cpp_test/values_vec_t.hpp index 5ce438c0..e5138902 100644 --- a/test/symforce_function_codegen_test_data/symengine/codegen_cpp_test_data/cpp/lcmtypes/codegen_cpp_test/values_vec_t.hpp +++ b/test/symforce_function_codegen_test_data/symengine/codegen_cpp_test_data/cpp/lcmtypes/codegen_cpp_test/values_vec_t.hpp @@ -303,7 +303,7 @@ __lcm_buffer_size values_vec_t::decode(const void *buf, __lcm_buffer_size offset { __lcm_buffer_size pos = 0, thislen; - uint64_t hash; + uint64_t hash = 0; thislen = __uint64_t_decode_array(buf, offset + pos, maxlen - pos, &hash, 1); if (thislen < 0) return thislen; else pos += thislen; if (hash != getHash()) return -1; diff --git a/test/symforce_function_codegen_test_data/symengine/codegen_dataclass_in_values_test_data/cpp/lcmtypes/codegen_test/my_dataclass_t.hpp b/test/symforce_function_codegen_test_data/symengine/codegen_dataclass_in_values_test_data/cpp/lcmtypes/codegen_test/my_dataclass_t.hpp index 84bef52b..bf0647fc 100644 --- a/test/symforce_function_codegen_test_data/symengine/codegen_dataclass_in_values_test_data/cpp/lcmtypes/codegen_test/my_dataclass_t.hpp +++ b/test/symforce_function_codegen_test_data/symengine/codegen_dataclass_in_values_test_data/cpp/lcmtypes/codegen_test/my_dataclass_t.hpp @@ -212,7 +212,7 @@ __lcm_buffer_size my_dataclass_t::decode(const void *buf, __lcm_buffer_size offs { __lcm_buffer_size pos = 0, thislen; - uint64_t hash; + uint64_t hash = 0; thislen = __uint64_t_decode_array(buf, offset + pos, maxlen - pos, &hash, 1); if (thislen < 0) return thislen; else pos += thislen; if (hash != getHash()) return -1; diff --git a/test/symforce_function_codegen_test_data/symengine/codegen_explicit_template_instantiation_test_data/cpp/lcmtypes/codegen_explicit_template_instantiation_test/constants_t.hpp b/test/symforce_function_codegen_test_data/symengine/codegen_explicit_template_instantiation_test_data/cpp/lcmtypes/codegen_explicit_template_instantiation_test/constants_t.hpp index 8b543f8f..cb197b3a 100644 --- a/test/symforce_function_codegen_test_data/symengine/codegen_explicit_template_instantiation_test_data/cpp/lcmtypes/codegen_explicit_template_instantiation_test/constants_t.hpp +++ b/test/symforce_function_codegen_test_data/symengine/codegen_explicit_template_instantiation_test_data/cpp/lcmtypes/codegen_explicit_template_instantiation_test/constants_t.hpp @@ -204,7 +204,7 @@ __lcm_buffer_size constants_t::decode(const void *buf, __lcm_buffer_size offset, { __lcm_buffer_size pos = 0, thislen; - uint64_t hash; + uint64_t hash = 0; thislen = __uint64_t_decode_array(buf, offset + pos, maxlen - pos, &hash, 1); if (thislen < 0) return thislen; else pos += thislen; if (hash != getHash()) return -1; diff --git a/test/symforce_function_codegen_test_data/symengine/codegen_explicit_template_instantiation_test_data/cpp/lcmtypes/codegen_explicit_template_instantiation_test/states_t.hpp b/test/symforce_function_codegen_test_data/symengine/codegen_explicit_template_instantiation_test_data/cpp/lcmtypes/codegen_explicit_template_instantiation_test/states_t.hpp index 059a41c4..9e69c9f1 100644 --- a/test/symforce_function_codegen_test_data/symengine/codegen_explicit_template_instantiation_test_data/cpp/lcmtypes/codegen_explicit_template_instantiation_test/states_t.hpp +++ b/test/symforce_function_codegen_test_data/symengine/codegen_explicit_template_instantiation_test_data/cpp/lcmtypes/codegen_explicit_template_instantiation_test/states_t.hpp @@ -212,7 +212,7 @@ __lcm_buffer_size states_t::decode(const void *buf, __lcm_buffer_size offset, __ { __lcm_buffer_size pos = 0, thislen; - uint64_t hash; + uint64_t hash = 0; thislen = __uint64_t_decode_array(buf, offset + pos, maxlen - pos, &hash, 1); if (thislen < 0) return thislen; else pos += thislen; if (hash != getHash()) return -1; diff --git a/test/symforce_function_codegen_test_data/symengine/codegen_explicit_template_instantiation_test_data/cpp/lcmtypes/codegen_explicit_template_instantiation_test/values_vec_t.hpp b/test/symforce_function_codegen_test_data/symengine/codegen_explicit_template_instantiation_test_data/cpp/lcmtypes/codegen_explicit_template_instantiation_test/values_vec_t.hpp index b2572db7..08b2adc5 100644 --- a/test/symforce_function_codegen_test_data/symengine/codegen_explicit_template_instantiation_test_data/cpp/lcmtypes/codegen_explicit_template_instantiation_test/values_vec_t.hpp +++ b/test/symforce_function_codegen_test_data/symengine/codegen_explicit_template_instantiation_test_data/cpp/lcmtypes/codegen_explicit_template_instantiation_test/values_vec_t.hpp @@ -303,7 +303,7 @@ __lcm_buffer_size values_vec_t::decode(const void *buf, __lcm_buffer_size offset { __lcm_buffer_size pos = 0, thislen; - uint64_t hash; + uint64_t hash = 0; thislen = __uint64_t_decode_array(buf, offset + pos, maxlen - pos, &hash, 1); if (thislen < 0) return thislen; else pos += thislen; if (hash != getHash()) return -1; diff --git a/test/symforce_function_codegen_test_data/symengine/codegen_multi_function_test_data/cpp/lcmtypes/codegen_multi_function_test/inputs_constants_t.hpp b/test/symforce_function_codegen_test_data/symengine/codegen_multi_function_test_data/cpp/lcmtypes/codegen_multi_function_test/inputs_constants_t.hpp index 4d6fa3f2..e1d14fc4 100644 --- a/test/symforce_function_codegen_test_data/symengine/codegen_multi_function_test_data/cpp/lcmtypes/codegen_multi_function_test/inputs_constants_t.hpp +++ b/test/symforce_function_codegen_test_data/symengine/codegen_multi_function_test_data/cpp/lcmtypes/codegen_multi_function_test/inputs_constants_t.hpp @@ -204,7 +204,7 @@ __lcm_buffer_size inputs_constants_t::decode(const void *buf, __lcm_buffer_size { __lcm_buffer_size pos = 0, thislen; - uint64_t hash; + uint64_t hash = 0; thislen = __uint64_t_decode_array(buf, offset + pos, maxlen - pos, &hash, 1); if (thislen < 0) return thislen; else pos += thislen; if (hash != getHash()) return -1; diff --git a/test/symforce_function_codegen_test_data/symengine/codegen_multi_function_test_data/cpp/lcmtypes/codegen_multi_function_test/inputs_states_t.hpp b/test/symforce_function_codegen_test_data/symengine/codegen_multi_function_test_data/cpp/lcmtypes/codegen_multi_function_test/inputs_states_t.hpp index e4e7f33b..05a67cfa 100644 --- a/test/symforce_function_codegen_test_data/symengine/codegen_multi_function_test_data/cpp/lcmtypes/codegen_multi_function_test/inputs_states_t.hpp +++ b/test/symforce_function_codegen_test_data/symengine/codegen_multi_function_test_data/cpp/lcmtypes/codegen_multi_function_test/inputs_states_t.hpp @@ -212,7 +212,7 @@ __lcm_buffer_size inputs_states_t::decode(const void *buf, __lcm_buffer_size off { __lcm_buffer_size pos = 0, thislen; - uint64_t hash; + uint64_t hash = 0; thislen = __uint64_t_decode_array(buf, offset + pos, maxlen - pos, &hash, 1); if (thislen < 0) return thislen; else pos += thislen; if (hash != getHash()) return -1; diff --git a/test/symforce_function_codegen_test_data/symengine/codegen_multi_function_test_data/cpp/lcmtypes/codegen_multi_function_test/inputs_t.hpp b/test/symforce_function_codegen_test_data/symengine/codegen_multi_function_test_data/cpp/lcmtypes/codegen_multi_function_test/inputs_t.hpp index 3bf3a082..ca87de04 100644 --- a/test/symforce_function_codegen_test_data/symengine/codegen_multi_function_test_data/cpp/lcmtypes/codegen_multi_function_test/inputs_t.hpp +++ b/test/symforce_function_codegen_test_data/symengine/codegen_multi_function_test_data/cpp/lcmtypes/codegen_multi_function_test/inputs_t.hpp @@ -416,7 +416,7 @@ __lcm_buffer_size inputs_t::decode(const void *buf, __lcm_buffer_size offset, __ { __lcm_buffer_size pos = 0, thislen; - uint64_t hash; + uint64_t hash = 0; thislen = __uint64_t_decode_array(buf, offset + pos, maxlen - pos, &hash, 1); if (thislen < 0) return thislen; else pos += thislen; if (hash != getHash()) return -1; diff --git a/test/symforce_function_codegen_test_data/symengine/codegen_multi_function_test_data/cpp/lcmtypes/codegen_multi_function_test/outputs_1_t.hpp b/test/symforce_function_codegen_test_data/symengine/codegen_multi_function_test_data/cpp/lcmtypes/codegen_multi_function_test/outputs_1_t.hpp index 2b4f378e..271120d1 100644 --- a/test/symforce_function_codegen_test_data/symengine/codegen_multi_function_test_data/cpp/lcmtypes/codegen_multi_function_test/outputs_1_t.hpp +++ b/test/symforce_function_codegen_test_data/symengine/codegen_multi_function_test_data/cpp/lcmtypes/codegen_multi_function_test/outputs_1_t.hpp @@ -323,7 +323,7 @@ __lcm_buffer_size outputs_1_t::decode(const void *buf, __lcm_buffer_size offset, { __lcm_buffer_size pos = 0, thislen; - uint64_t hash; + uint64_t hash = 0; thislen = __uint64_t_decode_array(buf, offset + pos, maxlen - pos, &hash, 1); if (thislen < 0) return thislen; else pos += thislen; if (hash != getHash()) return -1; diff --git a/test/symforce_function_codegen_test_data/symengine/codegen_multi_function_test_data/cpp/lcmtypes/codegen_multi_function_test/outputs_2_t.hpp b/test/symforce_function_codegen_test_data/symengine/codegen_multi_function_test_data/cpp/lcmtypes/codegen_multi_function_test/outputs_2_t.hpp index 70923860..7394d425 100644 --- a/test/symforce_function_codegen_test_data/symengine/codegen_multi_function_test_data/cpp/lcmtypes/codegen_multi_function_test/outputs_2_t.hpp +++ b/test/symforce_function_codegen_test_data/symengine/codegen_multi_function_test_data/cpp/lcmtypes/codegen_multi_function_test/outputs_2_t.hpp @@ -204,7 +204,7 @@ __lcm_buffer_size outputs_2_t::decode(const void *buf, __lcm_buffer_size offset, { __lcm_buffer_size pos = 0, thislen; - uint64_t hash; + uint64_t hash = 0; thislen = __uint64_t_decode_array(buf, offset + pos, maxlen - pos, &hash, 1); if (thislen < 0) return thislen; else pos += thislen; if (hash != getHash()) return -1; diff --git a/test/symforce_function_codegen_test_data/symengine/codegen_multi_function_test_data/cpp/lcmtypes/codegen_multi_function_test/values_vec_t.hpp b/test/symforce_function_codegen_test_data/symengine/codegen_multi_function_test_data/cpp/lcmtypes/codegen_multi_function_test/values_vec_t.hpp index 2d87fb1a..ed8573ae 100644 --- a/test/symforce_function_codegen_test_data/symengine/codegen_multi_function_test_data/cpp/lcmtypes/codegen_multi_function_test/values_vec_t.hpp +++ b/test/symforce_function_codegen_test_data/symengine/codegen_multi_function_test_data/cpp/lcmtypes/codegen_multi_function_test/values_vec_t.hpp @@ -303,7 +303,7 @@ __lcm_buffer_size values_vec_t::decode(const void *buf, __lcm_buffer_size offset { __lcm_buffer_size pos = 0, thislen; - uint64_t hash; + uint64_t hash = 0; thislen = __uint64_t_decode_array(buf, offset + pos, maxlen - pos, &hash, 1); if (thislen < 0) return thislen; else pos += thislen; if (hash != getHash()) return -1; diff --git a/test/symforce_function_codegen_test_data/symengine/codegen_python_test_data/cpp/lcmtypes/codegen_python_test/constants_t.hpp b/test/symforce_function_codegen_test_data/symengine/codegen_python_test_data/cpp/lcmtypes/codegen_python_test/constants_t.hpp index 046457ae..dce06d5c 100644 --- a/test/symforce_function_codegen_test_data/symengine/codegen_python_test_data/cpp/lcmtypes/codegen_python_test/constants_t.hpp +++ b/test/symforce_function_codegen_test_data/symengine/codegen_python_test_data/cpp/lcmtypes/codegen_python_test/constants_t.hpp @@ -204,7 +204,7 @@ __lcm_buffer_size constants_t::decode(const void *buf, __lcm_buffer_size offset, { __lcm_buffer_size pos = 0, thislen; - uint64_t hash; + uint64_t hash = 0; thislen = __uint64_t_decode_array(buf, offset + pos, maxlen - pos, &hash, 1); if (thislen < 0) return thislen; else pos += thislen; if (hash != getHash()) return -1; diff --git a/test/symforce_function_codegen_test_data/symengine/codegen_python_test_data/cpp/lcmtypes/codegen_python_test/states_t.hpp b/test/symforce_function_codegen_test_data/symengine/codegen_python_test_data/cpp/lcmtypes/codegen_python_test/states_t.hpp index c1497aec..e5812f45 100644 --- a/test/symforce_function_codegen_test_data/symengine/codegen_python_test_data/cpp/lcmtypes/codegen_python_test/states_t.hpp +++ b/test/symforce_function_codegen_test_data/symengine/codegen_python_test_data/cpp/lcmtypes/codegen_python_test/states_t.hpp @@ -212,7 +212,7 @@ __lcm_buffer_size states_t::decode(const void *buf, __lcm_buffer_size offset, __ { __lcm_buffer_size pos = 0, thislen; - uint64_t hash; + uint64_t hash = 0; thislen = __uint64_t_decode_array(buf, offset + pos, maxlen - pos, &hash, 1); if (thislen < 0) return thislen; else pos += thislen; if (hash != getHash()) return -1; diff --git a/test/symforce_function_codegen_test_data/symengine/codegen_python_test_data/cpp/lcmtypes/codegen_python_test/values_vec_t.hpp b/test/symforce_function_codegen_test_data/symengine/codegen_python_test_data/cpp/lcmtypes/codegen_python_test/values_vec_t.hpp index 26bff237..a208f5f8 100644 --- a/test/symforce_function_codegen_test_data/symengine/codegen_python_test_data/cpp/lcmtypes/codegen_python_test/values_vec_t.hpp +++ b/test/symforce_function_codegen_test_data/symengine/codegen_python_test_data/cpp/lcmtypes/codegen_python_test/values_vec_t.hpp @@ -303,7 +303,7 @@ __lcm_buffer_size values_vec_t::decode(const void *buf, __lcm_buffer_size offset { __lcm_buffer_size pos = 0, thislen; - uint64_t hash; + uint64_t hash = 0; thislen = __uint64_t_decode_array(buf, offset + pos, maxlen - pos, &hash, 1); if (thislen < 0) return thislen; else pos += thislen; if (hash != getHash()) return -1; diff --git a/test/symforce_function_codegen_test_data/symengine/with_jacobians_values/cpp/lcmtypes/sym/d_out_t.hpp b/test/symforce_function_codegen_test_data/symengine/with_jacobians_values/cpp/lcmtypes/sym/d_out_t.hpp index 19d819a5..21f06313 100644 --- a/test/symforce_function_codegen_test_data/symengine/with_jacobians_values/cpp/lcmtypes/sym/d_out_t.hpp +++ b/test/symforce_function_codegen_test_data/symengine/with_jacobians_values/cpp/lcmtypes/sym/d_out_t.hpp @@ -222,7 +222,7 @@ __lcm_buffer_size d_out_t::decode(const void *buf, __lcm_buffer_size offset, __l { __lcm_buffer_size pos = 0, thislen; - uint64_t hash; + uint64_t hash = 0; thislen = __uint64_t_decode_array(buf, offset + pos, maxlen - pos, &hash, 1); if (thislen < 0) return thislen; else pos += thislen; if (hash != getHash()) return -1; diff --git a/test/symforce_function_codegen_test_data/symengine/with_jacobians_values/cpp/lcmtypes/sym/d_t.hpp b/test/symforce_function_codegen_test_data/symengine/with_jacobians_values/cpp/lcmtypes/sym/d_t.hpp index 0a1dfa6c..b43db198 100644 --- a/test/symforce_function_codegen_test_data/symengine/with_jacobians_values/cpp/lcmtypes/sym/d_t.hpp +++ b/test/symforce_function_codegen_test_data/symengine/with_jacobians_values/cpp/lcmtypes/sym/d_t.hpp @@ -230,7 +230,7 @@ __lcm_buffer_size d_t::decode(const void *buf, __lcm_buffer_size offset, __lcm_b { __lcm_buffer_size pos = 0, thislen; - uint64_t hash; + uint64_t hash = 0; thislen = __uint64_t_decode_array(buf, offset + pos, maxlen - pos, &hash, 1); if (thislen < 0) return thislen; else pos += thislen; if (hash != getHash()) return -1; diff --git a/test/symforce_function_codegen_test_data/sympy/codegen_dataclass_in_values_test_data/cpp/lcmtypes/codegen_test/my_dataclass_t.hpp b/test/symforce_function_codegen_test_data/sympy/codegen_dataclass_in_values_test_data/cpp/lcmtypes/codegen_test/my_dataclass_t.hpp index 84bef52b..bf0647fc 100644 --- a/test/symforce_function_codegen_test_data/sympy/codegen_dataclass_in_values_test_data/cpp/lcmtypes/codegen_test/my_dataclass_t.hpp +++ b/test/symforce_function_codegen_test_data/sympy/codegen_dataclass_in_values_test_data/cpp/lcmtypes/codegen_test/my_dataclass_t.hpp @@ -212,7 +212,7 @@ __lcm_buffer_size my_dataclass_t::decode(const void *buf, __lcm_buffer_size offs { __lcm_buffer_size pos = 0, thislen; - uint64_t hash; + uint64_t hash = 0; thislen = __uint64_t_decode_array(buf, offset + pos, maxlen - pos, &hash, 1); if (thislen < 0) return thislen; else pos += thislen; if (hash != getHash()) return -1; diff --git a/test/symforce_function_codegen_test_data/sympy/with_jacobians_values/cpp/lcmtypes/sym/d_out_t.hpp b/test/symforce_function_codegen_test_data/sympy/with_jacobians_values/cpp/lcmtypes/sym/d_out_t.hpp index 19d819a5..21f06313 100644 --- a/test/symforce_function_codegen_test_data/sympy/with_jacobians_values/cpp/lcmtypes/sym/d_out_t.hpp +++ b/test/symforce_function_codegen_test_data/sympy/with_jacobians_values/cpp/lcmtypes/sym/d_out_t.hpp @@ -222,7 +222,7 @@ __lcm_buffer_size d_out_t::decode(const void *buf, __lcm_buffer_size offset, __l { __lcm_buffer_size pos = 0, thislen; - uint64_t hash; + uint64_t hash = 0; thislen = __uint64_t_decode_array(buf, offset + pos, maxlen - pos, &hash, 1); if (thislen < 0) return thislen; else pos += thislen; if (hash != getHash()) return -1; diff --git a/test/symforce_function_codegen_test_data/sympy/with_jacobians_values/cpp/lcmtypes/sym/d_t.hpp b/test/symforce_function_codegen_test_data/sympy/with_jacobians_values/cpp/lcmtypes/sym/d_t.hpp index 0a1dfa6c..b43db198 100644 --- a/test/symforce_function_codegen_test_data/sympy/with_jacobians_values/cpp/lcmtypes/sym/d_t.hpp +++ b/test/symforce_function_codegen_test_data/sympy/with_jacobians_values/cpp/lcmtypes/sym/d_t.hpp @@ -230,7 +230,7 @@ __lcm_buffer_size d_t::decode(const void *buf, __lcm_buffer_size offset, __lcm_b { __lcm_buffer_size pos = 0, thislen; - uint64_t hash; + uint64_t hash = 0; thislen = __uint64_t_decode_array(buf, offset + pos, maxlen - pos, &hash, 1); if (thislen < 0) return thislen; else pos += thislen; if (hash != getHash()) return -1; diff --git a/third_party/eigen_lcm/lcmtypes/eigen_lcm_lcm/cpp/lcmtypes/eigen_lcm/Matrix24d.hpp b/third_party/eigen_lcm/lcmtypes/eigen_lcm_lcm/cpp/lcmtypes/eigen_lcm/Matrix24d.hpp index 910e4870..cda6f45e 100644 --- a/third_party/eigen_lcm/lcmtypes/eigen_lcm_lcm/cpp/lcmtypes/eigen_lcm/Matrix24d.hpp +++ b/third_party/eigen_lcm/lcmtypes/eigen_lcm_lcm/cpp/lcmtypes/eigen_lcm/Matrix24d.hpp @@ -141,7 +141,7 @@ __lcm_buffer_size Matrix24d::decode(const void* buf, __lcm_buffer_size offset, __lcm_buffer_size maxlen) { __lcm_buffer_size pos = 0, thislen; - uint64_t hash; + uint64_t hash = 0; thislen = __uint64_t_decode_array(buf, offset + pos, maxlen - pos, &hash, 1); if (thislen < 0) { return thislen; diff --git a/third_party/eigen_lcm/lcmtypes/eigen_lcm_lcm/cpp/lcmtypes/eigen_lcm/Matrix2d.hpp b/third_party/eigen_lcm/lcmtypes/eigen_lcm_lcm/cpp/lcmtypes/eigen_lcm/Matrix2d.hpp index 936f18ff..467df438 100644 --- a/third_party/eigen_lcm/lcmtypes/eigen_lcm_lcm/cpp/lcmtypes/eigen_lcm/Matrix2d.hpp +++ b/third_party/eigen_lcm/lcmtypes/eigen_lcm_lcm/cpp/lcmtypes/eigen_lcm/Matrix2d.hpp @@ -141,7 +141,7 @@ __lcm_buffer_size Matrix2d::decode(const void* buf, __lcm_buffer_size offset, __lcm_buffer_size maxlen) { __lcm_buffer_size pos = 0, thislen; - uint64_t hash; + uint64_t hash = 0; thislen = __uint64_t_decode_array(buf, offset + pos, maxlen - pos, &hash, 1); if (thislen < 0) { return thislen; diff --git a/third_party/eigen_lcm/lcmtypes/eigen_lcm_lcm/cpp/lcmtypes/eigen_lcm/Matrix2f.hpp b/third_party/eigen_lcm/lcmtypes/eigen_lcm_lcm/cpp/lcmtypes/eigen_lcm/Matrix2f.hpp index 474fdae8..f49e410f 100644 --- a/third_party/eigen_lcm/lcmtypes/eigen_lcm_lcm/cpp/lcmtypes/eigen_lcm/Matrix2f.hpp +++ b/third_party/eigen_lcm/lcmtypes/eigen_lcm_lcm/cpp/lcmtypes/eigen_lcm/Matrix2f.hpp @@ -141,7 +141,7 @@ __lcm_buffer_size Matrix2f::decode(const void* buf, __lcm_buffer_size offset, __lcm_buffer_size maxlen) { __lcm_buffer_size pos = 0, thislen; - uint64_t hash; + uint64_t hash = 0; thislen = __uint64_t_decode_array(buf, offset + pos, maxlen - pos, &hash, 1); if (thislen < 0) { return thislen; diff --git a/third_party/eigen_lcm/lcmtypes/eigen_lcm_lcm/cpp/lcmtypes/eigen_lcm/Matrix2i.hpp b/third_party/eigen_lcm/lcmtypes/eigen_lcm_lcm/cpp/lcmtypes/eigen_lcm/Matrix2i.hpp index 35079591..73d2bcf3 100644 --- a/third_party/eigen_lcm/lcmtypes/eigen_lcm_lcm/cpp/lcmtypes/eigen_lcm/Matrix2i.hpp +++ b/third_party/eigen_lcm/lcmtypes/eigen_lcm_lcm/cpp/lcmtypes/eigen_lcm/Matrix2i.hpp @@ -141,7 +141,7 @@ __lcm_buffer_size Matrix2i::decode(const void* buf, __lcm_buffer_size offset, __lcm_buffer_size maxlen) { __lcm_buffer_size pos = 0, thislen; - uint64_t hash; + uint64_t hash = 0; thislen = __uint64_t_decode_array(buf, offset + pos, maxlen - pos, &hash, 1); if (thislen < 0) { return thislen; diff --git a/third_party/eigen_lcm/lcmtypes/eigen_lcm_lcm/cpp/lcmtypes/eigen_lcm/Matrix34d.hpp b/third_party/eigen_lcm/lcmtypes/eigen_lcm_lcm/cpp/lcmtypes/eigen_lcm/Matrix34d.hpp index 612b26d3..39a58829 100644 --- a/third_party/eigen_lcm/lcmtypes/eigen_lcm_lcm/cpp/lcmtypes/eigen_lcm/Matrix34d.hpp +++ b/third_party/eigen_lcm/lcmtypes/eigen_lcm_lcm/cpp/lcmtypes/eigen_lcm/Matrix34d.hpp @@ -141,7 +141,7 @@ __lcm_buffer_size Matrix34d::decode(const void* buf, __lcm_buffer_size offset, __lcm_buffer_size maxlen) { __lcm_buffer_size pos = 0, thislen; - uint64_t hash; + uint64_t hash = 0; thislen = __uint64_t_decode_array(buf, offset + pos, maxlen - pos, &hash, 1); if (thislen < 0) { return thislen; diff --git a/third_party/eigen_lcm/lcmtypes/eigen_lcm_lcm/cpp/lcmtypes/eigen_lcm/Matrix3d.hpp b/third_party/eigen_lcm/lcmtypes/eigen_lcm_lcm/cpp/lcmtypes/eigen_lcm/Matrix3d.hpp index c2d243e5..f575c7b1 100644 --- a/third_party/eigen_lcm/lcmtypes/eigen_lcm_lcm/cpp/lcmtypes/eigen_lcm/Matrix3d.hpp +++ b/third_party/eigen_lcm/lcmtypes/eigen_lcm_lcm/cpp/lcmtypes/eigen_lcm/Matrix3d.hpp @@ -141,7 +141,7 @@ __lcm_buffer_size Matrix3d::decode(const void* buf, __lcm_buffer_size offset, __lcm_buffer_size maxlen) { __lcm_buffer_size pos = 0, thislen; - uint64_t hash; + uint64_t hash = 0; thislen = __uint64_t_decode_array(buf, offset + pos, maxlen - pos, &hash, 1); if (thislen < 0) { return thislen; diff --git a/third_party/eigen_lcm/lcmtypes/eigen_lcm_lcm/cpp/lcmtypes/eigen_lcm/Matrix3f.hpp b/third_party/eigen_lcm/lcmtypes/eigen_lcm_lcm/cpp/lcmtypes/eigen_lcm/Matrix3f.hpp index 72696c14..ed336ec7 100644 --- a/third_party/eigen_lcm/lcmtypes/eigen_lcm_lcm/cpp/lcmtypes/eigen_lcm/Matrix3f.hpp +++ b/third_party/eigen_lcm/lcmtypes/eigen_lcm_lcm/cpp/lcmtypes/eigen_lcm/Matrix3f.hpp @@ -141,7 +141,7 @@ __lcm_buffer_size Matrix3f::decode(const void* buf, __lcm_buffer_size offset, __lcm_buffer_size maxlen) { __lcm_buffer_size pos = 0, thislen; - uint64_t hash; + uint64_t hash = 0; thislen = __uint64_t_decode_array(buf, offset + pos, maxlen - pos, &hash, 1); if (thislen < 0) { return thislen; diff --git a/third_party/eigen_lcm/lcmtypes/eigen_lcm_lcm/cpp/lcmtypes/eigen_lcm/Matrix3i.hpp b/third_party/eigen_lcm/lcmtypes/eigen_lcm_lcm/cpp/lcmtypes/eigen_lcm/Matrix3i.hpp index 52f681d0..123c85a4 100644 --- a/third_party/eigen_lcm/lcmtypes/eigen_lcm_lcm/cpp/lcmtypes/eigen_lcm/Matrix3i.hpp +++ b/third_party/eigen_lcm/lcmtypes/eigen_lcm_lcm/cpp/lcmtypes/eigen_lcm/Matrix3i.hpp @@ -141,7 +141,7 @@ __lcm_buffer_size Matrix3i::decode(const void* buf, __lcm_buffer_size offset, __lcm_buffer_size maxlen) { __lcm_buffer_size pos = 0, thislen; - uint64_t hash; + uint64_t hash = 0; thislen = __uint64_t_decode_array(buf, offset + pos, maxlen - pos, &hash, 1); if (thislen < 0) { return thislen; diff --git a/third_party/eigen_lcm/lcmtypes/eigen_lcm_lcm/cpp/lcmtypes/eigen_lcm/Matrix43f.hpp b/third_party/eigen_lcm/lcmtypes/eigen_lcm_lcm/cpp/lcmtypes/eigen_lcm/Matrix43f.hpp index 7db883da..dc9618a8 100644 --- a/third_party/eigen_lcm/lcmtypes/eigen_lcm_lcm/cpp/lcmtypes/eigen_lcm/Matrix43f.hpp +++ b/third_party/eigen_lcm/lcmtypes/eigen_lcm_lcm/cpp/lcmtypes/eigen_lcm/Matrix43f.hpp @@ -141,7 +141,7 @@ __lcm_buffer_size Matrix43f::decode(const void* buf, __lcm_buffer_size offset, __lcm_buffer_size maxlen) { __lcm_buffer_size pos = 0, thislen; - uint64_t hash; + uint64_t hash = 0; thislen = __uint64_t_decode_array(buf, offset + pos, maxlen - pos, &hash, 1); if (thislen < 0) { return thislen; diff --git a/third_party/eigen_lcm/lcmtypes/eigen_lcm_lcm/cpp/lcmtypes/eigen_lcm/Matrix4d.hpp b/third_party/eigen_lcm/lcmtypes/eigen_lcm_lcm/cpp/lcmtypes/eigen_lcm/Matrix4d.hpp index fbaebb5a..693015e9 100644 --- a/third_party/eigen_lcm/lcmtypes/eigen_lcm_lcm/cpp/lcmtypes/eigen_lcm/Matrix4d.hpp +++ b/third_party/eigen_lcm/lcmtypes/eigen_lcm_lcm/cpp/lcmtypes/eigen_lcm/Matrix4d.hpp @@ -141,7 +141,7 @@ __lcm_buffer_size Matrix4d::decode(const void* buf, __lcm_buffer_size offset, __lcm_buffer_size maxlen) { __lcm_buffer_size pos = 0, thislen; - uint64_t hash; + uint64_t hash = 0; thislen = __uint64_t_decode_array(buf, offset + pos, maxlen - pos, &hash, 1); if (thislen < 0) { return thislen; diff --git a/third_party/eigen_lcm/lcmtypes/eigen_lcm_lcm/cpp/lcmtypes/eigen_lcm/Matrix4f.hpp b/third_party/eigen_lcm/lcmtypes/eigen_lcm_lcm/cpp/lcmtypes/eigen_lcm/Matrix4f.hpp index 60da1bae..d7c2679a 100644 --- a/third_party/eigen_lcm/lcmtypes/eigen_lcm_lcm/cpp/lcmtypes/eigen_lcm/Matrix4f.hpp +++ b/third_party/eigen_lcm/lcmtypes/eigen_lcm_lcm/cpp/lcmtypes/eigen_lcm/Matrix4f.hpp @@ -141,7 +141,7 @@ __lcm_buffer_size Matrix4f::decode(const void* buf, __lcm_buffer_size offset, __lcm_buffer_size maxlen) { __lcm_buffer_size pos = 0, thislen; - uint64_t hash; + uint64_t hash = 0; thislen = __uint64_t_decode_array(buf, offset + pos, maxlen - pos, &hash, 1); if (thislen < 0) { return thislen; diff --git a/third_party/eigen_lcm/lcmtypes/eigen_lcm_lcm/cpp/lcmtypes/eigen_lcm/Matrix4i.hpp b/third_party/eigen_lcm/lcmtypes/eigen_lcm_lcm/cpp/lcmtypes/eigen_lcm/Matrix4i.hpp index 1837d4fc..4c3fa0aa 100644 --- a/third_party/eigen_lcm/lcmtypes/eigen_lcm_lcm/cpp/lcmtypes/eigen_lcm/Matrix4i.hpp +++ b/third_party/eigen_lcm/lcmtypes/eigen_lcm_lcm/cpp/lcmtypes/eigen_lcm/Matrix4i.hpp @@ -141,7 +141,7 @@ __lcm_buffer_size Matrix4i::decode(const void* buf, __lcm_buffer_size offset, __lcm_buffer_size maxlen) { __lcm_buffer_size pos = 0, thislen; - uint64_t hash; + uint64_t hash = 0; thislen = __uint64_t_decode_array(buf, offset + pos, maxlen - pos, &hash, 1); if (thislen < 0) { return thislen; diff --git a/third_party/eigen_lcm/lcmtypes/eigen_lcm_lcm/cpp/lcmtypes/eigen_lcm/Matrix54d.hpp b/third_party/eigen_lcm/lcmtypes/eigen_lcm_lcm/cpp/lcmtypes/eigen_lcm/Matrix54d.hpp index d39d6527..c922a9bb 100644 --- a/third_party/eigen_lcm/lcmtypes/eigen_lcm_lcm/cpp/lcmtypes/eigen_lcm/Matrix54d.hpp +++ b/third_party/eigen_lcm/lcmtypes/eigen_lcm_lcm/cpp/lcmtypes/eigen_lcm/Matrix54d.hpp @@ -141,7 +141,7 @@ __lcm_buffer_size Matrix54d::decode(const void* buf, __lcm_buffer_size offset, __lcm_buffer_size maxlen) { __lcm_buffer_size pos = 0, thislen; - uint64_t hash; + uint64_t hash = 0; thislen = __uint64_t_decode_array(buf, offset + pos, maxlen - pos, &hash, 1); if (thislen < 0) { return thislen; diff --git a/third_party/eigen_lcm/lcmtypes/eigen_lcm_lcm/cpp/lcmtypes/eigen_lcm/Matrix68f.hpp b/third_party/eigen_lcm/lcmtypes/eigen_lcm_lcm/cpp/lcmtypes/eigen_lcm/Matrix68f.hpp index bdac88a8..ba4e0e39 100644 --- a/third_party/eigen_lcm/lcmtypes/eigen_lcm_lcm/cpp/lcmtypes/eigen_lcm/Matrix68f.hpp +++ b/third_party/eigen_lcm/lcmtypes/eigen_lcm_lcm/cpp/lcmtypes/eigen_lcm/Matrix68f.hpp @@ -141,7 +141,7 @@ __lcm_buffer_size Matrix68f::decode(const void* buf, __lcm_buffer_size offset, __lcm_buffer_size maxlen) { __lcm_buffer_size pos = 0, thislen; - uint64_t hash; + uint64_t hash = 0; thislen = __uint64_t_decode_array(buf, offset + pos, maxlen - pos, &hash, 1); if (thislen < 0) { return thislen; diff --git a/third_party/eigen_lcm/lcmtypes/eigen_lcm_lcm/cpp/lcmtypes/eigen_lcm/MatrixXd.hpp b/third_party/eigen_lcm/lcmtypes/eigen_lcm_lcm/cpp/lcmtypes/eigen_lcm/MatrixXd.hpp index 2dfa8a71..e5ee2a8c 100644 --- a/third_party/eigen_lcm/lcmtypes/eigen_lcm_lcm/cpp/lcmtypes/eigen_lcm/MatrixXd.hpp +++ b/third_party/eigen_lcm/lcmtypes/eigen_lcm_lcm/cpp/lcmtypes/eigen_lcm/MatrixXd.hpp @@ -140,7 +140,7 @@ __lcm_buffer_size MatrixXd::decode(const void* buf, __lcm_buffer_size offset, __lcm_buffer_size maxlen) { __lcm_buffer_size pos = 0, thislen; - uint64_t hash; + uint64_t hash = 0; thislen = __uint64_t_decode_array(buf, offset + pos, maxlen - pos, &hash, 1); if (thislen < 0) { return thislen; diff --git a/third_party/eigen_lcm/lcmtypes/eigen_lcm_lcm/cpp/lcmtypes/eigen_lcm/MatrixXf.hpp b/third_party/eigen_lcm/lcmtypes/eigen_lcm_lcm/cpp/lcmtypes/eigen_lcm/MatrixXf.hpp index a94e92cd..dea98884 100644 --- a/third_party/eigen_lcm/lcmtypes/eigen_lcm_lcm/cpp/lcmtypes/eigen_lcm/MatrixXf.hpp +++ b/third_party/eigen_lcm/lcmtypes/eigen_lcm_lcm/cpp/lcmtypes/eigen_lcm/MatrixXf.hpp @@ -140,7 +140,7 @@ __lcm_buffer_size MatrixXf::decode(const void* buf, __lcm_buffer_size offset, __lcm_buffer_size maxlen) { __lcm_buffer_size pos = 0, thislen; - uint64_t hash; + uint64_t hash = 0; thislen = __uint64_t_decode_array(buf, offset + pos, maxlen - pos, &hash, 1); if (thislen < 0) { return thislen; diff --git a/third_party/eigen_lcm/lcmtypes/eigen_lcm_lcm/cpp/lcmtypes/eigen_lcm/MatrixXi.hpp b/third_party/eigen_lcm/lcmtypes/eigen_lcm_lcm/cpp/lcmtypes/eigen_lcm/MatrixXi.hpp index feace030..70f33330 100644 --- a/third_party/eigen_lcm/lcmtypes/eigen_lcm_lcm/cpp/lcmtypes/eigen_lcm/MatrixXi.hpp +++ b/third_party/eigen_lcm/lcmtypes/eigen_lcm_lcm/cpp/lcmtypes/eigen_lcm/MatrixXi.hpp @@ -140,7 +140,7 @@ __lcm_buffer_size MatrixXi::decode(const void* buf, __lcm_buffer_size offset, __lcm_buffer_size maxlen) { __lcm_buffer_size pos = 0, thislen; - uint64_t hash; + uint64_t hash = 0; thislen = __uint64_t_decode_array(buf, offset + pos, maxlen - pos, &hash, 1); if (thislen < 0) { return thislen; diff --git a/third_party/eigen_lcm/lcmtypes/eigen_lcm_lcm/cpp/lcmtypes/eigen_lcm/Quaterniond.hpp b/third_party/eigen_lcm/lcmtypes/eigen_lcm_lcm/cpp/lcmtypes/eigen_lcm/Quaterniond.hpp index 683acb85..7babf03e 100644 --- a/third_party/eigen_lcm/lcmtypes/eigen_lcm_lcm/cpp/lcmtypes/eigen_lcm/Quaterniond.hpp +++ b/third_party/eigen_lcm/lcmtypes/eigen_lcm_lcm/cpp/lcmtypes/eigen_lcm/Quaterniond.hpp @@ -146,7 +146,7 @@ __lcm_buffer_size Quaterniond::decode(const void* buf, __lcm_buffer_size offset, __lcm_buffer_size maxlen) { __lcm_buffer_size pos = 0, thislen; - uint64_t hash; + uint64_t hash = 0; thislen = __uint64_t_decode_array(buf, offset + pos, maxlen - pos, &hash, 1); if (thislen < 0) { return thislen; diff --git a/third_party/eigen_lcm/lcmtypes/eigen_lcm_lcm/cpp/lcmtypes/eigen_lcm/Quaternionf.hpp b/third_party/eigen_lcm/lcmtypes/eigen_lcm_lcm/cpp/lcmtypes/eigen_lcm/Quaternionf.hpp index d62afd5f..acd91b76 100644 --- a/third_party/eigen_lcm/lcmtypes/eigen_lcm_lcm/cpp/lcmtypes/eigen_lcm/Quaternionf.hpp +++ b/third_party/eigen_lcm/lcmtypes/eigen_lcm_lcm/cpp/lcmtypes/eigen_lcm/Quaternionf.hpp @@ -146,7 +146,7 @@ __lcm_buffer_size Quaternionf::decode(const void* buf, __lcm_buffer_size offset, __lcm_buffer_size maxlen) { __lcm_buffer_size pos = 0, thislen; - uint64_t hash; + uint64_t hash = 0; thislen = __uint64_t_decode_array(buf, offset + pos, maxlen - pos, &hash, 1); if (thislen < 0) { return thislen; diff --git a/third_party/eigen_lcm/lcmtypes/eigen_lcm_lcm/cpp/lcmtypes/eigen_lcm/SymmetricMatrix2d.hpp b/third_party/eigen_lcm/lcmtypes/eigen_lcm_lcm/cpp/lcmtypes/eigen_lcm/SymmetricMatrix2d.hpp index c2d394fc..2bf93192 100644 --- a/third_party/eigen_lcm/lcmtypes/eigen_lcm_lcm/cpp/lcmtypes/eigen_lcm/SymmetricMatrix2d.hpp +++ b/third_party/eigen_lcm/lcmtypes/eigen_lcm_lcm/cpp/lcmtypes/eigen_lcm/SymmetricMatrix2d.hpp @@ -141,7 +141,7 @@ __lcm_buffer_size SymmetricMatrix2d::decode(const void* buf, __lcm_buffer_size o __lcm_buffer_size maxlen) { __lcm_buffer_size pos = 0, thislen; - uint64_t hash; + uint64_t hash = 0; thislen = __uint64_t_decode_array(buf, offset + pos, maxlen - pos, &hash, 1); if (thislen < 0) { return thislen; diff --git a/third_party/eigen_lcm/lcmtypes/eigen_lcm_lcm/cpp/lcmtypes/eigen_lcm/SymmetricMatrix2f.hpp b/third_party/eigen_lcm/lcmtypes/eigen_lcm_lcm/cpp/lcmtypes/eigen_lcm/SymmetricMatrix2f.hpp index b17591b2..a28f59da 100644 --- a/third_party/eigen_lcm/lcmtypes/eigen_lcm_lcm/cpp/lcmtypes/eigen_lcm/SymmetricMatrix2f.hpp +++ b/third_party/eigen_lcm/lcmtypes/eigen_lcm_lcm/cpp/lcmtypes/eigen_lcm/SymmetricMatrix2f.hpp @@ -141,7 +141,7 @@ __lcm_buffer_size SymmetricMatrix2f::decode(const void* buf, __lcm_buffer_size o __lcm_buffer_size maxlen) { __lcm_buffer_size pos = 0, thislen; - uint64_t hash; + uint64_t hash = 0; thislen = __uint64_t_decode_array(buf, offset + pos, maxlen - pos, &hash, 1); if (thislen < 0) { return thislen; diff --git a/third_party/eigen_lcm/lcmtypes/eigen_lcm_lcm/cpp/lcmtypes/eigen_lcm/SymmetricMatrix3d.hpp b/third_party/eigen_lcm/lcmtypes/eigen_lcm_lcm/cpp/lcmtypes/eigen_lcm/SymmetricMatrix3d.hpp index 7ea6a980..3e42af77 100644 --- a/third_party/eigen_lcm/lcmtypes/eigen_lcm_lcm/cpp/lcmtypes/eigen_lcm/SymmetricMatrix3d.hpp +++ b/third_party/eigen_lcm/lcmtypes/eigen_lcm_lcm/cpp/lcmtypes/eigen_lcm/SymmetricMatrix3d.hpp @@ -141,7 +141,7 @@ __lcm_buffer_size SymmetricMatrix3d::decode(const void* buf, __lcm_buffer_size o __lcm_buffer_size maxlen) { __lcm_buffer_size pos = 0, thislen; - uint64_t hash; + uint64_t hash = 0; thislen = __uint64_t_decode_array(buf, offset + pos, maxlen - pos, &hash, 1); if (thislen < 0) { return thislen; diff --git a/third_party/eigen_lcm/lcmtypes/eigen_lcm_lcm/cpp/lcmtypes/eigen_lcm/SymmetricMatrix3f.hpp b/third_party/eigen_lcm/lcmtypes/eigen_lcm_lcm/cpp/lcmtypes/eigen_lcm/SymmetricMatrix3f.hpp index da2dbe3c..df6b0057 100644 --- a/third_party/eigen_lcm/lcmtypes/eigen_lcm_lcm/cpp/lcmtypes/eigen_lcm/SymmetricMatrix3f.hpp +++ b/third_party/eigen_lcm/lcmtypes/eigen_lcm_lcm/cpp/lcmtypes/eigen_lcm/SymmetricMatrix3f.hpp @@ -141,7 +141,7 @@ __lcm_buffer_size SymmetricMatrix3f::decode(const void* buf, __lcm_buffer_size o __lcm_buffer_size maxlen) { __lcm_buffer_size pos = 0, thislen; - uint64_t hash; + uint64_t hash = 0; thislen = __uint64_t_decode_array(buf, offset + pos, maxlen - pos, &hash, 1); if (thislen < 0) { return thislen; diff --git a/third_party/eigen_lcm/lcmtypes/eigen_lcm_lcm/cpp/lcmtypes/eigen_lcm/SymmetricMatrix4d.hpp b/third_party/eigen_lcm/lcmtypes/eigen_lcm_lcm/cpp/lcmtypes/eigen_lcm/SymmetricMatrix4d.hpp index 4373f607..9e085347 100644 --- a/third_party/eigen_lcm/lcmtypes/eigen_lcm_lcm/cpp/lcmtypes/eigen_lcm/SymmetricMatrix4d.hpp +++ b/third_party/eigen_lcm/lcmtypes/eigen_lcm_lcm/cpp/lcmtypes/eigen_lcm/SymmetricMatrix4d.hpp @@ -141,7 +141,7 @@ __lcm_buffer_size SymmetricMatrix4d::decode(const void* buf, __lcm_buffer_size o __lcm_buffer_size maxlen) { __lcm_buffer_size pos = 0, thislen; - uint64_t hash; + uint64_t hash = 0; thislen = __uint64_t_decode_array(buf, offset + pos, maxlen - pos, &hash, 1); if (thislen < 0) { return thislen; diff --git a/third_party/eigen_lcm/lcmtypes/eigen_lcm_lcm/cpp/lcmtypes/eigen_lcm/SymmetricMatrix4f.hpp b/third_party/eigen_lcm/lcmtypes/eigen_lcm_lcm/cpp/lcmtypes/eigen_lcm/SymmetricMatrix4f.hpp index b020b091..92701ece 100644 --- a/third_party/eigen_lcm/lcmtypes/eigen_lcm_lcm/cpp/lcmtypes/eigen_lcm/SymmetricMatrix4f.hpp +++ b/third_party/eigen_lcm/lcmtypes/eigen_lcm_lcm/cpp/lcmtypes/eigen_lcm/SymmetricMatrix4f.hpp @@ -141,7 +141,7 @@ __lcm_buffer_size SymmetricMatrix4f::decode(const void* buf, __lcm_buffer_size o __lcm_buffer_size maxlen) { __lcm_buffer_size pos = 0, thislen; - uint64_t hash; + uint64_t hash = 0; thislen = __uint64_t_decode_array(buf, offset + pos, maxlen - pos, &hash, 1); if (thislen < 0) { return thislen; diff --git a/third_party/eigen_lcm/lcmtypes/eigen_lcm_lcm/cpp/lcmtypes/eigen_lcm/SymmetricMatrixXd.hpp b/third_party/eigen_lcm/lcmtypes/eigen_lcm_lcm/cpp/lcmtypes/eigen_lcm/SymmetricMatrixXd.hpp index b4c6bf94..decb7660 100644 --- a/third_party/eigen_lcm/lcmtypes/eigen_lcm_lcm/cpp/lcmtypes/eigen_lcm/SymmetricMatrixXd.hpp +++ b/third_party/eigen_lcm/lcmtypes/eigen_lcm_lcm/cpp/lcmtypes/eigen_lcm/SymmetricMatrixXd.hpp @@ -141,7 +141,7 @@ __lcm_buffer_size SymmetricMatrixXd::decode(const void* buf, __lcm_buffer_size o __lcm_buffer_size maxlen) { __lcm_buffer_size pos = 0, thislen; - uint64_t hash; + uint64_t hash = 0; thislen = __uint64_t_decode_array(buf, offset + pos, maxlen - pos, &hash, 1); if (thislen < 0) { return thislen; diff --git a/third_party/eigen_lcm/lcmtypes/eigen_lcm_lcm/cpp/lcmtypes/eigen_lcm/SymmetricMatrixXf.hpp b/third_party/eigen_lcm/lcmtypes/eigen_lcm_lcm/cpp/lcmtypes/eigen_lcm/SymmetricMatrixXf.hpp index c967c0d8..014a21d5 100644 --- a/third_party/eigen_lcm/lcmtypes/eigen_lcm_lcm/cpp/lcmtypes/eigen_lcm/SymmetricMatrixXf.hpp +++ b/third_party/eigen_lcm/lcmtypes/eigen_lcm_lcm/cpp/lcmtypes/eigen_lcm/SymmetricMatrixXf.hpp @@ -141,7 +141,7 @@ __lcm_buffer_size SymmetricMatrixXf::decode(const void* buf, __lcm_buffer_size o __lcm_buffer_size maxlen) { __lcm_buffer_size pos = 0, thislen; - uint64_t hash; + uint64_t hash = 0; thislen = __uint64_t_decode_array(buf, offset + pos, maxlen - pos, &hash, 1); if (thislen < 0) { return thislen; diff --git a/third_party/eigen_lcm/lcmtypes/eigen_lcm_lcm/cpp/lcmtypes/eigen_lcm/Vector1d.hpp b/third_party/eigen_lcm/lcmtypes/eigen_lcm_lcm/cpp/lcmtypes/eigen_lcm/Vector1d.hpp index 0eb033eb..23ef6acd 100644 --- a/third_party/eigen_lcm/lcmtypes/eigen_lcm_lcm/cpp/lcmtypes/eigen_lcm/Vector1d.hpp +++ b/third_party/eigen_lcm/lcmtypes/eigen_lcm_lcm/cpp/lcmtypes/eigen_lcm/Vector1d.hpp @@ -141,7 +141,7 @@ __lcm_buffer_size Vector1d::decode(const void* buf, __lcm_buffer_size offset, __lcm_buffer_size maxlen) { __lcm_buffer_size pos = 0, thislen; - uint64_t hash; + uint64_t hash = 0; thislen = __uint64_t_decode_array(buf, offset + pos, maxlen - pos, &hash, 1); if (thislen < 0) { return thislen; diff --git a/third_party/eigen_lcm/lcmtypes/eigen_lcm_lcm/cpp/lcmtypes/eigen_lcm/Vector1f.hpp b/third_party/eigen_lcm/lcmtypes/eigen_lcm_lcm/cpp/lcmtypes/eigen_lcm/Vector1f.hpp index 8f63a5f9..a98a6d2c 100644 --- a/third_party/eigen_lcm/lcmtypes/eigen_lcm_lcm/cpp/lcmtypes/eigen_lcm/Vector1f.hpp +++ b/third_party/eigen_lcm/lcmtypes/eigen_lcm_lcm/cpp/lcmtypes/eigen_lcm/Vector1f.hpp @@ -141,7 +141,7 @@ __lcm_buffer_size Vector1f::decode(const void* buf, __lcm_buffer_size offset, __lcm_buffer_size maxlen) { __lcm_buffer_size pos = 0, thislen; - uint64_t hash; + uint64_t hash = 0; thislen = __uint64_t_decode_array(buf, offset + pos, maxlen - pos, &hash, 1); if (thislen < 0) { return thislen; diff --git a/third_party/eigen_lcm/lcmtypes/eigen_lcm_lcm/cpp/lcmtypes/eigen_lcm/Vector1i.hpp b/third_party/eigen_lcm/lcmtypes/eigen_lcm_lcm/cpp/lcmtypes/eigen_lcm/Vector1i.hpp index 654e8ba7..75d5df84 100644 --- a/third_party/eigen_lcm/lcmtypes/eigen_lcm_lcm/cpp/lcmtypes/eigen_lcm/Vector1i.hpp +++ b/third_party/eigen_lcm/lcmtypes/eigen_lcm_lcm/cpp/lcmtypes/eigen_lcm/Vector1i.hpp @@ -141,7 +141,7 @@ __lcm_buffer_size Vector1i::decode(const void* buf, __lcm_buffer_size offset, __lcm_buffer_size maxlen) { __lcm_buffer_size pos = 0, thislen; - uint64_t hash; + uint64_t hash = 0; thislen = __uint64_t_decode_array(buf, offset + pos, maxlen - pos, &hash, 1); if (thislen < 0) { return thislen; diff --git a/third_party/eigen_lcm/lcmtypes/eigen_lcm_lcm/cpp/lcmtypes/eigen_lcm/Vector2d.hpp b/third_party/eigen_lcm/lcmtypes/eigen_lcm_lcm/cpp/lcmtypes/eigen_lcm/Vector2d.hpp index dad4f9a2..3d3a3b05 100644 --- a/third_party/eigen_lcm/lcmtypes/eigen_lcm_lcm/cpp/lcmtypes/eigen_lcm/Vector2d.hpp +++ b/third_party/eigen_lcm/lcmtypes/eigen_lcm_lcm/cpp/lcmtypes/eigen_lcm/Vector2d.hpp @@ -141,7 +141,7 @@ __lcm_buffer_size Vector2d::decode(const void* buf, __lcm_buffer_size offset, __lcm_buffer_size maxlen) { __lcm_buffer_size pos = 0, thislen; - uint64_t hash; + uint64_t hash = 0; thislen = __uint64_t_decode_array(buf, offset + pos, maxlen - pos, &hash, 1); if (thislen < 0) { return thislen; diff --git a/third_party/eigen_lcm/lcmtypes/eigen_lcm_lcm/cpp/lcmtypes/eigen_lcm/Vector2f.hpp b/third_party/eigen_lcm/lcmtypes/eigen_lcm_lcm/cpp/lcmtypes/eigen_lcm/Vector2f.hpp index 92745901..52e6363e 100644 --- a/third_party/eigen_lcm/lcmtypes/eigen_lcm_lcm/cpp/lcmtypes/eigen_lcm/Vector2f.hpp +++ b/third_party/eigen_lcm/lcmtypes/eigen_lcm_lcm/cpp/lcmtypes/eigen_lcm/Vector2f.hpp @@ -141,7 +141,7 @@ __lcm_buffer_size Vector2f::decode(const void* buf, __lcm_buffer_size offset, __lcm_buffer_size maxlen) { __lcm_buffer_size pos = 0, thislen; - uint64_t hash; + uint64_t hash = 0; thislen = __uint64_t_decode_array(buf, offset + pos, maxlen - pos, &hash, 1); if (thislen < 0) { return thislen; diff --git a/third_party/eigen_lcm/lcmtypes/eigen_lcm_lcm/cpp/lcmtypes/eigen_lcm/Vector2i.hpp b/third_party/eigen_lcm/lcmtypes/eigen_lcm_lcm/cpp/lcmtypes/eigen_lcm/Vector2i.hpp index a307a407..2f52fd52 100644 --- a/third_party/eigen_lcm/lcmtypes/eigen_lcm_lcm/cpp/lcmtypes/eigen_lcm/Vector2i.hpp +++ b/third_party/eigen_lcm/lcmtypes/eigen_lcm_lcm/cpp/lcmtypes/eigen_lcm/Vector2i.hpp @@ -141,7 +141,7 @@ __lcm_buffer_size Vector2i::decode(const void* buf, __lcm_buffer_size offset, __lcm_buffer_size maxlen) { __lcm_buffer_size pos = 0, thislen; - uint64_t hash; + uint64_t hash = 0; thislen = __uint64_t_decode_array(buf, offset + pos, maxlen - pos, &hash, 1); if (thislen < 0) { return thislen; diff --git a/third_party/eigen_lcm/lcmtypes/eigen_lcm_lcm/cpp/lcmtypes/eigen_lcm/Vector3d.hpp b/third_party/eigen_lcm/lcmtypes/eigen_lcm_lcm/cpp/lcmtypes/eigen_lcm/Vector3d.hpp index 7bdc1922..cfa41394 100644 --- a/third_party/eigen_lcm/lcmtypes/eigen_lcm_lcm/cpp/lcmtypes/eigen_lcm/Vector3d.hpp +++ b/third_party/eigen_lcm/lcmtypes/eigen_lcm_lcm/cpp/lcmtypes/eigen_lcm/Vector3d.hpp @@ -141,7 +141,7 @@ __lcm_buffer_size Vector3d::decode(const void* buf, __lcm_buffer_size offset, __lcm_buffer_size maxlen) { __lcm_buffer_size pos = 0, thislen; - uint64_t hash; + uint64_t hash = 0; thislen = __uint64_t_decode_array(buf, offset + pos, maxlen - pos, &hash, 1); if (thislen < 0) { return thislen; diff --git a/third_party/eigen_lcm/lcmtypes/eigen_lcm_lcm/cpp/lcmtypes/eigen_lcm/Vector3f.hpp b/third_party/eigen_lcm/lcmtypes/eigen_lcm_lcm/cpp/lcmtypes/eigen_lcm/Vector3f.hpp index 5ced087b..9d2513ad 100644 --- a/third_party/eigen_lcm/lcmtypes/eigen_lcm_lcm/cpp/lcmtypes/eigen_lcm/Vector3f.hpp +++ b/third_party/eigen_lcm/lcmtypes/eigen_lcm_lcm/cpp/lcmtypes/eigen_lcm/Vector3f.hpp @@ -141,7 +141,7 @@ __lcm_buffer_size Vector3f::decode(const void* buf, __lcm_buffer_size offset, __lcm_buffer_size maxlen) { __lcm_buffer_size pos = 0, thislen; - uint64_t hash; + uint64_t hash = 0; thislen = __uint64_t_decode_array(buf, offset + pos, maxlen - pos, &hash, 1); if (thislen < 0) { return thislen; diff --git a/third_party/eigen_lcm/lcmtypes/eigen_lcm_lcm/cpp/lcmtypes/eigen_lcm/Vector3i.hpp b/third_party/eigen_lcm/lcmtypes/eigen_lcm_lcm/cpp/lcmtypes/eigen_lcm/Vector3i.hpp index 38070f54..bfb2eb09 100644 --- a/third_party/eigen_lcm/lcmtypes/eigen_lcm_lcm/cpp/lcmtypes/eigen_lcm/Vector3i.hpp +++ b/third_party/eigen_lcm/lcmtypes/eigen_lcm_lcm/cpp/lcmtypes/eigen_lcm/Vector3i.hpp @@ -141,7 +141,7 @@ __lcm_buffer_size Vector3i::decode(const void* buf, __lcm_buffer_size offset, __lcm_buffer_size maxlen) { __lcm_buffer_size pos = 0, thislen; - uint64_t hash; + uint64_t hash = 0; thislen = __uint64_t_decode_array(buf, offset + pos, maxlen - pos, &hash, 1); if (thislen < 0) { return thislen; diff --git a/third_party/eigen_lcm/lcmtypes/eigen_lcm_lcm/cpp/lcmtypes/eigen_lcm/Vector4d.hpp b/third_party/eigen_lcm/lcmtypes/eigen_lcm_lcm/cpp/lcmtypes/eigen_lcm/Vector4d.hpp index 46d1b400..9b3811e6 100644 --- a/third_party/eigen_lcm/lcmtypes/eigen_lcm_lcm/cpp/lcmtypes/eigen_lcm/Vector4d.hpp +++ b/third_party/eigen_lcm/lcmtypes/eigen_lcm_lcm/cpp/lcmtypes/eigen_lcm/Vector4d.hpp @@ -141,7 +141,7 @@ __lcm_buffer_size Vector4d::decode(const void* buf, __lcm_buffer_size offset, __lcm_buffer_size maxlen) { __lcm_buffer_size pos = 0, thislen; - uint64_t hash; + uint64_t hash = 0; thislen = __uint64_t_decode_array(buf, offset + pos, maxlen - pos, &hash, 1); if (thislen < 0) { return thislen; diff --git a/third_party/eigen_lcm/lcmtypes/eigen_lcm_lcm/cpp/lcmtypes/eigen_lcm/Vector4f.hpp b/third_party/eigen_lcm/lcmtypes/eigen_lcm_lcm/cpp/lcmtypes/eigen_lcm/Vector4f.hpp index 8d032243..40b4048e 100644 --- a/third_party/eigen_lcm/lcmtypes/eigen_lcm_lcm/cpp/lcmtypes/eigen_lcm/Vector4f.hpp +++ b/third_party/eigen_lcm/lcmtypes/eigen_lcm_lcm/cpp/lcmtypes/eigen_lcm/Vector4f.hpp @@ -141,7 +141,7 @@ __lcm_buffer_size Vector4f::decode(const void* buf, __lcm_buffer_size offset, __lcm_buffer_size maxlen) { __lcm_buffer_size pos = 0, thislen; - uint64_t hash; + uint64_t hash = 0; thislen = __uint64_t_decode_array(buf, offset + pos, maxlen - pos, &hash, 1); if (thislen < 0) { return thislen; diff --git a/third_party/eigen_lcm/lcmtypes/eigen_lcm_lcm/cpp/lcmtypes/eigen_lcm/Vector4i.hpp b/third_party/eigen_lcm/lcmtypes/eigen_lcm_lcm/cpp/lcmtypes/eigen_lcm/Vector4i.hpp index 7971aff2..97da0bee 100644 --- a/third_party/eigen_lcm/lcmtypes/eigen_lcm_lcm/cpp/lcmtypes/eigen_lcm/Vector4i.hpp +++ b/third_party/eigen_lcm/lcmtypes/eigen_lcm_lcm/cpp/lcmtypes/eigen_lcm/Vector4i.hpp @@ -141,7 +141,7 @@ __lcm_buffer_size Vector4i::decode(const void* buf, __lcm_buffer_size offset, __lcm_buffer_size maxlen) { __lcm_buffer_size pos = 0, thislen; - uint64_t hash; + uint64_t hash = 0; thislen = __uint64_t_decode_array(buf, offset + pos, maxlen - pos, &hash, 1); if (thislen < 0) { return thislen; diff --git a/third_party/eigen_lcm/lcmtypes/eigen_lcm_lcm/cpp/lcmtypes/eigen_lcm/Vector5d.hpp b/third_party/eigen_lcm/lcmtypes/eigen_lcm_lcm/cpp/lcmtypes/eigen_lcm/Vector5d.hpp index 901c303c..63591bc1 100644 --- a/third_party/eigen_lcm/lcmtypes/eigen_lcm_lcm/cpp/lcmtypes/eigen_lcm/Vector5d.hpp +++ b/third_party/eigen_lcm/lcmtypes/eigen_lcm_lcm/cpp/lcmtypes/eigen_lcm/Vector5d.hpp @@ -141,7 +141,7 @@ __lcm_buffer_size Vector5d::decode(const void* buf, __lcm_buffer_size offset, __lcm_buffer_size maxlen) { __lcm_buffer_size pos = 0, thislen; - uint64_t hash; + uint64_t hash = 0; thislen = __uint64_t_decode_array(buf, offset + pos, maxlen - pos, &hash, 1); if (thislen < 0) { return thislen; diff --git a/third_party/eigen_lcm/lcmtypes/eigen_lcm_lcm/cpp/lcmtypes/eigen_lcm/Vector5f.hpp b/third_party/eigen_lcm/lcmtypes/eigen_lcm_lcm/cpp/lcmtypes/eigen_lcm/Vector5f.hpp index 75d41948..875e345c 100644 --- a/third_party/eigen_lcm/lcmtypes/eigen_lcm_lcm/cpp/lcmtypes/eigen_lcm/Vector5f.hpp +++ b/third_party/eigen_lcm/lcmtypes/eigen_lcm_lcm/cpp/lcmtypes/eigen_lcm/Vector5f.hpp @@ -141,7 +141,7 @@ __lcm_buffer_size Vector5f::decode(const void* buf, __lcm_buffer_size offset, __lcm_buffer_size maxlen) { __lcm_buffer_size pos = 0, thislen; - uint64_t hash; + uint64_t hash = 0; thislen = __uint64_t_decode_array(buf, offset + pos, maxlen - pos, &hash, 1); if (thislen < 0) { return thislen; diff --git a/third_party/eigen_lcm/lcmtypes/eigen_lcm_lcm/cpp/lcmtypes/eigen_lcm/Vector5i.hpp b/third_party/eigen_lcm/lcmtypes/eigen_lcm_lcm/cpp/lcmtypes/eigen_lcm/Vector5i.hpp index 8d19a67f..9fd900a4 100644 --- a/third_party/eigen_lcm/lcmtypes/eigen_lcm_lcm/cpp/lcmtypes/eigen_lcm/Vector5i.hpp +++ b/third_party/eigen_lcm/lcmtypes/eigen_lcm_lcm/cpp/lcmtypes/eigen_lcm/Vector5i.hpp @@ -141,7 +141,7 @@ __lcm_buffer_size Vector5i::decode(const void* buf, __lcm_buffer_size offset, __lcm_buffer_size maxlen) { __lcm_buffer_size pos = 0, thislen; - uint64_t hash; + uint64_t hash = 0; thislen = __uint64_t_decode_array(buf, offset + pos, maxlen - pos, &hash, 1); if (thislen < 0) { return thislen; diff --git a/third_party/eigen_lcm/lcmtypes/eigen_lcm_lcm/cpp/lcmtypes/eigen_lcm/Vector6d.hpp b/third_party/eigen_lcm/lcmtypes/eigen_lcm_lcm/cpp/lcmtypes/eigen_lcm/Vector6d.hpp index 0fd27933..c09af7ae 100644 --- a/third_party/eigen_lcm/lcmtypes/eigen_lcm_lcm/cpp/lcmtypes/eigen_lcm/Vector6d.hpp +++ b/third_party/eigen_lcm/lcmtypes/eigen_lcm_lcm/cpp/lcmtypes/eigen_lcm/Vector6d.hpp @@ -141,7 +141,7 @@ __lcm_buffer_size Vector6d::decode(const void* buf, __lcm_buffer_size offset, __lcm_buffer_size maxlen) { __lcm_buffer_size pos = 0, thislen; - uint64_t hash; + uint64_t hash = 0; thislen = __uint64_t_decode_array(buf, offset + pos, maxlen - pos, &hash, 1); if (thislen < 0) { return thislen; diff --git a/third_party/eigen_lcm/lcmtypes/eigen_lcm_lcm/cpp/lcmtypes/eigen_lcm/Vector6f.hpp b/third_party/eigen_lcm/lcmtypes/eigen_lcm_lcm/cpp/lcmtypes/eigen_lcm/Vector6f.hpp index b22cffc0..328ef215 100644 --- a/third_party/eigen_lcm/lcmtypes/eigen_lcm_lcm/cpp/lcmtypes/eigen_lcm/Vector6f.hpp +++ b/third_party/eigen_lcm/lcmtypes/eigen_lcm_lcm/cpp/lcmtypes/eigen_lcm/Vector6f.hpp @@ -141,7 +141,7 @@ __lcm_buffer_size Vector6f::decode(const void* buf, __lcm_buffer_size offset, __lcm_buffer_size maxlen) { __lcm_buffer_size pos = 0, thislen; - uint64_t hash; + uint64_t hash = 0; thislen = __uint64_t_decode_array(buf, offset + pos, maxlen - pos, &hash, 1); if (thislen < 0) { return thislen; diff --git a/third_party/eigen_lcm/lcmtypes/eigen_lcm_lcm/cpp/lcmtypes/eigen_lcm/Vector6i.hpp b/third_party/eigen_lcm/lcmtypes/eigen_lcm_lcm/cpp/lcmtypes/eigen_lcm/Vector6i.hpp index 47ca19a1..dbc67a89 100644 --- a/third_party/eigen_lcm/lcmtypes/eigen_lcm_lcm/cpp/lcmtypes/eigen_lcm/Vector6i.hpp +++ b/third_party/eigen_lcm/lcmtypes/eigen_lcm_lcm/cpp/lcmtypes/eigen_lcm/Vector6i.hpp @@ -141,7 +141,7 @@ __lcm_buffer_size Vector6i::decode(const void* buf, __lcm_buffer_size offset, __lcm_buffer_size maxlen) { __lcm_buffer_size pos = 0, thislen; - uint64_t hash; + uint64_t hash = 0; thislen = __uint64_t_decode_array(buf, offset + pos, maxlen - pos, &hash, 1); if (thislen < 0) { return thislen; diff --git a/third_party/eigen_lcm/lcmtypes/eigen_lcm_lcm/cpp/lcmtypes/eigen_lcm/Vector7d.hpp b/third_party/eigen_lcm/lcmtypes/eigen_lcm_lcm/cpp/lcmtypes/eigen_lcm/Vector7d.hpp index 5ed7d841..fc747dc9 100644 --- a/third_party/eigen_lcm/lcmtypes/eigen_lcm_lcm/cpp/lcmtypes/eigen_lcm/Vector7d.hpp +++ b/third_party/eigen_lcm/lcmtypes/eigen_lcm_lcm/cpp/lcmtypes/eigen_lcm/Vector7d.hpp @@ -141,7 +141,7 @@ __lcm_buffer_size Vector7d::decode(const void* buf, __lcm_buffer_size offset, __lcm_buffer_size maxlen) { __lcm_buffer_size pos = 0, thislen; - uint64_t hash; + uint64_t hash = 0; thislen = __uint64_t_decode_array(buf, offset + pos, maxlen - pos, &hash, 1); if (thislen < 0) { return thislen; diff --git a/third_party/eigen_lcm/lcmtypes/eigen_lcm_lcm/cpp/lcmtypes/eigen_lcm/Vector7f.hpp b/third_party/eigen_lcm/lcmtypes/eigen_lcm_lcm/cpp/lcmtypes/eigen_lcm/Vector7f.hpp index 91cbb1e3..11933a2a 100644 --- a/third_party/eigen_lcm/lcmtypes/eigen_lcm_lcm/cpp/lcmtypes/eigen_lcm/Vector7f.hpp +++ b/third_party/eigen_lcm/lcmtypes/eigen_lcm_lcm/cpp/lcmtypes/eigen_lcm/Vector7f.hpp @@ -141,7 +141,7 @@ __lcm_buffer_size Vector7f::decode(const void* buf, __lcm_buffer_size offset, __lcm_buffer_size maxlen) { __lcm_buffer_size pos = 0, thislen; - uint64_t hash; + uint64_t hash = 0; thislen = __uint64_t_decode_array(buf, offset + pos, maxlen - pos, &hash, 1); if (thislen < 0) { return thislen; diff --git a/third_party/eigen_lcm/lcmtypes/eigen_lcm_lcm/cpp/lcmtypes/eigen_lcm/Vector7i.hpp b/third_party/eigen_lcm/lcmtypes/eigen_lcm_lcm/cpp/lcmtypes/eigen_lcm/Vector7i.hpp index 7a369789..f85e97db 100644 --- a/third_party/eigen_lcm/lcmtypes/eigen_lcm_lcm/cpp/lcmtypes/eigen_lcm/Vector7i.hpp +++ b/third_party/eigen_lcm/lcmtypes/eigen_lcm_lcm/cpp/lcmtypes/eigen_lcm/Vector7i.hpp @@ -141,7 +141,7 @@ __lcm_buffer_size Vector7i::decode(const void* buf, __lcm_buffer_size offset, __lcm_buffer_size maxlen) { __lcm_buffer_size pos = 0, thislen; - uint64_t hash; + uint64_t hash = 0; thislen = __uint64_t_decode_array(buf, offset + pos, maxlen - pos, &hash, 1); if (thislen < 0) { return thislen; diff --git a/third_party/eigen_lcm/lcmtypes/eigen_lcm_lcm/cpp/lcmtypes/eigen_lcm/Vector8d.hpp b/third_party/eigen_lcm/lcmtypes/eigen_lcm_lcm/cpp/lcmtypes/eigen_lcm/Vector8d.hpp index 7f1b54f2..79c39815 100644 --- a/third_party/eigen_lcm/lcmtypes/eigen_lcm_lcm/cpp/lcmtypes/eigen_lcm/Vector8d.hpp +++ b/third_party/eigen_lcm/lcmtypes/eigen_lcm_lcm/cpp/lcmtypes/eigen_lcm/Vector8d.hpp @@ -141,7 +141,7 @@ __lcm_buffer_size Vector8d::decode(const void* buf, __lcm_buffer_size offset, __lcm_buffer_size maxlen) { __lcm_buffer_size pos = 0, thislen; - uint64_t hash; + uint64_t hash = 0; thislen = __uint64_t_decode_array(buf, offset + pos, maxlen - pos, &hash, 1); if (thislen < 0) { return thislen; diff --git a/third_party/eigen_lcm/lcmtypes/eigen_lcm_lcm/cpp/lcmtypes/eigen_lcm/Vector8f.hpp b/third_party/eigen_lcm/lcmtypes/eigen_lcm_lcm/cpp/lcmtypes/eigen_lcm/Vector8f.hpp index 519d5d28..c9806619 100644 --- a/third_party/eigen_lcm/lcmtypes/eigen_lcm_lcm/cpp/lcmtypes/eigen_lcm/Vector8f.hpp +++ b/third_party/eigen_lcm/lcmtypes/eigen_lcm_lcm/cpp/lcmtypes/eigen_lcm/Vector8f.hpp @@ -141,7 +141,7 @@ __lcm_buffer_size Vector8f::decode(const void* buf, __lcm_buffer_size offset, __lcm_buffer_size maxlen) { __lcm_buffer_size pos = 0, thislen; - uint64_t hash; + uint64_t hash = 0; thislen = __uint64_t_decode_array(buf, offset + pos, maxlen - pos, &hash, 1); if (thislen < 0) { return thislen; diff --git a/third_party/eigen_lcm/lcmtypes/eigen_lcm_lcm/cpp/lcmtypes/eigen_lcm/Vector8i.hpp b/third_party/eigen_lcm/lcmtypes/eigen_lcm_lcm/cpp/lcmtypes/eigen_lcm/Vector8i.hpp index 6f76a372..14e87d3d 100644 --- a/third_party/eigen_lcm/lcmtypes/eigen_lcm_lcm/cpp/lcmtypes/eigen_lcm/Vector8i.hpp +++ b/third_party/eigen_lcm/lcmtypes/eigen_lcm_lcm/cpp/lcmtypes/eigen_lcm/Vector8i.hpp @@ -141,7 +141,7 @@ __lcm_buffer_size Vector8i::decode(const void* buf, __lcm_buffer_size offset, __lcm_buffer_size maxlen) { __lcm_buffer_size pos = 0, thislen; - uint64_t hash; + uint64_t hash = 0; thislen = __uint64_t_decode_array(buf, offset + pos, maxlen - pos, &hash, 1); if (thislen < 0) { return thislen; diff --git a/third_party/eigen_lcm/lcmtypes/eigen_lcm_lcm/cpp/lcmtypes/eigen_lcm/VectorXd.hpp b/third_party/eigen_lcm/lcmtypes/eigen_lcm_lcm/cpp/lcmtypes/eigen_lcm/VectorXd.hpp index 59ef8171..b51e1ca4 100644 --- a/third_party/eigen_lcm/lcmtypes/eigen_lcm_lcm/cpp/lcmtypes/eigen_lcm/VectorXd.hpp +++ b/third_party/eigen_lcm/lcmtypes/eigen_lcm_lcm/cpp/lcmtypes/eigen_lcm/VectorXd.hpp @@ -139,7 +139,7 @@ __lcm_buffer_size VectorXd::decode(const void* buf, __lcm_buffer_size offset, __lcm_buffer_size maxlen) { __lcm_buffer_size pos = 0, thislen; - uint64_t hash; + uint64_t hash = 0; thislen = __uint64_t_decode_array(buf, offset + pos, maxlen - pos, &hash, 1); if (thislen < 0) { return thislen; diff --git a/third_party/eigen_lcm/lcmtypes/eigen_lcm_lcm/cpp/lcmtypes/eigen_lcm/VectorXf.hpp b/third_party/eigen_lcm/lcmtypes/eigen_lcm_lcm/cpp/lcmtypes/eigen_lcm/VectorXf.hpp index c0dcd87a..22f5d433 100644 --- a/third_party/eigen_lcm/lcmtypes/eigen_lcm_lcm/cpp/lcmtypes/eigen_lcm/VectorXf.hpp +++ b/third_party/eigen_lcm/lcmtypes/eigen_lcm_lcm/cpp/lcmtypes/eigen_lcm/VectorXf.hpp @@ -139,7 +139,7 @@ __lcm_buffer_size VectorXf::decode(const void* buf, __lcm_buffer_size offset, __lcm_buffer_size maxlen) { __lcm_buffer_size pos = 0, thislen; - uint64_t hash; + uint64_t hash = 0; thislen = __uint64_t_decode_array(buf, offset + pos, maxlen - pos, &hash, 1); if (thislen < 0) { return thislen; diff --git a/third_party/eigen_lcm/lcmtypes/eigen_lcm_lcm/cpp/lcmtypes/eigen_lcm/VectorXi.hpp b/third_party/eigen_lcm/lcmtypes/eigen_lcm_lcm/cpp/lcmtypes/eigen_lcm/VectorXi.hpp index ae3254c2..54ac8a23 100644 --- a/third_party/eigen_lcm/lcmtypes/eigen_lcm_lcm/cpp/lcmtypes/eigen_lcm/VectorXi.hpp +++ b/third_party/eigen_lcm/lcmtypes/eigen_lcm_lcm/cpp/lcmtypes/eigen_lcm/VectorXi.hpp @@ -139,7 +139,7 @@ __lcm_buffer_size VectorXi::decode(const void* buf, __lcm_buffer_size offset, __lcm_buffer_size maxlen) { __lcm_buffer_size pos = 0, thislen; - uint64_t hash; + uint64_t hash = 0; thislen = __uint64_t_decode_array(buf, offset + pos, maxlen - pos, &hash, 1); if (thislen < 0) { return thislen; diff --git a/third_party/skymarshal/skymarshal/templates/lcmtype.hpp.template b/third_party/skymarshal/skymarshal/templates/lcmtype.hpp.template index 3975e770..88bd0994 100644 --- a/third_party/skymarshal/skymarshal/templates/lcmtype.hpp.template +++ b/third_party/skymarshal/skymarshal/templates/lcmtype.hpp.template @@ -267,7 +267,7 @@ class {{lcmtype.name}} { {{ size_t }} pos = 0, thislen; - uint64_t hash; + uint64_t hash = 0; thislen = __uint64_t_decode_array(buf, offset + pos, maxlen - pos, &hash, 1); if (thislen < 0) return thislen; else pos += thislen; if (hash != getHash()) return -1; From ec82c3c1cc6b860139f49519425bad03121a40f6 Mon Sep 17 00:00:00 2001 From: Ankit Agarwal Date: Mon, 27 Jul 2026 19:43:49 +0000 Subject: [PATCH 12/68] [SymForce] Update dependency pins GitOrigin-RevId: 12130b4e2f6130e794de7713ec0afefa5e719088 --- requirements/dev_py310.txt | 4 ++-- requirements/dev_py311.txt | 4 ++-- requirements/dev_py312.txt | 4 ++-- requirements/dev_py313.txt | 4 ++-- requirements/dev_py314.txt | 4 ++-- setup.py | 4 ++++ 6 files changed, 14 insertions(+), 10 deletions(-) diff --git a/requirements/dev_py310.txt b/requirements/dev_py310.txt index 9663d4e3..71ebb661 100644 --- a/requirements/dev_py310.txt +++ b/requirements/dev_py310.txt @@ -241,7 +241,7 @@ ruff==0.9.10 # via symforce (pyproject.toml) scipy==1.15.3 # via symforce (pyproject.toml) -setuptools==82.0.0 +setuptools==83.0.0 # via # symforce (pyproject.toml) # setuptools-scm @@ -323,7 +323,7 @@ types-markupsafe==1.1.10 # via types-jinja2 types-requests==2.32.4.20260107 # via symforce (pyproject.toml) -types-setuptools==82.0.0.20260210 +types-setuptools==83.0.0.20260724 # via symforce (pyproject.toml) typing-extensions==4.15.0 # via diff --git a/requirements/dev_py311.txt b/requirements/dev_py311.txt index bff0587f..6b644715 100644 --- a/requirements/dev_py311.txt +++ b/requirements/dev_py311.txt @@ -242,7 +242,7 @@ ruff==0.9.10 # via symforce (pyproject.toml) scipy==1.17.0 # via symforce (pyproject.toml) -setuptools==82.0.0 +setuptools==83.0.0 # via # symforce (pyproject.toml) # setuptools-scm @@ -319,7 +319,7 @@ types-markupsafe==1.1.10 # via types-jinja2 types-requests==2.32.4.20260107 # via symforce (pyproject.toml) -types-setuptools==82.0.0.20260210 +types-setuptools==83.0.0.20260724 # via symforce (pyproject.toml) typing-extensions==4.15.0 # via diff --git a/requirements/dev_py312.txt b/requirements/dev_py312.txt index e1c25f6e..84a43c9e 100644 --- a/requirements/dev_py312.txt +++ b/requirements/dev_py312.txt @@ -242,7 +242,7 @@ ruff==0.9.10 # via symforce (pyproject.toml) scipy==1.17.0 # via symforce (pyproject.toml) -setuptools==82.0.0 +setuptools==83.0.0 # via # symforce (pyproject.toml) # setuptools-scm @@ -319,7 +319,7 @@ types-markupsafe==1.1.10 # via types-jinja2 types-requests==2.32.4.20260107 # via symforce (pyproject.toml) -types-setuptools==82.0.0.20260210 +types-setuptools==83.0.0.20260724 # via symforce (pyproject.toml) typing-extensions==4.15.0 # via diff --git a/requirements/dev_py313.txt b/requirements/dev_py313.txt index 3e04c907..c398aad5 100644 --- a/requirements/dev_py313.txt +++ b/requirements/dev_py313.txt @@ -242,7 +242,7 @@ ruff==0.9.10 # via symforce (pyproject.toml) scipy==1.17.0 # via symforce (pyproject.toml) -setuptools==82.0.0 +setuptools==83.0.0 # via # symforce (pyproject.toml) # setuptools-scm @@ -319,7 +319,7 @@ types-markupsafe==1.1.10 # via types-jinja2 types-requests==2.32.4.20260107 # via symforce (pyproject.toml) -types-setuptools==82.0.0.20260210 +types-setuptools==83.0.0.20260724 # via symforce (pyproject.toml) typing-extensions==4.15.0 # via diff --git a/requirements/dev_py314.txt b/requirements/dev_py314.txt index b14930e9..ad1b02a3 100644 --- a/requirements/dev_py314.txt +++ b/requirements/dev_py314.txt @@ -244,7 +244,7 @@ ruff==0.9.10 # via symforce (pyproject.toml) scipy==1.17.0 # via symforce (pyproject.toml) -setuptools==82.0.0 +setuptools==83.0.0 # via # symforce (pyproject.toml) # setuptools-scm @@ -321,7 +321,7 @@ types-markupsafe==1.1.10 # via types-jinja2 types-requests==2.32.4.20260107 # via symforce (pyproject.toml) -types-setuptools==82.0.0.20260210 +types-setuptools==83.0.0.20260724 # via symforce (pyproject.toml) typing-extensions==4.15.0 # via diff --git a/setup.py b/setup.py index a2af94de..2ea059f8 100644 --- a/setup.py +++ b/setup.py @@ -259,6 +259,10 @@ def run(self) -> None: assert isinstance(build_ext_obj, CMakeBuild) build_dir = Path(build_ext_obj.build_temp) + # NOTE: types-setuptools>=83 types install_platlib as `str | None`; it is populated by + # super().run() above, so narrow it to str for the path arithmetic below. + assert self.install_platlib is not None + # Install symengine # NOTE(aaron): We add symenginepy as a package down below, and the only remaining thing we # need is the compiled symengine_wrapper.so, which we move into place here. This doesn't From 9e23fdb084ed8bef8bd4b1a20e0f1f5117fe2d87 Mon Sep 17 00:00:00 2001 From: Aaron Date: Tue, 18 Aug 2026 06:32:47 +0000 Subject: [PATCH 13/68] [SkyMarshal] Remove redundant python casts Topic: red-cast Reviewers: william-a GitOrigin-RevId: aa123dbcf035d1df8af9b381a3a70bc4a73ccd16 --- .../lcmtypes/codegen_cpp_test/_constants_t.py | 2 +- .../lcmtypes/codegen_cpp_test/_states_t.py | 2 +- .../lcmtypes/codegen_cpp_test/_values_vec_t.py | 2 +- .../lcmtypes/codegen_test/_my_dataclass_t.py | 2 +- .../_constants_t.py | 2 +- .../_states_t.py | 2 +- .../_values_vec_t.py | 2 +- .../_inputs_constants_t.py | 2 +- .../_inputs_states_t.py | 2 +- .../codegen_multi_function_test/_inputs_t.py | 2 +- .../codegen_multi_function_test/_outputs_1_t.py | 2 +- .../codegen_multi_function_test/_outputs_2_t.py | 2 +- .../_values_vec_t.py | 2 +- .../codegen_python_test/_constants_t.py | 2 +- .../lcmtypes/codegen_python_test/_states_t.py | 2 +- .../codegen_python_test/_values_vec_t.py | 2 +- .../python/lcmtypes/sym/_d_out_t.py | 2 +- .../python/lcmtypes/sym/_d_t.py | 2 +- .../lcmtypes/codegen_cpp_test/constants_t.hpp | 5 ++--- .../cpp/lcmtypes/codegen_cpp_test/states_t.hpp | 9 ++------- .../lcmtypes/codegen_cpp_test/values_vec_t.hpp | 11 ++--------- .../lcmtypes/codegen_cpp_test/_constants_t.py | 6 ++---- .../lcmtypes/codegen_cpp_test/_states_t.py | 7 ++----- .../lcmtypes/codegen_cpp_test/_values_vec_t.py | 7 ++----- .../lcmtypes/codegen_test/_my_dataclass_t.py | 2 +- .../constants_t.hpp | 5 ++--- .../states_t.hpp | 9 ++------- .../values_vec_t.hpp | 11 ++--------- .../_constants_t.py | 6 ++---- .../_states_t.py | 7 ++----- .../_values_vec_t.py | 7 ++----- .../inputs_constants_t.hpp | 5 ++--- .../inputs_states_t.hpp | 9 ++------- .../codegen_multi_function_test/inputs_t.hpp | 17 ++--------------- .../codegen_multi_function_test/outputs_1_t.hpp | 12 ++---------- .../codegen_multi_function_test/outputs_2_t.hpp | 5 ++--- .../values_vec_t.hpp | 11 ++--------- .../_inputs_constants_t.py | 6 ++---- .../_inputs_states_t.py | 7 ++----- .../codegen_multi_function_test/_inputs_t.py | 7 ++----- .../codegen_multi_function_test/_outputs_1_t.py | 7 ++----- .../codegen_multi_function_test/_outputs_2_t.py | 6 ++---- .../_values_vec_t.py | 7 ++----- .../codegen_python_test/constants_t.hpp | 5 ++--- .../lcmtypes/codegen_python_test/states_t.hpp | 9 ++------- .../codegen_python_test/values_vec_t.hpp | 11 ++--------- .../codegen_python_test/_constants_t.py | 6 ++---- .../lcmtypes/codegen_python_test/_states_t.py | 7 ++----- .../codegen_python_test/_values_vec_t.py | 7 ++----- .../python/lcmtypes/sym/_d_out_t.py | 2 +- .../python/lcmtypes/sym/_d_t.py | 2 +- .../templates/python_enum.py.template | 2 +- .../templates/python_struct.py.template | 2 +- 53 files changed, 83 insertions(+), 197 deletions(-) diff --git a/test/symforce_function_codegen_test_data/symengine/codegen_cpp_test_data/python/lcmtypes/codegen_cpp_test/_constants_t.py b/test/symforce_function_codegen_test_data/symengine/codegen_cpp_test_data/python/lcmtypes/codegen_cpp_test/_constants_t.py index c43c7f40..b66208a9 100644 --- a/test/symforce_function_codegen_test_data/symengine/codegen_cpp_test_data/python/lcmtypes/codegen_cpp_test/_constants_t.py +++ b/test/symforce_function_codegen_test_data/symengine/codegen_cpp_test_data/python/lcmtypes/codegen_cpp_test/_constants_t.py @@ -76,7 +76,7 @@ def decode(data: T.Union[bytes, T.BinaryIO]) -> constants_t: # NOTE(eric): mypy isn't able to figure out the hasattr check buf = T.cast(T.BinaryIO, data) else: - buf = BytesIO(T.cast(bytes, data)) + buf = BytesIO(data) if buf.read(8) != constants_t._get_packed_fingerprint(): raise ValueError("Decode error") diff --git a/test/symforce_function_codegen_test_data/symengine/codegen_cpp_test_data/python/lcmtypes/codegen_cpp_test/_states_t.py b/test/symforce_function_codegen_test_data/symengine/codegen_cpp_test_data/python/lcmtypes/codegen_cpp_test/_states_t.py index e7700a71..4f10457d 100644 --- a/test/symforce_function_codegen_test_data/symengine/codegen_cpp_test_data/python/lcmtypes/codegen_cpp_test/_states_t.py +++ b/test/symforce_function_codegen_test_data/symengine/codegen_cpp_test_data/python/lcmtypes/codegen_cpp_test/_states_t.py @@ -81,7 +81,7 @@ def decode(data: T.Union[bytes, T.BinaryIO]) -> states_t: # NOTE(eric): mypy isn't able to figure out the hasattr check buf = T.cast(T.BinaryIO, data) else: - buf = BytesIO(T.cast(bytes, data)) + buf = BytesIO(data) if buf.read(8) != states_t._get_packed_fingerprint(): raise ValueError("Decode error") diff --git a/test/symforce_function_codegen_test_data/symengine/codegen_cpp_test_data/python/lcmtypes/codegen_cpp_test/_values_vec_t.py b/test/symforce_function_codegen_test_data/symengine/codegen_cpp_test_data/python/lcmtypes/codegen_cpp_test/_values_vec_t.py index 0568f266..35080051 100644 --- a/test/symforce_function_codegen_test_data/symengine/codegen_cpp_test_data/python/lcmtypes/codegen_cpp_test/_values_vec_t.py +++ b/test/symforce_function_codegen_test_data/symengine/codegen_cpp_test_data/python/lcmtypes/codegen_cpp_test/_values_vec_t.py @@ -121,7 +121,7 @@ def decode(data: T.Union[bytes, T.BinaryIO]) -> values_vec_t: # NOTE(eric): mypy isn't able to figure out the hasattr check buf = T.cast(T.BinaryIO, data) else: - buf = BytesIO(T.cast(bytes, data)) + buf = BytesIO(data) if buf.read(8) != values_vec_t._get_packed_fingerprint(): raise ValueError("Decode error") diff --git a/test/symforce_function_codegen_test_data/symengine/codegen_dataclass_in_values_test_data/python/lcmtypes/codegen_test/_my_dataclass_t.py b/test/symforce_function_codegen_test_data/symengine/codegen_dataclass_in_values_test_data/python/lcmtypes/codegen_test/_my_dataclass_t.py index 4ed001ce..8895b7fd 100644 --- a/test/symforce_function_codegen_test_data/symengine/codegen_dataclass_in_values_test_data/python/lcmtypes/codegen_test/_my_dataclass_t.py +++ b/test/symforce_function_codegen_test_data/symengine/codegen_dataclass_in_values_test_data/python/lcmtypes/codegen_test/_my_dataclass_t.py @@ -81,7 +81,7 @@ def decode(data: T.Union[bytes, T.BinaryIO]) -> my_dataclass_t: # NOTE(eric): mypy isn't able to figure out the hasattr check buf = T.cast(T.BinaryIO, data) else: - buf = BytesIO(T.cast(bytes, data)) + buf = BytesIO(data) if buf.read(8) != my_dataclass_t._get_packed_fingerprint(): raise ValueError("Decode error") diff --git a/test/symforce_function_codegen_test_data/symengine/codegen_explicit_template_instantiation_test_data/python/lcmtypes/codegen_explicit_template_instantiation_test/_constants_t.py b/test/symforce_function_codegen_test_data/symengine/codegen_explicit_template_instantiation_test_data/python/lcmtypes/codegen_explicit_template_instantiation_test/_constants_t.py index f74c169b..e1309aa6 100644 --- a/test/symforce_function_codegen_test_data/symengine/codegen_explicit_template_instantiation_test_data/python/lcmtypes/codegen_explicit_template_instantiation_test/_constants_t.py +++ b/test/symforce_function_codegen_test_data/symengine/codegen_explicit_template_instantiation_test_data/python/lcmtypes/codegen_explicit_template_instantiation_test/_constants_t.py @@ -76,7 +76,7 @@ def decode(data: T.Union[bytes, T.BinaryIO]) -> constants_t: # NOTE(eric): mypy isn't able to figure out the hasattr check buf = T.cast(T.BinaryIO, data) else: - buf = BytesIO(T.cast(bytes, data)) + buf = BytesIO(data) if buf.read(8) != constants_t._get_packed_fingerprint(): raise ValueError("Decode error") diff --git a/test/symforce_function_codegen_test_data/symengine/codegen_explicit_template_instantiation_test_data/python/lcmtypes/codegen_explicit_template_instantiation_test/_states_t.py b/test/symforce_function_codegen_test_data/symengine/codegen_explicit_template_instantiation_test_data/python/lcmtypes/codegen_explicit_template_instantiation_test/_states_t.py index 2682d77a..cb11ca43 100644 --- a/test/symforce_function_codegen_test_data/symengine/codegen_explicit_template_instantiation_test_data/python/lcmtypes/codegen_explicit_template_instantiation_test/_states_t.py +++ b/test/symforce_function_codegen_test_data/symengine/codegen_explicit_template_instantiation_test_data/python/lcmtypes/codegen_explicit_template_instantiation_test/_states_t.py @@ -81,7 +81,7 @@ def decode(data: T.Union[bytes, T.BinaryIO]) -> states_t: # NOTE(eric): mypy isn't able to figure out the hasattr check buf = T.cast(T.BinaryIO, data) else: - buf = BytesIO(T.cast(bytes, data)) + buf = BytesIO(data) if buf.read(8) != states_t._get_packed_fingerprint(): raise ValueError("Decode error") diff --git a/test/symforce_function_codegen_test_data/symengine/codegen_explicit_template_instantiation_test_data/python/lcmtypes/codegen_explicit_template_instantiation_test/_values_vec_t.py b/test/symforce_function_codegen_test_data/symengine/codegen_explicit_template_instantiation_test_data/python/lcmtypes/codegen_explicit_template_instantiation_test/_values_vec_t.py index 644bd3ec..4cec0415 100644 --- a/test/symforce_function_codegen_test_data/symengine/codegen_explicit_template_instantiation_test_data/python/lcmtypes/codegen_explicit_template_instantiation_test/_values_vec_t.py +++ b/test/symforce_function_codegen_test_data/symengine/codegen_explicit_template_instantiation_test_data/python/lcmtypes/codegen_explicit_template_instantiation_test/_values_vec_t.py @@ -121,7 +121,7 @@ def decode(data: T.Union[bytes, T.BinaryIO]) -> values_vec_t: # NOTE(eric): mypy isn't able to figure out the hasattr check buf = T.cast(T.BinaryIO, data) else: - buf = BytesIO(T.cast(bytes, data)) + buf = BytesIO(data) if buf.read(8) != values_vec_t._get_packed_fingerprint(): raise ValueError("Decode error") diff --git a/test/symforce_function_codegen_test_data/symengine/codegen_multi_function_test_data/python/lcmtypes/codegen_multi_function_test/_inputs_constants_t.py b/test/symforce_function_codegen_test_data/symengine/codegen_multi_function_test_data/python/lcmtypes/codegen_multi_function_test/_inputs_constants_t.py index 1eb83dc3..5cdb8d6a 100644 --- a/test/symforce_function_codegen_test_data/symengine/codegen_multi_function_test_data/python/lcmtypes/codegen_multi_function_test/_inputs_constants_t.py +++ b/test/symforce_function_codegen_test_data/symengine/codegen_multi_function_test_data/python/lcmtypes/codegen_multi_function_test/_inputs_constants_t.py @@ -76,7 +76,7 @@ def decode(data: T.Union[bytes, T.BinaryIO]) -> inputs_constants_t: # NOTE(eric): mypy isn't able to figure out the hasattr check buf = T.cast(T.BinaryIO, data) else: - buf = BytesIO(T.cast(bytes, data)) + buf = BytesIO(data) if buf.read(8) != inputs_constants_t._get_packed_fingerprint(): raise ValueError("Decode error") diff --git a/test/symforce_function_codegen_test_data/symengine/codegen_multi_function_test_data/python/lcmtypes/codegen_multi_function_test/_inputs_states_t.py b/test/symforce_function_codegen_test_data/symengine/codegen_multi_function_test_data/python/lcmtypes/codegen_multi_function_test/_inputs_states_t.py index 20160ce6..5062af03 100644 --- a/test/symforce_function_codegen_test_data/symengine/codegen_multi_function_test_data/python/lcmtypes/codegen_multi_function_test/_inputs_states_t.py +++ b/test/symforce_function_codegen_test_data/symengine/codegen_multi_function_test_data/python/lcmtypes/codegen_multi_function_test/_inputs_states_t.py @@ -81,7 +81,7 @@ def decode(data: T.Union[bytes, T.BinaryIO]) -> inputs_states_t: # NOTE(eric): mypy isn't able to figure out the hasattr check buf = T.cast(T.BinaryIO, data) else: - buf = BytesIO(T.cast(bytes, data)) + buf = BytesIO(data) if buf.read(8) != inputs_states_t._get_packed_fingerprint(): raise ValueError("Decode error") diff --git a/test/symforce_function_codegen_test_data/symengine/codegen_multi_function_test_data/python/lcmtypes/codegen_multi_function_test/_inputs_t.py b/test/symforce_function_codegen_test_data/symengine/codegen_multi_function_test_data/python/lcmtypes/codegen_multi_function_test/_inputs_t.py index b37617f6..5120a91f 100644 --- a/test/symforce_function_codegen_test_data/symengine/codegen_multi_function_test_data/python/lcmtypes/codegen_multi_function_test/_inputs_t.py +++ b/test/symforce_function_codegen_test_data/symengine/codegen_multi_function_test_data/python/lcmtypes/codegen_multi_function_test/_inputs_t.py @@ -189,7 +189,7 @@ def decode(data: T.Union[bytes, T.BinaryIO]) -> inputs_t: # NOTE(eric): mypy isn't able to figure out the hasattr check buf = T.cast(T.BinaryIO, data) else: - buf = BytesIO(T.cast(bytes, data)) + buf = BytesIO(data) if buf.read(8) != inputs_t._get_packed_fingerprint(): raise ValueError("Decode error") diff --git a/test/symforce_function_codegen_test_data/symengine/codegen_multi_function_test_data/python/lcmtypes/codegen_multi_function_test/_outputs_1_t.py b/test/symforce_function_codegen_test_data/symengine/codegen_multi_function_test_data/python/lcmtypes/codegen_multi_function_test/_outputs_1_t.py index fc7c8961..1d692ba5 100644 --- a/test/symforce_function_codegen_test_data/symengine/codegen_multi_function_test_data/python/lcmtypes/codegen_multi_function_test/_outputs_1_t.py +++ b/test/symforce_function_codegen_test_data/symengine/codegen_multi_function_test_data/python/lcmtypes/codegen_multi_function_test/_outputs_1_t.py @@ -133,7 +133,7 @@ def decode(data: T.Union[bytes, T.BinaryIO]) -> outputs_1_t: # NOTE(eric): mypy isn't able to figure out the hasattr check buf = T.cast(T.BinaryIO, data) else: - buf = BytesIO(T.cast(bytes, data)) + buf = BytesIO(data) if buf.read(8) != outputs_1_t._get_packed_fingerprint(): raise ValueError("Decode error") diff --git a/test/symforce_function_codegen_test_data/symengine/codegen_multi_function_test_data/python/lcmtypes/codegen_multi_function_test/_outputs_2_t.py b/test/symforce_function_codegen_test_data/symengine/codegen_multi_function_test_data/python/lcmtypes/codegen_multi_function_test/_outputs_2_t.py index 0dd97336..0c27be8b 100644 --- a/test/symforce_function_codegen_test_data/symengine/codegen_multi_function_test_data/python/lcmtypes/codegen_multi_function_test/_outputs_2_t.py +++ b/test/symforce_function_codegen_test_data/symengine/codegen_multi_function_test_data/python/lcmtypes/codegen_multi_function_test/_outputs_2_t.py @@ -76,7 +76,7 @@ def decode(data: T.Union[bytes, T.BinaryIO]) -> outputs_2_t: # NOTE(eric): mypy isn't able to figure out the hasattr check buf = T.cast(T.BinaryIO, data) else: - buf = BytesIO(T.cast(bytes, data)) + buf = BytesIO(data) if buf.read(8) != outputs_2_t._get_packed_fingerprint(): raise ValueError("Decode error") diff --git a/test/symforce_function_codegen_test_data/symengine/codegen_multi_function_test_data/python/lcmtypes/codegen_multi_function_test/_values_vec_t.py b/test/symforce_function_codegen_test_data/symengine/codegen_multi_function_test_data/python/lcmtypes/codegen_multi_function_test/_values_vec_t.py index 50c362ed..263bd0be 100644 --- a/test/symforce_function_codegen_test_data/symengine/codegen_multi_function_test_data/python/lcmtypes/codegen_multi_function_test/_values_vec_t.py +++ b/test/symforce_function_codegen_test_data/symengine/codegen_multi_function_test_data/python/lcmtypes/codegen_multi_function_test/_values_vec_t.py @@ -121,7 +121,7 @@ def decode(data: T.Union[bytes, T.BinaryIO]) -> values_vec_t: # NOTE(eric): mypy isn't able to figure out the hasattr check buf = T.cast(T.BinaryIO, data) else: - buf = BytesIO(T.cast(bytes, data)) + buf = BytesIO(data) if buf.read(8) != values_vec_t._get_packed_fingerprint(): raise ValueError("Decode error") diff --git a/test/symforce_function_codegen_test_data/symengine/codegen_python_test_data/python/lcmtypes/codegen_python_test/_constants_t.py b/test/symforce_function_codegen_test_data/symengine/codegen_python_test_data/python/lcmtypes/codegen_python_test/_constants_t.py index 897a33cc..94e9959e 100644 --- a/test/symforce_function_codegen_test_data/symengine/codegen_python_test_data/python/lcmtypes/codegen_python_test/_constants_t.py +++ b/test/symforce_function_codegen_test_data/symengine/codegen_python_test_data/python/lcmtypes/codegen_python_test/_constants_t.py @@ -76,7 +76,7 @@ def decode(data: T.Union[bytes, T.BinaryIO]) -> constants_t: # NOTE(eric): mypy isn't able to figure out the hasattr check buf = T.cast(T.BinaryIO, data) else: - buf = BytesIO(T.cast(bytes, data)) + buf = BytesIO(data) if buf.read(8) != constants_t._get_packed_fingerprint(): raise ValueError("Decode error") diff --git a/test/symforce_function_codegen_test_data/symengine/codegen_python_test_data/python/lcmtypes/codegen_python_test/_states_t.py b/test/symforce_function_codegen_test_data/symengine/codegen_python_test_data/python/lcmtypes/codegen_python_test/_states_t.py index 1fbd8098..858860fc 100644 --- a/test/symforce_function_codegen_test_data/symengine/codegen_python_test_data/python/lcmtypes/codegen_python_test/_states_t.py +++ b/test/symforce_function_codegen_test_data/symengine/codegen_python_test_data/python/lcmtypes/codegen_python_test/_states_t.py @@ -81,7 +81,7 @@ def decode(data: T.Union[bytes, T.BinaryIO]) -> states_t: # NOTE(eric): mypy isn't able to figure out the hasattr check buf = T.cast(T.BinaryIO, data) else: - buf = BytesIO(T.cast(bytes, data)) + buf = BytesIO(data) if buf.read(8) != states_t._get_packed_fingerprint(): raise ValueError("Decode error") diff --git a/test/symforce_function_codegen_test_data/symengine/codegen_python_test_data/python/lcmtypes/codegen_python_test/_values_vec_t.py b/test/symforce_function_codegen_test_data/symengine/codegen_python_test_data/python/lcmtypes/codegen_python_test/_values_vec_t.py index 424a037f..39e1f87a 100644 --- a/test/symforce_function_codegen_test_data/symengine/codegen_python_test_data/python/lcmtypes/codegen_python_test/_values_vec_t.py +++ b/test/symforce_function_codegen_test_data/symengine/codegen_python_test_data/python/lcmtypes/codegen_python_test/_values_vec_t.py @@ -121,7 +121,7 @@ def decode(data: T.Union[bytes, T.BinaryIO]) -> values_vec_t: # NOTE(eric): mypy isn't able to figure out the hasattr check buf = T.cast(T.BinaryIO, data) else: - buf = BytesIO(T.cast(bytes, data)) + buf = BytesIO(data) if buf.read(8) != values_vec_t._get_packed_fingerprint(): raise ValueError("Decode error") diff --git a/test/symforce_function_codegen_test_data/symengine/with_jacobians_values/python/lcmtypes/sym/_d_out_t.py b/test/symforce_function_codegen_test_data/symengine/with_jacobians_values/python/lcmtypes/sym/_d_out_t.py index 61e19a8f..00fe53b8 100644 --- a/test/symforce_function_codegen_test_data/symengine/with_jacobians_values/python/lcmtypes/sym/_d_out_t.py +++ b/test/symforce_function_codegen_test_data/symengine/with_jacobians_values/python/lcmtypes/sym/_d_out_t.py @@ -81,7 +81,7 @@ def decode(data: T.Union[bytes, T.BinaryIO]) -> d_out_t: # NOTE(eric): mypy isn't able to figure out the hasattr check buf = T.cast(T.BinaryIO, data) else: - buf = BytesIO(T.cast(bytes, data)) + buf = BytesIO(data) if buf.read(8) != d_out_t._get_packed_fingerprint(): raise ValueError("Decode error") diff --git a/test/symforce_function_codegen_test_data/symengine/with_jacobians_values/python/lcmtypes/sym/_d_t.py b/test/symforce_function_codegen_test_data/symengine/with_jacobians_values/python/lcmtypes/sym/_d_t.py index 36bf9ab4..9ed51a34 100644 --- a/test/symforce_function_codegen_test_data/symengine/with_jacobians_values/python/lcmtypes/sym/_d_t.py +++ b/test/symforce_function_codegen_test_data/symengine/with_jacobians_values/python/lcmtypes/sym/_d_t.py @@ -87,7 +87,7 @@ def decode(data: T.Union[bytes, T.BinaryIO]) -> d_t: # NOTE(eric): mypy isn't able to figure out the hasattr check buf = T.cast(T.BinaryIO, data) else: - buf = BytesIO(T.cast(bytes, data)) + buf = BytesIO(data) if buf.read(8) != d_t._get_packed_fingerprint(): raise ValueError("Decode error") diff --git a/test/symforce_function_codegen_test_data/sympy/codegen_cpp_test_data/cpp/lcmtypes/codegen_cpp_test/constants_t.hpp b/test/symforce_function_codegen_test_data/sympy/codegen_cpp_test_data/cpp/lcmtypes/codegen_cpp_test/constants_t.hpp index b773ca24..efa6cadc 100644 --- a/test/symforce_function_codegen_test_data/sympy/codegen_cpp_test_data/cpp/lcmtypes/codegen_cpp_test/constants_t.hpp +++ b/test/symforce_function_codegen_test_data/sympy/codegen_cpp_test_data/cpp/lcmtypes/codegen_cpp_test/constants_t.hpp @@ -93,8 +93,7 @@ class constants_t inline __lcm_buffer_size _decodeNoHash(const void *buf, __lcm_buffer_size offset, __lcm_buffer_size maxlen); constexpr static uint64_t _computeHash(const __lcm_hash_ptr *) { - uint64_t hash = 0x152f505c823f2cbcLL; - return (hash<<1) + ((hash>>63)&1); + return 0x2a5ea0b9047e5978ULL; } // Comparison operators. @@ -205,7 +204,7 @@ __lcm_buffer_size constants_t::decode(const void *buf, __lcm_buffer_size offset, { __lcm_buffer_size pos = 0, thislen; - uint64_t hash; + uint64_t hash = 0; thislen = __uint64_t_decode_array(buf, offset + pos, maxlen - pos, &hash, 1); if (thislen < 0) return thislen; else pos += thislen; if (hash != getHash()) return -1; diff --git a/test/symforce_function_codegen_test_data/sympy/codegen_cpp_test_data/cpp/lcmtypes/codegen_cpp_test/states_t.hpp b/test/symforce_function_codegen_test_data/sympy/codegen_cpp_test_data/cpp/lcmtypes/codegen_cpp_test/states_t.hpp index e7a4aa55..e7d3591a 100644 --- a/test/symforce_function_codegen_test_data/sympy/codegen_cpp_test_data/cpp/lcmtypes/codegen_cpp_test/states_t.hpp +++ b/test/symforce_function_codegen_test_data/sympy/codegen_cpp_test_data/cpp/lcmtypes/codegen_cpp_test/states_t.hpp @@ -101,12 +101,7 @@ class states_t for(fp = p; fp != NULL; fp = fp->parent) if(fp->v == states_t::getHash) return 0; - const __lcm_hash_ptr cp = { p, states_t::getHash }; - - uint64_t hash = 0x0012345678017000LL + - ::eigen_lcm::Vector2d::_computeHash(&cp); - - return (hash<<1) + ((hash>>63)&1); + return 0xf8d125e8c0876fc1ULL; } // Comparison operators. @@ -217,7 +212,7 @@ __lcm_buffer_size states_t::decode(const void *buf, __lcm_buffer_size offset, __ { __lcm_buffer_size pos = 0, thislen; - uint64_t hash; + uint64_t hash = 0; thislen = __uint64_t_decode_array(buf, offset + pos, maxlen - pos, &hash, 1); if (thislen < 0) return thislen; else pos += thislen; if (hash != getHash()) return -1; diff --git a/test/symforce_function_codegen_test_data/sympy/codegen_cpp_test_data/cpp/lcmtypes/codegen_cpp_test/values_vec_t.hpp b/test/symforce_function_codegen_test_data/sympy/codegen_cpp_test_data/cpp/lcmtypes/codegen_cpp_test/values_vec_t.hpp index 8855dccd..e5138902 100644 --- a/test/symforce_function_codegen_test_data/sympy/codegen_cpp_test_data/cpp/lcmtypes/codegen_cpp_test/values_vec_t.hpp +++ b/test/symforce_function_codegen_test_data/sympy/codegen_cpp_test_data/cpp/lcmtypes/codegen_cpp_test/values_vec_t.hpp @@ -117,14 +117,7 @@ class values_vec_t for(fp = p; fp != NULL; fp = fp->parent) if(fp->v == values_vec_t::getHash) return 0; - const __lcm_hash_ptr cp = { p, values_vec_t::getHash }; - - uint64_t hash = 0xe7b60b55c8cf5417LL + - ::eigen_lcm::Vector4d::_computeHash(&cp) + - ::eigen_lcm::Vector4d::_computeHash(&cp) + - ::eigen_lcm::Vector4d::_computeHash(&cp); - - return (hash<<1) + ((hash>>63)&1); + return 0xb9724e5f032c5787ULL; } // Comparison operators. @@ -310,7 +303,7 @@ __lcm_buffer_size values_vec_t::decode(const void *buf, __lcm_buffer_size offset { __lcm_buffer_size pos = 0, thislen; - uint64_t hash; + uint64_t hash = 0; thislen = __uint64_t_decode_array(buf, offset + pos, maxlen - pos, &hash, 1); if (thislen < 0) return thislen; else pos += thislen; if (hash != getHash()) return -1; diff --git a/test/symforce_function_codegen_test_data/sympy/codegen_cpp_test_data/python/lcmtypes/codegen_cpp_test/_constants_t.py b/test/symforce_function_codegen_test_data/sympy/codegen_cpp_test_data/python/lcmtypes/codegen_cpp_test/_constants_t.py index 20367d56..b66208a9 100644 --- a/test/symforce_function_codegen_test_data/sympy/codegen_cpp_test_data/python/lcmtypes/codegen_cpp_test/_constants_t.py +++ b/test/symforce_function_codegen_test_data/sympy/codegen_cpp_test_data/python/lcmtypes/codegen_cpp_test/_constants_t.py @@ -76,7 +76,7 @@ def decode(data: T.Union[bytes, T.BinaryIO]) -> constants_t: # NOTE(eric): mypy isn't able to figure out the hasattr check buf = T.cast(T.BinaryIO, data) else: - buf = BytesIO(T.cast(bytes, data)) + buf = BytesIO(data) if buf.read(8) != constants_t._get_packed_fingerprint(): raise ValueError("Decode error") @@ -91,9 +91,7 @@ def _decode_one(buf: T.BinaryIO) -> constants_t: @staticmethod def _get_hash_recursive(parents: T.List[T.Type]) -> int: if constants_t in parents: return 0 - tmphash = (0x152f505c823f2cbc) & 0xffffffffffffffff - tmphash = (((tmphash<<1)&0xffffffffffffffff) + (tmphash>>63)) & 0xffffffffffffffff - return tmphash + return 0x2a5ea0b9047e5978 _packed_fingerprint: T.Optional[bytes] = None diff --git a/test/symforce_function_codegen_test_data/sympy/codegen_cpp_test_data/python/lcmtypes/codegen_cpp_test/_states_t.py b/test/symforce_function_codegen_test_data/sympy/codegen_cpp_test_data/python/lcmtypes/codegen_cpp_test/_states_t.py index d455b57d..4f10457d 100644 --- a/test/symforce_function_codegen_test_data/sympy/codegen_cpp_test_data/python/lcmtypes/codegen_cpp_test/_states_t.py +++ b/test/symforce_function_codegen_test_data/sympy/codegen_cpp_test_data/python/lcmtypes/codegen_cpp_test/_states_t.py @@ -81,7 +81,7 @@ def decode(data: T.Union[bytes, T.BinaryIO]) -> states_t: # NOTE(eric): mypy isn't able to figure out the hasattr check buf = T.cast(T.BinaryIO, data) else: - buf = BytesIO(T.cast(bytes, data)) + buf = BytesIO(data) if buf.read(8) != states_t._get_packed_fingerprint(): raise ValueError("Decode error") @@ -96,10 +96,7 @@ def _decode_one(buf: T.BinaryIO) -> states_t: @staticmethod def _get_hash_recursive(parents: T.List[T.Type]) -> int: if states_t in parents: return 0 - newparents = parents + [states_t] - tmphash = (0x12345678017000+ Vector2d._get_hash_recursive(newparents)) & 0xffffffffffffffff - tmphash = (((tmphash<<1)&0xffffffffffffffff) + (tmphash>>63)) & 0xffffffffffffffff - return tmphash + return 0xf8d125e8c0876fc1 _packed_fingerprint: T.Optional[bytes] = None diff --git a/test/symforce_function_codegen_test_data/sympy/codegen_cpp_test_data/python/lcmtypes/codegen_cpp_test/_values_vec_t.py b/test/symforce_function_codegen_test_data/sympy/codegen_cpp_test_data/python/lcmtypes/codegen_cpp_test/_values_vec_t.py index d0fac242..35080051 100644 --- a/test/symforce_function_codegen_test_data/sympy/codegen_cpp_test_data/python/lcmtypes/codegen_cpp_test/_values_vec_t.py +++ b/test/symforce_function_codegen_test_data/sympy/codegen_cpp_test_data/python/lcmtypes/codegen_cpp_test/_values_vec_t.py @@ -121,7 +121,7 @@ def decode(data: T.Union[bytes, T.BinaryIO]) -> values_vec_t: # NOTE(eric): mypy isn't able to figure out the hasattr check buf = T.cast(T.BinaryIO, data) else: - buf = BytesIO(T.cast(bytes, data)) + buf = BytesIO(data) if buf.read(8) != values_vec_t._get_packed_fingerprint(): raise ValueError("Decode error") @@ -146,10 +146,7 @@ def _decode_one(buf: T.BinaryIO) -> values_vec_t: @staticmethod def _get_hash_recursive(parents: T.List[T.Type]) -> int: if values_vec_t in parents: return 0 - newparents = parents + [values_vec_t] - tmphash = (0xe7b60b55c8cf5417+ Vector4d._get_hash_recursive(newparents)+ Vector4d._get_hash_recursive(newparents)+ Vector4d._get_hash_recursive(newparents)) & 0xffffffffffffffff - tmphash = (((tmphash<<1)&0xffffffffffffffff) + (tmphash>>63)) & 0xffffffffffffffff - return tmphash + return 0xb9724e5f032c5787 _packed_fingerprint: T.Optional[bytes] = None diff --git a/test/symforce_function_codegen_test_data/sympy/codegen_dataclass_in_values_test_data/python/lcmtypes/codegen_test/_my_dataclass_t.py b/test/symforce_function_codegen_test_data/sympy/codegen_dataclass_in_values_test_data/python/lcmtypes/codegen_test/_my_dataclass_t.py index 4ed001ce..8895b7fd 100644 --- a/test/symforce_function_codegen_test_data/sympy/codegen_dataclass_in_values_test_data/python/lcmtypes/codegen_test/_my_dataclass_t.py +++ b/test/symforce_function_codegen_test_data/sympy/codegen_dataclass_in_values_test_data/python/lcmtypes/codegen_test/_my_dataclass_t.py @@ -81,7 +81,7 @@ def decode(data: T.Union[bytes, T.BinaryIO]) -> my_dataclass_t: # NOTE(eric): mypy isn't able to figure out the hasattr check buf = T.cast(T.BinaryIO, data) else: - buf = BytesIO(T.cast(bytes, data)) + buf = BytesIO(data) if buf.read(8) != my_dataclass_t._get_packed_fingerprint(): raise ValueError("Decode error") diff --git a/test/symforce_function_codegen_test_data/sympy/codegen_explicit_template_instantiation_test_data/cpp/lcmtypes/codegen_explicit_template_instantiation_test/constants_t.hpp b/test/symforce_function_codegen_test_data/sympy/codegen_explicit_template_instantiation_test_data/cpp/lcmtypes/codegen_explicit_template_instantiation_test/constants_t.hpp index 5684686e..cb197b3a 100644 --- a/test/symforce_function_codegen_test_data/sympy/codegen_explicit_template_instantiation_test_data/cpp/lcmtypes/codegen_explicit_template_instantiation_test/constants_t.hpp +++ b/test/symforce_function_codegen_test_data/sympy/codegen_explicit_template_instantiation_test_data/cpp/lcmtypes/codegen_explicit_template_instantiation_test/constants_t.hpp @@ -93,8 +93,7 @@ class constants_t inline __lcm_buffer_size _decodeNoHash(const void *buf, __lcm_buffer_size offset, __lcm_buffer_size maxlen); constexpr static uint64_t _computeHash(const __lcm_hash_ptr *) { - uint64_t hash = 0x152f505c823f2cbcLL; - return (hash<<1) + ((hash>>63)&1); + return 0x2a5ea0b9047e5978ULL; } // Comparison operators. @@ -205,7 +204,7 @@ __lcm_buffer_size constants_t::decode(const void *buf, __lcm_buffer_size offset, { __lcm_buffer_size pos = 0, thislen; - uint64_t hash; + uint64_t hash = 0; thislen = __uint64_t_decode_array(buf, offset + pos, maxlen - pos, &hash, 1); if (thislen < 0) return thislen; else pos += thislen; if (hash != getHash()) return -1; diff --git a/test/symforce_function_codegen_test_data/sympy/codegen_explicit_template_instantiation_test_data/cpp/lcmtypes/codegen_explicit_template_instantiation_test/states_t.hpp b/test/symforce_function_codegen_test_data/sympy/codegen_explicit_template_instantiation_test_data/cpp/lcmtypes/codegen_explicit_template_instantiation_test/states_t.hpp index 4a088738..9e69c9f1 100644 --- a/test/symforce_function_codegen_test_data/sympy/codegen_explicit_template_instantiation_test_data/cpp/lcmtypes/codegen_explicit_template_instantiation_test/states_t.hpp +++ b/test/symforce_function_codegen_test_data/sympy/codegen_explicit_template_instantiation_test_data/cpp/lcmtypes/codegen_explicit_template_instantiation_test/states_t.hpp @@ -101,12 +101,7 @@ class states_t for(fp = p; fp != NULL; fp = fp->parent) if(fp->v == states_t::getHash) return 0; - const __lcm_hash_ptr cp = { p, states_t::getHash }; - - uint64_t hash = 0x0012345678017000LL + - ::eigen_lcm::Vector2d::_computeHash(&cp); - - return (hash<<1) + ((hash>>63)&1); + return 0xf8d125e8c0876fc1ULL; } // Comparison operators. @@ -217,7 +212,7 @@ __lcm_buffer_size states_t::decode(const void *buf, __lcm_buffer_size offset, __ { __lcm_buffer_size pos = 0, thislen; - uint64_t hash; + uint64_t hash = 0; thislen = __uint64_t_decode_array(buf, offset + pos, maxlen - pos, &hash, 1); if (thislen < 0) return thislen; else pos += thislen; if (hash != getHash()) return -1; diff --git a/test/symforce_function_codegen_test_data/sympy/codegen_explicit_template_instantiation_test_data/cpp/lcmtypes/codegen_explicit_template_instantiation_test/values_vec_t.hpp b/test/symforce_function_codegen_test_data/sympy/codegen_explicit_template_instantiation_test_data/cpp/lcmtypes/codegen_explicit_template_instantiation_test/values_vec_t.hpp index 2083bbf0..08b2adc5 100644 --- a/test/symforce_function_codegen_test_data/sympy/codegen_explicit_template_instantiation_test_data/cpp/lcmtypes/codegen_explicit_template_instantiation_test/values_vec_t.hpp +++ b/test/symforce_function_codegen_test_data/sympy/codegen_explicit_template_instantiation_test_data/cpp/lcmtypes/codegen_explicit_template_instantiation_test/values_vec_t.hpp @@ -117,14 +117,7 @@ class values_vec_t for(fp = p; fp != NULL; fp = fp->parent) if(fp->v == values_vec_t::getHash) return 0; - const __lcm_hash_ptr cp = { p, values_vec_t::getHash }; - - uint64_t hash = 0xe7b60b55c8cf5417LL + - ::eigen_lcm::Vector4d::_computeHash(&cp) + - ::eigen_lcm::Vector4d::_computeHash(&cp) + - ::eigen_lcm::Vector4d::_computeHash(&cp); - - return (hash<<1) + ((hash>>63)&1); + return 0xb9724e5f032c5787ULL; } // Comparison operators. @@ -310,7 +303,7 @@ __lcm_buffer_size values_vec_t::decode(const void *buf, __lcm_buffer_size offset { __lcm_buffer_size pos = 0, thislen; - uint64_t hash; + uint64_t hash = 0; thislen = __uint64_t_decode_array(buf, offset + pos, maxlen - pos, &hash, 1); if (thislen < 0) return thislen; else pos += thislen; if (hash != getHash()) return -1; diff --git a/test/symforce_function_codegen_test_data/sympy/codegen_explicit_template_instantiation_test_data/python/lcmtypes/codegen_explicit_template_instantiation_test/_constants_t.py b/test/symforce_function_codegen_test_data/sympy/codegen_explicit_template_instantiation_test_data/python/lcmtypes/codegen_explicit_template_instantiation_test/_constants_t.py index 8ce58cdf..e1309aa6 100644 --- a/test/symforce_function_codegen_test_data/sympy/codegen_explicit_template_instantiation_test_data/python/lcmtypes/codegen_explicit_template_instantiation_test/_constants_t.py +++ b/test/symforce_function_codegen_test_data/sympy/codegen_explicit_template_instantiation_test_data/python/lcmtypes/codegen_explicit_template_instantiation_test/_constants_t.py @@ -76,7 +76,7 @@ def decode(data: T.Union[bytes, T.BinaryIO]) -> constants_t: # NOTE(eric): mypy isn't able to figure out the hasattr check buf = T.cast(T.BinaryIO, data) else: - buf = BytesIO(T.cast(bytes, data)) + buf = BytesIO(data) if buf.read(8) != constants_t._get_packed_fingerprint(): raise ValueError("Decode error") @@ -91,9 +91,7 @@ def _decode_one(buf: T.BinaryIO) -> constants_t: @staticmethod def _get_hash_recursive(parents: T.List[T.Type]) -> int: if constants_t in parents: return 0 - tmphash = (0x152f505c823f2cbc) & 0xffffffffffffffff - tmphash = (((tmphash<<1)&0xffffffffffffffff) + (tmphash>>63)) & 0xffffffffffffffff - return tmphash + return 0x2a5ea0b9047e5978 _packed_fingerprint: T.Optional[bytes] = None diff --git a/test/symforce_function_codegen_test_data/sympy/codegen_explicit_template_instantiation_test_data/python/lcmtypes/codegen_explicit_template_instantiation_test/_states_t.py b/test/symforce_function_codegen_test_data/sympy/codegen_explicit_template_instantiation_test_data/python/lcmtypes/codegen_explicit_template_instantiation_test/_states_t.py index 2a5ba362..cb11ca43 100644 --- a/test/symforce_function_codegen_test_data/sympy/codegen_explicit_template_instantiation_test_data/python/lcmtypes/codegen_explicit_template_instantiation_test/_states_t.py +++ b/test/symforce_function_codegen_test_data/sympy/codegen_explicit_template_instantiation_test_data/python/lcmtypes/codegen_explicit_template_instantiation_test/_states_t.py @@ -81,7 +81,7 @@ def decode(data: T.Union[bytes, T.BinaryIO]) -> states_t: # NOTE(eric): mypy isn't able to figure out the hasattr check buf = T.cast(T.BinaryIO, data) else: - buf = BytesIO(T.cast(bytes, data)) + buf = BytesIO(data) if buf.read(8) != states_t._get_packed_fingerprint(): raise ValueError("Decode error") @@ -96,10 +96,7 @@ def _decode_one(buf: T.BinaryIO) -> states_t: @staticmethod def _get_hash_recursive(parents: T.List[T.Type]) -> int: if states_t in parents: return 0 - newparents = parents + [states_t] - tmphash = (0x12345678017000+ Vector2d._get_hash_recursive(newparents)) & 0xffffffffffffffff - tmphash = (((tmphash<<1)&0xffffffffffffffff) + (tmphash>>63)) & 0xffffffffffffffff - return tmphash + return 0xf8d125e8c0876fc1 _packed_fingerprint: T.Optional[bytes] = None diff --git a/test/symforce_function_codegen_test_data/sympy/codegen_explicit_template_instantiation_test_data/python/lcmtypes/codegen_explicit_template_instantiation_test/_values_vec_t.py b/test/symforce_function_codegen_test_data/sympy/codegen_explicit_template_instantiation_test_data/python/lcmtypes/codegen_explicit_template_instantiation_test/_values_vec_t.py index 87a99b54..4cec0415 100644 --- a/test/symforce_function_codegen_test_data/sympy/codegen_explicit_template_instantiation_test_data/python/lcmtypes/codegen_explicit_template_instantiation_test/_values_vec_t.py +++ b/test/symforce_function_codegen_test_data/sympy/codegen_explicit_template_instantiation_test_data/python/lcmtypes/codegen_explicit_template_instantiation_test/_values_vec_t.py @@ -121,7 +121,7 @@ def decode(data: T.Union[bytes, T.BinaryIO]) -> values_vec_t: # NOTE(eric): mypy isn't able to figure out the hasattr check buf = T.cast(T.BinaryIO, data) else: - buf = BytesIO(T.cast(bytes, data)) + buf = BytesIO(data) if buf.read(8) != values_vec_t._get_packed_fingerprint(): raise ValueError("Decode error") @@ -146,10 +146,7 @@ def _decode_one(buf: T.BinaryIO) -> values_vec_t: @staticmethod def _get_hash_recursive(parents: T.List[T.Type]) -> int: if values_vec_t in parents: return 0 - newparents = parents + [values_vec_t] - tmphash = (0xe7b60b55c8cf5417+ Vector4d._get_hash_recursive(newparents)+ Vector4d._get_hash_recursive(newparents)+ Vector4d._get_hash_recursive(newparents)) & 0xffffffffffffffff - tmphash = (((tmphash<<1)&0xffffffffffffffff) + (tmphash>>63)) & 0xffffffffffffffff - return tmphash + return 0xb9724e5f032c5787 _packed_fingerprint: T.Optional[bytes] = None diff --git a/test/symforce_function_codegen_test_data/sympy/codegen_multi_function_test_data/cpp/lcmtypes/codegen_multi_function_test/inputs_constants_t.hpp b/test/symforce_function_codegen_test_data/sympy/codegen_multi_function_test_data/cpp/lcmtypes/codegen_multi_function_test/inputs_constants_t.hpp index 9c8471e7..e1d14fc4 100644 --- a/test/symforce_function_codegen_test_data/sympy/codegen_multi_function_test_data/cpp/lcmtypes/codegen_multi_function_test/inputs_constants_t.hpp +++ b/test/symforce_function_codegen_test_data/sympy/codegen_multi_function_test_data/cpp/lcmtypes/codegen_multi_function_test/inputs_constants_t.hpp @@ -93,8 +93,7 @@ class inputs_constants_t inline __lcm_buffer_size _decodeNoHash(const void *buf, __lcm_buffer_size offset, __lcm_buffer_size maxlen); constexpr static uint64_t _computeHash(const __lcm_hash_ptr *) { - uint64_t hash = 0x152f505c823f2cbcLL; - return (hash<<1) + ((hash>>63)&1); + return 0x2a5ea0b9047e5978ULL; } // Comparison operators. @@ -205,7 +204,7 @@ __lcm_buffer_size inputs_constants_t::decode(const void *buf, __lcm_buffer_size { __lcm_buffer_size pos = 0, thislen; - uint64_t hash; + uint64_t hash = 0; thislen = __uint64_t_decode_array(buf, offset + pos, maxlen - pos, &hash, 1); if (thislen < 0) return thislen; else pos += thislen; if (hash != getHash()) return -1; diff --git a/test/symforce_function_codegen_test_data/sympy/codegen_multi_function_test_data/cpp/lcmtypes/codegen_multi_function_test/inputs_states_t.hpp b/test/symforce_function_codegen_test_data/sympy/codegen_multi_function_test_data/cpp/lcmtypes/codegen_multi_function_test/inputs_states_t.hpp index 9d8699f2..05a67cfa 100644 --- a/test/symforce_function_codegen_test_data/sympy/codegen_multi_function_test_data/cpp/lcmtypes/codegen_multi_function_test/inputs_states_t.hpp +++ b/test/symforce_function_codegen_test_data/sympy/codegen_multi_function_test_data/cpp/lcmtypes/codegen_multi_function_test/inputs_states_t.hpp @@ -101,12 +101,7 @@ class inputs_states_t for(fp = p; fp != NULL; fp = fp->parent) if(fp->v == inputs_states_t::getHash) return 0; - const __lcm_hash_ptr cp = { p, inputs_states_t::getHash }; - - uint64_t hash = 0x0012345678017000LL + - ::eigen_lcm::Vector2d::_computeHash(&cp); - - return (hash<<1) + ((hash>>63)&1); + return 0xf8d125e8c0876fc1ULL; } // Comparison operators. @@ -217,7 +212,7 @@ __lcm_buffer_size inputs_states_t::decode(const void *buf, __lcm_buffer_size off { __lcm_buffer_size pos = 0, thislen; - uint64_t hash; + uint64_t hash = 0; thislen = __uint64_t_decode_array(buf, offset + pos, maxlen - pos, &hash, 1); if (thislen < 0) return thislen; else pos += thislen; if (hash != getHash()) return -1; diff --git a/test/symforce_function_codegen_test_data/sympy/codegen_multi_function_test_data/cpp/lcmtypes/codegen_multi_function_test/inputs_t.hpp b/test/symforce_function_codegen_test_data/sympy/codegen_multi_function_test_data/cpp/lcmtypes/codegen_multi_function_test/inputs_t.hpp index bbef4ff3..ca87de04 100644 --- a/test/symforce_function_codegen_test_data/sympy/codegen_multi_function_test_data/cpp/lcmtypes/codegen_multi_function_test/inputs_t.hpp +++ b/test/symforce_function_codegen_test_data/sympy/codegen_multi_function_test_data/cpp/lcmtypes/codegen_multi_function_test/inputs_t.hpp @@ -140,20 +140,7 @@ class inputs_t for(fp = p; fp != NULL; fp = fp->parent) if(fp->v == inputs_t::getHash) return 0; - const __lcm_hash_ptr cp = { p, inputs_t::getHash }; - - uint64_t hash = 0x57fdecbc3532ce7fLL + - ::eigen_lcm::Vector4d::_computeHash(&cp) + - ::eigen_lcm::Vector4d::_computeHash(&cp) + - ::eigen_lcm::Vector4d::_computeHash(&cp) + - ::codegen_multi_function_test::values_vec_t::_computeHash(&cp) + - ::codegen_multi_function_test::values_vec_t::_computeHash(&cp) + - ::codegen_multi_function_test::inputs_constants_t::_computeHash(&cp) + - ::eigen_lcm::MatrixXd::_computeHash(&cp) + - ::eigen_lcm::Matrix4d::_computeHash(&cp) + - ::codegen_multi_function_test::inputs_states_t::_computeHash(&cp); - - return (hash<<1) + ((hash>>63)&1); + return 0xbaf4a87fdcc6ef9bULL; } // Comparison operators. @@ -429,7 +416,7 @@ __lcm_buffer_size inputs_t::decode(const void *buf, __lcm_buffer_size offset, __ { __lcm_buffer_size pos = 0, thislen; - uint64_t hash; + uint64_t hash = 0; thislen = __uint64_t_decode_array(buf, offset + pos, maxlen - pos, &hash, 1); if (thislen < 0) return thislen; else pos += thislen; if (hash != getHash()) return -1; diff --git a/test/symforce_function_codegen_test_data/sympy/codegen_multi_function_test_data/cpp/lcmtypes/codegen_multi_function_test/outputs_1_t.hpp b/test/symforce_function_codegen_test_data/sympy/codegen_multi_function_test_data/cpp/lcmtypes/codegen_multi_function_test/outputs_1_t.hpp index e279bc8a..271120d1 100644 --- a/test/symforce_function_codegen_test_data/sympy/codegen_multi_function_test_data/cpp/lcmtypes/codegen_multi_function_test/outputs_1_t.hpp +++ b/test/symforce_function_codegen_test_data/sympy/codegen_multi_function_test_data/cpp/lcmtypes/codegen_multi_function_test/outputs_1_t.hpp @@ -122,15 +122,7 @@ class outputs_1_t for(fp = p; fp != NULL; fp = fp->parent) if(fp->v == outputs_1_t::getHash) return 0; - const __lcm_hash_ptr cp = { p, outputs_1_t::getHash }; - - uint64_t hash = 0xa7f6beb7efb65a6fLL + - ::codegen_multi_function_test::values_vec_t::_computeHash(&cp) + - ::codegen_multi_function_test::values_vec_t::_computeHash(&cp) + - ::eigen_lcm::MatrixXd::_computeHash(&cp) + - ::eigen_lcm::Matrix4d::_computeHash(&cp); - - return (hash<<1) + ((hash>>63)&1); + return 0x2a8087805634c5b0ULL; } // Comparison operators. @@ -331,7 +323,7 @@ __lcm_buffer_size outputs_1_t::decode(const void *buf, __lcm_buffer_size offset, { __lcm_buffer_size pos = 0, thislen; - uint64_t hash; + uint64_t hash = 0; thislen = __uint64_t_decode_array(buf, offset + pos, maxlen - pos, &hash, 1); if (thislen < 0) return thislen; else pos += thislen; if (hash != getHash()) return -1; diff --git a/test/symforce_function_codegen_test_data/sympy/codegen_multi_function_test_data/cpp/lcmtypes/codegen_multi_function_test/outputs_2_t.hpp b/test/symforce_function_codegen_test_data/sympy/codegen_multi_function_test_data/cpp/lcmtypes/codegen_multi_function_test/outputs_2_t.hpp index fd0ae680..7394d425 100644 --- a/test/symforce_function_codegen_test_data/sympy/codegen_multi_function_test_data/cpp/lcmtypes/codegen_multi_function_test/outputs_2_t.hpp +++ b/test/symforce_function_codegen_test_data/sympy/codegen_multi_function_test_data/cpp/lcmtypes/codegen_multi_function_test/outputs_2_t.hpp @@ -93,8 +93,7 @@ class outputs_2_t inline __lcm_buffer_size _decodeNoHash(const void *buf, __lcm_buffer_size offset, __lcm_buffer_size maxlen); constexpr static uint64_t _computeHash(const __lcm_hash_ptr *) { - uint64_t hash = 0x2acd1c65693943deLL; - return (hash<<1) + ((hash>>63)&1); + return 0x559a38cad27287bcULL; } // Comparison operators. @@ -205,7 +204,7 @@ __lcm_buffer_size outputs_2_t::decode(const void *buf, __lcm_buffer_size offset, { __lcm_buffer_size pos = 0, thislen; - uint64_t hash; + uint64_t hash = 0; thislen = __uint64_t_decode_array(buf, offset + pos, maxlen - pos, &hash, 1); if (thislen < 0) return thislen; else pos += thislen; if (hash != getHash()) return -1; diff --git a/test/symforce_function_codegen_test_data/sympy/codegen_multi_function_test_data/cpp/lcmtypes/codegen_multi_function_test/values_vec_t.hpp b/test/symforce_function_codegen_test_data/sympy/codegen_multi_function_test_data/cpp/lcmtypes/codegen_multi_function_test/values_vec_t.hpp index 657c863b..ed8573ae 100644 --- a/test/symforce_function_codegen_test_data/sympy/codegen_multi_function_test_data/cpp/lcmtypes/codegen_multi_function_test/values_vec_t.hpp +++ b/test/symforce_function_codegen_test_data/sympy/codegen_multi_function_test_data/cpp/lcmtypes/codegen_multi_function_test/values_vec_t.hpp @@ -117,14 +117,7 @@ class values_vec_t for(fp = p; fp != NULL; fp = fp->parent) if(fp->v == values_vec_t::getHash) return 0; - const __lcm_hash_ptr cp = { p, values_vec_t::getHash }; - - uint64_t hash = 0xe7b60b55c8cf5417LL + - ::eigen_lcm::Vector4d::_computeHash(&cp) + - ::eigen_lcm::Vector4d::_computeHash(&cp) + - ::eigen_lcm::Vector4d::_computeHash(&cp); - - return (hash<<1) + ((hash>>63)&1); + return 0xb9724e5f032c5787ULL; } // Comparison operators. @@ -310,7 +303,7 @@ __lcm_buffer_size values_vec_t::decode(const void *buf, __lcm_buffer_size offset { __lcm_buffer_size pos = 0, thislen; - uint64_t hash; + uint64_t hash = 0; thislen = __uint64_t_decode_array(buf, offset + pos, maxlen - pos, &hash, 1); if (thislen < 0) return thislen; else pos += thislen; if (hash != getHash()) return -1; diff --git a/test/symforce_function_codegen_test_data/sympy/codegen_multi_function_test_data/python/lcmtypes/codegen_multi_function_test/_inputs_constants_t.py b/test/symforce_function_codegen_test_data/sympy/codegen_multi_function_test_data/python/lcmtypes/codegen_multi_function_test/_inputs_constants_t.py index 4c066f45..5cdb8d6a 100644 --- a/test/symforce_function_codegen_test_data/sympy/codegen_multi_function_test_data/python/lcmtypes/codegen_multi_function_test/_inputs_constants_t.py +++ b/test/symforce_function_codegen_test_data/sympy/codegen_multi_function_test_data/python/lcmtypes/codegen_multi_function_test/_inputs_constants_t.py @@ -76,7 +76,7 @@ def decode(data: T.Union[bytes, T.BinaryIO]) -> inputs_constants_t: # NOTE(eric): mypy isn't able to figure out the hasattr check buf = T.cast(T.BinaryIO, data) else: - buf = BytesIO(T.cast(bytes, data)) + buf = BytesIO(data) if buf.read(8) != inputs_constants_t._get_packed_fingerprint(): raise ValueError("Decode error") @@ -91,9 +91,7 @@ def _decode_one(buf: T.BinaryIO) -> inputs_constants_t: @staticmethod def _get_hash_recursive(parents: T.List[T.Type]) -> int: if inputs_constants_t in parents: return 0 - tmphash = (0x152f505c823f2cbc) & 0xffffffffffffffff - tmphash = (((tmphash<<1)&0xffffffffffffffff) + (tmphash>>63)) & 0xffffffffffffffff - return tmphash + return 0x2a5ea0b9047e5978 _packed_fingerprint: T.Optional[bytes] = None diff --git a/test/symforce_function_codegen_test_data/sympy/codegen_multi_function_test_data/python/lcmtypes/codegen_multi_function_test/_inputs_states_t.py b/test/symforce_function_codegen_test_data/sympy/codegen_multi_function_test_data/python/lcmtypes/codegen_multi_function_test/_inputs_states_t.py index b5386272..5062af03 100644 --- a/test/symforce_function_codegen_test_data/sympy/codegen_multi_function_test_data/python/lcmtypes/codegen_multi_function_test/_inputs_states_t.py +++ b/test/symforce_function_codegen_test_data/sympy/codegen_multi_function_test_data/python/lcmtypes/codegen_multi_function_test/_inputs_states_t.py @@ -81,7 +81,7 @@ def decode(data: T.Union[bytes, T.BinaryIO]) -> inputs_states_t: # NOTE(eric): mypy isn't able to figure out the hasattr check buf = T.cast(T.BinaryIO, data) else: - buf = BytesIO(T.cast(bytes, data)) + buf = BytesIO(data) if buf.read(8) != inputs_states_t._get_packed_fingerprint(): raise ValueError("Decode error") @@ -96,10 +96,7 @@ def _decode_one(buf: T.BinaryIO) -> inputs_states_t: @staticmethod def _get_hash_recursive(parents: T.List[T.Type]) -> int: if inputs_states_t in parents: return 0 - newparents = parents + [inputs_states_t] - tmphash = (0x12345678017000+ Vector2d._get_hash_recursive(newparents)) & 0xffffffffffffffff - tmphash = (((tmphash<<1)&0xffffffffffffffff) + (tmphash>>63)) & 0xffffffffffffffff - return tmphash + return 0xf8d125e8c0876fc1 _packed_fingerprint: T.Optional[bytes] = None diff --git a/test/symforce_function_codegen_test_data/sympy/codegen_multi_function_test_data/python/lcmtypes/codegen_multi_function_test/_inputs_t.py b/test/symforce_function_codegen_test_data/sympy/codegen_multi_function_test_data/python/lcmtypes/codegen_multi_function_test/_inputs_t.py index 0a990005..5120a91f 100644 --- a/test/symforce_function_codegen_test_data/sympy/codegen_multi_function_test_data/python/lcmtypes/codegen_multi_function_test/_inputs_t.py +++ b/test/symforce_function_codegen_test_data/sympy/codegen_multi_function_test_data/python/lcmtypes/codegen_multi_function_test/_inputs_t.py @@ -189,7 +189,7 @@ def decode(data: T.Union[bytes, T.BinaryIO]) -> inputs_t: # NOTE(eric): mypy isn't able to figure out the hasattr check buf = T.cast(T.BinaryIO, data) else: - buf = BytesIO(T.cast(bytes, data)) + buf = BytesIO(data) if buf.read(8) != inputs_t._get_packed_fingerprint(): raise ValueError("Decode error") @@ -226,10 +226,7 @@ def _decode_one(buf: T.BinaryIO) -> inputs_t: @staticmethod def _get_hash_recursive(parents: T.List[T.Type]) -> int: if inputs_t in parents: return 0 - newparents = parents + [inputs_t] - tmphash = (0x57fdecbc3532ce7f+ Vector4d._get_hash_recursive(newparents)+ Vector4d._get_hash_recursive(newparents)+ Vector4d._get_hash_recursive(newparents)+ values_vec_t._get_hash_recursive(newparents)+ values_vec_t._get_hash_recursive(newparents)+ inputs_constants_t._get_hash_recursive(newparents)+ MatrixXd._get_hash_recursive(newparents)+ Matrix4d._get_hash_recursive(newparents)+ inputs_states_t._get_hash_recursive(newparents)) & 0xffffffffffffffff - tmphash = (((tmphash<<1)&0xffffffffffffffff) + (tmphash>>63)) & 0xffffffffffffffff - return tmphash + return 0xbaf4a87fdcc6ef9b _packed_fingerprint: T.Optional[bytes] = None diff --git a/test/symforce_function_codegen_test_data/sympy/codegen_multi_function_test_data/python/lcmtypes/codegen_multi_function_test/_outputs_1_t.py b/test/symforce_function_codegen_test_data/sympy/codegen_multi_function_test_data/python/lcmtypes/codegen_multi_function_test/_outputs_1_t.py index 16ef2c42..1d692ba5 100644 --- a/test/symforce_function_codegen_test_data/sympy/codegen_multi_function_test_data/python/lcmtypes/codegen_multi_function_test/_outputs_1_t.py +++ b/test/symforce_function_codegen_test_data/sympy/codegen_multi_function_test_data/python/lcmtypes/codegen_multi_function_test/_outputs_1_t.py @@ -133,7 +133,7 @@ def decode(data: T.Union[bytes, T.BinaryIO]) -> outputs_1_t: # NOTE(eric): mypy isn't able to figure out the hasattr check buf = T.cast(T.BinaryIO, data) else: - buf = BytesIO(T.cast(bytes, data)) + buf = BytesIO(data) if buf.read(8) != outputs_1_t._get_packed_fingerprint(): raise ValueError("Decode error") @@ -159,10 +159,7 @@ def _decode_one(buf: T.BinaryIO) -> outputs_1_t: @staticmethod def _get_hash_recursive(parents: T.List[T.Type]) -> int: if outputs_1_t in parents: return 0 - newparents = parents + [outputs_1_t] - tmphash = (0xa7f6beb7efb65a6f+ values_vec_t._get_hash_recursive(newparents)+ values_vec_t._get_hash_recursive(newparents)+ MatrixXd._get_hash_recursive(newparents)+ Matrix4d._get_hash_recursive(newparents)) & 0xffffffffffffffff - tmphash = (((tmphash<<1)&0xffffffffffffffff) + (tmphash>>63)) & 0xffffffffffffffff - return tmphash + return 0x2a8087805634c5b0 _packed_fingerprint: T.Optional[bytes] = None diff --git a/test/symforce_function_codegen_test_data/sympy/codegen_multi_function_test_data/python/lcmtypes/codegen_multi_function_test/_outputs_2_t.py b/test/symforce_function_codegen_test_data/sympy/codegen_multi_function_test_data/python/lcmtypes/codegen_multi_function_test/_outputs_2_t.py index d2729bd2..0c27be8b 100644 --- a/test/symforce_function_codegen_test_data/sympy/codegen_multi_function_test_data/python/lcmtypes/codegen_multi_function_test/_outputs_2_t.py +++ b/test/symforce_function_codegen_test_data/sympy/codegen_multi_function_test_data/python/lcmtypes/codegen_multi_function_test/_outputs_2_t.py @@ -76,7 +76,7 @@ def decode(data: T.Union[bytes, T.BinaryIO]) -> outputs_2_t: # NOTE(eric): mypy isn't able to figure out the hasattr check buf = T.cast(T.BinaryIO, data) else: - buf = BytesIO(T.cast(bytes, data)) + buf = BytesIO(data) if buf.read(8) != outputs_2_t._get_packed_fingerprint(): raise ValueError("Decode error") @@ -91,9 +91,7 @@ def _decode_one(buf: T.BinaryIO) -> outputs_2_t: @staticmethod def _get_hash_recursive(parents: T.List[T.Type]) -> int: if outputs_2_t in parents: return 0 - tmphash = (0x2acd1c65693943de) & 0xffffffffffffffff - tmphash = (((tmphash<<1)&0xffffffffffffffff) + (tmphash>>63)) & 0xffffffffffffffff - return tmphash + return 0x559a38cad27287bc _packed_fingerprint: T.Optional[bytes] = None diff --git a/test/symforce_function_codegen_test_data/sympy/codegen_multi_function_test_data/python/lcmtypes/codegen_multi_function_test/_values_vec_t.py b/test/symforce_function_codegen_test_data/sympy/codegen_multi_function_test_data/python/lcmtypes/codegen_multi_function_test/_values_vec_t.py index 18910694..263bd0be 100644 --- a/test/symforce_function_codegen_test_data/sympy/codegen_multi_function_test_data/python/lcmtypes/codegen_multi_function_test/_values_vec_t.py +++ b/test/symforce_function_codegen_test_data/sympy/codegen_multi_function_test_data/python/lcmtypes/codegen_multi_function_test/_values_vec_t.py @@ -121,7 +121,7 @@ def decode(data: T.Union[bytes, T.BinaryIO]) -> values_vec_t: # NOTE(eric): mypy isn't able to figure out the hasattr check buf = T.cast(T.BinaryIO, data) else: - buf = BytesIO(T.cast(bytes, data)) + buf = BytesIO(data) if buf.read(8) != values_vec_t._get_packed_fingerprint(): raise ValueError("Decode error") @@ -146,10 +146,7 @@ def _decode_one(buf: T.BinaryIO) -> values_vec_t: @staticmethod def _get_hash_recursive(parents: T.List[T.Type]) -> int: if values_vec_t in parents: return 0 - newparents = parents + [values_vec_t] - tmphash = (0xe7b60b55c8cf5417+ Vector4d._get_hash_recursive(newparents)+ Vector4d._get_hash_recursive(newparents)+ Vector4d._get_hash_recursive(newparents)) & 0xffffffffffffffff - tmphash = (((tmphash<<1)&0xffffffffffffffff) + (tmphash>>63)) & 0xffffffffffffffff - return tmphash + return 0xb9724e5f032c5787 _packed_fingerprint: T.Optional[bytes] = None diff --git a/test/symforce_function_codegen_test_data/sympy/codegen_python_test_data/cpp/lcmtypes/codegen_python_test/constants_t.hpp b/test/symforce_function_codegen_test_data/sympy/codegen_python_test_data/cpp/lcmtypes/codegen_python_test/constants_t.hpp index 1df0b502..dce06d5c 100644 --- a/test/symforce_function_codegen_test_data/sympy/codegen_python_test_data/cpp/lcmtypes/codegen_python_test/constants_t.hpp +++ b/test/symforce_function_codegen_test_data/sympy/codegen_python_test_data/cpp/lcmtypes/codegen_python_test/constants_t.hpp @@ -93,8 +93,7 @@ class constants_t inline __lcm_buffer_size _decodeNoHash(const void *buf, __lcm_buffer_size offset, __lcm_buffer_size maxlen); constexpr static uint64_t _computeHash(const __lcm_hash_ptr *) { - uint64_t hash = 0x152f505c823f2cbcLL; - return (hash<<1) + ((hash>>63)&1); + return 0x2a5ea0b9047e5978ULL; } // Comparison operators. @@ -205,7 +204,7 @@ __lcm_buffer_size constants_t::decode(const void *buf, __lcm_buffer_size offset, { __lcm_buffer_size pos = 0, thislen; - uint64_t hash; + uint64_t hash = 0; thislen = __uint64_t_decode_array(buf, offset + pos, maxlen - pos, &hash, 1); if (thislen < 0) return thislen; else pos += thislen; if (hash != getHash()) return -1; diff --git a/test/symforce_function_codegen_test_data/sympy/codegen_python_test_data/cpp/lcmtypes/codegen_python_test/states_t.hpp b/test/symforce_function_codegen_test_data/sympy/codegen_python_test_data/cpp/lcmtypes/codegen_python_test/states_t.hpp index ca0c7872..e5812f45 100644 --- a/test/symforce_function_codegen_test_data/sympy/codegen_python_test_data/cpp/lcmtypes/codegen_python_test/states_t.hpp +++ b/test/symforce_function_codegen_test_data/sympy/codegen_python_test_data/cpp/lcmtypes/codegen_python_test/states_t.hpp @@ -101,12 +101,7 @@ class states_t for(fp = p; fp != NULL; fp = fp->parent) if(fp->v == states_t::getHash) return 0; - const __lcm_hash_ptr cp = { p, states_t::getHash }; - - uint64_t hash = 0x0012345678017000LL + - ::eigen_lcm::Vector2d::_computeHash(&cp); - - return (hash<<1) + ((hash>>63)&1); + return 0xf8d125e8c0876fc1ULL; } // Comparison operators. @@ -217,7 +212,7 @@ __lcm_buffer_size states_t::decode(const void *buf, __lcm_buffer_size offset, __ { __lcm_buffer_size pos = 0, thislen; - uint64_t hash; + uint64_t hash = 0; thislen = __uint64_t_decode_array(buf, offset + pos, maxlen - pos, &hash, 1); if (thislen < 0) return thislen; else pos += thislen; if (hash != getHash()) return -1; diff --git a/test/symforce_function_codegen_test_data/sympy/codegen_python_test_data/cpp/lcmtypes/codegen_python_test/values_vec_t.hpp b/test/symforce_function_codegen_test_data/sympy/codegen_python_test_data/cpp/lcmtypes/codegen_python_test/values_vec_t.hpp index 0dcd8381..a208f5f8 100644 --- a/test/symforce_function_codegen_test_data/sympy/codegen_python_test_data/cpp/lcmtypes/codegen_python_test/values_vec_t.hpp +++ b/test/symforce_function_codegen_test_data/sympy/codegen_python_test_data/cpp/lcmtypes/codegen_python_test/values_vec_t.hpp @@ -117,14 +117,7 @@ class values_vec_t for(fp = p; fp != NULL; fp = fp->parent) if(fp->v == values_vec_t::getHash) return 0; - const __lcm_hash_ptr cp = { p, values_vec_t::getHash }; - - uint64_t hash = 0xe7b60b55c8cf5417LL + - ::eigen_lcm::Vector4d::_computeHash(&cp) + - ::eigen_lcm::Vector4d::_computeHash(&cp) + - ::eigen_lcm::Vector4d::_computeHash(&cp); - - return (hash<<1) + ((hash>>63)&1); + return 0xb9724e5f032c5787ULL; } // Comparison operators. @@ -310,7 +303,7 @@ __lcm_buffer_size values_vec_t::decode(const void *buf, __lcm_buffer_size offset { __lcm_buffer_size pos = 0, thislen; - uint64_t hash; + uint64_t hash = 0; thislen = __uint64_t_decode_array(buf, offset + pos, maxlen - pos, &hash, 1); if (thislen < 0) return thislen; else pos += thislen; if (hash != getHash()) return -1; diff --git a/test/symforce_function_codegen_test_data/sympy/codegen_python_test_data/python/lcmtypes/codegen_python_test/_constants_t.py b/test/symforce_function_codegen_test_data/sympy/codegen_python_test_data/python/lcmtypes/codegen_python_test/_constants_t.py index 1336e16b..94e9959e 100644 --- a/test/symforce_function_codegen_test_data/sympy/codegen_python_test_data/python/lcmtypes/codegen_python_test/_constants_t.py +++ b/test/symforce_function_codegen_test_data/sympy/codegen_python_test_data/python/lcmtypes/codegen_python_test/_constants_t.py @@ -76,7 +76,7 @@ def decode(data: T.Union[bytes, T.BinaryIO]) -> constants_t: # NOTE(eric): mypy isn't able to figure out the hasattr check buf = T.cast(T.BinaryIO, data) else: - buf = BytesIO(T.cast(bytes, data)) + buf = BytesIO(data) if buf.read(8) != constants_t._get_packed_fingerprint(): raise ValueError("Decode error") @@ -91,9 +91,7 @@ def _decode_one(buf: T.BinaryIO) -> constants_t: @staticmethod def _get_hash_recursive(parents: T.List[T.Type]) -> int: if constants_t in parents: return 0 - tmphash = (0x152f505c823f2cbc) & 0xffffffffffffffff - tmphash = (((tmphash<<1)&0xffffffffffffffff) + (tmphash>>63)) & 0xffffffffffffffff - return tmphash + return 0x2a5ea0b9047e5978 _packed_fingerprint: T.Optional[bytes] = None diff --git a/test/symforce_function_codegen_test_data/sympy/codegen_python_test_data/python/lcmtypes/codegen_python_test/_states_t.py b/test/symforce_function_codegen_test_data/sympy/codegen_python_test_data/python/lcmtypes/codegen_python_test/_states_t.py index 20cbc2ba..858860fc 100644 --- a/test/symforce_function_codegen_test_data/sympy/codegen_python_test_data/python/lcmtypes/codegen_python_test/_states_t.py +++ b/test/symforce_function_codegen_test_data/sympy/codegen_python_test_data/python/lcmtypes/codegen_python_test/_states_t.py @@ -81,7 +81,7 @@ def decode(data: T.Union[bytes, T.BinaryIO]) -> states_t: # NOTE(eric): mypy isn't able to figure out the hasattr check buf = T.cast(T.BinaryIO, data) else: - buf = BytesIO(T.cast(bytes, data)) + buf = BytesIO(data) if buf.read(8) != states_t._get_packed_fingerprint(): raise ValueError("Decode error") @@ -96,10 +96,7 @@ def _decode_one(buf: T.BinaryIO) -> states_t: @staticmethod def _get_hash_recursive(parents: T.List[T.Type]) -> int: if states_t in parents: return 0 - newparents = parents + [states_t] - tmphash = (0x12345678017000+ Vector2d._get_hash_recursive(newparents)) & 0xffffffffffffffff - tmphash = (((tmphash<<1)&0xffffffffffffffff) + (tmphash>>63)) & 0xffffffffffffffff - return tmphash + return 0xf8d125e8c0876fc1 _packed_fingerprint: T.Optional[bytes] = None diff --git a/test/symforce_function_codegen_test_data/sympy/codegen_python_test_data/python/lcmtypes/codegen_python_test/_values_vec_t.py b/test/symforce_function_codegen_test_data/sympy/codegen_python_test_data/python/lcmtypes/codegen_python_test/_values_vec_t.py index 994477cc..39e1f87a 100644 --- a/test/symforce_function_codegen_test_data/sympy/codegen_python_test_data/python/lcmtypes/codegen_python_test/_values_vec_t.py +++ b/test/symforce_function_codegen_test_data/sympy/codegen_python_test_data/python/lcmtypes/codegen_python_test/_values_vec_t.py @@ -121,7 +121,7 @@ def decode(data: T.Union[bytes, T.BinaryIO]) -> values_vec_t: # NOTE(eric): mypy isn't able to figure out the hasattr check buf = T.cast(T.BinaryIO, data) else: - buf = BytesIO(T.cast(bytes, data)) + buf = BytesIO(data) if buf.read(8) != values_vec_t._get_packed_fingerprint(): raise ValueError("Decode error") @@ -146,10 +146,7 @@ def _decode_one(buf: T.BinaryIO) -> values_vec_t: @staticmethod def _get_hash_recursive(parents: T.List[T.Type]) -> int: if values_vec_t in parents: return 0 - newparents = parents + [values_vec_t] - tmphash = (0xe7b60b55c8cf5417+ Vector4d._get_hash_recursive(newparents)+ Vector4d._get_hash_recursive(newparents)+ Vector4d._get_hash_recursive(newparents)) & 0xffffffffffffffff - tmphash = (((tmphash<<1)&0xffffffffffffffff) + (tmphash>>63)) & 0xffffffffffffffff - return tmphash + return 0xb9724e5f032c5787 _packed_fingerprint: T.Optional[bytes] = None diff --git a/test/symforce_function_codegen_test_data/sympy/with_jacobians_values/python/lcmtypes/sym/_d_out_t.py b/test/symforce_function_codegen_test_data/sympy/with_jacobians_values/python/lcmtypes/sym/_d_out_t.py index 61e19a8f..00fe53b8 100644 --- a/test/symforce_function_codegen_test_data/sympy/with_jacobians_values/python/lcmtypes/sym/_d_out_t.py +++ b/test/symforce_function_codegen_test_data/sympy/with_jacobians_values/python/lcmtypes/sym/_d_out_t.py @@ -81,7 +81,7 @@ def decode(data: T.Union[bytes, T.BinaryIO]) -> d_out_t: # NOTE(eric): mypy isn't able to figure out the hasattr check buf = T.cast(T.BinaryIO, data) else: - buf = BytesIO(T.cast(bytes, data)) + buf = BytesIO(data) if buf.read(8) != d_out_t._get_packed_fingerprint(): raise ValueError("Decode error") diff --git a/test/symforce_function_codegen_test_data/sympy/with_jacobians_values/python/lcmtypes/sym/_d_t.py b/test/symforce_function_codegen_test_data/sympy/with_jacobians_values/python/lcmtypes/sym/_d_t.py index 36bf9ab4..9ed51a34 100644 --- a/test/symforce_function_codegen_test_data/sympy/with_jacobians_values/python/lcmtypes/sym/_d_t.py +++ b/test/symforce_function_codegen_test_data/sympy/with_jacobians_values/python/lcmtypes/sym/_d_t.py @@ -87,7 +87,7 @@ def decode(data: T.Union[bytes, T.BinaryIO]) -> d_t: # NOTE(eric): mypy isn't able to figure out the hasattr check buf = T.cast(T.BinaryIO, data) else: - buf = BytesIO(T.cast(bytes, data)) + buf = BytesIO(data) if buf.read(8) != d_t._get_packed_fingerprint(): raise ValueError("Decode error") diff --git a/third_party/skymarshal/skymarshal/templates/python_enum.py.template b/third_party/skymarshal/skymarshal/templates/python_enum.py.template index c2b4d2ee..b313b3ef 100644 --- a/third_party/skymarshal/skymarshal/templates/python_enum.py.template +++ b/third_party/skymarshal/skymarshal/templates/python_enum.py.template @@ -46,7 +46,7 @@ class {{enumtype.name}}(enum.Enum): # NOTE(eric): mypy isn't able to figure out the hasattr check buf = T.cast(T.BinaryIO, data) else: - buf = BytesIO(T.cast(bytes, data)) + buf = BytesIO(data) if buf.read(8) != cls._get_packed_fingerprint(): raise ValueError("Decode error") diff --git a/third_party/skymarshal/skymarshal/templates/python_struct.py.template b/third_party/skymarshal/skymarshal/templates/python_struct.py.template index d90b14cd..cc920853 100644 --- a/third_party/skymarshal/skymarshal/templates/python_struct.py.template +++ b/third_party/skymarshal/skymarshal/templates/python_struct.py.template @@ -110,7 +110,7 @@ class {{ lcmtype.name }}(object): # NOTE(eric): mypy isn't able to figure out the hasattr check buf = T.cast(T.BinaryIO, data) else: - buf = BytesIO(T.cast(bytes, data)) + buf = BytesIO(data) if buf.read(8) != {{ lcmtype.name }}._get_packed_fingerprint(): raise ValueError("Decode error") From 13e72357197947857558efa2ac1117b82e21df03 Mon Sep 17 00:00:00 2001 From: Ramon Roche Date: Wed, 19 Aug 2026 02:43:13 +0000 Subject: [PATCH 14/68] [SymForce-External] Build manylinux aarch64 wheels Build manylinux aarch64 wheels This adds Linux aarch64 wheels to the wheel build, next to the existing x86_64 Linux and arm64 macOS ones. The `build-linux` job now runs the same cibuildwheel configuration natively on GitHub's free `ubuntu-24.04-arm` hosted runner (no QEMU), so build times should be in line with the x86_64 jobs. The `os` matrix entry becomes a runner/arch object like the macOS job already uses, `CIBW_BUILD` selects `manylinux_`, and the per-job artifact names include the arch so the two Linux builds don't collide before `merge-wheel-artifacts` picks them up. Nothing changes for the existing x86_64 build beyond the artifact name. I built and tested `cp312-manylinux_aarch64` locally with cibuildwheel 3.4.1 against the same `manylinux_2_28_aarch64` image (arm64 Docker on Apple Silicon), including `run_wheel_tests.py` under both `symengine` and `sympy`. auditwheel tags the result `manylinux_2_27_aarch64.manylinux_2_28_aarch64`, matching the x86_64 wheels. Partially addresses symforce-org/symforce#146. Assisted-by: Claude:claude-fable-5 Signed-off-by: Ramon Roche Closes symforce-org/symforce#466 GitOrigin-RevId: ea69df6cc28834a06ed916c7b3919f576256f019 --- .github/workflows/build_wheels.yml | 13 +++++++++---- 1 file changed, 9 insertions(+), 4 deletions(-) diff --git a/.github/workflows/build_wheels.yml b/.github/workflows/build_wheels.yml index 0300fbf9..9fe83c75 100644 --- a/.github/workflows/build_wheels.yml +++ b/.github/workflows/build_wheels.yml @@ -84,11 +84,15 @@ jobs: build-linux: if: contains(fromJSON('["push", "workflow_dispatch"]'), github.event_name) || (github.event_name == 'pull_request' && github.event.pull_request.draft == false) - runs-on: ${{ matrix.os }} + runs-on: ${{ matrix.os.runner }} strategy: fail-fast: false matrix: - os: [ubuntu-latest] + os: + - runner: ubuntu-latest + arch: x86_64 + - runner: ubuntu-24.04-arm + arch: aarch64 python-version: [cp310, cp311, cp312, cp313, cp314] steps: @@ -105,7 +109,8 @@ jobs: - name: Build wheels uses: pypa/cibuildwheel@v3.4.1 env: - CIBW_BUILD: ${{ matrix.python-version }}-manylinux_x86_64 + CIBW_BUILD: ${{ matrix.python-version }}-manylinux_${{ matrix.os.arch }} + CIBW_ARCHS_LINUX: ${{ matrix.os.arch }} CIBW_BEFORE_BUILD: yum install -y gmp-devel git CIBW_ENVIRONMENT: SYMFORCE_REWRITE_LOCAL_DEPENDENCIES=$SYMFORCE_VERSION SYMFORCE_PYTHON_OVERRIDE=python CIBW_ENVIRONMENT_PASS_LINUX: SYMFORCE_VERSION @@ -121,7 +126,7 @@ jobs: - name: Upload Wheels uses: actions/upload-artifact@v7 with: - name: symforce-wheels-${{ matrix.os }}-${{ matrix.python-version }} + name: symforce-wheels-linux-${{ matrix.os.arch }}-${{ matrix.python-version }} path: wheelhouse/*.whl merge-wheel-artifacts: From 1a9e9770c375840a277a5fcd04416eb2c5a7f009 Mon Sep 17 00:00:00 2001 From: Jeff Daily Date: Thu, 20 Aug 2026 17:48:02 +0000 Subject: [PATCH 15/68] [ROCm] Harden SumStore's shared scratch buffer reuse contract SumStore's second stage has the first warp tile read inout_shared and reduce it into shared_tmp, and the function returns without a trailing __syncthreads(). The buffer is therefore not safe to reuse until the next block-wide barrier, and today that safety rests on non-local invariants of the call sites: SumStore and SumFlushFinal each open with a block-wide barrier, and every other store into the buffer is indexed by threadIdx.x scaled by the storing accessor's element stride, so nothing below element 32 is written by a thread outside the reading tile, whose own reads the shuffle collectives order ahead of any lane leaving the function. The trailing barrier replaces those implicit guarantees with a local one, at the cost of one barrier per call. Suggested by a user running this branch on gfx1151 / ROCm 7.2, where solver runs showed intermittent NaNs and run-to-run nondeterminism on the same binary, and adding this barrier made their determinism protocol pass 22/22 across fresh seeds and a larger synthetic problem. The precise interleaving behind their failure was not pinned down (their own revert-and-retest was inconclusive), so this change is offered on the strength of that empirical evidence and of the contract argument above, not a root-caused race. The barrier is not gated to HIP: the reuse contract is not platform-specific. Authored with assistance from Claude (Anthropic). Test Plan: Linux gfx1100 (Radeon Pro W7800, ROCm 7.2.1). A standalone harness compiles memops.cuh with hipcc and launches a 1024-thread kernel issuing four back-to-back SumStore calls against the same inout_shared buffer followed by SumFlushFinal, over a problem size that exercises the valid mask: ``` hipcc -x hip sumstore_test.cpp -I symforce/caspar/source/runtime --offload-arch=gfx1100 -o sumstore_test ./sumstore_test # all 4 sums exact, 20 reruns bit-identical ``` The pre-change code passes the same harness on this card (that call pattern is protected by SumStore's own leading barrier, and the gfx1151 failure does not reproduce here), so this is verified as a no-regression hardening. The changed header is not part of the prebuilt runtime library; it is compiled by the generated kernels, so the CUDA side is covered by compiling a representative translation unit with nvcc 12.8: ``` nvcc -arch=sm_75 -c nvcc_memops.cu -I symforce/caspar/source/runtime -o nvcc_memops.o # nvcc_memops.cu: includes memops.cuh and instantiates SumStore, SumFlushFinal, FlushSumBlock ``` Co-authored-by: bjoernellens1 <64093272+bjoernellens1@users.noreply.github.com> --- symforce/caspar/source/runtime/memops.cuh | 4 ++++ 1 file changed, 4 insertions(+) diff --git a/symforce/caspar/source/runtime/memops.cuh b/symforce/caspar/source/runtime/memops.cuh index dcdd31f6..63d89de0 100644 --- a/symforce/caspar/source/runtime/memops.cuh +++ b/symforce/caspar/source/runtime/memops.cuh @@ -406,6 +406,10 @@ __forceinline__ __device__ void SumStore(StorageT* const shared_tmp, StorageT* c shared_tmp[offset] = tot; } } + // The second-stage tile reads inout_shared above; without a trailing barrier the + // buffer is not safe to reuse until the next block-wide sync, which callers were + // implicitly relied on to provide. + __syncthreads(); } template From 5ddf38e9808d522a85e904ba2a5c80a0f4eaaea6 Mon Sep 17 00:00:00 2001 From: Aaron Date: Fri, 21 Aug 2026 17:07:37 +0000 Subject: [PATCH 16/68] [SymForce] IWYU for fixed_size_optimizer GitOrigin-RevId: 1db1ee491af31c1251ee3393f7693cfe6e651cc5 --- symforce/opt/fixed_size_optimizer.tcc | 1 + 1 file changed, 1 insertion(+) diff --git a/symforce/opt/fixed_size_optimizer.tcc b/symforce/opt/fixed_size_optimizer.tcc index 92aea97d..1c0b3ff2 100644 --- a/symforce/opt/fixed_size_optimizer.tcc +++ b/symforce/opt/fixed_size_optimizer.tcc @@ -7,6 +7,7 @@ #include "./assert.h" #include "./fixed_size_optimizer.h" +#include "./internal/optimizer_utils.h" namespace sym { From 658293082085486f564ca2c7244a778d6db8278f Mon Sep 17 00:00:00 2001 From: Zhewen Tan <1090179959@qq.com> Date: Wed, 26 Aug 2026 04:54:03 +0000 Subject: [PATCH 17/68] [SymForce-External] Fix Rust codegen matrix return types MIME-Version: 1.0 Content-Type: text/plain; charset=UTF-8 Content-Transfer-Encoding: 8bit Fix Rust codegen matrix return types ## Problem Rust codegen formats every matrix returned directly from a generated function as `nalgebra::SVector`. This loses the original two-dimensional shape. For example, a function returning `Matrix23` is currently generated with an `SVector` signature and constructor. The multi-output path already handles this correctly through `format_typename`, which selects `SVector` only when either matrix dimension is one and otherwise selects `SMatrix`. ## Approach Reuse the same shape-aware formatter in both places used by the single-return path: - the generated function return type; - the constructor used for the returned value. This keeps the single-return and multi-output paths consistent without duplicating their vector-versus-matrix condition. Scalar returns and vector-shaped matrices retain their existing behavior. ## Regression coverage The Rust codegen test now includes a non-square `2×3` matrix return. A non-square shape verifies both dimensions explicitly instead of checking only the flattened element count. Before this change, the generated code used: ```rust nalgebra::SVector ``` It now uses: ```rust nalgebra::SMatrix ``` The generated crate still includes the existing `3×1` return case, which remains an `SVector`. ## Validation - Rust codegen test with the SymEngine backend - Rust codegen test with the SymPy backend - Cargo build of both generated test-data crates - Ruff 0.9.10 lint and formatting checks - `git diff --check` Fixes symforce-org/symforce#439 Closes symforce-org/symforce#467 GitOrigin-RevId: cb6eedbe1d8f7e42c779e33d27056b77338c61bd --- .../backends/rust/templates/util/util.jinja | 5 ++-- .../symforce_rust_codegen_test/src/lib.rs | 1 + .../src/matrix_return_fun.rs | 28 +++++++++++++++++++ .../symforce_rust_codegen_test/src/lib.rs | 1 + .../src/matrix_return_fun.rs | 28 +++++++++++++++++++ test/symforce_rust_codegen_test.py | 11 ++++++++ 6 files changed, 71 insertions(+), 3 deletions(-) create mode 100644 test/symforce_function_codegen_test_data/symengine/symforce_rust_codegen_test/src/matrix_return_fun.rs create mode 100644 test/symforce_function_codegen_test_data/sympy/symforce_rust_codegen_test/src/matrix_return_fun.rs diff --git a/symforce/codegen/backends/rust/templates/util/util.jinja b/symforce/codegen/backends/rust/templates/util/util.jinja index a6ae4cbe..3bf34ba2 100644 --- a/symforce/codegen/backends/rust/templates/util/util.jinja +++ b/symforce/codegen/backends/rust/templates/util/util.jinja @@ -59,7 +59,7 @@ {% if is_symbolic(type) or T.__name__ == "float" %} {{ format_scalar(spec) }} {% elif issubclass(T, Matrix) %} - {{ format_vector(T, spec.return_key, spec) }} + {{ format_typename(spec.return_key, type, spec) }} {% else %} {{ raise("Unsupported return type: {}".format(T)) }} {% endif %} @@ -231,8 +231,7 @@ {% if is_symbolic(type) or T_return.__name__ == "float" %} {{ terms[0][1] }}; {% elif issubclass(T_return, Matrix) %} - {% set size = T_return.SHAPE[0] * T_return.SHAPE[1] %} - {{ format_vector(T_return, name, spec) }}::new( + {{ format_typename(name, type, spec) }}::new( {% for lhs, rhs in terms %} {{ rhs }}{% if not loop.last %},{% endif %} {% endfor %} diff --git a/test/symforce_function_codegen_test_data/symengine/symforce_rust_codegen_test/src/lib.rs b/test/symforce_function_codegen_test_data/symengine/symforce_rust_codegen_test/src/lib.rs index 149889d8..dc2d6522 100644 --- a/test/symforce_function_codegen_test_data/symengine/symforce_rust_codegen_test/src/lib.rs +++ b/test/symforce_function_codegen_test_data/symengine/symforce_rust_codegen_test/src/lib.rs @@ -1,4 +1,5 @@ mod backend_test_function_float32; mod backend_test_function_float64; +mod matrix_return_fun; mod vector_matrix_fun; diff --git a/test/symforce_function_codegen_test_data/symengine/symforce_rust_codegen_test/src/matrix_return_fun.rs b/test/symforce_function_codegen_test_data/symengine/symforce_rust_codegen_test/src/matrix_return_fun.rs new file mode 100644 index 00000000..3d34221a --- /dev/null +++ b/test/symforce_function_codegen_test_data/symengine/symforce_rust_codegen_test/src/matrix_return_fun.rs @@ -0,0 +1,28 @@ +// ----------------------------------------------------------------------------- +// This file was autogenerated by symforce from template: +// function/FUNCTION.rs.jinja +// Do NOT modify by hand. +// ----------------------------------------------------------------------------- + +pub mod sym { + + #[allow(unused_parens)] + + /// + /// This function was autogenerated from a symbolic function. Do not modify by hand. + /// + /// Symbolic function: matrix_return + /// + /// Outputs: + /// res: Matrix23 + + pub fn matrix_return_fun() -> nalgebra::SMatrix { + // Total ops: 0 + + // Intermediate terms (0) + + // Output terms (1) + + nalgebra::SMatrix::::new(1_f64, 4_f64, 2_f64, 5_f64, 3_f64, 6_f64) + } +} // mod sym diff --git a/test/symforce_function_codegen_test_data/sympy/symforce_rust_codegen_test/src/lib.rs b/test/symforce_function_codegen_test_data/sympy/symforce_rust_codegen_test/src/lib.rs index 149889d8..dc2d6522 100644 --- a/test/symforce_function_codegen_test_data/sympy/symforce_rust_codegen_test/src/lib.rs +++ b/test/symforce_function_codegen_test_data/sympy/symforce_rust_codegen_test/src/lib.rs @@ -1,4 +1,5 @@ mod backend_test_function_float32; mod backend_test_function_float64; +mod matrix_return_fun; mod vector_matrix_fun; diff --git a/test/symforce_function_codegen_test_data/sympy/symforce_rust_codegen_test/src/matrix_return_fun.rs b/test/symforce_function_codegen_test_data/sympy/symforce_rust_codegen_test/src/matrix_return_fun.rs new file mode 100644 index 00000000..3d34221a --- /dev/null +++ b/test/symforce_function_codegen_test_data/sympy/symforce_rust_codegen_test/src/matrix_return_fun.rs @@ -0,0 +1,28 @@ +// ----------------------------------------------------------------------------- +// This file was autogenerated by symforce from template: +// function/FUNCTION.rs.jinja +// Do NOT modify by hand. +// ----------------------------------------------------------------------------- + +pub mod sym { + + #[allow(unused_parens)] + + /// + /// This function was autogenerated from a symbolic function. Do not modify by hand. + /// + /// Symbolic function: matrix_return + /// + /// Outputs: + /// res: Matrix23 + + pub fn matrix_return_fun() -> nalgebra::SMatrix { + // Total ops: 0 + + // Intermediate terms (0) + + // Output terms (1) + + nalgebra::SMatrix::::new(1_f64, 4_f64, 2_f64, 5_f64, 3_f64, 6_f64) + } +} // mod sym diff --git a/test/symforce_rust_codegen_test.py b/test/symforce_rust_codegen_test.py index 543a05ea..2d49e6d3 100644 --- a/test/symforce_rust_codegen_test.py +++ b/test/symforce_rust_codegen_test.py @@ -55,6 +55,7 @@ def write_lib_rs(output_dir: Path) -> None: """ mod backend_test_function_float32; mod backend_test_function_float64; + mod matrix_return_fun; mod vector_matrix_fun; """ ) @@ -91,6 +92,9 @@ def test_codegen(self) -> None: def rust_func(vec3: sf.V3, mat33: sf.M33) -> sf.Matrix31: return sf.Matrix31(mat33 * vec3) + def matrix_return() -> sf.M23: + return sf.M23([[1, 2, 3], [4, 5, 6]]) + output_dir_base = self.make_output_dir("symforce_rust_codegen_test_") output_dir_src = output_dir_base / "src" @@ -103,6 +107,13 @@ def rust_func(vec3: sf.V3, mat33: sf.M33) -> sf.Matrix31: name="vector_matrix_fun", ).generate_function(output_dir_src, skip_directory_nesting=True) + # A non-square matrix distinguishes its row and column dimensions from a flattened vector. + Codegen.function( + matrix_return, + config=RustConfig(scalar_type=ScalarType.DOUBLE), + name="matrix_return_fun", + ).generate_function(output_dir_src, skip_directory_nesting=True) + # Generate the symbolic backend test function for scalar in scalars: Codegen.function( From 763e1bce736eb1f7e7d74b225da90efc2930a96d Mon Sep 17 00:00:00 2001 From: Aaron Date: Tue, 1 Sep 2026 02:34:47 +0000 Subject: [PATCH 18/68] [SymForce] Fix import cycle in camera_cal MIME-Version: 1.0 Content-Type: text/plain; charset=UTF-8 Content-Transfer-Encoding: 8bit Existing import cycle: ``` symforce.cam.__init__ → symforce.cam.atan_camera_cal → symforce.cam.camera_cal → symforce.util → symforce.codegen → symforce.codegen.codegen → symforce.symbolic → symforce.util.lambdify ← FAILS ``` Topic: sf-cycle Reviewers: ryan-br,ashley-m GitOrigin-RevId: fa2ab220246008a3b8157f631127fe3757f25318 --- symforce/cam/camera_cal.py | 6 +++++- 1 file changed, 5 insertions(+), 1 deletion(-) diff --git a/symforce/cam/camera_cal.py b/symforce/cam/camera_cal.py index d1843b83..39ffc48c 100644 --- a/symforce/cam/camera_cal.py +++ b/symforce/cam/camera_cal.py @@ -7,7 +7,6 @@ from symforce import geo from symforce import ops from symforce import typing as T -from symforce import util from symforce.ops.interfaces import Storage @@ -148,6 +147,11 @@ def has_camera_ray_from_pixel(cls) -> bool: Returns ``True`` if cls has implemented the method :meth:`camera_ray_from_pixel`, and ``False`` otherwise. """ + + # Imported locally, since this is outside the symforce core so otherwise creates an + # import cycle + from symforce import util + try: util.symbolic_eval(cls.camera_ray_from_pixel) except NotImplementedError: From 795c37c4c92058064999e9b5196dfb0346869667 Mon Sep 17 00:00:00 2001 From: Brian Kubisiak Date: Thu, 3 Sep 2026 16:18:26 +0000 Subject: [PATCH 19/68] [SymForce] Assign factor outputs through fixed-size Maps Assigning a fixed-size vector into a dynamically-sized one hides the destination size from Eigen, which then selects a linear vectorized assignment loop. When the result is shorter than one packet that loop body can emit a read past the end of the array that ends up discarded. Work around this by copying out through a fixed-size Map instead, following the idiom already used in JacobianFixedMap. This makes the destination size a compile-time constant, so Eigen never emits the vectorized path and the load disappears. Co-Authored-By: Claude Opus 5 Signed-off-by: Brian Kubisiak GitOrigin-RevId: afc3b23c93acd3f1d63cb52a204d96e7aa69df51 --- symforce/opt/internal/factor_utils.h | 11 +++++++++-- 1 file changed, 9 insertions(+), 2 deletions(-) diff --git a/symforce/opt/internal/factor_utils.h b/symforce/opt/internal/factor_utils.h index 341103b3..a0b8f1ff 100644 --- a/symforce/opt/internal/factor_utils.h +++ b/symforce/opt/internal/factor_utils.h @@ -142,7 +142,13 @@ void CalculateHessianRhs(const RVecType& residual, const JMatrixType& jacobian, // Compute RHS if needed if (rhs != nullptr) { - (*rhs) = jacobian.transpose() * residual; + constexpr int N = JMatrixType::ColsAtCompileTime; + if constexpr (N == Eigen::Dynamic) { + (*rhs) = jacobian.transpose() * residual; + } else { + rhs->resize(N); + Eigen::Map>{rhs->data()} = jacobian.transpose() * residual; + } } } @@ -223,7 +229,8 @@ auto JacobianFixed(Functor&& func) { SYM_ASSERT(rhs == nullptr); } - (*residual) = residual_fixed; + residual->resize(M); + Eigen::Map>{residual->data()} = residual_fixed; }; } From dc2f7a378636b52fcc5adf1a1684a8a4e5af7ee5 Mon Sep 17 00:00:00 2001 From: Aaron Date: Fri, 4 Sep 2026 22:27:06 +0000 Subject: [PATCH 20/68] [SkyMarshal] Support notations on struct members Notations (the `#name{prop = value}` syntax) could only be attached to a struct or an enum. Add a `notations` prefix to every member production so they can also be attached to an individual member, which lets a backend take per-member direction rather than only per-type direction. A notation declares which scopes it is valid in via `NotationSpec.allowed`, so add a "member" scope alongside "struct" and "enum". Notations written ahead of a multi-member declaration (`int64_t first, second;`) apply to every member the declaration introduces. Member notations are included in `__repr__` so that a type round-trips through the .lcm source that `--lcmout` emits. They are not part of the type hash, the same as struct and enum notations. Also initialize `Notation.properties` unconditionally. It was only assigned for known notations, so reading it on an unknown one (which is reachable via `--allow-unknown-notations`) raised AttributeError. Co-Authored-By: Claude Opus 5 GitOrigin-RevId: 8ac048972991ad2c9ca6dd00125f4e0ae21431c3 --- third_party/skymarshal/skymarshal/parser.py | 60 +++++++---- .../skymarshal/skymarshal/syntax_tree.py | 99 ++++++++++++------- 2 files changed, 107 insertions(+), 52 deletions(-) diff --git a/third_party/skymarshal/skymarshal/parser.py b/third_party/skymarshal/skymarshal/parser.py index 78f6de0f..38c402da 100644 --- a/third_party/skymarshal/skymarshal/parser.py +++ b/third_party/skymarshal/skymarshal/parser.py @@ -161,25 +161,39 @@ def p_members(p): # A type group is a list of one or more members that share the same type. # For example: int32_t foo, bar; +# Any notations preceding the group apply to every member it declares. def p_member_type_group(p): - """type_group : type member_names SEMICOLON""" + """type_group : notations type member_names SEMICOLON""" # Handle the definition of multiple members on a single line. - type_ref = p[1] - names = p[2] - comments = p[3] - p[0] = [syntax_tree.Member(type_ref=type_ref, name=name, comments=comments) for name in names] + notations = p[1] + type_ref = p[2] + names = p[3] + comments = p[4] + p[0] = [ + syntax_tree.Member(type_ref=type_ref, name=name, comments=comments, notations=notations) + for name in names + ] # A type group with id is one member. # For example: int32_t foo = 1; def p_member_with_id_type_group(p): - """type_group : type identifier EQUALS field_id SEMICOLON""" + """type_group : notations type identifier EQUALS field_id SEMICOLON""" # Handle the definition of multiple members on a single line. - type_ref = p[1] - name = p[2] - field_id = p[4] - comments = p[5] - p[0] = [syntax_tree.Member(type_ref=type_ref, name=name, field_id=field_id, comments=comments)] + notations = p[1] + type_ref = p[2] + name = p[3] + field_id = p[5] + comments = p[6] + p[0] = [ + syntax_tree.Member( + type_ref=type_ref, + name=name, + field_id=field_id, + comments=comments, + notations=notations, + ) + ] def p_member_reserved_group(p): @@ -227,11 +241,15 @@ def p_member_names(p): # Const member declarations are similar, but have assignments instead of just names def p_const_member_type_group(p): - """type_group : CONST type const_member_assignments SEMICOLON""" + """type_group : notations CONST type const_member_assignments SEMICOLON""" # Handle the definition of multiple const members on a single line. - type_ref = p[2] - assignments = p[3] - p[0] = [syntax_tree.ConstMember(type_ref, name, value) for name, value in assignments] + notations = p[1] + type_ref = p[3] + assignments = p[4] + p[0] = [ + syntax_tree.ConstMember(type_ref, name, value, notations=notations) + for name, value in assignments + ] # Assignments are comma-delimited and cannot be empty @@ -262,14 +280,18 @@ def p_const_string(p): # A single member can be an array with one or more dimensions. def p_array_member_type_group(p): - """type_group : type identifier array_dims SEMICOLON""" - p[0] = [syntax_tree.ArrayMember(type_ref=p[1], name=p[2], dims=p[3])] + """type_group : notations type identifier array_dims SEMICOLON""" + p[0] = [syntax_tree.ArrayMember(type_ref=p[2], name=p[3], dims=p[4], notations=p[1])] # allow members with ids (for protobuf) to have a single dimension (e.g. repeated) def p_array_member_with_id_type_group(p): - """type_group : type identifier array_dim EQUALS field_id SEMICOLON""" - p[0] = [syntax_tree.ArrayMember(type_ref=p[1], name=p[2], dims=[p[3]], field_id=p[5])] + """type_group : notations type identifier array_dim EQUALS field_id SEMICOLON""" + p[0] = [ + syntax_tree.ArrayMember( + type_ref=p[2], name=p[3], dims=[p[4]], field_id=p[6], notations=p[1] + ) + ] # A non-empty list of dimensions diff --git a/third_party/skymarshal/skymarshal/syntax_tree.py b/third_party/skymarshal/skymarshal/syntax_tree.py index 9852756c..ff6fddc9 100644 --- a/third_party/skymarshal/skymarshal/syntax_tree.py +++ b/third_party/skymarshal/skymarshal/syntax_tree.py @@ -211,6 +211,8 @@ def __init__(self, name: str, properties: T.Dict[str, str], lineno: int) -> None self.name = name self.raw_properties = properties self.lineno = lineno + # Unknown notations keep their raw properties unparsed, so this stays empty for them. + self.properties: T.Dict[str, T.Union[None, str, bool]] = {} self.spec = None try: @@ -279,11 +281,32 @@ def allowed_on_enum(self) -> bool: def allowed_on_struct(self) -> bool: return self.spec is None or "struct" in self.spec.allowed + def allowed_on_member(self) -> bool: + return self.spec is None or "member" in self.spec.allowed + def __repr__(self) -> str: properties = ", ".join(f"{key} = {value}" for key, value in self.raw_properties.items()) return f"{self.name} {{ {properties} }}\n" +def find_notation(notations: T.Sequence[Notation], name: str) -> T.Optional[Notation]: + """Return the first notation with the given name, else None.""" + for notation in notations: + if notation.name == name: + return notation + return None + + +def find_notation_property( + notations: T.Sequence[Notation], name: str, prop_name: str +) -> T.Union[None, str, bool]: + """Return the given property of the first notation with the given name, else None.""" + notation = find_notation(notations, name) + if notation is None: + return None + return notation.properties.get(prop_name) + + class Enum(AstNode): """A description of an lcm enum type""" @@ -371,20 +394,10 @@ def full_name(self) -> str: return self.type_ref.full_name def get_notation(self, name: str) -> T.Optional[Notation]: - # get the first notation with the given name, else None - for notation in self.notations: - if notation.name == name: - return notation - return None + return find_notation(self.notations, name) def get_notation_property(self, name: str, prop_name: str) -> T.Union[None, str, bool]: - notation = self.get_notation(name) - if notation is None: - return None - prop_value = notation.properties.get(prop_name) - if prop_value is None: - return None - return prop_value + return find_notation_property(self.notations, name, prop_name) def case_for_int_value(self, int_value: int) -> EnumCase: for case in self.cases: @@ -488,8 +501,10 @@ def __repr__(self) -> str: reserved: T.List[AstNode] = ( [ReservedFieldGroup(self.reserved_ids)] if self.reserved_ids else [] ) + # Members may render onto several lines (a member with notations), so indent line-by-line. children = "\n".join( - " " + repr(member) for member in reserved + T.cast(T.List[AstNode], self.members) + "\n".join(" " + line for line in repr(member).splitlines()) + for member in reserved + T.cast(T.List[AstNode], self.members) ) return f"{notations}struct {self.name} {{\n{children}\n}};" @@ -502,20 +517,10 @@ def full_name(self) -> str: return self.type_ref.full_name def get_notation(self, name: str) -> T.Optional[Notation]: - # get the first notation with the given name, else None - for notation in self.notations: - if notation.name == name: - return notation - return None + return find_notation(self.notations, name) def get_notation_property(self, name: str, prop_name: str) -> T.Union[None, str, bool]: - notation = self.get_notation(name) - if notation is None: - return None - prop_value = notation.properties.get(prop_name) - if prop_value is None: - return None - return prop_value + return find_notation_property(self.notations, name, prop_name) def add_package_name(self, package_name: str) -> None: self.type_ref.add_package_name(package_name) @@ -530,6 +535,15 @@ def reference_check(self) -> None: if disallowed_notations: raise ValueError(f"Invalid notations {disallowed_notations} on a struct ({self.name})") + for member in self.members: + disallowed_notations = [x.name for x in member.notations if not x.allowed_on_member()] + if disallowed_notations: + raise ValueError( + "Invalid notations {} on a member ({}.{})".format( + disallowed_notations, self.name, member.name + ) + ) + has_protobuf_notation = bool(self.get_notation("#protobuf")) # NOTE(jeff): Validate field IDs even if the struct isn't protobuf @@ -670,21 +684,33 @@ def __init__( name: str, field_id: T.Optional[int] = None, comments: T.Optional[T.List[str]] = None, + notations: T.Sequence[Notation] = (), ) -> None: super().__init__() self.name = name self.type_ref = type_ref self.field_id = field_id self.comments = comments or [] + self.notations = list(notations) @property def ndim(self) -> int: return 0 + def get_notation(self, name: str) -> T.Optional[Notation]: + return find_notation(self.notations, name) + + def get_notation_property(self, name: str, prop_name: str) -> T.Union[None, str, bool]: + return find_notation_property(self.notations, name, prop_name) + + def notations_repr(self) -> str: + """Render this member's notations as a prefix for __repr__, one per line.""" + return "".join(repr(notation) for notation in self.notations) + def __repr__(self) -> str: if self.field_id is None: - return f"{self.type_ref} {self.name};" - return f"{self.type_ref} {self.name} = {self.field_id};" + return f"{self.notations_repr()}{self.type_ref} {self.name};" + return f"{self.notations_repr()}{self.type_ref} {self.name} = {self.field_id};" def compute_hash(self, type_hash: Hash) -> None: self.compute_hash_prefix_for_auto_members(type_hash) @@ -927,8 +953,9 @@ def __init__( name: str, dims: T.Sequence[ArrayDim], field_id: T.Optional[int] = None, + notations: T.Sequence[Notation] = (), ) -> None: - super().__init__(type_ref, name, field_id=field_id) + super().__init__(type_ref, name, field_id=field_id, notations=notations) self.dims = dims def compute_hash_prefix_for_auto_members(self, type_hash: Hash) -> None: @@ -946,8 +973,8 @@ def compute_hash_for_dimensions(self, type_hash: Hash) -> None: def __repr__(self) -> str: dims_str = "".join(repr(dim) for dim in self.dims) if self.field_id is None: - return f"{self.type_ref} {self.name}{dims_str};" - return f"{self.type_ref} {self.name}{dims_str} = {self.field_id};" + return f"{self.notations_repr()}{self.type_ref} {self.name}{dims_str};" + return f"{self.notations_repr()}{self.type_ref} {self.name}{dims_str} = {self.field_id};" def is_constant_size(self) -> bool: return not any(dim.dynamic for dim in self.dims) @@ -964,8 +991,14 @@ def ndim(self) -> int: class ConstMember(Member): """An attribute whose value is bound to the type itself, not encoded in a message""" - def __init__(self, type_ref: TypeRef, name: str, value_str: str) -> None: - super().__init__(type_ref, name) + def __init__( + self, + type_ref: TypeRef, + name: str, + value_str: str, + notations: T.Sequence[Notation] = (), + ) -> None: + super().__init__(type_ref, name, notations=notations) if not type_ref.is_const_type(): raise TypeError( "Constant '{}' from line {} must be one of {}. '{}' found.".format( @@ -980,4 +1013,4 @@ def __init__(self, type_ref: TypeRef, name: str, value_str: str) -> None: self.value_str = value_str def __repr__(self) -> str: - return f"const {self.type_ref} {self.name} = {self.value_str};" + return f"{self.notations_repr()}const {self.type_ref} {self.name} = {self.value_str};" From 94f24522b9da30a97a7e4281066a9fcf989927d1 Mon Sep 17 00:00:00 2001 From: Aaron Date: Sat, 5 Sep 2026 22:16:13 +0000 Subject: [PATCH 21/68] [SkyMarshal] Add an #inline_capacity notation for noalloc targets Add a member notation that stores a dynamically-sized array inline, with room for a fixed number of elements, instead of in a std::vector. Embedded targets must not allocate, and some go further and overlay an LCM type directly on a hardware payload buffer, which needs the array to be a plain inline one at a fixed offset. The encoded form is a normal dynamically-sized array, and the capacity is not part of the type hash, so it is a bound on local storage only and two builds may disagree about it without disagreeing about the type. We use a std::array of that capacity plus a bounds check on both encode and decode, a message longer than the capacity fails to decode. The length is cast to size_t first, so a negative length in a signed length member is also rejected. Only supports C++ for now. The other backends ignore the notation and keep their existing containers, which is fine because nothing about the wire format changes. Rust is the other one that would benefit from this. It is only valid on a one-dimensional array whose length lives in a member of the same struct (`items[num_items]`), because that member stores the length. An automatic length (`items[uint8_t]`) is derived from the container's own size, which doesn't work for a fixed-size container. Co-Authored-By: Claude Opus 5 GitOrigin-RevId: 626a0d9ef8550be6f24c3ef3202c482242f74d55 --- third_party/skymarshal/skymarshal/emit_cpp.py | 56 ++++++-- .../skymarshal/skymarshal/syntax_tree.py | 124 +++++++++++++++++- 2 files changed, 165 insertions(+), 15 deletions(-) diff --git a/third_party/skymarshal/skymarshal/emit_cpp.py b/third_party/skymarshal/skymarshal/emit_cpp.py index 26edbe8e..9526e9a3 100644 --- a/third_party/skymarshal/skymarshal/emit_cpp.py +++ b/third_party/skymarshal/skymarshal/emit_cpp.py @@ -33,6 +33,13 @@ def get_array_type(member, mapped_typename): + inline_capacity = member.get_inline_capacity() + if inline_capacity is not None: + # The array is dynamically sized on the wire but stored inline, with only the first + # `` elements meaningful. Struct.inline_capacity_check has already + # restricted this to a single dimension. + return f"std::array< {mapped_typename}, {inline_capacity} >" + parts = [] for i in range(len(member.dims)): if i == len(member.dims) - 1: @@ -224,6 +231,10 @@ def include_list(self): includes.add(CppInclude(std="limits")) if member.is_constant_size(): includes.add(CppInclude(std="array")) + elif member.get_inline_capacity() is not None: + includes.add(CppInclude(std="array")) + # The generated capacity checks compare against std::size_t. + includes.add(CppInclude(std="cstddef")) elif member.type_ref.name == "boolean": includes.add(CppInclude(std="string")) if member.ndim > 1: @@ -389,10 +400,29 @@ def encode_members(self): self.encode_member(code, member) return code.getvalue().rstrip() + def check_inline_capacity(self, code, member, dim, inline_capacity, indent=1): + """Emit a guard that fails if an #inline_capacity array's length exceeds its storage. + + The length is cast to std::size_t so that a negative one (the length member may be a + signed type) is rejected by the same comparison rather than sneaking under the bound. + """ + code( + indent, + "if(static_cast(%s) > %d) return -1;", + dim_size_access(dim), + inline_capacity, + ) + def encode_member(self, code, member, virtual=False): if isinstance(member, ArrayMember): last_dim = member.dims[-1] + inline_capacity = member.get_inline_capacity() + if inline_capacity is not None: + # Only the first `` elements are stored, so a length past the + # capacity has nothing behind it to encode. Refuse rather than read past the end. + self.check_inline_capacity(code, member, last_dim, inline_capacity) + if last_dim.auto_member: # If the inner-most dimension of the array is dynamic size and based on a primitive # type, check that the size of the array to encode can be represented by this type's @@ -521,10 +551,15 @@ def decode_recursive(self, code, member, depth): decode_indent = 1 + depth if not member.is_constant_size(): - code.start(1 + depth, "this->%s", member.name) - for i in range(depth): - code.add("[a%d]", i) - code.end(".resize(%s);", dim_size_access(dim)) + inline_capacity = member.get_inline_capacity() + if inline_capacity is not None: + # Inline storage cannot grow, so a longer message is rejected, not truncated. + self.check_inline_capacity(code, member, dim, inline_capacity, 1 + depth) + else: + code.start(1 + depth, "this->%s", member.name) + for i in range(depth): + code.add("[a%d]", i) + code.end(".resize(%s);", dim_size_access(dim)) code(1 + depth, "if(%s) {", dim_size_access(dim)) @@ -570,10 +605,15 @@ def decode_recursive(self, code, member, depth): else: dim = member.dims[depth] if not member.is_constant_size(): - code.start(1 + depth, "this->%s", member.name) - for i in range(depth): - code.add("[a%d]", i) - code.end(".resize(%s);", dim_size_access(dim)) + inline_capacity = member.get_inline_capacity() + if inline_capacity is not None: + # Inline storage cannot grow, so a longer message is rejected, not truncated. + self.check_inline_capacity(code, member, dim, inline_capacity, 1 + depth) + else: + code.start(1 + depth, "this->%s", member.name) + for i in range(depth): + code.add("[a%d]", i) + code.end(".resize(%s);", dim_size_access(dim)) code( 1 + depth, diff --git a/third_party/skymarshal/skymarshal/syntax_tree.py b/third_party/skymarshal/skymarshal/syntax_tree.py index ff6fddc9..f087bd27 100644 --- a/third_party/skymarshal/skymarshal/syntax_tree.py +++ b/third_party/skymarshal/skymarshal/syntax_tree.py @@ -16,6 +16,18 @@ "uint64_t", ) PROTOBUF_INTEGER_TYPES = ("sfixed32", "ufixed32", "sfixed64", "ufixed64") +# The largest value each integer type holds, which bounds the length an array declared with it +# can carry. +INTEGER_TYPE_MAX = { + "int8_t": 2**7 - 1, + "int16_t": 2**15 - 1, + "int32_t": 2**31 - 1, + "int64_t": 2**63 - 1, + "uint8_t": 2**8 - 1, + "uint16_t": 2**16 - 1, + "uint32_t": 2**32 - 1, + "uint64_t": 2**64 - 1, +} FLOAT_TYPES = ("float", "double") NUMERIC_TYPES = INTEGER_TYPES + PROTOBUF_INTEGER_TYPES + FLOAT_TYPES @@ -134,6 +146,9 @@ def __repr__(self) -> str: NotationSpec = T.NamedTuple( "NotationSpec", [("allowed", T.Set[str]), ("properties", T.List[NotationSpecProperty])] ) +NotationPropertyValue = T.Union[None, str, bool, int] + +INLINE_CAPACITY_NOTATION = "#inline_capacity" class Notation(AstNode): @@ -197,6 +212,28 @@ class Notation(AstNode): "#cpp_display_everywhere": NotationSpec(allowed={"struct"}, properties=[]), "#cpp_no_display": NotationSpec(allowed={"struct"}, properties=[]), "#cpp_no_print_helpers": NotationSpec(allowed={"struct"}, properties=[]), + # Store a dynamically-sized array inline, with room for `capacity` elements, instead of in + # a heap-allocated container. This is for embedded targets, where a message must not + # allocate and its size must be known at compile time. + # + # The encoded form is unchanged: still a length followed by that many elements, and still + # the same type hash. `capacity` is a bound on the local storage only, so it can differ + # between builds without making them disagree about the type. Decoding a message whose + # length exceeds `capacity` fails rather than overruns, and so does encoding one. + # + # Only valid on a one-dimensional array whose length is a member of the same struct + # (`meas[num_meas]`), because that member is what carries the length; a fixed-size + # container cannot carry it the way a resizable one does. `capacity` must fit in that + # member's type, since storage past what it can count to is unreachable. + "#inline_capacity": NotationSpec( + allowed={"member"}, + properties=[ + NotationSpecProperty( + name="capacity", + type="int", + ), + ], + ), } # If allow_unknown_notations is true, then any notation that doesn't match a NOTATION_SPECS @@ -212,7 +249,7 @@ def __init__(self, name: str, properties: T.Dict[str, str], lineno: int) -> None self.raw_properties = properties self.lineno = lineno # Unknown notations keep their raw properties unparsed, so this stays empty for them. - self.properties: T.Dict[str, T.Union[None, str, bool]] = {} + self.properties: T.Dict[str, NotationPropertyValue] = {} self.spec = None try: @@ -248,11 +285,22 @@ def __init__(self, name: str, properties: T.Dict[str, str], lineno: int) -> None for prop, value in self.raw_properties.items() } - def parse_property(self, prop_name: str, raw_value: str) -> T.Union[None, str, bool]: + def parse_property(self, prop_name: str, raw_value: str) -> T.Union[None, str, bool, int]: if self.spec is None: return None [prop_spec] = [spec for spec in self.spec.properties if spec.name == prop_name] - if prop_spec.type == "string": + if prop_spec.type == "int": + try: + return int(raw_value, base=0) + except ValueError: + raise KeyError( + "Expected an integer for notation {} {}: {}".format( + self.name, + prop_name, + raw_value, + ) + ) + elif prop_spec.type == "string": if '"' not in raw_value: raise KeyError( "Expected a string for notation {} {}: {}".format( @@ -299,7 +347,7 @@ def find_notation(notations: T.Sequence[Notation], name: str) -> T.Optional[Nota def find_notation_property( notations: T.Sequence[Notation], name: str, prop_name: str -) -> T.Union[None, str, bool]: +) -> NotationPropertyValue: """Return the given property of the first notation with the given name, else None.""" notation = find_notation(notations, name) if notation is None: @@ -396,7 +444,7 @@ def full_name(self) -> str: def get_notation(self, name: str) -> T.Optional[Notation]: return find_notation(self.notations, name) - def get_notation_property(self, name: str, prop_name: str) -> T.Union[None, str, bool]: + def get_notation_property(self, name: str, prop_name: str) -> NotationPropertyValue: return find_notation_property(self.notations, name, prop_name) def case_for_int_value(self, int_value: int) -> EnumCase: @@ -519,7 +567,7 @@ def full_name(self) -> str: def get_notation(self, name: str) -> T.Optional[Notation]: return find_notation(self.notations, name) - def get_notation_property(self, name: str, prop_name: str) -> T.Union[None, str, bool]: + def get_notation_property(self, name: str, prop_name: str) -> NotationPropertyValue: return find_notation_property(self.notations, name, prop_name) def add_package_name(self, package_name: str) -> None: @@ -527,6 +575,55 @@ def add_package_name(self, package_name: str) -> None: for member in self.members: member.add_package_name(package_name) + def inline_capacity_check(self, member: Member) -> None: + """Check that an #inline_capacity notation on the given member is one we can generate. + + Must run after the member's dimensions have been resolved by its own reference_check. + """ + notation = member.get_notation(INLINE_CAPACITY_NOTATION) + if notation is None: + return + + where = f"{self.name}.{member.name}" + capacity = notation.properties.get("capacity") + if not isinstance(capacity, int): + raise ValueError(f"{INLINE_CAPACITY_NOTATION} on {where} needs a capacity") + if capacity < 1: + raise ValueError( + f"{INLINE_CAPACITY_NOTATION} capacity on {where} must be positive, got {capacity}" + ) + + if not isinstance(member, ArrayMember) or member.ndim != 1: + raise TypeError( + f"{INLINE_CAPACITY_NOTATION} on {where} is only valid on a 1-dimensional array" + ) + + [dim] = member.dims + if not dim.dynamic: + raise TypeError( + "{} on {} is only valid on a dynamically-sized array; {} is already " + "stored inline".format(INLINE_CAPACITY_NOTATION, where, dim) + ) + if dim.auto_member is not None: + raise TypeError( + "{} on {} needs its length in a member of {} (as in `{}[num_{}]`); an " + "automatic length is carried by the container, which a fixed-size one cannot " + "do".format( + INLINE_CAPACITY_NOTATION, where, self.name, member.name, member.name + ) + ) + + assert dim.size_str is not None + length_type = self.member_map[dim.size_str].type_ref.name + length_max = INTEGER_TYPE_MAX[length_type] + if capacity > length_max: + raise ValueError( + "{} capacity on {} is {}, which {} cannot count to ({} at most); the storage " + "past that could never be filled".format( + INLINE_CAPACITY_NOTATION, where, capacity, length_type, length_max + ) + ) + def reference_check(self) -> None: for member in self.members: member.reference_check(self) @@ -543,6 +640,7 @@ def reference_check(self) -> None: disallowed_notations, self.name, member.name ) ) + self.inline_capacity_check(member) has_protobuf_notation = bool(self.get_notation("#protobuf")) @@ -700,9 +798,21 @@ def ndim(self) -> int: def get_notation(self, name: str) -> T.Optional[Notation]: return find_notation(self.notations, name) - def get_notation_property(self, name: str, prop_name: str) -> T.Union[None, str, bool]: + def get_notation_property(self, name: str, prop_name: str) -> NotationPropertyValue: return find_notation_property(self.notations, name, prop_name) + def get_inline_capacity(self) -> T.Optional[int]: + """Return the #inline_capacity of this member, or None if it is not annotated with one. + + Struct.reference_check has already rejected an #inline_capacity that is malformed or on a + member that cannot have one, so a non-None result here is usable as-is. + """ + capacity = self.get_notation_property(INLINE_CAPACITY_NOTATION, "capacity") + if capacity is None: + return None + assert isinstance(capacity, int) + return capacity + def notations_repr(self) -> str: """Render this member's notations as a prefix for __repr__, one per line.""" return "".join(repr(notation) for notation in self.notations) From 7e362c4e5171f8bb77036f9258dfde8edf7db72f Mon Sep 17 00:00:00 2001 From: Aaron Date: Thu, 10 Sep 2026 01:45:11 +0000 Subject: [PATCH 22/68] [SymForce] Python Pose Graph Optimization Example GitOrigin-RevId: 517ff7b1231a64857a9dd3a734c1076f47014a8c --- pyproject.toml | 1 + requirements/dev_py310.txt | 2 + requirements/dev_py311.txt | 2 + requirements/dev_py312.txt | 2 + requirements/dev_py313.txt | 2 + requirements/dev_py314.txt | 2 + setup.py | 1 + .../parking-garage.g2o | 7936 +++++++++++++++++ .../examples/pose_graph_optimization/pgo.py | 89 + .../pose_graph_optimization/pgo_dataset.py | 62 + 10 files changed, 8099 insertions(+) create mode 100644 symforce/examples/pose_graph_optimization/parking-garage.g2o create mode 100644 symforce/examples/pose_graph_optimization/pgo.py create mode 100644 symforce/examples/pose_graph_optimization/pgo_dataset.py diff --git a/pyproject.toml b/pyproject.toml index a027a53a..43d4b498 100644 --- a/pyproject.toml +++ b/pyproject.toml @@ -70,6 +70,7 @@ module = [ "graphviz.*", "mpl_toolkits.*", "numba.*", + "plotly.*", "ruff.*", "scipy.*", "setuptools_scm.*", diff --git a/requirements/dev_py310.txt b/requirements/dev_py310.txt index 71ebb661..a17f1900 100644 --- a/requirements/dev_py310.txt +++ b/requirements/dev_py310.txt @@ -325,6 +325,8 @@ types-requests==2.32.4.20260107 # via symforce (pyproject.toml) types-setuptools==83.0.0.20260724 # via symforce (pyproject.toml) +types-tqdm==4.70.0.20260906 + # via symforce (pyproject.toml) typing-extensions==4.15.0 # via # beautifulsoup4 diff --git a/requirements/dev_py311.txt b/requirements/dev_py311.txt index 6b644715..88d8666e 100644 --- a/requirements/dev_py311.txt +++ b/requirements/dev_py311.txt @@ -321,6 +321,8 @@ types-requests==2.32.4.20260107 # via symforce (pyproject.toml) types-setuptools==83.0.0.20260724 # via symforce (pyproject.toml) +types-tqdm==4.70.0.20260906 + # via symforce (pyproject.toml) typing-extensions==4.15.0 # via # beautifulsoup4 diff --git a/requirements/dev_py312.txt b/requirements/dev_py312.txt index 84a43c9e..496763f0 100644 --- a/requirements/dev_py312.txt +++ b/requirements/dev_py312.txt @@ -321,6 +321,8 @@ types-requests==2.32.4.20260107 # via symforce (pyproject.toml) types-setuptools==83.0.0.20260724 # via symforce (pyproject.toml) +types-tqdm==4.70.0.20260906 + # via symforce (pyproject.toml) typing-extensions==4.15.0 # via # beautifulsoup4 diff --git a/requirements/dev_py313.txt b/requirements/dev_py313.txt index c398aad5..e4160208 100644 --- a/requirements/dev_py313.txt +++ b/requirements/dev_py313.txt @@ -321,6 +321,8 @@ types-requests==2.32.4.20260107 # via symforce (pyproject.toml) types-setuptools==83.0.0.20260724 # via symforce (pyproject.toml) +types-tqdm==4.70.0.20260906 + # via symforce (pyproject.toml) typing-extensions==4.15.0 # via # beautifulsoup4 diff --git a/requirements/dev_py314.txt b/requirements/dev_py314.txt index ad1b02a3..0039d361 100644 --- a/requirements/dev_py314.txt +++ b/requirements/dev_py314.txt @@ -323,6 +323,8 @@ types-requests==2.32.4.20260107 # via symforce (pyproject.toml) types-setuptools==83.0.0.20260724 # via symforce (pyproject.toml) +types-tqdm==4.70.0.20260906 + # via symforce (pyproject.toml) typing-extensions==4.15.0 # via # beautifulsoup4 diff --git a/setup.py b/setup.py index 2ea059f8..6d293237 100644 --- a/setup.py +++ b/setup.py @@ -435,6 +435,7 @@ def fixed_readme() -> str: "types-jinja2", "types-requests", "types-setuptools", + "types-tqdm", "sortedcontainers-stubs", # Oldest version that solves to the right requirements "uv>=0.2.0", diff --git a/symforce/examples/pose_graph_optimization/parking-garage.g2o b/symforce/examples/pose_graph_optimization/parking-garage.g2o new file mode 100644 index 00000000..2d1ad6ae --- /dev/null +++ b/symforce/examples/pose_graph_optimization/parking-garage.g2o @@ -0,0 +1,7936 @@ +VERTEX_SE3:QUAT 0 0 0 0 0 0 0 1 +VERTEX_SE3:QUAT 1 4.15448 -0.0665288 0.000389663 -0.0107791 0.00867285 -0.00190021 0.999902 +VERTEX_SE3:QUAT 2 8.31419 -0.173106 -0.0129024 -0.00802114 0.00792915 0.00172397 0.999935 +VERTEX_SE3:QUAT 3 12.6035 -0.1837 -0.0848858 -0.0103926 -0.00786875 0.0167457 0.999775 +VERTEX_SE3:QUAT 4 16.8016 -0.108137 -0.0601645 -0.00253999 0.00220233 0.0263555 0.999647 +VERTEX_SE3:QUAT 5 20.9607 0.0310604 -0.085476 -0.00864918 0.00189323 0.0207459 0.999746 +VERTEX_SE3:QUAT 6 25.492 0.0946081 -0.127169 -0.00444317 0.00936269 0.0151893 0.999831 +VERTEX_SE3:QUAT 7 29.583 0.104272 -0.194878 -0.00678458 0.0141998 0.012983 0.999792 +VERTEX_SE3:QUAT 8 34.0787 0.183728 -0.292361 -0.00473159 0.012228 0.0359905 0.999266 +VERTEX_SE3:QUAT 9 38.3977 0.671044 -0.378781 0.00383224 0.015159 0.122622 0.99233 +VERTEX_SE3:QUAT 10 42.3092 2.15489 -0.498543 0.00476216 0.0111507 0.256225 0.966541 +VERTEX_SE3:QUAT 11 45.7973 4.69776 -0.562561 0.00773828 0.0131353 0.38897 0.921124 +VERTEX_SE3:QUAT 12 48.3255 7.94648 -0.59199 0.00696949 0.0142966 0.499312 0.866276 +VERTEX_SE3:QUAT 13 50.2886 11.8218 -0.632211 0.0043765 0.0112782 0.54974 0.835248 +VERTEX_SE3:QUAT 14 51.8675 15.5579 -0.667529 0.000729013 0.00688092 0.570668 0.821151 +VERTEX_SE3:QUAT 15 53.1556 19.3964 -0.692883 -0.00569501 0.00803061 0.665472 0.746358 +VERTEX_SE3:QUAT 16 52.7629 23.7089 -0.695487 0.0152856 -0.00941798 0.826816 0.562186 +VERTEX_SE3:QUAT 17 50.7512 27.1768 -0.58678 0.0114423 -0.000551325 0.911879 0.410299 +VERTEX_SE3:QUAT 18 47.6926 30.0891 -0.522667 0.0109823 0.0107887 0.951396 0.307587 +VERTEX_SE3:QUAT 19 44.1188 32.5473 -0.4667 0.014009 0.0129989 0.962618 0.270187 +VERTEX_SE3:QUAT 20 40.5032 34.8185 -0.401651 0.0102884 0.0141354 0.966145 0.257407 +VERTEX_SE3:QUAT 21 36.5187 37.1607 -0.351521 0.0173424 0.0145557 0.968713 0.24715 +VERTEX_SE3:QUAT 22 32.9935 39.1494 -0.25859 0.0103804 0.0133977 0.971343 0.237075 +VERTEX_SE3:QUAT 23 29.2275 41.1294 -0.197772 0.00953295 0.0100552 0.975212 0.22084 +VERTEX_SE3:QUAT 24 25.0731 43.1332 -0.141528 0.00790445 0.0110768 0.978983 0.203488 +VERTEX_SE3:QUAT 25 21.0176 44.953 -0.0935092 0.00932127 0.0147984 0.982128 0.187399 +VERTEX_SE3:QUAT 26 16.6157 46.7425 -0.0417203 0.00851879 0.014545 0.984656 0.173693 +VERTEX_SE3:QUAT 27 12.0661 48.4451 -0.00604308 0.00638403 0.0137028 0.987019 0.159889 +VERTEX_SE3:QUAT 28 8.18542 49.7695 0.0198388 0.00612157 0.0135343 0.989454 0.144083 +VERTEX_SE3:QUAT 29 3.38409 51.1985 0.0664245 0.00250893 0.0102753 0.99204 0.125475 +VERTEX_SE3:QUAT 30 -1.40165 52.4516 0.08575 0.00172901 0.0104949 0.994094 0.107998 +VERTEX_SE3:QUAT 31 -6.02002 53.5102 0.115937 -0.0013129 0.00970546 0.995421 0.0950891 +VERTEX_SE3:QUAT 32 -10.8048 54.4903 0.119075 -0.00223305 0.00860771 0.996458 0.083615 +VERTEX_SE3:QUAT 33 -15.4279 55.3133 0.108045 -0.00462889 0.0101332 0.997553 0.0690242 +VERTEX_SE3:QUAT 34 -19.9421 55.9821 0.0799549 -0.0069323 0.00883312 0.998445 0.0546082 +VERTEX_SE3:QUAT 35 -24.4127 56.5277 0.0423674 -0.0102622 0.011144 0.999082 0.0400608 +VERTEX_SE3:QUAT 36 -28.6809 56.9149 -0.0267491 -0.0091308 0.0154043 0.999537 0.0245942 +VERTEX_SE3:QUAT 37 -32.9258 57.1556 -0.0699266 -0.0140077 0.0137335 0.999771 0.00859193 +VERTEX_SE3:QUAT 38 -37.6373 57.2362 -0.174829 0.0137233 -0.0130339 -0.999768 0.0102952 +VERTEX_SE3:QUAT 39 -41.8811 57.1655 -0.257988 0.0134501 -0.00823151 -0.999472 0.0284052 +VERTEX_SE3:QUAT 40 -46.3383 56.9468 -0.302992 0.0204619 -0.0159739 -0.998544 0.0472943 +VERTEX_SE3:QUAT 41 -50.4695 56.5769 -0.416389 0.0168569 -0.00841387 -0.99827 0.0556947 +VERTEX_SE3:QUAT 42 -54.5723 56.2303 -0.503581 0.0130324 -0.00959519 -0.999449 0.0289813 +VERTEX_SE3:QUAT 43 -58.697 56.6393 -0.615463 -0.0165263 0.00625994 0.990446 0.136763 +VERTEX_SE3:QUAT 44 -62.1924 58.589 -0.752286 0.0146379 -0.0224801 0.916802 0.398441 +VERTEX_SE3:QUAT 45 -64.4811 62.1685 -0.65459 -0.0279199 -0.00866771 0.85095 0.524433 +VERTEX_SE3:QUAT 46 -66.1343 66.0818 -0.803284 -0.0258185 -0.01178 0.825164 0.56418 +VERTEX_SE3:QUAT 47 -67.5001 70.2838 -0.917276 -0.0381335 -0.00936819 0.797617 0.601884 +VERTEX_SE3:QUAT 48 -68.296 74.2712 -1.09623 -0.0109762 -0.0143128 0.764646 0.644198 +VERTEX_SE3:QUAT 49 -68.7272 78.4764 -1.03921 0.0113477 -0.0309399 0.722979 0.690083 +VERTEX_SE3:QUAT 50 -68.5322 82.5585 -0.786977 -0.00440359 -0.0158666 0.667894 0.744074 +VERTEX_SE3:QUAT 51 -67.7019 86.7579 -0.744158 -0.0205182 0.00629109 0.609358 0.792605 +VERTEX_SE3:QUAT 52 -65.9614 90.8068 -0.885501 -0.026198 0.00648246 0.497865 0.866835 +VERTEX_SE3:QUAT 53 -63.4285 93.9861 -1.01015 -0.0210627 0.00420054 0.409642 0.911994 +VERTEX_SE3:QUAT 54 -60.4434 97.0429 -1.10769 -0.0196075 0.00390829 0.397571 0.917353 +VERTEX_SE3:QUAT 55 -57.4025 100.256 -1.20542 -0.0202644 0.00657573 0.411151 0.911318 +VERTEX_SE3:QUAT 56 -54.4827 103.553 -1.32324 -0.0237554 0.0107997 0.42489 0.904869 +VERTEX_SE3:QUAT 57 -51.5074 107.037 -1.48355 -0.0231383 0.00556226 0.430637 0.902211 +VERTEX_SE3:QUAT 58 -48.5159 110.604 -1.60957 -0.0233103 0.00701009 0.435326 0.899944 +VERTEX_SE3:QUAT 59 -45.5001 114.31 -1.74902 -0.0264172 0.0107518 0.4409 0.897103 +VERTEX_SE3:QUAT 60 -43.0202 117.443 -1.89113 -0.0275313 0.00912821 0.44735 0.893888 +VERTEX_SE3:QUAT 61 -40.1961 121.13 -2.0759 -0.027614 0.00993353 0.45433 0.89035 +VERTEX_SE3:QUAT 62 -37.4557 124.821 -2.23314 -0.0287122 0.00358654 0.456979 0.889006 +VERTEX_SE3:QUAT 63 -34.7926 128.408 -2.33965 -0.0322415 -0.00349108 0.453797 0.890515 +VERTEX_SE3:QUAT 64 -32.1758 131.863 -2.42104 -0.0318441 -0.00321769 0.4533 0.890783 +VERTEX_SE3:QUAT 65 -29.4443 135.492 -2.49634 -0.0301384 -0.00532763 0.457259 0.888807 +VERTEX_SE3:QUAT 66 -26.6444 139.299 -2.5616 -0.0286911 -0.00605697 0.463264 0.885735 +VERTEX_SE3:QUAT 67 -23.9487 143.05 -2.62279 -0.0272281 -0.00502947 0.468827 0.882856 +VERTEX_SE3:QUAT 68 -21.3376 146.82 -2.66819 -0.0289382 -0.0021809 0.47224 0.880992 +VERTEX_SE3:QUAT 69 -18.967 150.133 -2.72183 -0.0274464 -0.0030461 0.46395 0.885431 +VERTEX_SE3:QUAT 70 -16.496 153.632 -2.76175 -0.0254295 -0.00424499 0.476921 0.878568 +VERTEX_SE3:QUAT 71 -14.1679 157.394 -2.80447 -0.0286443 -0.00247772 0.521832 0.852563 +VERTEX_SE3:QUAT 72 -12.5067 161.428 -2.90257 -0.0271616 0.000268473 0.630113 0.776029 +VERTEX_SE3:QUAT 73 -12.3262 165.517 -3.04827 -0.0258699 0.00127879 0.774721 0.631772 +VERTEX_SE3:QUAT 74 -13.9103 169.495 -3.25136 -0.00422411 0.00365848 0.886175 0.463318 +VERTEX_SE3:QUAT 75 -16.7649 172.642 -3.24582 0.00336106 -0.00230208 0.946996 0.32122 +VERTEX_SE3:QUAT 76 -20.1102 174.949 -3.25494 -0.0250569 0.0079305 0.955028 0.295347 +VERTEX_SE3:QUAT 77 -23.1495 177.748 -3.42866 -0.0119619 -0.00475952 0.874964 0.484017 +VERTEX_SE3:QUAT 78 -24.1324 181.917 -3.47574 -0.00891812 -0.00713501 0.666444 0.745468 +VERTEX_SE3:QUAT 79 -22.5078 185.816 -3.47603 -0.00883906 -0.000232176 0.480294 0.877063 +VERTEX_SE3:QUAT 80 -19.9725 189.153 -3.52048 -0.0123589 0.00511947 0.44244 0.896698 +VERTEX_SE3:QUAT 81 -17.4747 192.276 -3.60298 -0.0120193 0.00396639 0.444151 0.895863 +VERTEX_SE3:QUAT 82 -14.9016 195.565 -3.66846 -0.0132396 0.00512804 0.452097 0.891856 +VERTEX_SE3:QUAT 83 -12.3912 198.93 -3.74116 -0.0156516 0.00472438 0.465972 0.884648 +VERTEX_SE3:QUAT 84 -10.071 202.321 -3.8032 -0.010869 0.000742341 0.505667 0.86266 +VERTEX_SE3:QUAT 85 -8.41644 206.35 -3.85198 -0.00627692 0.0016562 0.645389 0.763827 +VERTEX_SE3:QUAT 86 -8.45973 210.504 -3.88686 -0.00143735 0.00267593 0.79715 0.603773 +VERTEX_SE3:QUAT 87 -10.3896 214.291 -3.91336 0.00394626 0.00490025 0.911321 0.411649 +VERTEX_SE3:QUAT 88 -13.5319 217.022 -3.8801 -0.0108555 0.00471677 0.956871 0.290272 +VERTEX_SE3:QUAT 89 -16.8909 219.226 -3.98083 -0.0168841 0.00199999 0.961225 0.27524 +VERTEX_SE3:QUAT 90 -20.4208 221.659 -4.09885 -0.00790936 -0.00372158 0.952692 0.303812 +VERTEX_SE3:QUAT 91 -23.9123 224.396 -4.16463 -0.0100075 -0.00471122 0.945419 0.325669 +VERTEX_SE3:QUAT 92 -27.0288 226.99 -4.22063 -0.00726548 -0.0025421 0.944752 0.327694 +VERTEX_SE3:QUAT 93 -30.2705 229.652 -4.26338 -0.00608671 0.00314674 0.946696 0.322056 +VERTEX_SE3:QUAT 94 -33.5794 232.275 -4.30339 -0.00213429 0.00507433 0.949817 0.312759 +VERTEX_SE3:QUAT 95 -37.1049 234.912 -4.34462 -0.0170837 0.00809097 0.952534 0.303846 +VERTEX_SE3:QUAT 96 -40.6973 237.518 -4.49741 -0.0138288 0.00315334 0.954258 0.298646 +VERTEX_SE3:QUAT 97 -44.2724 240.093 -4.60382 -0.0121723 -0.000810103 0.954907 0.296655 +VERTEX_SE3:QUAT 98 -47.7257 242.573 -4.68974 -0.0128673 0.00199956 0.955569 0.29448 +VERTEX_SE3:QUAT 99 -51.2488 245.065 -4.79173 -0.0148089 0.0010673 0.956105 0.292648 +VERTEX_SE3:QUAT 100 -54.8727 247.632 -4.8901 -0.012357 0.00289244 0.956426 0.291698 +VERTEX_SE3:QUAT 101 -58.1529 249.927 -4.97533 -0.0034692 0.00611114 0.960487 0.278238 +VERTEX_SE3:QUAT 102 -61.7831 252.211 -5.01199 -0.00668511 0.0137645 0.972411 0.232773 +VERTEX_SE3:QUAT 103 -65.8392 253.87 -5.11772 -0.0160298 0.0174911 0.993654 0.109947 +VERTEX_SE3:QUAT 104 -69.9843 254.282 -5.24382 0.0109974 -0.0222989 -0.998703 0.0444403 +VERTEX_SE3:QUAT 105 -74.0811 253.334 -5.29096 0.0101445 -0.0193043 -0.97622 0.215685 +VERTEX_SE3:QUAT 106 -77.5121 251.091 -5.27009 0.00191451 -0.0145526 -0.921525 0.388042 +VERTEX_SE3:QUAT 107 -79.9138 247.678 -5.20017 -0.010501 -0.0150777 -0.80515 0.592787 +VERTEX_SE3:QUAT 108 -80.2268 243.488 -5.07164 -0.0115699 -0.0201824 -0.617303 0.786381 +VERTEX_SE3:QUAT 109 -78.4499 239.783 -4.90246 -0.0136509 -0.0158706 -0.427863 0.903601 +VERTEX_SE3:QUAT 110 -75.4115 236.793 -4.74221 -0.0126031 -0.00704097 -0.330569 0.943672 +VERTEX_SE3:QUAT 111 -71.9578 234.173 -4.66155 -0.0107702 -0.000374284 -0.294698 0.95553 +VERTEX_SE3:QUAT 112 -68.4241 231.728 -4.61583 -0.0166058 -0.000965339 -0.285736 0.958164 +VERTEX_SE3:QUAT 113 -64.605 229.135 -4.54928 -0.0168387 -0.00260308 -0.285706 0.958166 +VERTEX_SE3:QUAT 114 -61.258 226.84 -4.47897 -0.0190801 -0.00208575 -0.284813 0.958391 +VERTEX_SE3:QUAT 115 -57.8552 224.518 -4.40056 -0.0187653 -0.00294656 -0.283979 0.958642 +VERTEX_SE3:QUAT 116 -54.3409 222.086 -4.316 -0.0152045 -0.0101628 -0.285533 0.958195 +VERTEX_SE3:QUAT 117 -50.9682 219.773 -4.19892 -0.0145334 -0.0117568 -0.288268 0.957367 +VERTEX_SE3:QUAT 118 -47.522 217.372 -4.04825 -0.01133 0.00346051 -0.293088 0.956012 +VERTEX_SE3:QUAT 119 -44.2829 215.023 -4.02095 -0.00971294 0.00245782 -0.297009 0.954822 +VERTEX_SE3:QUAT 120 -40.6047 212.36 -3.99391 -0.0117863 0.00176211 -0.301247 0.953472 +VERTEX_SE3:QUAT 121 -37.0394 209.767 -3.94575 -0.0137655 0.00259781 -0.296927 0.954797 +VERTEX_SE3:QUAT 122 -33.4781 207.243 -3.88665 -0.015532 0.0028137 -0.290919 0.956618 +VERTEX_SE3:QUAT 123 -30.2042 204.92 -3.82684 -0.0124417 -0.0077438 -0.294287 0.955605 +VERTEX_SE3:QUAT 124 -26.6948 202.426 -3.69169 -0.012044 0.00115269 -0.304745 0.952357 +VERTEX_SE3:QUAT 125 -23.488 199.83 -3.67892 -0.00607349 0.00852672 -0.376268 0.926452 +VERTEX_SE3:QUAT 126 -21.0818 196.525 -3.67946 -0.0155107 0.00378113 -0.551471 0.834041 +VERTEX_SE3:QUAT 127 -20.5861 192.444 -3.61179 -0.0121058 -0.00146646 -0.758643 0.651393 +VERTEX_SE3:QUAT 128 -22.089 188.772 -3.53042 -0.00222958 -0.00136624 -0.870572 0.492034 +VERTEX_SE3:QUAT 129 -24.4163 185.572 -3.51903 0.00136286 -0.000463919 -0.893282 0.449495 +VERTEX_SE3:QUAT 130 -27.0415 182.121 -3.53094 0.000774692 0.00092351 -0.888574 0.458731 +VERTEX_SE3:QUAT 131 -29.4917 178.733 -3.52909 0.00154934 0.00087476 -0.88194 0.471359 +VERTEX_SE3:QUAT 132 -31.9096 175.212 -3.53025 -0.00231499 0.00504141 -0.883084 0.469183 +VERTEX_SE3:QUAT 133 -34.4282 171.704 -3.51132 -0.00968568 0.00343198 -0.885845 0.463868 +VERTEX_SE3:QUAT 134 -36.8986 168.294 -3.45241 -0.00717746 0.00321283 -0.884269 0.466912 +VERTEX_SE3:QUAT 135 -39.22 164.997 -3.39504 -0.00673386 0.00079725 -0.879625 0.475619 +VERTEX_SE3:QUAT 136 -41.53 161.568 -3.31911 -0.00634488 0.00225234 -0.877513 0.479506 +VERTEX_SE3:QUAT 137 -43.8947 158.223 -3.24528 0.000790195 0.00605002 -0.901481 0.432776 +VERTEX_SE3:QUAT 138 -47.0151 155.4 -3.2619 0.00176783 0.0101839 -0.963701 0.266782 +VERTEX_SE3:QUAT 139 -50.8444 154.126 -3.28768 0.000796335 0.0098962 -0.998304 0.0573654 +VERTEX_SE3:QUAT 140 -54.8101 154.506 -3.29043 0.0038855 -0.00432496 0.992679 0.120641 +VERTEX_SE3:QUAT 141 -58.8562 156.15 -3.2755 -0.0144903 0.00412316 0.973816 0.226839 +VERTEX_SE3:QUAT 142 -62.6291 158.334 -3.40115 -0.00942207 -0.00293608 0.963542 0.267376 +VERTEX_SE3:QUAT 143 -66.026 160.56 -3.46323 -0.0051245 -0.0027199 0.959627 0.281215 +VERTEX_SE3:QUAT 144 -69.5087 162.943 -3.49323 -0.00629217 -0.00121993 0.958533 0.284911 +VERTEX_SE3:QUAT 145 -73.0695 165.402 -3.52665 -0.00519625 -0.000463387 0.957358 0.288857 +VERTEX_SE3:QUAT 146 -76.649 167.919 -3.54768 -0.00340316 -0.000857405 0.95615 0.292857 +VERTEX_SE3:QUAT 147 -80.2874 170.501 -3.56919 -0.013005 -0.000101738 0.954913 0.296601 +VERTEX_SE3:QUAT 148 -83.5071 172.838 -3.67763 -0.0162914 0.000840188 0.954048 0.299211 +VERTEX_SE3:QUAT 149 -86.7675 175.222 -3.80167 -0.014214 -0.00178179 0.953322 0.301615 +VERTEX_SE3:QUAT 150 -90.4239 177.916 -3.9022 -0.0132517 -0.00464099 0.952595 0.303916 +VERTEX_SE3:QUAT 151 -93.9287 180.535 -3.96975 -0.0124698 -0.00477474 0.952002 0.305802 +VERTEX_SE3:QUAT 152 -97.2781 183.059 -4.02368 -0.0128138 -0.00379862 0.951413 0.307628 +VERTEX_SE3:QUAT 153 -100.787 185.74 -4.09511 -0.00703268 -0.0017022 0.950921 0.30935 +VERTEX_SE3:QUAT 154 -103.96 188.169 -4.12863 -0.00750698 3.99585e-05 0.951889 0.30635 +VERTEX_SE3:QUAT 155 -107.251 190.547 -4.15702 -0.0156176 0.00488469 0.96392 0.265689 +VERTEX_SE3:QUAT 156 -111.251 192.434 -4.29438 -0.0135294 0.00747559 0.992778 0.118968 +VERTEX_SE3:QUAT 157 -115.634 192.697 -4.39958 0.0138806 -0.00651553 -0.995579 0.0926645 +VERTEX_SE3:QUAT 158 -119.643 191.024 -4.49176 0.00889019 -0.00752277 -0.943086 0.332344 +VERTEX_SE3:QUAT 159 -122.263 187.898 -4.50572 -0.000840366 -0.0143776 -0.840708 0.541297 +VERTEX_SE3:QUAT 160 -123.241 183.538 -4.41255 -0.00225582 -0.0162299 -0.697961 0.715949 +VERTEX_SE3:QUAT 161 -122.548 179.478 -4.29159 -0.00257457 -0.0161194 -0.560333 0.828107 +VERTEX_SE3:QUAT 162 -120.453 175.68 -4.1556 -0.00117696 -0.0166255 -0.432096 0.901673 +VERTEX_SE3:QUAT 163 -117.543 172.696 -4.05378 -0.00464653 0.00320998 -0.334237 0.942472 +VERTEX_SE3:QUAT 164 -114.047 170.175 -4.06139 -0.00795477 -0.00170589 -0.271047 0.962532 +VERTEX_SE3:QUAT 165 -110.18 167.832 -4.01391 -0.0158251 -0.00126643 -0.266818 0.963616 +VERTEX_SE3:QUAT 166 -106.804 165.648 -3.95794 -0.0147733 -0.0017687 -0.277995 0.960467 +VERTEX_SE3:QUAT 167 -103.414 163.368 -3.89876 -0.014712 -0.00317733 -0.286751 0.957887 +VERTEX_SE3:QUAT 168 -99.8911 160.878 -3.82619 -0.0119812 -0.00690802 -0.296448 0.954949 +VERTEX_SE3:QUAT 169 -96.5223 158.397 -3.72903 -0.0102731 -0.0119824 -0.304768 0.952296 +VERTEX_SE3:QUAT 170 -93.1141 155.818 -3.59843 -0.00562824 -0.00649869 -0.30951 0.950857 +VERTEX_SE3:QUAT 171 -89.6036 153.123 -3.55053 -0.00320585 0.00315508 -0.3135 0.949578 +VERTEX_SE3:QUAT 172 -86.1994 150.469 -3.55534 -0.00811179 -0.000989241 -0.315714 0.948819 +VERTEX_SE3:QUAT 173 -82.763 147.791 -3.5123 -0.010082 0.000448162 -0.315709 0.948802 +VERTEX_SE3:QUAT 174 -79.3905 145.169 -3.47164 -0.0084676 -0.00238944 -0.312817 0.949773 +VERTEX_SE3:QUAT 175 -76.2311 142.726 -3.40596 -0.00843155 -0.00375543 -0.305699 0.952084 +VERTEX_SE3:QUAT 176 -72.6411 140.24 -3.3332 -0.0039988 -0.0107507 -0.247125 0.968916 +VERTEX_SE3:QUAT 177 -68.6898 138.467 -3.23437 0.00178026 0.00582779 -0.137289 0.990512 +VERTEX_SE3:QUAT 178 -64.6546 137.746 -3.27629 0.00127301 0.00738299 -0.0121681 0.999898 +VERTEX_SE3:QUAT 179 -60.4782 138.112 -3.30141 -0.00540142 0.00986943 0.131329 0.991275 +VERTEX_SE3:QUAT 180 -56.513 139.755 -3.35838 -0.010854 0.00786478 0.282968 0.959036 +VERTEX_SE3:QUAT 181 -53.2538 142.476 -3.41515 -0.00353902 -0.00336298 0.418026 0.908422 +VERTEX_SE3:QUAT 182 -50.7008 145.643 -3.40973 -0.00607777 -0.00675618 0.451436 0.892257 +VERTEX_SE3:QUAT 183 -48.229 149.002 -3.39862 -0.00730646 -0.00791235 0.465992 0.884723 +VERTEX_SE3:QUAT 184 -45.8601 152.311 -3.37023 -0.00502182 -0.0061661 0.468647 0.88335 +VERTEX_SE3:QUAT 185 -43.3405 155.834 -3.35117 -0.00669463 0.00135544 0.466469 0.884511 +VERTEX_SE3:QUAT 186 -40.7464 159.447 -3.40475 -0.0107275 0.00572488 0.465199 0.885123 +VERTEX_SE3:QUAT 187 -38.3528 162.779 -3.45663 -0.0116647 0.00602881 0.465965 0.884706 +VERTEX_SE3:QUAT 188 -36.0222 166.033 -3.51646 -0.0134377 0.00419882 0.465429 0.884973 +VERTEX_SE3:QUAT 189 -33.6572 169.32 -3.5704 -0.016997 0.00144684 0.467142 0.884018 +VERTEX_SE3:QUAT 190 -31.3927 172.651 -3.62906 -0.00748574 -0.00172375 0.521531 0.853198 +VERTEX_SE3:QUAT 191 -30.0732 176.456 -3.64457 -0.0014274 -0.000584052 0.678765 0.734354 +VERTEX_SE3:QUAT 192 -30.4439 180.482 -3.64562 0.0075713 0.00182446 0.821594 0.57002 +VERTEX_SE3:QUAT 193 -32.5021 184.038 -3.61159 0.021272 -0.00225944 0.912095 0.40942 +VERTEX_SE3:QUAT 194 -35.5851 186.907 -3.45121 0.0276237 -0.00482214 0.947264 0.319224 +VERTEX_SE3:QUAT 195 -38.9232 189.371 -3.21868 0.0245382 -0.00545567 0.956183 0.291688 +VERTEX_SE3:QUAT 196 -42.5069 191.854 -3.01768 0.0183065 -0.00595601 0.957101 0.289116 +VERTEX_SE3:QUAT 197 -45.8217 194.175 -2.87015 0.0213133 -0.00813503 0.956735 0.290064 +VERTEX_SE3:QUAT 198 -49.126 196.49 -2.69944 0.0195546 -0.00519822 0.956386 0.291404 +VERTEX_SE3:QUAT 199 -52.5463 198.905 -2.54234 0.0189023 -0.00503398 0.956064 0.292503 +VERTEX_SE3:QUAT 200 -55.9683 201.332 -2.37272 0.0158584 -0.00246026 0.955872 0.293346 +VERTEX_SE3:QUAT 201 -59.3284 203.726 -2.231 0.0162726 -0.00350237 0.955902 0.293212 +VERTEX_SE3:QUAT 202 -62.8661 206.236 -2.08723 0.0150405 -0.00455584 0.955991 0.292976 +VERTEX_SE3:QUAT 203 -66.2254 208.618 -1.94954 0.0155375 -0.00423644 0.956149 0.292436 +VERTEX_SE3:QUAT 204 -69.6298 211.024 -1.82385 0.0162858 -0.00492319 0.956272 0.291985 +VERTEX_SE3:QUAT 205 -72.9462 213.366 -1.68464 0.0126701 -0.00280612 0.956729 0.29069 +VERTEX_SE3:QUAT 206 -76.5482 215.866 -1.55217 0.00839272 -0.00193617 0.958218 0.28591 +VERTEX_SE3:QUAT 207 -79.9192 218.171 -1.43189 0.0104497 -0.00315769 0.958993 0.28322 +VERTEX_SE3:QUAT 208 -83.3153 220.526 -1.3178 0.00525217 -0.00282429 0.952892 0.303251 +VERTEX_SE3:QUAT 209 -86.4937 223.159 -1.31735 -0.0223349 0.00216524 0.924099 0.381494 +VERTEX_SE3:QUAT 210 -88.8434 226.755 -1.47678 -0.0198565 -0.00659218 0.817838 0.575069 +VERTEX_SE3:QUAT 211 -89.1615 231.131 -1.56114 -0.0232086 -0.00909532 0.630768 0.775571 +VERTEX_SE3:QUAT 212 -87.2401 234.783 -1.59971 -0.0253907 -0.000547221 0.399134 0.916541 +VERTEX_SE3:QUAT 213 -83.5074 237.005 -1.63577 -0.028624 -0.00557841 0.133427 0.990629 +VERTEX_SE3:QUAT 214 -79.4533 237.083 -1.57615 -0.0226586 -0.00972441 -0.0905223 0.995589 +VERTEX_SE3:QUAT 215 -75.7156 235.683 -1.44611 -0.0149372 -0.00120313 -0.23134 0.972757 +VERTEX_SE3:QUAT 216 -72.0419 233.391 -1.40248 -0.0147687 -0.00134466 -0.283001 0.959005 +VERTEX_SE3:QUAT 217 -68.7178 231.118 -1.37498 -0.0178846 -0.00223177 -0.287573 0.957589 +VERTEX_SE3:QUAT 218 -65.2279 228.722 -1.29986 -0.019195 0.0031241 -0.288132 0.957393 +VERTEX_SE3:QUAT 219 -61.6272 226.239 -1.23426 -0.0219675 -0.00149379 -0.287098 0.957648 +VERTEX_SE3:QUAT 220 -58.1403 223.845 -1.12914 -0.0208749 -0.00648291 -0.284529 0.958418 +VERTEX_SE3:QUAT 221 -54.7011 221.505 -1.02107 -0.0167358 -0.00939016 -0.281598 0.95934 +VERTEX_SE3:QUAT 222 -51.2855 219.212 -0.913239 -0.0129203 -0.00496769 -0.279206 0.960131 +VERTEX_SE3:QUAT 223 -47.8331 216.927 -0.816558 -0.0108771 0.00131374 -0.278159 0.960473 +VERTEX_SE3:QUAT 224 -44.4381 214.678 -0.773734 -0.0127681 -0.000842809 -0.280386 0.959802 +VERTEX_SE3:QUAT 225 -41.061 212.4 -0.730286 -0.0149504 -0.000555164 -0.284862 0.958452 +VERTEX_SE3:QUAT 226 -37.3497 209.808 -0.702365 -0.0151318 0.0018775 -0.297884 0.95448 +VERTEX_SE3:QUAT 227 -33.9863 207.275 -0.644008 -0.0162417 -0.000985789 -0.31896 0.947629 +VERTEX_SE3:QUAT 228 -30.8388 204.674 -0.545538 -0.0120813 -0.00255568 -0.32901 0.944246 +VERTEX_SE3:QUAT 229 -27.4239 201.951 -0.448651 -0.0109535 -0.00489582 -0.29569 0.955208 +VERTEX_SE3:QUAT 230 -23.8571 199.798 -0.409134 -0.00373855 0.00780037 -0.188748 0.981987 +VERTEX_SE3:QUAT 231 -19.8057 198.855 -0.450833 -0.00801832 0.00220013 0.00052786 0.999965 +VERTEX_SE3:QUAT 232 -15.5078 199.674 -0.467518 -0.0101789 0.00160587 0.217309 0.976049 +VERTEX_SE3:QUAT 233 -12.0588 202.079 -0.506696 -0.00894458 0.00287972 0.415084 0.909734 +VERTEX_SE3:QUAT 234 -9.91111 205.652 -0.56549 -0.0110094 0.00658454 0.591339 0.806321 +VERTEX_SE3:QUAT 235 -9.33017 209.776 -0.657457 -0.00801897 0.00639855 0.74213 0.670177 +VERTEX_SE3:QUAT 236 -10.511 213.95 -0.730298 0.00180983 0.00719391 0.864484 0.502605 +VERTEX_SE3:QUAT 237 -12.9549 217.12 -0.731431 -0.00204757 0.00691021 0.929956 0.367599 +VERTEX_SE3:QUAT 238 -16.0219 219.671 -0.793236 -0.00861311 0.00568285 0.952341 0.304861 +VERTEX_SE3:QUAT 239 -19.4705 222.112 -0.872778 -0.00901563 0.00244311 0.958117 0.286226 +VERTEX_SE3:QUAT 240 -23.0225 224.495 -0.929456 -0.0091914 0.00365691 0.960155 0.279292 +VERTEX_SE3:QUAT 241 -26.6164 226.874 -0.977938 -0.00461352 0.00269295 0.960952 0.276662 +VERTEX_SE3:QUAT 242 -30.1847 229.218 -1.02526 -0.00393817 0.00261061 0.961096 0.276173 +VERTEX_SE3:QUAT 243 -33.7902 231.609 -1.07037 -0.00610727 0.00478332 0.960202 0.279198 +VERTEX_SE3:QUAT 244 -37.4527 234.052 -1.12997 -0.0137632 0.00451387 0.959298 0.282023 +VERTEX_SE3:QUAT 245 -41.0609 236.502 -1.22464 -0.0152824 0.00605835 0.958721 0.283873 +VERTEX_SE3:QUAT 246 -44.7592 239.014 -1.33971 -0.0149851 0.00291115 0.958245 0.285539 +VERTEX_SE3:QUAT 247 -48.4226 241.529 -1.47595 -0.0106779 0.000358044 0.958114 0.286188 +VERTEX_SE3:QUAT 248 -52.0051 244.004 -1.55522 -0.00523362 -0.000740366 0.957212 0.289339 +VERTEX_SE3:QUAT 249 -55.5327 246.498 -1.58439 -0.0116254 0.00151921 0.955799 0.293788 +VERTEX_SE3:QUAT 250 -58.8847 248.909 -1.63346 -0.00851421 0.00446153 0.954502 0.298049 +VERTEX_SE3:QUAT 251 -62.2993 251.41 -1.68494 -0.00879328 0.0103286 0.95572 0.293964 +VERTEX_SE3:QUAT 252 -65.7184 253.592 -1.79781 -0.0141136 0.0134651 0.975753 0.218002 +VERTEX_SE3:QUAT 253 -69.8613 254.852 -1.90959 -0.0065485 0.0141542 0.999505 0.0273365 +VERTEX_SE3:QUAT 254 -74.02 254.362 -1.92825 0.00405176 -0.0147377 -0.982407 0.186129 +VERTEX_SE3:QUAT 255 -77.5828 252.139 -1.9045 0.00284858 -0.0117782 -0.919576 0.392726 +VERTEX_SE3:QUAT 256 -80.1407 248.717 -1.87401 -0.00114597 -0.0112374 -0.870628 0.491813 +VERTEX_SE3:QUAT 257 -82.2833 245.261 -1.81084 -0.00190227 -0.0121079 -0.86885 0.494923 +VERTEX_SE3:QUAT 258 -84.6469 241.549 -1.74302 -0.00264287 -0.0127994 -0.875713 0.482655 +VERTEX_SE3:QUAT 259 -87.1495 237.908 -1.67107 -0.00235194 -0.0133228 -0.884181 0.466948 +VERTEX_SE3:QUAT 260 -89.6268 234.553 -1.58837 0.0054306 -0.00805555 -0.891879 0.452169 +VERTEX_SE3:QUAT 261 -92.3941 231.073 -1.59157 0.00637307 -0.00858937 -0.897249 0.441395 +VERTEX_SE3:QUAT 262 -95.2082 227.637 -1.5914 0.00692326 -0.013075 -0.897875 0.440002 +VERTEX_SE3:QUAT 263 -97.9998 224.157 -1.57773 0.00508448 -0.0109858 -0.895869 0.444153 +VERTEX_SE3:QUAT 264 -100.664 220.768 -1.56076 0.00476992 -0.00849139 -0.893318 0.449319 +VERTEX_SE3:QUAT 265 -103.262 217.383 -1.55225 0.00441904 -0.0112357 -0.88888 0.457982 +VERTEX_SE3:QUAT 266 -105.814 213.911 -1.52719 0.0050204 -0.0131925 -0.88405 0.467179 +VERTEX_SE3:QUAT 267 -108.178 210.534 -1.49373 0.00304647 -0.0140946 -0.880697 0.473461 +VERTEX_SE3:QUAT 268 -110.555 207.083 -1.45604 -0.000806168 -0.0123655 -0.882199 0.470713 +VERTEX_SE3:QUAT 269 -113.009 203.649 -1.41762 0.0125926 -0.0083731 -0.883976 0.467287 +VERTEX_SE3:QUAT 270 -115.48 200.22 -1.45946 0.0102859 -0.0106614 -0.885665 0.464088 +VERTEX_SE3:QUAT 271 -117.877 196.963 -1.47672 0.0100075 -0.0122758 -0.886858 0.461771 +VERTEX_SE3:QUAT 272 -120.268 193.714 -1.4889 0.00926023 -0.010665 -0.88649 0.462532 +VERTEX_SE3:QUAT 273 -122.604 190.264 -1.49902 0.00674216 -0.00973665 -0.858835 0.512115 +VERTEX_SE3:QUAT 274 -124.174 186.442 -1.49013 0.00460767 -0.00992867 -0.772303 0.63516 +VERTEX_SE3:QUAT 275 -124.343 182.355 -1.45049 0.002777 -0.00827768 -0.643008 0.76581 +VERTEX_SE3:QUAT 276 -123 178.366 -1.38658 -0.00153118 -0.0169061 -0.489117 0.872053 +VERTEX_SE3:QUAT 277 -120.312 175.104 -1.24223 -0.00255562 -0.0143801 -0.348286 0.937274 +VERTEX_SE3:QUAT 278 -116.985 172.608 -1.15928 -0.0043563 -0.00330257 -0.282639 0.959211 +VERTEX_SE3:QUAT 279 -113.365 170.269 -1.11402 -0.00676367 0.0015949 -0.274239 0.961636 +VERTEX_SE3:QUAT 280 -109.669 167.837 -1.07101 -0.00860721 0.00201947 -0.283218 0.959015 +VERTEX_SE3:QUAT 281 -106.109 165.401 -1.0405 -0.0121348 -0.00281737 -0.287729 0.957631 +VERTEX_SE3:QUAT 282 -102.501 162.899 -0.967546 -0.0132257 -0.0104426 -0.289242 0.957108 +VERTEX_SE3:QUAT 283 -98.9408 160.4 -0.862978 -0.00809862 -0.0101059 -0.29061 0.956754 +VERTEX_SE3:QUAT 284 -95.4907 157.988 -0.747718 -0.0071577 -0.00428318 -0.2921 0.956351 +VERTEX_SE3:QUAT 285 -92.0099 155.52 -0.657838 -0.0036756 0.00101556 -0.293651 0.955905 +VERTEX_SE3:QUAT 286 -88.5607 153.041 -0.638587 -0.00318449 -0.00117279 -0.294555 0.955628 +VERTEX_SE3:QUAT 287 -85.0695 150.544 -0.63411 -0.00487 -0.00173229 -0.299782 0.953994 +VERTEX_SE3:QUAT 288 -81.4506 147.857 -0.602482 -0.00687371 0.00247983 -0.309567 0.95085 +VERTEX_SE3:QUAT 289 -78.0319 145.193 -0.554719 -0.00613922 0.000127919 -0.318008 0.948068 +VERTEX_SE3:QUAT 290 -74.8021 142.615 -0.489678 -0.00487353 -0.00481037 -0.317868 0.94811 +VERTEX_SE3:QUAT 291 -71.6171 140.2 -0.418602 -0.00215846 -0.00655171 -0.281595 0.959509 +VERTEX_SE3:QUAT 292 -67.8272 138.073 -0.402977 0.00110829 0.00293807 -0.189032 0.981966 +VERTEX_SE3:QUAT 293 -63.6344 136.876 -0.413043 -0.000583075 0.00204655 -0.0515556 0.998668 +VERTEX_SE3:QUAT 294 -59.5628 137.004 -0.394216 0.000876034 -0.000792344 0.117111 0.993118 +VERTEX_SE3:QUAT 295 -55.5981 138.588 -0.386019 -0.000284222 -0.0018938 0.295598 0.955311 +VERTEX_SE3:QUAT 296 -52.3934 141.441 -0.389358 0.00165513 0.00219694 0.454749 0.890616 +VERTEX_SE3:QUAT 297 -50.6301 145.174 -0.390843 0.000636154 0.00194286 0.653312 0.757086 +VERTEX_SE3:QUAT 298 -50.957 149.339 -0.398855 -0.00314475 0.000774484 0.82745 0.561531 +VERTEX_SE3:QUAT 299 -53.2109 152.678 -0.402812 0.000914761 -0.00202164 0.933791 0.357811 +VERTEX_SE3:QUAT 300 -56.6036 155.114 -0.379597 -0.00132204 -0.00239398 0.967221 0.253923 +VERTEX_SE3:QUAT 301 -60.1607 157.091 -0.434154 -0.0121647 -0.00427911 0.970355 0.241338 +VERTEX_SE3:QUAT 302 -64.0067 159.32 -0.531837 -0.0114584 -0.0044858 0.96632 0.257051 +VERTEX_SE3:QUAT 303 -67.4745 161.471 -0.592926 -0.00839556 -0.00603192 0.962252 0.271965 +VERTEX_SE3:QUAT 304 -70.9814 163.81 -0.606555 -0.00400812 -0.00450877 0.958624 0.284612 +VERTEX_SE3:QUAT 305 -74.4402 166.198 -0.632554 -0.00217684 -0.00595926 0.957762 0.287493 +VERTEX_SE3:QUAT 306 -77.9728 168.658 -0.652517 -0.00488026 -0.00152155 0.957495 0.288405 +VERTEX_SE3:QUAT 307 -81.5108 171.11 -0.668422 -0.0167285 0.000514133 0.95719 0.288978 +VERTEX_SE3:QUAT 308 -85.067 173.576 -0.764425 -0.0183352 -0.00250265 0.957077 0.289242 +VERTEX_SE3:QUAT 309 -88.6193 176.039 -0.883881 -0.0143252 -0.00543135 0.957167 0.28913 +VERTEX_SE3:QUAT 310 -92.2726 178.58 -0.995583 -0.0134253 -0.00675478 0.957095 0.289385 +VERTEX_SE3:QUAT 311 -95.7386 180.994 -1.06079 -0.01212 -0.00608875 0.956839 0.290301 +VERTEX_SE3:QUAT 312 -99.1773 183.391 -1.09609 -0.0130882 -0.00500686 0.956605 0.291052 +VERTEX_SE3:QUAT 313 -102.554 185.775 -1.14061 -0.00647433 -0.00542987 0.955962 0.293368 +VERTEX_SE3:QUAT 314 -105.853 188.166 -1.16474 -0.00318281 -0.00656927 0.950394 0.310962 +VERTEX_SE3:QUAT 315 -109.038 190.933 -1.20474 -0.0232546 -0.00621777 0.918527 0.394625 +VERTEX_SE3:QUAT 316 -111.417 194.384 -1.33033 -0.0238907 -0.00737308 0.844968 0.534233 +VERTEX_SE3:QUAT 317 -112.454 198.337 -1.41222 -0.0166829 -0.0101331 0.738501 0.67397 +VERTEX_SE3:QUAT 318 -111.99 202.287 -1.42505 -0.0194168 -0.00847291 0.577151 0.816363 +VERTEX_SE3:QUAT 319 -109.55 205.714 -1.45035 -0.0198226 -0.00538067 0.332491 0.942883 +VERTEX_SE3:QUAT 320 -105.661 207.392 -1.44562 -0.0202892 -0.00628691 0.0766019 0.996835 +VERTEX_SE3:QUAT 321 -101.549 207.06 -1.37254 -0.0196378 -0.0120971 -0.137751 0.990198 +VERTEX_SE3:QUAT 322 -97.9542 205.342 -1.23069 -0.016914 -0.0205881 -0.266508 0.963464 +VERTEX_SE3:QUAT 323 -94.5506 202.831 -0.996791 -0.0146029 -0.0367452 -0.323551 0.945384 +VERTEX_SE3:QUAT 324 -91.4631 200.308 -0.712673 -0.0130545 -0.03372 -0.320836 0.946444 +VERTEX_SE3:QUAT 325 -88.2107 197.731 -0.39792 -0.0114238 -0.027766 -0.314055 0.94893 +VERTEX_SE3:QUAT 326 -84.7263 195.077 -0.0987876 -0.0137373 -0.0291864 -0.306144 0.951438 +VERTEX_SE3:QUAT 327 -81.2197 192.498 0.179805 -0.0158776 -0.0336303 -0.297868 0.953882 +VERTEX_SE3:QUAT 328 -77.6248 189.93 0.457679 -0.0146078 -0.0367198 -0.292334 0.955499 +VERTEX_SE3:QUAT 329 -73.9796 187.369 0.777192 -0.013635 -0.029976 -0.292347 0.955745 +VERTEX_SE3:QUAT 330 -70.7107 185.059 1.05794 -0.0127517 -0.0238216 -0.291163 0.956292 +VERTEX_SE3:QUAT 331 -67.0601 182.507 1.33583 -0.0135024 -0.0259932 -0.288599 0.957002 +VERTEX_SE3:QUAT 332 -63.4246 179.999 1.5935 -0.0155551 -0.0302745 -0.283771 0.958288 +VERTEX_SE3:QUAT 333 -59.7109 177.536 1.85268 -0.0155898 -0.0339291 -0.27515 0.960676 +VERTEX_SE3:QUAT 334 -56.1982 175.279 2.14818 -0.012159 -0.0246319 -0.267105 0.963276 +VERTEX_SE3:QUAT 335 -52.5889 173.021 2.41951 -0.0153103 -0.0249686 -0.271129 0.962097 +VERTEX_SE3:QUAT 336 -49.12 170.687 2.70787 -0.00926834 -0.00671467 -0.307611 0.951443 +VERTEX_SE3:QUAT 337 -46 167.883 2.75048 -0.0101946 0.00604013 -0.416601 0.909012 +VERTEX_SE3:QUAT 338 -43.9279 164.268 2.75771 -0.0105284 0.00791593 -0.5842 0.811503 +VERTEX_SE3:QUAT 339 -43.4769 160.26 2.79141 -0.00864532 0.00428417 -0.737844 0.674902 +VERTEX_SE3:QUAT 340 -44.9089 156.278 2.839 0.00765133 0.00939638 -0.883288 0.468675 +VERTEX_SE3:QUAT 341 -48.21 153.554 2.764 0.00692764 0.0117049 -0.978124 0.207578 +VERTEX_SE3:QUAT 342 -52.1648 152.929 2.71122 -0.00188374 -0.0139753 0.999066 0.0408325 +VERTEX_SE3:QUAT 343 -55.9615 154.11 2.71402 0.00297868 -0.0106506 0.975091 0.22153 +VERTEX_SE3:QUAT 344 -59.6058 156.443 2.72835 -0.0168512 -0.00258865 0.953024 0.302414 +VERTEX_SE3:QUAT 345 -62.8163 158.957 2.62978 -0.0192782 -0.00450326 0.946237 0.322868 +VERTEX_SE3:QUAT 346 -66.221 161.709 2.50678 -0.0109642 -0.00784365 0.946759 0.321662 +VERTEX_SE3:QUAT 347 -69.5434 164.341 2.46488 -0.00264778 -0.00971138 0.949679 0.313062 +VERTEX_SE3:QUAT 348 -73.05 167.006 2.45388 -0.00333161 -0.00720285 0.952144 0.305548 +VERTEX_SE3:QUAT 349 -76.5034 169.573 2.45018 -0.0115676 -0.00593938 0.952876 0.303082 +VERTEX_SE3:QUAT 350 -80.0227 172.174 2.40564 -0.0165146 -0.00225046 0.953695 0.300313 +VERTEX_SE3:QUAT 351 -83.4676 174.678 2.30674 -0.0128343 -0.00278624 0.954401 0.298237 +VERTEX_SE3:QUAT 352 -86.9061 177.124 2.20248 -0.0138002 -0.00685653 0.955349 0.295077 +VERTEX_SE3:QUAT 353 -90.453 179.617 2.11938 -0.0179664 -0.00952603 0.956795 0.290053 +VERTEX_SE3:QUAT 354 -94.1664 182.176 2.02769 -0.0124764 -0.0105052 0.958466 0.284739 +VERTEX_SE3:QUAT 355 -97.742 184.598 1.99481 -0.0151619 -0.00548293 0.960049 0.279367 +VERTEX_SE3:QUAT 356 -101.208 186.892 1.92376 -0.0074559 -0.00681939 0.960348 0.278619 +VERTEX_SE3:QUAT 357 -104.655 189.207 1.89282 -0.00304142 -0.00682132 0.960275 0.278955 +VERTEX_SE3:QUAT 358 -108.142 191.414 1.86766 -0.023904 0.00422719 0.970578 0.239562 +VERTEX_SE3:QUAT 359 -112.195 193.077 1.69193 -0.0194736 0.00480302 0.995314 0.0945939 +VERTEX_SE3:QUAT 360 -116.634 193.17 1.5571 0.0124557 -0.00671138 -0.99431 0.105585 +VERTEX_SE3:QUAT 361 -120.607 191.597 1.47061 0.00840969 -0.00991303 -0.950855 0.309364 +VERTEX_SE3:QUAT 362 -123.483 188.586 1.44496 0.0106608 -0.0101496 -0.860471 0.509286 +VERTEX_SE3:QUAT 363 -124.797 184.592 1.43724 0.00654609 -0.00907558 -0.729864 0.683501 +VERTEX_SE3:QUAT 364 -124.303 180.286 1.47049 3.37506e-05 -0.0149612 -0.568579 0.822492 +VERTEX_SE3:QUAT 365 -122.137 176.53 1.58106 -0.00359846 -0.0160061 -0.414153 0.910059 +VERTEX_SE3:QUAT 366 -119.022 173.465 1.73521 0.00249711 -0.000862459 -0.330483 0.943808 +VERTEX_SE3:QUAT 367 -115.719 170.998 1.75396 -0.0055185 -0.00318932 -0.290677 0.9568 +VERTEX_SE3:QUAT 368 -112.178 168.617 1.78127 -0.00877695 -0.00849554 -0.279032 0.960204 +VERTEX_SE3:QUAT 369 -108.501 166.237 1.85717 -0.00814333 -0.00283025 -0.272981 0.961981 +VERTEX_SE3:QUAT 370 -105.132 164.051 1.91269 -0.00950703 -0.00623502 -0.278025 0.960507 +VERTEX_SE3:QUAT 371 -101.504 161.57 2.03321 -0.00536318 -0.00682756 -0.291318 0.956587 +VERTEX_SE3:QUAT 372 -98.0488 159.07 2.12473 -0.00654158 -0.00812415 -0.303471 0.952784 +VERTEX_SE3:QUAT 373 -94.5704 156.425 2.20305 -0.00404658 -0.00931765 -0.311449 0.950209 +VERTEX_SE3:QUAT 374 -91.1944 153.842 2.28506 -0.00352905 -0.00277529 -0.311637 0.950191 +VERTEX_SE3:QUAT 375 -87.8367 151.242 2.34345 -0.00097025 0.00288217 -0.311801 0.950143 +VERTEX_SE3:QUAT 376 -84.4429 148.626 2.36939 -0.00347637 0.000422552 -0.312358 0.949958 +VERTEX_SE3:QUAT 377 -81.1673 146.113 2.39449 -0.00699922 -0.000631248 -0.312591 0.949862 +VERTEX_SE3:QUAT 378 -77.9933 143.657 2.43799 -0.00643528 -0.00451321 -0.312343 0.949937 +VERTEX_SE3:QUAT 379 -74.6671 141.087 2.51555 -0.00293631 -0.00570447 -0.308014 0.95136 +VERTEX_SE3:QUAT 380 -71.3374 138.703 2.60036 0.000980478 0.0019644 -0.268175 0.963368 +VERTEX_SE3:QUAT 381 -67.6703 136.793 2.59507 0.00416493 0.00195877 -0.161251 0.986903 +VERTEX_SE3:QUAT 382 -63.3043 136.045 2.58831 -0.000565832 -0.00337269 0.0319045 0.999485 +VERTEX_SE3:QUAT 383 -59.3645 136.927 2.62252 -0.000470402 -0.00488875 0.218044 0.975927 +VERTEX_SE3:QUAT 384 -55.7664 139.289 2.65655 -0.00178209 -0.00364025 0.368978 0.929429 +VERTEX_SE3:QUAT 385 -52.9485 142.348 2.65759 -0.000106233 -0.00324699 0.449703 0.893172 +VERTEX_SE3:QUAT 386 -50.533 145.728 2.6821 -0.000491533 -0.00368745 0.474894 0.880035 +VERTEX_SE3:QUAT 387 -48.1156 149.229 2.72406 -0.00038865 -0.00468788 0.468086 0.883671 +VERTEX_SE3:QUAT 388 -45.6955 152.585 2.76738 0.00113062 -0.00974989 0.460646 0.88753 +VERTEX_SE3:QUAT 389 -43.2208 155.949 2.85052 -0.00762267 0.00524557 0.458763 0.888511 +VERTEX_SE3:QUAT 390 -40.6882 159.325 2.79457 -0.00379368 0.00329461 0.458338 0.888764 +VERTEX_SE3:QUAT 391 -38.132 162.749 2.77781 -0.00225386 0.00249098 0.457757 0.889071 +VERTEX_SE3:QUAT 392 -35.6086 166.136 2.76772 -0.00277026 0.000642839 0.458655 0.88861 +VERTEX_SE3:QUAT 393 -33.0769 169.538 2.76947 -0.00223859 0.000320409 0.460629 0.88759 +VERTEX_SE3:QUAT 394 -30.5842 172.925 2.7645 -0.00228765 0.00217904 0.465085 0.88526 +VERTEX_SE3:QUAT 395 -28.0935 176.409 2.75849 0.000451779 0.000930754 0.469782 0.882782 +VERTEX_SE3:QUAT 396 -25.6755 179.876 2.77101 -0.000166672 -0.00050354 0.473312 0.880894 +VERTEX_SE3:QUAT 397 -23.2855 183.368 2.77774 -0.000776062 -0.00441449 0.476438 0.879197 +VERTEX_SE3:QUAT 398 -20.9417 186.804 2.81078 -0.00704875 0.00839305 0.478838 0.877835 +VERTEX_SE3:QUAT 399 -18.6341 190.161 2.73898 -0.00543714 0.00517576 0.471776 0.881687 +VERTEX_SE3:QUAT 400 -16.211 193.578 2.69727 -0.00509178 0.0037905 0.462589 0.88655 +VERTEX_SE3:QUAT 401 -13.7977 196.816 2.67212 -0.00620461 0.00327658 0.455696 0.890108 +VERTEX_SE3:QUAT 402 -11.278 200.314 2.65382 -0.00688429 0.00180423 0.49227 0.870413 +VERTEX_SE3:QUAT 403 -9.39255 204.167 2.60593 -0.00442804 0.00519185 0.601107 0.79914 +VERTEX_SE3:QUAT 404 -8.74273 208.53 2.54592 -0.00452343 0.00366126 0.725503 0.688195 +VERTEX_SE3:QUAT 405 -9.43441 212.485 2.51774 0.00133376 0.00358444 0.82637 0.563114 +VERTEX_SE3:QUAT 406 -11.3869 216.059 2.51515 0.00605885 0.00377156 0.905539 0.424203 +VERTEX_SE3:QUAT 407 -14.4296 218.929 2.54145 -0.00802989 0.00586675 0.952114 0.305582 +VERTEX_SE3:QUAT 408 -18.053 221.324 2.5027 -0.0130142 0.00326717 0.964496 0.263755 +VERTEX_SE3:QUAT 409 -21.7584 223.624 2.42298 -0.00777672 -0.00213298 0.963478 0.267665 +VERTEX_SE3:QUAT 410 -25.4495 226.027 2.38962 -0.00260311 -0.000949982 0.959718 0.280953 +VERTEX_SE3:QUAT 411 -29.0745 228.511 2.36987 -0.00278261 5.61915e-06 0.957951 0.286918 +VERTEX_SE3:QUAT 412 -32.645 230.989 2.35302 -0.00982115 0.00270133 0.95702 0.289843 +VERTEX_SE3:QUAT 413 -36.0571 233.372 2.31493 -0.0132909 0.00213158 0.956247 0.29225 +VERTEX_SE3:QUAT 414 -39.3317 235.689 2.22751 -0.00909578 -0.000738249 0.955522 0.29478 +VERTEX_SE3:QUAT 415 -42.8631 238.212 2.15018 -0.0116883 -0.00237436 0.954812 0.296971 +VERTEX_SE3:QUAT 416 -46.4416 240.797 2.05872 -0.0112001 -0.0035479 0.954057 0.299396 +VERTEX_SE3:QUAT 417 -49.9383 243.351 1.99483 -0.0120723 -0.00710147 0.952667 0.303694 +VERTEX_SE3:QUAT 418 -53.4321 246.023 1.93893 -0.00957441 -0.00193326 0.949557 0.313441 +VERTEX_SE3:QUAT 419 -56.6034 248.501 1.89034 -0.00359507 -0.00358986 0.948151 0.31778 +VERTEX_SE3:QUAT 420 -59.9421 251.172 1.8627 -0.00205752 0.00165256 0.950691 0.310128 +VERTEX_SE3:QUAT 421 -63.4346 253.55 1.8341 -0.0175884 0.0112658 0.973686 0.226934 +VERTEX_SE3:QUAT 422 -67.335 254.967 1.70612 -0.0115913 0.0101079 0.996562 0.0814045 +VERTEX_SE3:QUAT 423 -71.5771 255.013 1.64053 0.00501198 -0.00589511 -0.994906 0.10051 +VERTEX_SE3:QUAT 424 -75.4764 253.641 1.62563 0.00616402 -0.0124987 -0.959527 0.281273 +VERTEX_SE3:QUAT 425 -78.6429 250.541 1.65243 0.00520205 -0.011541 -0.860175 0.509842 +VERTEX_SE3:QUAT 426 -79.7959 246.382 1.69222 -0.000639222 -0.00842205 -0.704227 0.709924 +VERTEX_SE3:QUAT 427 -79.0221 242.283 1.7656 -0.00547106 -0.0155387 -0.54368 0.839131 +VERTEX_SE3:QUAT 428 -76.7418 238.538 1.89662 -0.010055 -0.015682 -0.423198 0.905846 +VERTEX_SE3:QUAT 429 -73.8721 235.55 2.02875 -0.00607566 0.00312364 -0.345559 0.938372 +VERTEX_SE3:QUAT 430 -70.4265 232.758 2.04904 -0.00764365 0.00605944 -0.315203 0.948974 +VERTEX_SE3:QUAT 431 -67.1081 230.223 2.04932 -0.0131183 0.000831662 -0.309991 0.950649 +VERTEX_SE3:QUAT 432 -63.6922 227.656 2.0674 -0.0150357 0.000162351 -0.305646 0.952026 +VERTEX_SE3:QUAT 433 -60.1812 225.047 2.1237 -0.0174768 -0.0081558 -0.300794 0.953494 +VERTEX_SE3:QUAT 434 -56.5957 222.448 2.25038 -0.010653 -0.00154124 -0.296898 0.954848 +VERTEX_SE3:QUAT 435 -53.0974 219.939 2.32312 -0.00961682 -0.00158833 -0.29381 0.955814 +VERTEX_SE3:QUAT 436 -49.6756 217.507 2.38422 -0.0094586 -0.00368273 -0.290404 0.95685 +VERTEX_SE3:QUAT 437 -46.2084 215.087 2.42384 -0.00924696 -0.00237621 -0.287766 0.957653 +VERTEX_SE3:QUAT 438 -42.7279 212.698 2.47583 -0.00883308 0.00569184 -0.285268 0.95839 +VERTEX_SE3:QUAT 439 -39.185 210.272 2.49116 -0.0084659 0.00518912 -0.283346 0.958966 +VERTEX_SE3:QUAT 440 -35.8011 208.002 2.49471 -0.0114797 0.000379706 -0.277669 0.960608 +VERTEX_SE3:QUAT 441 -32.3954 205.785 2.53557 -0.0120162 -0.00705069 -0.275678 0.961149 +VERTEX_SE3:QUAT 442 -28.8835 203.418 2.61324 -0.00940785 -0.00580112 -0.297421 0.954683 +VERTEX_SE3:QUAT 443 -25.707 200.934 2.7022 -0.0038525 0.0110042 -0.349585 0.936832 +VERTEX_SE3:QUAT 444 -22.8632 197.827 2.65916 -0.0112966 0.00917426 -0.465345 0.88501 +VERTEX_SE3:QUAT 445 -21.1627 194.024 2.67131 -0.0105268 0.00499592 -0.616666 0.787138 +VERTEX_SE3:QUAT 446 -21.1499 189.735 2.72342 -0.00931657 0.00443335 -0.788895 0.614441 +VERTEX_SE3:QUAT 447 -23.2027 186.099 2.75279 0.0017248 0.00972111 -0.922715 0.385358 +VERTEX_SE3:QUAT 448 -26.8821 183.999 2.72959 0.00327403 0.00871569 -0.991511 0.129685 +VERTEX_SE3:QUAT 449 -31.1879 183.915 2.72009 -0.00153354 -0.00917053 0.9944 0.105271 +VERTEX_SE3:QUAT 450 -34.8687 185.552 2.72701 0.0132167 -0.0072898 0.963788 0.266241 +VERTEX_SE3:QUAT 451 -38.2822 187.991 2.86836 0.025743 -0.00950193 0.950232 0.310332 +VERTEX_SE3:QUAT 452 -41.6677 190.679 3.07894 0.0216341 -0.00239517 0.948664 0.315535 +VERTEX_SE3:QUAT 453 -45.025 193.26 3.26455 0.0197034 -0.0079213 0.949542 0.31292 +VERTEX_SE3:QUAT 454 -48.4433 195.898 3.45772 0.0218243 -0.00640641 0.950238 0.310692 +VERTEX_SE3:QUAT 455 -51.8017 198.443 3.6346 0.0244326 -0.0102332 0.950751 0.308823 +VERTEX_SE3:QUAT 456 -55.0554 200.909 3.80757 0.0219914 -0.00811564 0.951512 0.306716 +VERTEX_SE3:QUAT 457 -58.6037 203.562 3.9944 0.0192353 -0.00549428 0.952531 0.303783 +VERTEX_SE3:QUAT 458 -62.2699 206.264 4.19976 0.0144964 -0.0049657 0.953528 0.300913 +VERTEX_SE3:QUAT 459 -65.5835 208.677 4.32866 0.0218386 -0.00785024 0.954266 0.298056 +VERTEX_SE3:QUAT 460 -68.9574 211.109 4.49037 0.0235036 -0.0078822 0.955113 0.295201 +VERTEX_SE3:QUAT 461 -72.2758 213.48 4.68996 0.0167787 -0.00528676 0.956442 0.291392 +VERTEX_SE3:QUAT 462 -75.9909 216.07 4.89942 0.0112186 -0.00635036 0.956915 0.290081 +VERTEX_SE3:QUAT 463 -79.436 218.548 5.07617 0.0130212 -0.00765854 0.952522 0.304096 +VERTEX_SE3:QUAT 464 -82.7397 221.196 5.2403 0.00746376 -0.00550443 0.934645 0.355461 +VERTEX_SE3:QUAT 465 -85.5043 224.22 5.25897 -0.0163893 -0.00560799 0.894517 0.446698 +VERTEX_SE3:QUAT 466 -87.4323 227.752 5.18753 -0.0170193 -0.00468278 0.819441 0.572891 +VERTEX_SE3:QUAT 467 -88.0105 231.985 5.12855 -0.0136485 -0.00872093 0.670765 0.741493 +VERTEX_SE3:QUAT 468 -86.5873 235.735 5.10435 -0.0184223 0.00253525 0.458658 0.888418 +VERTEX_SE3:QUAT 469 -83.3879 238.29 5.05521 -0.0250867 -0.000263937 0.199128 0.979652 +VERTEX_SE3:QUAT 470 -79.2248 238.734 5.07152 -0.0205599 -0.00694596 -0.0754488 0.996913 +VERTEX_SE3:QUAT 471 -75.4488 237.199 5.16717 -0.01235 -0.00703814 -0.261777 0.965024 +VERTEX_SE3:QUAT 472 -71.9609 234.569 5.19819 -0.0101845 0.00246725 -0.335983 0.94181 +VERTEX_SE3:QUAT 473 -68.784 231.746 5.20018 -0.0112367 0.00238068 -0.351877 0.935976 +VERTEX_SE3:QUAT 474 -65.5001 228.731 5.24209 -0.0128384 0.00764916 -0.355541 0.934541 +VERTEX_SE3:QUAT 475 -62.1905 225.656 5.27341 -0.0122228 0.00154467 -0.3516 0.936069 +VERTEX_SE3:QUAT 476 -58.8167 222.638 5.33831 -0.014069 -0.00401392 -0.340899 0.939986 +VERTEX_SE3:QUAT 477 -55.4312 219.744 5.40299 -0.013203 -0.0092191 -0.328758 0.944277 +VERTEX_SE3:QUAT 478 -52.0739 217.023 5.49231 -0.0100096 -0.00471871 -0.316858 0.948408 +VERTEX_SE3:QUAT 479 -48.5364 214.315 5.56339 -0.00746258 0.00765076 -0.305147 0.952245 +VERTEX_SE3:QUAT 480 -45.199 211.871 5.57121 -0.00870846 0.00737353 -0.300088 0.953843 +VERTEX_SE3:QUAT 481 -41.9524 209.486 5.56579 -0.0120389 0.00222484 -0.30459 0.952405 +VERTEX_SE3:QUAT 482 -38.5155 206.879 5.56519 -0.0146858 -0.000365076 -0.312917 0.949667 +VERTEX_SE3:QUAT 483 -35.1338 204.237 5.61606 -0.0120094 0.00366602 -0.316129 0.948633 +VERTEX_SE3:QUAT 484 -31.7912 201.618 5.66635 -0.00895743 0.000850969 -0.314963 0.949061 +VERTEX_SE3:QUAT 485 -28.499 199.067 5.71822 -0.00827847 0.00442225 -0.309142 0.950969 +VERTEX_SE3:QUAT 486 -25.1112 196.595 5.69021 -0.00886873 0.00688659 -0.284546 0.958597 +VERTEX_SE3:QUAT 487 -21.5924 194.526 5.67199 -0.00556781 0.00425989 -0.184632 0.982783 +VERTEX_SE3:QUAT 488 -17.4396 193.674 5.66493 -0.00233894 0.00580585 0.0272939 0.999608 +VERTEX_SE3:QUAT 489 -13.4192 194.746 5.62601 -0.00335038 0.00117148 0.266438 0.963845 +VERTEX_SE3:QUAT 490 -10.3773 197.606 5.61828 -0.00479878 0.00162497 0.488287 0.872668 +VERTEX_SE3:QUAT 491 -8.67394 201.695 5.57869 -0.00895272 0.00856603 0.626179 0.779581 +VERTEX_SE3:QUAT 492 -8.19806 206.076 5.49659 -0.00660199 0.0070677 0.726156 0.687462 +VERTEX_SE3:QUAT 493 -8.85207 210.118 5.43704 -0.000333396 0.00672944 0.813986 0.580846 +VERTEX_SE3:QUAT 494 -10.5968 213.77 5.4243 0.00354707 0.00847936 0.889233 0.457362 +VERTEX_SE3:QUAT 495 -13.2749 216.83 5.45044 -0.00445516 0.00822143 0.93382 0.35762 +VERTEX_SE3:QUAT 496 -16.4945 219.493 5.37471 -0.00471915 0.00510385 0.950746 0.309892 +VERTEX_SE3:QUAT 497 -20.0181 222.014 5.30918 -0.00257354 0.000440128 0.957645 0.287939 +VERTEX_SE3:QUAT 498 -23.3678 224.276 5.30637 -0.00315193 -0.000361256 0.96065 0.277745 +VERTEX_SE3:QUAT 499 -27.1916 226.75 5.30926 -0.00386111 0.00100417 0.961992 0.273047 +VERTEX_SE3:QUAT 500 -30.7469 229.026 5.28998 0.000672035 0.00180642 0.962885 0.269906 +VERTEX_SE3:QUAT 501 -34.2914 231.276 5.27928 0.000844947 0.00110405 0.962717 0.270508 +VERTEX_SE3:QUAT 502 -38.084 233.695 5.27253 -0.00935606 0.0033968 0.962492 0.271128 +VERTEX_SE3:QUAT 503 -41.7555 236.055 5.21648 -0.0173603 0.00417402 0.961763 0.273301 +VERTEX_SE3:QUAT 504 -45.3807 238.408 5.11135 -0.0127346 0.00051704 0.961063 0.276034 +VERTEX_SE3:QUAT 505 -48.7783 240.653 5.0331 -0.00696207 -0.00102895 0.960324 0.278796 +VERTEX_SE3:QUAT 506 -52.5654 243.175 4.97639 1.56475e-05 -0.00352155 0.959678 0.281079 +VERTEX_SE3:QUAT 507 -56.1553 245.607 4.98303 -0.00544184 0.000976829 0.959364 0.282116 +VERTEX_SE3:QUAT 508 -59.6764 248.003 4.97979 -0.00172519 0.00320822 0.959809 0.280631 +VERTEX_SE3:QUAT 509 -63.2117 250.276 4.99759 -0.00897598 0.00783335 0.967388 0.253019 +VERTEX_SE3:QUAT 510 -66.8739 252.128 4.90671 -0.00925193 0.0110912 0.984771 0.173257 +VERTEX_SE3:QUAT 511 -70.919 253.188 4.83415 -0.0033647 0.0120367 0.9986 0.0513968 +VERTEX_SE3:QUAT 512 -75.082 253.098 4.81742 0.00368276 -0.0139761 -0.993656 0.111532 +VERTEX_SE3:QUAT 513 -79.1186 251.565 4.81944 0.00508036 -0.0122137 -0.961228 0.275439 +VERTEX_SE3:QUAT 514 -82.5005 248.811 4.82175 0.000590688 -0.00991965 -0.914664 0.404093 +VERTEX_SE3:QUAT 515 -85.2555 245.286 4.87138 -0.00321264 -0.00853905 -0.877528 0.479438 +VERTEX_SE3:QUAT 516 -87.6411 241.511 4.95345 -0.00404555 -0.0115609 -0.868054 0.496318 +VERTEX_SE3:QUAT 517 -89.9624 237.769 5.05701 9.56066e-05 -0.00496159 -0.870864 0.491499 +VERTEX_SE3:QUAT 518 -92.441 233.931 5.05292 0.00500425 -0.00533459 -0.876163 0.481959 +VERTEX_SE3:QUAT 519 -94.695 230.605 5.04535 0.00352602 -0.00726827 -0.880967 0.473109 +VERTEX_SE3:QUAT 520 -97.0866 227.207 5.06306 0.00476552 -0.00733224 -0.884958 0.465588 +VERTEX_SE3:QUAT 521 -99.4902 223.9 5.06854 0.00156958 -0.00586681 -0.888711 0.458427 +VERTEX_SE3:QUAT 522 -101.961 220.63 5.10906 0.00567267 -0.00285939 -0.891146 0.453672 +VERTEX_SE3:QUAT 523 -104.564 217.243 5.09554 0.00295198 -0.00575134 -0.892521 0.45096 +VERTEX_SE3:QUAT 524 -107.141 213.911 5.11304 0.00220726 -0.00649388 -0.89327 0.449469 +VERTEX_SE3:QUAT 525 -109.664 210.67 5.15103 0.00247917 -0.00644378 -0.892962 0.450079 +VERTEX_SE3:QUAT 526 -112.396 207.091 5.19023 0.00309351 -0.00175772 -0.892013 0.451997 +VERTEX_SE3:QUAT 527 -114.989 203.697 5.16235 0.00882196 0.00110042 -0.890489 0.454919 +VERTEX_SE3:QUAT 528 -117.533 200.271 5.11083 0.00799938 -0.000720801 -0.886642 0.462387 +VERTEX_SE3:QUAT 529 -119.994 196.75 5.0725 0.00636465 -0.0017409 -0.877223 0.480038 +VERTEX_SE3:QUAT 530 -122.252 193.265 5.05174 0.00249416 -0.00380944 -0.86464 0.502371 +VERTEX_SE3:QUAT 531 -124.152 189.548 5.05409 0.00872581 -0.005307 -0.817801 0.575411 +VERTEX_SE3:QUAT 532 -125.135 185.464 5.04483 0.00351114 -0.00378759 -0.73306 0.680144 +VERTEX_SE3:QUAT 533 -124.941 181.326 5.06358 0.00418013 -0.00941095 -0.616543 0.787254 +VERTEX_SE3:QUAT 534 -123.277 177.343 5.1344 0.00291059 -0.0120177 -0.467974 0.883656 +VERTEX_SE3:QUAT 535 -120.344 174.095 5.24276 0.00229957 -0.00198655 -0.340867 0.940107 +VERTEX_SE3:QUAT 536 -116.613 171.352 5.25995 -0.00563088 -0.00192689 -0.285037 0.958498 +VERTEX_SE3:QUAT 537 -113.194 169.096 5.27317 -0.00631826 -0.00369264 -0.273512 0.961841 +VERTEX_SE3:QUAT 538 -109.682 166.862 5.30571 -0.00584362 0.0044776 -0.270566 0.962673 +VERTEX_SE3:QUAT 539 -106.064 164.562 5.30944 -0.00831169 -0.00319716 -0.270365 0.962717 +VERTEX_SE3:QUAT 540 -102.453 162.244 5.38751 -0.0067482 -0.0054988 -0.270977 0.962546 +VERTEX_SE3:QUAT 541 -98.9195 159.96 5.44271 -0.0064656 -0.0101981 -0.272747 0.96201 +VERTEX_SE3:QUAT 542 -95.3487 157.635 5.52018 -0.00598782 -0.00924448 -0.276558 0.960934 +VERTEX_SE3:QUAT 543 -91.8365 155.292 5.60924 0.00222092 0.00447444 -0.281111 0.959662 +VERTEX_SE3:QUAT 544 -88.3153 152.905 5.59851 0.00111049 0.00374513 -0.285688 0.958315 +VERTEX_SE3:QUAT 545 -84.8092 150.488 5.5842 -0.0033632 -0.000670416 -0.290562 0.95685 +VERTEX_SE3:QUAT 546 -81.3068 148.01 5.58097 -0.00357759 -0.000562305 -0.296242 0.955106 +VERTEX_SE3:QUAT 547 -78.0263 145.62 5.60691 -0.00551492 -0.00324403 -0.303139 0.952925 +VERTEX_SE3:QUAT 548 -74.4878 142.952 5.68468 0.0020073 -0.000198726 -0.302424 0.953171 +VERTEX_SE3:QUAT 549 -71.1205 140.626 5.73776 0.00536062 -0.00135867 -0.256572 0.966509 +VERTEX_SE3:QUAT 550 -67.3805 138.778 5.73611 0.00610922 0.00443292 -0.163611 0.986496 +VERTEX_SE3:QUAT 551 -63.0363 137.864 5.72035 0.00243532 -0.000665746 -0.00173004 0.999995 +VERTEX_SE3:QUAT 552 -58.8779 138.552 5.765 0.00141159 -0.00130962 0.202547 0.979271 +VERTEX_SE3:QUAT 553 -55.3568 141.132 5.7835 0.00481946 -0.00342991 0.453604 0.891184 +VERTEX_SE3:QUAT 554 -53.7576 144.897 5.82523 -0.00231219 -0.00235791 0.660838 0.750522 +VERTEX_SE3:QUAT 555 -54.1089 148.961 5.83096 0.0041883 -0.00297469 0.822493 0.568752 +VERTEX_SE3:QUAT 556 -56.3017 152.49 5.86642 0.00639998 -0.0037946 0.92382 0.382756 +VERTEX_SE3:QUAT 557 -59.7528 155.242 5.91642 -0.0153351 -0.000556262 0.960033 0.279465 +VERTEX_SE3:QUAT 558 -63.3852 157.489 5.82546 -0.0157764 -0.00398701 0.965561 0.259667 +VERTEX_SE3:QUAT 559 -66.8158 159.598 5.72196 -0.00670912 -0.00881499 0.963848 0.266223 +VERTEX_SE3:QUAT 560 -70.2614 161.797 5.69259 -0.00333036 -0.00758612 0.961677 0.27406 +VERTEX_SE3:QUAT 561 -73.7603 164.121 5.70744 -0.00867844 -0.00632922 0.958862 0.283669 +VERTEX_SE3:QUAT 562 -77.31 166.585 5.69727 -0.00836142 -0.00442095 0.955794 0.293884 +VERTEX_SE3:QUAT 563 -80.7991 169.114 5.66161 -0.00345328 -0.00370538 0.953743 0.300582 +VERTEX_SE3:QUAT 564 -84.3136 171.691 5.59942 -0.00670301 -0.00455367 0.953538 0.301165 +VERTEX_SE3:QUAT 565 -87.9245 174.331 5.53465 -0.0139625 -0.00496672 0.954206 0.298782 +VERTEX_SE3:QUAT 566 -91.4473 176.856 5.46425 -0.0189026 -0.00459952 0.955629 0.293931 +VERTEX_SE3:QUAT 567 -94.9934 179.335 5.3596 -0.012107 -0.00816251 0.95748 0.288131 +VERTEX_SE3:QUAT 568 -98.3745 181.644 5.30916 -0.000786709 -0.0105756 0.959454 0.281664 +VERTEX_SE3:QUAT 569 -101.998 184.065 5.30499 -0.00411241 -0.00877593 0.958489 0.284964 +VERTEX_SE3:QUAT 570 -105.35 186.458 5.3212 -0.00425006 -0.00624126 0.950521 0.310569 +VERTEX_SE3:QUAT 571 -108.375 189.039 5.33479 -0.0197191 -0.00304721 0.925961 0.377092 +VERTEX_SE3:QUAT 572 -111.007 192.408 5.21327 -0.0201435 -0.00963591 0.867004 0.4978 +VERTEX_SE3:QUAT 573 -112.501 196.467 5.12775 -0.0145079 -0.0123482 0.773622 0.633361 +VERTEX_SE3:QUAT 574 -112.642 200.468 5.11816 -0.014605 -0.0113196 0.669181 0.742869 +VERTEX_SE3:QUAT 575 -111.538 204.382 5.14109 -0.0155505 -0.00422974 0.551583 0.833964 +VERTEX_SE3:QUAT 576 -109.335 208.033 5.10624 -0.0172055 -0.00367778 0.463496 0.885924 +VERTEX_SE3:QUAT 577 -106.607 211.494 5.08081 -0.0165509 -0.00201552 0.438688 0.898485 +VERTEX_SE3:QUAT 578 -104.049 214.625 5.06055 -0.0157443 -0.00299467 0.440193 0.89776 +VERTEX_SE3:QUAT 579 -101.505 217.743 5.04816 -0.0112918 -0.00358525 0.443017 0.896435 +VERTEX_SE3:QUAT 580 -98.7553 221.221 5.032 -0.0138608 -0.00240053 0.446354 0.894746 +VERTEX_SE3:QUAT 581 -96.2671 224.365 5.01987 -0.0127866 -0.00350108 0.448511 0.893679 +VERTEX_SE3:QUAT 582 -93.6117 227.818 5.00569 -0.0134493 -0.00320643 0.454789 0.890492 +VERTEX_SE3:QUAT 583 -90.9864 231.304 5.00365 -0.0139996 -0.00430271 0.45476 0.890494 +VERTEX_SE3:QUAT 584 -88.4194 234.47 5.01267 -0.0207164 -0.000785451 0.403343 0.914814 +VERTEX_SE3:QUAT 585 -85.2297 237.018 4.9792 -0.0201471 0.00446217 0.261356 0.965022 +VERTEX_SE3:QUAT 586 -81.4819 238.374 4.9454 -0.0237063 -0.00116967 0.0907019 0.995595 +VERTEX_SE3:QUAT 587 -77.3892 238.336 4.98361 -0.0214996 -0.00770772 -0.0863751 0.996001 +VERTEX_SE3:QUAT 588 -73.5312 236.935 5.08732 -0.0129837 0.001474 -0.226013 0.974037 +VERTEX_SE3:QUAT 589 -69.7572 234.468 5.09593 -0.0103662 0.00504069 -0.314943 0.94904 +VERTEX_SE3:QUAT 590 -66.5674 231.857 5.07706 -0.0151685 0.000136061 -0.331489 0.943337 +VERTEX_SE3:QUAT 591 -63.5229 229.31 5.12374 -0.0155038 0.0080545 -0.330843 0.943524 +VERTEX_SE3:QUAT 592 -60.1686 226.527 5.14867 -0.0174897 0.00148289 -0.32813 0.944469 +VERTEX_SE3:QUAT 593 -56.7255 223.712 5.22736 -0.01458 -0.00267726 -0.324124 0.945898 +VERTEX_SE3:QUAT 594 -53.4413 221.055 5.2955 -0.0156207 -0.00880777 -0.319846 0.9473 +VERTEX_SE3:QUAT 595 -50.0913 218.413 5.39039 -0.0113825 -0.00608889 -0.31587 0.948715 +VERTEX_SE3:QUAT 596 -46.7886 215.849 5.46713 -0.00750877 0.006653 -0.311834 0.950084 +VERTEX_SE3:QUAT 597 -43.474 213.304 5.47963 -0.00717904 0.0056312 -0.311563 0.950182 +VERTEX_SE3:QUAT 598 -40.2592 210.82 5.477 -0.0104 0.00136073 -0.314003 0.949364 +VERTEX_SE3:QUAT 599 -36.7369 208.07 5.49012 -0.0112163 0.000811 -0.314111 0.94932 +VERTEX_SE3:QUAT 600 -33.3645 205.45 5.52591 -0.0129278 0.00038546 -0.314027 0.949326 +VERTEX_SE3:QUAT 601 -30.1665 202.951 5.59534 -0.0126588 0.000448268 -0.324874 0.945673 +VERTEX_SE3:QUAT 602 -26.9275 200.089 5.67045 -0.0101221 0.00461729 -0.376787 0.926233 +VERTEX_SE3:QUAT 603 -24.2609 196.785 5.66331 -0.0148277 0.00949332 -0.48956 0.871792 +VERTEX_SE3:QUAT 604 -22.7002 192.807 5.68503 -0.0154412 0.00697302 -0.625907 0.779714 +VERTEX_SE3:QUAT 605 -22.5582 188.504 5.75845 -0.011326 0.0045366 -0.749327 0.662087 +VERTEX_SE3:QUAT 606 -23.865 184.314 5.79253 -0.00259589 0.00833138 -0.839084 0.543932 +VERTEX_SE3:QUAT 607 -25.9224 180.829 5.79555 -0.00228145 0.0064851 -0.877277 0.479935 +VERTEX_SE3:QUAT 608 -28.3417 177.381 5.80816 -0.00289205 0.00571303 -0.885545 0.46451 +VERTEX_SE3:QUAT 609 -30.9588 173.887 5.82614 -0.00209233 0.00278713 -0.891479 0.453048 +VERTEX_SE3:QUAT 610 -33.6613 170.379 5.86179 -0.00157593 0.00472976 -0.893582 0.448873 +VERTEX_SE3:QUAT 611 -36.3941 166.904 5.87844 -0.00384831 0.00291149 -0.894502 0.447038 +VERTEX_SE3:QUAT 612 -39.1705 163.39 5.9112 -0.00442156 0.00287131 -0.894394 0.447249 +VERTEX_SE3:QUAT 613 -41.8131 160.019 5.94855 -0.00375404 0.00133415 -0.894003 0.448042 +VERTEX_SE3:QUAT 614 -44.393 156.727 6.01112 0.00273941 0.00409795 -0.893049 0.449933 +VERTEX_SE3:QUAT 615 -47.0333 153.301 5.97643 0.00446068 0.00501364 -0.892088 0.451812 +VERTEX_SE3:QUAT 616 -49.6189 149.929 5.94121 0.00364787 0.00487347 -0.891191 0.453587 +VERTEX_SE3:QUAT 617 -52.2215 146.59 5.91483 0.00315873 0.00400293 -0.897608 0.440764 +VERTEX_SE3:QUAT 618 -54.9717 143.486 5.90256 0.00218537 0.00665266 -0.922046 0.387018 +VERTEX_SE3:QUAT 619 -58.2548 140.922 5.88162 0.00246114 0.00895444 -0.963271 0.268372 +VERTEX_SE3:QUAT 620 -62.1588 139.394 5.85875 -0.00137593 0.011151 -0.993299 0.115023 +VERTEX_SE3:QUAT 621 -66.3 139.166 5.87054 0.00267061 -0.0139613 0.998684 0.0492827 +VERTEX_SE3:QUAT 622 -70.5567 140.41 5.91691 -0.0140507 -0.00668012 0.979083 0.202867 +VERTEX_SE3:QUAT 623 -74.0383 142.487 5.84642 -0.00761149 -0.0014219 0.957131 0.289551 +VERTEX_SE3:QUAT 624 -77.4553 145.056 5.77463 -0.00504273 0.000440198 0.95017 0.31169 +VERTEX_SE3:QUAT 625 -81.0392 147.853 5.74242 -0.0011049 -0.00154083 0.949133 0.31487 +VERTEX_SE3:QUAT 626 -84.5892 150.618 5.75598 -0.00715529 -0.00149171 0.949338 0.314172 +VERTEX_SE3:QUAT 627 -87.7517 153.075 5.74515 -0.00491131 -0.00483944 0.949769 0.312876 +VERTEX_SE3:QUAT 628 -90.9327 155.545 5.73898 -0.00332378 -0.00494488 0.950577 0.310431 +VERTEX_SE3:QUAT 629 -94.4186 158.206 5.68862 -0.0103227 0.00202411 0.951454 0.30761 +VERTEX_SE3:QUAT 630 -97.6402 160.642 5.63354 -0.0151157 0.00350176 0.952276 0.304843 +VERTEX_SE3:QUAT 631 -101.163 163.271 5.54488 -0.0159101 0.00756166 0.953346 0.301366 +VERTEX_SE3:QUAT 632 -104.645 165.827 5.43395 -0.00689682 0.00370517 0.954481 0.298168 +VERTEX_SE3:QUAT 633 -108.03 168.269 5.39793 0.000348862 -0.000148323 0.955591 0.294695 +VERTEX_SE3:QUAT 634 -111.328 170.614 5.4084 -0.00655264 -0.000514883 0.957084 0.289735 +VERTEX_SE3:QUAT 635 -114.889 173.066 5.39294 -0.00942504 -0.00583375 0.956255 0.292325 +VERTEX_SE3:QUAT 636 -118.055 175.526 5.37657 -0.0157307 -0.00487751 0.933947 0.357031 +VERTEX_SE3:QUAT 637 -120.649 178.78 5.28 -0.018401 -0.00505862 0.864836 0.501692 +VERTEX_SE3:QUAT 638 -122.025 182.922 5.192 -0.016099 -0.00764314 0.757012 0.653158 +VERTEX_SE3:QUAT 639 -121.767 187.26 5.16793 -0.014082 -0.00803149 0.622314 0.7826 +VERTEX_SE3:QUAT 640 -120.218 191.03 5.16697 -0.0136684 -0.0074698 0.514609 0.857283 +VERTEX_SE3:QUAT 641 -117.717 194.657 5.17742 -0.00913907 -0.00602563 0.451336 0.892287 +VERTEX_SE3:QUAT 642 -115.229 197.825 5.20307 -0.0096291 -0.00818 0.453421 0.891207 +VERTEX_SE3:QUAT 643 -112.788 201.067 5.24387 -0.00916974 -0.00684406 0.463669 0.885935 +VERTEX_SE3:QUAT 644 -110.444 204.392 5.2812 -0.0148954 -0.000920376 0.472489 0.88121 +VERTEX_SE3:QUAT 645 -108.146 207.61 5.23996 -0.0128924 0.00027843 0.465881 0.884753 +VERTEX_SE3:QUAT 646 -105.754 210.872 5.20869 -0.012728 0.00112628 0.46012 0.887765 +VERTEX_SE3:QUAT 647 -103.26 214.192 5.17565 -0.0119545 -0.00058766 0.456846 0.889465 +VERTEX_SE3:QUAT 648 -100.809 217.441 5.15526 -0.0106959 -0.00180772 0.456483 0.889666 +VERTEX_SE3:QUAT 649 -98.2921 220.793 5.13885 -0.0124806 0.000810914 0.456654 0.889556 +VERTEX_SE3:QUAT 650 -95.7687 224.148 5.11071 -0.0124351 -0.00203697 0.457993 0.888866 +VERTEX_SE3:QUAT 651 -93.2573 227.511 5.09268 -0.0124063 -0.00136021 0.459565 0.888056 +VERTEX_SE3:QUAT 652 -90.7956 230.846 5.07962 -0.0121345 -0.00303707 0.461176 0.887221 +VERTEX_SE3:QUAT 653 -88.4402 234.067 5.07354 -0.0126667 -0.00289082 0.463366 0.886072 +VERTEX_SE3:QUAT 654 -86.049 237.358 5.0251 -0.0170159 0.0045975 0.465465 0.884891 +VERTEX_SE3:QUAT 655 -83.7134 240.593 4.95088 -0.0185064 0.00549184 0.465415 0.884882 +VERTEX_SE3:QUAT 656 -81.0638 244.187 4.87049 -0.0174528 0.00313067 0.455247 0.890189 +VERTEX_SE3:QUAT 657 -78.3773 247.563 4.80822 -0.0167336 0.00288516 0.428656 0.903308 +VERTEX_SE3:QUAT 658 -75.4576 250.582 4.77396 -0.0205641 0.0026304 0.348312 0.937149 +VERTEX_SE3:QUAT 659 -71.7335 252.705 4.7458 -0.0207225 0.00120421 0.16155 0.986646 +VERTEX_SE3:QUAT 660 -67.5833 253.06 4.75682 -0.0213141 -0.004196 -0.0693661 0.997355 +VERTEX_SE3:QUAT 661 -63.5115 251.573 4.84213 -0.0150897 -0.00355193 -0.235584 0.97173 +VERTEX_SE3:QUAT 662 -59.9395 249.337 4.87738 -0.00942889 0.00284468 -0.277178 0.960768 +VERTEX_SE3:QUAT 663 -56.6364 247.087 4.88037 -0.00741558 0.000327255 -0.284649 0.958603 +VERTEX_SE3:QUAT 664 -53.1126 244.622 4.92895 -0.00190318 0.00495054 -0.28904 0.957302 +VERTEX_SE3:QUAT 665 -49.5214 242.09 4.92758 -0.00424734 -0.00311287 -0.292928 0.95612 +VERTEX_SE3:QUAT 666 -46.0549 239.615 4.9887 -0.00775221 -0.00619191 -0.296189 0.955078 +VERTEX_SE3:QUAT 667 -42.5184 237.056 5.06489 -0.00998761 -0.0100957 -0.299124 0.954109 +VERTEX_SE3:QUAT 668 -38.8282 234.355 5.17977 -0.00728993 -0.0012454 -0.300539 0.953741 +VERTEX_SE3:QUAT 669 -35.2474 231.731 5.24857 -0.00647279 0.00686664 -0.301148 0.953531 +VERTEX_SE3:QUAT 670 -31.8858 229.27 5.25914 -0.00709604 0.00483201 -0.301024 0.953578 +VERTEX_SE3:QUAT 671 -28.5439 226.814 5.25539 -0.00739013 0.00131751 -0.300502 0.953752 +VERTEX_SE3:QUAT 672 -25.2602 224.401 5.26571 -0.00450747 0.00426261 -0.299791 0.953985 +VERTEX_SE3:QUAT 673 -22.0046 222.028 5.27521 -0.00536293 0.00427299 -0.298986 0.954233 +VERTEX_SE3:QUAT 674 -18.6241 219.593 5.30756 -0.00871829 -0.00195448 -0.294942 0.955473 +VERTEX_SE3:QUAT 675 -15.0701 217.017 5.38124 -0.0126225 0.000225433 -0.316381 0.948548 +VERTEX_SE3:QUAT 676 -11.841 214.161 5.3991 -0.00999689 0.00868614 -0.387318 0.921851 +VERTEX_SE3:QUAT 677 -9.41404 210.643 5.39256 -0.0115633 0.00578095 -0.543196 0.839506 +VERTEX_SE3:QUAT 678 -8.64547 206.634 5.42915 -0.0120139 0.000210811 -0.714472 0.699561 +VERTEX_SE3:QUAT 679 -9.62727 202.659 5.50655 -0.00817359 0.000198384 -0.838644 0.544618 +VERTEX_SE3:QUAT 680 -11.883 199.2 5.56797 -0.00453344 0.0028172 -0.911728 0.410759 +VERTEX_SE3:QUAT 681 -15.2643 196.707 5.60805 -0.00250997 0.000424836 -0.976246 0.216652 +VERTEX_SE3:QUAT 682 -19.4885 195.795 5.63032 -0.00767313 0.00381954 -0.999939 0.0069414 +VERTEX_SE3:QUAT 683 -23.6431 196.477 5.69428 0.00788079 -0.00528876 0.989783 0.142266 +VERTEX_SE3:QUAT 684 -27.3031 198.092 5.77393 -0.00941618 0.00347868 0.969597 0.2445 +VERTEX_SE3:QUAT 685 -30.816 200.474 5.7109 -0.00734622 0.00716666 0.951249 0.308253 +VERTEX_SE3:QUAT 686 -34.3402 203.299 5.62958 0.00314485 0.00857459 0.945617 0.325155 +VERTEX_SE3:QUAT 687 -37.4303 205.846 5.61437 0.00151202 0.00809105 0.944636 0.328018 +VERTEX_SE3:QUAT 688 -40.5234 208.417 5.63498 -0.00516837 0.00984655 0.944792 0.327481 +VERTEX_SE3:QUAT 689 -43.997 211.28 5.61111 -0.00374303 0.00858982 0.945904 0.324313 +VERTEX_SE3:QUAT 690 -47.5002 214.1 5.5759 -0.000159194 0.00455176 0.947105 0.320891 +VERTEX_SE3:QUAT 691 -50.973 216.868 5.52911 -0.00255128 0.00660376 0.948355 0.317131 +VERTEX_SE3:QUAT 692 -54.4715 219.621 5.4688 -0.0063889 0.0105389 0.949713 0.312878 +VERTEX_SE3:QUAT 693 -57.9624 222.31 5.41288 -0.0108324 0.014056 0.951134 0.308268 +VERTEX_SE3:QUAT 694 -61.4827 224.976 5.32513 -0.00483649 0.0122877 0.952457 0.304386 +VERTEX_SE3:QUAT 695 -64.8685 227.479 5.29733 -0.000869177 0.00927888 0.95435 0.298546 +VERTEX_SE3:QUAT 696 -68.5661 230.053 5.26252 0.00474229 0.00727142 0.9612 0.275716 +VERTEX_SE3:QUAT 697 -72.1626 232.254 5.2811 0.00131306 0.0051945 0.972072 0.23462 +VERTEX_SE3:QUAT 698 -75.9225 233.981 5.2799 -0.010512 0.0119741 0.987095 0.159338 +VERTEX_SE3:QUAT 699 -79.8301 235.038 5.20727 -0.00445485 0.0150951 0.997526 0.0685199 +VERTEX_SE3:QUAT 700 -84.2817 235.245 5.18804 0.000467161 -0.0152969 -0.997814 0.0642923 +VERTEX_SE3:QUAT 701 -88.538 234.155 5.19286 0.0105608 -0.00603988 -0.978507 0.205855 +VERTEX_SE3:QUAT 702 -92.1843 232.095 5.14449 0.00913831 -0.00707139 -0.947562 0.319363 +VERTEX_SE3:QUAT 703 -95.4926 229.263 5.12407 0.00475855 -0.00665785 -0.923817 0.382747 +VERTEX_SE3:QUAT 704 -98.5214 226.081 5.12582 0.000589677 -0.00291243 -0.908489 0.417899 +VERTEX_SE3:QUAT 705 -101.162 223.007 5.15051 0.000203015 -0.00631713 -0.899474 0.436929 +VERTEX_SE3:QUAT 706 -103.983 219.423 5.17048 0.00171301 -0.00136158 -0.890832 0.454329 +VERTEX_SE3:QUAT 707 -106.548 215.889 5.18558 -0.000107622 -0.00026461 -0.882358 0.470579 +VERTEX_SE3:QUAT 708 -109.029 212.279 5.21137 0.000131585 -0.00270556 -0.876944 0.480585 +VERTEX_SE3:QUAT 709 -111.309 208.807 5.24314 -0.00472347 -0.0053122 -0.871704 0.489981 +VERTEX_SE3:QUAT 710 -113.55 205.2 5.29622 0.010529 0.00108519 -0.866031 0.499877 +VERTEX_SE3:QUAT 711 -115.673 201.518 5.23309 0.00758295 -0.00143972 -0.856059 0.516821 +VERTEX_SE3:QUAT 712 -117.625 197.792 5.20391 0.00751528 -0.00462183 -0.844266 0.535852 +VERTEX_SE3:QUAT 713 -119.411 193.987 5.18875 0.00626604 -0.00571128 -0.830184 0.557425 +VERTEX_SE3:QUAT 714 -120.925 190.072 5.18834 0.00520692 -0.00707578 -0.797833 0.602814 +VERTEX_SE3:QUAT 715 -121.728 186.021 5.20242 0.00915403 -0.00707494 -0.716743 0.697242 +VERTEX_SE3:QUAT 716 -121.278 181.892 5.21845 0.00287807 -0.0127699 -0.595334 0.803371 +VERTEX_SE3:QUAT 717 -119.569 178.068 5.30459 3.57043e-05 -0.0148418 -0.470827 0.882101 +VERTEX_SE3:QUAT 718 -116.783 174.721 5.39386 0.00502385 0.00138061 -0.370683 0.928745 +VERTEX_SE3:QUAT 719 -113.711 172.062 5.40423 0.00032265 0.00362261 -0.313251 0.949663 +VERTEX_SE3:QUAT 720 -110.262 169.602 5.40823 -0.00467379 0.00196528 -0.284671 0.958612 +VERTEX_SE3:QUAT 721 -106.712 167.25 5.40241 -0.00646404 0.00209859 -0.276299 0.961048 +VERTEX_SE3:QUAT 722 -103.115 164.924 5.43554 -0.00993513 -0.00596356 -0.270903 0.962537 +VERTEX_SE3:QUAT 723 -99.5538 162.657 5.53293 -0.00577374 -0.00193727 -0.266399 0.963844 +VERTEX_SE3:QUAT 724 -96.0592 160.471 5.60571 -0.00342051 -0.00400836 -0.261933 0.965072 +VERTEX_SE3:QUAT 725 -92.2804 158.175 5.68431 -0.00284439 -0.00778545 -0.257382 0.966274 +VERTEX_SE3:QUAT 726 -88.414 155.886 5.71895 -0.000279871 -0.000850496 -0.25224 0.967664 +VERTEX_SE3:QUAT 727 -85.0205 153.873 5.74328 0.000194026 0.00679443 -0.257442 0.96627 +VERTEX_SE3:QUAT 728 -81.5429 151.764 5.73799 -0.00139669 0.00823651 -0.264031 0.964478 +VERTEX_SE3:QUAT 729 -78.0763 149.591 5.70494 -0.00465292 0.0019447 -0.270383 0.96274 +VERTEX_SE3:QUAT 730 -74.7264 147.427 5.72541 -0.00559543 -0.00878495 -0.273801 0.96173 +VERTEX_SE3:QUAT 731 -71.3772 145.24 5.81946 -0.00323321 -0.00310665 -0.274662 0.96153 +VERTEX_SE3:QUAT 732 -67.7842 142.967 5.91231 0.00365489 0.010216 -0.250314 0.968104 +VERTEX_SE3:QUAT 733 -64.0107 141.075 5.83816 0.00613658 0.00408491 -0.16727 0.985884 +VERTEX_SE3:QUAT 734 -59.8307 140.144 5.82247 0.00475118 -0.0022064 -0.0127504 0.999905 +VERTEX_SE3:QUAT 735 -55.698 140.598 5.8372 0.00605212 -0.0023118 0.158028 0.987413 +VERTEX_SE3:QUAT 736 -52.015 142.369 5.87406 0.00367867 0.00347891 0.314953 0.949094 +VERTEX_SE3:QUAT 737 -48.9585 145.243 5.8949 0.000691168 0.000413949 0.438414 0.898773 +VERTEX_SE3:QUAT 738 -46.6526 148.859 5.92512 0.00231137 -0.00086316 0.537088 0.843523 +VERTEX_SE3:QUAT 739 -45.1282 152.61 5.96686 -0.000696233 -0.0083648 0.579496 0.814932 +VERTEX_SE3:QUAT 740 -43.6551 156.469 6.01218 -0.00652719 0.00603679 0.56437 0.825474 +VERTEX_SE3:QUAT 741 -41.9829 160.164 5.96037 -0.00695707 0.00140049 0.521139 0.853442 +VERTEX_SE3:QUAT 742 -39.72 163.769 5.93595 -0.00749762 0.00163567 0.465549 0.884989 +VERTEX_SE3:QUAT 743 -37.1532 167.093 5.90771 -0.00632402 0.00115714 0.433689 0.90104 +VERTEX_SE3:QUAT 744 -34.4105 170.23 5.89666 -0.00681013 0.0020017 0.416319 0.909191 +VERTEX_SE3:QUAT 745 -31.5485 173.354 5.88055 -0.0040378 0.00305997 0.409911 0.912112 +VERTEX_SE3:QUAT 746 -28.66 176.43 5.86433 -0.000638599 0.00248626 0.407714 0.913106 +VERTEX_SE3:QUAT 747 -25.9576 179.331 5.86141 0.00197769 0.00451478 0.422527 0.906337 +VERTEX_SE3:QUAT 748 -23.3999 182.585 5.8546 0.00235938 -0.00111421 0.492423 0.870352 +VERTEX_SE3:QUAT 749 -21.726 186.568 5.8789 -0.00397053 0.0119766 0.647921 0.761603 +VERTEX_SE3:QUAT 750 -21.741 190.695 5.79461 0.000858912 0.0122592 0.783519 0.621246 +VERTEX_SE3:QUAT 751 -23.4067 194.672 5.75982 0.00428241 0.00994004 0.881472 0.472112 +VERTEX_SE3:QUAT 752 -26.3213 198.125 5.79067 -0.00565681 0.00826294 0.929069 0.369771 +VERTEX_SE3:QUAT 753 -29.5672 201.055 5.71609 -0.00646692 0.00782431 0.940078 0.340809 +VERTEX_SE3:QUAT 754 -32.6666 203.698 5.63189 -0.00140731 0.00773934 0.943932 0.330046 +VERTEX_SE3:QUAT 755 -35.9765 206.413 5.60423 -0.00441583 0.00837588 0.946938 0.321275 +VERTEX_SE3:QUAT 756 -39.3378 209.104 5.60087 -0.00578844 0.00879878 0.948319 0.317144 +VERTEX_SE3:QUAT 757 -42.7058 211.738 5.56823 -0.00205139 0.00495502 0.949335 0.314221 +VERTEX_SE3:QUAT 758 -46.0784 214.35 5.53107 0.00149753 0.00422869 0.950216 0.311558 +VERTEX_SE3:QUAT 759 -49.4055 216.888 5.52398 -0.0115759 0.00713864 0.950857 0.30933 +VERTEX_SE3:QUAT 760 -52.627 219.382 5.4538 -0.0157826 0.0114151 0.950106 0.311318 +VERTEX_SE3:QUAT 761 -56.0603 222.048 5.3459 -0.0100201 0.0112466 0.948605 0.316105 +VERTEX_SE3:QUAT 762 -59.4086 224.721 5.24377 -0.00452355 0.00998748 0.946317 0.323055 +VERTEX_SE3:QUAT 763 -62.7138 227.449 5.17367 4.798e-06 0.00966829 0.943949 0.329949 +VERTEX_SE3:QUAT 764 -65.9937 230.206 5.15929 -0.00589677 0.00895663 0.942169 0.334968 +VERTEX_SE3:QUAT 765 -69.1252 232.876 5.13624 -0.00315008 0.0035688 0.94163 0.336617 +VERTEX_SE3:QUAT 766 -72.1984 235.486 5.13042 -0.00640198 0.00668314 0.948188 0.317576 +VERTEX_SE3:QUAT 767 -75.5933 237.777 5.05184 -0.0132434 0.0128403 0.97653 0.214589 +VERTEX_SE3:QUAT 768 -79.7226 238.966 4.94968 -0.00589271 0.0153126 0.999562 0.0246106 +VERTEX_SE3:QUAT 769 -83.8454 238.527 4.93395 0.00117078 -0.0149543 -0.98563 0.168253 +VERTEX_SE3:QUAT 770 -87.5121 236.436 4.97654 0.00472139 -0.0107593 -0.925656 0.378185 +VERTEX_SE3:QUAT 771 -89.9347 232.892 4.98853 0.00667291 -0.0108017 -0.812033 0.583474 +VERTEX_SE3:QUAT 772 -90.3937 228.642 5.0204 0.0040048 -0.0104177 -0.644703 0.764352 +VERTEX_SE3:QUAT 773 -88.8178 224.66 5.09672 -0.0012871 -0.0133349 -0.462852 0.886334 +VERTEX_SE3:QUAT 774 -85.9107 221.486 5.24928 -0.00264009 0.00693808 -0.352008 0.935968 +VERTEX_SE3:QUAT 775 -82.6391 218.757 5.17916 -0.00104583 0.0182495 -0.319468 0.947421 +VERTEX_SE3:QUAT 776 -79.3184 216.179 5.02966 -0.000884977 0.0232961 -0.31101 0.950121 +VERTEX_SE3:QUAT 777 -75.8899 213.563 4.87179 0.00211301 0.0300061 -0.307036 0.951223 +VERTEX_SE3:QUAT 778 -72.4364 210.958 4.68318 0.000555559 0.0267507 -0.306485 0.951499 +VERTEX_SE3:QUAT 779 -68.9556 208.325 4.5113 -0.00233438 0.0227728 -0.309173 0.95073 +VERTEX_SE3:QUAT 780 -65.5228 205.707 4.33915 -0.0024094 0.0215837 -0.309181 0.950755 +VERTEX_SE3:QUAT 781 -62.0718 203.081 4.17514 0.000566061 0.0284333 -0.308291 0.950867 +VERTEX_SE3:QUAT 782 -58.6115 200.478 4.00161 -0.00161699 0.0321695 -0.306129 0.951445 +VERTEX_SE3:QUAT 783 -55.2617 197.955 3.7982 0.00197795 0.0290714 -0.30413 0.952185 +VERTEX_SE3:QUAT 784 -51.9574 195.515 3.58518 0.00115472 0.0230763 -0.301181 0.953287 +VERTEX_SE3:QUAT 785 -48.46 192.971 3.39111 0.000895406 0.0282202 -0.297576 0.954281 +VERTEX_SE3:QUAT 786 -45.089 190.566 3.18513 0.00170236 0.0291552 -0.291995 0.955974 +VERTEX_SE3:QUAT 787 -41.6982 188.199 3.01063 0.00653993 0.0296386 -0.289587 0.95667 +VERTEX_SE3:QUAT 788 -38.1357 185.671 2.76533 0.00433836 0.027114 -0.300746 0.953309 +VERTEX_SE3:QUAT 789 -35.009 183.043 2.61651 -0.00616043 0.00773241 -0.390732 0.920452 +VERTEX_SE3:QUAT 790 -32.6586 179.624 2.58762 -0.00683893 0.00911019 -0.545563 0.837992 +VERTEX_SE3:QUAT 791 -31.873 175.471 2.57218 -0.0083749 0.0064992 -0.724051 0.689665 +VERTEX_SE3:QUAT 792 -33.1665 171.465 2.6023 -0.0035308 0.0106161 -0.879113 0.476482 +VERTEX_SE3:QUAT 793 -36.2143 168.796 2.61494 -0.00100996 0.00665108 -0.973932 0.22674 +VERTEX_SE3:QUAT 794 -40.4263 168.055 2.63207 0.00429632 -0.00624008 0.998831 0.0477345 +VERTEX_SE3:QUAT 795 -44.2069 169.291 2.67045 0.00737245 -0.00675555 0.971671 0.236125 +VERTEX_SE3:QUAT 796 -47.6097 171.57 2.72621 -0.0370838 0.0104487 0.95182 0.304227 +VERTEX_SE3:QUAT 797 -50.8401 174.011 2.45545 -0.0305447 0.00670763 0.950657 0.308663 +VERTEX_SE3:QUAT 798 -54.3292 176.652 2.20996 -0.0297533 0.00646029 0.951803 0.305195 +VERTEX_SE3:QUAT 799 -57.8108 179.223 1.94592 -0.0281062 0.00787997 0.953369 0.300393 +VERTEX_SE3:QUAT 800 -61.2807 181.755 1.71286 -0.032235 0.00922636 0.953304 0.300145 +VERTEX_SE3:QUAT 801 -64.7405 184.281 1.4757 -0.0348335 0.00928985 0.953325 0.299787 +VERTEX_SE3:QUAT 802 -68.1833 186.793 1.22367 -0.0320776 0.00790964 0.953596 0.29927 +VERTEX_SE3:QUAT 803 -71.5935 189.278 0.958195 -0.029485 0.00793868 0.953961 0.298373 +VERTEX_SE3:QUAT 804 -75.1026 191.826 0.701837 -0.0344842 0.0109088 0.954203 0.296966 +VERTEX_SE3:QUAT 805 -78.5692 194.311 0.425655 -0.034067 0.00945498 0.954831 0.29504 +VERTEX_SE3:QUAT 806 -82.0081 196.758 0.172834 -0.037994 0.00943879 0.955286 0.293081 +VERTEX_SE3:QUAT 807 -85.4599 199.2 -0.134119 -0.0312147 0.0098717 0.956171 0.290974 +VERTEX_SE3:QUAT 808 -88.8616 201.567 -0.406285 -0.0308813 0.00949879 0.956806 0.288925 +VERTEX_SE3:QUAT 809 -92.2521 203.952 -0.671264 -0.0372088 0.0109866 0.952919 0.300733 +VERTEX_SE3:QUAT 810 -95.4383 206.473 -0.953147 -0.0237293 0.00260781 0.933319 0.358254 +VERTEX_SE3:QUAT 811 -98.0854 209.665 -1.11809 -0.0201849 0.000684143 0.868615 0.495076 +VERTEX_SE3:QUAT 812 -99.3941 213.776 -1.24205 -0.0157747 -0.00358883 0.732748 0.680308 +VERTEX_SE3:QUAT 813 -98.677 217.853 -1.29084 -0.017926 -0.00470509 0.541761 0.840328 +VERTEX_SE3:QUAT 814 -96.0096 220.981 -1.30734 -0.0185903 -0.00257059 0.28841 0.957323 +VERTEX_SE3:QUAT 815 -92.0346 222.204 -1.28811 -0.0189787 -0.00765783 0.0149818 0.999678 +VERTEX_SE3:QUAT 816 -88.0507 221.426 -1.18406 -0.0152048 -0.00961956 -0.185931 0.982398 +VERTEX_SE3:QUAT 817 -84.2858 219.218 -1.12769 -0.00129683 0.025125 -0.299255 0.953841 +VERTEX_SE3:QUAT 818 -80.7931 216.527 -1.29929 0.000233879 0.0252763 -0.317218 0.948016 +VERTEX_SE3:QUAT 819 -77.535 213.967 -1.45857 0.00146025 0.022294 -0.312095 0.949788 +VERTEX_SE3:QUAT 820 -74.0523 211.327 -1.61395 -0.00010719 0.0233387 -0.305632 0.951864 +VERTEX_SE3:QUAT 821 -70.8306 208.952 -1.76243 -0.00154343 0.0271971 -0.300283 0.953461 +VERTEX_SE3:QUAT 822 -67.5294 206.539 -1.95205 0.00157937 0.025048 -0.297052 0.954531 +VERTEX_SE3:QUAT 823 -64.1009 204.083 -2.13708 0.000695368 0.0227454 -0.295195 0.955166 +VERTEX_SE3:QUAT 824 -60.6305 201.61 -2.30825 0.00102398 0.0250304 -0.292927 0.955806 +VERTEX_SE3:QUAT 825 -57.0268 199.052 -2.49276 0.00385102 0.0284337 -0.293179 0.955627 +VERTEX_SE3:QUAT 826 -53.5972 196.614 -2.70704 0.00361878 0.0274782 -0.294519 0.955243 +VERTEX_SE3:QUAT 827 -50.2725 194.224 -2.89214 0.00335609 0.0274162 -0.296213 0.954723 +VERTEX_SE3:QUAT 828 -46.8296 191.728 -3.09843 0.00369561 0.0293018 -0.299264 0.953713 +VERTEX_SE3:QUAT 829 -43.5578 189.319 -3.2871 0.00264456 0.0314051 -0.301901 0.952818 +VERTEX_SE3:QUAT 830 -40.3189 186.924 -3.50922 0.00246876 0.0382117 -0.303082 0.952195 +VERTEX_SE3:QUAT 831 -37.038 184.468 -3.78623 0.00534923 0.0309394 -0.303884 0.952191 +VERTEX_SE3:QUAT 832 -33.78 182.041 -4.02041 0.00514736 0.0210844 -0.302285 0.952971 +VERTEX_SE3:QUAT 833 -30.372 179.542 -4.16427 0.00108148 0.00738527 -0.29686 0.954892 +VERTEX_SE3:QUAT 834 -27.0181 177.148 -4.19141 -0.00369791 0.00338594 -0.292617 0.956217 +VERTEX_SE3:QUAT 835 -23.6338 174.781 -4.1794 -0.0105248 -0.0113527 -0.289934 0.956922 +VERTEX_SE3:QUAT 836 -20.3097 172.507 -4.02944 -0.00838297 0.0158607 -0.287976 0.957469 +VERTEX_SE3:QUAT 837 -16.8855 169.981 -4.1326 0.00171761 0.0163911 -0.370402 0.928725 +VERTEX_SE3:QUAT 838 -14.9745 166.388 -4.17145 -0.00470188 -0.0162913 -0.66864 0.743393 +VERTEX_SE3:QUAT 839 -15.8825 162.242 -4.09044 -0.00299619 -0.0170548 -0.848408 0.52906 +VERTEX_SE3:QUAT 840 -18.2841 158.87 -4.02674 0.00166926 -0.0166607 -0.90153 0.432392 +VERTEX_SE3:QUAT 841 -21.0858 155.582 -3.9855 0.00264054 -0.016678 -0.90139 0.432678 +VERTEX_SE3:QUAT 842 -23.7636 152.375 -3.94062 0.00374586 -0.0163259 -0.897762 0.440163 +VERTEX_SE3:QUAT 843 -26.6151 148.781 -3.90475 0.00298852 -0.0180333 -0.891661 0.452336 +VERTEX_SE3:QUAT 844 -29.3778 145.056 -3.84724 0.00129225 -0.0149576 -0.885063 0.465228 +VERTEX_SE3:QUAT 845 -31.7184 141.773 -3.79649 0.000636107 -0.0165343 -0.87918 0.476202 +VERTEX_SE3:QUAT 846 -34.1488 138.163 -3.73248 0.00401541 -0.0182893 -0.873562 0.486352 +VERTEX_SE3:QUAT 847 -36.3557 134.77 -3.68149 0.00266703 -0.0201124 -0.871862 0.489331 +VERTEX_SE3:QUAT 848 -38.5824 131.35 -3.59647 -0.00353015 -0.0253248 -0.872112 0.488638 +VERTEX_SE3:QUAT 849 -41.0217 127.562 -3.44141 -0.0103396 -0.0190531 -0.874979 0.483676 +VERTEX_SE3:QUAT 850 -43.4801 123.936 -3.27653 -0.0171361 -0.0171172 -0.881056 0.472391 +VERTEX_SE3:QUAT 851 -45.806 120.587 -3.06754 -0.013602 -0.0112249 -0.880043 0.474567 +VERTEX_SE3:QUAT 852 -48.0856 117.198 -2.8881 -0.0165141 -0.00809957 -0.878705 0.477011 +VERTEX_SE3:QUAT 853 -50.6122 113.71 -2.71533 -0.0120985 -0.00641439 -0.901932 0.431662 +VERTEX_SE3:QUAT 854 -53.5409 110.885 -2.58442 -0.0109392 -0.00316512 -0.956507 0.291486 +VERTEX_SE3:QUAT 855 -57.57 109.696 -2.51029 0.0196562 0.00554371 0.999558 0.0215935 +VERTEX_SE3:QUAT 856 -61.6117 111.218 -2.37014 0.0154907 0.0134797 0.961001 0.275782 +VERTEX_SE3:QUAT 857 -64.9011 113.79 -2.29442 0.0131513 0.0201314 0.943136 0.331536 +VERTEX_SE3:QUAT 858 -68.0878 116.466 -2.24173 0.0134198 0.0205473 0.944961 0.326261 +VERTEX_SE3:QUAT 859 -71.4678 119.158 -2.18687 0.013325 0.0205746 0.949037 0.314211 +VERTEX_SE3:QUAT 860 -74.6907 121.636 -2.13697 0.00753031 0.0209173 0.951251 0.307615 +VERTEX_SE3:QUAT 861 -78.1078 124.217 -2.12688 0.00753108 0.0226485 0.952254 0.304372 +VERTEX_SE3:QUAT 862 -81.544 126.777 -2.11842 0.00765727 0.0228318 0.952899 0.302329 +VERTEX_SE3:QUAT 863 -85.0145 129.342 -2.10058 0.00509473 0.0233349 0.953153 0.301545 +VERTEX_SE3:QUAT 864 -88.6137 131.988 -2.11624 0.00488451 0.0209391 0.953152 0.301727 +VERTEX_SE3:QUAT 865 -92.2478 134.669 -2.12151 0.00416324 0.0187651 0.953303 0.301404 +VERTEX_SE3:QUAT 866 -96.005 137.417 -2.12711 0.00227864 0.017545 0.953155 0.301963 +VERTEX_SE3:QUAT 867 -99.2333 139.794 -2.14375 0.00184447 0.0153643 0.953009 0.302546 +VERTEX_SE3:QUAT 868 -102.527 142.215 -2.14984 -0.00187265 0.0131678 0.952975 0.302755 +VERTEX_SE3:QUAT 869 -105.768 144.616 -2.18359 -0.00167782 0.0125363 0.95284 0.303208 +VERTEX_SE3:QUAT 870 -109.103 147.1 -2.21589 -0.00267824 0.014334 0.952643 0.30374 +VERTEX_SE3:QUAT 871 -112.34 149.525 -2.264 -0.00249502 0.0141226 0.952478 0.304271 +VERTEX_SE3:QUAT 872 -115.719 152.05 -2.29989 -0.00403606 0.0151538 0.952687 0.303548 +VERTEX_SE3:QUAT 873 -118.996 154.474 -2.34809 -0.00461586 0.0143334 0.953042 0.302465 +VERTEX_SE3:QUAT 874 -122.282 156.931 -2.39977 -0.00401872 0.016368 0.952316 0.304647 +VERTEX_SE3:QUAT 875 -125.856 159.629 -2.46148 -0.00716972 0.0181008 0.950804 0.30918 +VERTEX_SE3:QUAT 876 -129.287 162.257 -2.5462 -0.00739561 0.0163064 0.94942 0.313497 +VERTEX_SE3:QUAT 877 -132.535 164.811 -2.63097 -0.00870463 0.0152207 0.9478 0.318382 +VERTEX_SE3:QUAT 878 -136.009 167.501 -2.72442 -0.00978272 0.0147475 0.956851 0.290039 +VERTEX_SE3:QUAT 879 -139.618 169.576 -2.80001 -0.00507702 0.0139699 0.983055 0.182705 +VERTEX_SE3:QUAT 880 -143.782 170.442 -2.83645 0.00107648 -0.0146514 -0.999666 0.0212662 +VERTEX_SE3:QUAT 881 -147.822 169.48 -2.83669 0.0019894 -0.0124739 -0.970004 0.24276 +VERTEX_SE3:QUAT 882 -151.184 166.725 -2.80852 -0.00074493 -0.0128998 -0.901616 0.432345 +VERTEX_SE3:QUAT 883 -153.617 163.192 -2.75227 -0.00311177 -0.00838859 -0.86862 0.495398 +VERTEX_SE3:QUAT 884 -155.869 159.475 -2.68879 -0.00541674 -0.00843983 -0.865014 0.501648 +VERTEX_SE3:QUAT 885 -157.949 156.027 -2.60596 -0.00645999 -0.00527613 -0.873563 0.48664 +VERTEX_SE3:QUAT 886 -160.366 152.706 -2.52441 -0.00255557 -0.00711589 -0.901869 0.431943 +VERTEX_SE3:QUAT 887 -163.275 149.768 -2.47149 -0.00173734 -0.00482508 -0.944336 0.328944 +VERTEX_SE3:QUAT 888 -166.959 147.965 -2.43267 0.00588053 -0.00620011 -0.993868 0.110243 +VERTEX_SE3:QUAT 889 -171.015 147.973 -2.47637 -0.001527 -0.00331016 0.993127 0.116983 +VERTEX_SE3:QUAT 890 -174.713 149.689 -2.47545 -0.00368255 0.00267127 0.957325 0.288978 +VERTEX_SE3:QUAT 891 -177.861 152.386 -2.54732 -0.0226134 0.016784 0.907958 0.418114 +VERTEX_SE3:QUAT 892 -179.452 156.151 -2.71009 0.00388314 0.000442208 0.721062 0.692859 +VERTEX_SE3:QUAT 893 -178.246 160.428 -2.74501 0.000591814 0.00626782 0.509578 0.860401 +VERTEX_SE3:QUAT 894 -175.679 163.963 -2.81646 -0.000899478 0.0089947 0.443565 0.896196 +VERTEX_SE3:QUAT 895 -172.826 167.487 -2.90307 -0.00282502 0.00729078 0.440904 0.89752 +VERTEX_SE3:QUAT 896 -170.104 170.871 -2.9656 -0.00279433 0.00793848 0.444084 0.895946 +VERTEX_SE3:QUAT 897 -167.263 174.477 -3.04182 -0.00223576 0.00956115 0.446596 0.894682 +VERTEX_SE3:QUAT 898 -164.687 177.738 -3.10836 -0.00372614 0.00873462 0.44609 0.894938 +VERTEX_SE3:QUAT 899 -161.663 181.558 -3.19288 -0.0021784 0.0119593 0.445274 0.895312 +VERTEX_SE3:QUAT 900 -159.067 184.826 -3.27975 -0.000512841 0.0107976 0.444758 0.895586 +VERTEX_SE3:QUAT 901 -156.398 188.179 -3.36125 -0.00232353 0.0105627 0.443741 0.89609 +VERTEX_SE3:QUAT 902 -153.717 191.537 -3.4475 -0.000951226 0.0117218 0.443787 0.896055 +VERTEX_SE3:QUAT 903 -151.011 194.901 -3.52443 -0.00257622 0.0132315 0.443006 0.896418 +VERTEX_SE3:QUAT 904 -148.365 198.194 -3.61944 -0.00202736 0.0129254 0.44255 0.896648 +VERTEX_SE3:QUAT 905 -145.611 201.63 -3.71794 -0.000501083 0.0159126 0.448007 0.893888 +VERTEX_SE3:QUAT 906 -143.141 204.953 -3.80706 -0.00380682 0.0119757 0.464734 0.885361 +VERTEX_SE3:QUAT 907 -140.801 208.259 -3.88855 -0.00344092 0.0141967 0.474075 0.880363 +VERTEX_SE3:QUAT 908 -138.292 211.944 -3.99427 -0.00348363 0.0125931 0.478452 0.878016 +VERTEX_SE3:QUAT 909 -135.9 215.461 -4.08011 -0.00161724 0.0137665 0.475791 0.879449 +VERTEX_SE3:QUAT 910 -133.46 218.917 -4.16965 -0.000584704 0.0157235 0.46234 0.886563 +VERTEX_SE3:QUAT 911 -130.913 222.18 -4.26908 -0.0049217 0.0164166 0.420571 0.907098 +VERTEX_SE3:QUAT 912 -127.732 224.945 -4.40734 -0.00371379 0.0198537 0.242015 0.970062 +VERTEX_SE3:QUAT 913 -123.679 225.505 -4.42466 -0.0261802 -0.00965953 -0.138028 0.990035 +VERTEX_SE3:QUAT 914 -120.152 223.575 -4.30179 -0.0199355 -0.00435192 -0.308876 0.950883 +VERTEX_SE3:QUAT 915 -116.756 220.825 -4.21556 -0.0155734 -0.00418283 -0.324294 0.945819 +VERTEX_SE3:QUAT 916 -113.491 218.232 -4.13877 -0.0155849 -0.00421174 -0.314668 0.949064 +VERTEX_SE3:QUAT 917 -110.298 215.756 -4.05557 -0.0116073 -1.3767e-05 -0.31373 0.949441 +VERTEX_SE3:QUAT 918 -107.136 213.301 -4.04627 -0.0108929 0.00608505 -0.313168 0.949616 +VERTEX_SE3:QUAT 919 -103.943 210.831 -4.05345 -0.010625 0.00537601 -0.311947 0.950025 +VERTEX_SE3:QUAT 920 -100.725 208.376 -4.05846 -0.0184199 -0.0207077 -0.310478 0.950176 +VERTEX_SE3:QUAT 921 -97.3373 205.796 -3.8517 -0.0174966 -0.0205067 -0.309245 0.9506 +VERTEX_SE3:QUAT 922 -93.9448 203.207 -3.63497 -0.0200514 -0.0224628 -0.30819 0.950848 +VERTEX_SE3:QUAT 923 -90.4759 200.571 -3.43202 -0.0141014 -0.019059 -0.30739 0.951288 +VERTEX_SE3:QUAT 924 -87.0607 197.992 -3.23837 -0.0131809 -0.0180702 -0.306372 0.951649 +VERTEX_SE3:QUAT 925 -83.5951 195.4 -3.06013 -0.0131993 -0.017411 -0.30627 0.951694 +VERTEX_SE3:QUAT 926 -80.1308 192.8 -2.87871 -0.0139405 -0.0176081 -0.305569 0.951905 +VERTEX_SE3:QUAT 927 -76.5636 190.169 -2.68944 -0.0140603 -0.0153555 -0.301131 0.953355 +VERTEX_SE3:QUAT 928 -73.0217 187.569 -2.5139 -0.0131613 -0.0133262 -0.299639 0.953869 +VERTEX_SE3:QUAT 929 -69.4501 184.966 -2.35904 -0.0160078 -0.0146323 -0.299978 0.9537 +VERTEX_SE3:QUAT 930 -65.9488 182.398 -2.19813 -0.01387 -0.0130979 -0.301197 0.953371 +VERTEX_SE3:QUAT 931 -62.4908 179.846 -2.04844 -0.013148 -0.0115587 -0.302753 0.952908 +VERTEX_SE3:QUAT 932 -59.1297 177.357 -1.90024 -0.0125761 -0.00994079 -0.303685 0.952638 +VERTEX_SE3:QUAT 933 -55.8908 174.956 -1.76341 -0.0128354 -0.00760049 -0.303874 0.952596 +VERTEX_SE3:QUAT 934 -52.4472 172.385 -1.63856 -0.0110422 -0.00926482 -0.304501 0.952403 +VERTEX_SE3:QUAT 935 -49.0577 169.836 -1.47833 -0.00746358 0.00501785 -0.311999 0.95004 +VERTEX_SE3:QUAT 936 -45.8404 167.259 -1.52619 -0.00459234 0.0182027 -0.316673 0.948349 +VERTEX_SE3:QUAT 937 -42.3344 165.216 -1.6604 0.000496668 0.0147007 -0.104741 0.994391 +VERTEX_SE3:QUAT 938 -38.0903 165.451 -1.78641 0.00426588 0.0119933 0.188387 0.982012 +VERTEX_SE3:QUAT 939 -34.5292 167.493 -1.87569 0.0108382 0.00944152 0.353126 0.935465 +VERTEX_SE3:QUAT 940 -31.6845 170.787 -1.89571 0.00931761 0.0152654 0.509852 0.860076 +VERTEX_SE3:QUAT 941 -30.2925 174.576 -1.92644 0.0105457 0.010032 0.656759 0.75396 +VERTEX_SE3:QUAT 942 -30.4493 178.921 -1.90968 0.0191248 0.0068847 0.805145 0.592729 +VERTEX_SE3:QUAT 943 -32.5154 182.751 -1.80762 0.018094 6.96615e-05 0.905839 0.423235 +VERTEX_SE3:QUAT 944 -35.4467 185.748 -1.68126 0.0300756 -0.00471896 0.940519 0.338373 +VERTEX_SE3:QUAT 945 -38.954 188.545 -1.39809 0.0323393 -0.00756629 0.948634 0.314627 +VERTEX_SE3:QUAT 946 -42.1467 191.013 -1.14561 0.0406177 -0.0094326 0.949889 0.309794 +VERTEX_SE3:QUAT 947 -45.4785 193.536 -0.838171 0.0339446 -0.00867128 0.950984 0.30725 +VERTEX_SE3:QUAT 948 -48.9027 196.1 -0.521904 0.0294841 -0.00572145 0.951654 0.305701 +VERTEX_SE3:QUAT 949 -52.3971 198.708 -0.226317 0.0294978 -0.0059602 0.95199 0.304646 +VERTEX_SE3:QUAT 950 -55.7889 201.222 0.0399733 0.0348109 -0.00713592 0.952169 0.303498 +VERTEX_SE3:QUAT 951 -59.3277 203.842 0.3048 0.036115 -0.0083621 0.952506 0.302256 +VERTEX_SE3:QUAT 952 -62.5246 206.195 0.574878 0.0287475 -0.00718535 0.953062 0.301322 +VERTEX_SE3:QUAT 953 -65.9637 208.728 0.85217 0.0257037 -0.0054653 0.953517 0.30019 +VERTEX_SE3:QUAT 954 -69.54 211.336 1.09999 0.0277869 -0.00789771 0.953725 0.299289 +VERTEX_SE3:QUAT 955 -73.0364 213.88 1.34934 0.0318454 -0.00735078 0.951958 0.30448 +VERTEX_SE3:QUAT 956 -76.5146 216.555 1.62029 0.0307399 -0.00681641 0.948961 0.313819 +VERTEX_SE3:QUAT 957 -79.8406 219.16 1.90178 0.0278602 -0.00541011 0.948122 0.316638 +VERTEX_SE3:QUAT 958 -83.1563 221.765 2.18189 -0.00287604 0.00609783 0.950749 0.309889 +VERTEX_SE3:QUAT 959 -86.7112 224.217 2.14574 -0.00285021 0.0080569 0.972797 0.231502 +VERTEX_SE3:QUAT 960 -90.6518 225.571 2.12153 0.00679684 0.00571686 0.998351 0.0567193 +VERTEX_SE3:QUAT 961 -95.0661 225.262 2.19735 -0.00211241 -0.00728424 -0.985163 0.171453 +VERTEX_SE3:QUAT 962 -98.6518 223.082 2.24577 -0.00732435 -0.00471368 -0.920146 0.391479 +VERTEX_SE3:QUAT 963 -101.1 219.651 2.30629 -0.00232968 -0.00379627 -0.831055 0.556172 +VERTEX_SE3:QUAT 964 -102.016 215.526 2.35147 -0.00634855 0.00172532 -0.699221 0.714875 +VERTEX_SE3:QUAT 965 -101.177 211.358 2.37885 -0.00893004 -0.000398941 -0.538004 0.842895 +VERTEX_SE3:QUAT 966 -98.9314 207.789 2.4206 -0.00782113 -0.00310025 -0.41484 0.909855 +VERTEX_SE3:QUAT 967 -95.9247 204.854 2.46486 -0.0150663 -0.0189305 -0.325478 0.94524 +VERTEX_SE3:QUAT 968 -92.6506 202.337 2.66345 -0.00959702 -0.0241656 -0.297155 0.954475 +VERTEX_SE3:QUAT 969 -89.2782 199.986 2.84522 -0.023656 -0.0222303 -0.298461 0.95387 +VERTEX_SE3:QUAT 970 -85.9586 197.555 3.03605 -0.0168337 -0.0202104 -0.299165 0.953839 +VERTEX_SE3:QUAT 971 -82.309 194.895 3.25233 -0.0134541 -0.0169549 -0.300855 0.953424 +VERTEX_SE3:QUAT 972 -78.8852 192.389 3.45569 -0.0141803 -0.0155398 -0.302158 0.953026 +VERTEX_SE3:QUAT 973 -75.2831 189.724 3.60135 -0.0163247 -0.0228456 -0.304646 0.952052 +VERTEX_SE3:QUAT 974 -72.0818 187.297 3.77114 -0.015137 -0.0223218 -0.310194 0.950291 +VERTEX_SE3:QUAT 975 -68.8681 184.833 3.96905 -0.0127109 -0.0137447 -0.310533 0.950378 +VERTEX_SE3:QUAT 976 -65.6447 182.373 4.14358 -0.0130127 -0.0133218 -0.308594 0.951012 +VERTEX_SE3:QUAT 977 -62.4653 179.961 4.29095 -0.0144764 -0.0169691 -0.306579 0.951584 +VERTEX_SE3:QUAT 978 -59.0027 177.367 4.44923 -0.0142454 -0.0168526 -0.303496 0.952577 +VERTEX_SE3:QUAT 979 -55.485 174.779 4.63369 -0.0130766 -0.0150071 -0.299625 0.953849 +VERTEX_SE3:QUAT 980 -52.1424 172.346 4.82844 -0.0123689 -0.0156457 -0.299401 0.953919 +VERTEX_SE3:QUAT 981 -48.9373 169.847 5.01671 -0.00903172 0.00404228 -0.361447 0.93234 +VERTEX_SE3:QUAT 982 -46.3319 166.641 5.00645 -0.0123206 0.01683 -0.508226 0.860971 +VERTEX_SE3:QUAT 983 -45.1956 162.505 4.97604 -0.0158198 0.0176823 -0.686185 0.72704 +VERTEX_SE3:QUAT 984 -45.7807 158.51 5.0086 -0.0105977 0.0140575 -0.812327 0.582936 +VERTEX_SE3:QUAT 985 -47.9662 154.848 5.00786 -0.00469157 0.0178437 -0.914977 0.403084 +VERTEX_SE3:QUAT 986 -51.2911 152.582 5.01783 -0.00848769 0.0193696 -0.98396 0.17713 +VERTEX_SE3:QUAT 987 -55.3517 152.211 5.08624 0.0119226 -0.0172826 0.997487 0.0676644 +VERTEX_SE3:QUAT 988 -59.3255 153.682 5.22122 -0.0030211 -0.00427351 0.973297 0.22949 +VERTEX_SE3:QUAT 989 -62.9168 155.869 5.214 -0.000346698 -0.00199979 0.959917 0.280276 +VERTEX_SE3:QUAT 990 -66.5887 158.387 5.19787 0.00263856 -0.0040271 0.957072 0.289811 +VERTEX_SE3:QUAT 991 -69.8768 160.703 5.24401 0.00570261 -0.00442162 0.955967 0.293385 +VERTEX_SE3:QUAT 992 -73.2485 163.109 5.33209 0.00233308 -0.00301534 0.955241 0.295803 +VERTEX_SE3:QUAT 993 -76.6541 165.563 5.39404 0.00633544 -0.00254475 0.954778 0.297242 +VERTEX_SE3:QUAT 994 -80.1074 168.07 5.44204 0.0110257 -0.00160875 0.954687 0.297404 +VERTEX_SE3:QUAT 995 -83.4845 170.508 5.50595 -0.00306811 0.00188739 0.954607 0.297848 +VERTEX_SE3:QUAT 996 -86.7689 172.88 5.52316 -0.00921335 0.000995472 0.954151 0.299183 +VERTEX_SE3:QUAT 997 -90.3629 175.489 5.49821 -0.00592097 -0.00262474 0.953686 0.300736 +VERTEX_SE3:QUAT 998 -93.8697 178.056 5.46836 -0.00107829 -0.00592881 0.952929 0.303134 +VERTEX_SE3:QUAT 999 -97.2455 180.562 5.49289 0.00860337 -0.00856522 0.952245 0.305094 +VERTEX_SE3:QUAT 1000 -100.584 183.06 5.59894 0.000187927 -0.00455057 0.95103 0.309065 +VERTEX_SE3:QUAT 1001 -104.008 185.733 5.66209 0.00618868 -0.00304932 0.945167 0.326515 +VERTEX_SE3:QUAT 1002 -107.17 188.53 5.74776 -0.00251545 -0.00133328 0.926953 0.375166 +VERTEX_SE3:QUAT 1003 -109.848 191.663 5.72159 -0.00887809 -0.00438567 0.887332 0.461024 +VERTEX_SE3:QUAT 1004 -111.629 195.275 5.68604 -0.01095 -0.00584968 0.807295 0.590017 +VERTEX_SE3:QUAT 1005 -111.989 199.623 5.66988 -0.00761953 -0.00212433 0.665678 0.746197 +VERTEX_SE3:QUAT 1006 -110.791 203.489 5.66748 -0.00607421 0.000611524 0.543219 0.839569 +VERTEX_SE3:QUAT 1007 -108.62 207.259 5.60149 -0.0099965 0.0072139 0.483017 0.875524 +VERTEX_SE3:QUAT 1008 -106.056 210.867 5.52183 -0.010911 0.00825788 0.460278 0.887669 +VERTEX_SE3:QUAT 1009 -103.625 214.074 5.44379 -0.00995387 0.00688869 0.451401 0.892239 +VERTEX_SE3:QUAT 1010 -101.076 217.287 5.37945 -0.00739388 0.00668439 0.44295 0.896491 +VERTEX_SE3:QUAT 1011 -98.5671 220.367 5.33101 -0.00958877 0.0102816 0.435341 0.900156 +VERTEX_SE3:QUAT 1012 -95.7581 223.679 5.2441 -0.00849919 0.00697323 0.429416 0.90304 +VERTEX_SE3:QUAT 1013 -92.8962 227.035 5.17854 -0.00707082 0.00819172 0.43076 0.902402 +VERTEX_SE3:QUAT 1014 -90.0667 230.379 5.11312 -0.00710047 0.00556814 0.428343 0.903571 +VERTEX_SE3:QUAT 1015 -87.2637 233.409 5.0636 -0.0121091 0.00511112 0.368616 0.929489 +VERTEX_SE3:QUAT 1016 -83.8437 235.784 4.98111 -0.0185148 0.014731 0.234287 0.97188 +VERTEX_SE3:QUAT 1017 -79.8261 236.943 4.87255 -0.0240973 0.00994133 0.0508876 0.998364 +VERTEX_SE3:QUAT 1018 -75.4222 236.393 4.8212 -0.0205991 0.0029221 -0.148622 0.988675 +VERTEX_SE3:QUAT 1019 -71.7577 234.625 4.83652 -0.0106136 0.0180884 -0.26223 0.964777 +VERTEX_SE3:QUAT 1020 -68.189 232.058 4.73416 -0.0126837 0.018655 -0.320018 0.947143 +VERTEX_SE3:QUAT 1021 -65.0714 229.538 4.65797 -0.018183 0.0131236 -0.326627 0.944887 +VERTEX_SE3:QUAT 1022 -61.811 226.886 4.59226 -0.0211039 0.0100616 -0.325479 0.94526 +VERTEX_SE3:QUAT 1023 -58.5789 224.259 4.57652 -0.0196439 0.00814989 -0.322214 0.946428 +VERTEX_SE3:QUAT 1024 -55.3622 221.686 4.59844 -0.0161473 0.0127318 -0.318964 0.947544 +VERTEX_SE3:QUAT 1025 -52.1988 219.191 4.58408 -0.0156378 0.00651469 -0.316926 0.948299 +VERTEX_SE3:QUAT 1026 -49.0409 216.704 4.56885 -0.0150275 0.00477906 -0.31442 0.949153 +VERTEX_SE3:QUAT 1027 -45.8753 214.245 4.55525 -0.0117416 0.0157836 -0.311882 0.949917 +VERTEX_SE3:QUAT 1028 -42.6447 211.767 4.49831 -0.00940215 0.01734 -0.308871 0.950899 +VERTEX_SE3:QUAT 1029 -39.3777 209.303 4.41331 -0.013273 0.0130225 -0.306237 0.951774 +VERTEX_SE3:QUAT 1030 -36.0814 206.828 4.34033 -0.0138763 0.011115 -0.304443 0.952365 +VERTEX_SE3:QUAT 1031 -32.8475 204.413 4.29972 -0.015079 0.0133017 -0.310936 0.950218 +VERTEX_SE3:QUAT 1032 -29.4561 201.653 4.28746 -0.0157737 0.0117335 -0.349005 0.936915 +VERTEX_SE3:QUAT 1033 -26.5275 198.643 4.2896 -0.0155454 0.0154199 -0.417254 0.908526 +VERTEX_SE3:QUAT 1034 -24.1359 195.109 4.22667 -0.0189554 0.0197114 -0.517218 0.855417 +VERTEX_SE3:QUAT 1035 -22.7774 191.274 4.21164 -0.0212698 0.0170482 -0.625722 0.779569 +VERTEX_SE3:QUAT 1036 -22.4998 187.188 4.2593 -0.0173521 0.0133936 -0.722011 0.691534 +VERTEX_SE3:QUAT 1037 -23.2452 183.129 4.29464 -0.0105661 0.0177738 -0.796074 0.604846 +VERTEX_SE3:QUAT 1038 -24.8041 179.199 4.31227 -0.0118087 0.0169626 -0.843006 0.537507 +VERTEX_SE3:QUAT 1039 -26.8408 175.556 4.362 -0.0120265 0.0163054 -0.875583 0.482643 +VERTEX_SE3:QUAT 1040 -29.5915 172.273 4.42861 -0.0131201 0.01201 -0.929528 0.368323 +VERTEX_SE3:QUAT 1041 -33.0104 169.968 4.51998 -0.0121135 0.00843871 -0.975162 0.220998 +VERTEX_SE3:QUAT 1042 -36.9371 168.877 4.6201 -0.0113828 0.0081057 -0.998177 0.0587114 +VERTEX_SE3:QUAT 1043 -41.0304 169.107 4.74675 0.0120719 -0.0070009 0.995506 0.0936637 +VERTEX_SE3:QUAT 1044 -44.8846 170.342 4.88543 0.0074596 0.00426146 0.980325 0.197201 +VERTEX_SE3:QUAT 1045 -48.7407 172.439 4.86311 -0.0243125 0.00829811 0.963076 0.268001 +VERTEX_SE3:QUAT 1046 -52.2391 174.805 4.6617 -0.0223352 0.00930996 0.957188 0.288455 +VERTEX_SE3:QUAT 1047 -55.5029 177.109 4.5085 -0.0237635 0.00729434 0.955631 0.293515 +VERTEX_SE3:QUAT 1048 -59.1092 179.693 4.32503 -0.0202417 0.0079829 0.955091 0.295514 +VERTEX_SE3:QUAT 1049 -62.4498 182.083 4.15271 -0.0177076 0.00730249 0.95531 0.294983 +VERTEX_SE3:QUAT 1050 -65.738 184.441 4.00616 -0.0241217 0.00885461 0.95499 0.295523 +VERTEX_SE3:QUAT 1051 -69.0195 186.806 3.85945 -0.0290352 0.0119413 0.954296 0.29721 +VERTEX_SE3:QUAT 1052 -72.488 189.316 3.64142 -0.0240885 0.00932788 0.95361 0.299935 +VERTEX_SE3:QUAT 1053 -75.7552 191.738 3.44321 -0.0198773 0.00719923 0.95248 0.303865 +VERTEX_SE3:QUAT 1054 -79.1955 194.308 3.26094 -0.0268006 0.0110054 0.951677 0.305732 +VERTEX_SE3:QUAT 1055 -82.4205 196.729 3.07594 -0.0287343 0.0125394 0.951525 0.305969 +VERTEX_SE3:QUAT 1056 -85.6973 199.187 2.86881 -0.0273356 0.0124633 0.951674 0.305636 +VERTEX_SE3:QUAT 1057 -89.0917 201.769 2.63596 -0.0221118 0.0145769 0.951155 0.307575 +VERTEX_SE3:QUAT 1058 -92.5571 204.377 2.41221 -0.0271402 0.0100662 0.94791 0.317221 +VERTEX_SE3:QUAT 1059 -95.8593 207.191 2.22246 -0.012884 0.00510573 0.924072 0.381967 +VERTEX_SE3:QUAT 1060 -98.3343 210.693 2.1304 -0.00979773 0.000857917 0.84367 0.536772 +VERTEX_SE3:QUAT 1061 -99.2116 214.865 2.07107 -0.00670846 0.00289275 0.70221 0.711932 +VERTEX_SE3:QUAT 1062 -98.3502 218.918 2.02748 -0.00900441 0.00241874 0.566105 0.82428 +VERTEX_SE3:QUAT 1063 -96.2556 222.664 1.96511 -0.00646242 0.00514774 0.475277 0.879797 +VERTEX_SE3:QUAT 1064 -93.8091 225.955 1.91549 -0.00746679 0.00446036 0.45134 0.89231 +VERTEX_SE3:QUAT 1065 -91.3089 229.204 1.87774 -0.00601128 0.00430421 0.451873 0.892052 +VERTEX_SE3:QUAT 1066 -88.6907 232.64 1.84025 -0.00608543 0.00226677 0.447995 0.894013 +VERTEX_SE3:QUAT 1067 -86.0568 235.649 1.80483 -0.0135206 0.0116295 0.363376 0.931472 +VERTEX_SE3:QUAT 1068 -82.4956 237.779 1.69923 -0.0173654 0.00910361 0.152304 0.988139 +VERTEX_SE3:QUAT 1069 -78.423 238.069 1.64539 -0.0201839 0.00490642 -0.06712 0.997529 +VERTEX_SE3:QUAT 1070 -74.5573 236.83 1.65054 -0.0162254 0.00158353 -0.20898 0.977784 +VERTEX_SE3:QUAT 1071 -71.0858 234.815 1.65038 -0.0120018 0.0136362 -0.283869 0.958691 +VERTEX_SE3:QUAT 1072 -67.628 232.287 1.58369 -0.0119726 0.0176794 -0.308699 0.95092 +VERTEX_SE3:QUAT 1073 -64.4211 229.854 1.51505 -0.0146557 0.0150206 -0.309368 0.950711 +VERTEX_SE3:QUAT 1074 -61.0666 227.329 1.43816 -0.0179412 0.0119816 -0.308049 0.951126 +VERTEX_SE3:QUAT 1075 -57.747 224.812 1.41413 -0.02081 0.00304013 -0.307798 0.951219 +VERTEX_SE3:QUAT 1076 -54.4156 222.273 1.45841 -0.0145483 0.00923571 -0.31028 0.950489 +VERTEX_SE3:QUAT 1077 -51.0532 219.683 1.45755 -0.0123019 0.00875844 -0.312011 0.949958 +VERTEX_SE3:QUAT 1078 -47.7611 217.132 1.44351 -0.012171 0.00628395 -0.312888 0.949691 +VERTEX_SE3:QUAT 1079 -44.5229 214.622 1.41068 -0.0121169 0.00925573 -0.313791 0.94937 +VERTEX_SE3:QUAT 1080 -41.1402 211.998 1.38621 -0.0107595 0.0171961 -0.313981 0.949213 +VERTEX_SE3:QUAT 1081 -37.994 209.54 1.32368 -0.0111429 0.0166591 -0.31441 0.949076 +VERTEX_SE3:QUAT 1082 -34.5287 206.861 1.24454 -0.01458 0.0113075 -0.314187 0.949182 +VERTEX_SE3:QUAT 1083 -31.3026 204.352 1.21182 -0.0155755 0.00446957 -0.313829 0.949341 +VERTEX_SE3:QUAT 1084 -27.9031 201.673 1.20836 -0.0130846 0.00522519 -0.325463 0.94545 +VERTEX_SE3:QUAT 1085 -24.6874 198.736 1.21824 -0.010516 0.0224087 -0.40445 0.914225 +VERTEX_SE3:QUAT 1086 -22.4312 195.344 1.12462 -0.0186605 0.0189534 -0.537108 0.843094 +VERTEX_SE3:QUAT 1087 -21.397 191.391 1.11748 -0.0199961 0.0150144 -0.672546 0.739633 +VERTEX_SE3:QUAT 1088 -21.731 187.376 1.17662 -0.0166202 0.0110013 -0.787736 0.61569 +VERTEX_SE3:QUAT 1089 -23.4467 183.594 1.23058 -0.00863202 0.0103356 -0.86875 0.495068 +VERTEX_SE3:QUAT 1090 -25.8712 180.146 1.26892 -0.00924616 0.00965695 -0.887827 0.459984 +VERTEX_SE3:QUAT 1091 -28.2582 176.921 1.31679 -0.0100343 0.00992765 -0.887184 0.461199 +VERTEX_SE3:QUAT 1092 -30.673 173.627 1.36523 -0.0118115 0.00774833 -0.88598 0.463507 +VERTEX_SE3:QUAT 1093 -33.0448 170.337 1.43861 -0.00885529 0.00974751 -0.884689 0.465995 +VERTEX_SE3:QUAT 1094 -35.4378 166.984 1.4887 -0.01136 0.00950188 -0.883201 0.46876 +VERTEX_SE3:QUAT 1095 -37.9778 163.383 1.55881 -0.0103925 0.00950492 -0.881532 0.471915 +VERTEX_SE3:QUAT 1096 -40.4207 159.887 1.62648 -0.0124947 0.00862513 -0.88531 0.464753 +VERTEX_SE3:QUAT 1097 -43.1048 156.497 1.72377 -0.0117559 0.00738542 -0.914537 0.404264 +VERTEX_SE3:QUAT 1098 -46.4275 153.792 1.77733 -0.00356642 0.0143061 -0.967027 0.254248 +VERTEX_SE3:QUAT 1099 -50.5145 152.511 1.80267 -0.00773431 0.0133678 -0.998215 0.0576965 +VERTEX_SE3:QUAT 1100 -54.5057 152.805 1.88319 0.0113076 -0.0118699 0.99384 0.109603 +VERTEX_SE3:QUAT 1101 -58.4254 154.373 2.01235 -0.000242946 -0.000625335 0.972922 0.231132 +VERTEX_SE3:QUAT 1102 -61.9549 156.51 2.00628 -0.00142562 -0.00180814 0.960303 0.278948 +VERTEX_SE3:QUAT 1103 -65.62 159.058 1.97927 -0.000825994 -0.00493588 0.953982 0.299822 +VERTEX_SE3:QUAT 1104 -68.7983 161.459 1.98776 0.0064187 -0.00458127 0.950888 0.309435 +VERTEX_SE3:QUAT 1105 -72.046 163.955 2.07641 0.00343575 -0.0034491 0.949779 0.312883 +VERTEX_SE3:QUAT 1106 -75.1987 166.405 2.14239 0.00710526 -0.00214577 0.949672 0.313157 +VERTEX_SE3:QUAT 1107 -78.705 169.133 2.19249 0.00671819 -0.00178401 0.94971 0.313053 +VERTEX_SE3:QUAT 1108 -81.9808 171.655 2.23285 -0.00209702 0.000663266 0.949711 0.313119 +VERTEX_SE3:QUAT 1109 -85.2163 174.165 2.25249 -0.00808832 0.000200167 0.94958 0.31342 +VERTEX_SE3:QUAT 1110 -88.7689 176.891 2.21626 -0.00589559 -0.00276355 0.950145 0.311739 +VERTEX_SE3:QUAT 1111 -92.0026 179.365 2.19366 -0.00408735 -0.00617187 0.950718 0.309967 +VERTEX_SE3:QUAT 1112 -95.4542 181.991 2.20501 0.00550599 -0.00771108 0.95155 0.307348 +VERTEX_SE3:QUAT 1113 -98.8687 184.55 2.27573 -0.00116364 -0.00335716 0.952346 0.305001 +VERTEX_SE3:QUAT 1114 -102.22 187.033 2.32011 0.00224726 -0.00434796 0.952493 0.30452 +VERTEX_SE3:QUAT 1115 -105.621 189.693 2.38493 0.00340223 -0.00123123 0.940876 0.338732 +VERTEX_SE3:QUAT 1116 -108.709 192.758 2.36344 -0.0100771 -0.00369171 0.902068 0.431461 +VERTEX_SE3:QUAT 1117 -110.724 196.485 2.30775 -0.0116709 -0.00557699 0.807299 0.590001 +VERTEX_SE3:QUAT 1118 -111.116 200.74 2.27974 -0.00915935 -0.00584817 0.671062 0.741321 +VERTEX_SE3:QUAT 1119 -109.774 204.939 2.27959 -0.0139239 0.00721629 0.534165 0.845235 +VERTEX_SE3:QUAT 1120 -107.518 208.557 2.17374 -0.0143098 0.00638039 0.462377 0.886545 +VERTEX_SE3:QUAT 1121 -104.761 212.004 2.08769 -0.0120569 0.00698748 0.436631 0.899533 +VERTEX_SE3:QUAT 1122 -102.207 215.1 2.01452 -0.0076368 0.00499508 0.437528 0.899159 +VERTEX_SE3:QUAT 1123 -99.6909 218.222 1.96268 -0.00777717 0.00314572 0.443292 0.896338 +VERTEX_SE3:QUAT 1124 -97.141 221.404 1.91915 -0.00856321 0.00780451 0.442636 0.896627 +VERTEX_SE3:QUAT 1125 -94.3846 224.807 1.8518 -0.00675034 0.00683156 0.439948 0.897972 +VERTEX_SE3:QUAT 1126 -91.6678 228.135 1.80127 -0.00520482 0.0043529 0.438646 0.898635 +VERTEX_SE3:QUAT 1127 -88.9738 231.436 1.76334 -0.00533978 0.00148672 0.43945 0.89825 +VERTEX_SE3:QUAT 1128 -86.3218 234.745 1.7435 -0.00949766 0.0132145 0.44572 0.895024 +VERTEX_SE3:QUAT 1129 -83.6928 238.145 1.62247 -0.0102569 0.0125831 0.45409 0.890808 +VERTEX_SE3:QUAT 1130 -81.1138 241.607 1.50987 -0.0105749 0.0124636 0.462637 0.886397 +VERTEX_SE3:QUAT 1131 -78.6284 245.092 1.41035 -0.0100724 0.00868981 0.466136 0.884613 +VERTEX_SE3:QUAT 1132 -75.9887 248.517 1.32614 -0.0143314 0.00692803 0.411549 0.911249 +VERTEX_SE3:QUAT 1133 -72.6427 251.276 1.23574 -0.0157314 0.00829973 0.258396 0.965875 +VERTEX_SE3:QUAT 1134 -68.6246 252.538 1.16932 -0.0207475 0.00249469 0.0452297 0.998758 +VERTEX_SE3:QUAT 1135 -64.3337 252.001 1.17856 -0.0211147 -0.00215396 -0.151075 0.988294 +VERTEX_SE3:QUAT 1136 -60.632 250.239 1.22123 -0.0131053 0.0147891 -0.252267 0.967456 +VERTEX_SE3:QUAT 1137 -56.9287 247.833 1.15613 -0.00716347 0.0130486 -0.283167 0.958955 +VERTEX_SE3:QUAT 1138 -53.5881 245.502 1.09643 -0.00667907 0.00487049 -0.294441 0.955634 +VERTEX_SE3:QUAT 1139 -50.1921 243.039 1.06851 -0.00443391 0.00371128 -0.300437 0.953784 +VERTEX_SE3:QUAT 1140 -46.7876 240.512 1.07068 -0.00309895 0.00364215 -0.30462 0.952462 +VERTEX_SE3:QUAT 1141 -43.3992 237.998 1.0818 -0.00703083 0.00416268 -0.305532 0.952147 +VERTEX_SE3:QUAT 1142 -40.0349 235.477 1.09722 -0.0102794 0.00439591 -0.305867 0.952009 +VERTEX_SE3:QUAT 1143 -36.793 233.038 1.08334 -0.0106311 0.00268308 -0.305644 0.952083 +VERTEX_SE3:QUAT 1144 -33.1468 230.307 1.07674 -0.0106645 0.00651057 -0.304546 0.952416 +VERTEX_SE3:QUAT 1145 -29.5855 227.644 1.05725 -0.00792843 0.0135211 -0.30339 0.952738 +VERTEX_SE3:QUAT 1146 -26.0814 225.04 1.00044 -0.00427429 0.0129284 -0.3018 0.953274 +VERTEX_SE3:QUAT 1147 -22.6322 222.5 0.935494 -0.0054433 0.00795203 -0.300361 0.953777 +VERTEX_SE3:QUAT 1148 -19.306 220.073 0.8979 -0.00846434 0.00252254 -0.300301 0.953804 +VERTEX_SE3:QUAT 1149 -15.8497 217.48 0.892895 -0.0126876 0.00701528 -0.327366 0.944787 +VERTEX_SE3:QUAT 1150 -12.7976 214.53 0.897794 -0.0121743 0.0231002 -0.423659 0.905445 +VERTEX_SE3:QUAT 1151 -10.7482 210.877 0.812365 -0.0141282 0.0162919 -0.573804 0.818709 +VERTEX_SE3:QUAT 1152 -10.1115 206.506 0.809889 -0.0171414 0.0115471 -0.718262 0.695466 +VERTEX_SE3:QUAT 1153 -10.9895 202.566 0.868674 -0.0156348 0.00778491 -0.819266 0.573147 +VERTEX_SE3:QUAT 1154 -12.9078 198.956 0.9357 -0.00948031 0.00565088 -0.872472 0.488539 +VERTEX_SE3:QUAT 1155 -15.2897 195.534 1.00829 -0.00930475 0.00373142 -0.886742 0.462157 +VERTEX_SE3:QUAT 1156 -17.8211 192.156 1.09134 -0.0126741 0.00143922 -0.892759 0.450353 +VERTEX_SE3:QUAT 1157 -20.3513 188.895 1.18511 -0.016621 0.00595199 -0.894956 0.445805 +VERTEX_SE3:QUAT 1158 -22.8892 185.661 1.30297 -0.00492595 0.00957857 -0.893094 0.449742 +VERTEX_SE3:QUAT 1159 -25.4243 182.393 1.3191 -0.00664647 0.00669512 -0.892329 0.451288 +VERTEX_SE3:QUAT 1160 -27.9786 179.064 1.35527 -0.00652075 0.00700512 -0.891189 0.453531 +VERTEX_SE3:QUAT 1161 -30.5548 175.7 1.40244 -0.00597659 0.00746444 -0.890912 0.454076 +VERTEX_SE3:QUAT 1162 -33.1064 172.309 1.45037 -0.00890511 0.00895439 -0.890349 0.455104 +VERTEX_SE3:QUAT 1163 -35.7225 168.857 1.49825 -0.00808942 0.00803957 -0.889934 0.455946 +VERTEX_SE3:QUAT 1164 -38.2779 165.489 1.55065 -0.00714689 0.00499123 -0.889453 0.456943 +VERTEX_SE3:QUAT 1165 -40.8036 162.13 1.60208 -0.00939548 0.00464471 -0.888807 0.458161 +VERTEX_SE3:QUAT 1166 -43.2625 158.817 1.67006 -0.0121283 0.00603137 -0.888341 0.458984 +VERTEX_SE3:QUAT 1167 -45.6499 155.606 1.75668 0.00198132 0.0104782 -0.887612 0.460468 +VERTEX_SE3:QUAT 1168 -48.1036 152.274 1.72329 -0.000457724 0.0085045 -0.886145 0.46333 +VERTEX_SE3:QUAT 1169 -50.5139 148.928 1.72163 -0.00224717 0.00816949 -0.884036 0.467343 +VERTEX_SE3:QUAT 1170 -52.9207 145.54 1.72932 -0.0046835 0.00893804 -0.883248 0.468798 +VERTEX_SE3:QUAT 1171 -55.3146 142.194 1.7457 -0.00809243 0.00620563 -0.888836 0.458111 +VERTEX_SE3:QUAT 1172 -58.0522 138.878 1.78428 -0.00548918 0.0127189 -0.922185 0.3865 +VERTEX_SE3:QUAT 1173 -61.5164 136.431 1.81105 -0.00631278 0.0127271 -0.97826 0.206896 +VERTEX_SE3:QUAT 1174 -65.5566 135.619 1.86457 0.00997898 -0.0114268 0.999884 0.00123527 +VERTEX_SE3:QUAT 1175 -69.7759 136.534 1.94729 0.0116949 -0.00828429 0.981932 0.188691 +VERTEX_SE3:QUAT 1176 -73.3984 138.643 2.02527 -0.000671234 -0.0014556 0.953823 0.300365 +VERTEX_SE3:QUAT 1177 -76.6911 141.34 2.03605 -0.0022039 0.0025122 0.941517 0.336949 +VERTEX_SE3:QUAT 1178 -79.9491 144.195 2.04069 0.00536215 0.00350346 0.940574 0.339527 +VERTEX_SE3:QUAT 1179 -83.2315 147.044 2.07911 0.00688137 0.00191462 0.941415 0.337174 +VERTEX_SE3:QUAT 1180 -86.2921 149.635 2.122 0.00536706 -0.00169518 0.943516 0.33128 +VERTEX_SE3:QUAT 1181 -89.6819 152.43 2.18659 0.000983915 0.00132384 0.946534 0.3226 +VERTEX_SE3:QUAT 1182 -93.1856 155.205 2.22834 -0.00327946 0.00336156 0.948885 0.315588 +VERTEX_SE3:QUAT 1183 -96.7762 157.99 2.21933 -0.00230531 0.002684 0.950329 0.311228 +VERTEX_SE3:QUAT 1184 -100.273 160.672 2.19861 -0.00069472 0.00324456 0.95104 0.30905 +VERTEX_SE3:QUAT 1185 -103.843 163.392 2.17069 9.58441e-05 0.0064834 0.9518 0.30665 +VERTEX_SE3:QUAT 1186 -107.136 165.865 2.17087 0.00381372 0.00516298 0.952456 0.304608 +VERTEX_SE3:QUAT 1187 -110.494 168.354 2.20936 -0.00244987 0.0040076 0.951153 0.308684 +VERTEX_SE3:QUAT 1188 -113.662 170.837 2.21657 0.00371881 0.000987967 0.94527 0.326267 +VERTEX_SE3:QUAT 1189 -116.974 173.756 2.25039 0.00319401 -0.00420784 0.92615 0.377118 +VERTEX_SE3:QUAT 1190 -119.576 176.866 2.2749 -0.0168381 -0.00116712 0.88394 0.467295 +VERTEX_SE3:QUAT 1191 -121.315 180.781 2.19151 -0.0132561 -0.00321032 0.79039 0.612452 +VERTEX_SE3:QUAT 1192 -121.535 185.21 2.13456 -0.00818394 -0.00449586 0.665008 0.746777 +VERTEX_SE3:QUAT 1193 -120.299 189.381 2.1289 -0.0116557 0.000771297 0.547075 0.837002 +VERTEX_SE3:QUAT 1194 -118.274 192.811 2.09392 -0.00518834 -9.84238e-05 0.477775 0.878467 +VERTEX_SE3:QUAT 1195 -115.965 196.112 2.09065 -0.00522534 -2.8421e-05 0.470074 0.882612 +VERTEX_SE3:QUAT 1196 -113.614 199.477 2.09329 -0.0054895 -0.00125601 0.470989 0.882121 +VERTEX_SE3:QUAT 1197 -111.299 202.797 2.09547 -0.00571867 -0.0031165 0.471939 0.881607 +VERTEX_SE3:QUAT 1198 -108.996 206.095 2.07951 -0.0102789 0.00735556 0.473626 0.880636 +VERTEX_SE3:QUAT 1199 -106.516 209.706 2.00214 -0.0119708 0.00528511 0.47567 0.879526 +VERTEX_SE3:QUAT 1200 -104.034 213.303 1.9338 -0.0126501 0.00352506 0.469048 0.883075 +VERTEX_SE3:QUAT 1201 -101.518 216.662 1.88181 -0.0104973 0.0025669 0.435895 0.899933 +VERTEX_SE3:QUAT 1202 -98.689 219.613 1.84807 -0.010069 0.00526939 0.347922 0.937455 +VERTEX_SE3:QUAT 1203 -94.9724 221.828 1.78876 -0.0131937 0.00287934 0.173929 0.984666 +VERTEX_SE3:QUAT 1204 -90.9103 222.431 1.78632 -0.0163315 -0.00357264 -0.0232008 0.999591 +VERTEX_SE3:QUAT 1205 -86.9538 221.443 1.84492 -0.0150718 -0.00409448 -0.202134 0.979233 +VERTEX_SE3:QUAT 1206 -83.1712 219.142 1.80785 0.000233671 0.0316197 -0.295737 0.954746 +VERTEX_SE3:QUAT 1207 -79.934 216.717 1.59455 -0.000762864 0.0340764 -0.310586 0.949934 +VERTEX_SE3:QUAT 1208 -76.6263 214.154 1.36565 -8.88865e-05 0.0307971 -0.312724 0.949345 +VERTEX_SE3:QUAT 1209 -73.0928 211.43 1.10154 -0.00208336 0.024103 -0.309225 0.950681 +VERTEX_SE3:QUAT 1210 -69.8928 209.013 0.889421 0.000156702 0.0251773 -0.304547 0.952164 +VERTEX_SE3:QUAT 1211 -66.4803 206.471 0.704488 0.00240553 0.0345399 -0.304804 0.951786 +VERTEX_SE3:QUAT 1212 -62.9664 203.837 0.459944 0.00166074 0.0323492 -0.306158 0.95143 +VERTEX_SE3:QUAT 1213 -59.5055 201.244 0.211328 -0.00146938 0.0322345 -0.306694 0.951261 +VERTEX_SE3:QUAT 1214 -56.3048 198.804 -0.0298242 -0.000278195 0.0324088 -0.306543 0.951305 +VERTEX_SE3:QUAT 1215 -52.7582 196.149 -0.284989 0.00313685 0.0375964 -0.305341 0.951496 +VERTEX_SE3:QUAT 1216 -49.4044 193.653 -0.52644 0.00239718 0.039462 -0.301897 0.952521 +VERTEX_SE3:QUAT 1217 -46.1425 191.246 -0.783344 0.00335254 0.0345075 -0.299447 0.953483 +VERTEX_SE3:QUAT 1218 -42.7658 188.804 -1.0655 -0.000811834 0.0310016 -0.298412 0.953933 +VERTEX_SE3:QUAT 1219 -39.4953 186.389 -1.29807 0.0021443 0.0368432 -0.311183 0.949633 +VERTEX_SE3:QUAT 1220 -36.3505 183.716 -1.54884 -0.0048966 0.0170772 -0.385125 0.922693 +VERTEX_SE3:QUAT 1221 -33.9453 180.263 -1.64359 -0.00625741 0.0177339 -0.535155 0.844545 +VERTEX_SE3:QUAT 1222 -32.9578 176.382 -1.71393 -0.0102179 0.0144407 -0.677896 0.734945 +VERTEX_SE3:QUAT 1223 -33.4292 172.316 -1.70775 -0.00503818 0.01137 -0.793007 0.609086 +VERTEX_SE3:QUAT 1224 -35.1045 168.33 -1.72905 -0.00811223 0.0113692 -0.855597 0.517454 +VERTEX_SE3:QUAT 1225 -37.2481 164.828 -1.70181 -0.00843923 0.0113988 -0.872131 0.489067 +VERTEX_SE3:QUAT 1226 -39.6303 161.171 -1.66177 -0.00860766 0.0120001 -0.878494 0.477525 +VERTEX_SE3:QUAT 1227 -42.0076 157.95 -1.61988 -0.0103675 0.0095533 -0.903053 0.429298 +VERTEX_SE3:QUAT 1228 -44.9811 155.078 -1.55672 0.000436405 0.0141957 -0.948894 0.315277 +VERTEX_SE3:QUAT 1229 -48.483 153.218 -1.56485 0.000242024 0.0167625 -0.985735 0.16747 +VERTEX_SE3:QUAT 1230 -52.7017 152.569 -1.54358 0.00423035 -0.0153698 0.999814 0.0108321 +VERTEX_SE3:QUAT 1231 -56.731 153.351 -1.4776 0.0114074 -0.0111989 0.987562 0.156417 +VERTEX_SE3:QUAT 1232 -60.5312 155.158 -1.43192 -0.00663648 -0.00415477 0.967023 0.25457 +VERTEX_SE3:QUAT 1233 -63.9482 157.383 -1.45949 -0.00701705 -0.0081517 0.95711 0.289525 +VERTEX_SE3:QUAT 1234 -67.3039 159.813 -1.471 -0.00135071 -0.00689423 0.952172 0.305482 +VERTEX_SE3:QUAT 1235 -70.7701 162.44 -1.42854 0.00698073 -0.00960742 0.950239 0.311295 +VERTEX_SE3:QUAT 1236 -74.2039 165.086 -1.36583 0.00499158 -0.00643509 0.950269 0.311324 +VERTEX_SE3:QUAT 1237 -77.6861 167.768 -1.3036 0.00116559 -0.00334203 0.950839 0.309665 +VERTEX_SE3:QUAT 1238 -81.1701 170.399 -1.25103 -0.00824903 -0.000804093 0.951346 0.308014 +VERTEX_SE3:QUAT 1239 -84.3707 172.817 -1.28355 -0.00561181 -0.00414778 0.952024 0.305945 +VERTEX_SE3:QUAT 1240 -87.8923 175.436 -1.32694 -0.00487487 -0.00803322 0.952868 0.303241 +VERTEX_SE3:QUAT 1241 -91.4321 178.039 -1.34375 -0.00761555 -0.00729677 0.953938 0.299818 +VERTEX_SE3:QUAT 1242 -94.9106 180.564 -1.35087 -0.00611994 -0.00776379 0.954261 0.298813 +VERTEX_SE3:QUAT 1243 -98.4739 183.171 -1.3305 -0.0030276 -0.00737789 0.952803 0.303483 +VERTEX_SE3:QUAT 1244 -101.839 185.72 -1.30818 0.003921 -0.00984406 0.949748 0.312837 +VERTEX_SE3:QUAT 1245 -105.105 188.339 -1.25084 0.00591091 -0.0084666 0.941859 0.33585 +VERTEX_SE3:QUAT 1246 -108.194 191.231 -1.18999 -0.0165118 -0.0047572 0.914363 0.404531 +VERTEX_SE3:QUAT 1247 -110.451 194.615 -1.25797 -0.0155903 -0.00609106 0.843101 0.537495 +VERTEX_SE3:QUAT 1248 -111.393 198.832 -1.29803 -0.00636997 -0.0080346 0.714969 0.699081 +VERTEX_SE3:QUAT 1249 -110.654 202.864 -1.27851 -0.00854877 -0.00356501 0.573108 0.819428 +VERTEX_SE3:QUAT 1250 -108.646 206.553 -1.30979 -0.0088614 0.00132886 0.47943 0.877534 +VERTEX_SE3:QUAT 1251 -106.247 209.803 -1.34343 -0.0102054 0.00407846 0.449393 0.893267 +VERTEX_SE3:QUAT 1252 -103.681 213.068 -1.38521 -0.00771321 0.00278345 0.447288 0.894353 +VERTEX_SE3:QUAT 1253 -101.057 216.421 -1.4196 -0.00684376 0.00280111 0.44876 0.893622 +VERTEX_SE3:QUAT 1254 -98.5351 219.669 -1.44877 -0.00554489 0.00206508 0.450694 0.892659 +VERTEX_SE3:QUAT 1255 -96.0854 222.857 -1.46867 -0.00749877 0.00286594 0.452629 0.891663 +VERTEX_SE3:QUAT 1256 -93.6793 226.025 -1.48493 -0.00698343 0.00197376 0.455095 0.890413 +VERTEX_SE3:QUAT 1257 -91.2373 229.292 -1.49646 -0.00589192 -0.000695503 0.456875 0.889511 +VERTEX_SE3:QUAT 1258 -88.7809 232.473 -1.51099 -0.00934069 -0.00141479 0.427838 0.903806 +VERTEX_SE3:QUAT 1259 -85.937 235.314 -1.53168 -0.0154909 0.00533475 0.330343 0.943719 +VERTEX_SE3:QUAT 1260 -82.1493 237.31 -1.59473 -0.0192409 0.00440518 0.151405 0.988275 +VERTEX_SE3:QUAT 1261 -78.1787 237.75 -1.61632 -0.0160994 0.000510101 -0.0300596 0.999418 +VERTEX_SE3:QUAT 1262 -74.2538 236.708 -1.58718 -0.0122763 0.00117808 -0.200167 0.979684 +VERTEX_SE3:QUAT 1263 -70.5697 234.573 -1.60785 -0.0110409 0.00728508 -0.287085 0.957814 +VERTEX_SE3:QUAT 1264 -67.2502 232.142 -1.64521 -0.0101987 0.0131305 -0.308909 0.950946 +VERTEX_SE3:QUAT 1265 -63.8577 229.538 -1.68198 -0.0121248 0.0132135 -0.313424 0.949444 +VERTEX_SE3:QUAT 1266 -60.3865 226.854 -1.7335 -0.0168935 0.00723704 -0.315012 0.94891 +VERTEX_SE3:QUAT 1267 -56.9932 224.204 -1.71938 -0.0172641 0.000750727 -0.314704 0.949033 +VERTEX_SE3:QUAT 1268 -53.6777 221.608 -1.67854 -0.0147188 0.00199369 -0.313651 0.949422 +VERTEX_SE3:QUAT 1269 -50.4506 219.093 -1.63594 -0.0100752 0.00748941 -0.312762 0.949748 +VERTEX_SE3:QUAT 1270 -47.0998 216.506 -1.62779 -0.00855489 0.00980565 -0.310476 0.950492 +VERTEX_SE3:QUAT 1271 -43.7285 213.937 -1.66933 -0.0102237 0.00770844 -0.308345 0.951189 +VERTEX_SE3:QUAT 1272 -40.2683 211.328 -1.71152 -0.0105524 0.00958576 -0.305987 0.951929 +VERTEX_SE3:QUAT 1273 -36.7239 208.686 -1.76683 -0.0113151 0.0141177 -0.30335 0.952707 +VERTEX_SE3:QUAT 1274 -33.2045 206.104 -1.81358 -0.0128635 0.0103751 -0.300612 0.953603 +VERTEX_SE3:QUAT 1275 -29.8679 203.653 -1.80841 -0.0106961 0.00697174 -0.30684 0.951675 +VERTEX_SE3:QUAT 1276 -26.4641 200.904 -1.80611 -0.0139731 0.00426997 -0.35717 0.933925 +VERTEX_SE3:QUAT 1277 -23.7586 197.795 -1.81491 -0.011371 0.0196367 -0.476014 0.879145 +VERTEX_SE3:QUAT 1278 -22.1772 194.124 -1.86996 -0.0148679 0.0133243 -0.611893 0.790688 +VERTEX_SE3:QUAT 1279 -21.8914 189.781 -1.84664 -0.0186827 0.0104938 -0.745099 0.666609 +VERTEX_SE3:QUAT 1280 -23.0232 185.887 -1.77614 -0.00578447 0.0128174 -0.832503 0.553843 +VERTEX_SE3:QUAT 1281 -25.1436 182.081 -1.78422 -0.00435843 0.00876476 -0.872917 0.487771 +VERTEX_SE3:QUAT 1282 -27.4322 178.656 -1.7659 -0.00578737 0.00997051 -0.880083 0.474681 +VERTEX_SE3:QUAT 1283 -29.7055 175.392 -1.74169 -0.00774566 0.0101246 -0.882141 0.470813 +VERTEX_SE3:QUAT 1284 -32.0353 172.089 -1.70685 -0.00870865 0.00804286 -0.883326 0.468609 +VERTEX_SE3:QUAT 1285 -34.3986 168.772 -1.69733 -0.00751468 0.00933573 -0.884164 0.467023 +VERTEX_SE3:QUAT 1286 -36.7205 165.514 -1.66315 -0.00845771 0.0104164 -0.884977 0.465442 +VERTEX_SE3:QUAT 1287 -39.0582 162.28 -1.62205 -0.00947774 0.0106166 -0.885756 0.463934 +VERTEX_SE3:QUAT 1288 -41.587 158.811 -1.56722 -0.0104565 0.00831677 -0.886595 0.462354 +VERTEX_SE3:QUAT 1289 -44.1043 155.345 -1.49816 -0.00201151 0.012371 -0.887187 0.46124 +VERTEX_SE3:QUAT 1290 -46.4619 152.134 -1.512 -0.00127881 0.0127877 -0.887692 0.460258 +VERTEX_SE3:QUAT 1291 -49.0636 148.598 -1.53438 -0.00304508 0.0141333 -0.888178 0.459272 +VERTEX_SE3:QUAT 1292 -51.7251 145.076 -1.54377 -0.00550859 0.0128487 -0.896008 0.443817 +VERTEX_SE3:QUAT 1293 -54.5633 141.802 -1.53563 -0.00727337 0.012534 -0.921338 0.388493 +VERTEX_SE3:QUAT 1294 -57.8665 139.175 -1.50892 -0.00206348 0.0132999 -0.96425 0.264651 +VERTEX_SE3:QUAT 1295 -61.8775 137.672 -1.48498 -0.00594337 0.0118729 -0.995131 0.0976578 +VERTEX_SE3:QUAT 1296 -66.1126 137.631 -1.41602 0.00908539 -0.0137281 0.996876 0.0772502 +VERTEX_SE3:QUAT 1297 -70.2401 139.058 -1.29302 -0.00605831 -0.00573708 0.974455 0.224428 +VERTEX_SE3:QUAT 1298 -73.6537 141.221 -1.31332 -0.00159847 0.000555935 0.95432 0.298782 +VERTEX_SE3:QUAT 1299 -77.0599 143.811 -1.32909 0.00340672 0.000165094 0.94946 0.313869 +VERTEX_SE3:QUAT 1300 -80.5461 146.56 -1.30921 0.00693702 -0.000135941 0.946617 0.322287 +VERTEX_SE3:QUAT 1301 -83.8851 149.279 -1.23047 0.00111068 -0.00188078 0.944514 0.328465 +VERTEX_SE3:QUAT 1302 -87.1284 151.976 -1.17454 0.000946187 -0.00256491 0.94412 0.329589 +VERTEX_SE3:QUAT 1303 -90.3138 154.614 -1.14959 0.00396021 -0.00178445 0.945841 0.324601 +VERTEX_SE3:QUAT 1304 -93.5853 157.236 -1.14017 -0.000638287 0.00191035 0.949512 0.313724 +VERTEX_SE3:QUAT 1305 -97.0365 159.848 -1.1482 -0.00682782 0.0027399 0.95346 0.30143 +VERTEX_SE3:QUAT 1306 -100.519 162.374 -1.17061 -0.00670784 0.00984553 0.95716 0.289313 +VERTEX_SE3:QUAT 1307 -104.071 164.792 -1.21467 0.00011108 0.00644857 0.959989 0.279963 +VERTEX_SE3:QUAT 1308 -107.542 167.078 -1.20103 0.00517911 0.00322234 0.961211 0.275748 +VERTEX_SE3:QUAT 1309 -111.205 169.456 -1.16398 0.00155206 -0.000338938 0.960687 0.27763 +VERTEX_SE3:QUAT 1310 -114.629 171.81 -1.11716 0.00055278 -0.0037915 0.951151 0.308704 +VERTEX_SE3:QUAT 1311 -117.698 174.469 -1.07997 -0.00707893 -0.00556349 0.921406 0.388497 +VERTEX_SE3:QUAT 1312 -120.156 177.793 -1.1283 -0.0142716 -0.00260913 0.861319 0.507857 +VERTEX_SE3:QUAT 1313 -121.531 181.874 -1.19548 -0.00878355 -0.00321901 0.763187 0.64611 +VERTEX_SE3:QUAT 1314 -121.428 186.136 -1.20294 -0.0101006 -0.00320154 0.638327 0.769693 +VERTEX_SE3:QUAT 1315 -119.938 190.106 -1.21623 -0.00864873 -0.00210723 0.521513 0.853197 +VERTEX_SE3:QUAT 1316 -117.537 193.72 -1.22376 -0.00504612 -0.00064179 0.459968 0.887921 +VERTEX_SE3:QUAT 1317 -115.112 196.913 -1.22638 -0.00370808 -0.00162615 0.452464 0.891773 +VERTEX_SE3:QUAT 1318 -112.645 200.141 -1.21767 -0.00477045 -0.00265179 0.453663 0.891157 +VERTEX_SE3:QUAT 1319 -110.148 203.447 -1.20017 -0.00839651 0.00282359 0.455958 0.889957 +VERTEX_SE3:QUAT 1320 -107.674 206.731 -1.25832 -0.00594174 0.00451443 0.456304 0.889793 +VERTEX_SE3:QUAT 1321 -105.167 210.067 -1.3032 -0.00841821 0.00596773 0.456463 0.889682 +VERTEX_SE3:QUAT 1322 -102.672 213.375 -1.35625 -0.00730718 0.00482816 0.457362 0.889238 +VERTEX_SE3:QUAT 1323 -100.213 216.669 -1.40084 -0.0073988 0.00324924 0.458496 0.88866 +VERTEX_SE3:QUAT 1324 -97.7729 219.948 -1.4351 -0.00580612 0.00392949 0.45986 0.887964 +VERTEX_SE3:QUAT 1325 -95.1939 223.434 -1.47044 -0.00608861 0.00445717 0.461781 0.886962 +VERTEX_SE3:QUAT 1326 -92.6886 226.862 -1.50474 -0.0070854 0.00293477 0.463461 0.886084 +VERTEX_SE3:QUAT 1327 -90.1843 230.312 -1.54217 -0.00737758 0.000496136 0.464365 0.885613 +VERTEX_SE3:QUAT 1328 -87.7413 233.7 -1.56588 -0.0108535 0.00425964 0.465004 0.885232 +VERTEX_SE3:QUAT 1329 -85.2432 237.155 -1.64129 -0.0111022 0.00783932 0.465663 0.884858 +VERTEX_SE3:QUAT 1330 -82.6846 240.705 -1.73208 -0.0113548 0.0074589 0.465884 0.884741 +VERTEX_SE3:QUAT 1331 -80.128 244.22 -1.81325 -0.0128336 0.00682553 0.453445 0.891166 +VERTEX_SE3:QUAT 1332 -77.3387 247.583 -1.89153 -0.0104622 0.00454708 0.401306 0.915873 +VERTEX_SE3:QUAT 1333 -74.1223 250.359 -1.94934 -0.0160497 0.00721312 0.292716 0.956037 +VERTEX_SE3:QUAT 1334 -70.1693 252.144 -2.02488 -0.0191566 0.00439731 0.125347 0.991918 +VERTEX_SE3:QUAT 1335 -65.8568 252.407 -2.04381 -0.0207391 -9.34095e-05 -0.0567551 0.998173 +VERTEX_SE3:QUAT 1336 -61.6514 251.122 -1.97706 -0.0143898 0.0125776 -0.213514 0.976753 +VERTEX_SE3:QUAT 1337 -58.25 249.021 -2.02901 -0.00653988 0.00730416 -0.294876 0.955485 +VERTEX_SE3:QUAT 1338 -54.8333 246.456 -2.08398 -0.00527115 0.00302921 -0.309778 0.950789 +VERTEX_SE3:QUAT 1339 -51.3084 243.743 -2.10081 -0.00266509 0.0083327 -0.311054 0.950352 +VERTEX_SE3:QUAT 1340 -47.8548 241.097 -2.12455 -0.00370815 0.00327209 -0.310528 0.950551 +VERTEX_SE3:QUAT 1341 -44.2969 238.39 -2.09458 -0.00501178 0.00114627 -0.308131 0.95133 +VERTEX_SE3:QUAT 1342 -40.8249 235.793 -2.07668 -0.00868108 0.000241535 -0.304705 0.952407 +VERTEX_SE3:QUAT 1343 -37.3441 233.217 -2.06261 -0.00802106 0.000948759 -0.300717 0.953679 +VERTEX_SE3:QUAT 1344 -33.7929 230.645 -2.05203 -0.00770892 0.00875659 -0.295629 0.955232 +VERTEX_SE3:QUAT 1345 -30.2711 228.135 -2.07791 -0.00377641 0.0104724 -0.289354 0.957158 +VERTEX_SE3:QUAT 1346 -26.7841 225.734 -2.12382 -0.00394671 0.0114102 -0.282797 0.959104 +VERTEX_SE3:QUAT 1347 -23.4072 223.472 -2.18811 -0.00492219 0.00560173 -0.278569 0.960387 +VERTEX_SE3:QUAT 1348 -19.765 221.015 -2.20425 -0.00499731 0.00534022 -0.292758 0.956159 +VERTEX_SE3:QUAT 1349 -16.444 218.487 -2.21897 -0.0104007 0.00540151 -0.337618 0.94121 +VERTEX_SE3:QUAT 1350 -13.4788 215.566 -2.19991 -0.0105401 0.0160138 -0.419981 0.90733 +VERTEX_SE3:QUAT 1351 -11.2724 212.01 -2.26626 -0.011176 0.0185874 -0.544357 0.838573 +VERTEX_SE3:QUAT 1352 -10.2854 208.028 -2.29528 -0.0124923 0.00893457 -0.670732 0.741541 +VERTEX_SE3:QUAT 1353 -10.6082 203.875 -2.24779 -0.01314 0.00634735 -0.780565 0.624904 +VERTEX_SE3:QUAT 1354 -12.237 199.839 -2.18732 -0.00864056 0.00272651 -0.854048 0.520115 +VERTEX_SE3:QUAT 1355 -14.649 196.156 -2.11716 -0.00614456 0.000465802 -0.88511 0.46534 +VERTEX_SE3:QUAT 1356 -17.028 192.895 -2.06 -0.00920618 0.000130821 -0.886319 0.462984 +VERTEX_SE3:QUAT 1357 -19.3769 189.605 -1.97376 -0.0106858 0.00392254 -0.883507 0.468279 +VERTEX_SE3:QUAT 1358 -21.8687 186.014 -1.88948 -0.00634621 0.00916107 -0.88034 0.474212 +VERTEX_SE3:QUAT 1359 -24.1326 182.699 -1.8706 -0.0041055 0.0101629 -0.87685 0.480638 +VERTEX_SE3:QUAT 1360 -26.5347 179.01 -1.85524 -0.00488496 0.0100506 -0.873064 0.487478 +VERTEX_SE3:QUAT 1361 -28.8855 175.371 -1.8323 -0.00688228 0.0125803 -0.878979 0.476645 +VERTEX_SE3:QUAT 1362 -31.2816 172.183 -1.79879 -0.0098368 0.00938711 -0.907351 0.420154 +VERTEX_SE3:QUAT 1363 -34.4208 169.356 -1.75804 -0.00593031 0.0103539 -0.958289 0.285553 +VERTEX_SE3:QUAT 1364 -38.4109 167.813 -1.69599 -0.00918273 0.011478 -0.996746 0.0792542 +VERTEX_SE3:QUAT 1365 -42.3813 167.989 -1.60696 0.00719579 -0.00626563 0.993682 0.111824 +VERTEX_SE3:QUAT 1366 -46.1025 169.533 -1.51794 -0.00660829 0.00333177 0.967528 0.252657 +VERTEX_SE3:QUAT 1367 -49.5819 171.91 -1.63901 -0.019904 0.00811182 0.953451 0.30078 +VERTEX_SE3:QUAT 1368 -52.7759 174.271 -1.79947 -0.0206942 0.00872437 0.952104 0.304949 +VERTEX_SE3:QUAT 1369 -55.9906 176.688 -1.95023 -0.0242237 0.00732056 0.95124 0.307411 +VERTEX_SE3:QUAT 1370 -59.4164 179.286 -2.15037 -0.0242175 0.00938934 0.950811 0.30868 +VERTEX_SE3:QUAT 1371 -62.6372 181.732 -2.33929 -0.0233528 0.0088327 0.951037 0.308067 +VERTEX_SE3:QUAT 1372 -65.8906 184.194 -2.52109 -0.0256805 0.00914451 0.951221 0.307304 +VERTEX_SE3:QUAT 1373 -69.3404 186.81 -2.73497 -0.025609 0.0107684 0.951501 0.30639 +VERTEX_SE3:QUAT 1374 -72.6678 189.323 -2.93567 -0.0284745 0.0107385 0.951531 0.306042 +VERTEX_SE3:QUAT 1375 -76.2003 191.973 -3.16416 -0.029683 0.0101426 0.95134 0.306544 +VERTEX_SE3:QUAT 1376 -79.5778 194.518 -3.39476 -0.0282968 0.0111406 0.951476 0.306217 +VERTEX_SE3:QUAT 1377 -82.7801 196.911 -3.60973 -0.0284271 0.00981964 0.951991 0.304647 +VERTEX_SE3:QUAT 1378 -86.1739 199.429 -3.83836 -0.0294352 0.01032 0.952883 0.30173 +VERTEX_SE3:QUAT 1379 -89.4234 201.805 -4.06545 -0.0275878 0.0122121 0.95342 0.300135 +VERTEX_SE3:QUAT 1380 -92.7839 204.303 -4.31971 -0.0346688 0.012136 0.946952 0.31927 +VERTEX_SE3:QUAT 1381 -95.7877 206.983 -4.58404 -0.0317157 0.0121828 0.920957 0.38818 +VERTEX_SE3:QUAT 1382 -98.2656 210.498 -4.85911 -0.0273597 0.00302218 0.842229 0.538417 +VERTEX_SE3:QUAT 1383 -99.0733 214.72 -5.0238 -0.0203503 0.0004371 0.700611 0.713253 +VERTEX_SE3:QUAT 1384 -98.1678 218.74 -5.13074 -0.018433 -0.00249452 0.557641 0.829874 +VERTEX_SE3:QUAT 1385 -96.0061 222.306 -5.17229 -0.00802973 -0.0037638 0.457112 0.889365 +VERTEX_SE3:QUAT 1386 -93.3912 225.579 -5.16533 -0.00794259 -0.00273819 0.435364 0.900215 +VERTEX_SE3:QUAT 1387 -90.8159 228.767 -5.16345 -0.00929275 -0.000357692 0.448972 0.893497 +VERTEX_SE3:QUAT 1388 -88.3534 232.016 -5.17768 -0.0101994 -0.000733326 0.456902 0.889458 +VERTEX_SE3:QUAT 1389 -85.7894 235.421 -5.23215 -0.0143621 0.00709536 0.45397 0.890873 +VERTEX_SE3:QUAT 1390 -83.2829 238.761 -5.33208 -0.0205503 0.00942972 0.457077 0.889139 +VERTEX_SE3:QUAT 1391 -80.7619 242.153 -5.45773 -0.0165425 0.0105062 0.463761 0.885744 +VERTEX_SE3:QUAT 1392 -78.3526 245.561 -5.57263 -0.0189159 0.0092145 0.466123 0.884469 +VERTEX_SE3:QUAT 1393 -75.7232 249.025 -5.68891 -0.0245433 0.00261713 0.416067 0.908999 +VERTEX_SE3:QUAT 1394 -72.6213 251.813 -5.7619 -0.0279877 0.000232045 0.287576 0.957349 +VERTEX_SE3:QUAT 1395 -68.7418 253.311 -5.78294 -0.0259843 -0.00378882 0.0775281 0.996644 +VERTEX_SE3:QUAT 1396 -64.4535 252.986 -5.74136 -0.0239124 -0.00853783 -0.133426 0.990733 +VERTEX_SE3:QUAT 1397 -60.7862 251.331 -5.62574 -0.01193 0.00971807 -0.246965 0.968902 +VERTEX_SE3:QUAT 1398 -57.0767 248.891 -5.67238 -0.0111463 0.00291473 -0.298577 0.954316 +VERTEX_SE3:QUAT 1399 -53.7022 246.348 -5.65015 -0.00727809 -0.001462 -0.308307 0.951258 +VERTEX_SE3:QUAT 1400 -50.2107 243.705 -5.61089 -0.00723805 -0.00459642 -0.308964 0.951035 +VERTEX_SE3:QUAT 1401 -47.0113 241.27 -5.55527 -0.00695967 -0.00307862 -0.308876 0.951072 +VERTEX_SE3:QUAT 1402 -43.7554 238.791 -5.50283 -0.0059327 -0.00206364 -0.308726 0.95113 +VERTEX_SE3:QUAT 1403 -40.1678 236.093 -5.45032 -0.0119216 -0.00494368 -0.311179 0.950264 +VERTEX_SE3:QUAT 1404 -36.7887 233.471 -5.36441 -0.0132435 -0.00537705 -0.319173 0.947589 +VERTEX_SE3:QUAT 1405 -33.3942 230.716 -5.30504 -0.00977952 0.00775809 -0.32821 0.944522 +VERTEX_SE3:QUAT 1406 -30.0374 227.902 -5.31936 -0.00796516 0.00461381 -0.330599 0.943726 +VERTEX_SE3:QUAT 1407 -26.8321 225.186 -5.31356 -0.00321072 0.00326895 -0.331569 0.94342 +VERTEX_SE3:QUAT 1408 -23.7567 222.632 -5.2995 -0.00577503 0.000296222 -0.32782 0.944722 +VERTEX_SE3:QUAT 1409 -20.4499 219.946 -5.26544 -0.00495344 0.00216864 -0.321272 0.946972 +VERTEX_SE3:QUAT 1410 -17.0733 217.264 -5.22964 -0.0128101 -0.0069598 -0.323861 0.945992 +VERTEX_SE3:QUAT 1411 -13.967 214.548 -5.10081 -0.0086138 0.012386 -0.373706 0.927424 +VERTEX_SE3:QUAT 1412 -11.2289 211.269 -5.1539 -0.0101254 0.0115247 -0.467792 0.883706 +VERTEX_SE3:QUAT 1413 -9.50682 207.382 -5.17448 -0.00966731 0.00857293 -0.628089 0.778034 +VERTEX_SE3:QUAT 1414 -9.62202 203.389 -5.14134 -0.00677463 0.00535799 -0.787113 0.616748 +VERTEX_SE3:QUAT 1415 -11.4024 199.617 -5.10978 -0.0127423 -0.00146641 -0.876442 0.481336 +VERTEX_SE3:QUAT 1416 -13.8796 196.332 -4.99065 -0.00789862 -0.00211586 -0.896925 0.442108 +VERTEX_SE3:QUAT 1417 -16.6433 193.001 -4.90093 -0.00942791 -0.00388842 -0.903517 0.428432 +VERTEX_SE3:QUAT 1418 -19.2243 189.949 -4.79606 -0.0103567 -0.00329267 -0.900083 0.435583 +VERTEX_SE3:QUAT 1419 -21.826 186.724 -4.69529 -0.00611899 -0.000299385 -0.894638 0.446749 +VERTEX_SE3:QUAT 1420 -24.4307 183.362 -4.65067 -0.00263513 0.00331221 -0.892603 0.450824 +VERTEX_SE3:QUAT 1421 -27.1019 179.935 -4.6346 -0.00259077 0.00486081 -0.895167 0.445697 +VERTEX_SE3:QUAT 1422 -29.689 176.688 -4.61326 -0.00267363 0.00319352 -0.895105 0.445836 +VERTEX_SE3:QUAT 1423 -32.3966 173.218 -4.59006 -0.00559752 0.00678515 -0.894396 0.447189 +VERTEX_SE3:QUAT 1424 -34.9598 169.944 -4.55817 -0.0137012 0.00499122 -0.893805 0.448219 +VERTEX_SE3:QUAT 1425 -37.4287 166.774 -4.46949 -0.0106281 0.00518758 -0.892744 0.450409 +VERTEX_SE3:QUAT 1426 -39.993 163.437 -4.38401 -0.00977166 0.00297756 -0.891225 0.453446 +VERTEX_SE3:QUAT 1427 -42.4355 160.205 -4.29336 -0.0106729 0.00340214 -0.889642 0.456521 +VERTEX_SE3:QUAT 1428 -44.9969 156.783 -4.19763 -0.00285254 0.00564313 -0.888702 0.458442 +VERTEX_SE3:QUAT 1429 -47.393 153.554 -4.18864 -0.00131872 0.00556265 -0.887976 0.459854 +VERTEX_SE3:QUAT 1430 -49.7812 150.31 -4.19733 -0.00157086 0.00607797 -0.887183 0.461375 +VERTEX_SE3:QUAT 1431 -52.2514 146.957 -4.19035 -0.00144247 0.00366539 -0.888297 0.459253 +VERTEX_SE3:QUAT 1432 -54.8283 143.511 -4.18001 -0.00613159 0.0141604 -0.90032 0.434955 +VERTEX_SE3:QUAT 1433 -57.8125 140.348 -4.15302 -0.0121954 0.0084408 -0.93732 0.348155 +VERTEX_SE3:QUAT 1434 -61.4237 138.216 -4.06868 -0.0108714 0.00434109 -0.983151 0.18242 +VERTEX_SE3:QUAT 1435 -65.5604 137.453 -3.99344 -0.00763569 0.00937209 -0.999918 0.00429456 +VERTEX_SE3:QUAT 1436 -69.4996 138.132 -3.93175 0.00198603 -0.00325068 0.987609 0.156887 +VERTEX_SE3:QUAT 1437 -73.2386 140.036 -3.94604 -0.0105968 0.00348353 0.96124 0.275489 +VERTEX_SE3:QUAT 1438 -76.4882 142.391 -4.01878 -0.0031479 0.00591782 0.95097 0.309209 +VERTEX_SE3:QUAT 1439 -79.7676 144.961 -4.04574 -0.00359917 0.0052911 0.947655 0.319232 +VERTEX_SE3:QUAT 1440 -83.0471 147.603 -4.0651 -0.000588002 0.00685917 0.94672 0.321985 +VERTEX_SE3:QUAT 1441 -86.31 150.201 -4.06762 -0.00207804 0.00262665 0.947575 0.319517 +VERTEX_SE3:QUAT 1442 -89.6068 152.799 -4.06358 0.000790641 -0.000511979 0.948055 0.318106 +VERTEX_SE3:QUAT 1443 -92.8409 155.354 -4.04565 -0.00911809 0.00385525 0.948297 0.31723 +VERTEX_SE3:QUAT 1444 -96.1115 157.936 -4.12842 -0.012788 0.00633166 0.948446 0.316616 +VERTEX_SE3:QUAT 1445 -99.4482 160.574 -4.23645 -0.00701106 0.0080797 0.948944 0.315262 +VERTEX_SE3:QUAT 1446 -102.845 163.247 -4.29631 -0.00421811 0.0103183 0.949546 0.313429 +VERTEX_SE3:QUAT 1447 -106.256 165.882 -4.33933 -0.00265411 0.0109533 0.950406 0.310807 +VERTEX_SE3:QUAT 1448 -109.556 168.39 -4.36731 -0.00276924 0.0116759 0.951985 0.305908 +VERTEX_SE3:QUAT 1449 -113.031 170.919 -4.39717 -0.00156395 0.00189152 0.95375 0.300592 +VERTEX_SE3:QUAT 1450 -116.322 173.347 -4.39769 0.00161563 -0.000644816 0.948433 0.316973 +VERTEX_SE3:QUAT 1451 -119.494 176.18 -4.37214 -0.0199722 -0.000266022 0.915822 0.401087 +VERTEX_SE3:QUAT 1452 -121.793 179.794 -4.51749 -0.0179694 -0.000409697 0.830362 0.556935 +VERTEX_SE3:QUAT 1453 -122.592 183.796 -4.61228 -0.0197176 0.00230798 0.712936 0.700949 +VERTEX_SE3:QUAT 1454 -121.807 187.926 -4.72178 -0.0204638 -0.000720629 0.569872 0.821478 +VERTEX_SE3:QUAT 1455 -119.781 191.513 -4.76614 -0.0107842 -0.00411439 0.473113 0.880926 +VERTEX_SE3:QUAT 1456 -117.253 194.903 -4.74918 -0.0108396 -0.00387825 0.449109 0.893403 +VERTEX_SE3:QUAT 1457 -114.643 198.255 -4.74838 -0.0111204 -0.00365678 0.449658 0.893124 +VERTEX_SE3:QUAT 1458 -112.143 201.527 -4.74302 -0.0106516 -0.00352284 0.453745 0.891061 +VERTEX_SE3:QUAT 1459 -109.63 204.828 -4.76385 -0.0130822 0.00544393 0.456694 0.889511 +VERTEX_SE3:QUAT 1460 -107.041 208.279 -4.85978 -0.012902 0.00382284 0.458979 0.888345 +VERTEX_SE3:QUAT 1461 -104.446 211.799 -4.94848 -0.0120487 0.00310266 0.460295 0.887679 +VERTEX_SE3:QUAT 1462 -101.868 215.291 -5.0218 -0.0145312 0.00506563 0.457475 0.889089 +VERTEX_SE3:QUAT 1463 -99.4736 218.518 -5.09559 -0.0187888 0.00121053 0.457825 0.888843 +VERTEX_SE3:QUAT 1464 -96.7943 222.094 -5.14414 -0.0120129 -0.000831172 0.460903 0.887369 +VERTEX_SE3:QUAT 1465 -94.3567 225.448 -5.16125 -0.0111977 -0.00271899 0.464909 0.885283 +VERTEX_SE3:QUAT 1466 -91.864 228.951 -5.16839 -0.0129517 -0.000410317 0.466964 0.884181 +VERTEX_SE3:QUAT 1467 -89.4667 232.186 -5.19949 -0.0123531 -0.00266103 0.440829 0.897502 +VERTEX_SE3:QUAT 1468 -86.584 235.362 -5.23584 -0.020023 0.00518332 0.365659 0.930519 +VERTEX_SE3:QUAT 1469 -83.1282 237.636 -5.31073 -0.0244312 0.00573877 0.186212 0.982189 +VERTEX_SE3:QUAT 1470 -79.1829 238.246 -5.34949 -0.0274977 -0.000374251 -0.0301278 0.999168 +VERTEX_SE3:QUAT 1471 -74.9657 237.158 -5.29089 -0.0213132 -0.00428571 -0.187963 0.981935 +VERTEX_SE3:QUAT 1472 -71.3598 235.27 -5.23007 -0.0129817 0.00382874 -0.256253 0.966515 +VERTEX_SE3:QUAT 1473 -67.9175 233.063 -5.21716 -0.0139036 0.00367335 -0.282109 0.959275 +VERTEX_SE3:QUAT 1474 -64.4315 230.648 -5.19983 -0.0188893 0.00191311 -0.294861 0.955352 +VERTEX_SE3:QUAT 1475 -61.1949 228.314 -5.15707 -0.0186762 0.0023874 -0.298321 0.95428 +VERTEX_SE3:QUAT 1476 -57.9399 225.922 -5.1123 -0.0201722 0.00154968 -0.305025 0.952129 +VERTEX_SE3:QUAT 1477 -54.6621 223.448 -5.05832 -0.0211484 -0.00150736 -0.30819 0.951088 +VERTEX_SE3:QUAT 1478 -51.4659 220.998 -4.97047 -0.0165958 -0.00541166 -0.307705 0.951322 +VERTEX_SE3:QUAT 1479 -48.24 218.571 -4.87089 -0.0170265 -0.00493242 -0.306644 0.951659 +VERTEX_SE3:QUAT 1480 -44.9919 216.125 -4.80014 -0.0125305 0.00473637 -0.306596 0.951745 +VERTEX_SE3:QUAT 1481 -41.4732 213.477 -4.79386 -0.0107398 0.00599443 -0.305328 0.952168 +VERTEX_SE3:QUAT 1482 -38.0182 210.893 -4.78931 -0.0143644 0.00820386 -0.309911 0.950622 +VERTEX_SE3:QUAT 1483 -34.7685 208.395 -4.77956 -0.0165427 0.00614418 -0.314051 0.949242 +VERTEX_SE3:QUAT 1484 -31.5145 205.848 -4.75741 -0.0182675 0.00199263 -0.321938 0.946583 +VERTEX_SE3:QUAT 1485 -28.4062 203.27 -4.68425 -0.0167848 -0.00478492 -0.339444 0.940464 +VERTEX_SE3:QUAT 1486 -25.2938 200.425 -4.56369 -0.0129893 0.00893269 -0.373053 0.927676 +VERTEX_SE3:QUAT 1487 -22.6199 197.4 -4.58871 -0.0125409 0.0116793 -0.452677 0.89151 +VERTEX_SE3:QUAT 1488 -20.793 193.802 -4.58592 -0.0187245 0.00567205 -0.601685 0.798494 +VERTEX_SE3:QUAT 1489 -20.6457 189.615 -4.49926 -0.0147688 -0.00080353 -0.777665 0.628505 +VERTEX_SE3:QUAT 1490 -22.2274 185.927 -4.3902 -0.00569784 0.00132241 -0.867506 0.497392 +VERTEX_SE3:QUAT 1491 -24.5502 182.568 -4.3608 -0.00353814 0.00152706 -0.887743 0.460324 +VERTEX_SE3:QUAT 1492 -26.9701 179.345 -4.33825 -0.00346984 0.00354114 -0.892568 0.450886 +VERTEX_SE3:QUAT 1493 -29.5174 176.098 -4.30081 -0.00337517 0.00123972 -0.895144 0.445763 +VERTEX_SE3:QUAT 1494 -32.149 172.771 -4.26773 -0.00413229 0.00380948 -0.896758 0.442485 +VERTEX_SE3:QUAT 1495 -34.6629 169.649 -4.22921 -0.0133166 0.000276321 -0.89735 0.441119 +VERTEX_SE3:QUAT 1496 -37.2015 166.452 -4.13023 -0.0111138 0.00176873 -0.894125 0.447676 +VERTEX_SE3:QUAT 1497 -39.8814 162.962 -4.0269 -0.0103593 -0.000350033 -0.890099 0.45565 +VERTEX_SE3:QUAT 1498 -42.2872 159.733 -3.92573 -0.0118202 0.00149299 -0.890063 0.455683 +VERTEX_SE3:QUAT 1499 -44.9011 156.529 -3.82122 -0.00433288 0.00621918 -0.918494 0.395363 +VERTEX_SE3:QUAT 1500 -48.1176 154.057 -3.79711 -0.00340386 0.00818457 -0.971321 0.237605 +VERTEX_SE3:QUAT 1501 -52.119 152.884 -3.78127 -0.00257212 0.00651967 -0.998457 0.0550824 +VERTEX_SE3:QUAT 1502 -56.2385 153.232 -3.74669 0.00793854 -0.0027493 0.992964 0.11812 +VERTEX_SE3:QUAT 1503 -60.2967 154.917 -3.69311 -0.0101186 0.00784739 0.971163 0.238074 +VERTEX_SE3:QUAT 1504 -63.9262 157.272 -3.79147 -0.00543713 0.00231595 0.953743 0.300564 +VERTEX_SE3:QUAT 1505 -67.2701 159.8 -3.83483 -0.00123587 0.000117524 0.950769 0.309898 +VERTEX_SE3:QUAT 1506 -70.8075 162.512 -3.83976 -0.00192298 0.00231922 0.95032 0.31126 +VERTEX_SE3:QUAT 1507 -74.3336 165.235 -3.84796 -0.000861008 0.00209824 0.949917 0.312495 +VERTEX_SE3:QUAT 1508 -77.8008 167.916 -3.84398 -0.000379333 0.00247138 0.949619 0.313397 +VERTEX_SE3:QUAT 1509 -81.3181 170.648 -3.83795 -0.0110761 0.00411201 0.948859 0.31548 +VERTEX_SE3:QUAT 1510 -84.7293 173.319 -3.93991 -0.0141073 0.00507171 0.948897 0.31523 +VERTEX_SE3:QUAT 1511 -87.8802 175.765 -4.04703 -0.00944994 0.00124008 0.949328 0.314144 +VERTEX_SE3:QUAT 1512 -91.0725 178.221 -4.10531 -0.00927589 -0.000901068 0.950006 0.312093 +VERTEX_SE3:QUAT 1513 -94.6381 180.919 -4.15845 -0.00942808 -0.00269608 0.951134 0.308624 +VERTEX_SE3:QUAT 1514 -98.0658 183.5 -4.19705 -0.00813273 -0.00365856 0.952266 0.305139 +VERTEX_SE3:QUAT 1515 -101.303 185.944 -4.22347 -0.00243551 0.00384925 0.953412 0.301636 +VERTEX_SE3:QUAT 1516 -104.821 188.518 -4.23253 -0.00405994 0.00297974 0.950395 0.311004 +VERTEX_SE3:QUAT 1517 -108.048 191.309 -4.23732 -0.0174062 0.00654651 0.919152 0.393464 +VERTEX_SE3:QUAT 1518 -110.306 194.676 -4.37289 -0.0152882 -0.00231439 0.831199 0.55576 +VERTEX_SE3:QUAT 1519 -111 198.73 -4.44281 -0.012485 -0.00255846 0.692595 0.721214 +VERTEX_SE3:QUAT 1520 -109.87 202.814 -4.47719 -0.0140435 0.00307062 0.536722 0.843637 +VERTEX_SE3:QUAT 1521 -107.846 206.376 -4.54641 -0.0146446 0.00843892 0.522817 0.852277 +VERTEX_SE3:QUAT 1522 -106.263 210.441 -4.66709 -0.0103024 0.0104569 0.666776 0.745114 +VERTEX_SE3:QUAT 1523 -106.891 214.688 -4.77429 -0.00461524 0.00951911 0.852206 0.523099 +VERTEX_SE3:QUAT 1524 -109.412 217.978 -4.90553 -0.0217029 0.0166748 0.931823 0.361879 +VERTEX_SE3:QUAT 1525 -112.475 220.623 -5.08181 -0.0184913 0.0203451 0.945615 0.324125 +VERTEX_SE3:QUAT 1526 -115.614 223.155 -5.24881 -0.0193993 0.0179633 0.948874 0.314547 +VERTEX_SE3:QUAT 1527 -118.903 225.613 -5.44681 -0.015238 0.0195809 0.96298 0.268427 +VERTEX_SE3:QUAT 1528 -122.728 227.301 -5.64647 -0.00949756 0.0254208 0.995108 0.0949925 +VERTEX_SE3:QUAT 1529 -127.076 227.469 -5.70756 -0.0107704 -0.0207758 -0.995932 0.087015 +VERTEX_SE3:QUAT 1530 -131.447 226.044 -5.6467 -0.0055749 -0.0270541 -0.969019 0.245436 +VERTEX_SE3:QUAT 1531 -135.048 223.64 -5.57778 -0.000643431 -0.030382 -0.936687 0.348847 +VERTEX_SE3:QUAT 1532 -138.073 220.728 -5.50802 -0.00387481 -0.0291514 -0.911523 0.410196 +VERTEX_SE3:QUAT 1533 -141.059 217.273 -5.40562 -0.00488286 -0.0262912 -0.899012 0.437107 +VERTEX_SE3:QUAT 1534 -144.147 213.344 -5.2716 -0.00569609 -0.0212976 -0.894583 0.446358 +VERTEX_SE3:QUAT 1535 -146.688 210.112 -5.17917 -0.00680608 -0.0204617 -0.894105 0.447339 +VERTEX_SE3:QUAT 1536 -149.349 206.725 -5.07471 -0.00514601 -0.0210983 -0.893432 0.448674 +VERTEX_SE3:QUAT 1537 -152.127 203.158 -4.98276 -0.00470739 -0.0208604 -0.892453 0.450634 +VERTEX_SE3:QUAT 1538 -154.966 199.474 -4.88613 -0.00414323 -0.01912 -0.891729 0.452148 +VERTEX_SE3:QUAT 1539 -158.075 195.428 -4.79792 -0.0046794 -0.0205951 -0.891086 0.453343 +VERTEX_SE3:QUAT 1540 -161.131 191.429 -4.68749 -0.00234873 -0.0209009 -0.890664 0.454176 +VERTEX_SE3:QUAT 1541 -164.252 187.311 -4.59354 -0.00332942 -0.0185716 -0.89048 0.45463 +VERTEX_SE3:QUAT 1542 -167.451 183.109 -4.48613 0.00159494 -0.0164714 -0.889881 0.455893 +VERTEX_SE3:QUAT 1543 -170.491 179.068 -4.40003 0.00253649 -0.0170516 -0.889345 0.456912 +VERTEX_SE3:QUAT 1544 -173.49 175.047 -4.31672 0.00109951 -0.0148584 -0.888894 0.457871 +VERTEX_SE3:QUAT 1545 -176.524 170.953 -4.2426 -0.000629168 -0.0136476 -0.888164 0.459324 +VERTEX_SE3:QUAT 1546 -179.355 167.122 -4.14667 -0.00263444 -0.0145544 -0.886666 0.462174 +VERTEX_SE3:QUAT 1547 -182.128 163.339 -4.06374 -0.00022863 -0.0150328 -0.884719 0.465883 +VERTEX_SE3:QUAT 1548 -184.839 159.543 -3.97797 0.00382346 -0.0176491 -0.881759 0.471354 +VERTEX_SE3:QUAT 1549 -187.445 155.778 -3.90858 0.0018729 -0.017567 -0.878765 0.476928 +VERTEX_SE3:QUAT 1550 -189.99 151.984 -3.82477 0.00509947 -0.0196258 -0.873663 0.486109 +VERTEX_SE3:QUAT 1551 -192.339 148.245 -3.7825 -0.000104407 -0.0167922 -0.867769 0.496683 +VERTEX_SE3:QUAT 1552 -194.729 144.265 -3.68911 -0.000985299 -0.0200676 -0.860746 0.508638 +VERTEX_SE3:QUAT 1553 -196.804 140.564 -3.59671 0.00839185 -0.015365 -0.853056 0.521525 +VERTEX_SE3:QUAT 1554 -198.87 136.605 -3.58181 0.00608057 -0.0188349 -0.845313 0.533905 +VERTEX_SE3:QUAT 1555 -200.773 132.669 -3.52574 0.00600111 -0.0206516 -0.837295 0.546328 +VERTEX_SE3:QUAT 1556 -202.623 128.56 -3.45572 0.00652917 -0.0212275 -0.829179 0.558542 +VERTEX_SE3:QUAT 1557 -204.319 124.457 -3.38756 0.0049236 -0.0228287 -0.820891 0.570608 +VERTEX_SE3:QUAT 1558 -205.871 120.358 -3.2955 0.00783821 -0.0205684 -0.812896 0.581993 +VERTEX_SE3:QUAT 1559 -207.293 116.31 -3.23485 0.005664 -0.0223885 -0.804912 0.592945 +VERTEX_SE3:QUAT 1560 -208.614 112.234 -3.15303 0.00878868 -0.0223476 -0.797089 0.603384 +VERTEX_SE3:QUAT 1561 -209.782 108.218 -3.09159 0.00888959 -0.0205429 -0.789161 0.613778 +VERTEX_SE3:QUAT 1562 -210.865 104.14 -3.02974 0.00790315 -0.019476 -0.781223 0.623898 +VERTEX_SE3:QUAT 1563 -211.853 99.9959 -2.96462 0.00743473 -0.0204838 -0.77274 0.634348 +VERTEX_SE3:QUAT 1564 -212.711 95.9557 -2.89213 0.00935712 -0.0215548 -0.764223 0.644524 +VERTEX_SE3:QUAT 1565 -213.453 91.9258 -2.82332 0.0124474 -0.0224829 -0.755397 0.654763 +VERTEX_SE3:QUAT 1566 -214.069 87.9694 -2.77291 0.013864 -0.0229483 -0.746131 0.665259 +VERTEX_SE3:QUAT 1567 -214.575 83.965 -2.72139 0.0126003 -0.0240947 -0.735902 0.676542 +VERTEX_SE3:QUAT 1568 -215.007 79.017 -2.63922 0.00980725 -0.0214188 -0.722114 0.691373 +VERTEX_SE3:QUAT 1569 -215.25 73.9781 -2.55005 0.00994119 -0.0229816 -0.709819 0.703939 +VERTEX_SE3:QUAT 1570 -215.326 69.279 -2.44378 0.0102394 -0.0205772 -0.699886 0.713885 +VERTEX_SE3:QUAT 1571 -215.293 64.5996 -2.34936 0.0122901 -0.0193178 -0.691572 0.721945 +VERTEX_SE3:QUAT 1572 -215.155 60.1147 -2.27397 0.012356 -0.0194694 -0.681421 0.731528 +VERTEX_SE3:QUAT 1573 -214.887 55.7635 -2.18753 0.0190928 -0.0137004 -0.669223 0.74269 +VERTEX_SE3:QUAT 1574 -214.389 51.0697 -2.17835 0.0045873 -0.0166031 -0.655998 0.754566 +VERTEX_SE3:QUAT 1575 -213.793 46.6409 -2.0519 0.0116412 -0.0132381 -0.642065 0.766448 +VERTEX_SE3:QUAT 1576 -213.114 42.5583 -1.99427 0.0131053 -0.0160018 -0.629793 0.776487 +VERTEX_SE3:QUAT 1577 -212.246 38.2277 -1.92362 0.0129027 -0.0117921 -0.621576 0.783159 +VERTEX_SE3:QUAT 1578 -211.379 34.2383 -1.87965 0.011122 -0.00941633 -0.613929 0.789227 +VERTEX_SE3:QUAT 1579 -210.408 30.2616 -1.85221 0.000656956 -0.0176546 -0.604791 0.796188 +VERTEX_SE3:QUAT 1580 -209.242 26.0695 -1.76237 0.00381694 -0.0154056 -0.572185 0.819971 +VERTEX_SE3:QUAT 1581 -207.483 22.2146 -1.66762 -0.000715438 -0.015429 -0.478456 0.877976 +VERTEX_SE3:QUAT 1582 -204.777 18.8525 -1.56143 -0.00521333 -0.0126463 -0.362682 0.931813 +VERTEX_SE3:QUAT 1583 -201.449 16.3785 -1.48095 -0.00452867 -0.0159862 -0.244092 0.96961 +VERTEX_SE3:QUAT 1584 -197.33 14.7334 -1.34745 0.00139838 -0.00525577 -0.11305 0.993574 +VERTEX_SE3:QUAT 1585 -193.218 14.1893 -1.31318 0.00288501 -0.00161266 0.00229663 0.999992 +VERTEX_SE3:QUAT 1586 -188.813 14.5568 -1.28355 0.00525756 0.0120816 0.0994089 0.994959 +VERTEX_SE3:QUAT 1587 -184.294 15.7086 -1.33846 0.00630048 -0.0013454 0.154024 0.988046 +VERTEX_SE3:QUAT 1588 -180.236 16.9286 -1.33083 0.0104032 -0.00104639 0.159785 0.987096 +VERTEX_SE3:QUAT 1589 -176.205 18.1744 -1.2928 0.00846107 -1.65284e-05 0.15981 0.987111 +VERTEX_SE3:QUAT 1590 -172.114 19.4303 -1.27201 0.00892149 -0.00284589 0.16042 0.987004 +VERTEX_SE3:QUAT 1591 -167.901 20.7364 -1.2307 0.0087723 -0.00293213 0.16223 0.98671 +VERTEX_SE3:QUAT 1592 -163.565 22.0961 -1.18253 0.0109274 -0.000879486 0.165036 0.986227 +VERTEX_SE3:QUAT 1593 -159.722 23.3394 -1.14741 0.0121353 -0.000243959 0.168959 0.985548 +VERTEX_SE3:QUAT 1594 -155.503 24.749 -1.13006 0.00927161 -0.00106242 0.172855 0.984903 +VERTEX_SE3:QUAT 1595 -150.875 26.3336 -1.10278 0.0091813 -0.00161417 0.17468 0.984581 +VERTEX_SE3:QUAT 1596 -146.19 27.9542 -1.05812 0.00637673 0.000530926 0.175389 0.984478 +VERTEX_SE3:QUAT 1597 -142.365 29.251 -1.0375 0.00683708 -1.09056e-06 0.175319 0.984488 +VERTEX_SE3:QUAT 1598 -137.631 30.8707 -1.01032 0.0075243 0.00161044 0.17578 0.984399 +VERTEX_SE3:QUAT 1599 -132.918 32.4807 -0.993798 0.00732691 0.000915541 0.175468 0.984457 +VERTEX_SE3:QUAT 1600 -128.064 34.1305 -0.965597 0.0107301 0.00177508 0.174345 0.984625 +VERTEX_SE3:QUAT 1601 -123.399 35.6989 -0.942879 0.00951692 -2.5271e-05 0.173301 0.984823 +VERTEX_SE3:QUAT 1602 -118.702 37.2684 -0.907507 0.00913766 0.000526725 0.172566 0.984955 +VERTEX_SE3:QUAT 1603 -114.051 38.832 -0.883258 0.0101284 0.000525029 0.171581 0.985118 +VERTEX_SE3:QUAT 1604 -109.369 40.3574 -0.839953 0.0149144 -0.00440051 0.166457 0.985926 +VERTEX_SE3:QUAT 1605 -104.747 41.8282 -0.772635 0.00907878 -0.00558618 0.160076 0.987047 +VERTEX_SE3:QUAT 1606 -100.279 43.1723 -0.677068 0.00695069 -0.00468887 0.154804 0.98791 +VERTEX_SE3:QUAT 1607 -95.614 44.5191 -0.596108 0.00874489 -0.00547195 0.15023 0.988597 +VERTEX_SE3:QUAT 1608 -91.2862 45.7419 -0.516727 0.00464984 -0.00666542 0.145206 0.989368 +VERTEX_SE3:QUAT 1609 -86.7456 46.9226 -0.447726 0.0119131 -0.00574717 0.136358 0.990571 +VERTEX_SE3:QUAT 1610 -82.4333 47.9619 -0.360585 0.0112528 -0.00569659 0.123588 0.992253 +VERTEX_SE3:QUAT 1611 -78.2006 48.8703 -0.275999 0.00902199 -0.00478994 0.111076 0.993759 +VERTEX_SE3:QUAT 1612 -73.8985 49.6941 -0.207809 0.00832286 -0.00443442 0.0995206 0.994991 +VERTEX_SE3:QUAT 1613 -69.6266 50.3823 -0.161291 0.00829958 -0.00594473 0.0840229 0.996412 +VERTEX_SE3:QUAT 1614 -65.3516 50.9371 -0.101144 0.00744383 -0.00482167 0.0687732 0.997593 +VERTEX_SE3:QUAT 1615 -61.0754 51.3652 -0.0441144 0.00577375 -0.00385894 0.0536426 0.998536 +VERTEX_SE3:QUAT 1616 -56.7261 51.6749 0.00752449 0.00531086 -0.00464929 0.0408495 0.99914 +VERTEX_SE3:QUAT 1617 -52.3547 51.8507 0.0537473 0.00657416 -0.00435168 0.0231051 0.999702 +VERTEX_SE3:QUAT 1618 -48.0229 51.8684 0.0900054 0.0069108 -0.00324304 0.00474555 0.99996 +VERTEX_SE3:QUAT 1619 -43.631 51.7166 0.129104 0.00926488 -0.00408327 -0.0114404 0.999883 +VERTEX_SE3:QUAT 1620 -39.297 51.4361 0.17065 0.0100598 -0.00503335 -0.0272262 0.999566 +VERTEX_SE3:QUAT 1621 -34.9091 51.0349 0.208191 0.00950725 -0.002445 -0.0407724 0.99912 +VERTEX_SE3:QUAT 1622 -30.4605 50.5352 0.237 0.00436221 -0.00155858 -0.0534311 0.998561 +VERTEX_SE3:QUAT 1623 -26.0759 49.9105 0.249744 0.000641198 0.0026755 -0.0649413 0.997885 +VERTEX_SE3:QUAT 1624 -21.7098 49.2127 0.225563 0.00123259 0.00531061 -0.0713548 0.997436 +VERTEX_SE3:QUAT 1625 -17.2585 48.4109 0.176671 0.00549036 0.00100882 -0.0799272 0.996785 +VERTEX_SE3:QUAT 1626 -12.9627 47.5483 0.155385 0.00630824 0.00674437 -0.0951022 0.995425 +VERTEX_SE3:QUAT 1627 -8.57301 46.502 0.101579 0.00764921 0.00924361 -0.112149 0.993619 +VERTEX_SE3:QUAT 1628 -4.25961 45.3609 0.038459 0.00765811 0.00640152 -0.124662 0.992149 +VERTEX_SE3:QUAT 1629 0.0180213 44.0892 -0.0189575 0.00813383 0.00910085 -0.14211 0.989776 +VERTEX_SE3:QUAT 1630 4.36591 42.6048 -0.0968432 0.00828692 0.0104263 -0.163596 0.986437 +VERTEX_SE3:QUAT 1631 8.2922 41.0317 -0.172674 0.00802198 0.0102918 -0.191535 0.981399 +VERTEX_SE3:QUAT 1632 12.2443 39.1981 -0.253711 0.00499985 0.00953239 -0.214426 0.976681 +VERTEX_SE3:QUAT 1633 16.0815 37.2608 -0.335786 0.00557757 0.0102062 -0.22502 0.974285 +VERTEX_SE3:QUAT 1634 19.9392 35.2345 -0.418014 0.00775678 0.0125551 -0.231168 0.972802 +VERTEX_SE3:QUAT 1635 23.649 33.2475 -0.519992 0.0089025 0.0106553 -0.236617 0.971504 +VERTEX_SE3:QUAT 1636 27.327 31.2481 -0.599894 0.0051237 0.0150452 -0.241924 0.970165 +VERTEX_SE3:QUAT 1637 31.4233 28.9117 -0.714794 0.00700268 0.0144633 -0.247157 0.968842 +VERTEX_SE3:QUAT 1638 35.0436 26.7972 -0.820767 0.0103051 0.0155405 -0.252421 0.967438 +VERTEX_SE3:QUAT 1639 38.4922 24.7058 -0.929492 0.00829119 0.0164432 -0.275765 0.961049 +VERTEX_SE3:QUAT 1640 41.8487 22.0344 -1.06499 0.00651747 0.018577 -0.390001 0.920604 +VERTEX_SE3:QUAT 1641 44.0721 18.3334 -1.24009 -0.0206229 0.0167393 -0.595869 0.802642 +VERTEX_SE3:QUAT 1642 44.2327 13.884 -1.20509 -0.0131207 0.0139602 -0.754619 0.655884 +VERTEX_SE3:QUAT 1643 43.1665 9.99352 -1.1901 -0.0116975 0.0135197 -0.81371 0.580997 +VERTEX_SE3:QUAT 1644 41.5278 6.20596 -1.16508 -0.0150905 0.0171894 -0.850719 0.525122 +VERTEX_SE3:QUAT 1645 39.3153 2.86235 -1.11504 -0.0106853 0.0158088 -0.901816 0.4317 +VERTEX_SE3:QUAT 1646 36.2042 0.115695 -1.06458 -0.0127974 0.0140013 -0.958751 0.283615 +VERTEX_SE3:QUAT 1647 32.1959 -1.60762 -0.955713 -0.0139357 0.0075456 -0.988994 0.147101 +VERTEX_SE3:QUAT 1648 27.853 -2.34349 -0.826732 -0.00963816 0.00304902 -0.998276 0.0578221 +VERTEX_SE3:QUAT 1649 23.4887 -2.67173 -0.72624 -0.0136168 0.00152797 -0.999036 0.0417169 +VERTEX_SE3:QUAT 1650 19.246 -2.94131 -0.605647 -0.00961223 0.00384626 -0.999231 0.0378055 +VERTEX_SE3:QUAT 1651 15.166 -3.15808 -0.512005 -0.00291507 -0.00111882 -0.999019 0.0441847 +VERTEX_SE3:QUAT 1652 11.0605 -3.50661 -0.47249 -0.00189466 0.00647752 -0.998864 0.0471673 +VERTEX_SE3:QUAT 1653 6.89966 -3.66003 -0.407699 -0.00477142 -0.000842579 0.999516 0.0307264 +VERTEX_SE3:QUAT 1654 3.03777 -2.46556 -0.42474 0.00743576 -0.00438125 0.959414 0.28187 +VERTEX_SE3:QUAT 1655 0.24119 0.770358 -0.368958 0.00211114 0.00310235 0.853356 0.521315 +VERTEX_SE3:QUAT 1656 -0.926586 4.58673 -0.371826 -0.00152823 0.000959441 0.765922 0.642931 +VERTEX_SE3:QUAT 1657 -1.16209 8.68382 -0.387923 0.00165807 0.00310673 0.704296 0.709898 +VERTEX_SE3:QUAT 1658 -0.888073 12.8799 -0.360451 0.00107498 0.00690652 0.685761 0.727794 +VERTEX_SE3:QUAT 1659 -0.574597 17.1106 -0.377747 0.00538606 0.0107384 0.681793 0.731447 +VERTEX_SE3:QUAT 1660 -0.0944743 21.306 -0.408636 0.00745758 0.0145585 0.712572 0.701408 +EDGE_SE3:QUAT 0 1 4.15448 -0.0665288 0.000389663 -0.0107791 0.00867285 -0.00190021 0.999902 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 4.00073 -0.000375887 0.0691425 3.9997 -8.5017e-05 4.00118 +EDGE_SE3:QUAT 1 2 4.15971 -0.0912353 0.0567356 0.00272799 -0.000777724 0.00363979 0.999989 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 3.99998 -8.64848e-06 -0.00634076 4 -1.1571e-05 3.99996 +EDGE_SE3:QUAT 2 3 4.28985 -0.0247738 -0.00423717 -0.00251893 -0.015912 0.0148755 0.99976 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 4.004 0.000250029 -0.126914 3.999 -0.00096047 4.00314 +EDGE_SE3:QUAT 3 4 4.19815 -0.0648981 -0.0412507 0.00809376 0.00983641 0.0096526 0.999872 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 4.00125 0.000335718 0.0777606 3.99963 0.000392584 4.00114 +EDGE_SE3:QUAT 4 5 4.16073 -0.0800714 -0.00683181 -0.00610256 -0.000133946 -0.00562439 0.999966 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 3.99985 4.94074e-06 -0.00148332 4 4.55294e-06 3.99987 +EDGE_SE3:QUAT 5 6 4.53017 -0.123911 -0.0250554 0.00437116 0.00742819 -0.00548444 0.999948 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 4.00082 0.000123487 0.0597205 3.99978 -0.000158288 4.00077 +EDGE_SE3:QUAT 6 7 4.08996 -0.114357 0.0084345 -0.00224706 0.00488201 -0.00220577 0.999983 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 4.00036 -4.50641e-05 0.0389992 3.99991 -4.42828e-05 4.00036 +EDGE_SE3:QUAT 7 8 4.4972 -0.0368689 0.0305298 0.00169669 -0.00214664 0.0230253 0.999731 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 4.00007 -1.24311e-05 -0.0176283 3.99998 -0.000204509 3.99796 +EDGE_SE3:QUAT 8 9 4.34366 0.175615 0.0227239 0.00757089 0.0022955 0.0869368 0.996182 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 3.9998 3.34958e-05 0.0102964 4 0.000330501 3.96979 +EDGE_SE3:QUAT 9 10 4.15685 0.48636 -0.00411743 -0.00149517 -0.00318863 0.13577 0.990734 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 4.00012 4.33404e-05 -0.0224014 3.99997 -0.00144986 3.92639 +EDGE_SE3:QUAT 10 11 4.29022 0.480612 0.0108215 0.00212114 0.00229424 0.139963 0.990152 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 4.00003 2.59367e-05 0.0143012 3.99999 0.000905188 3.92169 +EDGE_SE3:QUAT 11 12 4.09147 0.453422 0.0338667 -0.00128138 0.00294306 0.122954 0.992407 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 4.00015 1.18564e-05 0.024885 3.99996 0.00155739 3.93968 +EDGE_SE3:QUAT 12 13 4.33741 0.243695 0.0306209 -0.00425808 -0.000525027 0.0591607 0.998239 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 3.99993 3.85731e-07 -0.00116223 4 -4.35887e-06 3.986 +EDGE_SE3:QUAT 13 14 4.05604 0.0272498 0.0210505 -0.00563827 -0.00141707 0.0252084 0.999665 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 3.9999 2.64541e-05 -0.00962047 3.99999 -0.000114258 3.99748 +EDGE_SE3:QUAT 14 15 4.04679 0.130947 0.0158262 -0.00521682 0.0051938 0.120486 0.992688 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 4.00047 -3.22058e-05 0.0481234 3.99985 0.00302885 3.94251 +EDGE_SE3:QUAT 15 16 4.23869 0.882735 0.0784195 0.00170297 -0.0264247 0.24305 0.969652 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 4.00975 0.00362587 -0.198128 3.99832 -0.0236338 3.77347 +EDGE_SE3:QUAT 16 17 3.96598 0.59573 -0.0345204 0.00829326 0.00803217 0.173305 0.984801 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 4.00021 0.00031337 0.0444787 3.99993 0.00327979 3.88034 +EDGE_SE3:QUAT 17 18 4.20856 0.357531 -0.0286207 0.011349 0.00546783 0.109745 0.99388 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 3.99968 0.000170955 0.0281219 3.99997 0.00125957 3.95201 +EDGE_SE3:QUAT 18 19 4.33681 0.0998401 -0.00860454 0.0033234 -0.00167297 0.039042 0.999231 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 4.00001 -2.25098e-05 -0.0149086 3.99999 -0.000300706 3.99396 +EDGE_SE3:QUAT 19 20 4.26984 -0.057287 -0.0182644 0.000221923 0.00410408 0.013191 0.999905 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 4.00027 8.95979e-06 0.0327909 3.99993 0.000216304 3.99957 +EDGE_SE3:QUAT 20 21 4.62193 -0.0485773 -0.00654039 0.00229106 -0.0065356 0.010666 0.999919 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 4.00067 -4.93342e-05 -0.0525767 3.99983 -0.000278654 4.00024 +EDGE_SE3:QUAT 21 22 4.04814 -0.0552791 -0.0119384 -0.00270598 0.00665023 0.0103284 0.999921 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 4.00069 -6.15448e-05 0.0535365 3.99982 0.000274263 4.00029 +EDGE_SE3:QUAT 22 23 4.25516 -0.0214021 0.00270387 -0.00333093 0.000288424 0.016711 0.999855 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 3.99996 -5.2737e-06 0.00297421 4 2.66986e-05 3.99889 +EDGE_SE3:QUAT 23 24 4.6127 -0.0179721 -0.00861072 0.000764114 0.00202416 0.0177286 0.99984 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 4.00006 7.81566e-06 0.0160234 3.99998 0.000141613 3.99881 +EDGE_SE3:QUAT 24 25 4.44503 -0.0523622 0.00056694 0.00402409 -0.000426651 0.0163772 0.999858 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 3.99994 -8.88539e-06 -0.00420245 4 -3.65423e-05 3.99893 +EDGE_SE3:QUAT 25 26 4.75183 -0.042221 -0.00748827 -0.000308966 0.000967011 0.0139246 0.999903 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 4.00001 -8.89633e-07 0.00778549 4 5.43131e-05 3.99924 +EDGE_SE3:QUAT 26 27 4.85765 -0.0429295 -0.0199257 -0.00111682 0.00217664 0.0139792 0.999899 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 4.00007 -8.24433e-06 0.0175956 3.99998 0.000123288 3.9993 +EDGE_SE3:QUAT 27 28 4.10041 -0.0312675 -0.00691899 -0.000140687 0.000464248 0.015987 0.999872 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 4 -1.80059e-07 0.00373955 4 2.99596e-05 3.99898 +EDGE_SE3:QUAT 28 29 5.00969 0.000382475 0.00542828 -0.00366627 0.00337265 0.0187558 0.999812 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 4.00014 -4.60856e-05 0.0277926 3.99995 0.000262154 3.99879 +EDGE_SE3:QUAT 29 30 4.94706 -0.0217959 0.00791578 0.000142706 0.000985997 0.0175872 0.999845 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 4.00002 9.67318e-07 0.00785423 4 6.89719e-05 3.99878 +EDGE_SE3:QUAT 30 31 4.73799 -0.0415418 0.0255281 -0.00110489 0.00307645 0.0129453 0.999911 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 4.00015 -1.07485e-05 0.0247778 3.99996 0.000160497 3.99948 +EDGE_SE3:QUAT 31 32 4.88374 -0.0562155 0.0259943 -0.00120536 0.000921553 0.0115099 0.999933 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 4.00001 -4.333e-06 0.00753743 4 4.3669e-05 3.99948 +EDGE_SE3:QUAT 32 33 4.69559 -0.0409947 0.0173165 0.00127778 0.00263806 0.0146134 0.999889 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 4.0001 1.56879e-05 0.0208742 3.99997 0.00015218 3.99925 +EDGE_SE3:QUAT 33 34 4.56333 -0.0407636 0.0212397 -0.00153168 0.00234998 0.0144129 0.999892 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 4.00008 -1.27116e-05 0.0190592 3.99998 0.000137772 3.99926 +EDGE_SE3:QUAT 34 35 4.50349 -0.0548443 0.0300326 0.00201897 0.00357501 0.0145462 0.999886 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 4.00018 3.27649e-05 0.0282397 3.99995 0.000205148 3.99935 +EDGE_SE3:QUAT 35 36 4.28599 -0.044706 0.0235666 0.00413789 -0.000792013 0.0155269 0.999871 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 3.99994 -1.49491e-05 -0.00710453 4 -5.70703e-05 3.99905 +EDGE_SE3:QUAT 36 37 4.25164 -0.0317075 0.0386368 -0.00193966 0.00507797 0.0159102 0.999859 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 4.0004 -2.98885e-05 0.0409821 3.99989 0.000325831 3.99941 +EDGE_SE3:QUAT 37 38 4.71327 -0.000657242 0.0282638 -0.000961562 -3.09584e-05 0.0188769 0.999821 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 4 -2.05763e-08 -2.97706e-05 4 4.04715e-07 3.99857 +EDGE_SE3:QUAT 38 39 4.24504 -0.017373 0.0326678 -0.0050487 1.63877e-05 0.0180465 0.999824 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 3.9999 -4.00359e-06 0.00122411 4 1.43319e-05 3.9987 +EDGE_SE3:QUAT 39 40 4.46205 -0.034552 0.0735074 0.00769102 0.00695617 0.018952 0.999767 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 4.00049 0.000225922 0.0538741 3.99982 0.000513621 3.99929 +EDGE_SE3:QUAT 40 41 4.1489 -0.0232755 0.0507316 -0.00788702 -0.00310241 0.00830393 0.99993 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 3.9999 9.5554e-05 -0.0240293 3.99996 -0.000100417 3.99987 +EDGE_SE3:QUAT 41 42 4.11651 -0.112282 0.0496252 0.00140666 -0.00412833 -0.0266807 0.999634 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 4.00026 -3.34484e-05 -0.032543 3.99993 0.000432614 3.99742 +EDGE_SE3:QUAT 42 43 4.09543 -0.648383 0.00545628 -0.000985727 0.00211564 -0.165469 0.986212 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 4.00005 -2.05484e-05 0.0143133 3.99999 -0.00111081 3.89053 +EDGE_SE3:QUAT 43 44 3.89524 -0.930021 0.00469593 -0.0194178 -0.035218 -0.26953 0.962152 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 4.02284 -0.00664426 -0.313055 3.99532 0.0435146 3.73377 +EDGE_SE3:QUAT 44 45 4.17817 -0.768652 -0.112173 -0.00761817 0.0463888 -0.140994 0.988894 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 4.03005 -0.00802803 0.34954 3.99348 -0.024963 3.95077 +EDGE_SE3:QUAT 45 46 4.24162 -0.278879 0.00201523 -0.000660178 -0.00235592 -0.0474503 0.998871 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 4.00009 -1.32929e-07 -0.0191595 3.99998 0.000456967 3.99109 +EDGE_SE3:QUAT 46 47 4.41282 -0.249472 0.00326565 -0.00430876 0.012678 -0.0464464 0.998831 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 4.00236 -0.000383181 0.0987466 3.99941 -0.00229177 3.99381 +EDGE_SE3:QUAT 47 48 4.05714 -0.323211 0.00243731 0.0137064 -0.0229835 -0.0540379 0.99818 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 4.00684 -0.00181151 -0.174418 3.9982 0.00480973 3.99591 +EDGE_SE3:QUAT 48 49 4.21745 -0.290623 0.0395959 0.00157447 -0.026667 -0.0624296 0.997692 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 4.01113 -0.00121935 -0.211423 3.99729 0.00664962 3.99555 +EDGE_SE3:QUAT 49 50 4.07607 -0.388421 8.56352e-07 -0.0022891 0.0228351 -0.076732 0.996788 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 4.008 -0.00114 0.179278 3.99807 -0.00689539 3.98447 +EDGE_SE3:QUAT 50 51 4.26435 -0.373646 -0.0431778 0.00209348 0.0282777 -0.0756148 0.996734 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 4.0128 -0.00122109 0.226811 3.99688 -0.0086066 3.98995 +EDGE_SE3:QUAT 51 52 4.36278 -0.63955 -0.00464176 -0.00216072 0.00543334 -0.133635 0.991013 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 4.00036 -0.000120808 0.0388864 3.99992 -0.00249686 3.92894 +EDGE_SE3:QUAT 52 53 4.02476 -0.583398 0.00284604 0.00507033 -0.00251622 -0.098984 0.995073 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 3.99994 -3.84171e-05 -0.0138508 3.99999 0.000581694 3.96086 +EDGE_SE3:QUAT 53 54 4.26903 -0.199342 0.00186521 0.00137098 -0.000630898 -0.0132039 0.999912 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 4 -3.37786e-06 -0.00482865 4 3.14099e-05 3.99931 +EDGE_SE3:QUAT 54 55 4.42495 -0.0204833 0.00231648 0.000286523 0.00246546 0.0149062 0.999886 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 4.0001 4.97981e-06 0.0196663 3.99998 0.000146482 3.99921 +EDGE_SE3:QUAT 55 56 4.40559 -0.00548906 0.00822832 -0.00166584 0.00504874 0.0152353 0.99987 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 4.0004 -2.45491e-05 0.0406839 3.9999 0.000309706 3.99949 +EDGE_SE3:QUAT 56 57 4.5839 -0.061808 0.0197524 -0.00179213 -0.00510927 0.00621207 0.999966 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 4.0004 4.03489e-05 -0.0407417 3.9999 -0.000127556 4.00026 +EDGE_SE3:QUAT 57 58 4.65638 -0.0804731 0.0105465 0.000389743 0.00128446 0.00523866 0.999985 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 4.00003 2.20267e-06 0.0102508 3.99999 2.68444e-05 3.99992 +EDGE_SE3:QUAT 58 59 4.77963 -0.0616422 0.0156684 -0.00127249 0.00460978 0.00631903 0.999969 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 4.00034 -2.03146e-05 0.0369752 3.99991 0.000116297 4.00018 +EDGE_SE3:QUAT 59 60 3.99786 -0.047224 0.0263936 -0.0018695 -0.00110115 0.00714873 0.999972 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 4 8.23594e-06 -0.00864818 4 -3.07731e-05 3.99981 +EDGE_SE3:QUAT 60 61 4.64774 -0.0467343 0.00364908 0.000125219 0.000597 0.00784329 0.999969 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 4.00001 3.64829e-07 0.00476378 4 1.8667e-05 3.99976 +EDGE_SE3:QUAT 61 62 4.59935 -0.0506332 0.0375537 -0.00392487 -0.00521191 0.00278327 0.999975 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 4.00037 8.33143e-05 -0.0415667 3.99989 -6.03471e-05 4.0004 +EDGE_SE3:QUAT 62 63 4.46799 -0.0763324 0.0356431 -0.00631716 -0.00459327 -0.00373461 0.999963 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 4.00018 0.000115367 -0.0370291 3.99991 6.60973e-05 4.00029 +EDGE_SE3:QUAT 63 64 4.33405 -0.0846141 0.013387 0.000484854 8.00934e-05 -0.000557044 1 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 4 1.56295e-07 0.000643988 4 -1.7959e-07 4 +EDGE_SE3:QUAT 64 65 4.54211 -0.070602 0.0256335 0.00051281 -0.00278516 0.00435012 0.999987 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 4.00012 -4.9112e-06 -0.022308 3.99997 -4.84485e-05 4.00005 +EDGE_SE3:QUAT 65 66 4.72575 -0.0630238 0.016584 0.0008923 -0.00150739 0.00671247 0.999976 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 4.00003 -5.0532e-06 -0.0121303 3.99999 -4.07435e-05 3.99986 +EDGE_SE3:QUAT 66 67 4.619 -0.0730671 0.00792645 0.00172291 5.52855e-05 0.00628202 0.999979 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 3.99999 2.32071e-07 0.000312379 4 8.45247e-07 3.99984 +EDGE_SE3:QUAT 67 68 4.58578 -0.0512691 0.0282897 -0.000207872 0.00321433 0.00397294 0.999987 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 4.00017 -1.68859e-06 0.0257249 3.99996 5.10617e-05 4.0001 +EDGE_SE3:QUAT 68 69 4.0716 -0.139603 0.0346497 0.00101606 -0.00121712 -0.00942861 0.999954 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 4.00002 -5.19707e-06 -0.00962078 3.99999 4.52087e-05 3.99967 +EDGE_SE3:QUAT 69 70 4.28332 -0.0402705 0.0440563 0.00108073 -0.00237421 0.0146309 0.99989 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 4.00009 -8.38713e-06 -0.0191777 3.99998 -0.000140601 3.99924 +EDGE_SE3:QUAT 70 71 4.42309 0.0973701 0.0363667 -0.00245218 0.00183342 0.0519175 0.998647 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 4.00004 -1.55104e-05 0.0161332 3.99998 0.000431289 3.98928 +EDGE_SE3:QUAT 71 72 4.34897 0.357554 0.0319799 0.000773158 -0.00172367 0.132329 0.991204 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 4.00005 4.68761e-06 -0.0146423 3.99999 -0.000987751 3.93001 +EDGE_SE3:QUAT 72 73 4.04108 0.665525 0.0221723 -0.00231806 -0.00391894 0.203146 0.979138 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 4.00012 7.5483e-05 -0.0239358 3.99998 -0.00217319 3.83507 +EDGE_SE3:QUAT 73 74 4.21969 0.754546 -0.00396633 0.0110184 -0.0179339 0.201008 0.979364 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 4.00598 0.000976385 -0.160949 3.99852 -0.0167267 3.84485 +EDGE_SE3:QUAT 74 75 4.21298 0.548362 0.0499571 -0.0025905 -0.00922049 0.154105 0.988008 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 4.00107 0.000353721 -0.0664512 3.99977 -0.0049372 3.90611 +EDGE_SE3:QUAT 75 76 4.05832 0.204423 -0.040508 0.000667243 0.030166 0.0271129 0.999177 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 4.01454 0.00067443 0.24161 3.99639 0.00331906 4.0116 +EDGE_SE3:QUAT 76 77 4.09226 -0.594625 0.0415699 -0.00288934 -0.0157442 -0.204046 0.978831 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 4.00388 -0.00104632 -0.125156 3.9992 0.0127504 3.83737 +EDGE_SE3:QUAT 77 78 4.05445 -1.38211 -0.00840915 0.00152977 -7.42901e-05 -0.32973 0.944074 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 4 3.50833e-06 0.00511411 4 -0.00117946 3.56512 +EDGE_SE3:QUAT 78 79 4.05595 -1.17911 -0.0221212 0.0045047 0.0076922 -0.226408 0.973992 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 4.0011 -0.000232534 0.0687053 3.99974 -0.00805147 3.79614 +EDGE_SE3:QUAT 79 80 4.17738 -0.338371 -0.0160067 -0.000351947 0.00672344 -0.0425835 0.99907 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 4.00071 -5.52108e-05 0.05347 3.99982 -0.00113707 3.99346 +EDGE_SE3:QUAT 80 81 3.99904 -0.0814193 -0.00348701 -0.000224802 -0.00120106 0.00189154 0.999997 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 4.00002 1.14468e-06 -0.00960335 3.99999 -9.08887e-06 4.00001 +EDGE_SE3:QUAT 81 82 4.17605 -0.0563225 0.00777269 -0.000656942 0.00150307 0.00890704 0.999959 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 4.00003 -3.49268e-06 0.0120934 3.99999 5.39257e-05 3.99972 +EDGE_SE3:QUAT 82 83 4.19871 -0.0351079 0.0153087 -0.00250025 0.000583715 0.0156154 0.999875 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 3.99998 -6.46737e-06 0.00513641 4 4.12948e-05 3.99903 +EDGE_SE3:QUAT 83 84 4.10913 0.00499386 0.0323789 0.00184373 -0.00626869 0.045323 0.998951 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 4.00064 -3.36991e-06 -0.0510036 3.99984 -0.00116092 3.99243 +EDGE_SE3:QUAT 84 85 4.324 0.524971 0.0137421 0.00324559 -0.00297899 0.170522 0.985344 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 4.00017 6.77077e-07 -0.0293138 3.99994 -0.00265713 3.8839 +EDGE_SE3:QUAT 85 86 4.08861 0.736112 0.014077 0.00309873 -0.00303202 0.21923 0.975664 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 4.00019 2.08222e-05 -0.0304209 3.99994 -0.00356532 3.80798 +EDGE_SE3:QUAT 86 87 4.16829 0.831732 -0.00558391 0.00444193 -0.00259854 0.222103 0.97501 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 4.00016 -6.18538e-06 -0.0307199 3.99994 -0.00378912 3.80292 +EDGE_SE3:QUAT 87 88 4.12649 0.552609 0.0134976 -0.00600456 0.0141882 0.129292 0.991487 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 4.00345 0.000319563 0.119976 3.99913 0.00788048 3.93673 +EDGE_SE3:QUAT 88 89 4.01864 0.0335201 -0.00633305 -0.00453327 0.00500361 0.0155899 0.999856 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 4.00034 -8.3604e-05 0.0408648 3.99989 0.000317973 3.99945 +EDGE_SE3:QUAT 89 90 4.28424 -0.195672 0.0247062 -0.00253002 -0.0101146 -0.0298915 0.999499 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 4.00164 2.92625e-05 -0.081745 3.99958 0.00122073 3.9981 +EDGE_SE3:QUAT 90 91 4.43191 -0.209935 -0.0115107 -0.00143447 0.00183711 -0.0230326 0.999732 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 4.00004 -1.19377e-05 0.014289 3.99999 -0.000163106 3.99793 +EDGE_SE3:QUAT 91 92 4.05329 -0.123974 0.00635004 0.00296087 -0.00186975 -0.00212333 0.999992 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 4.00002 -2.21727e-05 -0.0148825 3.99999 1.60204e-05 4.00004 +EDGE_SE3:QUAT 92 93 4.19402 -0.0827696 0.00704784 0.00572478 0.000722096 0.00600222 0.999965 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 3.99988 1.50266e-05 0.00536386 4 1.57484e-05 3.99986 +EDGE_SE3:QUAT 93 94 4.22215 -0.0610937 0.017332 0.00303134 -0.00311069 0.00983052 0.999942 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 4.00012 -3.61042e-05 -0.0252401 3.99996 -0.000123934 3.99977 +EDGE_SE3:QUAT 94 95 4.40271 -0.0266413 -0.00918459 -0.00184311 0.0151821 0.00924648 0.99984 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 4.00369 -6.11895e-05 0.121744 3.99907 0.000554273 4.00336 +EDGE_SE3:QUAT 95 96 4.44046 -0.0448038 0.0137955 -0.00381706 -0.00458805 0.00541848 0.999968 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 4.00027 7.21429e-05 -0.0364565 3.99992 -0.000100473 4.00021 +EDGE_SE3:QUAT 96 97 4.40647 -0.0773661 0.0180209 -0.00331702 -0.00276709 0.00204412 0.999989 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 4.00008 3.69103e-05 -0.0220554 3.99997 -2.31219e-05 4.0001 +EDGE_SE3:QUAT 97 98 4.25153 -0.0863218 0.010117 0.00245084 0.00148736 0.00230868 0.999993 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 4.00001 1.45918e-05 0.0118309 3.99999 1.37599e-05 4.00001 +EDGE_SE3:QUAT 98 99 4.31587 -0.0764418 0.00894097 -0.00148724 0.00157754 0.00189251 0.999996 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 4.00003 -9.30493e-06 0.0126541 3.99999 1.18957e-05 4.00003 +EDGE_SE3:QUAT 99 100 4.44086 -0.0985895 0.0295186 0.00244814 -0.00181385 0.00103209 0.999995 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 4.00003 -1.77305e-05 -0.0145411 3.99999 -7.31541e-06 4.00005 +EDGE_SE3:QUAT 100 101 4.00354 -0.0737645 0.0160394 0.00549296 -0.00757291 0.0141232 0.999856 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 4.00082 -0.000149958 -0.0615061 3.99976 -0.000428999 4.00015 +EDGE_SE3:QUAT 101 102 4.28908 0.0098973 0.00641285 0.00622558 0.00545478 0.0469928 0.998861 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 4.00024 0.00015008 0.039989 3.99991 0.000915102 3.99157 +EDGE_SE3:QUAT 102 103 4.36897 0.355859 -0.0293634 0.00033505 0.011503 0.124279 0.992181 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 4.002 0.00039536 0.0894439 3.99954 0.0055116 3.94022 +EDGE_SE3:QUAT 103 104 4.13705 0.502294 0.0059195 0.00276748 -0.00185241 0.154127 0.988045 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 4.00006 -9.19855e-06 -0.0193321 3.99997 -0.00160716 3.90507 +EDGE_SE3:QUAT 104 105 4.16518 0.579522 0.00973185 -0.00441048 0.00334709 0.172007 0.98508 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 4.00022 -1.14211e-05 0.034523 3.99992 0.00319381 3.88195 +EDGE_SE3:QUAT 105 106 4.05627 0.590029 0.0426526 -0.00710639 -0.00312729 0.180166 0.983606 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 3.99981 2.17117e-05 -0.0087771 4 -0.000292466 3.87017 +EDGE_SE3:QUAT 106 107 4.12005 0.668184 0.0190195 -0.00303233 -0.00844252 0.234018 0.972191 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 4.00068 0.000365412 -0.0538696 3.9999 -0.00575381 3.78166 +EDGE_SE3:QUAT 107 108 4.09573 0.946036 -0.0251498 0.00834169 -0.00294028 0.267188 0.963604 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 4.00025 -4.81517e-05 -0.0465248 3.99984 -0.00728091 3.71497 +EDGE_SE3:QUAT 108 109 4.02437 0.846778 -0.0217617 0.000881363 0.00228009 0.221425 0.975174 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 4.00005 2.61442e-05 0.0146506 3.99999 0.0014845 3.80394 +EDGE_SE3:QUAT 109 110 4.24155 0.454787 -0.00591316 -0.000739944 0.00773455 0.105163 0.994425 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 4.00095 0.000128638 0.0617926 3.99977 0.00324838 3.95672 +EDGE_SE3:QUAT 110 111 4.33443 0.107257 -0.0110079 -7.21036e-05 0.00652845 0.0378415 0.999262 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 4.00068 3.67718e-05 0.0521559 3.99983 0.000986696 3.99495 +EDGE_SE3:QUAT 111 112 4.29721 -0.0305293 0.0147498 -0.0053702 -0.00238004 0.00933514 0.999939 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 3.99997 5.01706e-05 -0.0184358 3.99998 -8.58086e-05 3.99974 +EDGE_SE3:QUAT 112 113 4.61598 -0.0789154 0.0117452 0.000244887 -0.00163625 2.22617e-06 0.999999 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 4.00004 -1.60271e-06 -0.0130902 3.99999 1.16511e-09 4.00004 +EDGE_SE3:QUAT 113 114 4.05789 -0.0883887 0.00830758 -0.00228935 -0.000159161 0.000934643 0.999997 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 3.99998 1.41885e-06 -0.0012476 4 -5.80378e-07 4 +EDGE_SE3:QUAT 114 115 4.11933 -0.0884276 0.0140516 0.000553461 -0.000750708 0.00085375 0.999999 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 4.00001 -1.65249e-06 -0.00601134 4 -2.55941e-06 4.00001 +EDGE_SE3:QUAT 115 116 4.27268 -0.12712 0.010531 0.00544979 -0.00587882 -0.0017623 0.999966 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 4.00043 -0.000129244 -0.0469186 3.99986 4.58264e-05 4.00054 +EDGE_SE3:QUAT 116 117 4.09029 -0.0909554 -0.000219786 0.0010578 -0.00130254 -0.00288838 0.999994 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 4.00002 -5.60247e-06 -0.0103836 3.99999 1.50212e-05 3.99999 +EDGE_SE3:QUAT 117 118 4.20158 -0.100788 0.018774 -0.00139623 0.0155461 -0.00482121 0.999867 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 4.00386 -0.000115005 0.124388 3.99904 -0.000308643 4.00377 +EDGE_SE3:QUAT 118 119 3.99909 -0.130577 0.0241141 0.00183988 -0.000436102 -0.004103 0.99999 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 3.99999 -3.11624e-06 -0.00339812 4 6.9173e-06 3.99994 +EDGE_SE3:QUAT 119 120 4.53978 -0.107182 0.0200143 -0.00177575 -0.00123559 -0.00446043 0.999988 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 4.00001 8.72287e-06 -0.00997951 3.99999 2.22612e-05 3.99995 +EDGE_SE3:QUAT 120 121 4.40804 -0.0748034 0.0299176 -0.00213086 0.000147327 0.00452523 0.999987 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 3.99998 -1.41731e-06 0.00129428 4 3.01441e-06 3.99992 +EDGE_SE3:QUAT 121 122 4.36479 -0.0605895 0.0434027 -0.00174133 -0.000405836 0.00627566 0.999979 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 3.99999 2.69758e-06 -0.00311535 4 -9.64453e-06 3.99984 +EDGE_SE3:QUAT 122 123 4.01308 -0.108595 0.0417628 0.00602136 -0.00914532 -0.00367217 0.999933 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 4.00118 -0.000226769 -0.0729129 3.99967 0.000145848 4.00127 +EDGE_SE3:QUAT 123 124 4.30636 -0.0893241 0.0381803 -0.00235949 0.00872351 -0.0108417 0.9999 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 4.00118 -0.000101584 0.0694865 3.9997 -0.00038068 4.00074 +EDGE_SE3:QUAT 124 125 4.11816 -0.252067 -0.0143824 0.00320932 0.00973351 -0.0759144 0.997062 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 4.00156 -5.11114e-05 0.0801359 3.9996 -0.00306566 3.97855 +EDGE_SE3:QUAT 125 126 4.02908 -0.691592 0.0324877 -0.00602487 -0.00609543 -0.197198 0.980326 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 4.00075 -5.69235e-05 -0.0598448 3.99978 0.00626807 3.84535 +EDGE_SE3:QUAT 126 127 3.9495 -1.1429 -0.0093269 0.00368409 0.00140501 -0.273583 0.96184 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 4.00006 6.56235e-06 0.0214938 3.99997 -0.00342885 3.70072 +EDGE_SE3:QUAT 80 126 5.22787 5.20821 0.0606868 0.00137218 0.0122792 -0.863955 0.503418 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 3.9997 -0.000156739 0.0196754 4.00055 0.0168034 1.01404 +EDGE_SE3:QUAT 81 126 1.25508 5.29496 0.065863 0.000439433 0.0131788 -0.864815 0.501917 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 3.99965 -5.25389e-05 0.0156142 4.00043 0.0213032 1.00803 +EDGE_SE3:QUAT 82 126 -2.8225 5.3953 0.0511467 0.00232861 0.0131238 -0.869145 0.494377 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 3.99966 -0.000263257 0.024735 4.00079 0.0163676 0.978029 +EDGE_SE3:QUAT 127 128 3.8578 -0.930713 -0.00947043 0.00426395 0.00867911 -0.19382 0.98099 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 4.00134 -0.000240612 0.0752495 3.99968 -0.00748027 3.85115 +EDGE_SE3:QUAT 79 127 6.67214 1.79226 -0.0218011 -0.00495896 0.0108061 -0.978463 0.206079 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 4 -3.07282e-05 -0.0203041 3.99954 0.0465298 0.170542 +EDGE_SE3:QUAT 80 127 2.27734 2.31976 0.0245935 0.00105623 0.00979586 -0.968872 0.247366 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 3.99989 0.000136428 0.00578161 3.99992 0.0313581 0.245038 +EDGE_SE3:QUAT 81 127 -1.68976 2.42906 0.0253084 0.000108476 0.0104858 -0.969287 0.245708 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 3.9999 0.000159274 0.00171701 3.99977 0.0355477 0.241832 +EDGE_SE3:QUAT 82 127 -5.80128 2.58455 0.00401478 0.00211916 0.0103575 -0.971433 0.237077 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 3.99984 0.00014358 0.0102654 4.00004 0.0319334 0.225128 +EDGE_SE3:QUAT 128 129 3.9419 -0.343251 -0.00914902 0.000856198 0.00356396 -0.0482103 0.99883 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 4.00021 -2.59998e-06 0.0289082 3.99995 -0.000699845 3.99091 +EDGE_SE3:QUAT 78 128 7.00167 -1.41057 -0.0436913 0.00374043 -0.0112217 0.976619 0.214654 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 3.99976 -0.000156134 -0.0168477 4.00026 0.0336785 0.184686 +EDGE_SE3:QUAT 79 128 2.73281 1.07837 0.00361272 0.00234473 0.00762765 -0.999894 0.0121442 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 3.99997 7.54152e-05 0.00938191 3.99987 0.0302717 0.000841064 +EDGE_SE3:QUAT 80 128 -1.53799 1.29742 0.0106032 0.00893076 0.00756199 -0.998409 0.0551654 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 3.99963 0.000177191 0.0358956 4.00122 0.0261003 0.0126669 +EDGE_SE3:QUAT 81 128 -5.54293 1.39654 0.0144087 0.00778303 0.00825674 -0.998539 0.0528326 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 3.99971 0.00019785 0.0312727 4.00086 0.0295262 0.011629 +EDGE_SE3:QUAT 129 130 4.33573 -0.0517113 -0.0030553 -0.00151414 0.000108947 0.0103647 0.999945 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 3.99999 -8.45767e-07 0.00105975 4 5.81648e-06 3.99957 +EDGE_SE3:QUAT 78 129 3.55485 0.556151 0.00208014 0.00104116 -0.00928854 0.965174 0.261441 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 3.99989 -0.000119873 -0.00589778 3.99995 0.0289317 0.273646 +EDGE_SE3:QUAT 79 129 -1.19647 1.31664 -0.0199452 -0.00528217 -0.00678075 0.999321 0.0358323 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 3.99991 0.000151197 0.0211683 4.0002 0.0285515 0.00545198 +EDGE_SE3:QUAT 80 129 -5.48634 1.20066 -0.070002 0.0123858 0.00727518 -0.999875 0.00662006 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 3.99938 0.000339346 0.0495462 4.00227 0.028465 0.000991528 +EDGE_SE3:QUAT 130 131 4.18099 -0.0353965 0.0111157 0.000382763 0.000659447 0.0142648 0.999898 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 4.00001 1.13849e-06 0.00520846 4 3.69933e-05 3.99919 +EDGE_SE3:QUAT 77 130 5.67813 0.909943 0.0496981 -0.00301453 -0.0118901 0.830614 0.556713 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 3.9997 -0.000162695 -0.000187936 3.99997 0.0242825 1.24005 +EDGE_SE3:QUAT 78 130 -0.138843 2.79596 0.0380955 0.000361079 -0.0109906 0.96779 0.251518 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 3.99988 -0.00017585 -0.00297513 3.99979 0.0364853 0.253411 +EDGE_SE3:QUAT 79 130 -5.47488 1.69612 -0.067767 -0.00582677 -0.00823385 0.999624 0.0254802 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 3.99988 0.000196926 0.023331 4.00021 0.0340736 0.00302353 +EDGE_SE3:QUAT 131 132 4.2709 -0.0538855 0.0140294 -0.00549184 -0.00144399 -0.00246809 0.999981 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 3.99991 3.21885e-05 -0.011714 3.99999 1.42417e-05 4.00001 +EDGE_SE3:QUAT 77 131 4.14508 4.76429 0.0969819 -0.00396014 -0.0112245 0.838663 0.544521 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 3.99974 -0.000226033 0.00666474 3.99982 0.0274606 1.18638 +EDGE_SE3:QUAT 78 131 -3.75511 4.85971 0.071679 -0.000679154 -0.0107376 0.971319 0.237535 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 3.99993 -0.000158107 0.001784 3.99967 0.0382294 0.226083 +EDGE_SE3:QUAT 132 133 4.31671 -0.123828 0.0203312 -0.00203533 -0.00723086 -0.00602987 0.999954 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 4.00082 5.15093e-05 -0.0580013 3.99979 0.000172546 4.0007 +EDGE_SE3:QUAT 133 134 4.2103 -0.0885329 -0.00126743 0.00138169 0.00209452 0.00343383 0.999991 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 4.00006 1.18835e-05 0.0166992 3.99998 2.87843e-05 4.00002 +EDGE_SE3:QUAT 134 135 4.03221 -0.0581034 0.0175668 0.00239073 -0.000796903 0.00985176 0.999948 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 3.99999 -7.90901e-06 -0.00665687 4 -3.32147e-05 3.99962 +EDGE_SE3:QUAT 135 136 4.13472 -0.0557945 0.0296506 -0.00107044 0.0010169 0.00443401 0.999989 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 4.00001 -4.28342e-06 0.00819196 4 1.81769e-05 3.99994 +EDGE_SE3:QUAT 136 137 4.09282 -0.183912 0.0352524 -0.000153709 0.00833945 -0.0524592 0.998588 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 4.0011 -9.20453e-05 0.0663598 3.99973 -0.00173885 3.99009 +EDGE_SE3:QUAT 137 138 4.15434 -0.669312 0.0042105 -0.0027959 0.00362546 -0.176565 0.984278 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 4.00009 -6.39867e-05 0.0218573 3.99998 -0.00171529 3.87542 +EDGE_SE3:QUAT 138 139 3.93946 -0.876284 -0.00732598 0.000740661 0.00105852 -0.211056 0.977473 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 4.00002 -3.47366e-06 0.00972891 3.99999 -0.00107201 3.82184 +EDGE_SE3:QUAT 139 140 3.89608 -0.831649 -0.00848984 0.00537929 -0.00322741 -0.177424 0.984114 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 3.99992 -4.20524e-05 -0.0133962 4 0.000813547 3.87412 +EDGE_SE3:QUAT 140 141 4.32204 -0.626954 -0.0277184 0.00567517 0.0196465 -0.107649 0.993979 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 4.00642 -0.000585008 0.161953 3.99841 -0.0087807 3.96019 +EDGE_SE3:QUAT 141 142 4.35145 -0.292036 0.00572326 -0.00509497 -0.00655511 -0.0418871 0.999088 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 4.00065 9.54959e-05 -0.0548681 3.99981 0.00116094 3.99373 +EDGE_SE3:QUAT 142 143 4.05872 -0.156943 0.00356411 0.00147626 -0.00400557 -0.0143917 0.999887 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 4.00024 -2.88692e-05 -0.0317813 3.99994 0.000228657 3.99942 +EDGE_SE3:QUAT 143 144 4.21816 -0.126224 0.0040113 0.00112701 0.001558 -0.00384397 0.999991 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 4.00003 6.83722e-06 0.0125158 3.99999 -2.40229e-05 3.99998 +EDGE_SE3:QUAT 144 145 4.32593 -0.114752 0.0150759 0.00106081 -0.000822726 -0.00411385 0.999991 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 4.00001 -3.51989e-06 -0.00652928 4 1.34113e-05 3.99994 +EDGE_SE3:QUAT 145 146 4.37429 -0.117158 0.0208657 0.000160956 -0.00182231 -0.00418174 0.99999 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 4.00005 -1.50538e-06 -0.0145702 3.99999 3.04723e-05 3.99998 +EDGE_SE3:QUAT 146 147 4.46036 -0.101429 0.00490908 -0.00207775 0.00940947 -0.00393027 0.999946 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 4.0014 -8.64978e-05 0.0751988 3.99965 -0.000152255 4.00135 +EDGE_SE3:QUAT 147 148 3.97862 -0.101154 -0.0106658 -4.14336e-05 0.00342911 -0.00273645 0.99999 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 4.00019 -1.3406e-06 0.0274324 3.99995 -3.75492e-05 4.00016 +EDGE_SE3:QUAT 148 149 4.03981 -0.0945974 0.00280153 -0.00184015 -0.0027566 -0.00255182 0.999991 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 4.00011 1.98939e-05 -0.0221094 3.99997 2.78988e-05 4.0001 +EDGE_SE3:QUAT 149 150 4.54166 -0.100116 0.0164807 -0.00240407 -0.00176538 -0.00245503 0.999993 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 4.00003 1.69052e-05 -0.0141938 3.99999 1.72713e-05 4.00003 +EDGE_SE3:QUAT 150 151 4.37441 -0.10503 0.0287874 0.000132449 -0.000768824 -0.00198275 0.999998 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 4.00001 -4.35147e-07 -0.00614742 4 6.09524e-06 3.99999 +EDGE_SE3:QUAT 151 152 4.19294 -0.101138 0.0316971 0.000844044 0.000641999 -0.00190458 0.999998 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 4 2.1594e-06 0.00515526 4 -4.90703e-06 3.99999 +EDGE_SE3:QUAT 152 153 4.41481 -0.118774 0.0241092 0.00379318 -0.00484242 -0.00178483 0.999979 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 4.00032 -7.42899e-05 -0.0386603 3.99991 3.66129e-05 4.00036 +EDGE_SE3:QUAT 153 154 3.99493 -0.0971236 0.0149696 0.00149048 0.000978039 0.0031657 0.999993 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 4.00001 5.84654e-06 0.00776758 4 1.22989e-05 3.99997 +EDGE_SE3:QUAT 154 155 4.06021 -0.0121337 0.0296849 0.00182124 0.00911593 0.0424261 0.999056 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 4.00128 0.000147825 0.0718242 3.99968 0.00152051 3.99409 +EDGE_SE3:QUAT 155 156 4.40406 0.428779 0.00619373 0.000619838 -0.0010585 0.149145 0.988815 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 4.00002 1.72395e-06 -0.00927996 3.99999 -0.000712449 3.91104 +EDGE_SE3:QUAT 156 157 4.32241 0.779478 0.00954674 -0.00387911 0.00177865 0.210422 0.977601 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 4.00007 -1.45958e-05 0.022801 3.99996 0.00270732 3.82302 +EDGE_SE3:QUAT 157 158 4.25003 0.90372 0.00610635 -0.00244454 -0.00277143 0.243531 0.969886 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 4.00002 3.43946e-05 -0.013367 4 -0.00125485 3.76281 +EDGE_SE3:QUAT 158 159 4.00096 0.792794 0.0171945 0.00214332 -0.00897284 0.231219 0.972858 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 4.00127 0.000382643 -0.0718593 3.99975 -0.00830886 3.78744 +EDGE_SE3:QUAT 159 160 4.3746 0.915242 -0.00239632 0.00299018 0.000198504 0.224119 0.974557 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 3.99997 -1.17296e-05 -0.00630267 4 -0.00101089 3.79909 +EDGE_SE3:QUAT 160 161 4.07794 0.590683 0.00187631 0.00218138 0.00136646 0.176821 0.98424 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 3.99999 7.82235e-06 0.00589086 4 0.000369056 3.87494 +EDGE_SE3:QUAT 161 162 4.30673 0.533264 0.00122795 0.00369748 0.00121968 0.147392 0.989071 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 3.99995 2.39992e-06 0.00299606 4 5.22693e-05 3.9131 +EDGE_SE3:QUAT 162 163 4.14999 0.399166 -0.0317298 -0.0100243 0.0169491 0.105947 0.994177 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 4.00493 7.36696e-05 0.146125 3.99866 0.00787255 3.96043 +EDGE_SE3:QUAT 163 164 4.30319 0.244893 0.00773181 -0.0015845 -0.0060968 0.0662253 0.997785 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 4.00055 9.32706e-05 -0.0472038 3.99987 -0.00154752 3.98301 +EDGE_SE3:QUAT 164 165 4.52162 0.0187197 0.013404 -0.00767873 -0.00174204 0.00438135 0.999959 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 3.99981 5.17386e-05 -0.0135311 3.99999 -2.98815e-05 3.99997 +EDGE_SE3:QUAT 165 166 4.01888 -0.137463 0.0081267 0.00108362 -3.04548e-05 -0.0116191 0.999932 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 4 -2.28965e-08 -9.25131e-05 4 2.44785e-07 3.99946 +EDGE_SE3:QUAT 166 167 4.08412 -0.117753 0.00853577 0.000396842 -0.00121112 -0.00914797 0.999957 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 4.00002 -2.23043e-06 -0.00964424 3.99999 4.40589e-05 3.99969 +EDGE_SE3:QUAT 167 168 4.31218 -0.145717 0.00609945 0.00361154 -0.00265719 -0.0101949 0.999938 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 4.00006 -3.8989e-05 -0.0208125 3.99997 0.000105933 3.99969 +EDGE_SE3:QUAT 168 169 4.18264 -0.138124 0.00967293 0.00304618 -0.0042581 -0.00880492 0.999948 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 4.00025 -5.50091e-05 -0.0337406 3.99993 0.000149397 3.99997 +EDGE_SE3:QUAT 169 170 4.27426 -0.121801 0.0047985 0.00268041 0.00666923 -0.00495275 0.999962 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 4.00069 6.65176e-05 0.053519 3.99982 -0.00012985 4.00062 +EDGE_SE3:QUAT 170 171 4.42445 -0.112273 -0.0229485 -0.000717725 0.00994325 -0.00415171 0.999942 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 4.00158 -3.84163e-05 0.0795356 3.99961 -0.000166952 4.00151 +EDGE_SE3:QUAT 171 172 4.31521 -0.105483 0.0115224 -0.00335476 -0.00546387 -0.00236904 0.999977 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 4.00043 7.18582e-05 -0.0438098 3.99988 4.9535e-05 4.00046 +EDGE_SE3:QUAT 172 173 4.35602 -0.0855803 0.0112888 -0.00232335 0.000741741 1.31798e-05 0.999997 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 3.99999 -6.89366e-06 0.00593426 4 8.42627e-09 4.00001 +EDGE_SE3:QUAT 173 174 4.27127 -0.0791714 0.0155677 0.00243612 -0.00221223 0.00302223 0.99999 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 4.00006 -2.13436e-05 -0.0177861 3.99998 -2.66341e-05 4.00004 +EDGE_SE3:QUAT 174 175 3.99324 -0.0880142 0.0251203 0.000498122 -0.00134085 0.00747223 0.999971 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 4.00003 -2.36174e-06 -0.0107706 3.99999 -4.02739e-05 3.99981 +EDGE_SE3:QUAT 175 176 4.36676 0.0679655 0.0199613 0.0067207 -0.00573568 0.060837 0.998109 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 4.00046 -0.000119074 -0.0505295 3.99983 -0.00157857 3.98583 +EDGE_SE3:QUAT 176 177 4.31894 0.335937 0.00113558 0.00276963 0.0172843 0.111763 0.993581 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 4.00433 0.000931959 0.132128 3.999 0.00730643 3.95439 +EDGE_SE3:QUAT 177 178 4.07939 0.403654 0.00639347 -0.00146184 0.00163886 0.125217 0.992127 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 4.00005 -1.36694e-06 0.0149775 3.99999 0.000976957 3.93734 +EDGE_SE3:QUAT 178 179 4.16618 0.467537 0.0354183 -0.00775244 0.0026513 0.143325 0.989642 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 4.00004 -9.50857e-05 0.0337111 3.99991 0.00271588 3.91811 +EDGE_SE3:QUAT 179 180 4.25645 0.553863 0.0368578 -0.00733904 -0.00177194 0.154485 0.987966 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 3.99978 -1.5729e-05 -0.000281664 4 0.000341751 3.90453 +EDGE_SE3:QUAT 180 181 4.21443 0.516048 0.041155 0.0022267 -0.0139056 0.143784 0.989509 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 4.0031 0.000553528 -0.111678 3.99929 -0.00804313 3.92042 +EDGE_SE3:QUAT 181 182 4.06608 0.121115 -0.00627403 -0.00366955 -0.00219379 0.0371035 0.999302 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 4.00001 3.17959e-05 -0.0158816 3.99999 -0.000284678 3.99456 +EDGE_SE3:QUAT 182 183 4.17044 -0.00159013 -0.0163155 -0.00156569 -0.000616306 0.0163908 0.999864 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 4 3.67149e-06 -0.00462055 4 -3.70335e-05 3.99893 +EDGE_SE3:QUAT 183 184 4.06881 -0.0820207 -0.00253457 0.00284598 0.000450066 0.00298275 0.999991 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 3.99997 4.94395e-06 0.00349857 4 5.18024e-06 3.99997 +EDGE_SE3:QUAT 138 183 4.35597 4.87226 0.0825467 0.000877041 0.0177808 -0.976797 0.213427 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 3.99975 0.000446693 0.0051288 3.99933 0.0617245 0.183222 +EDGE_SE3:QUAT 139 183 -1.97437 5.40995 0.0829151 -0.00196397 0.0166069 -0.909688 0.414955 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 3.99957 0.000399499 -0.000112938 3.99973 0.0450219 0.689452 +EDGE_SE3:QUAT 184 185 4.32988 -0.110934 -0.00935439 0.00203967 0.00744623 -0.00241925 0.999967 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 4.00087 5.76529e-05 0.0596398 3.99978 -6.94883e-05 4.00087 +EDGE_SE3:QUAT 137 184 5.87032 2.14876 0.0327678 0.000729301 0.0125605 -0.999102 0.0404676 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 3.99999 8.58537e-05 0.0029323 3.9994 0.0497973 0.00717371 +EDGE_SE3:QUAT 138 184 0.628997 3.25276 0.0483202 0.00260782 0.0153054 -0.976157 0.216511 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 3.99971 0.000335145 0.0123845 3.99987 0.0498659 0.188213 +EDGE_SE3:QUAT 139 184 -4.7018 2.39273 0.0390368 -9.40099e-05 0.0143084 -0.908477 0.41769 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 3.99963 0.000194875 0.00788044 4.00011 0.034119 0.698308 +EDGE_SE3:QUAT 185 186 4.447 -0.0997732 -0.0161994 -0.00152305 0.00575369 -0.0013852 0.999981 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 4.00052 -3.61426e-05 0.0460092 3.99987 -3.30804e-05 4.00052 +EDGE_SE3:QUAT 136 185 5.817 1.55909 0.0321943 -0.000537537 -0.0105211 0.999833 0.0149059 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 4 9.45384e-06 0.0021508 3.99956 0.0421226 0.00133363 +EDGE_SE3:QUAT 137 185 1.53448 1.91859 0.0194028 0.00851466 0.0109561 -0.999195 0.0376386 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 3.99966 0.000335644 0.0341389 4.00085 0.0411248 0.00638181 +EDGE_SE3:QUAT 138 185 -3.36244 1.51345 -0.0012768 0.0105646 0.0149306 -0.976723 0.213725 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 3.99913 -2.87069e-05 0.0462093 4.00245 0.035803 0.183629 +EDGE_SE3:QUAT 186 187 4.10204 -0.0816774 0.0295261 -0.000697048 0.000699199 0.000869432 0.999999 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 4.00001 -1.94267e-06 0.00560087 4 2.42766e-06 4 +EDGE_SE3:QUAT 135 186 5.4842 1.75563 0.0455623 -0.00541301 -0.0113343 0.999846 0.0122699 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 3.99989 0.000240872 0.0216607 3.99992 0.0458554 0.00124526 +EDGE_SE3:QUAT 136 186 1.36682 1.78729 0.0140966 -0.00653134 -0.0122202 0.999766 0.016631 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 3.99985 0.000315091 0.0261413 4.00002 0.0497226 0.00189545 +EDGE_SE3:QUAT 137 186 -2.90259 1.68694 -0.0734179 0.0145694 0.0128266 -0.999164 0.0359815 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 3.99905 0.000598333 0.0583978 4.00305 0.047006 0.00658518 +EDGE_SE3:QUAT 138 186 -7.43312 -0.238055 -0.13846 0.0162078 0.0179707 -0.976896 0.212341 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 3.99831 -0.000423517 0.0704103 4.00554 0.0376771 0.182056 +EDGE_SE3:QUAT 187 188 4.00208 -0.0808921 0.0251608 -0.00241495 -0.000788214 -0.00063072 0.999997 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 3.99999 7.63394e-06 -0.00632395 4 1.96008e-06 4.00001 +EDGE_SE3:QUAT 134 187 5.36877 1.91941 0.0652766 -0.00657976 -0.014385 0.999873 0.00176674 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 3.99983 0.000377561 0.0263268 3.99986 0.0576403 0.00101633 +EDGE_SE3:QUAT 135 187 1.38147 1.94016 0.0331192 -0.00595052 -0.0118796 0.999845 0.0115556 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 3.99987 0.000278983 0.0238115 3.99996 0.0480581 0.00125333 +EDGE_SE3:QUAT 136 187 -2.71778 2.01543 -0.0126272 -0.00741626 -0.0128876 0.999762 0.0159951 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 3.9998 0.000380759 0.029683 4.00014 0.0524767 0.00193223 +EDGE_SE3:QUAT 137 187 -6.98133 1.47893 -0.170473 0.0152428 0.0134689 -0.999118 0.0367484 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 3.99896 0.000654604 0.0611028 4.00335 0.049281 0.00694405 +EDGE_SE3:QUAT 188 189 4.04877 -0.0857172 0.0250998 -0.00445072 -0.000797855 0.00190882 0.999988 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 3.99993 1.39295e-05 -0.00628068 4 -6.02821e-06 4 +EDGE_SE3:QUAT 133 188 5.54556 1.93177 0.0490983 0.00366173 0.0184164 -0.999823 0.00154399 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 3.99994 0.000273294 0.0146544 3.99886 0.0736128 0.00141829 +EDGE_SE3:QUAT 134 188 1.3571 2.00909 0.0474 -0.00577287 -0.0168528 0.999839 0.00195921 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 3.99987 0.000386205 0.0231011 3.99939 0.0675038 0.00128807 +EDGE_SE3:QUAT 135 188 -2.62037 2.11182 0.0103604 -0.00526487 -0.0141746 0.99981 0.0123321 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 3.9999 0.000286158 0.0210701 3.9996 0.0571984 0.00153741 +EDGE_SE3:QUAT 136 188 -6.70836 2.22484 -0.0355735 -0.00673268 -0.0154308 0.999721 0.0165376 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 3.99985 0.000400291 0.0269504 3.99969 0.0625781 0.00225486 +EDGE_SE3:QUAT 189 190 4.02823 0.00655227 0.01581 0.00632442 -0.00812579 0.0624384 0.997996 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 4.00104 -0.000114358 -0.069368 3.99969 -0.00220143 3.98561 +EDGE_SE3:QUAT 132 189 5.83456 1.86226 0.0844157 -0.0100733 -0.0205191 0.999736 0.00245973 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 3.9996 0.00082486 0.0403172 3.99991 0.0823013 0.00212369 +EDGE_SE3:QUAT 133 189 1.50431 2.00199 0.049153 0.00258027 0.0225865 -0.999736 0.00333542 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 3.99997 0.000245937 0.0103294 3.99808 0.0902551 0.00210864 +EDGE_SE3:QUAT 134 189 -2.67643 2.10869 0.0318584 -0.00501061 -0.0212278 0.999762 0.000570064 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 3.9999 0.000423508 0.0200557 3.9986 0.0849265 0.00190553 +EDGE_SE3:QUAT 135 189 -6.64704 2.29972 0.0122877 -0.0041782 -0.0188731 0.999761 0.0102589 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 3.99994 0.000289811 0.0167237 3.99882 0.0758085 0.00192817 +EDGE_SE3:QUAT 190 191 3.98809 0.560678 0.0120702 0.00514475 -0.00356909 0.19613 0.980558 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 4.00027 -8.67569e-06 -0.0387216 3.9999 -0.00413546 3.8465 +EDGE_SE3:QUAT 131 190 6.09873 1.80095 0.0343759 0.00424745 0.00820659 -0.998283 0.057844 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 3.99989 0.000137826 0.0170887 4.00012 0.030596 0.0136919 +EDGE_SE3:QUAT 132 190 1.80415 1.86536 0.0299579 0.00298654 0.0134766 -0.998104 0.0599899 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 3.99992 0.000224738 0.0120374 3.99955 0.0519937 0.01511 +EDGE_SE3:QUAT 133 190 -2.51239 1.95551 0.0543367 -0.0042501 0.0160079 -0.997691 0.0658678 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 3.99998 -0.000149149 -0.017079 3.99908 0.0655621 0.0185068 +EDGE_SE3:QUAT 134 190 -6.67554 2.09951 0.0203804 -0.00197105 0.0145612 -0.997948 0.0623137 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 4 -9.57485e-06 -0.0079028 3.99915 0.0586526 0.0164111 +EDGE_SE3:QUAT 191 192 3.98444 0.685806 0.00523448 0.00809189 -0.00463917 0.216429 0.976254 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 4.00049 -3.05894e-05 -0.0549025 3.9998 -0.00659523 3.81338 +EDGE_SE3:QUAT 77 191 2.49343 6.49363 0.0997551 0.0100536 -0.00340179 -0.31559 0.948836 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 3.99959 0.000133051 0.0122956 3.99996 -0.0041627 3.60161 +EDGE_SE3:QUAT 130 191 6.36675 0.813692 0.011448 0.00180971 0.00240782 -0.963969 0.265998 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 3.99998 -1.06314e-05 0.00832797 4.00008 0.004392 0.283045 +EDGE_SE3:QUAT 131 191 2.20245 0.787334 0.00248544 0.00258472 0.00180701 -0.967666 0.252215 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 3.99997 -3.01826e-05 0.0115093 4.00013 0.001221 0.254485 +EDGE_SE3:QUAT 132 191 -2.07746 0.838287 0.00241443 0.00245434 0.00733268 -0.967055 0.254452 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 3.99989 4.8196e-05 0.0116899 4.00016 0.0200212 0.259133 +EDGE_SE3:QUAT 133 191 -6.38472 0.881757 0.0735094 -0.00385057 0.0110837 -0.965512 0.260093 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 3.99998 0.000100316 -0.0153239 3.99948 0.0444831 0.271183 +EDGE_SE3:QUAT 192 193 4.05163 0.683026 -0.0158946 0.00550519 -0.0126061 0.183592 0.982906 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 4.00278 0.000486521 -0.107717 3.99934 -0.0100937 3.86808 +EDGE_SE3:QUAT 78 192 -2.12365 5.95307 0.0857962 0.0166378 -0.00632245 0.231108 0.972765 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 4.00094 -0.000272288 -0.091102 3.9994 -0.0121057 3.7884 +EDGE_SE3:QUAT 130 192 3.28409 -1.82421 -0.00760517 0.000183228 -0.00692846 -0.883593 0.468205 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 3.99991 2.81632e-05 -0.00475727 4.00005 -0.0142881 0.876961 +EDGE_SE3:QUAT 131 192 -0.94757 -1.74181 -0.0197992 0.000770978 -0.00766403 -0.890206 0.455493 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 3.99989 6.67795e-05 -0.00190971 4 -0.0181935 0.83003 +EDGE_SE3:QUAT 132 192 -5.19957 -1.70526 -0.0322053 0.00180424 -0.00215612 -0.889186 0.457536 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 4 5.19601e-06 0.00745192 3.99998 -0.00967952 0.837402 +EDGE_SE3:QUAT 193 194 4.19562 0.397859 -0.0154944 0.0022612 -0.00629826 0.0967061 0.99529 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 4.00066 3.81665e-05 -0.0522963 3.99983 -0.00255832 3.96328 +EDGE_SE3:QUAT 130 193 1.55749 -5.54033 0.0114403 -0.00939694 -0.0177612 -0.782371 0.622489 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 4.00059 -0.00304505 -0.0865102 4.00322 0.0162392 1.55253 +EDGE_SE3:QUAT 131 193 -2.76905 -5.4161 -0.00476839 -0.00911612 -0.0183021 -0.791406 0.610949 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 4.00042 -0.00295619 -0.0838208 4.00333 0.0133168 1.49546 +EDGE_SE3:QUAT 194 195 4.15508 0.0599781 0.00177923 -0.000781437 0.00283416 0.0289635 0.999576 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 4.00013 -3.30685e-06 0.0229169 3.99997 0.000332924 3.99678 +EDGE_SE3:QUAT 195 196 4.36403 -0.0595557 -0.0174667 -0.00222802 0.00582122 0.00277333 0.999977 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 4.00052 -4.97513e-05 0.0466486 3.99986 6.29261e-05 4.00051 +EDGE_SE3:QUAT 196 197 4.0481 -0.0977207 -0.00835172 -0.00123576 -0.00350886 -0.000991188 0.999993 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 4.00019 1.70662e-05 -0.0280867 3.99995 1.35583e-05 4.00019 +EDGE_SE3:QUAT 197 198 4.03713 -0.0905558 -0.0132898 0.00226823 0.0025379 -0.00143146 0.999993 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 4.00008 2.28649e-05 0.0203424 3.99997 -1.42182e-05 4.0001 +EDGE_SE3:QUAT 198 199 4.18876 -0.0973607 -0.012133 -5.6181e-05 0.000671145 -0.00114507 0.999999 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 4.00001 -1.6317e-07 0.00536838 4 -3.07405e-06 4 +EDGE_SE3:QUAT 199 200 4.19759 -0.0967435 0.00568512 0.00155339 0.00366361 -0.000895504 0.999992 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 4.00021 2.24967e-05 0.0293268 3.99995 -1.26346e-05 4.00021 +EDGE_SE3:QUAT 200 201 4.127 -0.0966863 0.0110947 -0.000872427 -0.000701438 0.000152535 0.999999 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 4 2.4487e-06 -0.00560991 4 -4.38114e-07 4.00001 +EDGE_SE3:QUAT 201 202 4.33903 -0.0944284 0.000140122 -0.00136411 0.000869403 0.000273574 0.999999 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 4 -4.74297e-06 0.0069597 4 9.27436e-07 4.00001 +EDGE_SE3:QUAT 202 203 4.1194 -0.0907502 0.00824404 0.00045978 -0.000381598 0.000554925 1 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 4 -7.00802e-07 -0.00305584 4 -8.46557e-07 4 +EDGE_SE3:QUAT 203 204 4.1697 -0.0899949 -0.00844887 -0.000430278 -0.000916295 0.000475235 0.999999 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 4.00001 1.58593e-06 -0.00732792 4 -1.74973e-06 4.00001 +EDGE_SE3:QUAT 204 205 4.06137 -0.0900182 0.00104215 0.000992106 0.0040768 0.00135513 0.99999 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 4.00026 1.67117e-05 0.0326001 3.99993 2.24842e-05 4.00026 +EDGE_SE3:QUAT 205 206 4.38591 -0.0734211 0.0191372 -0.00034633 0.00435061 0.00500709 0.999978 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 4.0003 -3.75631e-06 0.0348267 3.99992 8.70664e-05 4.0002 +EDGE_SE3:QUAT 206 207 4.08437 -0.0808373 0.05016 -0.000558307 -0.00231895 0.00280556 0.999993 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 4.00008 5.53358e-06 -0.018533 3.99998 -2.60622e-05 4.00005 +EDGE_SE3:QUAT 207 208 4.13213 -0.13214 0.0238691 -0.00138088 0.00507829 -0.0209246 0.999767 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 4.0004 -4.0487e-05 0.0402564 3.9999 -0.000420828 3.99865 +EDGE_SE3:QUAT 208 209 4.11526 -0.311704 -0.0484792 -0.00410357 0.0278704 -0.0832378 0.996131 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 4.01168 -0.00193818 0.217109 3.99721 -0.00909201 3.98403 +EDGE_SE3:QUAT 209 210 4.20537 -0.890233 0.00951372 -0.00259366 -0.00367704 -0.21961 0.975577 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 4.00026 -4.56128e-05 -0.0339315 3.99993 0.00389458 3.80737 +EDGE_SE3:QUAT 210 211 4.22688 -1.17933 -0.0187902 -0.00122678 0.00633831 -0.271584 0.962393 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 4.00042 -0.000222152 0.0414027 3.99995 -0.00517646 3.70539 +EDGE_SE3:QUAT 211 212 3.96744 -1.13524 -0.0323171 0.00486438 0.0146641 -0.268349 0.963198 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 4.00349 -0.00119167 0.11988 3.99937 -0.0161994 3.71554 +EDGE_SE3:QUAT 212 213 4.16987 -1.21805 -0.012966 -0.00323583 0.00346628 -0.273229 0.961937 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 4.00001 -4.80806e-05 0.0146017 4 -0.00136413 3.70143 +EDGE_SE3:QUAT 213 214 3.93035 -0.998799 -0.0119481 0.00424903 0.00153491 -0.222665 0.974885 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 4.00005 2.00942e-05 0.0223558 3.99996 -0.00287404 3.8018 +EDGE_SE3:QUAT 214 215 3.93052 -0.705903 0.00721255 0.0050293 0.0121514 -0.142146 0.989758 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 4.00254 -0.000291841 0.102802 3.99937 -0.00743144 3.92182 +EDGE_SE3:QUAT 215 216 4.31236 -0.393316 -0.00748174 -7.09237e-05 0.000656433 -0.0534375 0.998571 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 4.00001 -7.25366e-07 0.0051836 4 -0.000137895 3.98858 +EDGE_SE3:QUAT 216 217 4.02563 -0.104227 -0.0194147 -0.00276417 -0.00166692 -0.00479425 0.999983 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 4.00001 1.83976e-05 -0.0134939 3.99999 3.22864e-05 3.99995 +EDGE_SE3:QUAT 217 218 4.23316 -0.0782967 0.010909 -0.00279981 0.00476142 -0.000491998 0.999985 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 4.00033 -5.35771e-05 0.0380774 3.99991 -1.08904e-05 4.00036 +EDGE_SE3:QUAT 218 219 4.3733 -0.0853112 0.0401275 -0.00132211 -0.00524061 0.000965667 0.999985 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 4.00043 2.8348e-05 -0.0419134 3.99989 -2.11116e-05 4.00044 +EDGE_SE3:QUAT 219 220 4.22994 -0.0837729 0.0362453 0.00249943 -0.00451942 0.00256963 0.999983 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 4.0003 -4.40602e-05 -0.0362343 3.99992 -4.53678e-05 4.0003 +EDGE_SE3:QUAT 220 221 4.16028 -0.0863503 0.00381854 0.00483246 -0.00166387 0.00298391 0.999982 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 3.99995 -3.25166e-05 -0.0134835 3.99999 -1.98755e-05 4.00001 +EDGE_SE3:QUAT 221 222 4.11444 -0.0844345 -0.00734863 0.00245069 0.00528447 0.0025563 0.99998 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 4.00042 5.34072e-05 0.0422039 3.99989 5.55644e-05 4.00042 +EDGE_SE3:QUAT 222 223 4.14039 -0.0786663 0.0255888 0.000217565 0.00658966 0.00117159 0.999978 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 4.00069 6.9589e-06 0.0527221 3.99983 3.11247e-05 4.00069 +EDGE_SE3:QUAT 223 224 4.07155 -0.0874276 0.0265775 -0.00122079 -0.00257221 -0.0023513 0.999993 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 4.0001 1.22152e-05 -0.0206124 3.99997 2.40537e-05 4.00008 +EDGE_SE3:QUAT 224 225 4.07253 -0.102399 0.00524038 -0.00219621 -0.000279781 -0.00466922 0.999987 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 3.99998 2.62833e-06 -0.00236121 4 5.60372e-06 3.99991 +EDGE_SE3:QUAT 225 226 4.52457 -0.144345 -0.0195322 -0.000933527 0.00247237 -0.0135759 0.999904 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 4.00009 -1.11021e-05 0.0196218 3.99998 -0.000132979 3.99936 +EDGE_SE3:QUAT 226 227 4.20732 -0.17166 0.0303706 -0.000270481 -0.00273176 -0.0222031 0.99975 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 4.00012 -1.02761e-06 -0.0219106 3.99997 0.000243418 3.99815 +EDGE_SE3:QUAT 227 228 4.08052 -0.170572 0.0434482 0.00437833 -7.93575e-07 -0.010633 0.999934 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 3.99992 1.61594e-06 0.00055226 4 -3.92583e-06 3.99955 +EDGE_SE3:QUAT 228 229 4.3685 -0.0127332 0.0408177 0.00205248 -0.00221313 0.0350381 0.999381 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 4.00007 -1.48792e-05 -0.0185349 3.99998 -0.000329321 3.99518 +EDGE_SE3:QUAT 229 230 4.15953 0.238529 -0.0220369 0.00395454 0.0132206 0.110174 0.993816 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 4.00237 0.000608601 0.0987063 3.99945 0.00533003 3.95388 +EDGE_SE3:QUAT 230 231 4.11244 0.626248 0.0219442 -0.00455485 -0.007155 0.189206 0.981901 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 4.0004 0.000249376 -0.0441007 3.99992 -0.00375209 3.85728 +EDGE_SE3:QUAT 231 232 4.29877 0.814473 0.0153276 -0.00282949 -0.00227869 0.216777 0.976214 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 3.99999 2.10235e-05 -0.00982974 4 -0.000751895 3.81205 +EDGE_SE3:QUAT 232 233 4.14367 0.714905 0.00585043 0.000488926 -0.000931523 0.207464 0.978242 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 4.00002 3.04151e-06 -0.00815859 4 -0.000871174 3.82785 +EDGE_SE3:QUAT 233 234 4.10659 0.719909 0.00321181 -0.00177319 0.00294876 0.203298 0.979111 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 4.00016 2.74142e-05 0.0263504 3.99996 0.00277368 3.83485 +EDGE_SE3:QUAT 234 235 4.1089 0.685659 0.0120015 -0.000190478 -0.00268201 0.202111 0.979359 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 4.0001 3.30259e-05 -0.0197059 3.99998 -0.00193036 3.8367 +EDGE_SE3:QUAT 235 236 4.27298 0.750545 0.0156059 0.00505066 -0.00667016 0.206428 0.978426 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 4.00086 0.000122387 -0.0621554 3.99977 -0.00672097 3.83051 +EDGE_SE3:QUAT 236 237 3.96395 0.555532 0.00720855 -0.00241067 0.00428178 0.14959 0.988736 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 4.00033 3.00361e-05 0.0373765 3.99992 0.00287367 3.91084 +EDGE_SE3:QUAT 237 238 3.98269 0.234975 -0.0290734 -0.00383802 0.0060422 0.0665252 0.997759 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 4.00059 -3.61291e-05 0.0510784 3.99983 0.00172642 3.98295 +EDGE_SE3:QUAT 238 239 4.2258 0.0152572 0.00434139 -0.00340138 -0.000548181 0.0194766 0.999804 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 3.99996 5.75368e-06 -0.00358812 4 -3.23715e-05 3.99849 +EDGE_SE3:QUAT 239 240 4.2774 -0.044143 0.0231836 0.00104516 0.000514384 0.00723825 0.999973 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 4 2.13137e-06 0.00402397 4 1.44598e-05 3.99979 +EDGE_SE3:QUAT 240 241 4.30933 -0.0801388 0.0365403 0.000325931 -0.00466241 0.00275521 0.999985 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 4.00035 -4.64438e-06 -0.0373125 3.99991 -5.12483e-05 4.00032 +EDGE_SE3:QUAT 241 242 4.26868 -0.0878417 -0.00288186 0.000105071 -0.000671101 0.00051181 1 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 4.00001 -2.76567e-07 -0.00536946 4 -1.373e-06 4.00001 +EDGE_SE3:QUAT 242 243 4.32503 -0.112287 -0.00581438 0.00150338 0.00268038 -0.00315136 0.99999 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 4.00011 1.56311e-05 0.0215 3.99997 -3.3649e-05 4.00008 +EDGE_SE3:QUAT 243 244 4.40182 -0.0984171 0.0043525 -0.00237468 0.00726807 -0.00300357 0.999966 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 4.00082 -7.27507e-05 0.0580684 3.99979 -9.02153e-05 4.00081 +EDGE_SE3:QUAT 244 245 4.36097 -0.107451 0.031699 0.00108126 0.00189246 -0.00192272 0.999996 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 4.00005 8.03759e-06 0.0151647 3.99999 -1.44941e-05 4.00004 +EDGE_SE3:QUAT 245 246 4.47113 -0.0935983 0.0316191 -0.00290454 -0.00118126 -0.00177913 0.999994 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 3.99999 1.3784e-05 -0.00951201 3.99999 8.38176e-06 4.00001 +EDGE_SE3:QUAT 246 247 4.44459 -0.0993887 -0.00150455 -0.00120652 -0.00485629 -0.000685201 0.999987 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 4.00037 2.30645e-05 -0.0388634 3.99991 1.26358e-05 4.00038 +EDGE_SE3:QUAT 247 248 4.35376 -0.10447 0.0101408 0.000539642 -0.00552203 -0.00328692 0.999979 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 4.00049 -1.43208e-05 -0.0441589 3.99988 7.29792e-05 4.00044 +EDGE_SE3:QUAT 248 249 4.31854 -0.122313 0.0117057 0.000335751 0.00678271 -0.004651 0.999966 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 4.00074 3.97991e-06 0.0542874 3.99982 -0.000125949 4.00065 +EDGE_SE3:QUAT 249 250 4.12754 -0.111985 0.0459136 0.00377778 -0.00210061 -0.00441452 0.999981 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 4.00001 -3.16972e-05 -0.0166041 3.99998 3.68961e-05 3.99999 +EDGE_SE3:QUAT 250 251 4.23124 -0.113646 0.0289427 0.00547672 0.0020229 0.00431099 0.999974 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 3.99994 4.36911e-05 0.0158989 3.99998 3.45904e-05 3.99999 +EDGE_SE3:QUAT 251 252 4.05589 0.11573 -0.0217645 0.000558811 0.00661515 0.0784595 0.996895 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 4.00067 9.46467e-05 0.0519168 3.99984 0.00202488 3.97605 +EDGE_SE3:QUAT 252 253 4.28677 0.622071 0.0189523 -0.000689257 -0.00499931 0.191332 0.981512 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 4.00033 0.000112559 -0.036277 3.99994 -0.00334929 3.8539 +EDGE_SE3:QUAT 253 254 4.1257 0.716577 0.0185307 -0.000504382 0.000653841 0.212931 0.977067 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 4.00001 1.25335e-06 0.00612889 4 0.000685144 3.81865 +EDGE_SE3:QUAT 254 255 4.129 0.766213 0.0106304 -0.00304251 0.00266818 0.214663 0.97668 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 4.00015 1.13198e-05 0.0274848 3.99995 0.00317497 3.81587 +EDGE_SE3:QUAT 255 256 4.24083 0.518848 0.00107513 -0.00177176 -0.00215444 0.110386 0.993885 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 4.00004 2.1731e-05 -0.0145936 3.99999 -0.000756629 3.95131 +EDGE_SE3:QUAT 256 257 4.06645 -0.0504979 0.0110416 0.000409433 -0.00105363 0.00359008 0.999993 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 4.00002 -1.6344e-06 -0.00844656 4 -1.51616e-05 3.99997 +EDGE_SE3:QUAT 257 258 4.39895 -0.139165 0.00322476 0.00012787 -0.00112122 -0.0140485 0.999901 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 4.00002 -9.93557e-07 -0.0089456 4 6.27842e-05 3.99923 +EDGE_SE3:QUAT 258 259 4.41541 -0.170851 0.00035207 0.000448897 -0.000176522 -0.0178467 0.999841 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 4 -2.99956e-07 -0.00131539 4 1.145e-05 3.99873 +EDGE_SE3:QUAT 212 258 6.72844 2.56521 0.062129 0.00430104 0.0101798 -0.995491 0.0942066 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 3.99985 0.000184387 0.0175014 4.0001 0.0366101 0.0359155 +EDGE_SE3:QUAT 213 258 0.178412 4.53709 0.108162 0.00506022 0.0137562 -0.931893 0.362437 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 3.99952 -0.000158087 0.0290535 4.00113 0.0250732 0.525923 +EDGE_SE3:QUAT 214 258 -5.7801 3.35956 0.0683855 0.00155781 0.0101385 -0.828064 0.56054 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 3.99985 -0.000268349 0.0226858 4.00051 0.00768687 1.2571 +EDGE_SE3:QUAT 259 260 4.16847 -0.153224 0.0167778 -0.00116052 0.00916191 -0.0167535 0.999817 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 4.00133 -7.59556e-05 0.0730523 3.99967 -0.000614065 4.00021 +EDGE_SE3:QUAT 211 259 6.95468 -0.716696 -0.0759513 0.00795826 -0.0142604 0.980784 0.194411 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 3.99941 -0.000178577 -0.0344213 4.00131 0.0398347 0.151915 +EDGE_SE3:QUAT 212 259 2.36781 1.91028 0.0192438 0.00387161 0.00995079 -0.997014 0.0764767 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 3.99989 0.000171569 0.0156591 4 0.0368704 0.0237986 +EDGE_SE3:QUAT 213 259 -3.1626 1.72061 0.0267915 0.00493357 0.0131947 -0.938283 0.345581 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 3.99955 -0.000100794 0.0272926 4.001 0.0256944 0.478151 +EDGE_SE3:QUAT 260 261 4.44269 -0.175287 0.0108527 0.000917515 0.000483241 -0.0120419 0.999927 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 4 1.78299e-06 0.00399766 4 -2.43286e-05 3.99942 +EDGE_SE3:QUAT 211 260 3.17627 1.01792 0.0319254 -0.00111568 -0.0136723 0.977454 0.210704 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 3.99992 -0.000227938 0.00372415 3.99938 0.0505079 0.17826 +EDGE_SE3:QUAT 212 260 -1.77353 1.43657 -0.00298821 0.0128768 0.0117061 -0.998079 0.0594552 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 3.99921 0.000399384 0.0517991 4.00252 0.0403455 0.0152215 +EDGE_SE3:QUAT 213 260 -6.45386 -0.862265 -0.0273284 0.0129111 0.0176708 -0.943718 0.330026 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 3.99878 -0.00112889 0.064421 4.0045 0.0218251 0.437035 +EDGE_SE3:QUAT 261 262 4.4393 -0.132065 0.0200616 0.00427106 -0.00150222 -0.00150246 0.999989 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 3.99996 -2.55254e-05 -0.0119405 3.99999 9.17992e-06 4.00003 +EDGE_SE3:QUAT 210 261 5.12479 1.79076 0.0464208 0.00132227 -0.00921996 0.8775 0.479486 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 3.99983 7.85842e-05 -0.0149051 4.00032 0.0135771 0.91981 +EDGE_SE3:QUAT 211 261 -0.807499 3.0042 0.0612096 -0.00117399 -0.0125079 0.974815 0.222662 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 3.99993 -0.000196645 0.00392541 3.99949 0.0459237 0.198875 +EDGE_SE3:QUAT 212 261 -6.196 1.07225 -0.11209 0.013357 0.0108674 -0.998718 0.047598 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 3.99919 0.000402536 0.0536181 4.0027 0.0381863 0.010148 +EDGE_SE3:QUAT 262 263 4.4607 -0.0734846 0.0199843 -0.00268736 -0.000663614 0.00461949 0.999985 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 3.99998 6.91293e-06 -0.00515972 4 -1.183e-05 3.99992 +EDGE_SE3:QUAT 210 262 2.8188 5.60226 0.116937 0.00501243 -0.00584113 0.876999 0.48043 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 3.99996 0.000382643 -0.0308833 4.00063 -0.00378986 0.923548 +EDGE_SE3:QUAT 211 262 -4.75013 5.04454 0.10447 0.00103521 -0.00871597 0.974616 0.223713 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 3.99992 -0.000109398 -0.0052212 3.99991 0.0288196 0.200419 +EDGE_SE3:QUAT 263 264 4.31029 -0.068407 0.0158338 -0.00237266 0.00089584 0.0057518 0.99998 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 3.99999 -8.64581e-06 0.00733009 4 2.11901e-05 3.99988 +EDGE_SE3:QUAT 264 265 4.26652 -0.0674887 0.013629 0.00229029 -0.00145181 0.00974871 0.999949 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 4.00001 -1.31962e-05 -0.0118807 3.99999 -5.82247e-05 3.99966 +EDGE_SE3:QUAT 265 266 4.30859 -0.0622959 0.0160674 0.00202833 -0.000236925 0.0103895 0.999944 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 3.99998 -2.24671e-06 -0.00214794 4 -1.1592e-05 3.99957 +EDGE_SE3:QUAT 266 267 4.122 -0.0497399 0.0206412 -0.000111976 -0.00206679 0.00715021 0.999972 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 4.00007 1.65728e-06 -0.0165237 3.99998 -5.90752e-05 3.99986 +EDGE_SE3:QUAT 267 268 4.18984 -0.0786115 0.00643439 -0.00335966 -0.00261766 -0.0030819 0.999986 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 4.00007 3.49466e-05 -0.0210654 3.99997 3.1969e-05 4.00007 +EDGE_SE3:QUAT 268 269 4.21899 -0.126151 -0.014043 0.00276015 0.0136588 -0.00402145 0.999895 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 4.00296 0.000133379 0.109471 3.99925 -0.000208243 4.00293 +EDGE_SE3:QUAT 269 270 4.22526 -0.110962 0.0221225 0.000970985 -0.00315645 -0.00356929 0.999988 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 4.00016 -1.30852e-05 -0.0252104 3.99996 4.52028e-05 4.00011 +EDGE_SE3:QUAT 270 271 4.04226 -0.117136 0.0197271 0.00131181 -0.00103278 -0.00258537 0.999995 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 4.00001 -5.4493e-06 -0.00822143 4 1.06436e-05 3.99999 +EDGE_SE3:QUAT 271 272 4.03281 -0.0957075 0.01666 -0.00177679 9.41615e-05 0.000837589 0.999998 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 3.99999 -6.90186e-07 0.000771146 4 3.25052e-07 4 +EDGE_SE3:QUAT 272 273 4.16605 0.057578 0.015602 -0.00215183 -0.00101799 0.0567638 0.998385 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 3.99999 7.64309e-06 -0.00664195 4 -0.000174311 3.98712 +EDGE_SE3:QUAT 273 274 4.10884 0.435923 0.00519869 -0.000915244 -0.000150036 0.150013 0.988684 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 4 -4.70768e-07 0.000462861 4 7.69305e-05 3.90998 +EDGE_SE3:QUAT 274 275 4.04287 0.623622 0.00420923 -0.0017561 0.00152773 0.183034 0.983104 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 4.00005 6.12593e-07 0.015384 3.99998 0.00150619 3.86605 +EDGE_SE3:QUAT 275 276 4.16157 0.633172 0.0165798 0.00322774 -0.00807115 0.186226 0.982468 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 4.00112 0.000211312 -0.0683034 3.99974 -0.00647592 3.86245 +EDGE_SE3:QUAT 276 277 4.18736 0.593982 0.00637571 0.000351869 0.00258878 0.154733 0.987953 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 4.00009 2.59483e-05 0.0193284 3.99998 0.00145915 3.90432 +EDGE_SE3:QUAT 277 278 4.15026 0.282387 -0.0378052 -0.0045458 0.00990321 0.0692237 0.997542 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 4.00162 -1.62064e-05 0.0824501 3.99957 0.00288238 3.98253 +EDGE_SE3:QUAT 278 279 4.31014 -0.00255887 0.00732215 -0.00365509 0.0039887 0.00877236 0.999947 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 4.00021 -5.58442e-05 0.0322919 3.99993 0.000140797 3.99995 +EDGE_SE3:QUAT 279 280 4.42286 -0.117242 0.0385452 -0.00189265 -3.2375e-05 -0.00935354 0.999954 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 3.99999 5.12459e-07 -0.000471388 4 2.53557e-06 3.99965 +EDGE_SE3:QUAT 280 281 4.31226 -0.111641 0.024222 -0.00201595 -0.00559603 -0.00476719 0.999971 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 4.00049 4.17002e-05 -0.0448868 3.99987 0.000105596 4.00041 +EDGE_SE3:QUAT 281 282 4.39007 -0.100036 0.0164513 0.00113869 -0.00759917 -0.00168847 0.999969 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 4.00092 -3.69619e-05 -0.0607821 3.99977 5.29166e-05 4.00091 +EDGE_SE3:QUAT 282 283 4.34955 -0.10984 -0.0177821 0.00479085 0.00181965 -0.00146085 0.999986 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 3.99996 3.50217e-05 0.0146408 3.99999 -1.03306e-05 4.00005 +EDGE_SE3:QUAT 283 284 4.2103 -0.0862729 0.0131985 -0.000810226 0.00585234 -0.00150491 0.999981 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 4.00055 -2.02046e-05 0.0468095 3.99986 -3.58968e-05 4.00054 +EDGE_SE3:QUAT 284 285 4.26653 -0.102662 0.0359425 0.00177251 0.00609376 -0.00159022 0.999979 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 4.00058 4.1848e-05 0.0487898 3.99985 -3.72355e-05 4.00058 +EDGE_SE3:QUAT 285 286 4.24608 -0.115177 0.0174515 0.00111197 -0.00194404 -0.000953673 0.999997 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 4.00006 -8.72422e-06 -0.0155397 3.99998 7.5089e-06 4.00006 +EDGE_SE3:QUAT 286 287 4.29112 -0.0982089 -0.0137219 -0.00145725 -0.00101643 -0.00547595 0.999983 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 4.00001 5.87924e-06 -0.00822681 4 2.25753e-05 3.9999 +EDGE_SE3:QUAT 287 288 4.50549 -0.134176 0.00247378 -0.00320651 0.00345986 -0.0102534 0.999936 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 4.00014 -4.64102e-05 0.0272807 3.99995 -0.000140096 3.99977 +EDGE_SE3:QUAT 288 289 4.33179 -0.141371 0.0476963 0.00142828 -0.00194401 -0.00890171 0.999957 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 4.00005 -1.17549e-05 -0.0153978 3.99999 6.84347e-05 3.99974 +EDGE_SE3:QUAT 289 290 4.13129 -0.109624 0.0486305 0.00277061 -0.00428021 0.000116679 0.999987 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 4.00026 -4.74024e-05 -0.0342473 3.99993 -7.79932e-07 4.00029 +EDGE_SE3:QUAT 290 291 3.99762 -0.00740395 0.0221822 0.00335774 -0.000909898 0.0379923 0.999272 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 3.99997 -1.45905e-05 -0.00879269 3.99999 -0.000176532 3.99425 +EDGE_SE3:QUAT 291 292 4.33808 0.258448 -0.0440778 0.00111712 0.00997279 0.0951373 0.995414 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 4.00149 0.000260743 0.0774587 3.99965 0.0036534 3.96529 +EDGE_SE3:QUAT 292 293 4.33752 0.445128 0.0163056 -0.00191476 -0.00109188 0.138151 0.990409 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 3.99999 5.96626e-06 -0.00535219 4 -0.000290817 3.92366 +EDGE_SE3:QUAT 293 294 4.03666 0.546552 0.0358369 0.0012551 -0.00284687 0.168157 0.985755 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 4.00014 2.11651e-05 -0.0243015 3.99997 -0.00208645 3.88704 +EDGE_SE3:QUAT 294 295 4.22441 0.618329 -0.000279242 -0.00110672 -0.0008316 0.181688 0.983355 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 4 3.11652e-06 -0.00396626 4 -0.000277071 3.86796 +EDGE_SE3:QUAT 295 296 4.25593 0.544496 -0.0171181 0.00334492 0.00316691 0.17116 0.985232 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 4.00003 4.87742e-05 0.0174939 3.99999 0.00126933 3.88289 +EDGE_SE3:QUAT 296 297 4.0578 0.760748 0.00452309 -0.00123828 0.000859092 0.237565 0.971371 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 4.00002 9.58524e-07 0.0096965 3.99999 0.00126727 3.77428 +EDGE_SE3:QUAT 297 298 4.07231 0.93296 -0.00268404 -0.00383971 0.00207627 0.259589 0.965709 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 4.00011 2.18081e-06 0.0263842 3.99995 0.00386386 3.73063 +EDGE_SE3:QUAT 298 299 3.93533 0.861204 0.0218846 -0.000757118 -0.00510579 0.228276 0.973583 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 4.00031 0.000131842 -0.0356958 3.99995 -0.00387059 3.79188 +EDGE_SE3:QUAT 299 300 4.15187 0.454861 0.0115351 -0.000985426 0.00177603 0.108976 0.994042 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 4.00005 1.5829e-06 0.0152346 3.99999 0.000848816 3.95255 +EDGE_SE3:QUAT 300 301 4.06957 0.0254715 -0.0489628 -0.00458567 0.00997434 0.0129916 0.999855 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 4.00154 -0.000153875 0.0805156 3.99959 0.000513959 4.00094 +EDGE_SE3:QUAT 301 302 4.44318 -0.166942 -0.00433245 0.000143766 -0.000618959 -0.0162264 0.999868 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 4.00001 -5.00889e-07 -0.00492174 4 3.98515e-05 3.99895 +EDGE_SE3:QUAT 302 303 4.07864 -0.143372 0.0177442 -0.000554099 -0.0032436 -0.015489 0.999875 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 4.00017 3.29109e-06 -0.0260434 3.99996 0.000201816 3.99921 +EDGE_SE3:QUAT 303 304 4.21227 -0.157456 0.0380709 0.00274319 -0.00370084 -0.0131704 0.999903 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 4.00018 -4.40384e-05 -0.0291665 3.99995 0.000192007 3.99952 +EDGE_SE3:QUAT 304 305 4.20162 -0.113497 -0.00573539 -0.000861618 -0.00215189 -0.00302058 0.999993 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 4.00007 7.09807e-06 -0.0172464 3.99998 2.59679e-05 4.00004 +EDGE_SE3:QUAT 305 306 4.30341 -0.107617 -0.0181289 0.00347345 0.00387105 -0.000924421 0.999986 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 4.00019 5.35498e-05 0.031008 3.99994 -1.30886e-05 4.00024 +EDGE_SE3:QUAT 306 307 4.30366 -0.0900398 0.0200236 -0.00146559 0.0119341 -0.00060884 0.999928 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 4.00227 -7.21729e-05 0.0955091 3.99943 -3.41294e-05 4.00228 +EDGE_SE3:QUAT 307 308 4.32755 -0.0859062 0.0431492 -0.00334746 0.000667906 -0.00033679 0.999994 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 3.99996 -8.9164e-06 0.00532964 4 -9.32422e-07 4.00001 +EDGE_SE3:QUAT 308 309 4.32343 -0.0825974 0.0247667 -0.00164498 -0.00468691 7.00531e-05 0.999988 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 4.00034 3.08842e-05 -0.0374966 3.99991 -2.18095e-06 4.00035 +EDGE_SE3:QUAT 309 310 4.45053 -0.0924299 -0.00536124 -0.0010033 -0.00124154 -0.000289439 0.999999 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 4.00002 4.97425e-06 -0.00993584 3.99999 1.40096e-06 4.00002 +EDGE_SE3:QUAT 310 311 4.2233 -0.0887951 0.0249885 0.00102577 -0.00104698 -0.00095061 0.999998 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 4.00001 -4.31284e-06 -0.00836411 4 4.00062e-06 4.00001 +EDGE_SE3:QUAT 311 312 4.19078 -0.0823109 0.0455635 0.000761806 0.00124788 -0.000767554 0.999999 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 4.00002 3.77748e-06 0.00999006 3.99999 -3.80641e-06 4.00002 +EDGE_SE3:QUAT 312 313 4.13227 -0.0993609 0.0452191 0.00154741 -0.00642996 -0.00244091 0.999975 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 4.00065 -4.21938e-05 -0.0514011 3.99984 6.42748e-05 4.00064 +EDGE_SE3:QUAT 313 314 4.07236 -0.128788 0.0114808 -3.99201e-05 -0.00334925 -0.0184785 0.999824 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 4.00018 -4.43973e-06 -0.0267902 3.99996 0.000247525 3.99881 +EDGE_SE3:QUAT 314 315 4.20467 -0.348621 -0.0367882 -0.00585057 0.0198364 -0.0892895 0.995791 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 4.00553 -0.00121631 0.150733 3.99868 -0.00668518 3.97378 +EDGE_SE3:QUAT 315 316 4.14301 -0.648188 0.011781 0.00147695 0.00270694 -0.157284 0.987549 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 4.00013 -1.4153e-05 0.0235993 3.99997 -0.00190736 3.90119 +EDGE_SE3:QUAT 316 317 4.01678 -0.757194 0.0199003 0.00407191 -0.00399094 -0.175071 0.984539 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 4.00005 -7.72422e-05 -0.0220908 3.99998 0.00164152 3.87752 +EDGE_SE3:QUAT 270 316 2.46821 6.65451 -4.85305e-05 0.00154709 0.0100041 -0.865464 0.500868 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 3.99981 -0.000141978 0.0180976 4.00043 0.0126136 1.0037 +EDGE_SE3:QUAT 271 316 -1.59731 6.75708 -0.0336223 -7.94941e-05 0.00925941 -0.864062 0.5033 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 3.99983 1.99672e-06 0.00902922 4.00017 0.0160298 1.01341 +EDGE_SE3:QUAT 317 318 3.89131 -0.821981 -0.000883396 0.000124018 0.00727257 -0.213847 0.97684 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 4.00074 -0.000247949 0.0545527 3.99986 -0.00570016 3.81782 +EDGE_SE3:QUAT 269 317 4.06327 3.43319 0.0111082 0.00177556 0.00437259 -0.940902 0.338647 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 3.99995 -1.34312e-05 0.00957366 4.00012 0.00842395 0.458778 +EDGE_SE3:QUAT 270 317 -0.197752 3.5365 -0.0145667 -0.00171011 0.00445562 -0.939738 0.341861 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 3.99999 2.79896e-05 -0.00650662 3.99992 0.016964 0.46757 +EDGE_SE3:QUAT 271 317 -4.22886 3.63142 -0.036601 -0.00306151 0.00381059 -0.938927 0.344081 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 4 -1.01776e-05 -0.0129793 3.99994 0.0183522 0.473704 +EDGE_SE3:QUAT 318 319 4.04481 -1.1561 -0.0385926 0.00183712 0.00858109 -0.272689 0.962062 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 4.0011 -0.000419193 0.0668658 3.99982 -0.00902577 3.70368 +EDGE_SE3:QUAT 268 318 4.74758 1.46828 -0.0240185 -0.00557237 0.0114899 -0.992074 0.125004 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 3.99998 -0.00016073 -0.0226303 3.99964 0.0496593 0.0632585 +EDGE_SE3:QUAT 269 318 0.531743 1.58654 -0.00189785 0.00786703 0.00709101 -0.991549 0.129298 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 3.99967 2.65585e-05 0.0323682 4.0011 0.0191909 0.0672338 +EDGE_SE3:QUAT 270 318 -3.69705 1.68491 -0.0023834 0.00447784 0.00621339 -0.991141 0.13259 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 3.99987 5.65497e-05 0.0184931 4.00034 0.0191043 0.0705014 +EDGE_SE3:QUAT 319 320 4.08136 -1.13209 -0.029277 -0.00104865 0.00466334 -0.259228 0.965804 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 4.00023 -0.000117306 0.0304954 3.99997 -0.00364244 3.73143 +EDGE_SE3:QUAT 267 319 4.73534 1.48648 0.0096533 -0.00341769 -0.00541167 0.988161 0.153286 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 3.99999 5.57998e-05 0.0139888 3.99995 0.0244785 0.0941895 +EDGE_SE3:QUAT 268 319 0.551973 1.57707 0.010979 -0.000360248 -0.00835178 0.988537 0.150747 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 3.99998 -6.73899e-05 0.00125989 3.99975 0.031948 0.0911601 +EDGE_SE3:QUAT 269 319 -3.67098 1.68167 -0.0944835 -0.0144061 -0.00791254 0.989105 0.146289 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 3.99953 0.000938277 0.0592617 4.00213 0.0465104 0.0870437 +EDGE_SE3:QUAT 320 321 4.01332 -0.957788 -0.00441717 -0.00127809 -0.00153434 -0.213289 0.976987 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 4.00005 -6.43737e-06 -0.0146189 3.99999 0.00164434 3.81809 +EDGE_SE3:QUAT 266 320 5.2755 3.78125 0.00612908 -0.00892366 -0.00682027 0.917363 0.397894 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 4.00007 0.000224896 0.0396859 3.9999 0.0410126 0.634173 +EDGE_SE3:QUAT 267 320 1.19119 3.81436 -0.0211797 -0.00689108 -0.00609515 0.914438 0.404622 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 4.00004 9.16224e-05 0.0302334 3.99986 0.0336489 0.655443 +EDGE_SE3:QUAT 268 320 -3.02214 3.88686 0.0169258 -0.00342891 -0.00808006 0.915748 0.401657 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 3.99995 -0.00011577 0.012424 3.99974 0.0292871 0.645616 +EDGE_SE3:QUAT 321 322 3.92935 -0.674141 0.00248737 0.00178421 -0.00582751 -0.131377 0.991314 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 4.00044 -0.000130949 -0.0426415 3.9999 0.00271489 3.93141 +EDGE_SE3:QUAT 267 321 -0.792472 7.39652 -0.0381247 -0.00443527 -0.00923921 0.807218 0.590164 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 3.9998 -0.000182981 0.00910346 3.99984 0.0226971 1.39347 +EDGE_SE3:QUAT 322 323 4.21637 -0.407665 0.0198309 0.00505245 -0.0143583 -0.0600984 0.998076 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 4.00296 -0.000557777 -0.110677 3.99927 0.00331351 3.98861 +EDGE_SE3:QUAT 323 324 3.99592 -0.10265 -0.0317575 0.000600296 0.00336027 0.00289738 0.99999 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 4.00018 8.84566e-06 0.026862 3.99995 3.90715e-05 4.00015 +EDGE_SE3:QUAT 324 325 4.16091 -0.0684943 0.014141 -0.00010583 0.00615356 0.00723728 0.999955 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 4.00061 3.97298e-06 0.0492403 3.99985 0.000178164 4.0004 +EDGE_SE3:QUAT 325 326 4.38979 -0.0520165 0.036154 -0.00150091 -0.00209506 0.00834286 0.999962 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 4.00006 1.32931e-05 -0.0166086 3.99998 -6.92294e-05 3.99979 +EDGE_SE3:QUAT 326 327 4.36148 -0.0513018 -0.000746205 -0.000400753 -0.00492573 0.00862346 0.999951 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 4.00039 1.28996e-05 -0.0393633 3.9999 -0.000169934 4.00009 +EDGE_SE3:QUAT 327 328 4.42586 -0.0671727 -0.0487709 0.00234328 -0.00260228 0.00566928 0.999978 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 4.00009 -2.37087e-05 -0.020977 3.99997 -5.92305e-05 3.99998 +EDGE_SE3:QUAT 328 329 4.46544 -0.0839445 -0.0326148 -0.00103887 0.00673728 0.000122418 0.999977 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 4.00072 -2.7882e-05 0.0539082 3.99982 2.16925e-06 4.00073 +EDGE_SE3:QUAT 329 330 4.01157 -0.0872898 0.0182026 -0.000912043 0.00614054 0.0013489 0.99998 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 4.0006 -2.1201e-05 0.0491454 3.99985 3.23366e-05 4.0006 +EDGE_SE3:QUAT 330 331 4.46181 -0.0862588 0.0406272 -1.54029e-05 -0.0023111 0.00264834 0.999994 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 4.00009 4.8187e-07 -0.0184884 3.99998 -2.44849e-05 4.00006 +EDGE_SE3:QUAT 331 332 4.42343 -0.0813695 0.00224713 -0.000586069 -0.0047214 0.00498752 0.999976 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 4.00035 1.3722e-05 -0.0377376 3.99991 -9.44133e-05 4.00026 +EDGE_SE3:QUAT 332 333 4.46335 -0.0451506 -0.0398647 0.00130195 -0.00357379 0.00888352 0.999953 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 4.0002 -1.5989e-05 -0.0287269 3.99995 -0.000127414 3.99989 +EDGE_SE3:QUAT 333 334 4.18533 -0.0567575 -0.0139263 0.00105125 0.00983836 0.00847153 0.999915 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 4.00154 6.09898e-05 0.0786179 3.99961 0.00033562 4.00126 +EDGE_SE3:QUAT 334 335 4.26514 -0.0784418 0.0404805 -0.00305899 -0.00114615 -0.00411662 0.999986 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 3.99998 1.41989e-05 -0.00932001 3.99999 1.91882e-05 3.99995 +EDGE_SE3:QUAT 335 336 4.18669 -0.181956 0.0496422 -0.000210309 0.0194928 -0.03786 0.999093 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 4.00605 -0.000361073 0.155717 3.9985 -0.00295867 4.00032 +EDGE_SE3:QUAT 336 337 4.17102 -0.446759 -0.0405121 -0.00592988 0.0125758 -0.116625 0.993079 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 4.0019 -0.000635801 0.0903682 3.99956 -0.0050949 3.94763 +EDGE_SE3:QUAT 337 338 4.09109 -0.790476 -0.00122477 -0.00106666 0.00386363 -0.192956 0.981199 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 4.00017 -7.00313e-05 0.0267913 3.99997 -0.00244899 3.85125 +EDGE_SE3:QUAT 338 339 3.94397 -0.844677 0.013613 0.00342786 0.000851862 -0.204508 0.978859 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 4 1.65692e-05 0.0145696 3.99998 -0.00176106 3.83276 +EDGE_SE3:QUAT 339 340 4.09373 -1.07264 -0.00026232 0.00606683 0.0176155 -0.25021 0.968012 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 4.00514 -0.00157523 0.145526 3.999 -0.0184033 3.75486 +EDGE_SE3:QUAT 340 341 4.10712 -1.20608 0.00532001 0.000510572 0.00217047 -0.275095 0.961414 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 4.00007 -2.70297e-05 0.0170311 3.99999 -0.00232414 3.69736 +EDGE_SE3:QUAT 341 342 3.86827 -1.03456 -0.00227357 -0.00130171 -0.00169972 -0.247399 0.968911 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 4.00006 -1.20966e-05 -0.0160757 3.99999 0.00209369 3.75524 +EDGE_SE3:QUAT 342 343 3.88042 -0.867111 -0.0113745 0.00352553 -0.00215164 -0.18157 0.983369 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 3.99997 -1.84182e-05 -0.00885595 4 0.000545419 3.86815 +EDGE_SE3:QUAT 343 344 4.29446 -0.529104 -0.0411828 0.00299223 0.0219176 -0.0835703 0.996256 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 4.00776 -0.000712667 0.176796 3.9981 -0.00740632 3.97986 +EDGE_SE3:QUAT 344 345 4.07379 -0.202338 0.022851 -0.00223154 0.00190134 -0.0215714 0.999763 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 4.00003 -1.78585e-05 0.0146227 3.99999 -0.000155789 3.99819 +EDGE_SE3:QUAT 345 346 4.37846 -0.0958049 0.0220177 -0.000497387 -0.00896099 0.00120768 0.999959 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 4.00128 2.01738e-05 -0.0717007 3.99968 -4.42894e-05 4.00128 +EDGE_SE3:QUAT 346 347 4.23828 -0.0630989 0.0233306 0.000835408 -0.00857393 0.0089965 0.999922 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 4.00118 -1.28178e-05 -0.0686909 3.99971 -0.000307873 4.00086 +EDGE_SE3:QUAT 347 348 4.40398 -0.056995 -0.0167797 0.00217226 0.00135525 0.00792047 0.999965 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 4.00001 1.18143e-05 0.0106345 3.99999 4.19348e-05 3.99978 +EDGE_SE3:QUAT 348 349 4.30225 -0.0781711 0.00342708 -0.00131644 0.00820772 0.00263513 0.999962 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 4.00107 -3.90304e-05 0.0657181 3.99973 8.4536e-05 4.00105 +EDGE_SE3:QUAT 349 350 4.37532 -0.0898926 0.0345255 0.0019886 0.00580594 0.00295904 0.999977 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 4.00052 4.84982e-05 0.0463815 3.99987 7.02165e-05 4.0005 +EDGE_SE3:QUAT 350 351 4.25914 -0.0778803 0.0284136 0.000561547 -0.00368704 0.00217428 0.999991 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 4.00022 -7.57878e-06 -0.0295122 3.99995 -3.19104e-05 4.0002 +EDGE_SE3:QUAT 351 352 4.22069 -0.0522786 -0.00855609 -0.00421066 -0.000313052 0.00324928 0.999986 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 3.99993 4.81835e-06 -0.00234013 4 -3.72183e-06 3.99996 +EDGE_SE3:QUAT 352 353 4.33578 -0.0577853 0.0124599 -0.0038391 0.0031381 0.00521823 0.999974 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 4.0001 -4.75562e-05 0.0253445 3.99996 6.54205e-05 4.00005 +EDGE_SE3:QUAT 353 354 4.51006 -0.0655085 0.0365978 0.000575981 -0.00561749 0.00549855 0.999969 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 4.0005 -8.79161e-06 -0.0449808 3.99987 -0.000123302 4.00038 +EDGE_SE3:QUAT 354 355 4.31791 -0.0771157 0.0424788 0.00399864 0.00392776 0.00569098 0.999968 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 4.00018 6.41807e-05 0.0311484 3.99994 8.9846e-05 4.00011 +EDGE_SE3:QUAT 355 356 4.15615 -0.0758104 0.0357909 0.000860032 -0.00778009 0.000738925 0.999969 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 4.00097 -2.57175e-05 -0.0622614 3.99976 -2.17688e-05 4.00097 +EDGE_SE3:QUAT 356 357 4.15086 -0.110542 0.0108242 0.0012301 -0.00423714 -0.000372945 0.99999 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 4.00028 -2.10098e-05 -0.0338937 3.99993 6.85102e-06 4.00029 +EDGE_SE3:QUAT 357 358 4.12678 0.0050621 -0.0166868 0.00474036 0.0228158 0.0408784 0.998892 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 4.008 0.000927144 0.180054 3.99802 0.00373897 4.0014 +EDGE_SE3:QUAT 358 359 4.36468 0.414078 0.0370255 -0.00194962 -0.00414064 0.146661 0.989176 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 4.00019 7.53759e-05 -0.0286811 3.99996 -0.00199377 3.91417 +EDGE_SE3:QUAT 359 360 4.37904 0.744576 0.0345528 -0.00133011 -0.00582341 0.199217 0.979937 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 4.00041 0.000160275 -0.0407491 3.99993 -0.0038608 3.84166 +EDGE_SE3:QUAT 360 361 4.21575 0.702862 0.00072903 0.000509646 -0.00245217 0.207275 0.97828 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 4.00009 2.55282e-05 -0.0195986 3.99998 -0.00202986 3.82824 +EDGE_SE3:QUAT 361 362 4.09728 0.741916 -0.00310148 0.000136015 0.00480921 0.218038 0.975928 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 4.00031 0.000111337 0.0354207 3.99994 0.00374629 3.81015 +EDGE_SE3:QUAT 362 363 4.13355 0.769715 0.00358245 -0.00355135 0.000166981 0.216454 0.976286 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 3.99997 -1.78705e-05 0.0101794 3.99999 0.00143049 3.81261 +EDGE_SE3:QUAT 363 364 4.26442 0.775544 0.00387953 0.00039844 -0.00645878 0.21178 0.977296 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 4.0006 0.000191408 -0.0492221 3.99988 -0.00512287 3.8212 +EDGE_SE3:QUAT 364 365 4.28029 0.700251 -0.00656348 -8.59463e-05 -0.00160925 0.176857 0.984235 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 4.00004 1.06438e-05 -0.0120962 3.99999 -0.00104609 3.87492 +EDGE_SE3:QUAT 365 366 4.35984 0.33602 0.0118924 0.000736237 0.0165452 0.0900793 0.995797 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 4.00422 0.000626019 0.130081 3.99899 0.00584389 3.97177 +EDGE_SE3:QUAT 366 367 4.12048 0.132493 0.018143 -0.00679433 -0.00473453 0.0418753 0.999089 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 4.00011 0.000132201 -0.0343659 3.99993 -0.000698299 3.99328 +EDGE_SE3:QUAT 367 368 4.26712 -0.0089696 -0.0125015 -0.00151937 -0.00607757 0.0121127 0.999907 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 4.00058 4.73813e-05 -0.048395 3.99985 -0.000294079 4 +EDGE_SE3:QUAT 368 369 4.38049 -0.0390591 -0.0175017 -0.000905399 0.00557864 0.00634941 0.999964 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 4.0005 -1.54982e-05 0.0447002 3.99988 0.000141349 4.00034 +EDGE_SE3:QUAT 369 370 4.01539 -0.0911238 0.0145181 -0.000408693 -0.0036107 -0.00527775 0.999979 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 4.00021 4.25678e-06 -0.0289116 3.99995 7.61981e-05 4.0001 +EDGE_SE3:QUAT 370 371 4.39371 -0.160677 0.0423008 0.00402479 0.000684899 -0.0138897 0.999895 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 3.99994 1.26341e-05 0.00614823 4 -4.41933e-05 3.99924 +EDGE_SE3:QUAT 371 372 4.26307 -0.150118 0.0215734 -0.000852889 -0.00154438 -0.0127321 0.999917 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 4.00004 4.60067e-06 -0.0124824 3.99999 7.96863e-05 3.99939 +EDGE_SE3:QUAT 372 373 4.36806 -0.146309 -0.00774928 0.00265773 -0.000348716 -0.0084105 0.999961 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 3.99997 -3.25236e-06 -0.00252118 4 1.02324e-05 3.99972 +EDGE_SE3:QUAT 373 374 4.25076 -0.0835171 -0.00413294 -0.00154767 0.00637837 -0.000162594 0.999978 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 4.00064 -3.96644e-05 0.051031 3.99984 -5.66165e-06 4.00065 +EDGE_SE3:QUAT 374 375 4.24565 -0.106624 0.0261299 0.000667652 0.00617351 -0.0001579 0.999981 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 4.00061 1.63519e-05 0.0493959 3.99985 -3.29056e-06 4.00061 +EDGE_SE3:QUAT 375 376 4.28375 -0.0965944 0.0464592 -0.00161284 -0.00311733 -0.00059639 0.999994 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 4.00015 1.99868e-05 -0.0249509 3.99996 7.06569e-06 4.00015 +EDGE_SE3:QUAT 376 377 4.12781 -0.0788323 0.0189083 -0.00301763 -0.0021006 -0.000256777 0.999993 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 4.00003 2.5348e-05 -0.0168142 3.99998 1.83938e-06 4.00007 +EDGE_SE3:QUAT 377 378 4.0124 -0.0914897 0.0199525 0.00174981 -0.00351274 0.000231319 0.999992 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 4.00019 -2.45277e-05 -0.0281078 3.99995 -2.73318e-06 4.0002 +EDGE_SE3:QUAT 378 379 4.20297 -0.0950665 0.0237341 0.00372459 -6.01737e-05 0.00453335 0.999983 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 3.99994 -1.39884e-06 -0.000683978 4 -1.70286e-06 3.99992 +EDGE_SE3:QUAT 379 380 4.09586 0.0197491 0.0329883 0.00162667 0.00845381 0.0416004 0.999097 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 4.0011 0.000123815 0.0666596 3.99973 0.00138344 3.99419 +EDGE_SE3:QUAT 380 381 4.12653 0.259535 0.0122818 0.00283619 0.000907163 0.109325 0.994002 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 3.99997 3.8002e-06 0.00343636 4 0.000117675 3.95219 +EDGE_SE3:QUAT 381 382 4.37701 0.680543 0.0108775 -0.00423983 -0.00524463 0.192667 0.981241 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 4.00015 0.000133569 -0.0300825 3.99997 -0.00250856 3.85174 +EDGE_SE3:QUAT 382 383 3.98817 0.628908 0.008313 0.000661471 -0.00170311 0.186794 0.982397 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 4.00005 9.54928e-06 -0.0143664 3.99999 -0.00136512 3.86048 +EDGE_SE3:QUAT 383 384 4.26137 0.606004 -0.00391021 -0.000291874 0.00120614 0.157446 0.987527 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 4.00002 4.29023e-06 0.00983494 3.99999 0.000779114 3.90087 +EDGE_SE3:QUAT 384 385 4.14869 0.293343 -0.0198179 0.00193194 -0.00052869 0.0884011 0.996083 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 3.99999 -5.54125e-06 -0.00621877 4 -0.000304309 3.96875 +EDGE_SE3:QUAT 385 386 4.15384 0.0724005 0.00103878 -0.000461814 -0.000265464 0.0284089 0.999596 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 4 4.83735e-07 -0.00196379 4 -2.71376e-05 3.99677 +EDGE_SE3:QUAT 386 387 4.25353 -0.0988744 0.0159082 -0.00040788 -0.000912524 -0.00771914 0.99997 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 4.00001 1.34342e-06 -0.00733734 4 2.83587e-05 3.99978 +EDGE_SE3:QUAT 342 386 -2.15714 6.94522 0.172843 0.00576993 0.0124822 -0.859465 0.511009 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 3.99978 -0.000854398 0.0435191 4.00152 0.00306514 1.04519 +EDGE_SE3:QUAT 387 388 4.13615 -0.116907 0.00996361 -0.0010603 -0.00516332 -0.00838944 0.999951 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 4.00042 1.65897e-05 -0.0414127 3.99989 0.000173226 4.00015 +EDGE_SE3:QUAT 341 387 1.69362 3.9021 0.0652967 0.00841429 0.00866563 -0.961421 0.274816 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 3.99958 -0.000326972 0.0386832 4.00159 0.0111944 0.302545 +EDGE_SE3:QUAT 342 387 -4.2938 3.27686 0.0951386 0.00458863 0.0123427 -0.863391 0.504364 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 3.99975 -0.000615625 0.0365752 4.00122 0.00713204 1.01806 +EDGE_SE3:QUAT 388 389 4.1761 -0.0877881 0.00590456 -0.00088067 0.0173485 -0.00205478 0.999847 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 4.00482 -7.62179e-05 0.138912 3.9988 -0.000149529 4.0048 +EDGE_SE3:QUAT 340 388 3.42761 1.33767 0.0234917 -0.00349025 -0.00907978 0.999915 0.00870473 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 3.99996 0.000123413 0.0139642 3.99985 0.0365561 0.000685959 +EDGE_SE3:QUAT 341 388 -1.90357 1.81044 -0.00619571 0.0032429 0.00878117 -0.963743 0.26667 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 3.99982 4.83048e-05 0.0156115 4.00031 0.0226146 0.284664 +EDGE_SE3:QUAT 342 388 -6.42457 -0.244877 0.0291347 -0.000415497 0.0112868 -0.867421 0.497446 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 3.99975 4.04647e-05 0.00895847 4.00019 0.0210271 0.990067 +EDGE_SE3:QUAT 389 390 4.21929 -0.109811 0.0119327 0.00251123 -0.00348813 -0.000488697 0.999991 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 4.00017 -3.51615e-05 -0.0278912 3.99995 7.54757e-06 4.00019 +EDGE_SE3:QUAT 339 389 4.19343 0.600705 0.0342736 -0.00475711 -0.00990597 0.965319 0.260841 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 4 -2.23033e-05 0.0194639 3.99958 0.0422955 0.272727 +EDGE_SE3:QUAT 340 389 -0.727287 1.51211 -0.000660236 -0.0208719 -0.00954503 0.999679 0.0107502 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 3.99829 0.000904799 0.0834981 4.00651 0.0400579 0.00260637 +EDGE_SE3:QUAT 341 389 -5.50754 -0.230416 -0.0335071 0.0197982 0.0143636 -0.963975 0.264867 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 3.99821 -0.00192324 0.0891774 4.00779 0.00860439 0.282794 +EDGE_SE3:QUAT 390 391 4.2718 -0.0972414 0.0227513 0.00100328 -0.0014188 -0.00065535 0.999998 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 4.00003 -5.72033e-06 -0.0113426 3.99999 3.76431e-06 4.00003 +EDGE_SE3:QUAT 338 390 5.61776 1.48666 0.0693824 -0.00086778 -0.0110287 0.891204 0.453469 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 3.99978 -0.000126292 -0.00386144 4.00002 0.0256493 0.822805 +EDGE_SE3:QUAT 339 390 0.594108 2.80819 0.0309041 -0.000824987 -0.00838603 0.96522 0.261304 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 3.99995 -9.98973e-05 0.00242263 3.99979 0.0295632 0.273359 +EDGE_SE3:QUAT 340 390 -4.93838 1.7061 -0.161919 -0.0175719 -0.00707483 0.999761 0.010887 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 3.99879 0.000574808 0.070296 4.00468 0.0298712 0.00193269 +EDGE_SE3:QUAT 391 392 4.22275 -0.0864155 0.0171784 -0.00130839 -0.00140762 0.00100423 0.999998 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 4.00002 7.40094e-06 -0.0112452 3.99999 -5.70593e-06 4.00003 +EDGE_SE3:QUAT 338 391 3.18589 4.99407 0.131064 0.000999198 -0.0105109 0.89108 0.453723 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 3.99978 1.17596e-05 -0.0128808 4.00029 0.0191618 0.823682 +EDGE_SE3:QUAT 339 391 -3.03007 5.0548 0.0703007 0.000694983 -0.00782275 0.965096 0.261777 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 3.99993 -8.66654e-05 -0.00417375 3.99995 0.0247055 0.274283 +EDGE_SE3:QUAT 392 393 4.23959 -0.0930538 0.0169642 0.000320463 -0.000535179 0.00222136 0.999997 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 4 -6.72526e-07 -0.00428995 4 -4.76571e-06 3.99998 +EDGE_SE3:QUAT 393 394 4.20446 -0.0885982 0.00576651 0.000805962 0.00166307 0.00503267 0.999986 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 4.00004 5.66742e-06 0.0132555 3.99999 3.33682e-05 3.99994 +EDGE_SE3:QUAT 394 395 4.28205 -0.0742068 0.0194724 0.00182864 -0.00238447 0.005314 0.999981 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 4.00008 -1.68518e-05 -0.0191919 3.99998 -5.08464e-05 3.99998 +EDGE_SE3:QUAT 395 396 4.22634 -0.0688436 0.0177863 -0.0012222 -0.000972281 0.00400293 0.999991 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 4.00001 4.79508e-06 -0.00771936 4 -1.54383e-05 3.99995 +EDGE_SE3:QUAT 396 397 4.23106 -0.0655581 0.00359356 -0.00238662 -0.00315808 0.00355647 0.999986 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 4.00014 3.08355e-05 -0.025163 3.99996 -4.52573e-05 4.00011 +EDGE_SE3:QUAT 397 398 4.15847 -0.0876229 0.00334735 0.000596614 0.014241 0.00279652 0.999895 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 4.00324 4.76948e-05 0.113988 3.99919 0.00016262 4.00321 +EDGE_SE3:QUAT 398 399 4.07239 -0.122676 0.0151702 -3.9413e-05 -0.0035785 -0.0080529 0.999961 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 4.0002 -1.91103e-06 -0.0286303 3.99995 0.000115283 3.99995 +EDGE_SE3:QUAT 399 400 4.1874 -0.120019 0.0174272 -0.000275047 -0.00135952 -0.0103996 0.999945 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 4.00003 1.03824e-06 -0.0109088 3.99999 5.67685e-05 3.9996 +EDGE_SE3:QUAT 400 401 4.03642 -0.127346 0.0202918 -0.00118007 8.07782e-05 -0.00776453 0.999969 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 3.99999 -2.95664e-07 0.000536218 4 -1.93952e-06 3.99976 +EDGE_SE3:QUAT 401 402 4.31095 0.000923787 0.031234 -0.00151797 -0.00116322 0.0415188 0.999136 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 4.00001 7.45317e-06 -0.00852631 4 -0.000171646 3.99312 +EDGE_SE3:QUAT 402 403 4.27387 0.369932 -0.00172259 0.00311854 0.00111882 0.129846 0.991529 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 3.99996 4.69437e-06 0.00392053 4 0.000144458 3.93256 +EDGE_SE3:QUAT 403 404 4.3725 0.585583 3.91547e-05 -0.00213339 -0.00114064 0.166092 0.986107 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 3.99999 5.1765e-06 -0.00457621 4 -0.000251732 3.88966 +EDGE_SE3:QUAT 404 405 3.98603 0.482117 0.018511 0.00304007 -0.00430059 0.160183 0.987073 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 4.00034 2.5906e-05 -0.0388357 3.99991 -0.00322939 3.89774 +EDGE_SE3:QUAT 405 406 4.04052 0.509816 0.0010284 0.00271689 -0.00319578 0.159391 0.987207 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 4.00019 7.9393e-06 -0.029708 3.99994 -0.00247867 3.8986 +EDGE_SE3:QUAT 406 407 4.15268 0.500755 -0.0119754 -0.00353617 0.0143763 0.127106 0.991779 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 4.00341 0.000448525 0.117659 3.99918 0.00753072 3.93883 +EDGE_SE3:QUAT 407 408 4.34037 0.161007 0.0421799 -0.00440671 0.00409717 0.0435583 0.999033 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 4.00023 -5.92693e-05 0.034986 3.99992 0.000776181 3.99272 +EDGE_SE3:QUAT 408 409 4.36074 -0.0943457 0.0372289 -0.00377281 -0.00647531 -0.0040928 0.999964 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 4.00062 9.40963e-05 -0.0519931 3.99983 0.000102752 4.00061 +EDGE_SE3:QUAT 409 410 4.40172 -0.154711 0.0262989 0.0026199 -0.00461042 -0.0138108 0.999891 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 4.0003 -5.44672e-05 -0.0364409 3.99992 0.000251983 3.99957 +EDGE_SE3:QUAT 410 411 4.39232 -0.136948 -0.000598387 0.000880526 0.000451013 -0.00621881 0.99998 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 4 1.59574e-06 0.0036736 4 -1.14862e-05 3.99985 +EDGE_SE3:QUAT 411 412 4.34485 -0.107257 0.00615729 0.000571022 0.00751862 -0.00306181 0.999967 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 4.0009 1.30371e-05 0.060181 3.99977 -9.14211e-05 4.00087 +EDGE_SE3:QUAT 412 413 4.16082 -0.0894417 0.0466038 -0.00152523 0.0031566 -0.00254264 0.999991 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 4.00015 -1.98195e-05 0.0252068 3.99996 -3.23932e-05 4.00013 +EDGE_SE3:QUAT 413 414 4.01131 -0.0904173 0.0192136 -0.00148307 -0.00484606 -0.00265977 0.999984 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 4.00037 2.73019e-05 -0.0388185 3.99991 5.082e-05 4.00035 +EDGE_SE3:QUAT 414 415 4.33974 -0.0946825 -0.00442572 -0.00230817 0.00200302 -0.0023164 0.999993 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 4.00004 -1.86167e-05 0.0159599 3.99998 -1.86815e-05 4.00004 +EDGE_SE3:QUAT 415 416 4.41435 -0.0987886 -0.000289403 -0.000948946 -0.000800129 -0.00255467 0.999996 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 4.00001 3.01597e-06 -0.00643006 4 8.21107e-06 3.99998 +EDGE_SE3:QUAT 416 417 4.32943 -0.0978798 0.0181224 -0.00360825 -0.000200933 -0.00455329 0.999983 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 3.99995 3.36883e-06 -0.00180454 4 4.25365e-06 3.99992 +EDGE_SE3:QUAT 417 418 4.39594 -0.156638 0.0229942 0.00577775 -0.00070335 -0.0101851 0.999931 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 3.99987 -1.36293e-05 -0.00491955 4 2.39084e-05 3.99959 +EDGE_SE3:QUAT 418 419 4.02356 -0.102975 0.0187012 0.000339955 -0.00617514 -0.00458787 0.99997 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 4.00061 -1.25938e-05 -0.0493874 3.99985 0.000113632 4.00053 +EDGE_SE3:QUAT 419 420 4.27406 -0.11939 -0.00933989 0.00544082 0.000171505 0.0080755 0.999953 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 3.99988 1.82225e-06 0.000844634 4 2.70241e-06 3.99974 +EDGE_SE3:QUAT 420 421 4.22302 0.13884 -0.00800953 0.00411344 0.0178365 0.0862176 0.996108 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 4.00462 0.000898933 0.137002 3.9989 0.00587031 3.97495 +EDGE_SE3:QUAT 421 422 4.12694 0.452748 0.0281802 -0.00258375 -0.00486495 0.146938 0.98913 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 4.00025 0.00010639 -0.0331771 3.99995 -0.00229624 3.91391 +EDGE_SE3:QUAT 422 423 4.19381 0.642694 0.0264779 -0.00575461 -0.00504161 0.181172 0.983422 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 4.00003 0.000120036 -0.0261248 3.99998 -0.00192973 3.86887 +EDGE_SE3:QUAT 423 424 4.09493 0.564378 0.0138985 0.00598833 0.00172537 0.183424 0.983014 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 3.99985 -1.26349e-05 0.000226618 4 -0.000403773 3.86542 +EDGE_SE3:QUAT 424 425 4.33889 0.900543 0.0229041 -0.0013567 0.00281559 0.24727 0.968942 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 4.00014 3.7958e-05 0.0243531 3.99997 0.0030874 3.75558 +EDGE_SE3:QUAT 425 426 4.20202 0.985552 0.00315092 -0.004902 -0.000313977 0.251665 0.967802 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 3.99993 -3.41198e-05 0.0119018 3.99998 0.00212765 3.74669 +EDGE_SE3:QUAT 426 427 4.10565 0.741221 0.0124702 0.00301623 -0.00746942 0.205004 0.978728 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 4.00096 0.000209412 -0.0632544 3.99978 -0.00660394 3.83289 +EDGE_SE3:QUAT 427 428 4.35178 0.551205 -0.0126135 -0.00153145 -0.00223492 0.137442 0.990506 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 4.00005 2.3179e-05 -0.0148812 3.99999 -0.000953217 3.92449 +EDGE_SE3:QUAT 428 429 4.13523 0.283344 -0.0191612 -0.00280929 0.0184485 0.0842206 0.996272 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 4.00551 0.000490075 0.149027 3.99865 0.00629272 3.97717 +EDGE_SE3:QUAT 429 430 4.4334 0.109151 0.0291469 -0.00251626 0.00199549 0.0321621 0.999478 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 4.00005 -1.83074e-05 0.0169098 3.99998 0.000276748 3.99593 +EDGE_SE3:QUAT 430 431 4.17554 -0.0461046 0.0273408 -0.00356627 -0.00673665 0.00540026 0.999956 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 4.00067 0.000101445 -0.0536671 3.99982 -0.000148625 4.0006 +EDGE_SE3:QUAT 431 432 4.27252 -0.0600225 -0.011445 -0.00160083 -0.0012888 0.0045471 0.999988 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 4.00002 8.33806e-06 -0.0102227 3.99999 -2.32388e-05 3.99994 +EDGE_SE3:QUAT 432 433 4.37387 -0.0787072 0.0151967 0.000239705 -0.00873841 0.00494246 0.99995 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 4.00122 6.74132e-07 -0.0699376 3.99969 -0.000172541 4.00112 +EDGE_SE3:QUAT 433 434 4.42959 -0.0730096 0.00914638 0.00457225 0.00830244 0.00418175 0.999946 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 4.00101 0.00015816 0.066202 3.99973 0.000145883 4.00103 +EDGE_SE3:QUAT 434 435 4.3047 -0.0839115 0.0312165 0.00101844 0.000231263 0.00323368 0.999994 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 4 9.19267e-07 0.00181055 4 2.90732e-06 3.99996 +EDGE_SE3:QUAT 435 436 4.19742 -0.0907578 0.0230562 0.000781962 -0.00198647 0.0035396 0.999991 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 4.00006 -5.89457e-06 -0.0159249 3.99998 -2.81302e-05 4.00001 +EDGE_SE3:QUAT 436 437 4.22753 -0.0848961 -0.0147568 -0.000159602 0.00128961 0.00276902 0.999995 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 4.00003 -7.13254e-07 0.0103221 3.99999 1.42873e-05 4 +EDGE_SE3:QUAT 437 438 4.22115 -0.0753146 0.00908493 -0.00191261 0.00782414 0.00267782 0.999964 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 4.00097 -5.60452e-05 0.062667 3.99975 8.11713e-05 4.00095 +EDGE_SE3:QUAT 438 439 4.29272 -0.0941986 0.0386378 0.000489463 -0.000397308 0.00200354 0.999998 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 4 -7.7407e-07 -0.00319021 4 -3.19792e-06 3.99999 +EDGE_SE3:QUAT 439 440 4.07415 -0.0666012 0.0232788 -0.00154299 -0.00552261 0.00585378 0.999966 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 4.00048 3.82545e-05 -0.0440747 3.99988 -0.00013006 4.00035 +EDGE_SE3:QUAT 440 441 4.06348 -0.0586851 0.0166169 0.00155329 -0.00730974 0.00197714 0.99997 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 4.00085 -4.29497e-05 -0.0585252 3.99979 -5.59062e-05 4.00084 +EDGE_SE3:QUAT 441 442 4.23328 -0.14636 -0.010568 0.00193154 0.00213577 -0.0226844 0.999739 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 4.00006 1.45608e-05 0.0175988 3.99998 -0.000201335 3.99802 +EDGE_SE3:QUAT 442 443 4.02614 -0.241154 0.0183384 -0.000165177 0.0180832 -0.0549833 0.998323 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 4.00518 -0.000441208 0.144064 3.99873 -0.00396838 3.99309 +EDGE_SE3:QUAT 443 444 4.18417 -0.484396 0.0247426 -0.00526001 -0.00330043 -0.126653 0.991928 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 4.00017 4.58003e-05 -0.0336807 3.99992 0.00228632 3.93612 +EDGE_SE3:QUAT 444 445 4.09688 -0.755028 0.0140666 0.00290832 -0.000732314 -0.179505 0.983753 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 3.99997 3.96531e-06 0.000552498 4 -0.000245592 3.87111 +EDGE_SE3:QUAT 445 446 4.16756 -1.01479 0.00771215 0.000342031 0.0029793 -0.242065 0.970255 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 4.00013 -4.54789e-05 0.0227258 3.99998 -0.0027025 3.76575 +EDGE_SE3:QUAT 398 445 5.71949 4.11085 0.0439766 0.00412282 0.00687039 -0.919117 0.393902 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 3.99986 -0.000189584 0.0232195 4.00056 0.00644501 0.62082 +EDGE_SE3:QUAT 399 445 1.57302 4.25036 0.0212081 0.000732274 0.00813383 -0.916057 0.400965 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 3.99987 3.80843e-05 0.00774052 4.00011 0.0182512 0.643233 +EDGE_SE3:QUAT 400 445 -2.7372 4.32481 0.0102369 -0.000391198 0.0093156 -0.911877 0.410358 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 3.99985 0.000101838 0.00324248 3.99999 0.0236048 0.673776 +EDGE_SE3:QUAT 446 447 4.02795 -1.10008 -0.0281904 0.00107177 0.0142218 -0.262849 0.964732 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 4.00276 -0.00111864 0.105477 3.99956 -0.0134907 3.72641 +EDGE_SE3:QUAT 397 446 6.25863 1.70862 -0.0467127 -0.00882493 0.0115182 -0.986685 0.161994 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 3.99993 -0.000376839 -0.0362797 3.99997 0.054222 0.106055 +EDGE_SE3:QUAT 398 446 2.08867 1.79302 0.00906564 0.00518326 0.00854739 -0.98717 0.15936 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 3.99979 9.17359e-05 0.0217841 4.00049 0.0256031 0.101875 +EDGE_SE3:QUAT 399 446 -1.96571 1.87418 0.0098742 0.00181914 0.0088773 -0.985913 0.167016 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 3.99992 0.000116221 0.00790628 3.99992 0.0306954 0.111837 +EDGE_SE3:QUAT 400 446 -6.2144 1.87928 0.0162288 0.00022828 0.00973387 -0.984094 0.177383 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 3.99995 0.000120012 0.00139085 3.99973 0.0355923 0.126188 +EDGE_SE3:QUAT 447 448 4.08019 -1.14044 0.00141398 0.00263449 0.00340882 -0.262407 0.964948 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 4.00023 -5.48729e-05 0.0324196 3.99994 -0.00448556 3.72483 +EDGE_SE3:QUAT 396 447 6.33201 1.41277 0.0299778 -0.00604784 -0.00731852 0.995009 0.099331 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 3.99992 0.000194348 0.024492 4.00016 0.0333168 0.0398976 +EDGE_SE3:QUAT 397 447 2.09901 1.47277 0.0128208 -0.00271123 -0.00975934 0.994606 0.10323 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 4 3.09238e-05 0.0109319 3.99964 0.0402148 0.0430642 +EDGE_SE3:QUAT 398 447 -2.02621 1.56996 -0.0550235 -0.0171099 -0.0105011 0.994168 0.105956 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 3.9992 0.00123399 0.0695047 4.00323 0.0552438 0.0468942 +EDGE_SE3:QUAT 399 447 -6.10022 1.59521 -0.0202752 -0.0136569 -0.0102788 0.995026 0.0981381 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 3.99951 0.000829095 0.0553481 4.00186 0.0507878 0.0399458 +EDGE_SE3:QUAT 448 449 4.18256 -1.02625 0.0102465 0.000117742 0.000371622 -0.233354 0.972392 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 4 -6.46966e-07 0.00305121 4 -0.000358976 3.78219 +EDGE_SE3:QUAT 396 448 2.562 3.34131 0.00742082 -0.00691539 -0.00575782 0.934071 0.356974 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 4.00003 0.000150229 0.0303323 3.99995 0.0332639 0.510269 +EDGE_SE3:QUAT 397 448 -1.66172 3.41496 0.0216689 -0.00333905 -0.00706176 0.932686 0.360604 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 3.99998 -6.64006e-05 0.0130481 3.99978 0.0278733 0.520409 +EDGE_SE3:QUAT 398 448 -5.75328 3.56014 -0.152737 -0.0168438 -0.0119348 0.931585 0.362937 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 4.0002 0.00104828 0.0748042 4.00016 0.0752499 0.52993 +EDGE_SE3:QUAT 449 450 3.94197 -0.83005 -0.00407587 0.00338911 -0.0129465 -0.163424 0.986465 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 4.00211 -0.000715418 -0.092961 3.99957 0.0073235 3.89532 +EDGE_SE3:QUAT 396 449 0.13536 6.88326 0.00120213 -0.00583242 -0.00672531 0.824968 0.565109 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 3.99994 -0.000123435 0.0218298 3.99976 0.0259632 1.27778 +EDGE_SE3:QUAT 450 451 4.18376 -0.341491 0.0161359 0.000521438 -0.0125194 -0.0461651 0.998855 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 4.00248 -0.000198289 -0.0996005 3.99939 0.00230006 3.99395 +EDGE_SE3:QUAT 451 452 4.32447 -0.171876 -0.0268902 0.00532907 0.00611893 -0.00557495 0.999952 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 4.00049 0.000126687 0.0493102 3.99985 -0.000132989 4.00048 +EDGE_SE3:QUAT 452 453 4.23844 -0.0550637 0.00573537 -0.00579293 0.000100576 0.00288209 0.999979 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 3.99987 -3.10305e-06 0.0010049 4 1.54231e-06 3.99997 +EDGE_SE3:QUAT 453 454 4.32124 -0.0891427 0.00982075 0.00215153 -0.00154376 0.00228677 0.999994 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 4.00002 -1.32389e-05 -0.0124091 3.99999 -1.40871e-05 4.00002 +EDGE_SE3:QUAT 454 455 4.21689 -0.0692608 -0.0147282 -0.00278188 -0.00366823 0.0020021 0.999987 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 4.00018 4.13453e-05 -0.0292798 3.99995 -3.01874e-05 4.0002 +EDGE_SE3:QUAT 455 456 4.08519 -0.0835792 -0.0430681 0.00131861 0.00297195 0.00221168 0.999992 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 4.00013 1.61141e-05 0.0237411 3.99996 2.65222e-05 4.00012 +EDGE_SE3:QUAT 456 457 4.43358 -0.0814892 -0.0209707 0.00172168 0.0034251 0.00306836 0.999988 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 4.00017 2.4379e-05 0.027338 3.99995 4.23969e-05 4.00015 +EDGE_SE3:QUAT 457 458 4.55818 -0.080389 0.0232291 -0.000875433 0.00467793 0.00305198 0.999984 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 4.00035 -1.47991e-05 0.0374578 3.99991 5.67291e-05 4.00031 +EDGE_SE3:QUAT 458 459 4.10044 -0.0739748 0.00323373 -0.000496012 -0.00787257 0.00295213 0.999965 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 4.00099 2.00175e-05 -0.0629758 3.99975 -9.37453e-05 4.00096 +EDGE_SE3:QUAT 459 460 4.16133 -0.0795181 -0.0313967 0.000534729 -0.00160221 0.00296406 0.999994 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 4.00004 -3.2508e-06 -0.0128367 3.99999 -1.90011e-05 4.00001 +EDGE_SE3:QUAT 460 461 4.0824 -0.0852266 -0.00280018 0.000593747 0.00719034 0.00402183 0.999966 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 4.00083 2.2065e-05 0.057503 3.99979 0.000116413 4.00076 +EDGE_SE3:QUAT 461 462 4.53269 -0.0786386 0.050019 -0.00261295 0.00500904 0.00143934 0.999983 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 4.00038 -5.15813e-05 0.0401205 3.9999 2.73154e-05 4.00039 +EDGE_SE3:QUAT 462 463 4.24424 -0.148671 0.069171 -0.000914046 -0.00206466 -0.014682 0.99989 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 4.00007 6.11972e-06 -0.0166732 3.99998 0.00012269 3.99921 +EDGE_SE3:QUAT 463 464 4.2299 -0.244497 0.0378877 -0.000443893 0.00610922 -0.054348 0.998503 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 4.00058 -5.8684e-05 0.0483746 3.99986 -0.00131084 3.98877 +EDGE_SE3:QUAT 464 465 4.07508 -0.422537 -0.0562471 -0.00947746 0.02246 -0.0994059 0.994748 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 4.00651 -0.00183842 0.166001 3.99845 -0.00816073 3.96734 +EDGE_SE3:QUAT 465 466 3.98255 -0.580048 0.0110731 0.00219337 0.002915 -0.1464 0.989219 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 4.00015 -6.59937e-06 0.0263735 3.99996 -0.0020056 3.91444 +EDGE_SE3:QUAT 466 467 4.1747 -0.909851 0.0103457 0.000795359 -0.00175571 -0.22342 0.97472 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 4.00003 -1.55042e-05 -0.0109459 4 0.0011029 3.80036 +EDGE_SE3:QUAT 467 468 3.8736 -1.04043 -0.0366229 0.00416605 0.0157247 -0.255633 0.966637 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 4.00389 -0.00130855 0.126004 3.99929 -0.0161169 3.74257 +EDGE_SE3:QUAT 468 469 3.9363 -1.1279 0.000815407 -0.00486597 0.00511966 -0.272484 0.962134 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 4.00001 -0.000103741 0.0213567 4 -0.0019719 3.70311 +EDGE_SE3:QUAT 469 470 4.00603 -1.21676 -0.00567968 0.00346466 -0.000554677 -0.272596 0.962122 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 3.99996 1.67285e-05 0.00681986 3.99999 -0.00146668 3.70277 +EDGE_SE3:QUAT 470 471 3.96474 -0.950938 -0.00955231 0.00624163 0.00413692 -0.188218 0.982099 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 4.00035 2.39581e-05 0.0451205 3.99986 -0.00462839 3.8588 +EDGE_SE3:QUAT 471 472 4.33847 -0.506528 -0.0661997 -0.00120748 0.0104929 -0.0775847 0.99693 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 4.00168 -0.000247873 0.082096 3.9996 -0.00316701 3.97761 +EDGE_SE3:QUAT 472 473 4.24634 -0.174726 -0.0109801 -0.000982057 -0.000258769 -0.0169333 0.999856 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 4 1.11512e-06 -0.00226878 4 1.97677e-05 3.99885 +EDGE_SE3:QUAT 473 474 4.45693 -0.105651 0.0241347 -0.00336041 0.00441215 -0.00387827 0.999977 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 4.00026 -6.07685e-05 0.0351418 3.99992 -6.96157e-05 4.00025 +EDGE_SE3:QUAT 474 475 4.51637 -0.0987971 0.0517747 0.00273518 -0.00554833 0.00415231 0.999972 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 4.00047 -5.78919e-05 -0.0445261 3.99988 -9.05357e-05 4.00043 +EDGE_SE3:QUAT 475 476 4.52669 -0.0518123 0.0378529 0.000257561 -0.00598918 0.0113229 0.999918 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 4.00057 3.58041e-06 -0.0479453 3.99986 -0.00027137 4.00006 +EDGE_SE3:QUAT 476 477 4.45401 -0.0516658 -0.0128846 0.00269756 -0.00475118 0.0127988 0.999903 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 4.00034 -4.49599e-05 -0.038417 3.99991 -0.000245283 3.99971 +EDGE_SE3:QUAT 477 478 4.32208 -0.0482687 -0.024375 0.00170011 0.00518041 0.0126248 0.999905 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 4.00041 4.29903e-05 0.0411795 3.99989 0.000260534 3.99979 +EDGE_SE3:QUAT 478 479 4.45542 -0.038383 0.00232631 -0.00141004 0.0124393 0.0124345 0.999844 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 4.00248 -2.41372e-05 0.0997554 3.99938 0.000616346 4.00187 +EDGE_SE3:QUAT 479 480 4.13602 -0.0495823 0.048323 -0.00112857 -0.000694154 0.00529344 0.999985 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 4 3.13948e-06 -0.00548131 4 -1.44569e-05 3.9999 +EDGE_SE3:QUAT 480 481 4.02722 -0.0967948 0.0281506 -0.00161102 -0.00586067 -0.00479502 0.99997 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 4.00054 3.39171e-05 -0.0469819 3.99986 0.000111421 4.00046 +EDGE_SE3:QUAT 481 482 4.31183 -0.128644 -0.0170788 -0.00174645 -0.00316652 -0.00880145 0.999955 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 4.00015 2.01931e-05 -0.0255145 3.99996 0.000112135 3.99985 +EDGE_SE3:QUAT 482 483 4.29015 -0.114983 0.0052864 0.00126388 0.00471248 -0.00331626 0.999983 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 4.00035 2.2102e-05 0.0377523 3.99991 -6.19653e-05 4.00031 +EDGE_SE3:QUAT 483 484 4.2455 -0.0914985 0.0453003 0.00378601 -0.00172121 0.00121957 0.999991 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 3.99999 -2.61189e-05 -0.0138249 3.99999 -8.17081e-06 4.00004 +EDGE_SE3:QUAT 484 485 4.16435 -0.0772237 0.0337502 -0.000468299 0.00354945 0.00615736 0.999975 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 4.0002 -4.795e-06 0.0284298 3.99995 8.74299e-05 4.00005 +EDGE_SE3:QUAT 485 486 4.19386 -0.00697508 -0.0143336 -0.00136878 0.0019237 0.0257657 0.999665 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 4.00005 -8.52064e-06 0.0157974 3.99998 0.000205149 3.99741 +EDGE_SE3:QUAT 486 487 4.07776 0.185928 0.0189322 0.0034381 -0.00263136 0.102659 0.994707 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 4.00011 -2.26723e-05 -0.0249252 3.99996 -0.00134548 3.958 +EDGE_SE3:QUAT 487 488 4.1788 0.713111 0.0282666 0.00207874 0.000863866 0.211406 0.977396 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 3.99998 -1.09702e-07 0.00133643 4 -6.12259e-05 3.82123 +EDGE_SE3:QUAT 488 489 4.07306 0.851073 0.0125876 -0.00260961 -0.00495666 0.24001 0.970754 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 4.00018 0.000123874 -0.0290499 3.99998 -0.00304458 3.76979 +EDGE_SE3:QUAT 489 490 4.07894 0.891547 0.0139654 -0.00184057 0.000186536 0.238121 0.971234 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 4 -4.8658e-06 0.00642773 4 0.000968398 3.7732 +EDGE_SE3:QUAT 490 491 4.37609 0.687576 -0.0020034 -0.000906567 0.00757512 0.165814 0.986127 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 4.00089 0.000200306 0.0599015 3.9998 0.0049474 3.89092 +EDGE_SE3:QUAT 491 492 4.3812 0.480296 0.0270968 -0.00078676 -0.00274601 0.13563 0.990755 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 4.0001 2.92522e-05 -0.0201003 3.99998 -0.0013205 3.92652 +EDGE_SE3:QUAT 492 493 4.07212 0.431889 0.0185558 0.00273916 -0.00461084 0.137841 0.99044 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 4.00038 2.48612e-05 -0.0403173 3.9999 -0.00285734 3.92441 +EDGE_SE3:QUAT 493 494 4.02087 0.462257 0.015992 0.00313082 -0.00133633 0.144248 0.989536 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 4.00002 -1.5594e-05 -0.0157029 3.99998 -0.00125445 3.91683 +EDGE_SE3:QUAT 494 495 4.04678 0.399312 0.0246863 -0.00391355 0.00800177 0.109019 0.994 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 4.00109 4.94513e-05 0.0679721 3.99971 0.00377328 3.95361 +EDGE_SE3:QUAT 495 496 4.17546 0.168214 -0.0184847 -0.00335746 -0.000551404 0.0506063 0.998713 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 3.99996 2.95886e-06 -0.00235881 4 -4.23548e-05 3.98976 +EDGE_SE3:QUAT 496 497 4.33287 0.0393592 -0.0132114 -0.00390791 -0.00340569 0.0229977 0.999722 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 4.00011 5.63852e-05 -0.0261461 3.99996 -0.000297487 3.99806 +EDGE_SE3:QUAT 497 498 4.04169 -0.0395908 0.0181111 -0.000961538 0.000319892 0.0106252 0.999943 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 4 -1.28059e-06 0.00268129 4 1.44584e-05 3.99955 +EDGE_SE3:QUAT 498 499 4.55396 -0.0518129 0.0294279 0.0011004 0.00105459 0.00489125 0.999987 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 4.00001 4.72333e-06 0.00837181 4 2.04507e-05 3.99992 +EDGE_SE3:QUAT 499 500 4.22087 -0.0688585 0.0143786 0.0019965 -0.00414209 0.00327257 0.999984 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 4.00026 -3.18375e-05 -0.0332164 3.99993 -5.35785e-05 4.00023 +EDGE_SE3:QUAT 500 501 4.19757 -0.079864 -0.0117325 -0.000629738 -0.000357268 -0.000623855 1 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 4 9.00004e-07 -0.00286286 4 8.91561e-07 4 +EDGE_SE3:QUAT 501 502 4.49747 -0.0896452 -0.011149 -0.000552457 0.01044 -0.000671106 0.999945 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 4.00174 -2.48605e-05 0.0835476 3.99956 -2.9512e-05 4.00174 +EDGE_SE3:QUAT 502 503 4.36376 -0.0966078 0.0307278 -0.00139928 0.00791413 -0.00230912 0.999965 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 4.00099 -4.77672e-05 0.0632874 3.99975 -7.5204e-05 4.00098 +EDGE_SE3:QUAT 503 504 4.32184 -0.094959 0.0489418 -0.00220257 -0.00544755 -0.00286414 0.999979 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 4.00046 4.60788e-05 -0.0436598 3.99988 6.10061e-05 4.00044 +EDGE_SE3:QUAT 504 505 4.07178 -0.0996924 0.0219844 0.00014316 -0.0059665 -0.00287504 0.999978 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 4.00057 -5.8742e-06 -0.0477324 3.99986 6.87616e-05 4.00054 +EDGE_SE3:QUAT 505 506 4.54923 -0.101783 0.000914602 -0.000433115 -0.00738897 -0.0023966 0.99997 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 4.00087 9.67218e-06 -0.059135 3.99978 7.03389e-05 4.00085 +EDGE_SE3:QUAT 506 507 4.33471 -0.110987 -0.00282073 0.00278189 0.00650547 -0.00106415 0.999974 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 4.00065 7.14154e-05 0.0520863 3.99983 -2.49032e-05 4.00067 +EDGE_SE3:QUAT 507 508 4.25738 -0.10858 0.0434324 0.00318073 -0.00293708 0.00156582 0.999989 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 4.0001 -3.71731e-05 -0.0235567 3.99997 -1.77988e-05 4.00013 +EDGE_SE3:QUAT 508 509 4.2028 -0.0103298 0.0393408 0.0023325 0.00833284 0.0286136 0.999553 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 4.00106 0.000123186 0.0657953 3.99973 0.000941593 3.99781 +EDGE_SE3:QUAT 509 510 4.10101 0.177677 -0.00529079 0.00222965 0.00156002 0.0815857 0.996663 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 4.00001 1.40008e-05 0.0101825 3.99999 0.000384092 3.9734 +EDGE_SE3:QUAT 510 511 4.16465 0.383715 0.0121875 0.000670315 -0.00441013 0.122475 0.992462 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 4.00031 4.6166e-05 -0.035468 3.99993 -0.00217582 3.94031 +EDGE_SE3:QUAT 511 512 4.13181 0.51677 0.00390494 0.00143164 0.00239505 0.162449 0.986713 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 4.00005 2.7018e-05 0.0156654 3.99999 0.00117614 3.8945 +EDGE_SE3:QUAT 512 513 4.276 0.600027 0.002827 -0.0017458 0.00399551 0.166458 0.986039 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 4.00028 4.1129e-05 0.0340698 3.99993 0.00289445 3.88946 +EDGE_SE3:QUAT 513 514 4.32721 0.545005 0.00113667 -0.00352659 -0.00187585 0.136534 0.990627 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 3.99997 1.74005e-05 -0.00888271 4 -0.0004654 3.92545 +EDGE_SE3:QUAT 514 515 4.46139 0.337515 0.0124009 -0.00247581 -0.00215154 0.0839595 0.996464 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 4.00003 2.41422e-05 -0.0145479 3.99999 -0.000573489 3.97186 +EDGE_SE3:QUAT 515 516 4.46621 0.0325005 0.0199354 0.00238753 -0.00206597 0.0193521 0.999808 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 4.00005 -1.85131e-05 -0.0170729 3.99998 -0.000166706 3.99857 +EDGE_SE3:QUAT 469 515 0.566432 6.73581 0.17147 0.00815123 0.0140813 -0.953661 0.300442 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 3.99934 -0.000254938 0.0397576 4.00191 0.0262145 0.361725 +EDGE_SE3:QUAT 516 517 4.40351 -0.101279 0.0237316 -0.00372518 0.00682571 -0.00559964 0.999954 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 4.00068 -0.00010736 0.0543604 3.99982 -0.000156173 4.00061 +EDGE_SE3:QUAT 468 516 3.52776 4.05573 0.0680535 0.00343668 0.00686668 -0.998791 0.048556 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 3.99993 9.52723e-05 0.0138022 4.00006 0.0259747 0.00964759 +EDGE_SE3:QUAT 469 516 -3.07427 4.17004 0.0837989 0.00742417 0.011293 -0.947642 0.319047 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 3.99953 -0.000317742 0.0368016 4.00155 0.0170803 0.407651 +EDGE_SE3:QUAT 517 518 4.56662 -0.138343 -0.0243947 0.00271204 0.0040436 -0.0109368 0.999928 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 4.00024 4.01434e-05 0.0327005 3.99993 -0.000178406 3.99979 +EDGE_SE3:QUAT 467 517 4.99856 2.61126 0.0343743 0.00289346 -0.0118726 0.976638 0.214543 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 3.99979 -0.000194222 -0.013284 4.00007 0.0373812 0.184536 +EDGE_SE3:QUAT 468 517 -0.86052 3.73423 0.0647978 0.00997592 0.0111068 -0.998965 0.0429597 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 3.99953 0.000370507 0.0400238 4.00133 0.0408222 0.00820073 +EDGE_SE3:QUAT 469 517 -6.59316 1.63401 0.0191616 0.0126613 0.0170785 -0.949442 0.313223 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 3.99882 -0.000930809 0.0617046 4.00421 0.0235494 0.393702 +EDGE_SE3:QUAT 518 519 4.01593 -0.122944 0.00873894 0.00100044 -0.00229838 -0.0100512 0.999946 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 4.00008 -1.03769e-05 -0.0182639 3.99998 9.17102e-05 3.99968 +EDGE_SE3:QUAT 467 518 0.971796 4.63844 0.0651227 -0.000279077 -0.00816408 0.974261 0.225276 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 3.99996 -9.08048e-05 0.000450706 3.99981 0.0290645 0.203222 +EDGE_SE3:QUAT 468 518 -5.33816 3.50055 -0.0580588 0.0142459 0.0082906 -0.999341 0.0323499 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 3.99913 0.00032619 0.057072 4.00315 0.029425 0.00521789 +EDGE_SE3:QUAT 519 520 4.15362 -0.116721 0.0168352 0.000640285 0.000992959 -0.00852277 0.999963 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 4.00001 2.36648e-06 0.00800831 4 -3.42033e-05 3.99973 +EDGE_SE3:QUAT 467 519 -2.50974 6.47242 0.0917687 0.00240847 -0.0075006 0.971855 0.23545 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 3.99989 -6.23914e-05 -0.0111843 4.00013 0.0216424 0.221909 +EDGE_SE3:QUAT 520 521 4.08679 -0.107517 0.0139218 -0.00277823 -0.00221638 -0.00806834 0.999961 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 4.00005 2.41531e-05 -0.0179984 3.99998 7.26362e-05 3.99982 +EDGE_SE3:QUAT 521 522 4.09691 -0.117368 0.0313074 -0.000798583 0.00499343 -0.00537049 0.999973 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 4.0004 -1.91355e-05 0.0398977 3.9999 -0.000107592 4.00028 +EDGE_SE3:QUAT 522 523 4.2702 -0.112049 0.0197237 0.00135431 -0.00375208 -0.0030167 0.999987 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 4.00022 -2.13019e-05 -0.0299686 3.99994 4.56414e-05 4.00019 +EDGE_SE3:QUAT 523 524 4.21113 -0.0975689 0.019109 0.000326982 -0.00101031 -0.00166175 0.999998 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 4.00002 -1.36066e-06 -0.00807599 4 6.7164e-06 4.00001 +EDGE_SE3:QUAT 524 525 4.10624 -0.0941487 0.0314939 7.8119e-05 0.000270045 0.000681374 1 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 4 8.55412e-08 0.00215972 4 7.35852e-07 4 +EDGE_SE3:QUAT 525 526 4.50211 -0.0666779 0.0339388 -0.00390662 0.00267239 0.00212381 0.999987 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 4.00005 -4.16552e-05 0.0214786 3.99997 2.21705e-05 4.0001 +EDGE_SE3:QUAT 526 527 4.27042 -0.0838782 -0.0106002 3.33869e-05 0.0064116 0.00327641 0.999974 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 4.00066 4.08967e-06 0.051298 3.99984 8.41047e-05 4.00061 +EDGE_SE3:QUAT 527 528 4.26718 -0.0535459 0.020125 0.00117745 -0.0015353 0.00841548 0.999963 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 4.00003 -6.84028e-06 -0.0124 3.99999 -5.22748e-05 3.99976 +EDGE_SE3:QUAT 528 529 4.29593 -0.00277841 0.0197716 1.41743e-05 -0.00183303 0.0200145 0.999798 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 4.00005 1.50951e-06 -0.014659 3.99999 -0.000146682 3.99845 +EDGE_SE3:QUAT 529 530 4.15251 -0.0229896 0.0188806 -0.000163647 -0.00426929 0.0256519 0.999662 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 4.00029 1.39692e-05 -0.0340724 3.99993 -0.000436807 3.99766 +EDGE_SE3:QUAT 530 531 4.17012 0.190171 0.00264575 0.00442171 0.00503086 0.0866633 0.996215 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 4.00023 0.000117209 0.0352199 3.99993 0.00145566 3.97027 +EDGE_SE3:QUAT 531 532 4.17599 0.454139 0.0163361 -0.00470732 -0.00209503 0.134426 0.99091 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 3.99993 2.00342e-05 -0.00880556 4 -0.000411631 3.92774 +EDGE_SE3:QUAT 532 533 4.1119 0.503079 0.013536 0.00464251 -0.00251949 0.157784 0.98746 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 4.00011 -2.98614e-05 -0.0280528 3.99995 -0.00242305 3.90061 +EDGE_SE3:QUAT 533 534 4.26615 0.661707 0.0175654 0.00160293 -0.00130663 0.17642 0.984313 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 4.00003 -6.40805e-07 -0.013292 3.99999 -0.00125746 3.87555 +EDGE_SE3:QUAT 534 535 4.33601 0.602005 0.018217 -0.00387102 0.00962649 0.138714 0.990278 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 4.00159 0.000178381 0.0811898 3.99961 0.00572441 3.92468 +EDGE_SE3:QUAT 535 536 4.62202 0.285723 0.00554979 -0.0074072 -0.00248222 0.0587709 0.998241 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 3.99983 5.27294e-05 -0.0145417 3.99999 -0.000375826 3.98624 +EDGE_SE3:QUAT 536 537 4.09617 -0.0211368 -0.0152654 -0.000114523 -0.00194685 0.011991 0.999926 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 4.00006 1.97908e-06 -0.0155552 3.99998 -9.32357e-05 3.99949 +EDGE_SE3:QUAT 537 538 4.16211 -0.051905 -0.0119379 -0.00176199 0.00797273 0.00311062 0.999962 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 4.00101 -5.15632e-05 0.0638607 3.99975 9.67298e-05 4.00098 +EDGE_SE3:QUAT 538 539 4.28638 -0.0785964 0.0260564 -0.00030006 -0.00805741 0.000149412 0.999967 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 4.00104 9.91238e-06 -0.0644734 3.99974 -5.28749e-06 4.00104 +EDGE_SE3:QUAT 539 540 4.29041 -0.0999438 0.0309541 0.00212411 -0.00178857 -0.000659219 0.999996 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 4.00003 -1.52238e-05 -0.0142918 3.99999 4.87181e-06 4.00005 +EDGE_SE3:QUAT 540 541 4.20645 -0.105389 -0.00576796 0.00153207 -0.0044377 -0.00188172 0.999987 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 4.00031 -2.80553e-05 -0.0354691 3.99992 3.40905e-05 4.0003 +EDGE_SE3:QUAT 541 542 4.26037 -0.105103 -0.0218791 0.000153714 0.00106134 -0.00395906 0.999992 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 4.00002 5.46141e-07 0.00849789 4 -1.68226e-05 3.99996 +EDGE_SE3:QUAT 542 543 4.22128 -0.117843 -0.000672641 0.00404427 0.0154687 -0.00472046 0.999861 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 4.00378 0.000224464 0.124076 3.99904 -0.000270442 4.00376 +EDGE_SE3:QUAT 543 544 4.25249 -0.109828 0.0312933 -0.000837155 -0.00101618 -0.00477442 0.999988 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 4.00001 3.31007e-06 -0.00817718 4 1.95379e-05 3.99993 +EDGE_SE3:QUAT 544 545 4.25722 -0.102632 0.0189491 -0.00300585 -0.00550948 -0.00510168 0.999967 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 4.00045 6.28941e-05 -0.0442623 3.99988 0.000110893 4.00039 +EDGE_SE3:QUAT 545 546 4.28887 -0.111984 -0.0177924 -0.00024622 5.90858e-05 -0.0059407 0.999982 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 4 -5.57766e-08 0.000455109 4 -1.33445e-06 3.99986 +EDGE_SE3:QUAT 546 547 4.05725 -0.114219 0.0122398 -0.0010676 -0.0031118 -0.00724241 0.999968 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 4.00015 1.16622e-05 -0.024986 3.99996 9.03488e-05 3.99995 +EDGE_SE3:QUAT 547 548 4.43015 -0.133706 0.034428 0.00624863 0.00517906 0.000748901 0.999967 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 4.00027 0.000129733 0.0413777 3.99989 1.95052e-05 4.00043 +EDGE_SE3:QUAT 548 549 4.0923 0.041027 0.0563367 0.00352942 3.19027e-06 0.0477397 0.998854 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 3.99995 -4.6653e-06 -0.0019934 4 -6.36674e-05 3.99088 +EDGE_SE3:QUAT 549 550 4.16414 0.250227 -0.00389938 -0.000743275 0.00631517 0.0949442 0.995462 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 4.00064 7.28908e-05 0.0506886 3.99984 0.00240912 3.96458 +EDGE_SE3:QUAT 550 551 4.40662 0.53739 0.025895 -0.00359016 -0.00470178 0.161918 0.986786 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 4.00016 0.000107014 -0.0292913 3.99996 -0.00214422 3.89534 +EDGE_SE3:QUAT 551 552 4.15605 0.70258 0.0357281 -0.000836143 -0.000161954 0.204243 0.97892 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 4 -6.17592e-07 0.000776909 4 0.000151883 3.83314 +EDGE_SE3:QUAT 552 553 4.25571 0.971517 0.00298036 0.0033609 -0.00252756 0.263692 0.964598 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 4.00015 1.99839e-05 -0.0282916 3.99995 -0.00409827 3.72206 +EDGE_SE3:QUAT 553 554 3.98534 0.92272 -0.00511416 -0.00448064 0.0047066 0.248508 0.968608 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 4.00047 8.21587e-05 0.0470363 3.99987 0.00624393 3.75353 +EDGE_SE3:QUAT 554 555 3.98685 0.862835 0.00948669 0.00443204 -0.00556104 0.241429 0.970392 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 4.00062 0.00012012 -0.0530051 3.99984 -0.00674909 3.76755 +EDGE_SE3:QUAT 555 556 4.07604 0.805784 -0.00631121 0.00166396 -0.00241431 0.210607 0.977566 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 4.00011 1.81756e-05 -0.0221253 3.99997 -0.0024306 3.8227 +EDGE_SE3:QUAT 556 557 4.38643 0.49509 -0.0135667 -0.00452914 0.0211587 0.109345 0.993768 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 4.00734 0.000821547 0.172418 3.99822 0.00947448 3.95959 +EDGE_SE3:QUAT 557 558 4.27171 0.0539147 0.0340261 -0.00371746 -0.00063097 0.0204987 0.999783 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 3.99995 7.2529e-06 -0.0041303 4 -3.92239e-05 3.99832 +EDGE_SE3:QUAT 558 559 4.02702 -0.103039 0.00921656 -0.00221065 -0.00995547 -0.0068865 0.999924 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 4.00157 7.19697e-05 -0.0798481 3.9996 0.000270147 4.0014 +EDGE_SE3:QUAT 559 560 4.0859 -0.118488 0.00186011 0.00211739 -0.0028458 -0.0081538 0.99996 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 4.00011 -2.53718e-05 -0.0225574 3.99997 9.20929e-05 3.99986 +EDGE_SE3:QUAT 560 561 4.19832 -0.130725 0.0221422 -0.000246323 0.00556985 -0.0099677 0.999935 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 4.0005 -1.2898e-05 0.0445275 3.99988 -0.000222114 4.0001 +EDGE_SE3:QUAT 561 562 4.31871 -0.136435 0.0438802 0.00198894 0.000328618 -0.0106501 0.999941 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 3.99999 2.91891e-06 0.00288265 4 -1.57947e-05 3.99955 +EDGE_SE3:QUAT 562 563 4.30734 -0.131708 0.0202374 0.00217329 -0.00443412 -0.00702002 0.999963 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 4.00029 -4.15735e-05 -0.0352894 3.99992 0.000124691 4.00011 +EDGE_SE3:QUAT 563 564 4.35722 -0.0957348 -0.0440722 -0.00178461 0.0028473 -0.000608892 0.999994 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 4.00012 -2.04303e-05 0.0227659 3.99997 -7.27717e-06 4.00013 +EDGE_SE3:QUAT 564 565 4.47264 -0.0864903 -0.0209663 -0.00259309 0.0067825 0.00250355 0.999971 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 4.00071 -6.77581e-05 0.0543456 3.99982 6.52235e-05 4.00071 +EDGE_SE3:QUAT 565 566 4.33423 -0.0645916 0.0310897 -0.00118629 0.00477958 0.00508403 0.999975 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 4.00036 -1.99474e-05 0.0383105 3.99991 9.6817e-05 4.00026 +EDGE_SE3:QUAT 566 567 4.32741 -0.0569625 0.038884 -0.0015086 -0.00760291 0.00598758 0.999952 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 4.00091 5.40886e-05 -0.0607236 3.99977 -0.00018388 4.00078 +EDGE_SE3:QUAT 567 568 4.09411 -0.0592813 0.0238923 0.000889118 -0.0116109 0.00663969 0.99991 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 4.00216 -1.98897e-05 -0.0929961 3.99946 -0.00030636 4.00198 +EDGE_SE3:QUAT 568 569 4.3571 -0.0778374 -0.0251696 0.000782316 0.00373341 -0.00340118 0.999987 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 4.00022 1.05618e-05 0.0299001 3.99994 -5.06109e-05 4.00018 +EDGE_SE3:QUAT 569 570 4.11484 -0.173445 0.0247482 0.0024256 0.0011117 -0.0268017 0.999637 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 4 1.11259e-05 0.00966375 3.99999 -0.000132864 3.99715 +EDGE_SE3:QUAT 570 571 3.96526 -0.29729 0.0259462 -0.00163876 0.0162152 -0.0707487 0.997361 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 4.00405 -0.000539604 0.127474 3.99902 -0.00450369 3.98404 +EDGE_SE3:QUAT 571 572 4.23871 -0.570584 0.011833 -0.0040603 -0.000561207 -0.134131 0.990955 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 3.99996 2.18265e-05 -0.0108259 3.99999 0.000869247 3.92806 +EDGE_SE3:QUAT 572 573 4.25978 -0.754399 -0.00533625 0.00228468 -0.00304893 -0.164127 0.986432 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 4.00007 -4.49709e-05 -0.0189937 3.99998 0.00140861 3.89234 +EDGE_SE3:QUAT 573 574 3.95015 -0.651323 -0.00712581 0.0010333 0.00359404 -0.150851 0.988549 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 4.00022 -3.41007e-05 0.02962 3.99995 -0.002256 3.9092 +EDGE_SE3:QUAT 528 573 0.455068 6.02046 0.0329638 -0.000346175 0.0110437 -0.918162 0.396051 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 3.9998 0.000148472 0.00381868 3.99998 0.0287634 0.627711 +EDGE_SE3:QUAT 529 573 -3.59058 6.19472 0.0281423 -0.00152259 0.012069 -0.925802 0.377813 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 3.99981 0.000229549 -0.00203992 3.99976 0.0358817 0.571378 +EDGE_SE3:QUAT 574 575 4.00761 -0.691184 0.00840245 0.00404132 0.00864825 -0.148204 0.988911 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 4.0013 -0.000146114 0.074023 3.99967 -0.00560212 3.91351 +EDGE_SE3:QUAT 526 574 5.72632 3.38083 0.000222331 -0.00271785 0.0136504 -0.964555 0.263514 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 3.99992 0.000237828 -0.00994286 3.99932 0.0506831 0.27848 +EDGE_SE3:QUAT 527 574 1.49439 3.46603 0.0305383 0.00343725 0.0118009 -0.965334 0.26073 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 3.99973 0.000137169 0.016751 4.00032 0.0326984 0.272299 +EDGE_SE3:QUAT 528 574 -2.75009 3.58084 0.00844107 0.00160968 0.0112171 -0.967466 0.252749 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 3.99983 0.000172499 0.00847545 3.99997 0.0348204 0.255882 +EDGE_SE3:QUAT 575 576 4.22218 -0.597765 -0.0105053 -0.000640362 0.00296277 -0.102106 0.994769 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 4.00013 -2.71196e-05 0.0225539 3.99997 -0.00113196 3.95842 +EDGE_SE3:QUAT 525 575 6.40754 1.86819 0.0233497 0.0014945 0.00802162 -0.99274 0.120001 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 3.99996 8.85958e-05 0.00621734 3.99987 0.0295233 0.0578328 +EDGE_SE3:QUAT 526 575 1.94807 1.93148 0.0178818 0.00478602 0.0114743 -0.992973 0.11769 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 3.99979 0.000224976 0.0196893 4.00018 0.0398781 0.0559066 +EDGE_SE3:QUAT 527 575 -2.35316 2.03215 -0.000750175 0.0110855 0.0104062 -0.993248 0.115009 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 3.99934 0.000128574 0.0453357 4.00212 0.0302122 0.0536621 +EDGE_SE3:QUAT 528 575 -6.53261 2.20788 -0.00593967 0.00954392 0.00959522 -0.994241 0.106305 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 3.9995 0.000148036 0.0389077 4.00153 0.0292919 0.0458041 +EDGE_SE3:QUAT 576 577 4.39883 -0.267245 0.00701003 0.00147525 0.00164226 -0.0277736 0.999612 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 4.00004 8.25849e-06 0.0136144 3.99999 -0.000191171 3.99696 +EDGE_SE3:QUAT 524 576 6.30383 1.32948 0.0304537 0.00320529 0.00904827 -0.999784 0.0184247 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 3.99995 0.00012289 0.0128296 3.99986 0.0356909 0.00171762 +EDGE_SE3:QUAT 525 576 2.21005 1.42865 0.00407727 0.0035741 0.00858047 -0.999799 0.0177914 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 3.99994 0.000127069 0.014305 3.99994 0.0337876 0.00160279 +EDGE_SE3:QUAT 526 576 -2.26352 1.51111 -0.0321957 0.00650897 0.012633 -0.999776 0.0157081 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 3.99981 0.000331796 0.0260513 4.0001 0.0496918 0.0017741 +EDGE_SE3:QUAT 527 576 -6.54945 1.64231 -0.105767 0.0130558 0.0124498 -0.999758 0.0126263 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 3.99929 0.000613914 0.0522422 4.00221 0.0485038 0.00190797 +EDGE_SE3:QUAT 577 578 4.04204 -0.0915076 0.0209248 0.00028622 -0.00125995 0.0016514 0.999998 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 4.00003 -1.38062e-06 -0.0100853 3.99999 -8.31819e-06 4.00001 +EDGE_SE3:QUAT 523 577 6.09436 1.3236 0.0359999 -0.00551032 -0.00821652 0.999895 0.0106307 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 3.99989 0.00018283 0.022047 4.00019 0.0333296 0.0008513 +EDGE_SE3:QUAT 524 577 1.88418 1.4358 0.0180495 -0.00442356 -0.00746563 0.999922 0.00901817 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 3.99993 0.000132161 0.0176977 4.00008 0.0301778 0.0006313 +EDGE_SE3:QUAT 525 577 -2.2357 1.54282 -0.0150385 -0.00505462 -0.00728097 0.999917 0.00936928 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 3.9999 0.00014881 0.0202225 4.00018 0.0294995 0.000670936 +EDGE_SE3:QUAT 526 577 -6.61929 1.64357 -0.0775532 -0.008126 -0.0109473 0.99983 0.0123966 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 3.99975 0.000362943 0.0325165 4.00052 0.0445908 0.00137612 +EDGE_SE3:QUAT 578 579 4.02284 -0.101983 0.0185979 0.00372493 -0.0025386 0.00309612 0.999985 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 4.00005 -3.76859e-05 -0.020447 3.99997 -3.11441e-05 4.00007 +EDGE_SE3:QUAT 522 578 6.30692 1.37125 0.0565986 -0.00812246 -0.00947308 0.999851 0.0119385 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 3.99975 0.000317627 0.0325004 4.00065 0.0386663 0.00120794 +EDGE_SE3:QUAT 523 578 2.06953 1.4963 0.0147953 -0.00418324 -0.00779802 0.999922 0.00885863 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 3.99993 0.000129746 0.0167363 4.00002 0.0314843 0.000631759 +EDGE_SE3:QUAT 524 578 -2.15424 1.59311 0.00298205 -0.00316645 -0.00744901 0.999942 0.00713777 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 3.99996 9.28225e-05 0.0126678 3.99993 0.0299738 0.000468529 +EDGE_SE3:QUAT 525 578 -6.25408 1.70756 -0.0358956 -0.00389487 -0.00691258 0.999939 0.00767934 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 3.99994 0.000107465 0.0155819 4.00004 0.0278871 0.000491018 +EDGE_SE3:QUAT 579 580 4.43311 -0.0715045 -0.00197791 -0.00178519 0.00215639 0.00376293 0.999989 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 4.00006 -1.50717e-05 0.0173316 3.99998 3.24599e-05 4.00002 +EDGE_SE3:QUAT 521 579 6.38968 1.4165 0.0182788 -0.000509762 -0.00489476 0.999887 0.0141785 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 4 7.32139e-06 0.00203961 3.99991 0.0196268 0.000901486 +EDGE_SE3:QUAT 522 579 2.31495 1.55571 0.0111355 -0.00536453 -0.00537101 0.999935 0.00854217 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 3.99989 0.000119084 0.0214611 4.00033 0.0218498 0.000526376 +EDGE_SE3:QUAT 523 579 -1.944 1.6527 0.00567854 -0.0016956 -0.00403573 0.999976 0.00538448 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 3.99999 2.70294e-05 0.00678286 3.99998 0.0162149 0.000193205 +EDGE_SE3:QUAT 524 579 -6.16927 1.75023 -0.00171213 -0.000424884 -0.00329902 0.999987 0.00388994 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 4 5.28352e-06 0.0016996 3.99996 0.0132087 0.000104867 +EDGE_SE3:QUAT 580 581 4.00828 -0.0969299 0.0176437 0.000460324 -0.00149666 0.00238766 0.999996 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 4.00004 -2.63131e-06 -0.0119865 3.99999 -1.42906e-05 4.00001 +EDGE_SE3:QUAT 520 580 6.11033 1.46111 0.0242477 -0.0048955 -0.00369149 0.999814 0.0182667 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 3.99991 8.04347e-05 0.0195919 4.00031 0.0154707 0.00149053 +EDGE_SE3:QUAT 521 580 2.00195 1.60035 0.0124644 -0.00260288 -0.00638269 0.999924 0.0102546 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 3.99998 6.46685e-05 0.0104137 3.99994 0.0257379 0.000613373 +EDGE_SE3:QUAT 522 580 -2.12469 1.69741 -0.031582 -0.00776553 -0.00716261 0.999934 0.00452039 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 3.99976 0.000227263 0.0310646 4.00075 0.0289386 0.000532308 +EDGE_SE3:QUAT 523 580 -6.36948 1.77469 -0.0113898 -0.00386947 -0.00569277 0.999975 0.00141429 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 3.99994 8.82635e-05 0.0154786 4.00011 0.0228163 0.000198037 +EDGE_SE3:QUAT 581 582 4.35548 -0.0654455 0.00682249 -0.000478845 0.000469119 0.00704616 0.999975 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 4 -8.73539e-07 0.00379316 4 1.34083e-05 3.99981 +EDGE_SE3:QUAT 519 581 6.27762 1.53454 0.0209699 -0.00231987 -0.0037978 0.999693 0.0243751 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 3.99998 3.52479e-05 0.00928749 4.00002 0.0156211 0.0024592 +EDGE_SE3:QUAT 520 581 2.11582 1.69713 0.0085319 -0.00330793 -0.00304751 0.999864 0.0158704 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 3.99996 4.31546e-05 0.0132368 4.00013 0.0126029 0.00109101 +EDGE_SE3:QUAT 521 581 -1.98551 1.7723 0.0144845 -0.00117094 -0.00606006 0.999953 0.00752928 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 4 2.63928e-05 0.00468439 3.99987 0.024307 0.000379967 +EDGE_SE3:QUAT 522 581 -6.13535 1.82947 -0.0745295 -0.0063251 -0.00658486 0.999955 0.00238958 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 3.99984 0.000168128 0.0253018 4.00046 0.0264652 0.000357961 +EDGE_SE3:QUAT 582 583 4.36312 -0.0834364 0.024186 -0.000988688 -0.000725561 -3.9728e-05 0.999999 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 4 2.86924e-06 -0.00580496 4 1.0282e-07 4.00001 +EDGE_SE3:QUAT 466 582 2.04939 6.60517 0.102994 0.00676031 0.00367042 -0.461663 0.887022 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 4.00051 -0.000239768 0.0526338 3.99991 -0.0141139 3.14816 +EDGE_SE3:QUAT 518 582 5.99023 1.63324 0.0355654 -0.00501839 -0.00549145 0.999598 0.0273648 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 3.99991 0.00011888 0.0200961 4.00025 0.0230251 0.00322898 +EDGE_SE3:QUAT 519 582 1.95791 1.79822 0.0147314 -0.00282204 -0.0041656 0.999842 0.0170587 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 3.99997 4.77001e-05 0.0112932 4.00005 0.0170359 0.00126846 +EDGE_SE3:QUAT 520 582 -2.19701 1.8951 -0.0124236 -0.00370976 -0.00373639 0.999951 0.00837725 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 3.99995 5.72223e-05 0.0148408 4.00016 0.0151926 0.000393484 +EDGE_SE3:QUAT 521 582 -6.34091 1.89771 0.0148251 -0.00155131 -0.00657287 0.999977 0.000491139 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 3.99999 4.06426e-05 0.00620564 3.99987 0.0262973 0.000183485 +EDGE_SE3:QUAT 583 584 4.06971 -0.223757 0.023208 -0.00426253 0.00701106 -0.0567681 0.998354 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 4.00063 -0.000171916 0.0529263 3.99983 -0.00147753 3.98781 +EDGE_SE3:QUAT 466 583 4.49599 3.01504 0.074509 0.0056154 0.00339519 -0.461487 0.887123 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 4.00039 -0.000194062 0.0456518 3.99994 -0.0120859 3.14864 +EDGE_SE3:QUAT 467 583 -1.38355 3.64371 0.057793 0.00308666 0.00564497 -0.251551 0.967823 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 4.00058 -0.000153031 0.0498731 3.99987 -0.00647402 3.74751 +EDGE_SE3:QUAT 468 583 -6.91165 1.45711 -0.11287 0.00258133 -0.00955883 0.00443518 0.999941 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 4.00144 -8.92989e-05 -0.0766296 3.99963 -0.000164517 4.00139 +EDGE_SE3:QUAT 517 583 6.23777 1.75271 -0.00922631 -0.00026528 -0.00902798 0.99923 0.0381712 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 4 -1.53054e-05 0.00105933 3.99967 0.0360599 0.00615403 +EDGE_SE3:QUAT 518 583 1.63567 1.93521 0.0170605 -0.00436713 -0.00634035 0.999597 0.02733 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 3.99994 0.000113183 0.0174881 4.00011 0.0262701 0.00323688 +EDGE_SE3:QUAT 519 583 -2.39328 2.01438 0.0184783 -0.00218388 -0.00513897 0.999836 0.0172094 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 3.99998 4.3017e-05 0.00873954 3.99996 0.0208415 0.00131237 +EDGE_SE3:QUAT 520 583 -6.57906 2.0289 -0.0163015 -0.00312523 -0.00428838 0.999949 0.00864277 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 3.99996 5.43043e-05 0.0125026 4.00008 0.0173671 0.000413279 +EDGE_SE3:QUAT 584 585 4.0328 -0.635732 0.00363297 0.00356592 0.0075519 -0.150035 0.988645 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 4.001 -0.000113384 0.0647251 3.99975 -0.00496185 3.91101 +EDGE_SE3:QUAT 466 584 6.62281 -0.411469 0.0563987 0.00510006 0.0118472 -0.51101 0.859478 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 4.00168 -0.00147366 0.0860567 4.00027 -0.0207578 2.95726 +EDGE_SE3:QUAT 467 584 2.01549 1.50019 0.0359595 0.000644065 0.013718 -0.305907 0.951962 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 4.00233 -0.00116409 0.096968 3.99973 -0.0141358 3.62801 +EDGE_SE3:QUAT 468 584 -2.91283 1.27782 -0.00800085 -0.0014512 -0.00243864 -0.0521644 0.998634 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 4.00009 7.00214e-06 -0.0203367 3.99997 0.000537443 3.98922 +EDGE_SE3:QUAT 469 584 -7.09624 -1.56069 -0.0868965 0.00402327 -0.00796102 0.221847 0.975041 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 4.00114 0.00025275 -0.0694223 3.99974 -0.00791459 3.80434 +EDGE_SE3:QUAT 516 584 6.65004 2.14677 9.50861e-05 -0.000526728 -0.00815877 0.994889 0.100645 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 4 -3.60738e-05 0.00207191 3.99974 0.0322303 0.0407809 +EDGE_SE3:QUAT 517 584 2.22773 2.27716 0.0263327 -0.00689749 -0.0129108 0.995392 0.0947675 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 3.99993 0.0002906 0.0278784 3.99972 0.055673 0.0369004 +EDGE_SE3:QUAT 518 584 -2.37903 2.3871 0.018684 -0.011122 -0.0107146 0.996324 0.084258 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 3.99968 0.000595389 0.0449185 4.00103 0.0495674 0.0295228 +EDGE_SE3:QUAT 519 584 -6.43912 2.37977 0.0314095 -0.00889982 -0.00953192 0.997166 0.074089 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 3.99979 0.000396807 0.0358663 4.0006 0.0428647 0.0227413 +EDGE_SE3:QUAT 585 586 3.92006 -0.720282 0.0149276 -0.00352912 -0.00120289 -0.172804 0.984949 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 4.00002 1.83685e-05 -0.0163678 3.99998 0.00161194 3.88062 +EDGE_SE3:QUAT 467 585 4.89874 -1.36252 -0.0617377 0.00429931 0.019723 -0.445373 0.895118 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 4.00423 -0.00325385 0.133301 4.00028 -0.0274211 3.21087 +EDGE_SE3:QUAT 468 585 1.02633 0.22826 0.0124841 0.00231563 0.00428288 -0.201532 0.97947 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 4.00033 -6.0163e-05 0.0376483 3.99992 -0.003909 3.83789 +EDGE_SE3:QUAT 469 585 -3.18498 -0.381561 -0.0142844 0.00679945 0.00078603 0.0730178 0.997307 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 3.99981 -5.72478e-06 0.000301169 4 -6.21217e-05 3.97867 +EDGE_SE3:QUAT 470 585 -6.5405 -3.0844 0.0109985 0.003066 0.00320995 0.342509 0.939504 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 3.99998 2.84275e-05 0.00967952 4.00001 0.000662692 3.53076 +EDGE_SE3:QUAT 516 585 2.83332 3.56585 0.015294 -0.00664686 -0.00368829 0.9685 0.248896 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 3.99996 0.00022168 0.0284888 4.00029 0.0249372 0.248169 +EDGE_SE3:QUAT 517 585 -1.52741 3.65803 0.00373227 -0.012362 -0.00937476 0.969788 0.243457 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 3.99992 0.000721188 0.0525821 4.00062 0.0547293 0.238582 +EDGE_SE3:QUAT 518 585 -6.13578 3.68271 -0.0468217 -0.0170282 -0.00769503 0.972197 0.233417 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 3.99965 0.00147451 0.0727008 4.00245 0.0567965 0.220137 +EDGE_SE3:QUAT 586 587 4.01841 -0.778078 0.00924891 0.00140645 -0.00251108 -0.176491 0.984298 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 4.00006 -3.00977e-05 -0.0162407 3.99999 0.00131756 3.87547 +EDGE_SE3:QUAT 468 586 4.35532 -1.97577 -0.0141108 -0.00218625 0.00414008 -0.367978 0.929823 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 4.00005 -7.77315e-05 0.0178437 4.00001 -0.00224203 3.45844 +EDGE_SE3:QUAT 469 586 0.796551 -0.510632 -0.0122357 0.00302083 0.00030141 -0.100359 0.994947 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 3.99997 9.84207e-06 0.00598849 4 -0.000360704 3.95972 +EDGE_SE3:QUAT 470 586 -3.09779 -1.09426 0.00093763 -0.000597483 0.00139878 0.17458 0.984642 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 4.00003 5.55047e-06 0.0119089 3.99999 0.0010607 3.87812 +EDGE_SE3:QUAT 471 586 -6.49024 -2.74832 -0.0355402 -0.00790575 -0.00188114 0.356779 0.934154 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 3.99981 -0.000104543 0.0187059 3.99994 0.00551941 3.4909 +EDGE_SE3:QUAT 515 586 3.97635 6.1051 0.0406043 -0.00607651 -0.0118324 0.918692 0.39475 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 3.99992 -0.000216173 0.0234675 3.99938 0.0461258 0.624092 +EDGE_SE3:QUAT 516 586 -0.25351 6.08924 -0.00337544 -0.00531637 -0.00856831 0.910867 0.412576 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 3.99997 -0.000102964 0.0211516 3.99965 0.035149 0.681366 +EDGE_SE3:QUAT 587 588 4.04254 -0.71802 -0.00317067 0.00614027 0.0127134 -0.140845 0.989931 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 4.00282 -0.000272462 0.109006 3.99928 -0.00783548 3.92362 +EDGE_SE3:QUAT 469 587 4.57298 -2.07339 -0.0137055 0.00402247 -0.00173303 -0.274509 0.961575 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 3.99993 9.9567e-06 0.000258002 4 -0.000715663 3.69857 +EDGE_SE3:QUAT 470 587 0.93138 -0.440861 -0.00434802 0.00102152 -0.000968154 -0.00183722 0.999997 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 4.00001 -3.98176e-06 -0.00772268 4 7.11016e-06 4 +EDGE_SE3:QUAT 471 587 -2.99019 -0.642039 -0.0209026 -0.00511699 -0.00488903 0.186333 0.982461 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 4.00006 0.00011355 -0.0259153 3.99998 -0.00199637 3.86128 +EDGE_SE3:QUAT 472 587 -7.2077 -1.27575 -0.110614 -0.00540134 -0.0158393 0.262204 0.964867 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 4.00222 0.00133401 -0.0976879 3.99974 -0.0115144 3.72734 +EDGE_SE3:QUAT 588 589 4.47473 -0.552846 -0.0191611 0.00154998 0.00525719 -0.0922211 0.995723 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 4.00046 -3.0314e-05 0.0432321 3.99989 -0.00201104 3.96645 +EDGE_SE3:QUAT 470 588 4.96647 -1.17596 0.00170553 0.00688173 0.0118151 -0.142925 0.989639 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 4.00248 -0.000190334 0.103339 3.99935 -0.00758134 3.92096 +EDGE_SE3:QUAT 471 588 1.01463 0.159732 0.0186841 -0.000560325 0.0081403 0.0460204 0.998907 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 4.00106 5.51686e-05 0.0652398 3.99974 0.00150212 3.99259 +EDGE_SE3:QUAT 472 588 -3.37784 0.149066 0.0166452 -0.000629687 -0.00244349 0.123379 0.992356 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 4.00008 2.15029e-05 -0.0181807 3.99998 -0.00109326 3.93919 +EDGE_SE3:QUAT 589 590 4.118 -0.185549 -0.0106018 -0.00298861 -0.00596689 -0.0175737 0.999823 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 4.00055 5.72575e-05 -0.0483487 3.99985 0.000424168 3.99935 +EDGE_SE3:QUAT 471 589 5.50692 0.0206798 -0.07065 -5.91952e-05 0.0132973 -0.0464108 0.998834 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 4.00281 -0.000199388 0.106067 3.99931 -0.00246323 3.99419 +EDGE_SE3:QUAT 472 589 1.07743 0.700944 0.0226174 0.000487639 0.00278693 0.0313352 0.999505 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 4.00012 1.11228e-05 0.0220799 3.99997 0.000344927 3.99619 +EDGE_SE3:QUAT 473 589 -3.18549 0.776511 0.0361355 0.00178641 0.00327323 0.048083 0.998836 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 4.00014 3.36263e-05 0.0250666 3.99996 0.000594143 3.99091 +EDGE_SE3:QUAT 590 591 3.9688 -0.0833602 0.00539644 -0.00293841 0.00734879 0.00079097 0.999968 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 4.00083 -8.54674e-05 0.0588286 3.99978 1.94703e-05 4.00086 +EDGE_SE3:QUAT 472 590 5.18984 0.773184 -0.0126969 -0.00213726 -0.00320757 0.013495 0.999902 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 4.00014 3.01838e-05 -0.0253082 3.99996 -0.000170507 3.99943 +EDGE_SE3:QUAT 473 590 0.907822 0.98888 0.000423761 -0.000975178 -0.00279735 0.030523 0.99953 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 4.00012 1.62418e-05 -0.0219911 3.99997 -0.000333847 3.99639 +EDGE_SE3:QUAT 474 590 -3.53015 1.07811 -0.0487188 0.00229143 -0.00739876 0.034198 0.999385 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 4.00088 -2.31846e-05 -0.0600374 3.99977 -0.00102887 3.99622 +EDGE_SE3:QUAT 591 592 4.35761 -0.0799741 0.0437199 0.000293229 -0.00690716 0.0027552 0.999972 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 4.00076 -4.9524e-06 -0.0552756 3.99981 -7.58542e-05 4.00073 +EDGE_SE3:QUAT 473 591 4.82947 1.13739 0.0230722 -0.00409823 0.00424018 0.0312028 0.999496 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 4.00025 -5.91778e-05 0.0354071 3.99992 0.000558337 3.99642 +EDGE_SE3:QUAT 474 591 0.394274 1.25478 0.0143941 -0.000894232 -0.000383995 0.0350301 0.999386 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 4 1.24742e-06 -0.00269071 4 -4.49029e-05 3.99509 +EDGE_SE3:QUAT 475 591 -4.08229 1.4049 0.00500931 -0.0033056 0.00519731 0.0310998 0.999497 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 4.00041 -5.02634e-05 0.0427547 3.99988 0.000668865 3.99659 +EDGE_SE3:QUAT 592 593 4.44727 -0.0758608 0.0375456 0.00413219 -0.00304657 0.00418389 0.999978 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 4.00008 -4.99864e-05 -0.0245796 3.99996 -5.06352e-05 4.00008 +EDGE_SE3:QUAT 474 592 4.75365 1.48169 0.0626795 -0.000436423 -0.00712605 0.0377584 0.999261 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 4.0008 5.80164e-05 -0.0566989 3.9998 -0.00106951 3.9951 +EDGE_SE3:QUAT 475 592 0.220687 1.57887 -0.000272412 -0.00280821 -0.00171142 0.033756 0.999425 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 4.00001 1.91235e-05 -0.0125312 3.99999 -0.000205147 3.99548 +EDGE_SE3:QUAT 476 592 -4.23617 1.73335 0.0149295 -0.00293985 0.00418198 0.0223116 0.999738 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 4.00026 -4.098e-05 0.0342195 3.99993 0.000383372 3.9983 +EDGE_SE3:QUAT 593 594 4.22409 -0.0853097 0.00461888 0.00103452 -0.00619481 0.00441458 0.999971 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 4.00061 -2.16118e-05 -0.0496184 3.99985 -0.000108651 4.00054 +EDGE_SE3:QUAT 475 593 4.68654 1.7969 0.052334 0.00117074 -0.00441282 0.037873 0.999272 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 4.00031 -2.95465e-06 -0.0357607 3.99992 -0.000679642 3.99458 +EDGE_SE3:QUAT 476 593 0.191988 1.84631 0.0150515 0.00115629 0.00116651 0.0266078 0.999645 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 4.00001 5.91846e-06 0.00895321 4 0.000117468 3.99719 +EDGE_SE3:QUAT 477 593 -4.24985 2.00075 0.0618845 -0.00145643 0.00602802 0.0136718 0.999887 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 4.00058 -2.33413e-05 0.0484556 3.99985 0.000330598 3.99984 +EDGE_SE3:QUAT 594 595 4.26686 -0.0714708 -0.0206742 0.00320239 0.00388154 0.00422381 0.999978 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 4.0002 5.08967e-05 0.0308903 3.99994 6.6281e-05 4.00017 +EDGE_SE3:QUAT 476 594 4.41253 1.9964 0.00598983 0.00249825 -0.00468625 0.0306276 0.999517 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 4.00034 -3.15483e-05 -0.0383576 3.99991 -0.000590592 3.99662 +EDGE_SE3:QUAT 477 594 -0.0011217 2.0417 0.00826665 -0.000285624 2.41271e-05 0.0180094 0.999838 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 4 -3.89073e-08 0.000254636 4 2.4779e-06 3.9987 +EDGE_SE3:QUAT 478 594 -4.29146 2.19044 -0.0145101 -0.00195546 -0.00495384 0.0053992 0.999971 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 4.00037 4.17581e-05 -0.0395055 3.9999 -0.000107707 4.00027 +EDGE_SE3:QUAT 595 596 4.1812 -0.0731561 -0.00293202 -0.000309577 0.0132744 0.00438322 0.999902 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 4.00282 2.07524e-06 0.106274 3.99929 0.000232041 4.00274 +EDGE_SE3:QUAT 477 595 4.29901 2.12506 -0.00826658 0.00268109 0.00409215 0.022314 0.999739 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 4.00023 5.12253e-05 0.0319965 3.99994 0.000355324 3.99826 +EDGE_SE3:QUAT 478 595 0.0278399 2.1648 0.00633676 0.00100968 -0.00112208 0.00959597 0.999953 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 4.00002 -4.31349e-06 -0.00909171 3.99999 -4.37753e-05 3.99965 +EDGE_SE3:QUAT 479 595 -4.39278 2.32438 -0.105468 0.00248238 -0.0136424 -0.00299515 0.999899 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 4.00295 -0.000149036 -0.109118 3.99926 0.000174769 4.00294 +EDGE_SE3:QUAT 596 597 4.17784 -0.086301 0.0441703 0.00063084 -0.000870657 0.000282052 0.999999 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 4.00001 -2.19277e-06 -0.00696741 4 -9.71212e-07 4.00001 +EDGE_SE3:QUAT 478 596 4.18296 2.1613 0.00995116 0.000786617 0.0123404 0.0139029 0.999827 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 4.00243 8.95543e-05 0.0986154 3.99939 0.000689115 4.00166 +EDGE_SE3:QUAT 479 596 -0.211151 2.21667 0.00568543 0.0020993 -0.000229507 0.00144231 0.999997 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 3.99998 -1.97616e-06 -0.00187238 4 -1.35627e-06 3.99999 +EDGE_SE3:QUAT 480 596 -4.30891 2.31247 -0.0289223 0.00297158 0.000364437 -0.00420923 0.999987 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 3.99997 4.61442e-06 0.00306547 4 -6.54662e-06 3.99993 +EDGE_SE3:QUAT 597 598 4.06142 -0.0982779 0.0209819 -0.00172209 -0.00503914 -0.00262158 0.999982 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 4.0004 3.31841e-05 -0.0403703 3.9999 5.19028e-05 4.00038 +EDGE_SE3:QUAT 479 597 3.97889 2.14633 0.0532027 0.00278431 -0.00133048 0.00141915 0.999994 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 4 -1.48453e-05 -0.0106912 3.99999 -7.4784e-06 4.00002 +EDGE_SE3:QUAT 480 597 -0.154177 2.18823 0.0066915 0.00373847 -0.000686659 -0.00349482 0.999987 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 3.99995 -9.9148e-06 -0.00533629 4 9.27371e-06 3.99996 +EDGE_SE3:QUAT 481 597 -4.18362 2.2515 0.0345943 0.00549405 0.0050009 0.000924388 0.999972 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 4.00028 0.000110262 0.0399478 3.9999 2.17488e-05 4.0004 +EDGE_SE3:QUAT 598 599 4.4674 -0.107471 -0.00673095 -0.000602656 -0.000777025 -0.000124002 1 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 4.00001 1.87169e-06 -0.00621711 4 3.76753e-07 4.00001 +EDGE_SE3:QUAT 480 598 3.9403 2.04876 0.030711 0.00181878 -0.00567098 -0.00672197 0.99996 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 4.0005 -4.62562e-05 -0.0452229 3.99987 0.000153273 4.00033 +EDGE_SE3:QUAT 481 598 -0.118568 2.15104 0.0124478 0.00345323 9.49459e-05 -0.00128263 0.999993 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 3.99995 1.4335e-06 0.000812702 4 -5.31726e-07 3.99999 +EDGE_SE3:QUAT 482 598 -4.4546 2.20213 0.0614897 0.00514875 0.00340759 0.00703172 0.999956 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 4.00007 7.05995e-05 0.0268242 3.99996 9.5208e-05 3.99998 +EDGE_SE3:QUAT 599 600 4.26968 -0.0919263 0.010277 -0.00149112 -0.000942539 7.60605e-05 0.999998 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 4.00001 5.62205e-06 -0.00753895 4 -3.18477e-07 4.00001 +EDGE_SE3:QUAT 481 599 4.33839 2.03119 0.00480704 0.00276463 -0.00069953 -0.00147805 0.999995 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 3.99998 -7.66241e-06 -0.00554713 4 4.11941e-06 4 +EDGE_SE3:QUAT 482 599 0.00224992 2.16725 0.0277185 0.00444266 0.00250419 0.00683083 0.999964 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 4.00002 4.44195e-05 0.0196678 3.99998 6.7411e-05 3.99991 +EDGE_SE3:QUAT 483 599 -4.29999 2.2403 -0.0254005 0.00283442 -0.00207205 0.00998818 0.999944 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 4.00004 -2.30685e-05 -0.0169137 3.99998 -8.47321e-05 3.99967 +EDGE_SE3:QUAT 600 601 4.05778 -0.100313 0.036979 0.000192624 0.00028574 -0.0114434 0.999934 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 4 2.00678e-07 0.00231192 4 -1.32773e-05 3.99948 +EDGE_SE3:QUAT 482 600 4.27385 2.13389 0.0105609 0.0030973 0.00155471 0.0065251 0.999973 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 4 1.91265e-05 0.0121943 3.99999 3.96948e-05 3.99987 +EDGE_SE3:QUAT 483 600 -0.0402978 2.24538 0.00107732 0.00125266 -0.00317512 0.00972663 0.999947 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 4.00016 -1.36565e-05 -0.0255444 3.99996 -0.000124169 3.99978 +EDGE_SE3:QUAT 484 600 -4.26046 2.34199 -0.0485925 -0.00267664 -0.00144557 0.00821429 0.999962 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 4 1.54018e-05 -0.0112995 3.99999 -4.61761e-05 3.99976 +EDGE_SE3:QUAT 601 602 4.31443 -0.268614 0.0367841 0.000821627 0.00543252 -0.0553547 0.998452 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 4.00048 -2.17094e-05 0.0438098 3.99988 -0.00121552 3.98822 +EDGE_SE3:QUAT 483 601 4.02979 2.2287 0.0663335 0.00132128 -0.0024834 -0.00179178 0.999994 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 4.00009 -1.33656e-05 -0.019839 3.99998 1.79613e-05 4.00009 +EDGE_SE3:QUAT 484 601 -0.209679 2.31962 5.0922e-05 -0.00281609 -0.000699844 -0.00323947 0.999991 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 3.99998 8.04934e-06 -0.00570808 4 9.27053e-06 3.99997 +EDGE_SE3:QUAT 485 601 -4.3305 2.44408 -0.0626651 -0.00256988 -0.00452264 -0.0098009 0.999938 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 4.00031 4.21389e-05 -0.0364805 3.99992 0.000178016 3.99995 +EDGE_SE3:QUAT 602 603 4.2158 -0.504039 -0.0144463 -0.00622603 0.00413622 -0.124939 0.992136 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 3.99997 -9.14818e-05 0.0230793 3.99998 -0.00123271 3.93769 +EDGE_SE3:QUAT 484 602 4.09614 2.01841 0.0437214 -0.00146628 0.00445746 -0.0583796 0.998283 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 4.00029 -5.14077e-05 0.0344547 3.99993 -0.000994819 3.98666 +EDGE_SE3:QUAT 485 602 -0.0273791 2.09857 0.0101009 -0.00076429 0.000642037 -0.0649627 0.997887 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 4 -2.17073e-06 0.00450969 4 -0.000139683 3.98312 +EDGE_SE3:QUAT 486 602 -4.1072 2.32822 0.0214625 0.000460708 -0.000954406 -0.0907011 0.995878 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 4.00001 -3.33392e-06 -0.00704255 4 0.000310382 3.96711 +EDGE_SE3:QUAT 603 604 4.20897 -0.738451 0.00432975 0.000628054 0.000398303 -0.163987 0.986462 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 4 4.43388e-07 0.00427252 4 -0.000380498 3.89244 +EDGE_SE3:QUAT 485 603 4.083 1.05244 -0.00692619 -0.0069694 0.00537798 -0.188908 0.981955 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 3.99996 -0.000128218 0.0253157 3.99999 -0.00182217 3.85741 +EDGE_SE3:QUAT 486 603 -0.0477849 1.09035 0.00742732 -0.00488943 0.00356837 -0.21415 0.976782 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 3.99995 -4.82753e-05 0.0144242 4 -0.00102461 3.8166 +EDGE_SE3:QUAT 487 603 -3.86336 1.71618 0.00667553 -0.00833224 0.00618896 -0.313498 0.949532 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 3.99972 -5.12032e-05 0.0130978 4.00002 -1.48462e-05 3.60688 +EDGE_SE3:QUAT 604 605 4.23225 -0.793303 0.0116135 0.00377793 0.00340196 -0.169864 0.985454 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 4.00022 5.69931e-07 0.0336007 3.99993 -0.00303659 3.88487 +EDGE_SE3:QUAT 486 604 3.46232 -1.35575 0.00130471 -0.00449179 0.00317179 -0.371506 0.928414 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 3.9999 8.47573e-06 0.00212394 4 0.0011924 3.44792 +EDGE_SE3:QUAT 487 604 -0.921115 -1.40681 -0.00051594 -0.00837882 0.00489727 -0.464891 0.885314 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 3.99969 0.000143467 -0.0128196 3.99993 0.0076569 3.13548 +EDGE_SE3:QUAT 488 604 -5.51325 0.174376 -0.0333857 -0.00881871 0.00472366 -0.641911 0.766714 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 3.99989 0.000161982 -0.0322348 3.99978 0.0201566 2.352 +EDGE_SE3:QUAT 605 606 4.31906 -0.780896 -0.0303151 0.00200556 0.0106068 -0.147881 0.988946 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 4.00182 -0.000323218 0.085628 3.99958 -0.00635154 3.91436 +EDGE_SE3:QUAT 487 605 0.839911 -5.30015 0.0225717 -0.00385473 0.00466281 -0.608424 0.793589 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 3.9999 4.11183e-05 -0.00255419 3.99999 0.00611378 2.51924 +EDGE_SE3:QUAT 488 605 -5.52003 -4.1022 0.0115828 -0.0038608 0.00322999 -0.762523 0.646941 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 3.99998 3.85973e-05 -0.0146365 3.99993 0.0132233 1.67427 +EDGE_SE3:QUAT 606 607 4.02124 -0.455622 0.0142935 0.00187229 -0.000108077 -0.0744759 0.997221 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 3.99999 1.27793e-06 0.000809664 4 -5.10094e-05 3.97781 +EDGE_SE3:QUAT 607 608 4.2083 -0.178025 0.0195469 0.000402699 -0.00078731 -0.017506 0.999846 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 4.00001 -1.49959e-06 -0.00621102 4 5.41161e-05 3.99878 +EDGE_SE3:QUAT 608 609 4.36226 -0.167228 0.016649 0.00296324 -0.000568278 -0.0129109 0.999912 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 3.99997 -5.9115e-06 -0.00408599 4 2.54059e-05 3.99934 +EDGE_SE3:QUAT 609 610 4.42681 -0.115304 0.0295242 -0.00150073 0.0013565 -0.00466879 0.999987 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 4.00002 -8.26239e-06 0.0107676 3.99999 -2.51361e-05 3.99994 +EDGE_SE3:QUAT 610 611 4.41924 -0.11789 0.0218059 0.000606222 -0.00283661 -0.00206635 0.999994 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 4.00013 -7.27173e-06 -0.0226783 3.99997 2.35443e-05 4.00011 +EDGE_SE3:QUAT 611 612 4.47718 -0.11121 0.0126294 -0.000219825 -0.000531762 0.00023529 1 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 4 4.69086e-07 -0.00425348 4 -5.01868e-07 4 +EDGE_SE3:QUAT 612 613 4.28249 -0.0921107 0.0136412 0.00167576 -9.44727e-05 0.000879309 0.999998 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 3.99999 -6.52809e-07 -0.000773459 4 -3.42274e-07 4 +EDGE_SE3:QUAT 613 614 4.18165 -0.0967959 0.0389456 0.000444321 0.00703736 0.00213734 0.999973 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 4.00079 1.50527e-05 0.0562968 3.9998 6.07178e-05 4.00077 +EDGE_SE3:QUAT 614 615 4.32469 -0.0829343 0.0020154 -5.23856e-05 0.0019441 0.0021144 0.999996 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 4.00006 -2.15615e-07 0.0155542 3.99998 1.64403e-05 4.00004 +EDGE_SE3:QUAT 615 616 4.24838 -0.0890743 0.0174021 -0.000254609 -0.000793327 0.0019858 0.999998 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 4.00001 8.36875e-07 -0.00634053 4 -6.29738e-06 3.99999 +EDGE_SE3:QUAT 616 617 4.23124 -0.139165 0.0190909 0.000631998 -0.000791693 -0.0143378 0.999897 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 4.00001 -2.16465e-06 -0.00622288 4 4.43564e-05 3.99919 +EDGE_SE3:QUAT 554 616 5.9215 -3.74186 0.0368441 -0.00710717 -0.00415279 0.969784 0.243826 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 3.99996 0.000251553 0.0303704 4.00032 0.0272378 0.238237 +EDGE_SE3:QUAT 555 616 -0.417817 -4.97514 0.0640863 -0.00355644 0.00334091 0.88242 0.470437 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 3.99999 0.000168105 0.0208925 4.00027 0.00385071 0.885378 +EDGE_SE3:QUAT 556 616 -6.48024 -3.39525 0.121774 -0.0010767 0.00693575 0.763297 0.646009 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 3.99999 0.000219454 0.02099 4.00026 -0.000257393 1.6695 +EDGE_SE3:QUAT 617 618 4.13769 -0.278307 0.0245702 -0.00253985 0.000432161 -0.0590268 0.998253 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 3.99997 -1.41095e-06 0.00164436 4 -3.06576e-05 3.98606 +EDGE_SE3:QUAT 553 617 6.75106 0.579629 -0.00603562 -0.00169434 0.000295981 0.999952 0.00963164 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 3.99999 -1.34631e-06 0.0067783 4.00005 -0.00105312 0.000382839 +EDGE_SE3:QUAT 554 617 2.25836 -1.61878 0.0144869 -0.00620085 -0.00368641 0.966181 0.257765 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 3.99998 0.000190301 0.0266469 4.00022 0.0242941 0.26611 +EDGE_SE3:QUAT 555 617 -2.66123 -1.38912 0.0473633 -0.00272261 0.00370778 0.875511 0.483176 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 3.99998 0.000123995 0.0173327 4.00021 0.00114563 0.933931 +EDGE_SE3:QUAT 556 617 -7.06143 0.786505 0.096306 -0.000137219 0.00703657 0.753948 0.656896 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 3.99996 0.000153835 0.0167272 4.0002 -0.00249563 1.72621 +EDGE_SE3:QUAT 618 619 4.1296 -0.547324 0.0111796 -0.00148208 0.00184432 -0.125355 0.992109 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 4.00003 -1.61203e-05 0.0122021 3.99999 -0.000710987 3.93718 +EDGE_SE3:QUAT 552 618 6.03498 3.09447 0.0306806 0.00393638 0.00608181 -0.980447 0.196652 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 3.99987 1.90531e-05 0.0170017 4.00033 0.016056 0.154833 +EDGE_SE3:QUAT 553 618 2.61371 0.925624 0.0065943 -0.00232803 -0.00216657 0.99763 0.0687267 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 3.99998 2.4995e-05 0.0093723 4.00005 0.00983828 0.0189398 +EDGE_SE3:QUAT 554 618 -1.19234 0.684755 -0.00472663 -0.00715625 -0.00650565 0.949224 0.314453 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 4.00002 0.000178132 0.0309323 3.99996 0.0360411 0.396125 +EDGE_SE3:QUAT 555 618 -4.64975 2.26394 0.0391407 -0.00441645 0.00157165 0.845357 0.534182 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 4.00005 0.000195065 0.0253748 4.0002 0.011208 1.14162 +EDGE_SE3:QUAT 619 620 4.13177 -0.710638 0.00525933 -0.00249935 -0.00180739 -0.155815 0.987781 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 4.00006 6.4902e-06 -0.0185336 3.99998 0.00155108 3.90297 +EDGE_SE3:QUAT 551 619 5.21316 3.31761 0.0332071 0.00313302 0.00848669 -0.961709 0.273922 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 3.99983 3.86857e-05 0.0152562 4.0003 0.021401 0.30033 +EDGE_SE3:QUAT 552 619 2.00469 1.99441 0.00482568 0.0047457 0.00831968 -0.997334 0.0723472 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 3.99986 0.000145215 0.0191575 4.00023 0.0301156 0.0212568 +EDGE_SE3:QUAT 553 619 -1.41505 2.01769 0.00106999 -0.00393837 -0.0037627 0.98114 0.193221 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 3.99999 7.39856e-05 0.0163942 4.00005 0.0195258 0.149505 +EDGE_SE3:QUAT 554 619 -4.19198 3.58448 -0.0194264 -0.00841204 -0.00794805 0.902319 0.430913 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 4.00005 6.66551e-05 0.0365562 3.99969 0.041646 0.743611 +EDGE_SE3:QUAT 620 621 4.08371 -0.72451 -0.00517718 -0.00310643 0.000876825 -0.163835 0.986483 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 3.99996 1.92048e-06 0.000736004 4 0.000114278 3.89263 +EDGE_SE3:QUAT 550 620 5.12378 2.58471 0.0213967 0.00172366 0.00649828 -0.959901 0.28026 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 3.99992 3.80871e-05 0.0088023 4.0001 0.0174716 0.314292 +EDGE_SE3:QUAT 551 620 1.32826 1.72811 0.00210993 -0.000614411 0.0109099 -0.992598 0.120955 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 3.99998 8.59434e-05 -0.00235575 3.99955 0.0426351 0.0589832 +EDGE_SE3:QUAT 552 620 -2.18087 2.10315 -0.0223872 -0.00153959 -0.0112295 0.996411 0.0838905 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 4 -1.58363e-05 0.00617021 3.99949 0.0451528 0.0286734 +EDGE_SE3:QUAT 553 620 -4.95423 4.24006 -0.0140594 -0.00218623 -0.0071368 0.9391 0.343564 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 3.99997 -7.97573e-05 0.00783557 3.99981 0.0257792 0.472352 +EDGE_SE3:QUAT 621 622 4.35863 -0.819424 -0.00551466 0.00576373 0.0191501 -0.154134 0.987848 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 4.00614 -0.000983876 0.158483 3.99855 -0.0123409 3.91124 +EDGE_SE3:QUAT 549 621 5.23373 1.45699 -0.0262046 -0.00675616 0.00984405 -0.977021 0.212806 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 4 -0.000163989 -0.0280428 3.99976 0.0459712 0.181897 +EDGE_SE3:QUAT 550 621 1.29552 0.995337 -0.00426645 0.000640802 0.00988745 -0.9928 0.119373 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 3.99997 0.000105908 0.00275301 3.99969 0.0375437 0.0573593 +EDGE_SE3:QUAT 551 621 -2.80522 1.45266 0.0126578 0.00190801 -0.0135031 0.998985 0.0429275 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 3.99996 -0.000158355 -0.00766433 3.99939 0.0531069 0.00809231 +EDGE_SE3:QUAT 552 621 -6.09296 3.49814 -0.00991526 -0.000458373 -0.0140155 0.969234 0.245739 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 3.99985 -0.000280449 0.000324934 3.99951 0.0486247 0.24219 +EDGE_SE3:QUAT 622 623 4.02088 -0.522132 0.0194437 0.00752586 -0.00435031 -0.0892932 0.995967 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 3.99995 -0.00011534 -0.0263638 3.99997 0.0010532 3.96828 +EDGE_SE3:QUAT 548 622 4.99274 0.505501 0.0824021 0.0115589 0.0110249 -0.994092 0.107358 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 3.99929 0.000179762 0.0471334 4.00227 0.033047 0.0469435 +EDGE_SE3:QUAT 549 622 0.953797 0.384461 0.0220168 0.0115349 0.00713288 -0.998102 0.0600664 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 3.9994 0.000144223 0.0463981 4.00214 0.0227681 0.0151023 +EDGE_SE3:QUAT 550 622 -3.1298 0.754039 -0.00755686 -0.0188228 -0.00628544 0.999186 0.035133 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 3.99866 0.000753581 0.0754251 4.0053 0.0304074 0.0065926 +EDGE_SE3:QUAT 623 624 4.26862 -0.243819 -0.0148495 0.00268468 -0.001835 -0.0231952 0.999726 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 4.00002 -2.0075e-05 -0.0139212 3.99999 0.000158722 3.9979 +EDGE_SE3:QUAT 547 623 5.37679 0.017416 0.0294351 0.00197595 0.0104443 -0.999761 0.0191017 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 3.99998 9.69092e-05 0.0079101 3.99965 0.0414361 0.00190458 +EDGE_SE3:QUAT 548 623 0.96084 0.152591 0.00233251 0.00710896 0.00422394 -0.999798 0.0183441 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 3.99979 9.99226e-05 0.0284502 4.00076 0.0158429 0.00161121 +EDGE_SE3:QUAT 549 623 -3.10634 0.41091 -0.052581 -0.00722148 -0.000253853 0.999541 0.029418 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 3.99979 4.39917e-05 0.0289227 4.00083 0.00271218 0.00367282 +EDGE_SE3:QUAT 550 623 -7.1108 1.54765 -0.137375 -0.0135833 -0.000665731 0.992177 0.124098 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 3.99937 0.000561593 0.0555628 4.00276 0.0158573 0.0624469 +EDGE_SE3:QUAT 624 625 4.54438 -0.130639 0.0122846 -0.000638438 -0.00435524 -0.00335286 0.999985 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 4.0003 9.60765e-06 -0.0348693 3.99992 5.81907e-05 4.00026 +EDGE_SE3:QUAT 546 624 5.18686 -0.0218727 0.0138146 -0.00325919 -0.00709351 0.999909 0.0109831 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 3.99996 9.06817e-05 0.01304 3.99996 0.0286527 0.000730295 +EDGE_SE3:QUAT 547 624 1.10082 0.109037 -0.00669467 0.000114169 -0.00797159 0.99996 0.00402235 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 4 -5.6824e-06 -0.000456751 3.99975 0.0318804 0.000318879 +EDGE_SE3:QUAT 548 624 -3.31581 0.254393 -0.0722149 -0.00523968 -0.00178884 0.999973 0.00482674 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 3.99989 4.0549e-05 0.0209593 4.00042 0.00735836 0.000216553 +EDGE_SE3:QUAT 549 624 -7.33562 0.909908 -0.132626 -0.00502113 0.00183357 0.99861 0.0524445 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 3.99989 -5.03956e-06 0.0201691 4.00041 -0.00518371 0.0111104 +EDGE_SE3:QUAT 625 626 4.49873 -0.0949267 0.0182869 -0.00185891 0.00575676 0.000736512 0.999981 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 4.00052 -4.22589e-05 0.0460756 3.99987 1.54959e-05 4.00053 +EDGE_SE3:QUAT 545 625 4.85839 0.0747247 -0.0105476 0.0010013 -0.00731816 0.999768 0.0202578 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 3.99999 -3.72919e-05 -0.00400853 3.99981 0.0290798 0.00185704 +EDGE_SE3:QUAT 546 625 0.645008 0.195194 0.00262984 0.00109555 -0.00772591 0.999865 0.0144597 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 3.99999 -4.02217e-05 -0.00438418 3.99979 0.0307601 0.00107774 +EDGE_SE3:QUAT 547 625 -3.43296 0.266909 0.0143364 0.00417175 -0.00854008 0.999928 0.00736696 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 3.99993 -0.000143621 -0.01669 4 0.033912 0.000574244 +EDGE_SE3:QUAT 626 627 4.00369 -0.0854806 0.0391875 -0.00248177 -0.00318707 0.00133878 0.999991 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 4.00014 3.19019e-05 -0.0254573 3.99996 -1.76373e-05 4.00015 +EDGE_SE3:QUAT 544 626 4.65405 0.233615 0.0442477 -0.0104325 -0.00585508 0.999628 0.0245293 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 3.99959 0.000299638 0.0417679 4.00153 0.0254456 0.00300504 +EDGE_SE3:QUAT 545 626 0.454104 0.343224 0.0155655 -0.00478619 -0.00881115 0.999761 0.019443 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 3.99992 0.000166314 0.0191572 4.00002 0.0359582 0.00192726 +EDGE_SE3:QUAT 546 626 -3.85351 0.415369 0.0356973 -0.00481902 -0.00916244 0.999854 0.0136169 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 3.99992 0.000174563 0.0192836 4.00001 0.0371605 0.00117993 +EDGE_SE3:QUAT 627 628 4.02619 -0.0958481 0.0180248 0.000388455 -0.00155657 0.00256668 0.999995 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 4.00004 -2.27231e-06 -0.0124645 3.99999 -1.59791e-05 4.00001 +EDGE_SE3:QUAT 543 627 4.96349 0.385494 0.0358859 -0.00832001 -0.0076002 0.999536 0.0283023 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 3.99975 0.000283815 0.0333212 4.00079 0.0322329 0.00374173 +EDGE_SE3:QUAT 544 627 0.716691 0.510158 0.0017368 -0.00726804 -0.00847518 0.999667 0.0232517 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 3.99981 0.000260513 0.0290978 4.00049 0.0352144 0.00268446 +EDGE_SE3:QUAT 545 627 -3.49181 0.583029 0.0221729 -0.00196862 -0.0113454 0.99977 0.0181191 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 3.99999 7.19051e-05 0.00787917 3.99953 0.0456276 0.00184942 +EDGE_SE3:QUAT 628 629 4.38468 -0.0902423 -0.0371517 0.00444685 0.00879951 0.00301129 0.999947 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 4.00115 0.000161782 0.0702512 3.99969 0.000114014 4.0012 +EDGE_SE3:QUAT 542 628 5.0854 0.581893 -0.0245941 0.00879513 -0.0105421 0.999448 0.0302524 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 3.99965 -0.000336531 -0.0352343 4.00093 0.0399615 0.004371 +EDGE_SE3:QUAT 543 628 0.966754 0.70359 -0.00606285 -0.00680536 -0.00730822 0.999622 0.0256128 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 3.99984 0.000214474 0.0272493 4.00047 0.030585 0.00304376 +EDGE_SE3:QUAT 544 628 -3.20737 0.779785 -0.0371391 -0.00567557 -0.00806524 0.999741 0.0205338 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 3.99989 0.000187112 0.0227182 4.00021 0.0331633 0.00209067 +EDGE_SE3:QUAT 629 630 4.0382 -0.088923 0.0290557 -9.86895e-05 0.00501196 0.00289169 0.999983 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 4.0004 -2.35657e-07 0.0401022 3.9999 5.79386e-05 4.00037 +EDGE_SE3:QUAT 541 629 4.98927 0.825467 -0.00115148 0.00128957 -0.00598867 0.99949 0.0313544 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 3.99999 -3.81118e-05 -0.00516766 3.9999 0.0235726 0.00407813 +EDGE_SE3:QUAT 542 629 0.792635 0.931036 0.0195728 0.000181946 -0.00576976 0.999608 0.0273844 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 4 -1.13951e-05 -0.000729628 3.99987 0.0229956 0.00313206 +EDGE_SE3:QUAT 543 629 -3.42116 1.01845 -0.0983905 -0.0156947 -0.00256074 0.999618 0.0226209 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 3.99903 0.000292562 0.0628206 4.00387 0.0130872 0.00307694 +EDGE_SE3:QUAT 630 631 4.39528 -0.0944185 0.04704 0.00356768 0.00199011 0.00369572 0.999985 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 4.00001 2.83698e-05 0.0157622 3.99998 2.93636e-05 4.00001 +EDGE_SE3:QUAT 540 630 5.20043 1.04482 0.0472291 -0.00781493 -0.00740866 0.999484 0.030267 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 3.99978 0.000259413 0.0313034 4.00067 0.0314664 0.00415723 +EDGE_SE3:QUAT 541 630 1.03857 1.15026 0.0382894 -0.00348735 -0.00575394 0.999569 0.0285674 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 3.99996 8.00099e-05 0.0139661 4.00004 0.0237662 0.00345449 +EDGE_SE3:QUAT 542 630 -3.25056 1.24016 0.0498354 -0.00474212 -0.00582378 0.999672 0.0244809 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 3.99992 0.000116007 0.0189857 4.00019 0.0241908 0.00263379 +EDGE_SE3:QUAT 631 632 4.31972 -0.0903314 0.0402601 -0.00101974 -0.00974882 0.00339694 0.999946 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 4.00152 4.7534e-05 -0.0779734 3.99962 -0.000134868 4.00147 +EDGE_SE3:QUAT 539 631 5.13552 1.30598 0.0665163 -0.0114622 -0.00585362 0.999536 0.0275958 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 3.99951 0.000344963 0.045901 4.00187 0.0259165 0.00374121 +EDGE_SE3:QUAT 540 631 0.869338 1.40689 0.0281246 -0.0097092 -0.00374433 0.999586 0.0268082 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 3.99964 0.000201526 0.0388777 4.0014 0.0170399 0.00332548 +EDGE_SE3:QUAT 541 631 -3.38999 1.50105 0.0587492 -0.00546501 -0.00216732 0.999676 0.0247509 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 3.99989 6.37283e-05 0.0218798 4.00044 0.00973905 0.00259391 +EDGE_SE3:QUAT 632 633 4.17319 -0.0809423 0.0283871 -0.00154572 -0.00805966 0.00364652 0.99996 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 4.00103 5.5483e-05 -0.0644228 3.99974 -0.000119904 4.00098 +EDGE_SE3:QUAT 538 632 5.0732 1.55488 0.0560864 -0.00996938 -0.00728355 0.999645 0.0236237 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 3.99963 0.000334515 0.0399123 4.00129 0.0309922 0.00287094 +EDGE_SE3:QUAT 539 632 0.811157 1.62337 0.0169107 -0.00189548 -0.00698762 0.999688 0.0239213 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 3.99999 4.5232e-05 0.00758815 3.99985 0.0282728 0.00250327 +EDGE_SE3:QUAT 540 632 -3.48973 1.72708 -0.00818825 -0.000117645 -0.00503545 0.999719 0.023144 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 4 -2.32644e-06 0.000470455 3.9999 0.0201364 0.00224405 +EDGE_SE3:QUAT 633 634 4.04592 -0.0802105 0.00741249 -0.00238217 0.00648677 0.00518067 0.999963 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 4.00065 -5.68223e-05 0.0520474 3.99983 0.000132589 4.00057 +EDGE_SE3:QUAT 537 633 5.03326 1.76286 -0.0268343 0.0062056 -0.0070369 0.999822 0.0163687 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 3.99983 -0.000165362 -0.0248337 4.00045 0.0273217 0.0014126 +EDGE_SE3:QUAT 538 633 0.918016 1.82137 0.0102115 -0.00177206 -0.00904866 0.99976 0.0198747 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 3.99999 5.22269e-05 0.00709263 3.99971 0.0364395 0.00192471 +EDGE_SE3:QUAT 539 633 -3.38693 1.90816 0.0335914 0.00624873 -0.00905143 0.999731 0.0204361 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 3.99983 -0.000219061 -0.0250134 4.00035 0.0351534 0.00213605 +EDGE_SE3:QUAT 634 635 4.32292 -0.0653376 0.0371627 -0.00590628 0.00121483 -0.00275187 0.999978 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 3.99988 -2.80252e-05 0.00952306 3.99999 -1.32163e-05 3.99999 +EDGE_SE3:QUAT 536 634 5.0958 1.9511 0.0244368 0.00234247 0.00881421 -0.999958 0.000681995 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 3.99998 8.29151e-05 0.00937095 3.99978 0.0352437 0.000334358 +EDGE_SE3:QUAT 537 634 1.02769 1.96774 0.0301159 -0.000323071 -0.00921104 0.999895 0.0111436 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 4 4.34639e-06 0.00129252 3.99966 0.03686 0.000836871 +EDGE_SE3:QUAT 538 634 -3.14257 2.05869 0.00126551 -0.00852722 -0.011125 0.999794 0.0146703 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 3.99973 0.000389503 0.0341253 4.0006 0.0454912 0.0016694 +EDGE_SE3:QUAT 635 636 4.00018 -0.269449 0.0376099 -0.00044916 0.00689708 -0.0683512 0.997637 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 4.00074 -8.87541e-05 0.0544319 3.99982 -0.00185305 3.98205 +EDGE_SE3:QUAT 535 635 5.13722 2.358 0.0225097 0.00513727 0.00752062 -0.998326 0.057118 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 3.99986 0.000136061 0.0206615 4.0003 0.0275016 0.0133467 +EDGE_SE3:QUAT 536 635 0.760765 2.00991 0.0430973 -0.00346981 -0.0149531 0.99988 0.00210464 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 3.99995 0.000204307 0.0138839 3.99929 0.0598672 0.000962069 +EDGE_SE3:QUAT 537 635 -3.26069 2.12156 0.0669946 -0.00149572 -0.0152736 0.99979 0.0136146 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 4 6.64142e-05 0.00598595 3.99909 0.0612224 0.00168782 +EDGE_SE3:QUAT 636 637 4.10448 -0.692766 -0.00435794 0.000815999 0.00422201 -0.15977 0.987145 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 4.00029 -5.6129e-05 0.0340311 3.99993 -0.0027253 3.89818 +EDGE_SE3:QUAT 534 636 4.81307 2.97932 0.00450772 0.000578122 0.00594343 -0.99181 0.127583 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 3.99998 4.2661e-05 0.00246725 3.9999 0.0222312 0.0652372 +EDGE_SE3:QUAT 535 636 1.11794 2.17409 0.0192161 -0.0114269 -0.00855394 0.999832 0.0115065 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 3.9995 0.000420122 0.0457195 4.00174 0.0352798 0.00136329 +EDGE_SE3:QUAT 536 636 -3.22949 2.29267 0.0637247 -0.0093726 -0.0154514 0.997361 0.0703139 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 3.9998 0.000549403 0.0377391 3.99998 0.0663038 0.0212376 +EDGE_SE3:QUAT 637 638 4.2798 -0.860569 0.00307643 0.00116139 -0.000537213 -0.185147 0.98271 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 3.99999 -6.8231e-07 -0.00155727 4 5.75926e-05 3.86288 +EDGE_SE3:QUAT 533 637 3.99655 3.29542 0.0212838 0.00405921 0.00769089 -0.989463 0.144524 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 3.99986 9.10982e-05 0.0169235 4.00026 0.0245767 0.0837776 +EDGE_SE3:QUAT 534 637 0.67451 2.58351 -0.00653387 -0.00386627 -0.00564894 0.999452 0.0323887 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 3.99995 8.9274e-05 0.0154886 4.00008 0.0235386 0.00439478 +EDGE_SE3:QUAT 535 637 -2.96771 2.94394 -0.0681151 -0.014073 -0.00910063 0.985126 0.171012 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 3.99966 0.000951585 0.0583627 4.00164 0.0524977 0.118554 +EDGE_SE3:QUAT 638 639 4.25351 -0.89047 0.00811151 0.0020778 0.0013773 -0.18599 0.982548 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 4.00004 2.83324e-06 0.0149822 3.99999 -0.00151864 3.86169 +EDGE_SE3:QUAT 531 638 6.14546 4.22838 0.019143 0.00328623 0.00735088 -0.968302 0.249651 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 3.99986 2.73116e-05 0.0152298 4.00028 0.0187712 0.249464 +EDGE_SE3:QUAT 532 638 2.8954 3.11679 0.0279342 0.00336389 0.0121154 -0.993033 0.117163 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 3.99986 0.000225852 0.0138882 3.99987 0.0436998 0.0554427 +EDGE_SE3:QUAT 533 638 -0.357044 2.90144 -0.0124753 -0.00244339 -0.00713735 0.999108 0.0415377 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 3.99999 5.69675e-05 0.00979542 3.99986 0.0292368 0.0071396 +EDGE_SE3:QUAT 534 638 -3.53169 3.72235 -0.026297 -0.00229183 -0.00506648 0.976237 0.216635 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 4 2.91904e-06 0.00937776 3.9999 0.0217129 0.187869 +EDGE_SE3:QUAT 639 640 4.02203 -0.65996 -0.00217164 0.000859868 0.00229872 -0.130761 0.991411 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 4.00009 -9.57088e-06 0.0192544 3.99998 -0.00127781 3.9317 +EDGE_SE3:QUAT 530 639 5.6207 3.42652 0.00615323 -0.00136787 0.0109738 -0.988436 0.151233 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 3.99998 8.57698e-05 -0.00535163 3.99953 0.04302 0.0919666 +EDGE_SE3:QUAT 531 639 1.98209 2.92428 -0.0033417 0.00382659 0.00596361 -0.997861 0.0649878 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 3.99992 8.06355e-05 0.0154165 4.00016 0.0216237 0.0170708 +EDGE_SE3:QUAT 532 639 -1.46113 2.98794 0.0134738 -0.00271308 -0.0105013 0.99751 0.0696896 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 3.99999 5.71915e-05 0.0109039 3.9996 0.0429995 0.0199209 +EDGE_SE3:QUAT 533 639 -4.52374 4.12613 -0.00883517 -0.00231059 -0.00532582 0.973973 0.226591 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 4 -2.59217e-06 0.00943083 3.99988 0.0225915 0.205531 +EDGE_SE3:QUAT 640 641 4.37702 -0.501907 0.000345466 0.00463191 3.35483e-05 -0.0722704 0.997374 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 3.99992 1.26812e-05 0.00426923 4 -0.000202609 3.97911 +EDGE_SE3:QUAT 529 640 5.59699 2.89462 0.0454815 0.00352801 0.00975148 -0.998856 0.046675 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 3.99992 0.00015411 0.0141678 3.9999 0.0374809 0.00911653 +EDGE_SE3:QUAT 530 640 1.60767 2.84982 0.016032 -0.000498943 0.0101434 -0.999722 0.0212608 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 4 -2.75689e-06 -0.00199648 3.99959 0.0406105 0.00222161 +EDGE_SE3:QUAT 531 640 -2.06598 3.06992 -0.0371737 -0.00519625 -0.00590904 0.997827 0.0654126 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 3.99992 0.000138609 0.0209061 4.0002 0.026094 0.0173958 +EDGE_SE3:QUAT 532 640 -5.32999 4.18764 0.00282276 -0.00359698 -0.00994588 0.979872 0.199344 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 4 -1.68665e-05 0.0145901 3.99959 0.0413926 0.159452 +EDGE_SE3:QUAT 641 642 4.02624 -0.127425 0.0128017 -0.0014069 -0.0017267 0.00233061 0.999995 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 4.00004 9.84657e-06 -0.0137743 3.99999 -1.61366e-05 4.00003 +EDGE_SE3:QUAT 528 641 5.3438 2.98491 0.0481128 -0.00478626 -0.00523756 0.999956 0.0060661 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 3.99991 0.000102244 0.0191467 4.00025 0.0211829 0.000351015 +EDGE_SE3:QUAT 529 641 1.2054 2.96995 0.0210981 -0.00293299 -0.00534361 0.999655 0.0255329 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 3.99997 6.149e-05 0.0117432 4 0.0219389 0.00276262 +EDGE_SE3:QUAT 530 641 -2.79303 3.15583 0.0286473 0.00121356 -0.00545722 0.998677 0.0511113 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 3.99999 -3.56222e-05 -0.0048793 3.99992 0.0211915 0.010568 +EDGE_SE3:QUAT 572 641 4.98205 4.94051 0.137395 0.012282 0.00366893 -0.546109 0.837616 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 4.00106 -0.000618852 0.0817705 3.99981 -0.0277835 2.80873 +EDGE_SE3:QUAT 573 641 -1.16785 5.62625 0.123534 0.00811561 0.00688706 -0.401264 0.915901 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 4.00123 -0.000519294 0.0772496 3.99978 -0.0170718 3.35744 +EDGE_SE3:QUAT 642 643 4.05786 -0.0650427 0.0154754 0.00104819 0.00084051 0.0115327 0.999933 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 4.00001 3.61076e-06 0.00657769 4 3.76652e-05 3.99948 +EDGE_SE3:QUAT 527 642 5.57631 3.10461 0.0510132 0.00449078 0.00766001 -0.999949 0.0048607 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 3.99992 0.000137498 0.0179651 4.0001 0.0304662 0.000407233 +EDGE_SE3:QUAT 528 642 1.35003 3.14573 0.0205284 -0.00300917 -0.00646668 0.999968 0.00358189 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 3.99996 7.74045e-05 0.0120376 3.99997 0.0259528 0.000255934 +EDGE_SE3:QUAT 529 642 -2.78705 3.28836 0.010506 -0.00129105 -0.00679132 0.999707 0.023186 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 4 2.71599e-05 0.00516799 3.99983 0.0273677 0.00234439 +EDGE_SE3:QUAT 572 642 6.49399 1.23273 0.0674423 0.0102094 0.00298864 -0.544136 0.838929 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 4.00072 -0.00041433 0.0676423 3.99986 -0.0229427 2.8168 +EDGE_SE3:QUAT 573 642 1.46181 2.6108 0.0526076 0.00594155 0.00567946 -0.399087 0.916876 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 4.00077 -0.000339838 0.0604708 3.99988 -0.0131215 3.36383 +EDGE_SE3:QUAT 574 642 -3.37719 2.37718 0.0317669 0.00552494 0.00283534 -0.256131 0.966622 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 4.00021 2.22258e-06 0.0367282 3.99991 -0.00532521 3.73792 +EDGE_SE3:QUAT 643 644 4.06815 -0.0315193 0.0218833 -0.00230893 0.00778962 0.0100985 0.999916 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 4.00096 -5.76093e-05 0.0626002 3.99975 0.000313355 4.00057 +EDGE_SE3:QUAT 526 643 5.74234 3.03356 0.00513865 -0.0010023 0.00677383 -0.999793 0.0191588 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 4 -2.04365e-05 -0.00401126 3.99983 0.0272235 0.00165761 +EDGE_SE3:QUAT 527 643 1.53596 3.11309 0.0369212 0.0055007 0.0066335 -0.999831 0.0162217 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 3.99987 0.000139324 0.0220127 4.00034 0.0258068 0.00134027 +EDGE_SE3:QUAT 528 643 -2.69284 3.22528 0.0156286 0.00388433 0.00530957 -0.999948 0.0078518 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 3.99994 8.1356e-05 0.0155393 4.00014 0.0209925 0.000417146 +EDGE_SE3:QUAT 573 643 4.17338 -0.390384 0.00794984 0.00747819 0.0059289 -0.388349 0.921463 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 4.00095 -0.000363722 0.06848 3.99981 -0.0147467 3.39791 +EDGE_SE3:QUAT 574 643 0.134025 0.318022 0.0128935 0.00670559 0.00330239 -0.244876 0.969526 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 4.00028 1.64646e-05 0.0429985 3.99987 -0.00596311 3.7606 +EDGE_SE3:QUAT 575 643 -3.9685 -0.17435 -0.0594876 0.00430828 -0.00502767 -0.0987786 0.995087 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 4.00022 -0.000118098 -0.0345614 3.99994 0.00161558 3.96127 +EDGE_SE3:QUAT 644 645 3.95227 -0.132657 0.00438471 0.00237819 0.000211689 -0.0074809 0.999969 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 3.99998 2.34227e-06 0.00190684 4 -7.39534e-06 3.99978 +EDGE_SE3:QUAT 525 644 6.2141 2.83848 0.0305878 0.00407572 0.00545284 -0.999489 0.0312331 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 3.99992 8.24963e-05 0.0163285 4.00018 0.0207426 0.00407642 +EDGE_SE3:QUAT 526 644 1.75983 2.90211 0.0356736 0.00705717 0.00916641 -0.999513 0.0289759 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 3.99977 0.000240264 0.0282681 4.00055 0.0349631 0.00386418 +EDGE_SE3:QUAT 527 644 -2.52018 3.00927 0.0117014 0.0134126 0.00880046 -0.999527 0.0262252 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 3.99923 0.000371172 0.0537058 4.00271 0.0323607 0.00373451 +EDGE_SE3:QUAT 528 644 -6.72936 3.19716 0.00989447 0.0119498 0.00762558 -0.999739 0.0178981 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 3.9994 0.00031032 0.0478221 4.00213 0.0287895 0.0020605 +EDGE_SE3:QUAT 574 644 3.66002 -1.61237 -0.00360231 0.00620741 0.0115411 -0.235771 0.97172 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 4.00243 -0.000577378 0.101708 3.99946 -0.0123599 3.78023 +EDGE_SE3:QUAT 575 644 -0.0244283 -1.00042 -0.00471697 0.00262701 0.00289095 -0.089057 0.996019 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 4.00014 1.36951e-05 0.0256463 3.99996 -0.00117904 3.96844 +EDGE_SE3:QUAT 576 644 -4.01932 -1.27343 -0.0206279 0.00301517 0.000219552 0.0136348 0.999902 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 3.99996 1.66496e-06 0.00126263 4 7.48774e-06 3.99926 +EDGE_SE3:QUAT 645 646 4.04315 -0.126317 0.0164476 0.000580904 0.000746966 -0.00648898 0.999978 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 4.00001 1.66513e-06 0.00602059 4 -1.95745e-05 3.99984 +EDGE_SE3:QUAT 524 645 6.30494 2.62142 0.0370492 0.00372033 0.00348777 -0.999689 0.0244015 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 3.99994 4.56892e-05 0.0148951 4.00019 0.0132055 0.00248086 +EDGE_SE3:QUAT 525 645 2.21417 2.71837 0.00827093 0.00409484 0.00311274 -0.999705 0.0237363 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 3.99993 4.28295e-05 0.0163936 4.00024 0.0116573 0.00235488 +EDGE_SE3:QUAT 526 645 -2.14145 2.79995 -0.01386 0.00716977 0.00683723 -0.999723 0.0213325 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 3.99978 0.000176452 0.0287 4.00069 0.0261018 0.0021967 +EDGE_SE3:QUAT 527 645 -6.37236 2.92554 -0.0864193 0.0138593 0.00668374 -0.99972 0.0179882 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 3.99921 0.000293078 0.0554616 4.00297 0.0247451 0.00221667 +EDGE_SE3:QUAT 575 645 3.83985 -1.8283 -0.0264093 0.00505581 0.00294791 -0.0964718 0.995319 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 4.00011 4.99564e-05 0.0290719 3.99994 -0.00148976 3.96298 +EDGE_SE3:QUAT 576 645 -0.0836643 -1.29216 -0.0195863 0.00531672 0.000436044 0.00558338 0.99997 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 3.99989 8.03122e-06 0.00313184 4 8.43191e-06 3.99988 +EDGE_SE3:QUAT 577 645 -4.38325 -1.26916 -0.0327593 0.00379402 -0.00104527 0.0333832 0.999435 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 3.99997 -1.85319e-05 -0.00986678 3.99999 -0.000172943 3.99557 +EDGE_SE3:QUAT 646 647 4.15064 -0.123684 0.0212159 -7.66114e-05 -0.00183771 -0.00371046 0.999991 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 4.00005 2.62497e-07 -0.0147049 3.99999 2.72777e-05 4 +EDGE_SE3:QUAT 523 646 6.49071 2.43406 0.0428873 0.00545904 0.00330908 -0.999847 0.016298 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 3.99988 6.17536e-05 0.0218449 4.00045 0.0125179 0.00122102 +EDGE_SE3:QUAT 524 646 2.30668 2.53884 0.0214606 0.00441126 0.00296115 -0.999822 0.0180979 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 3.99992 4.48098e-05 0.0176538 4.00029 0.0111976 0.00141944 +EDGE_SE3:QUAT 525 646 -1.77676 2.65538 -0.00850255 0.00511059 0.00194073 -0.999831 0.0175647 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 3.99989 2.90151e-05 0.0204517 4.00041 0.00704002 0.00135107 +EDGE_SE3:QUAT 526 646 -6.09138 2.74535 -0.0567328 0.00814418 0.00562944 -0.999837 0.0151303 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 3.99972 0.000162633 0.0325882 4.00097 0.0215269 0.00129712 +EDGE_SE3:QUAT 576 646 3.92307 -1.35745 -0.00772592 0.00629894 0.00133959 -0.000334787 0.999979 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 3.99987 3.38419e-05 0.0107414 3.99999 -1.5272e-06 4.00003 +EDGE_SE3:QUAT 577 646 -0.390084 -1.12076 -0.0123303 0.0045855 -0.000194613 0.0268287 0.99963 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 3.99992 -8.00231e-06 -0.00303072 4 -4.7236e-05 3.99712 +EDGE_SE3:QUAT 578 646 -4.41263 -1.01758 -0.0198896 0.00441447 0.00118101 0.0251274 0.999674 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 3.99994 1.7577e-05 0.00810836 4 9.63762e-05 3.99749 +EDGE_SE3:QUAT 647 648 4.06861 -0.0995549 0.0176315 0.000564287 -0.00165574 -0.000429257 0.999998 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 4.00004 -3.76452e-06 -0.0132431 3.99999 2.87934e-06 4.00004 +EDGE_SE3:QUAT 522 647 6.59254 2.28403 0.0701858 0.00753791 0.00489722 -0.999916 0.00928743 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 3.99977 0.000136684 0.0301556 4.00083 0.0190304 0.000662917 +EDGE_SE3:QUAT 523 647 2.32949 2.40733 0.0249316 0.00352213 0.00333965 -0.999909 0.0125676 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 3.99995 4.43191e-05 0.014092 4.00016 0.0130001 0.000723687 +EDGE_SE3:QUAT 524 647 -1.83042 2.51356 0.00888386 0.00253048 0.00261964 -0.999887 0.0145773 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 3.99997 2.49879e-05 0.0101253 4.00008 0.0101783 0.000901536 +EDGE_SE3:QUAT 525 647 -5.92253 2.61875 -0.0302487 0.00326786 0.00212436 -0.999893 0.0140776 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 3.99996 2.45854e-05 0.0130754 4.00016 0.00812573 0.000851976 +EDGE_SE3:QUAT 577 647 3.77042 -1.01545 0.00641448 0.00475826 -0.00208092 0.0232253 0.999717 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 3.99999 -4.1051e-05 -0.0179593 3.99998 -0.000213088 3.99792 +EDGE_SE3:QUAT 578 647 -0.264082 -0.924763 -0.0105477 0.00446555 -0.000700043 0.0212811 0.999763 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 3.99993 -1.55513e-05 -0.00673642 4 -7.564e-05 3.9982 +EDGE_SE3:QUAT 579 647 -4.30954 -0.806448 -0.00461043 0.000559513 0.00177036 0.0182772 0.999831 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 4.00005 5.26943e-06 0.0140332 3.99999 0.000127894 3.99871 +EDGE_SE3:QUAT 648 649 4.1908 -0.0896048 0.00918237 -0.000393267 0.00314236 0.000233266 0.999995 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 4.00016 -4.88884e-06 0.0251409 3.99996 2.83939e-06 4.00016 +EDGE_SE3:QUAT 521 648 6.63079 2.16079 0.0236292 0.000868569 0.00367301 -0.999988 0.00306453 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 4 1.30342e-05 0.00347439 3.99996 0.0146704 9.43892e-05 +EDGE_SE3:QUAT 522 648 2.53544 2.30619 0.0210228 0.00598786 0.00408026 -0.999934 0.00888024 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 3.99985 9.11925e-05 0.0239544 4.00052 0.0158955 0.000522064 +EDGE_SE3:QUAT 523 648 -1.73287 2.40964 0.00823241 0.00194257 0.00247756 -0.999923 0.0120308 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 3.99998 1.87087e-05 0.00777206 4.00004 0.00971989 0.000617688 +EDGE_SE3:QUAT 524 648 -5.94918 2.49874 -0.000561188 0.00110933 0.00213344 -0.999905 0.0135933 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 3.99999 9.53208e-06 0.00443862 4 0.00840925 0.000761717 +EDGE_SE3:QUAT 578 648 3.81414 -0.850763 0.0103279 0.00538092 -0.00222648 0.020699 0.999769 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 3.99998 -4.99195e-05 -0.0191361 3.99998 -0.000201913 3.99838 +EDGE_SE3:QUAT 579 648 -0.233656 -0.758242 -0.00235396 0.0012658 0.00026655 0.0174177 0.999847 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 3.99999 1.14977e-06 0.00186691 4 1.54896e-05 3.99879 +EDGE_SE3:QUAT 580 648 -4.62685 -0.657734 -0.0201162 0.00289326 -0.00180989 0.0132987 0.999906 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 4.00002 -2.07321e-05 -0.014937 3.99999 -0.000100101 3.99935 +EDGE_SE3:QUAT 649 650 4.197 -0.0948588 0.0237265 -0.00126969 -0.00257029 0.0014704 0.999995 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 4.0001 1.32688e-05 -0.0205403 3.99997 -1.52978e-05 4.0001 +EDGE_SE3:QUAT 520 649 6.56385 2.06351 0.0382638 -0.00607062 -0.000623388 0.99997 0.00487225 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 3.99985 1.94342e-05 0.0242829 4.00059 0.00273059 0.000244243 +EDGE_SE3:QUAT 521 649 2.43347 2.21507 0.0274711 0.00392203 0.00378668 -0.99998 0.00330112 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 3.99994 5.85667e-05 0.0156886 4.00019 0.0150439 0.0001617 +EDGE_SE3:QUAT 522 649 -1.6781 2.31641 -0.015281 0.00923928 0.00451323 -0.999906 0.00905184 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 3.99965 0.000149698 0.036961 4.0013 0.0173882 0.000744887 +EDGE_SE3:QUAT 523 649 -5.93175 2.3965 0.00369636 0.00505031 0.00289854 -0.999908 0.0122702 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 3.9999 5.17479e-05 0.0202058 4.00038 0.0110956 0.0007351 +EDGE_SE3:QUAT 579 649 3.97051 -0.694796 0.0072998 0.000902416 0.00340758 0.0177011 0.999837 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 4.00018 1.70557e-05 0.0270572 3.99995 0.000239146 3.99893 +EDGE_SE3:QUAT 580 649 -0.412184 -0.618145 0.00422246 0.00258143 0.00124045 0.0133457 0.999907 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 4 1.25539e-05 0.00950754 3.99999 6.26067e-05 3.99931 +EDGE_SE3:QUAT 581 649 -4.41646 -0.513794 0.00170425 0.00224278 0.00281563 0.0108338 0.999935 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 4.0001 2.68396e-05 0.02223 3.99997 0.000120311 3.99965 +EDGE_SE3:QUAT 650 651 4.19624 -0.0930649 0.0123442 0.000328629 0.00056719 0.00177684 0.999998 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 4 7.57728e-07 0.00453049 4 4.02544e-06 3.99999 +EDGE_SE3:QUAT 519 650 6.53134 2.03021 0.0276051 -0.00271101 -0.00294776 0.999921 0.011888 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 3.99997 3.31665e-05 0.0108464 4.00008 0.0120451 0.000630986 +EDGE_SE3:QUAT 520 650 2.36834 2.18764 0.0120512 -0.00338438 -0.0020184 0.999987 0.00307944 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 3.99995 2.80703e-05 0.0135377 4.00017 0.00815729 0.000100385 +EDGE_SE3:QUAT 521 650 -1.77307 2.27838 0.0178737 0.00138701 0.00504405 -0.999975 0.00485335 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 3.99999 2.87372e-05 0.00554846 3.99993 0.0201211 0.000203136 +EDGE_SE3:QUAT 522 650 -5.92468 2.33641 -0.0663875 0.00656959 0.00575235 -0.999911 0.0100485 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 3.99982 0.000143253 0.026283 4.00058 0.0224806 0.000702939 +EDGE_SE3:QUAT 580 650 3.77577 -0.594867 0.0164288 0.00170243 -0.00147089 0.0151435 0.999883 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 4.00002 -9.54465e-06 -0.0120724 3.99999 -9.20904e-05 3.99912 +EDGE_SE3:QUAT 581 650 -0.231354 -0.505195 -0.00137281 0.00110541 0.000229038 0.0125665 0.99992 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 4 9.03223e-07 0.00166519 4 1.0114e-05 3.99937 +EDGE_SE3:QUAT 582 650 -4.58017 -0.383297 -0.0137358 0.0015334 -0.000145642 0.00525186 0.999985 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 3.99999 -9.8901e-07 -0.00126172 4 -3.39683e-06 3.99989 +EDGE_SE3:QUAT 651 652 4.14426 -0.0836811 0.0222435 -0.000537392 -0.0016352 0.00179302 0.999997 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 4.00004 3.62583e-06 -0.0130701 3.99999 -1.17487e-05 4.00003 +EDGE_SE3:QUAT 466 651 1.48093 6.69398 0.106423 0.00861781 0.00315429 -0.455139 0.890373 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 4.00055 -0.000205735 0.0583923 3.99984 -0.0160785 3.17224 +EDGE_SE3:QUAT 518 651 6.42005 2.02708 0.0449552 -0.00552148 -0.0033245 0.999778 0.0200808 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 3.99988 8.58906e-05 0.0220992 4.00043 0.0141735 0.00178534 +EDGE_SE3:QUAT 519 651 2.37189 2.20909 0.0196769 -0.00323783 -0.00241005 0.999943 0.00986324 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 3.99996 3.31919e-05 0.0129532 4.00014 0.00989383 0.000455558 +EDGE_SE3:QUAT 520 651 -1.78335 2.30166 -0.00258868 -0.00419601 -0.00151994 0.99999 0.000879927 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 3.99993 2.58721e-05 0.016784 4.00027 0.00610986 8.28553e-05 +EDGE_SE3:QUAT 521 651 -5.95231 2.31847 0.022676 0.00213059 0.00487979 -0.999964 0.00661671 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 3.99998 4.20983e-05 0.0085232 3.99998 0.0194045 0.000287423 +EDGE_SE3:QUAT 581 651 3.96124 -0.492573 0.00861314 0.00136853 0.000983266 0.0143647 0.999895 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 4.00001 5.48297e-06 0.00762782 4 5.42459e-05 3.99919 +EDGE_SE3:QUAT 582 651 -0.379645 -0.414942 0.000895184 0.00188718 0.000471871 0.00717756 0.999972 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 3.99999 3.39298e-06 0.00361212 4 1.27777e-05 3.9998 +EDGE_SE3:QUAT 583 651 -4.76984 -0.362692 -0.023555 0.00295529 0.000956321 0.00730938 0.999968 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 3.99998 1.09449e-05 0.00739067 4 2.67557e-05 3.9998 +EDGE_SE3:QUAT 652 653 3.98956 -0.0772227 0.0151977 -0.000412067 0.000345156 0.00247624 0.999997 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 4 -5.65139e-07 0.00277347 4 3.43775e-06 3.99998 +EDGE_SE3:QUAT 466 652 3.82106 3.3193 0.0708415 0.00741298 0.00168978 -0.453063 0.891446 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 4.00026 -6.89873e-05 0.0443689 3.99988 -0.0126558 3.17942 +EDGE_SE3:QUAT 467 652 -2.12451 3.6258 0.0569807 0.0050694 0.0045442 -0.242639 0.970093 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 4.00046 -6.00219e-05 0.0473773 3.99987 -0.00620586 3.76507 +EDGE_SE3:QUAT 517 652 6.86957 2.08457 -0.00845722 0.000300302 -0.00694252 0.999552 0.0291 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 4 -1.93405e-05 -0.00120426 3.99981 0.0276408 0.00357878 +EDGE_SE3:QUAT 518 652 2.2983 2.27307 0.0223374 -0.003715 -0.00393368 0.999824 0.0179605 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 3.99995 6.18872e-05 0.0148673 4.00015 0.0162567 0.00141169 +EDGE_SE3:QUAT 519 652 -1.76611 2.37747 0.015011 -0.00151849 -0.00284007 0.999966 0.00764694 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 3.99999 1.71644e-05 0.00607454 4 0.0114516 0.000275915 +EDGE_SE3:QUAT 520 652 -5.91744 2.39724 -0.0159668 0.0026049 0.00226116 -0.999993 0.00110221 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 3.99997 2.34275e-05 0.0104197 4.00009 0.00902195 5.23503e-05 +EDGE_SE3:QUAT 582 652 3.7149 -0.444471 0.0195774 0.00151229 -0.00129325 0.0094669 0.999953 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 4.00002 -7.60523e-06 -0.0105164 3.99999 -4.99865e-05 3.99967 +EDGE_SE3:QUAT 583 652 -0.634841 -0.389579 -0.012356 0.00216961 -0.000584215 0.00941495 0.999953 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 3.99999 -5.34016e-06 -0.00491818 4 -2.35167e-05 3.99965 +EDGE_SE3:QUAT 584 652 -4.56535 -0.68192 -0.1036 0.00628149 -0.00748838 0.0659056 0.997778 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 4.00088 -0.000107679 -0.0644824 3.99973 -0.00216697 3.98366 +EDGE_SE3:QUAT 653 654 4.06731 -0.0854054 -0.0236857 -0.000392742 0.00862043 0.00251523 0.99996 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 4.00119 -9.07082e-06 0.0689926 3.9997 8.61378e-05 4.00116 +EDGE_SE3:QUAT 466 653 6.10925 0.0450598 0.0500038 0.00714075 0.0022654 -0.451029 0.892478 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 4.00033 -0.000108583 0.0462964 3.99989 -0.012795 3.18682 +EDGE_SE3:QUAT 467 653 1.35444 1.68231 0.028831 0.00504301 0.00474871 -0.240269 0.970682 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 4.00049 -6.75711e-05 0.0487343 3.99986 -0.00629625 3.76967 +EDGE_SE3:QUAT 468 653 -3.53561 1.12162 -0.0442527 0.0035847 -0.0102644 0.0158778 0.999815 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 4.00166 -0.000108284 -0.0827967 3.99957 -0.000650586 4.0007 +EDGE_SE3:QUAT 517 653 2.911 2.3822 0.0124605 -5.10593e-05 -0.00731495 0.999623 0.0264636 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 4 -9.81345e-06 0.000203301 3.99979 0.0292186 0.00301489 +EDGE_SE3:QUAT 518 653 -1.69677 2.49759 0.0110552 -0.00405541 -0.0043136 0.999861 0.015613 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 3.99994 7.35519e-05 0.0162278 4.00018 0.0177517 0.0011197 +EDGE_SE3:QUAT 519 653 -5.74361 2.51212 0.0241452 -0.00197708 -0.00336757 0.999979 0.00510965 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 3.99998 2.66374e-05 0.00790876 4.00002 0.0135504 0.000165976 +EDGE_SE3:QUAT 583 653 3.38932 -0.381471 0.0126049 0.00178943 -0.000284343 0.0116997 0.99993 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 3.99999 -2.30761e-06 -0.00252547 4 -1.52585e-05 3.99945 +EDGE_SE3:QUAT 584 653 -0.626197 -0.240167 -0.0226674 0.00591869 -0.00717024 0.0682683 0.997624 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 4.00081 -9.24834e-05 -0.0618055 3.99975 -0.00215326 3.98231 +EDGE_SE3:QUAT 585 653 -4.57247 -1.00357 -0.100705 0.00281748 -0.0136628 0.217374 0.975989 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 4.00293 0.000837202 -0.108836 3.99941 -0.0118159 3.81395 +EDGE_SE3:QUAT 654 655 3.98962 -0.0910993 0.0190984 -0.000902514 0.00148604 -3.22425e-05 0.999998 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 4.00003 -5.36636e-06 0.0118881 3.99999 -2.39485e-07 4.00004 +EDGE_SE3:QUAT 467 654 4.89498 -0.288774 -0.0441597 0.00652719 0.0132239 -0.237679 0.971232 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 4.00313 -0.000784324 0.114954 3.99932 -0.0140244 3.77734 +EDGE_SE3:QUAT 468 654 0.521486 1.15167 0.01049 0.0028517 -0.00170274 0.018369 0.999826 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 4.00002 -1.92343e-05 -0.0142434 3.99999 -0.000132513 3.9987 +EDGE_SE3:QUAT 469 654 -4.11499 0.132432 -0.0129111 0.0079808 -0.00620264 0.290276 0.95689 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 4.00096 0.000180179 -0.0697384 3.99972 -0.0111322 3.66417 +EDGE_SE3:QUAT 516 654 3.26263 2.5836 0.00990855 -0.00188732 -0.00304495 0.999539 0.030141 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 3.99999 2.29998e-05 0.00755901 4.00001 0.012607 0.00368799 +EDGE_SE3:QUAT 517 654 -1.1359 2.67646 -0.00303695 -0.00866472 -0.00717865 0.999644 0.0242097 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 3.99972 0.000280319 0.0346907 4.00092 0.030361 0.00287598 +EDGE_SE3:QUAT 518 654 -5.72463 2.7158 -0.0443161 -0.0127554 -0.00447686 0.999818 0.0134607 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 3.99936 0.000278681 0.0510333 4.00249 0.0192898 0.00146903 +EDGE_SE3:QUAT 583 654 7.41041 -0.378533 -0.00834876 0.00144855 0.00833376 0.0139975 0.999866 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 4.00109 7.12785e-05 0.0664229 3.99973 0.000467001 4.00032 +EDGE_SE3:QUAT 584 654 3.41914 0.226616 0.0105841 0.00489762 0.00126879 0.0708032 0.997477 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 3.99991 1.23012e-05 0.00592651 4 0.000159884 3.97996 +EDGE_SE3:QUAT 585 654 -0.829546 0.652387 -0.00803311 0.000891038 -0.00537563 0.219626 0.975569 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 4.00044 0.000132872 -0.0422083 3.99991 -0.00460366 3.8075 +EDGE_SE3:QUAT 586 654 -4.94199 -0.358387 -0.00615331 0.00526694 -0.00480753 0.385223 0.922796 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 4.00057 0.000229623 -0.0521717 3.9999 -0.0109801 3.40709 +EDGE_SE3:QUAT 655 656 4.4633 -0.146187 0.0358621 -1.26025e-05 -0.00242066 -0.0115055 0.999931 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 4.00009 -1.49588e-06 -0.0193636 3.99998 0.000111395 3.99956 +EDGE_SE3:QUAT 468 655 4.50762 1.21365 0.045564 0.00176792 -5.57262e-05 0.0185726 0.999826 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 3.99999 -8.54195e-07 -0.000839505 4 -9.01446e-06 3.99862 +EDGE_SE3:QUAT 469 655 -0.748943 2.27449 0.0676737 0.00618866 -0.0051237 0.290311 0.956899 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 4.00064 0.000128688 -0.0562757 3.99982 -0.00893807 3.66367 +EDGE_SE3:QUAT 470 655 -5.8718 0.462738 0.0674061 0.00443256 -0.0015531 0.540359 0.841422 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 4.00015 9.16235e-05 -0.0305508 3.99998 -0.0101089 2.83228 +EDGE_SE3:QUAT 515 655 3.64945 2.9085 0.0487944 -0.00516238 -0.00661692 0.999911 0.0104068 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 3.9999 0.000139448 0.020654 4.00023 0.0268935 0.000720681 +EDGE_SE3:QUAT 516 655 -0.725729 2.91748 0.0214178 -0.00318009 -0.00395471 0.999536 0.030019 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 3.99997 5.31186e-05 0.012737 4.00008 0.0165469 0.00371367 +EDGE_SE3:QUAT 517 655 -5.10586 2.96967 -0.0504763 -0.0102829 -0.00791503 0.999627 0.0240396 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 3.99961 0.000371902 0.0411694 4.00135 0.0336086 0.003018 +EDGE_SE3:QUAT 584 655 7.37308 0.710568 0.0226941 0.00407434 0.00272001 0.0710235 0.997463 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 4.00002 4.40468e-05 0.0181346 3.99998 0.000601512 3.9799 +EDGE_SE3:QUAT 585 655 2.80948 2.27639 0.052425 -0.000576498 -0.00417635 0.219721 0.975554 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 4.00022 8.60507e-05 -0.0295509 3.99996 -0.00309979 3.80711 +EDGE_SE3:QUAT 586 655 -2.06658 2.41873 0.0640451 0.00373308 -0.00378613 0.385113 0.922854 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 4.00033 0.000139704 -0.0393566 3.99994 -0.00819043 3.40714 +EDGE_SE3:QUAT 587 655 -6.81161 0.886847 0.0847964 0.00407302 -0.000376812 0.541884 0.840443 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 4.00006 2.57281e-05 -0.0230907 3.99997 -0.00837839 2.82558 +EDGE_SE3:QUAT 656 657 4.31015 -0.201378 0.0245771 0.000840723 -0.000122994 -0.029645 0.99956 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 4 -2.51586e-07 -0.000683753 4 8.65101e-06 3.99648 +EDGE_SE3:QUAT 469 656 3.02799 4.62569 0.1632 0.00688731 -0.00714805 0.279363 0.960134 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 4.00112 0.000254406 -0.07253 3.99972 -0.0108676 3.68914 +EDGE_SE3:QUAT 470 656 -3.89063 4.45626 0.142371 0.00569612 -0.00355396 0.530592 0.847601 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 4.00042 0.00028098 -0.0467817 3.99999 -0.0141716 2.87444 +EDGE_SE3:QUAT 514 656 3.15086 3.30031 0.035619 0.00431226 0.00463731 -0.998073 0.0617308 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 3.99991 5.82316e-05 0.0173562 4.00027 0.016253 0.0153847 +EDGE_SE3:QUAT 515 656 -0.805745 3.1476 0.0416694 -0.00275644 -0.00686326 0.99974 0.021591 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 3.99998 7.09223e-05 0.0110336 3.99991 0.0278973 0.00208979 +EDGE_SE3:QUAT 516 656 -5.15095 3.33083 0.0284596 -0.000835108 -0.00437461 0.999143 0.0411414 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 4 8.65331e-06 0.00334654 3.99993 0.0176987 0.00685171 +EDGE_SE3:QUAT 586 656 1.16084 5.49357 0.149203 0.00471536 -0.00599438 0.374445 0.927218 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 4.00074 0.00032136 -0.0574497 3.99989 -0.0113671 3.43999 +EDGE_SE3:QUAT 587 656 -4.83461 4.88702 0.141745 0.00531876 -0.00225868 0.531983 0.846736 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 4.00026 0.000155759 -0.0385213 3.99997 -0.0122828 2.86835 +EDGE_SE3:QUAT 657 658 4.18503 -0.352547 0.0378278 -0.00277131 0.00265869 -0.0870977 0.996192 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 4.00005 -3.53252e-05 0.0181461 3.99998 -0.00074508 3.96974 +EDGE_SE3:QUAT 512 657 5.55479 4.28624 -0.0245208 0.000738232 0.000756888 -0.943935 0.33013 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 4 -3.91565e-06 0.0036128 4.00001 0.000497677 0.435948 +EDGE_SE3:QUAT 513 657 2.41938 3.07696 -0.00635251 0.00516056 0.00114857 -0.985674 0.168581 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 3.9999 -8.73994e-05 0.0215471 4.00043 -0.00249156 0.1138 +EDGE_SE3:QUAT 514 657 -1.15418 2.96026 0.0197872 0.00423416 0.00423832 -0.999463 0.0322231 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 3.99992 6.13791e-05 0.0169643 4.00024 0.0158205 0.00428797 +EDGE_SE3:QUAT 515 657 -5.11203 3.53627 0.0441324 -0.00230973 -0.00599649 0.998647 0.0515951 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 3.99999 4.49555e-05 0.00926963 3.99991 0.0247773 0.0108236 +EDGE_SE3:QUAT 658 659 4.20672 -0.824537 0.0225928 0.000863905 0.00242902 -0.192294 0.981334 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 4.0001 -2.08324e-05 0.0203091 3.99998 -0.001981 3.8522 +EDGE_SE3:QUAT 511 658 5.47939 3.02017 0.00895693 -0.000367486 0.00637655 -0.915948 0.401245 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 3.99993 5.25132e-05 0.00151554 3.99998 0.01683 0.644088 +EDGE_SE3:QUAT 512 658 2.06829 1.93369 0.00127776 0.00227741 0.00441432 -0.969082 0.246687 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 3.99994 4.29945e-06 0.0104326 4.00013 0.0108085 0.243481 +EDGE_SE3:QUAT 513 658 -1.65471 2.00803 -0.0137904 0.00727722 0.00495137 -0.996607 0.0818298 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 3.99975 4.1719e-05 0.0294206 4.00088 0.0147469 0.0270573 +EDGE_SE3:QUAT 514 658 -5.36556 3.03809 0.0219031 -0.00636549 -0.00734008 0.998426 0.0552399 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 3.99988 0.000207796 0.0255707 4.00031 0.0319462 0.0126255 +EDGE_SE3:QUAT 659 660 4.04661 -0.987512 0.0077396 -0.000956131 -0.000460244 -0.229675 0.973267 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 4.00001 5.86345e-07 -0.00593702 4 0.000770917 3.78901 +EDGE_SE3:QUAT 510 659 6.02026 1.32323 0.0415792 0.00455652 0.00662548 -0.942149 0.335099 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 3.99984 -0.000144499 0.0230219 4.00058 0.00851913 0.449346 +EDGE_SE3:QUAT 511 659 2.00766 0.475304 0.0173893 0.00102539 0.00669943 -0.976102 0.217207 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 3.99995 6.44662e-05 0.00493091 3.99997 0.0219924 0.18885 +EDGE_SE3:QUAT 512 659 -2.01532 0.629804 0.00748794 0.00400587 0.00456815 -0.998445 0.0554154 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 3.99992 5.753e-05 0.0161035 4.00022 0.0163635 0.0124157 +EDGE_SE3:QUAT 513 659 -5.92825 2.11365 -0.0475688 -0.00873571 -0.00553115 0.99375 0.111153 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 3.9998 0.000328994 0.0355268 4.00081 0.0291261 0.0499528 +EDGE_SE3:QUAT 660 661 4.23892 -0.910792 -0.00089671 0.00491966 0.00450939 -0.167568 0.985838 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 4.00039 8.07498e-07 0.0442777 3.99987 -0.00394025 3.88817 +EDGE_SE3:QUAT 509 660 6.40454 0.0650163 -0.0103126 0.000295209 0.0106093 -0.981631 0.190493 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 3.99993 0.000149095 0.0018314 3.9997 0.0382024 0.145532 +EDGE_SE3:QUAT 510 660 2.26432 -0.474936 0.0087976 0.00219301 0.00790093 -0.993904 0.109943 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 3.99994 9.55953e-05 0.00901436 3.99994 0.028748 0.0485801 +EDGE_SE3:QUAT 511 660 -2.06368 -0.351199 0.0186865 0.00120239 -0.00720448 0.999893 0.0127099 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 3.99999 -3.9391e-05 -0.00481124 3.99982 0.0286836 0.000857688 +EDGE_SE3:QUAT 512 660 -6.13673 1.17217 -0.00984212 -0.002147 -0.00598785 0.98456 0.174931 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 4 1.93423e-06 0.00871685 3.99986 0.025051 0.122585 +EDGE_SE3:QUAT 661 662 4.19942 -0.351946 -0.0333441 0.00368072 0.0081381 -0.0429245 0.999038 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 4.00106 5.29999e-05 0.0668339 3.99972 -0.0014416 3.99375 +EDGE_SE3:QUAT 508 661 6.38584 -0.581369 -0.00397777 -0.00459554 0.00878862 -0.998577 0.0524075 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 3.99995 -0.000148925 -0.0184498 3.99993 0.0368365 0.0114116 +EDGE_SE3:QUAT 509 661 2.15619 -0.685856 -0.010582 0.00382022 0.00632125 -0.999681 0.0241581 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 3.99993 9.49576e-05 0.0152957 4.0001 0.0245119 0.00254326 +EDGE_SE3:QUAT 510 661 -2.07092 -0.511477 -0.0021482 -0.0058319 -0.00376398 0.998299 0.0578896 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 3.99989 0.000123651 0.0234393 4.00042 0.0176247 0.0136205 +EDGE_SE3:QUAT 511 661 -6.28851 0.671354 0.0415862 -0.00192493 -0.00228135 0.983672 0.179946 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 4 1.74059e-05 0.00795828 4 0.0110765 0.12957 +EDGE_SE3:QUAT 662 663 3.99399 -0.144855 0.00109267 0.00263294 -0.00178402 -0.00779596 0.999965 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 4.00002 -1.89343e-05 -0.0140246 3.99999 5.45431e-05 3.99981 +EDGE_SE3:QUAT 507 662 6.42984 -0.787063 0.0533958 0.00610768 0.00846194 -0.99989 0.0105276 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 3.99984 0.000203053 0.0244369 4.00034 0.0333299 0.000870342 +EDGE_SE3:QUAT 508 662 2.18305 -0.670766 0.00530311 0.00336253 0.00540788 -0.999935 0.00941435 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 3.99995 7.22888e-05 0.0134524 4.00007 0.0213746 0.00051399 +EDGE_SE3:QUAT 509 662 -2.07165 -0.548543 -0.0718631 -0.0117055 -0.00299109 0.999736 0.0195462 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 3.99946 0.000202329 0.0468466 4.00212 0.0137932 0.00212468 +EDGE_SE3:QUAT 510 662 -6.19184 0.298013 -0.0840949 -0.0134543 0.000110066 0.994807 0.100888 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 3.99933 0.000425524 0.0546306 4.00282 0.0103324 0.0414942 +EDGE_SE3:QUAT 663 664 4.29818 -0.142946 0.0310757 0.00395999 0.00603398 -0.00454363 0.999964 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 4.00053 9.21918e-05 0.0484914 3.99985 -0.000106883 4.00051 +EDGE_SE3:QUAT 506 663 6.81099 -0.848946 -0.0335198 -0.00231431 0.00901932 -0.999955 0.0015555 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 3.99998 -8.26711e-05 -0.00925839 3.99976 0.0361054 0.000357025 +EDGE_SE3:QUAT 507 663 2.43976 -0.722718 0.00669976 0.00416871 0.0060353 -0.999969 0.00293146 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 3.99993 0.000100273 0.0166758 4.00014 0.0240448 0.000248426 +EDGE_SE3:QUAT 508 663 -1.81224 -0.606274 -0.0183207 0.00127764 0.00269759 -0.999995 0.00139977 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 3.99999 1.38126e-05 0.00511064 4 0.0107761 4.3398e-05 +EDGE_SE3:QUAT 509 663 -6.0546 -0.256279 -0.170583 -0.00974207 -0.000790308 0.999575 0.0274513 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 3.99963 9.27997e-05 0.0390106 4.0015 0.00529617 0.00340208 +EDGE_SE3:QUAT 664 665 4.39224 -0.12161 0.0346396 0.000103574 -0.00838345 -0.00409074 0.999956 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 4.00112 -1.03776e-05 -0.0670773 3.99972 0.000137469 4.00106 +EDGE_SE3:QUAT 505 664 7.12211 -0.855491 0.0622533 -0.0114187 -0.00458074 0.999907 0.0058279 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 3.99948 0.00022675 0.0456759 4.00199 0.0188671 0.000746441 +EDGE_SE3:QUAT 506 664 2.56699 -0.73739 0.0229163 -0.00373041 -0.00485795 0.999975 0.00347317 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 3.99995 7.29892e-05 0.0149223 4.00013 0.0195361 0.000199332 +EDGE_SE3:QUAT 507 664 -1.77881 -0.621796 0.00398642 -0.0101314 -0.00217834 0.999944 0.00202394 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 3.99959 9.33105e-05 0.0405242 4.00162 0.00888234 0.000446694 +EDGE_SE3:QUAT 508 664 -6.05354 -0.494924 0.00296069 -0.00750934 0.00120268 0.999967 0.00289011 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 3.99977 -3.22701e-05 0.0300369 4.0009 -0.00463843 0.000264357 +EDGE_SE3:QUAT 665 666 4.25835 -0.108702 0.0244924 -0.00246371 -0.00396 -0.00342539 0.999983 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 4.00023 3.79031e-05 -0.0317822 3.99994 5.35677e-05 4.00021 +EDGE_SE3:QUAT 504 665 6.78274 -0.796096 0.0558201 -0.00898989 -0.00502208 0.999868 0.0125895 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 3.99969 0.000202205 0.0359683 4.00116 0.0209946 0.00106764 +EDGE_SE3:QUAT 505 665 2.69374 -0.677119 -0.000753665 -0.00274938 -0.00481811 0.999936 0.00986792 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 3.99997 5.28657e-05 0.0109995 4.00002 0.0194853 0.000514681 +EDGE_SE3:QUAT 506 665 -1.84621 -0.585039 0.0297107 0.0044811 -0.00487215 0.999951 0.00740296 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 3.99992 -8.51129e-05 -0.0179263 4.00023 0.0192225 0.000391931 +EDGE_SE3:QUAT 507 665 -6.14254 -0.486765 -0.0533746 -0.00221449 -0.00214914 0.999976 0.0061715 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 3.99998 1.95248e-05 0.0088585 4.00006 0.00870527 0.000190914 +EDGE_SE3:QUAT 666 667 4.36453 -0.109372 0.00330766 -0.0010044 -0.0043738 -0.00310641 0.999985 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 4.0003 1.6173e-05 -0.0350297 3.99992 5.39763e-05 4.00027 +EDGE_SE3:QUAT 503 666 6.80123 -0.692328 0.0872393 -0.0103234 -0.00550081 0.999747 0.0192006 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 3.99959 0.000270577 0.0413164 4.00153 0.0235814 0.00204059 +EDGE_SE3:QUAT 504 666 2.49419 -0.580167 0.00296559 -0.0048928 -0.007759 0.999828 0.0161276 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 3.99991 0.000152752 0.0195802 4.00011 0.0316499 0.00138674 +EDGE_SE3:QUAT 505 666 -1.55332 -0.488638 0.0024425 0.00127548 -0.00741961 0.999883 0.0132807 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 3.99999 -4.30703e-05 -0.00510387 3.99981 0.0295294 0.000930069 +EDGE_SE3:QUAT 506 666 -6.12774 -0.412562 0.0945535 0.00848316 -0.00735668 0.999879 0.0107926 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 3.9997 -0.000235429 -0.0339399 4.00097 0.0286966 0.000959778 +EDGE_SE3:QUAT 667 668 4.57315 -0.111525 -0.00199875 -9.14239e-05 0.00926155 -0.00139919 0.999956 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 4.00137 -6.27238e-06 0.0741129 3.99966 -5.20837e-05 4.00136 +EDGE_SE3:QUAT 502 667 6.79123 -0.532617 -0.00917156 0.00193462 -0.00535841 0.999691 0.0242145 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 3.99998 -4.44522e-05 -0.00774621 3.99996 0.0210279 0.00247099 +EDGE_SE3:QUAT 503 667 2.46206 -0.41826 0.00266579 -0.00586608 -0.00688606 0.999715 0.0220786 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 3.99988 0.000170234 0.0234824 4.00032 0.0285507 0.00229163 +EDGE_SE3:QUAT 504 667 -1.81106 -0.33778 -0.0303677 -0.000489531 -0.0089631 0.999774 0.0192865 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 4 5.18031e-06 0.00195883 3.99968 0.0358932 0.00181106 +EDGE_SE3:QUAT 505 667 -5.89422 -0.271411 0.022711 0.00575044 -0.00851417 0.999815 0.0162893 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 3.99986 -0.000191594 -0.0230131 4.00028 0.0332901 0.00147091 +EDGE_SE3:QUAT 668 669 4.43861 -0.0977645 0.0375244 -0.00166094 0.00798655 -0.000585713 0.999967 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 4.00101 -5.39914e-05 0.0638947 3.99974 -2.1266e-05 4.00102 +EDGE_SE3:QUAT 501 668 6.69216 -0.298513 -0.0428719 0.00296322 -0.0043285 0.999639 0.026336 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 3.99996 -4.91337e-05 -0.0118661 4.00008 0.0166608 0.00287901 +EDGE_SE3:QUAT 502 668 2.2311 -0.20161 0.0147042 -0.00729202 -0.00543743 0.999627 0.0257472 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 3.9998 0.00018377 0.0291973 4.00068 0.0232209 0.00299979 +EDGE_SE3:QUAT 503 668 -2.13085 -0.103876 -0.0554949 -0.0152001 -0.00691329 0.999589 0.0232867 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 3.99912 0.000538186 0.0608488 4.00338 0.0304836 0.00332752 +EDGE_SE3:QUAT 504 668 -6.41667 -0.0459194 -0.0306142 -0.0097397 -0.0089976 0.999703 0.0204652 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 3.99965 0.000381903 0.0389865 4.00111 0.0375639 0.00240821 +EDGE_SE3:QUAT 669 670 4.16505 -0.0842952 0.0474934 1.78859e-05 -0.0021289 0.000115467 0.999998 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 4.00007 -1.39761e-07 -0.0170315 3.99998 -9.81389e-07 4.00007 +EDGE_SE3:QUAT 500 669 6.43823 -0.0600623 0.0090986 -0.00524939 -0.00544202 0.99959 0.0276236 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 3.9999 0.00012463 0.0210215 4.00028 0.0228886 0.00329385 +EDGE_SE3:QUAT 501 669 2.25567 0.028232 0.0199848 -0.00483755 -0.00598831 0.999612 0.0267687 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 3.99992 0.000121933 0.0193711 4.00019 0.0249481 0.00311583 +EDGE_SE3:QUAT 502 669 -2.18632 0.117275 -0.0128762 -0.0151391 -0.00684256 0.999518 0.0262364 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 3.99913 0.000545505 0.0606181 4.00334 0.0305361 0.00390579 +EDGE_SE3:QUAT 503 669 -6.5346 0.192649 -0.145532 -0.0231532 -0.00849804 0.999413 0.0237841 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 3.99794 0.00107819 0.0926831 4.00806 0.0384596 0.00478131 +EDGE_SE3:QUAT 670 671 4.14626 -0.0922353 0.0152317 0.000776223 -0.00344441 0.000523105 0.999994 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 4.00019 -1.05498e-05 -0.0275613 3.99995 -6.98895e-06 4.00019 +EDGE_SE3:QUAT 499 670 6.4931 0.202172 0.0487132 -0.00713999 -0.00765253 0.99965 0.0242882 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 3.99982 0.000234949 0.0285866 4.00052 0.031959 0.00281952 +EDGE_SE3:QUAT 500 670 2.28755 0.254343 0.0129097 -0.00308067 -0.00562546 0.99961 0.0271907 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 3.99997 6.78285e-05 0.012336 4 0.0231306 0.00312926 +EDGE_SE3:QUAT 501 670 -1.84523 0.344127 0.0195841 -0.00277046 -0.00621192 0.999622 0.0266312 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 3.99998 6.47636e-05 0.0110933 3.99995 0.0253939 0.00302899 +EDGE_SE3:QUAT 502 670 -6.36428 0.431392 -0.0993173 -0.0131594 -0.00710255 0.999558 0.0257091 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 3.99935 0.000467177 0.0526903 4.00245 0.0310963 0.0035801 +EDGE_SE3:QUAT 671 672 4.07386 -0.0949113 0.0010512 0.00186512 0.00366957 0.000774351 0.999991 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 4.0002 2.76101e-05 0.0293405 3.99995 1.19615e-05 4.00021 +EDGE_SE3:QUAT 498 671 6.89939 0.446383 0.0347847 -0.00233901 -0.00798483 0.999795 0.0184421 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 3.99998 6.73227e-05 0.00936124 3.99982 0.0322569 0.00164258 +EDGE_SE3:QUAT 499 671 2.34733 0.487044 0.0102817 -0.00364641 -0.0068503 0.999696 0.0234193 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 3.99996 9.77414e-05 0.0145979 4 0.0280476 0.00244393 +EDGE_SE3:QUAT 500 671 -1.79169 0.565052 0.000341047 0.000385619 -0.00489376 0.999629 0.0268053 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 4 -1.24849e-05 -0.00154497 3.99991 0.019457 0.00296941 +EDGE_SE3:QUAT 501 671 -5.98645 0.658862 0.018958 0.000499872 -0.00537097 0.999646 0.0260614 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 4 -1.64619e-05 -0.0020024 3.99989 0.021343 0.00283176 +EDGE_SE3:QUAT 672 673 4.02767 -0.0844143 0.0304322 -0.000821515 -0.000251242 0.000838039 0.999999 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 4 8.22331e-07 -0.00200167 4 -8.38822e-07 4 +EDGE_SE3:QUAT 497 672 6.85313 0.708572 0.0301277 -0.00562194 -0.00558692 0.999943 0.00720963 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 3.99988 0.000129248 0.0224903 4.00037 0.0226725 0.000462876 +EDGE_SE3:QUAT 498 672 2.81107 0.678027 0.0180535 -0.00589259 -0.00607905 0.999808 0.017649 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 3.99987 0.000152116 0.0235822 4.00038 0.0251331 0.00154297 +EDGE_SE3:QUAT 499 672 -1.6999 0.762086 -0.0204382 -0.0071496 -0.00511837 0.999698 0.0229313 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 3.99981 0.000168552 0.0286212 4.00067 0.0217631 0.00242672 +EDGE_SE3:QUAT 500 672 -5.87072 0.889328 0.0105683 -0.00328275 -0.00325545 0.999655 0.0258425 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 3.99996 4.67871e-05 0.0131439 4.00012 0.013679 0.00276136 +EDGE_SE3:QUAT 673 674 4.16537 -0.0711542 0.0520549 -0.0013505 -0.00697266 0.00418274 0.999966 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 4.00077 4.25016e-05 -0.0557213 3.99981 -0.000118118 4.00071 +EDGE_SE3:QUAT 496 673 7.09645 1.02652 0.0194952 0.00848344 0.00289028 -0.99982 0.0167183 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 3.99971 6.9983e-05 0.0339471 4.00114 0.0104227 0.00143337 +EDGE_SE3:QUAT 497 673 2.82232 0.861121 0.0203289 -0.00510858 -0.00649452 0.999948 0.006058 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 3.9999 0.000134419 0.0204365 4.00024 0.0262264 0.00042316 +EDGE_SE3:QUAT 498 673 -1.13004 0.915666 0.00245153 -0.00561606 -0.00696276 0.999818 0.0168611 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 3.99988 0.000161977 0.022475 4.00028 0.0285926 0.00146791 +EDGE_SE3:QUAT 499 673 -5.61511 1.05533 -0.0514954 -0.00733189 -0.00598164 0.999702 0.0225192 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 3.9998 0.000196714 0.0293505 4.00067 0.0252231 0.00240302 +EDGE_SE3:QUAT 674 675 4.38809 -0.125355 0.0327853 -0.00447557 0.00110472 -0.0225009 0.999736 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 3.99993 -1.66773e-05 0.00762278 4 -8.13071e-05 3.99799 +EDGE_SE3:QUAT 495 674 6.99661 1.42199 -0.0103441 0.00184307 0.00100383 -0.99745 0.0713372 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 3.99998 1.60156e-06 0.00743124 4.00006 0.00291789 0.020372 +EDGE_SE3:QUAT 496 674 2.93819 0.948156 0.00511478 0.00165117 0.00437105 -0.999769 0.0209571 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 3.99999 3.04937e-05 0.00660954 3.99997 0.0171884 0.00184162 +EDGE_SE3:QUAT 497 674 -1.31754 0.990427 0.0349709 0.00166672 -0.00825607 0.999963 0.00188014 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 3.99999 -5.59337e-05 -0.0066676 3.99977 0.0329983 0.000297491 +EDGE_SE3:QUAT 498 674 -5.22183 1.14622 0.0109076 0.00078759 -0.00882443 0.999872 0.0133034 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 4 -3.58002e-05 -0.0031518 3.9997 0.0351971 0.00102019 +EDGE_SE3:QUAT 675 676 4.29699 -0.345659 -0.0229563 -0.000507315 0.00975752 -0.075626 0.997088 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 4.00148 -0.000188947 0.0769575 3.99964 -0.00289973 3.9786 +EDGE_SE3:QUAT 494 675 6.39892 1.86641 -0.021782 -0.00612383 0.00207647 -0.987487 0.157566 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 3.99991 -0.000161769 -0.0253263 4.00045 0.0153253 0.0995318 +EDGE_SE3:QUAT 495 675 2.6224 0.920075 0.00130829 0.00276837 0.0055944 -0.998783 0.0489274 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 3.99996 6.27464e-05 0.0111188 4.00004 0.0211636 0.00971881 +EDGE_SE3:QUAT 496 675 -1.45212 0.900621 0.0140832 -0.00294544 -0.00877152 0.999955 0.00192554 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 3.99997 0.00010255 0.0117832 3.99983 0.0351314 0.000358105 +EDGE_SE3:QUAT 497 675 -5.70107 1.1549 0.0861023 0.000607957 -0.0127904 0.999615 0.0245986 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 3.99999 -6.26792e-05 -0.00243655 3.99936 0.0509608 0.0030716 +EDGE_SE3:QUAT 676 677 4.2113 -0.728954 0.00995351 0.000211988 -0.00101133 -0.175632 0.984455 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 4.00001 -4.46254e-06 -0.00728159 4 0.000615167 3.87663 +EDGE_SE3:QUAT 493 676 5.90674 1.9102 0.0428296 0.00476485 0.00635357 -0.974292 0.225148 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 3.99983 -2.70695e-05 0.0210318 4.00051 0.0141062 0.20294 +EDGE_SE3:QUAT 494 676 2.22912 0.847722 0.0115288 0.00356627 0.00357959 -0.996589 0.0823694 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 3.99993 2.89228e-05 0.0144255 4.0002 0.0117429 0.0272261 +EDGE_SE3:QUAT 495 676 -1.66317 0.830781 -0.042809 -0.0123125 -0.00686 0.999544 0.0267183 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 3.99943 0.000421754 0.0493031 4.00213 0.0300448 0.0036893 +EDGE_SE3:QUAT 496 676 -5.71492 1.26686 -0.0169737 -0.012259 -0.00966169 0.99689 0.0772484 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 3.99956 0.000649004 0.0494469 4.00157 0.0456325 0.0250066 +EDGE_SE3:QUAT 677 678 3.97195 -0.942201 0.00103608 0.00201935 -0.00213136 -0.219871 0.975524 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 4.00001 -2.07769e-05 -0.0106732 4 0.000931532 3.80665 +EDGE_SE3:QUAT 492 677 5.61379 1.61906 0.0422602 0.00619767 0.00912016 -0.982109 0.18799 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 3.9997 4.6239e-05 0.0265529 4.00079 0.0243131 0.141703 +EDGE_SE3:QUAT 493 677 1.79824 0.721436 0.00980351 0.00242615 0.0063557 -0.998699 0.0505457 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 3.99996 6.82073e-05 0.0097488 3.99997 0.0242826 0.0103911 +EDGE_SE3:QUAT 494 677 -2.03507 0.87582 -0.0084619 -0.0018335 -0.00314983 0.995573 0.093917 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 3.99999 2.0165e-05 0.00740962 3.99999 0.0136879 0.0353427 +EDGE_SE3:QUAT 495 677 -5.81747 1.78574 -0.123677 -0.0100557 -0.00817063 0.979261 0.202188 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 3.9999 0.000488515 0.0420826 4.0005 0.0450035 0.164497 +EDGE_SE3:QUAT 678 679 3.99543 -0.898379 -0.00538457 0.0008601 0.00425954 -0.197569 0.980279 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 4.00029 -7.31235e-05 0.034089 3.99994 -0.00336721 3.84416 +EDGE_SE3:QUAT 491 678 5.63387 1.87211 0.0242063 0.00391567 0.00734421 -0.994613 0.10332 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 3.99989 0.000100796 0.0159768 4.00018 0.0253963 0.0429282 +EDGE_SE3:QUAT 492 678 1.56584 1.04233 -0.00580889 -0.00230107 -0.00797206 0.999434 0.032588 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 3.99999 5.97693e-05 0.00921751 3.9998 0.0324025 0.00453194 +EDGE_SE3:QUAT 493 678 -2.22828 1.24969 -0.00199273 0.00111786 -0.0045988 0.985329 0.170599 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 3.99997 -3.15516e-05 -0.00484514 3.99999 0.0155894 0.116485 +EDGE_SE3:QUAT 494 678 -5.75437 2.53845 -0.0154284 0.00129746 -0.00203534 0.95053 0.310623 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 3.99999 8.55599e-06 -0.00637304 4.00005 0.00333223 0.385961 +EDGE_SE3:QUAT 679 680 4.07786 -0.654067 0.000355072 -0.00129337 0.00510296 -0.15204 0.98836 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 4.00034 -0.000106073 0.0370955 3.99993 -0.00272514 3.90788 +EDGE_SE3:QUAT 490 679 5.18299 3.0088 -0.0304992 -0.00204323 0.00652292 -0.997493 0.0704308 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 4 -3.26506e-05 -0.00821569 3.99986 0.0269139 0.0200409 +EDGE_SE3:QUAT 491 679 1.5433 1.9222 -0.00289245 -0.00681353 -0.00706117 0.995382 0.0954891 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 3.99989 0.000232777 0.027578 4.00032 0.0327659 0.0369347 +EDGE_SE3:QUAT 492 679 -2.33044 2.16115 -0.0125589 -0.0049254 -0.00710104 0.973239 0.229634 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 4 7.79106e-05 0.0205111 3.99986 0.0333007 0.211326 +EDGE_SE3:QUAT 493 679 -5.66361 3.4221 0.019104 -0.00203113 -0.00282785 0.93232 0.361616 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 4 -1.53509e-06 0.00848601 3.99996 0.0128953 0.523132 +EDGE_SE3:QUAT 680 681 4.10772 -0.881162 0.00782244 0.00231413 0.00170149 -0.20348 0.979075 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 4.00006 -2.07755e-07 0.0182702 3.99998 -0.00202052 3.83447 +EDGE_SE3:QUAT 489 680 3.59696 4.08999 -0.00923039 0.000296002 0.00579805 -0.987528 0.157339 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 3.99998 4.15466e-05 0.00140804 3.99991 0.0214059 0.0991406 +EDGE_SE3:QUAT 490 680 1.08464 3.08204 -0.0100502 -0.00181829 -0.00757833 0.996616 0.0818281 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 4 1.91949e-05 0.00731301 3.99978 0.0309886 0.0270384 +EDGE_SE3:QUAT 491 680 -2.31201 3.33852 -0.0480172 -0.0106544 -0.00887437 0.969193 0.245912 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 3.99996 0.000517659 0.045262 4.00033 0.0499506 0.243073 +EDGE_SE3:QUAT 492 680 -5.67695 4.55895 -0.0305929 -0.00888752 -0.00795064 0.926853 0.375236 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 4.00006 0.000194204 0.0388778 3.99981 0.0441001 0.564152 +EDGE_SE3:QUAT 681 682 4.21349 -0.96053 0.000555213 -0.00494897 -0.00415649 -0.209856 0.977711 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 4.00037 -2.00807e-05 -0.0431803 3.99988 0.00488488 3.82431 +EDGE_SE3:QUAT 487 681 4.309 5.00043 0.0212762 0.00448534 0.00445867 -0.917256 0.398248 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 3.99993 -0.000208655 0.0239301 4.00047 -0.000854944 0.634575 +EDGE_SE3:QUAT 488 681 1.88345 3.81306 -0.0239378 0.00512055 0.00111659 -0.980815 0.194869 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 3.99991 -0.000103075 0.0216813 4.00042 -0.0036324 0.152021 +EDGE_SE3:QUAT 489 681 -0.542538 3.6796 0.000411616 -0.000928221 -0.00348016 0.998934 0.0460271 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 4 9.01503e-06 0.00372201 3.99996 0.014188 0.00852786 +EDGE_SE3:QUAT 490 681 -2.8117 4.61244 -0.000355845 -0.0017321 -0.00492625 0.959079 0.283091 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 3.99999 -2.4481e-05 0.0068159 3.9999 0.0194778 0.320678 +EDGE_SE3:QUAT 682 683 4.14518 -0.73984 -0.00516029 -0.00265425 0.000294523 -0.149117 0.988816 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 3.99997 5.23411e-06 -0.00240108 4 0.000299016 3.91106 +EDGE_SE3:QUAT 486 682 4.2694 2.84538 0.0213542 -0.000198471 0.0105893 -0.954944 0.296599 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 3.99988 0.000166842 0.00131997 3.99981 0.0337636 0.352208 +EDGE_SE3:QUAT 487 682 0.731011 2.5689 -0.0227217 -0.00261902 0.00810716 -0.980368 0.196994 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 4 2.1405e-05 -0.0105723 3.99973 0.0332916 0.155543 +EDGE_SE3:QUAT 488 682 -2.3731 3.12067 -0.0681057 0.000178699 -0.00624979 0.999865 0.0151822 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 4 -9.17798e-06 -0.000715288 3.99985 0.0249626 0.00107794 +EDGE_SE3:QUAT 489 682 -4.6354 5.02186 0.00241252 0.00347631 -0.00885176 0.966824 0.255266 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 3.99981 -5.22048e-05 -0.0163739 4.00033 0.0231393 0.260867 +EDGE_SE3:QUAT 603 682 3.18274 3.42158 0.0661101 0.00269279 0.0141317 -0.86912 0.494391 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 3.99961 -0.000332453 0.0275943 4.00096 0.017069 0.978157 +EDGE_SE3:QUAT 604 682 -2.32335 3.61182 0.0458559 0.0004262 0.0135421 -0.776323 0.63019 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 3.99979 -0.000488839 0.029485 4.00074 0.00735003 1.58908 +EDGE_SE3:QUAT 683 684 3.96744 -0.519141 0.00751576 0.00530465 0.0187492 -0.104039 0.994382 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 4.00583 -0.000507964 0.154339 3.99855 -0.00808485 3.96265 +EDGE_SE3:QUAT 485 683 4.57197 1.10069 -0.0138852 -0.0047752 0.0122811 -0.98423 0.1764 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 4 -2.90061e-05 -0.0194343 3.99941 0.0518699 0.125257 +EDGE_SE3:QUAT 486 683 0.446663 1.10845 0.00231007 -0.00232327 0.0131321 -0.988453 0.150939 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 3.99999 8.98113e-05 -0.0092435 3.9993 0.0522971 0.0918523 +EDGE_SE3:QUAT 487 683 -3.36727 1.63545 -0.0106184 -0.00389572 0.0104438 -0.998751 0.0487031 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 3.99997 -0.000132184 -0.0156309 3.99972 0.0430419 0.0100134 +EDGE_SE3:QUAT 602 683 4.68602 -0.366027 -0.0156115 -0.00451468 0.0127349 -0.97058 0.240398 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 3.99999 9.78591e-05 -0.01814 3.99931 0.0519058 0.231963 +EDGE_SE3:QUAT 603 683 0.436259 0.243312 -0.0016759 -0.000406165 0.0168569 -0.933101 0.35922 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 3.99958 0.000389624 0.00434645 3.9998 0.047706 0.516876 +EDGE_SE3:QUAT 604 683 -3.88575 -0.289669 -0.022063 -0.00288984 0.015702 -0.861698 0.50717 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 3.99952 0.000290958 0.00130201 3.99994 0.034992 1.02946 +EDGE_SE3:QUAT 684 685 4.22276 -0.431469 0.0221884 0.00474609 -0.00115431 -0.0662586 0.997791 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 3.99992 -1.07778e-05 -0.00541093 4 0.000136982 3.98245 +EDGE_SE3:QUAT 484 684 4.82177 0.162973 0.0532573 0.00929085 0.00994775 -0.996715 0.0798311 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 3.99955 0.000230625 0.0375574 4.00133 0.0332794 0.0261262 +EDGE_SE3:QUAT 485 684 0.686944 0.234173 0.0208557 0.0132675 0.00973594 -0.997169 0.0733723 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 3.99917 0.000220946 0.0535234 4.00286 0.0307047 0.0224916 +EDGE_SE3:QUAT 486 684 -3.46488 0.419166 0.030074 0.0155664 0.0101118 -0.998707 0.0473156 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 3.99893 0.000373326 0.0624782 4.00381 0.0343873 0.0102296 +EDGE_SE3:QUAT 601 684 5.05094 -2.12793 0.0335745 0.00848894 0.0125006 -0.996455 0.0827587 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 3.99957 0.000337681 0.034362 4.00095 0.0435853 0.0281722 +EDGE_SE3:QUAT 602 684 0.957427 -1.75464 0.0173245 0.0135469 0.0111893 -0.990312 0.137743 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 3.99903 -3.23395e-05 0.0559319 4.00331 0.0280323 0.076895 +EDGE_SE3:QUAT 603 684 -2.83266 -2.01086 -0.0213511 0.0172402 0.0182647 -0.965208 0.260276 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 3.99818 -0.0011511 0.0781377 4.00664 0.0275537 0.272862 +EDGE_SE3:QUAT 604 684 -6.24935 -3.50185 -0.0503939 0.0144636 0.0197 -0.909598 0.41477 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 3.99888 -0.00255195 0.0819644 4.00602 0.00725546 0.69024 +EDGE_SE3:QUAT 685 686 4.512 -0.221446 0.00369304 0.00473773 -0.00962538 -0.0177283 0.999785 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 4.00135 -0.000217946 -0.0759802 3.99964 0.00068137 4.00019 +EDGE_SE3:QUAT 483 685 4.83082 -0.15542 0.0511301 0.00976884 0.0100004 -0.999788 0.015112 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 3.9996 0.000367286 0.0390922 4.0012 0.038817 0.00167227 +EDGE_SE3:QUAT 484 685 0.600716 -0.0939973 0.00215178 0.00787711 0.00567054 -0.999864 0.0133096 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 3.99974 0.000161915 0.0315172 4.00089 0.0218408 0.00107621 +EDGE_SE3:QUAT 485 685 -3.50776 0.0552524 -0.0607316 0.011984 0.00583402 -0.999889 0.0065849 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 3.99942 0.000259099 0.0479378 4.00218 0.0227198 0.000877008 +EDGE_SE3:QUAT 600 685 4.82439 -2.50168 0.029402 0.00664652 0.00821699 -0.999931 0.00514075 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 3.99982 0.0002158 0.0265891 4.00045 0.0325994 0.000548101 +EDGE_SE3:QUAT 601 685 0.826243 -2.40338 -0.0131273 0.0071656 0.00843893 -0.999808 0.0161654 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 3.99978 0.000230306 0.0286759 4.00058 0.0328157 0.00152015 +EDGE_SE3:QUAT 602 685 -3.19283 -2.49128 -0.0792595 0.0122974 0.00724897 -0.997356 0.0712549 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 3.99932 0.000101442 0.0495799 4.00248 0.0216716 0.0210451 +EDGE_SE3:QUAT 686 687 4.00303 -0.108267 -0.0147225 -0.000988761 0.00135917 -0.00303892 0.999994 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 4.00003 -5.48588e-06 0.0108372 3.99999 -1.64923e-05 3.99999 +EDGE_SE3:QUAT 482 686 4.65093 -0.183229 -0.0204719 0.00447072 -0.00692186 0.999948 0.0059622 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 3.99992 -0.000123161 -0.0178849 4.00014 0.0274742 0.000410864 +EDGE_SE3:QUAT 483 686 0.348015 -0.0788542 -0.0302298 -4.23607e-05 -0.00550552 0.999981 0.00280613 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 4 2.52401e-07 0.000169448 3.99988 0.0220223 0.000152755 +EDGE_SE3:QUAT 484 686 -3.87132 0.0299828 -0.0693496 0.00167352 -0.00132572 0.999987 0.00456851 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 3.99999 -8.629e-06 -0.00669428 4.00004 0.00524153 0.000101557 +EDGE_SE3:QUAT 599 686 4.61469 -2.40405 -0.000873111 0.00187713 -0.00239578 0.999915 0.0127005 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 3.99998 -1.74521e-05 -0.00751041 4.00004 0.00938874 0.00068135 +EDGE_SE3:QUAT 600 686 0.330993 -2.3419 -0.0239759 0.00306679 -0.00360055 0.99991 0.0125169 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 3.99996 -4.25354e-05 -0.0122703 4.00011 0.0140902 0.000713981 +EDGE_SE3:QUAT 601 686 -3.66521 -2.31209 -0.0728812 0.00241447 -0.00386899 0.999989 0.00133567 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 3.99998 -3.73403e-05 -0.00965809 4.00003 0.0154505 9.01342e-05 +EDGE_SE3:QUAT 687 688 4.02078 -0.100307 0.0321037 -0.000533433 0.00689093 0.0005015 0.999976 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 4.00076 -1.41426e-05 0.0551398 3.99981 1.32253e-05 4.00076 +EDGE_SE3:QUAT 481 687 4.96328 -0.168721 -0.0117486 -1.15009e-05 -0.00635956 0.999822 0.0177907 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 4 -5.45678e-06 4.57052e-05 3.99984 0.0254192 0.00142763 +EDGE_SE3:QUAT 482 687 0.662782 -0.0395848 0.000594611 0.00326097 -0.00768905 0.999923 0.00922139 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 3.99995 -0.00010217 -0.0130467 3.99994 0.0305101 0.000615429 +EDGE_SE3:QUAT 483 687 -3.6092 0.0614806 -0.0460024 -0.0013975 -0.00626532 0.999961 0.00599764 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 3.99999 3.33992e-05 0.00559062 3.99987 0.0251258 0.000309538 +EDGE_SE3:QUAT 598 687 5.09309 -2.30877 -0.0035242 -0.00030236 -0.00285454 0.999864 0.0162498 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 4 2.41539e-06 0.00120983 3.99997 0.0114499 0.00108938 +EDGE_SE3:QUAT 599 687 0.618349 -2.2104 -0.00451261 0.000420732 -0.00356545 0.999867 0.0159272 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 4 -7.52623e-06 -0.00168372 3.99995 0.0141991 0.00106584 +EDGE_SE3:QUAT 600 687 -3.62542 -2.13167 -0.0112414 0.00150092 -0.00461311 0.999858 0.0161377 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 3.99999 -2.94522e-05 -0.00600637 3.99996 0.0182468 0.00113398 +EDGE_SE3:QUAT 688 689 4.5001 -0.0988997 0.0506178 -0.000747905 -0.00173275 0.00336516 0.999993 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 4.00005 5.41043e-06 -0.0138317 3.99999 -2.33103e-05 4 +EDGE_SE3:QUAT 480 688 4.99715 -0.0345627 0.0648716 -0.0127757 -0.00509321 0.999659 0.0222143 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 3.99937 0.000341183 0.051139 4.00244 0.0226371 0.00275616 +EDGE_SE3:QUAT 481 688 0.94846 0.0709985 0.0232288 -0.00685526 -0.00669902 0.999802 0.0174137 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 3.99983 0.000196288 0.0274347 4.00053 0.0277367 0.00159352 +EDGE_SE3:QUAT 482 688 -3.3631 0.132919 0.0535973 -0.00379183 -0.0082976 0.999917 0.00904986 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 3.99995 0.000123833 0.0151706 3.99994 0.0334595 0.000665045 +EDGE_SE3:QUAT 597 688 5.16508 -2.18379 0.0691601 -0.012016 -0.00144668 0.999751 0.0187738 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 3.99943 0.000134023 0.0480862 4.00228 0.00759202 0.00200258 +EDGE_SE3:QUAT 598 688 1.07657 -2.07626 0.0248117 -0.0072154 -0.00329379 0.999845 0.0156908 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 3.9998 0.000112996 0.0288721 4.00077 0.0140765 0.0012428 +EDGE_SE3:QUAT 599 688 -3.39445 -1.97321 0.0393558 -0.00649198 -0.00391759 0.999846 0.0158394 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 3.99984 0.000115452 0.0259778 4.00059 0.0164866 0.00124025 +EDGE_SE3:QUAT 689 690 4.49662 -0.0772948 0.0227566 -0.00268045 -0.00467466 0.00364233 0.999979 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 4.00032 5.18257e-05 -0.0372818 3.99991 -6.92391e-05 4.00029 +EDGE_SE3:QUAT 479 689 4.63853 0.212691 0.0549651 -0.0116025 -0.00505404 0.999828 0.0135747 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 3.99948 0.000275383 0.0464219 4.00201 0.0214822 0.00139131 +EDGE_SE3:QUAT 480 689 0.506682 0.251751 0.0116903 -0.0111573 -0.00571896 0.999743 0.0188682 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 3.99952 0.000305626 0.0446531 4.0018 0.0245553 0.00207343 +EDGE_SE3:QUAT 481 689 -3.51192 0.32012 0.0258448 -0.00540917 -0.00722379 0.999855 0.0144165 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 3.99989 0.00015993 0.0216448 4.00023 0.0295076 0.00116619 +EDGE_SE3:QUAT 596 689 4.83768 -2.02004 0.0646806 -0.0116211 -0.00255202 0.999814 0.0151481 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 3.99947 0.000166733 0.0464979 4.00211 0.011619 0.00149229 +EDGE_SE3:QUAT 597 689 0.668212 -1.91594 0.0158862 -0.0105261 -0.00223335 0.999827 0.0151548 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 3.99956 0.000133531 0.0421173 4.00174 0.0102105 0.00138833 +EDGE_SE3:QUAT 598 689 -3.40925 -1.84219 0.0257855 -0.00566115 -0.00367552 0.999901 0.0123797 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 3.99988 9.12439e-05 0.0226499 4.00045 0.0152596 0.000799517 +EDGE_SE3:QUAT 690 691 4.44024 -0.0873453 -0.0317372 0.00116957 0.00294094 0.00395153 0.999987 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 4.00013 1.45337e-05 0.0234722 3.99997 4.65847e-05 4.00008 +EDGE_SE3:QUAT 478 690 4.60464 0.381888 -0.0180112 -0.00546397 0.00639427 -0.999961 0.00262132 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 3.99988 -0.000140804 -0.0218571 4.00031 0.0256949 0.000311958 +EDGE_SE3:QUAT 479 690 0.162244 0.408308 -0.0198897 -0.00698649 -0.00776165 0.999896 0.00993151 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 3.99981 0.00022353 0.0279521 4.00051 0.0316013 0.000839526 +EDGE_SE3:QUAT 480 690 -3.96534 0.510114 -0.063662 -0.00666754 -0.00862906 0.999822 0.0153778 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 3.99984 0.000236617 0.0266821 4.00037 0.0353228 0.00143587 +EDGE_SE3:QUAT 595 690 4.56978 -1.86585 -0.0307098 0.00640548 -0.00501331 0.999943 0.00689305 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 3.99983 -0.000123019 -0.0256241 4.00057 0.0197019 0.000451244 +EDGE_SE3:QUAT 596 690 0.36792 -1.79852 -0.0110079 -0.00692449 -0.00541484 0.999896 0.0113929 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 3.99982 0.000160196 0.027704 4.00063 0.0222888 0.00083529 +EDGE_SE3:QUAT 597 690 -3.79832 -1.6991 -0.0493455 -0.00598333 -0.00493803 0.999901 0.011771 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 3.99986 0.00012579 0.0239388 4.00046 0.0203123 0.000800661 +EDGE_SE3:QUAT 691 692 4.45115 -0.0951842 -0.0190907 0.00249503 0.00491199 0.00444881 0.999975 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 4.00036 5.13773e-05 0.0391645 3.9999 8.8477e-05 4.0003 +EDGE_SE3:QUAT 477 691 4.52634 0.405171 -0.0252964 -0.00758626 0.00680007 -0.999762 0.0193124 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 3.99979 -0.000224782 -0.0303633 4.00069 0.0283545 0.00192345 +EDGE_SE3:QUAT 478 691 0.179042 0.446752 -0.00042893 -0.0025422 0.00529805 -0.999961 0.00656284 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 3.99998 -5.33837e-05 -0.0101698 3.99999 0.0213238 0.000311821 +EDGE_SE3:QUAT 479 691 -4.2622 0.593451 -0.114602 -0.0102378 -0.00659604 0.999908 0.00591295 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 3.99959 0.000283153 0.040954 4.00148 0.0268809 0.000739765 +EDGE_SE3:QUAT 594 691 4.4365 -1.79538 -0.0365759 -0.00743445 0.00716552 -0.999946 0.00136297 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 3.99978 -0.000214471 -0.0297394 4.00068 0.028751 0.000435148 +EDGE_SE3:QUAT 595 691 0.135467 -1.71793 -0.00579804 0.0035812 -0.00402596 0.999981 0.00285571 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 3.99995 -5.71635e-05 -0.0143252 4.00014 0.0160227 0.000148103 +EDGE_SE3:QUAT 596 691 -4.05639 -1.60557 -0.109029 -0.00983389 -0.00433799 0.999914 0.00745258 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 3.99962 0.000186888 0.0393382 4.00146 0.0179452 0.000689563 +EDGE_SE3:QUAT 692 693 4.40588 -0.0877617 0.0280165 0.00190556 0.00535994 0.00479763 0.999972 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 4.00044 4.40246e-05 0.0427724 3.99989 0.000103853 4.00037 +EDGE_SE3:QUAT 476 692 4.57673 0.283542 0.0151758 0.00184295 0.00686902 -0.999297 0.0367963 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 3.99998 6.03535e-05 0.00739004 3.99989 0.0268414 0.00560992 +EDGE_SE3:QUAT 477 692 0.123505 0.331722 0.0238737 -0.00287031 0.00434231 -0.999705 0.0237066 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 3.99997 -5.05259e-05 -0.0114908 4.00004 0.0178895 0.00236109 +EDGE_SE3:QUAT 478 692 -4.20771 0.490556 0.00316307 0.00248113 0.00265626 -0.999931 0.0111376 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 3.99997 2.52949e-05 0.00992646 4.00007 0.010401 0.000547871 +EDGE_SE3:QUAT 593 692 4.29627 -1.80257 0.0220081 0.00337006 0.00545257 -0.999929 0.0100645 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 3.99995 7.30407e-05 0.0134828 4.00007 0.0215345 0.00056657 +EDGE_SE3:QUAT 594 692 0.0345557 -1.71866 0.0222385 -0.00253179 0.00462937 -0.999969 0.00587458 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 3.99998 -4.67552e-05 -0.010128 4.00001 0.0186353 0.000250508 +EDGE_SE3:QUAT 595 692 -4.3091 -1.59922 0.0114058 0.00134805 0.00163643 -0.999996 0.00165853 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 3.99999 8.78699e-06 0.00539226 4.00002 0.00652786 2.89252e-05 +EDGE_SE3:QUAT 693 694 4.41553 -0.0946027 0.0434271 0.000105842 -0.00620777 0.00416559 0.999972 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 4.00062 1.224e-06 -0.0496729 3.99985 -0.000103405 4.00055 +EDGE_SE3:QUAT 475 693 4.681 0.00365218 0.0690373 0.0131226 0.00530618 -0.998525 0.0524188 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 3.99927 6.2943e-05 0.0527074 4.0028 0.0156051 0.0117486 +EDGE_SE3:QUAT 476 693 0.22126 0.0556514 0.0289619 0.0074234 0.005206 -0.99911 0.0412053 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 3.99976 0.000105041 0.0297717 4.00085 0.0182982 0.00709736 +EDGE_SE3:QUAT 477 693 -4.31831 0.210671 0.0777798 0.00279452 0.00256381 -0.999577 0.0288442 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 3.99997 2.43934e-05 0.0111925 4.00011 0.00959001 0.00338232 +EDGE_SE3:QUAT 592 693 4.37497 -1.88321 0.0474839 0.0119853 0.00760737 -0.999722 0.0188228 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 3.9994 0.000307174 0.0479666 4.00215 0.0286205 0.00219739 +EDGE_SE3:QUAT 593 693 -0.126407 -1.80538 0.0168611 0.0088035 0.00366085 -0.999849 0.0145514 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 3.99968 0.000103109 0.0352244 4.00121 0.0136167 0.0012036 +EDGE_SE3:QUAT 594 693 -4.37859 -1.6802 0.0687371 0.00301621 0.00279566 -0.99994 0.0101645 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 3.99996 3.20936e-05 0.0120668 4.00012 0.010935 0.000479568 +EDGE_SE3:QUAT 694 695 4.20973 -0.0754135 0.0440337 -0.00170969 -0.00463194 0.00617285 0.999969 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 4.00033 3.4701e-05 -0.0369293 3.99991 -0.000114748 4.00019 +EDGE_SE3:QUAT 474 694 4.84903 -0.471934 0.0562436 0.0126939 0.0069236 -0.998019 0.0612369 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 3.99929 0.000119093 0.0510691 4.00262 0.021258 0.015768 +EDGE_SE3:QUAT 475 694 0.31242 -0.366831 0.000602182 0.00714939 0.0046998 -0.998326 0.0571947 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 3.99977 6.7693e-05 0.028744 4.00082 0.0153894 0.0133517 +EDGE_SE3:QUAT 476 694 -4.1752 -0.217865 0.0125146 0.00125735 0.00470897 -0.998925 0.0461063 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 3.99999 2.92376e-05 0.00504926 3.99995 0.0182731 0.00859321 +EDGE_SE3:QUAT 591 694 4.35126 -2.04295 0.0294768 0.0124316 0.00758254 -0.999553 0.0260922 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 3.99935 0.00028901 0.0497769 4.00236 0.0277085 0.00353511 +EDGE_SE3:QUAT 592 694 -0.0333339 -1.96184 -0.0110112 0.0059056 0.00741582 -0.999684 0.0232774 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 3.99984 0.000164487 0.0236435 4.00039 0.028529 0.00251075 +EDGE_SE3:QUAT 593 694 -4.46864 -1.83612 -0.0103016 0.00292193 0.00320622 -0.999811 0.0189744 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 3.99996 3.49341e-05 0.0116943 4.0001 0.0123705 0.00151258 +EDGE_SE3:QUAT 695 696 4.50543 -0.00823652 -0.00223271 -0.000323942 -0.00574875 0.0238833 0.999698 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 4.00053 2.62908e-05 -0.0458631 3.99987 -0.0005476 3.99824 +EDGE_SE3:QUAT 473 695 5.11347 -1.02794 0.0184586 0.0029291 0.00521304 -0.997943 0.0638281 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 3.99995 5.7698e-05 0.0117989 4.00008 0.0191514 0.0164232 +EDGE_SE3:QUAT 474 695 0.649666 -0.918897 -0.0125546 0.00787863 0.00837236 -0.997613 0.06809 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 3.99969 0.00018141 0.0317544 4.00092 0.0288404 0.0190074 +EDGE_SE3:QUAT 475 695 -3.82214 -0.765618 -0.0225889 0.00241823 0.00602089 -0.997945 0.0637431 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 3.99996 6.37416e-05 0.00974459 4 0.0226118 0.016405 +EDGE_SE3:QUAT 590 695 4.07132 -2.26734 -0.00868046 0.000243904 0.00615191 -0.999436 0.0330025 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 4 1.57929e-05 0.000979091 3.99985 0.0244759 0.00450682 +EDGE_SE3:QUAT 591 695 0.104479 -2.19134 -0.0326287 0.00774449 0.00902326 -0.999399 0.0325737 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 3.99972 0.000249315 0.0310316 4.00074 0.0339921 0.00477432 +EDGE_SE3:QUAT 592 695 -4.2403 -2.08145 -0.0178845 0.00127404 0.00881676 -0.999519 0.0297142 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 3.99999 6.15417e-05 0.00510548 3.99973 0.0348858 0.00384282 +EDGE_SE3:QUAT 696 697 4.21639 0.0402046 -0.00362035 -0.002826 0.00307393 0.042484 0.999088 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 4.00014 -2.68401e-05 0.0259646 3.99996 0.000560627 3.99295 +EDGE_SE3:QUAT 472 696 4.84396 -1.80501 -0.027182 -0.00226783 0.00372317 -0.997492 0.070644 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 3.99999 -3.20727e-05 -0.00912867 4 0.0159827 0.0200474 +EDGE_SE3:QUAT 473 696 0.641803 -1.60024 -0.0146241 -0.00256971 0.00497886 -0.996123 0.0877958 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 3.99999 -4.18222e-05 -0.0103704 3.99996 0.0213238 0.0309739 +EDGE_SE3:QUAT 474 696 -3.78086 -1.50173 -0.0836723 0.00231732 0.00785062 -0.99578 0.0914085 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 3.99995 9.49078e-05 0.00943348 3.99993 0.0290688 0.0336578 +EDGE_SE3:QUAT 589 696 3.59194 -2.73533 -0.0180543 0.000887493 0.00306763 -0.999221 0.039339 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 3.99999 1.28202e-05 0.00355975 3.99998 0.0119442 0.00622913 +EDGE_SE3:QUAT 590 696 -0.421744 -2.56123 -0.011721 -0.00546243 0.00610668 -0.998337 0.0570657 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 3.99991 -0.00015038 -0.0219485 4.00024 0.0267169 0.0133257 +EDGE_SE3:QUAT 591 696 -4.37889 -2.47634 -0.108863 0.00256631 0.00890228 -0.998336 0.0569199 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 3.99995 0.000113282 0.0103293 3.99986 0.0341568 0.013279 +EDGE_SE3:QUAT 697 698 4.13372 0.178182 -0.00358606 0.00383666 0.0134963 0.0766332 0.996961 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 4.00262 0.00051111 0.103562 3.99937 0.00393389 3.97919 +EDGE_SE3:QUAT 471 697 4.61769 -3.02244 -0.0795792 -0.00892398 0.00655174 -0.999298 0.0357918 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 3.99972 -0.000285342 -0.035764 4.001 0.0286864 0.00565028 +EDGE_SE3:QUAT 472 697 0.682188 -2.43736 -0.0102229 0.000981571 0.00688779 -0.993533 0.113331 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 3.99998 5.9538e-05 0.00408183 3.99988 0.0257919 0.051549 +EDGE_SE3:QUAT 473 697 -3.48977 -2.37511 -0.00698586 0.000477922 0.00847482 -0.991466 0.13009 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 3.99997 8.02907e-05 0.00210952 3.99978 0.031984 0.0679554 +EDGE_SE3:QUAT 588 697 3.31782 -3.4962 -0.0477231 0.000453409 -0.00752434 0.999917 0.0104698 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 4 -1.83089e-05 -0.00181419 3.99978 0.0300503 0.000665086 +EDGE_SE3:QUAT 589 697 -0.597642 -3.11292 -0.0313395 0.00408207 0.0059926 -0.996611 0.0819429 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 3.9999 7.78962e-05 0.0165186 4.00022 0.0209131 0.0270375 +EDGE_SE3:QUAT 590 697 -4.60878 -3.07274 0.0229065 -0.00228819 0.00964369 -0.994984 0.0995384 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 4 -1.59111e-05 -0.0092123 3.99963 0.0394249 0.0400453 +EDGE_SE3:QUAT 698 699 4.04233 0.225677 0.022117 0.00296633 -0.00450389 0.091414 0.995798 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 4.00034 -8.73693e-06 -0.0388192 3.9999 -0.00181574 3.96695 +EDGE_SE3:QUAT 470 698 3.13621 -4.38666 -0.0590441 -0.00243512 -0.00990735 0.997025 0.076396 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 4 3.9866e-05 0.00979099 3.99963 0.0405303 0.0237825 +EDGE_SE3:QUAT 471 698 0.499685 -3.49181 -0.0136306 0.00520433 0.00400882 -0.993613 0.112648 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 3.99986 8.88241e-06 0.0212552 4.00047 0.0108999 0.0509035 +EDGE_SE3:QUAT 472 698 -3.32019 -3.52642 -0.0315342 0.0153191 0.00462479 -0.981818 0.189151 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 3.99913 -0.000842362 0.0647199 4.0039 -0.00550317 0.144205 +EDGE_SE3:QUAT 586 698 4.71886 -5.22987 -0.0480107 -0.00557215 -0.00977948 0.96831 0.249499 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 4.00001 4.06061e-05 0.0230579 3.99962 0.0435922 0.249639 +EDGE_SE3:QUAT 587 698 2.22493 -3.92878 -0.0532702 -0.00161091 -0.00876348 0.997147 0.0749546 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 4 1.11445e-05 0.00646854 3.9997 0.0355217 0.0228005 +EDGE_SE3:QUAT 588 698 -0.837265 -3.5935 -0.0451841 0.0135408 0.00364635 -0.997686 0.0665233 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 3.99924 -9.95937e-05 0.0545243 4.003 0.00725544 0.0184614 +EDGE_SE3:QUAT 589 698 -4.65601 -3.94779 -0.0732873 0.0185412 0.00299497 -0.987226 0.158216 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 3.99877 -0.0011016 0.0769846 4.00547 -0.0116789 0.10168 +EDGE_SE3:QUAT 699 700 4.4381 0.403607 0.0174953 -0.000121477 -0.00196046 0.132565 0.991172 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 4.00006 1.25114e-05 -0.0150813 3.99999 -0.000986148 3.92976 +EDGE_SE3:QUAT 468 699 2.77505 -5.22054 -0.0478895 -5.07092e-05 -0.00375745 0.859158 0.511697 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 3.99997 7.72615e-07 -0.00376178 4.00003 0.00630419 1.04736 +EDGE_SE3:QUAT 469 699 1.15483 -4.11375 -0.0909606 -0.00106462 -0.0103356 0.966012 0.258287 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 3.99993 -0.000149989 0.0032369 3.99968 0.0366625 0.267216 +EDGE_SE3:QUAT 470 699 -0.894558 -3.97178 -0.0518828 -0.00130702 0.00660179 -0.999864 0.0150724 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 4 -2.97547e-05 -0.00523 3.99985 0.0265493 0.00109181 +EDGE_SE3:QUAT 471 699 -3.39324 -4.61991 -0.0353038 0.0014845 -7.22411e-05 -0.979093 0.203406 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 3.99999 -1.01021e-05 0.00629011 4.00003 -0.00257526 0.165508 +EDGE_SE3:QUAT 585 699 3.73938 -4.33726 -0.0143171 -0.00426441 -0.00385679 0.944594 0.32819 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 4.00001 5.94966e-05 0.018494 3.99998 0.0214241 0.431049 +EDGE_SE3:QUAT 586 699 1.06512 -3.47296 -0.0576612 -0.00122161 -0.00737722 0.987137 0.1597 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 3.99999 -3.44709e-05 0.00482925 3.99978 0.0291643 0.10224 +EDGE_SE3:QUAT 587 699 -1.80979 -3.54206 -0.0435878 -0.00236655 0.00596169 -0.999839 0.0167816 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 3.99998 -5.36689e-05 -0.00947044 3.99994 0.0241478 0.00129474 +EDGE_SE3:QUAT 588 699 -4.81774 -4.34153 -0.134275 0.00959047 -0.00104802 -0.987439 0.157709 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 3.99973 -0.000355917 0.0397343 4.00129 -0.0157414 0.0999544 +EDGE_SE3:QUAT 654 699 2.02662 -6.4784 -0.034804 -0.000144095 -0.000401838 0.849356 0.52782 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 4 -3.06517e-07 0.00028961 4 0.00104347 1.11437 +EDGE_SE3:QUAT 655 699 -1.99981 -6.38373 -0.06509 -0.000879154 -0.00180967 0.849476 0.527623 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 3.99999 -7.52953e-06 0.00252404 3.99999 0.00540326 1.11356 +EDGE_SE3:QUAT 700 701 4.36098 0.534589 -0.0160512 -0.00835864 0.0128412 0.142336 0.9897 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 4.00295 0.000176492 0.113784 3.9992 0.00833796 3.92219 +EDGE_SE3:QUAT 467 700 3.39686 -2.4998 -0.0670497 0.0159042 -0.00230371 0.787934 0.61555 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 4.00103 0.00187348 -0.0924915 4.00105 -0.0469231 1.51869 +EDGE_SE3:QUAT 468 700 0.302307 -1.51158 -0.0197713 0.00119289 -0.0046867 0.919313 0.393497 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 3.99995 1.00652e-05 -0.00802932 4.00009 0.00872374 0.61941 +EDGE_SE3:QUAT 469 700 -2.89745 -2.25219 -0.0697118 -0.000573732 -0.0105756 0.991716 0.128015 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 3.99998 -8.71601e-05 0.00217237 3.99958 0.0411551 0.0659835 +EDGE_SE3:QUAT 470 700 -5.32872 -4.50743 -0.0398964 -0.00253155 0.006692 -0.98906 0.147339 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 4 -1.88224e-05 -0.0102797 3.99983 0.028245 0.0870649 +EDGE_SE3:QUAT 516 700 3.69149 5.23334 0.00810273 0.00208951 -0.00187013 -0.438013 0.898964 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 3.99998 1.74766e-06 -0.001291 4 -0.000863766 3.23257 +EDGE_SE3:QUAT 517 700 -0.737002 5.33056 0.0211562 0.00875201 -0.00633901 -0.432431 0.901602 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 3.99961 9.5879e-05 0.00258371 3.99998 -0.004943 3.25193 +EDGE_SE3:QUAT 584 700 3.49208 -2.45038 -0.0377922 0.00477262 -0.0051027 0.938589 0.344965 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 3.99988 0.000179563 -0.0238582 4.00055 0.00299402 0.476172 +EDGE_SE3:QUAT 585 700 0.0159322 -1.89417 -0.0306109 -0.00294537 -0.00380728 0.979785 0.199997 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 4 3.68316e-05 0.0122236 3.99998 0.018252 0.160119 +EDGE_SE3:QUAT 586 700 -3.27297 -2.44194 -0.046065 -0.000247604 -0.00780416 0.999592 0.0274818 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 4 -5.66883e-06 0.000990228 3.99976 0.0312112 0.00326497 +EDGE_SE3:QUAT 587 700 -6.24509 -4.07945 -0.0145567 -0.00340424 0.00581167 -0.988819 0.148966 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 3.99999 -5.51483e-05 -0.0139096 3.99993 0.0259342 0.0889837 +EDGE_SE3:QUAT 653 700 3.79832 -2.75235 -0.0354971 0.00916902 0.002473 0.912788 0.408324 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 4.00007 0.000467955 -0.0433041 4.00043 -0.0309838 0.667682 +EDGE_SE3:QUAT 654 700 -0.294418 -2.6637 -0.0226555 0.00142387 -0.0015642 0.911825 0.410573 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 3.99999 2.28041e-05 -0.00781023 4.00005 -0.000106799 0.674298 +EDGE_SE3:QUAT 655 700 -4.31274 -2.58122 -0.0601332 0.000325671 -0.00256282 0.911797 0.410633 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 3.99999 -1.51579e-06 -0.00300795 4.00002 0.00530549 0.67449 +EDGE_SE3:QUAT 701 702 4.16749 0.415991 0.0206794 -0.000295328 -0.000591901 0.117458 0.993078 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 4 1.43285e-06 -0.00422512 4 -0.000238054 3.94482 +EDGE_SE3:QUAT 466 701 6.56892 -0.311372 0.0659877 -0.00148413 -0.00474663 0.734495 0.678596 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 3.99995 1.98226e-06 -0.00348985 4.00003 0.00544854 1.84203 +EDGE_SE3:QUAT 467 701 1.9805 1.53025 0.0452995 1.78705e-05 -0.00288613 0.867758 0.496978 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 3.99998 6.32253e-08 -0.00292675 4.00002 0.00501583 0.987964 +EDGE_SE3:QUAT 468 701 -2.99897 1.29425 0.0012659 -0.0140112 -0.00806172 0.966003 0.258023 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 3.99988 0.000978311 0.0602734 4.00118 0.0540347 0.268011 +EDGE_SE3:QUAT 469 701 -7.13289 -1.56234 -0.0804747 0.0163228 0.0167609 -0.999613 0.0150205 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 3.99887 0.00103173 0.0653288 4.00334 0.0651342 0.0030294 +EDGE_SE3:QUAT 516 701 6.74362 2.11976 0.0129286 -0.000124312 0.0130814 -0.304817 0.952321 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 4.002 -0.00104297 0.0900188 3.99978 -0.0129265 3.63035 +EDGE_SE3:QUAT 517 701 2.36611 2.25724 0.0383124 0.00547964 0.00761857 -0.299607 0.954016 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 4.00116 -0.000357842 0.0714711 3.99976 -0.0112469 3.64222 +EDGE_SE3:QUAT 518 701 -2.24829 2.36341 0.0271385 0.00403899 0.00301479 -0.289147 0.957272 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 4.00023 -4.0599e-05 0.034393 3.99993 -0.00548935 3.66587 +EDGE_SE3:QUAT 519 701 -6.33443 2.36496 0.0411634 0.00239412 0.00476193 -0.279469 0.96014 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 4.0004 -0.000129305 0.0413356 3.99992 -0.0059287 3.68801 +EDGE_SE3:QUAT 583 701 3.91323 -0.216982 0.0379802 -0.00538793 -0.00354503 0.964797 0.262918 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 3.99999 0.000139745 0.0231543 4.00014 0.0223407 0.276773 +EDGE_SE3:QUAT 584 701 -0.106157 -0.00843962 0.0105032 -0.0107219 -0.00970902 0.978126 0.207511 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 3.99991 0.000543192 0.0448861 4.0004 0.0517657 0.173453 +EDGE_SE3:QUAT 585 701 -4.08213 -0.600488 -0.0612016 -0.017944 -0.00851189 0.998122 0.0579511 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 3.99888 0.000993102 0.0721304 4.0044 0.0421237 0.0151824 +EDGE_SE3:QUAT 652 701 4.52153 0.0788888 0.0396141 -0.0055349 -0.000988807 0.96233 0.271825 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 3.99996 0.000169886 0.0242966 4.00032 0.0143928 0.295765 +EDGE_SE3:QUAT 653 701 0.563929 0.149295 0.0247822 -0.00581294 -0.00132119 0.96174 0.2739 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 3.99996 0.000186322 0.0255019 4.00033 0.0161043 0.300324 +EDGE_SE3:QUAT 654 701 -3.47229 0.259697 -0.0109579 -0.0140344 -0.00396458 0.960968 0.276274 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 3.99981 0.00107654 0.0615393 4.0018 0.0416003 0.306754 +EDGE_SE3:QUAT 702 703 4.34755 0.251774 0.0303998 -0.00220189 -0.00335283 0.0676705 0.9977 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 4.00013 4.29141e-05 -0.0248566 3.99996 -0.000819396 3.98184 +EDGE_SE3:QUAT 466 702 5.85525 3.78871 0.107689 -0.0019212 -0.00531306 0.809021 0.587753 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 3.99993 -4.3164e-05 0.00188251 3.99998 0.0112272 1.38189 +EDGE_SE3:QUAT 467 702 -0.428247 4.90388 0.080719 -5.80154e-05 -0.00343509 0.920095 0.391681 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 3.99998 -1.39799e-05 -0.00137228 4 0.00891736 0.613684 +EDGE_SE3:QUAT 468 702 -6.74022 3.03118 -0.0755439 -0.0146027 -0.00726297 0.989645 0.142605 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 3.99949 0.000938264 0.0600108 4.00233 0.0439486 0.082749 +EDGE_SE3:QUAT 517 702 6.00308 0.207178 -0.0147477 0.00608157 0.00653437 -0.185281 0.982645 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 4.00084 -5.68395e-05 0.0628307 3.99976 -0.00614752 3.86367 +EDGE_SE3:QUAT 518 702 1.42894 0.382361 0.0189215 0.00381984 0.00214698 -0.174733 0.984606 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 4.00009 1.66438e-05 0.0242421 3.99996 -0.00232705 3.87802 +EDGE_SE3:QUAT 519 702 -2.60422 0.470464 0.0222358 0.0023043 0.00402963 -0.164935 0.986294 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 4.00029 -3.35192e-05 0.0354109 3.99993 -0.00300818 3.8915 +EDGE_SE3:QUAT 520 702 -6.74875 0.479329 -0.00446233 0.0016424 0.00296928 -0.156499 0.987672 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 4.00016 -1.6579e-05 0.0259219 3.99996 -0.00208543 3.9022 +EDGE_SE3:QUAT 582 702 4.49598 1.48254 0.0474706 -0.00604194 -0.00256064 0.988995 0.1478 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 3.99991 0.000158103 0.0248813 4.00042 0.0166783 0.087608 +EDGE_SE3:QUAT 583 702 0.106785 1.54841 0.0277033 -0.00519295 -0.0036623 0.98899 0.147849 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 3.99995 0.000127627 0.0213479 4.00023 0.0198648 0.0876536 +EDGE_SE3:QUAT 584 702 -4.04741 1.34305 -0.0370181 -0.0114323 -0.00924829 0.995805 0.0903102 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 3.99965 0.000588256 0.0462399 4.00127 0.0444579 0.0336592 +EDGE_SE3:QUAT 651 702 4.92625 1.83015 0.0466718 -0.00687591 -0.000731948 0.987861 0.155186 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 3.99986 0.000180378 0.0284576 4.00067 0.0110869 0.0965684 +EDGE_SE3:QUAT 652 702 0.792298 1.9091 0.0205756 -0.00511291 -0.000833352 0.987538 0.157295 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 3.99992 0.000103945 0.0211707 4.00035 0.00940513 0.099104 +EDGE_SE3:QUAT 653 702 -3.16592 2.01646 0.00641611 -0.00569889 -0.000977792 0.987284 0.158862 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 3.99991 0.000130601 0.023611 4.00044 0.0107285 0.101121 +EDGE_SE3:QUAT 703 704 4.39168 0.107748 0.0162638 -0.00512092 -0.00211075 0.0383508 0.999249 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 3.99995 3.83166e-05 -0.0144939 3.99999 -0.000263064 3.99417 +EDGE_SE3:QUAT 518 703 5.59261 -0.882853 0.0330056 0.0010175 -0.00124242 -0.107795 0.994172 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 4.00001 -7.18986e-06 -0.00846067 4 0.000429261 3.95354 +EDGE_SE3:QUAT 519 703 1.57923 -0.723836 0.0177098 -0.000286472 0.000946835 -0.0978508 0.995201 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 4.00001 -2.92738e-06 0.00713194 4 -0.000341669 3.96171 +EDGE_SE3:QUAT 520 703 -2.54377 -0.639041 -0.00280635 -0.000741846 -0.000115416 -0.0893832 0.995997 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 4 6.50319e-07 -0.00170375 4 8.783e-05 3.96804 +EDGE_SE3:QUAT 521 703 -6.64129 -0.629481 0.0124418 0.00175532 0.00228449 -0.0814705 0.996672 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 4.00009 6.2168e-06 0.0198031 3.99997 -0.000827302 3.97355 +EDGE_SE3:QUAT 581 703 4.58647 2.46754 0.0374403 -0.00282788 -0.00426573 0.997263 0.0737621 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 3.99998 4.76162e-05 0.0113901 4.00001 0.0184913 0.0218819 +EDGE_SE3:QUAT 582 703 0.259307 2.52424 0.0297956 -0.00323462 -0.00497616 0.996727 0.0806276 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 3.99998 6.22319e-05 0.0130437 4.00001 0.0216553 0.0261639 +EDGE_SE3:QUAT 583 703 -4.10901 2.60047 0.0112543 -0.00252922 -0.00587249 0.996732 0.08052 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 3.99999 4.39331e-05 0.0101907 3.99991 0.0247288 0.0261138 +EDGE_SE3:QUAT 650 703 4.87387 2.85154 0.0305251 -0.00309877 -0.00314336 0.996274 0.0861291 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 3.99998 4.73731e-05 0.0125164 4.00007 0.0144607 0.0297649 +EDGE_SE3:QUAT 651 703 0.747092 2.93483 0.0171885 -0.00390152 -0.00278136 0.996087 0.088249 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 3.99996 6.45565e-05 0.0157723 4.00016 0.0136433 0.031261 +EDGE_SE3:QUAT 652 703 -3.40721 3.03573 0.0104045 -0.0021893 -0.00350583 0.995906 0.0903055 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 3.99999 2.84066e-05 0.00884318 4 0.0153072 0.032699 +EDGE_SE3:QUAT 704 705 4.05246 -0.0046246 0.0191945 0.00294658 -0.00171336 0.021059 0.999772 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 4.00002 -2.00289e-05 -0.0144421 3.99999 -0.000154429 3.99828 +EDGE_SE3:QUAT 519 704 5.87702 -1.47434 0.025622 -0.00554701 -0.000826443 -0.0597967 0.998195 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 3.9999 3.08001e-05 -0.0105466 3.99999 0.000354447 3.98572 +EDGE_SE3:QUAT 520 704 1.77256 -1.31878 0.0101915 -0.00607299 -0.0017784 -0.0511471 0.998671 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 3.99993 5.24472e-05 -0.0178917 3.99998 0.000488202 3.98962 +EDGE_SE3:QUAT 521 704 -2.3239 -1.24244 0.00238272 -0.00341035 0.000443402 -0.0433911 0.999052 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 3.99995 -2.06758e-06 0.00176364 4 -2.53542e-05 3.99247 +EDGE_SE3:QUAT 522 704 -6.40414 -1.18468 -0.0940957 -0.00251053 -0.00459311 -0.0377692 0.999273 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 4.00033 2.79044e-05 -0.0378057 3.99991 0.000719446 3.99465 +EDGE_SE3:QUAT 580 704 4.23014 2.92536 0.0510895 -0.00276747 -0.0102013 0.999398 0.0330585 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 3.99998 8.96162e-05 0.0110866 3.99966 0.041424 0.00483168 +EDGE_SE3:QUAT 581 704 0.259394 3.01499 0.0244556 -0.00128241 -0.00944416 0.999322 0.0355632 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 4 2.36277e-05 0.00513642 3.99965 0.0380201 0.00542744 +EDGE_SE3:QUAT 582 704 -4.08426 3.14304 0.0173273 -0.00169137 -0.0102324 0.999053 0.0422485 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 4 3.50286e-05 0.00677814 3.9996 0.0413157 0.00757879 +EDGE_SE3:QUAT 649 704 4.75835 3.41718 0.0326989 -0.00421124 -0.00713985 0.998884 0.0465046 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 3.99995 0.000117061 0.0168951 4.00001 0.02997 0.00894719 +EDGE_SE3:QUAT 650 704 0.546556 3.5062 0.0188689 -0.00154823 -0.00825716 0.998813 0.0479766 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 4 2.61018e-05 0.00620742 3.99974 0.0334306 0.00949673 +EDGE_SE3:QUAT 651 704 -3.60087 3.60688 0.0013861 -0.00224408 -0.00828114 0.998712 0.0500133 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 3.99999 5.02465e-05 0.00900242 3.99977 0.0338126 0.0103122 +EDGE_SE3:QUAT 705 706 4.56108 -0.00180844 -0.00352205 -0.00374656 0.0036351 0.0194161 0.999798 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 4.00017 -5.01804e-05 0.0299379 3.99994 0.000292207 3.99872 +EDGE_SE3:QUAT 520 705 5.77745 -1.74805 0.0476874 -0.00331249 -0.00343939 -0.0299817 0.999539 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 4.00016 3.90472e-05 -0.02867 3.99995 0.000434608 3.99661 +EDGE_SE3:QUAT 521 705 1.72399 -1.5964 0.00720113 -0.000299698 -0.00127509 -0.0217376 0.999763 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 4.00003 6.85158e-07 -0.0102717 3.99999 0.000111888 3.99814 +EDGE_SE3:QUAT 522 705 -2.35438 -1.50571 -0.0434419 0.000409938 -0.00628979 -0.016429 0.999845 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 4.00063 -2.58469e-05 -0.0502241 3.99984 0.000412847 3.99955 +EDGE_SE3:QUAT 523 705 -6.58331 -1.43337 -0.00777495 -0.00113104 -0.00241934 -0.0133278 0.999908 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 4.00009 9.17987e-06 -0.0195308 3.99998 0.000130388 3.99938 +EDGE_SE3:QUAT 579 705 4.58024 3.15227 0.0339847 0.00085876 -0.00532114 0.999958 0.00736593 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 4 -1.97994e-05 -0.00343549 3.9999 0.0212309 0.000332674 +EDGE_SE3:QUAT 580 705 0.184563 3.21183 0.043359 -0.00132375 -0.00696439 0.999906 0.0117571 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 3.99999 3.27274e-05 0.00529638 3.99983 0.027972 0.000755574 +EDGE_SE3:QUAT 581 705 -3.77962 3.33256 0.0318655 0.000160621 -0.00631966 0.99988 0.0141422 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 4 -8.55255e-06 -0.000642885 3.99984 0.0252473 0.000959501 +EDGE_SE3:QUAT 648 705 4.92474 3.72104 0.0206595 0.000535558 -0.00357794 0.999673 0.0253057 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 4 -9.99631e-06 -0.0021448 3.99996 0.0141804 0.00261297 +EDGE_SE3:QUAT 649 705 0.738886 3.80388 0.0202724 -0.00258631 -0.00416283 0.999664 0.0254478 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 3.99998 4.31842e-05 0.010355 4.00002 0.017151 0.00269077 +EDGE_SE3:QUAT 650 705 -3.46282 3.90633 0.0225626 -0.000126702 -0.00508636 0.999619 0.0271227 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 4 -3.0371e-06 0.000506548 3.9999 0.0203353 0.00304609 +EDGE_SE3:QUAT 706 707 4.3667 -0.00114374 0.0230295 -0.00182068 -0.00108686 0.0183264 0.99983 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 4 7.90678e-06 -0.00829014 4 -7.47766e-05 3.99867 +EDGE_SE3:QUAT 521 706 6.26285 -1.80724 0.0206043 -0.00425264 0.00236183 -0.00230165 0.999986 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 4.00002 -4.01495e-05 0.0187769 3.99998 -2.21287e-05 4.00007 +EDGE_SE3:QUAT 522 706 2.16968 -1.65993 0.00753753 -0.00332018 -0.00261184 0.00316442 0.999986 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 4.00006 3.49231e-05 -0.0207685 3.99997 -3.33341e-05 4.00007 +EDGE_SE3:QUAT 523 706 -2.05405 -1.55746 0.00749131 -0.00479891 0.00128506 0.00624868 0.999968 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 3.99994 -2.55551e-05 0.0106394 3.99999 3.34149e-05 3.99987 +EDGE_SE3:QUAT 524 706 -6.26754 -1.47749 0.00539207 -0.00545569 0.00231452 0.00796845 0.999951 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 3.99997 -5.13315e-05 0.0190356 3.99998 7.58034e-05 3.99984 +EDGE_SE3:QUAT 578 706 4.03493 3.12848 0.0785969 0.00554691 0.0129462 -0.999788 0.0150231 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 3.99986 0.000295288 0.0222006 3.99987 0.0510943 0.00167881 +EDGE_SE3:QUAT 579 706 0.0477371 3.22153 0.0336007 0.00287389 0.00909241 -0.999881 0.0120875 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 3.99996 0.000109868 0.0114996 3.99982 0.0360788 0.000942974 +EDGE_SE3:QUAT 580 706 -4.36013 3.32768 0.0297576 0.00525977 0.0110433 -0.999896 0.00764948 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 3.99988 0.000234545 0.0210445 3.99998 0.0438492 0.000825478 +EDGE_SE3:QUAT 647 706 4.49284 3.85965 0.0458021 -0.00491417 -0.00800805 0.999935 0.00638691 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 3.99991 0.000157765 0.0196596 4.00012 0.0322832 0.000520342 +EDGE_SE3:QUAT 648 706 0.414341 3.95368 0.0273563 -0.00338971 -0.00763946 0.999948 0.00584547 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 3.99996 0.000102412 0.0135606 3.99994 0.0307147 0.000418507 +EDGE_SE3:QUAT 649 706 -3.77481 4.04302 -0.00690771 -0.00654957 -0.00790221 0.999927 0.00629932 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 3.99983 0.000210327 0.0262018 4.00042 0.0319422 0.00058541 +EDGE_SE3:QUAT 707 708 4.38008 -0.0491337 0.0238853 0.00226887 -0.000935524 0.0113772 0.999932 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 3.99999 -8.7021e-06 -0.00779244 4 -4.48624e-05 3.9995 +EDGE_SE3:QUAT 522 707 6.53052 -1.63973 0.0538345 -0.00519134 -0.00352964 0.0213694 0.999752 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 4.00007 7.45527e-05 -0.0268869 3.99996 -0.000283938 3.99835 +EDGE_SE3:QUAT 523 707 2.3191 -1.50627 0.0207731 -0.00667592 0.000265733 0.0242916 0.999683 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 3.99983 -1.56252e-05 0.00406905 4 5.72595e-05 3.99764 +EDGE_SE3:QUAT 524 707 -1.89091 -1.40716 0.0031913 -0.00683556 0.00124863 0.0259363 0.999639 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 3.99985 -4.24674e-05 0.0121048 3.99999 0.000165783 3.99735 +EDGE_SE3:QUAT 525 707 -6.02726 -1.30264 -0.024883 -0.00720496 0.000888591 0.025621 0.999645 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 3.99981 -3.54618e-05 0.00931536 3.99999 0.000128552 3.9974 +EDGE_SE3:QUAT 577 707 3.69332 2.91024 0.07436 0.00596075 0.0148414 -0.999259 0.0350094 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 3.99981 0.000378581 0.0238989 3.99984 0.0575238 0.0058739 +EDGE_SE3:QUAT 578 707 -0.333918 2.99205 0.0512134 0.00475065 0.0145273 -0.999326 0.0333614 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 3.99987 0.000309164 0.0190444 3.99963 0.056684 0.00534694 +EDGE_SE3:QUAT 579 707 -4.3439 3.12123 0.0341582 0.00204913 0.0111123 -0.999488 0.0299412 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 3.99997 0.000116209 0.00821162 3.99961 0.0438581 0.00408415 +EDGE_SE3:QUAT 646 707 4.30925 3.7927 0.0523087 0.00604549 0.0102407 -0.999899 0.00782814 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 3.99985 0.00024718 0.0241875 4.00019 0.0405844 0.000803142 +EDGE_SE3:QUAT 647 707 0.146843 3.90949 0.031118 0.0041251 0.0100956 -0.999876 0.011383 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 3.99992 0.000170875 0.0165061 3.99989 0.0399958 0.00098638 +EDGE_SE3:QUAT 648 707 -3.95878 4.01247 0.0259207 0.00260454 0.00965074 -0.999875 0.0122166 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 3.99997 0.000107403 0.0104221 3.99975 0.0383338 0.000991584 +EDGE_SE3:QUAT 708 709 4.15341 -0.0534928 0.0221885 -3.44503e-05 -0.00548421 0.0107707 0.999927 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 4.00048 8.5287e-06 -0.0438662 3.99988 -0.000236312 4.00002 +EDGE_SE3:QUAT 523 708 6.66201 -1.34391 0.042877 -0.00443989 -0.00030504 0.0359092 0.999345 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 3.99992 -2.44484e-07 -0.000524002 4 2.06923e-06 3.99484 +EDGE_SE3:QUAT 524 708 2.47288 -1.22894 0.0132602 -0.00455293 0.000558499 0.0373112 0.999293 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 3.99993 -1.58147e-05 0.00649513 4 0.000133726 3.99444 +EDGE_SE3:QUAT 525 708 -1.65069 -1.1293 -0.0100462 -0.00463378 0.000251265 0.0367836 0.999312 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 3.99992 -1.07808e-05 0.00404947 4 8.69685e-05 3.99459 +EDGE_SE3:QUAT 526 708 -6.13941 -1.02771 -0.0863998 -0.000869779 -0.00259227 0.0343285 0.999407 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 4.0001 1.41677e-05 -0.0203439 3.99997 -0.000347088 3.99539 +EDGE_SE3:QUAT 576 708 3.9367 2.42253 0.0600353 0.00439402 0.0137902 -0.999714 0.019012 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 3.9999 0.000261038 0.0175912 3.99961 0.0544443 0.00226458 +EDGE_SE3:QUAT 577 708 -0.640315 2.65159 0.0426395 0.00552618 0.0124239 -0.998831 0.0463845 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 3.99982 0.000288138 0.02219 4.00003 0.0473888 0.00929216 +EDGE_SE3:QUAT 578 708 -4.67543 2.75343 0.0333871 0.0044258 0.0123999 -0.998916 0.0446383 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 3.99988 0.000246066 0.0177686 3.99982 0.0477785 0.00862131 +EDGE_SE3:QUAT 645 708 4.04846 3.65408 0.0400779 0.0047238 0.00809743 -0.999872 0.0129492 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 3.9999 0.000152479 0.0189016 4.00012 0.03189 0.00101433 +EDGE_SE3:QUAT 646 708 -0.00857788 3.7784 0.0216476 0.00544115 0.00751358 -0.999773 0.0191607 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 3.99987 0.000157659 0.0217783 4.00029 0.0291972 0.00180033 +EDGE_SE3:QUAT 647 708 -4.22167 3.85967 0.0152918 0.00358566 0.007445 -0.999709 0.0226612 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 3.99994 0.000108954 0.0143554 4.00001 0.0290936 0.00231739 +EDGE_SE3:QUAT 709 710 4.24662 -0.0393599 -0.00381558 0.00197369 0.0164561 0.0113557 0.999798 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 4.0043 0.000203666 0.131477 3.99892 0.000760866 4.0038 +EDGE_SE3:QUAT 524 709 6.62756 -0.976027 0.0401784 -0.0046669 -0.00454344 0.0481571 0.998819 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 4.00019 9.7146e-05 -0.0335291 3.99993 -0.000786864 3.991 +EDGE_SE3:QUAT 525 709 2.49117 -0.880777 0.00569502 -0.00445205 -0.00513676 0.0475701 0.998845 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 4.00029 0.000110732 -0.0384188 3.99991 -0.000895305 3.99132 +EDGE_SE3:QUAT 526 709 -1.98882 -0.801295 -0.0409234 -0.000568431 -0.00790757 0.045056 0.998953 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 4.00098 8.46813e-05 -0.0627745 3.99976 -0.00141219 3.99286 +EDGE_SE3:QUAT 527 709 -6.2662 -0.671257 -0.107693 -0.00104129 -0.0143627 0.0418598 0.99902 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 4.00325 0.000264736 -0.114158 3.9992 -0.0023938 3.99625 +EDGE_SE3:QUAT 575 709 4.42226 1.74041 0.0373839 0.00261814 -0.0130889 0.997242 0.0730057 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 3.99992 -0.000211207 -0.0105999 3.99957 0.050138 0.0219797 +EDGE_SE3:QUAT 576 709 -0.214256 2.31397 0.0510997 -0.00090323 0.0136985 -0.999455 0.0300172 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 4 -4.47216e-06 -0.00361524 3.99925 0.0548821 0.00436124 +EDGE_SE3:QUAT 577 709 -4.73029 2.33251 0.0239589 0.000704389 0.0124202 -0.998257 0.0576874 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 3.99998 0.000102568 0.0028521 3.99943 0.0489408 0.0139143 +EDGE_SE3:QUAT 644 709 3.88034 3.48691 0.0514552 -0.00049736 0.0102347 -0.999819 0.0160114 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 4 -6.9673e-06 -0.00199004 3.99958 0.0409742 0.00144632 +EDGE_SE3:QUAT 645 709 -0.131066 3.60349 0.0245584 -0.000423134 0.00779175 -0.999695 0.0234216 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 4 -1.82383e-06 -0.00169319 3.99976 0.0312025 0.00243855 +EDGE_SE3:QUAT 646 709 -4.13636 3.67223 -0.000375087 0.000527312 0.00718685 -0.99953 0.0298114 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 4 2.70123e-05 0.00211383 3.9998 0.0285573 0.00376008 +EDGE_SE3:QUAT 710 711 4.25063 0.00316565 0.0189771 0.000524743 -0.00372694 0.0196826 0.999799 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 4.00022 -1.26187e-06 -0.0299235 3.99994 -0.000294704 3.99867 +EDGE_SE3:QUAT 525 710 6.694 -0.530287 0.048989 -0.00317839 0.0116234 0.0589963 0.998185 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 4.0022 4.56471e-05 0.0947929 3.99944 0.00280698 3.98832 +EDGE_SE3:QUAT 526 710 2.23049 -0.458703 0.0185036 0.000687923 0.00860706 0.0565332 0.998363 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 4.00116 0.000122249 0.068078 3.99972 0.0019195 3.98837 +EDGE_SE3:QUAT 527 710 -2.01933 -0.367836 0.00571413 0.000301848 0.00220745 0.0531444 0.998584 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 4.00008 8.6902e-06 0.017393 3.99998 0.000459858 3.98878 +EDGE_SE3:QUAT 528 710 -6.30456 -0.199583 0.0137192 -0.00096694 0.00397328 0.0447411 0.99899 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 4.00026 1.67938e-06 0.0322111 3.99994 0.000723486 3.99225 +EDGE_SE3:QUAT 574 710 4.96244 1.52711 0.0784121 -0.00622919 -0.0112454 0.977922 0.208575 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 4 0.000102065 0.0256765 3.99956 0.0501046 0.174835 +EDGE_SE3:QUAT 575 710 0.209259 2.42374 0.0627352 -0.0138495 -0.00947582 0.997937 0.0619613 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 3.99938 0.00073354 0.055707 4.0023 0.0444195 0.0166298 +EDGE_SE3:QUAT 576 710 -4.38723 2.10933 0.0593425 0.0158865 0.0120005 -0.998941 0.0414718 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 3.99888 0.000541148 0.0637149 4.00383 0.042593 0.00835047 +EDGE_SE3:QUAT 643 710 3.6322 3.35771 0.0636739 0.00807849 0.00642445 -0.99925 0.0373315 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 3.99971 0.000157081 0.0323842 4.00097 0.0232073 0.00597197 +EDGE_SE3:QUAT 644 710 -0.281754 3.39193 0.0529765 0.0163377 0.00835496 -0.999458 0.0273143 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 3.99888 0.000381807 0.0654197 4.00417 0.029833 0.0042777 +EDGE_SE3:QUAT 645 710 -4.27021 3.45084 0.0285099 0.0164622 0.00602219 -0.99923 0.0351094 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 3.99887 0.000172277 0.0659641 4.00435 0.019424 0.00611451 +EDGE_SE3:QUAT 711 712 4.2064 0.00802182 0.0190911 0.00256177 -0.00158569 0.0224098 0.999744 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 4.00002 -1.59414e-05 -0.0133646 3.99999 -0.000152123 3.99804 +EDGE_SE3:QUAT 526 711 6.47235 -0.00191322 -0.0336276 0.00159733 0.00496172 0.0759343 0.997099 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 4.00035 7.16904e-05 0.0379038 3.99992 0.00141755 3.97729 +EDGE_SE3:QUAT 527 711 2.20927 0.077661 0.00491881 0.00112501 -0.00153691 0.0725582 0.997362 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 4.00004 -2.98046e-06 -0.0131745 3.99999 -0.000488567 3.97898 +EDGE_SE3:QUAT 528 711 -2.07693 0.17393 -0.00360544 -0.000178727 0.000112911 0.0645282 0.997916 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 4 -7.19534e-08 0.00103566 4 3.48422e-05 3.98334 +EDGE_SE3:QUAT 529 711 -6.36537 0.450274 -0.000544696 0.00040022 0.0019807 0.044612 0.999002 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 4.00006 7.19886e-06 0.0155846 3.99999 0.000345734 3.9921 +EDGE_SE3:QUAT 573 711 5.97703 2.1783 0.0644783 -0.000810519 -0.0115235 0.941778 0.336038 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 3.99984 -0.00020265 0.000243484 3.99978 0.0355416 0.452062 +EDGE_SE3:QUAT 574 711 1.07378 3.29065 0.0667555 -0.00263649 -0.0115144 0.981765 0.189731 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 3.99999 -8.55585e-05 0.0104704 3.99946 0.0458194 0.144564 +EDGE_SE3:QUAT 575 711 -3.97573 2.94764 -0.0281352 -0.010305 -0.00908044 0.999008 0.0423604 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 3.99964 0.000443903 0.0413306 4.00118 0.0396645 0.00799917 +EDGE_SE3:QUAT 642 711 3.4132 2.99421 0.0419979 0.00364207 0.00667566 -0.997655 0.068023 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 3.99992 9.23799e-05 0.0146864 4.00012 0.0244233 0.0187126 +EDGE_SE3:QUAT 643 711 -0.596925 3.06352 0.0170465 0.00478541 0.00581091 -0.998377 0.0564479 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 3.99988 8.97999e-05 0.0192416 4.00031 0.0209072 0.012948 +EDGE_SE3:QUAT 644 711 -4.38927 3.16566 -0.0672367 0.0129777 0.0071898 -0.998766 0.0473957 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 3.99927 0.000189225 0.0520881 4.00269 0.0237096 0.00980623 +EDGE_SE3:QUAT 712 713 4.2033 0.00363236 0.0173042 0.000153334 -0.00143294 0.0257732 0.999667 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 4.00003 3.94165e-07 -0.0114996 3.99999 -0.000148341 3.99738 +EDGE_SE3:QUAT 527 712 6.35352 0.672797 0.0401341 0.0033246 -0.00275657 0.0949805 0.99547 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 4.00012 -2.24418e-05 -0.0255219 3.99996 -0.00126661 3.96408 +EDGE_SE3:QUAT 528 712 2.06745 0.707071 0.011355 0.00257546 -0.00131344 0.0867388 0.996227 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 4.00002 -1.28202e-05 -0.0130564 3.99999 -0.000603138 3.96995 +EDGE_SE3:QUAT 529 712 -2.1786 0.811718 -0.00135646 0.00293162 0.000448714 0.066877 0.997757 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 3.99997 7.0166e-07 0.00121994 4 1.43032e-05 3.98211 +EDGE_SE3:QUAT 530 712 -6.29235 1.16412 0.0394959 0.00322908 0.00458549 0.0413698 0.999128 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 4.00026 7.50112e-05 0.0349902 3.99993 0.00071373 3.99346 +EDGE_SE3:QUAT 573 712 2.7444 4.83121 0.107319 0.00152704 -0.00958748 0.949107 0.314803 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 3.99984 -9.30547e-05 -0.00933945 4.0001 0.0257228 0.396629 +EDGE_SE3:QUAT 574 712 -2.81702 4.87 0.0875487 -0.00081456 -0.00950249 0.985736 0.16803 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 3.99998 -8.62345e-05 0.00303196 3.99967 0.0364162 0.113281 +EDGE_SE3:QUAT 641 712 3.2465 2.32766 0.0244135 0.00397141 0.00246658 -0.995699 0.0925315 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 3.99993 3.72136e-06 0.0161038 4.00027 0.00674164 0.0343253 +EDGE_SE3:QUAT 642 712 -0.739735 2.44498 0.0281161 0.00208338 0.00401078 -0.995905 0.0902965 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 3.99997 3.10309e-05 0.00845855 4.00004 0.0142247 0.032683 +EDGE_SE3:QUAT 643 712 -4.72599 2.61386 -0.00941335 0.00334071 0.00300916 -0.996885 0.0787437 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 3.99994 2.09459e-05 0.0134983 4.00018 0.00975965 0.0248721 +EDGE_SE3:QUAT 713 714 4.19675 0.0806382 0.0152053 0.00044276 -0.00117794 0.055729 0.998445 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 4.00002 -2.23771e-07 -0.00967515 3.99999 -0.000271923 3.9876 +EDGE_SE3:QUAT 528 713 6.20444 1.42697 0.0440399 0.00260226 -0.00294621 0.11237 0.993659 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 4.00015 -7.42736e-06 -0.0266049 3.99995 -0.00155156 3.94967 +EDGE_SE3:QUAT 529 713 1.97366 1.36951 0.0185286 0.00285192 -0.00114995 0.0923551 0.995721 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 4 -1.42377e-05 -0.0122249 3.99999 -0.000611206 3.96592 +EDGE_SE3:QUAT 530 713 -2.0976 1.50052 0.0178331 0.00348851 0.00323378 0.0667026 0.997762 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 4.00008 5.21703e-05 0.0229139 3.99997 0.000732035 3.98233 +EDGE_SE3:QUAT 531 713 -5.95531 2.37367 -0.0580572 -0.000948247 -0.00166928 -0.0200419 0.999797 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 4.00004 5.09568e-06 -0.0135743 3.99999 0.000136701 3.99844 +EDGE_SE3:QUAT 573 713 -0.609547 7.33523 0.16241 0.00286462 -0.00993047 0.956888 0.290275 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 3.99979 -7.01032e-05 -0.0147553 4.00029 0.0255175 0.337291 +EDGE_SE3:QUAT 640 713 3.74108 1.17785 0.0237001 0.00326236 0.00654126 -0.998914 0.0460066 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 3.99994 8.63776e-05 0.0130965 4.00005 0.0248298 0.00866388 +EDGE_SE3:QUAT 641 713 -0.880923 1.57462 0.0118242 0.00248025 0.00219451 -0.992992 0.118139 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 3.99997 4.24928e-06 0.0101554 4.00011 0.00616206 0.0558634 +EDGE_SE3:QUAT 642 713 -4.87422 1.69313 0.0243771 0.000621679 0.00362434 -0.993277 0.115699 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 3.99999 1.74914e-05 0.00258112 3.99997 0.0134468 0.0535931 +EDGE_SE3:QUAT 714 715 4.11628 0.334361 0.00729217 0.00246081 0.00424003 0.124192 0.992246 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 4.00019 7.80794e-05 0.0295098 3.99995 0.00174127 3.93852 +EDGE_SE3:QUAT 529 714 6.10074 2.2148 0.0480849 0.0032769 -0.00228347 0.147833 0.989004 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 4.00009 -1.33947e-05 -0.0234012 3.99996 -0.00185744 3.91272 +EDGE_SE3:QUAT 530 714 2.05743 2.1426 0.0114225 0.00423866 0.00175693 0.122217 0.992493 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 3.99994 1.5189e-05 0.00758684 4 0.000330652 3.94026 +EDGE_SE3:QUAT 531 714 -1.73948 2.28433 -0.0246328 -0.000675627 -0.00313919 0.0358275 0.999353 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 4.00015 1.66347e-05 -0.0247757 3.99996 -0.000442005 3.99502 +EDGE_SE3:QUAT 532 714 -5.22098 3.35603 0.0120168 0.00364259 -0.000950256 -0.0987833 0.995102 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 3.99995 -3.78021e-06 -0.0032011 4 8.51976e-05 3.96097 +EDGE_SE3:QUAT 639 714 3.782 0.157097 0.00812501 -0.00098092 -0.0065326 0.999547 0.0293713 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 4 1.59653e-05 0.00392762 3.99984 0.0263039 0.00362768 +EDGE_SE3:QUAT 640 714 -0.44826 0.713494 0.0145405 0.00253168 0.00591204 -0.994787 0.10177 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 3.99995 6.18356e-05 0.010333 4.00004 0.0209991 0.0415674 +EDGE_SE3:QUAT 641 714 -4.94607 0.505791 0.00888486 0.00150826 0.00163489 -0.984892 0.173156 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 3.99999 -4.55522e-07 0.00636611 4.00004 0.00402795 0.119947 +EDGE_SE3:QUAT 715 716 4.11497 0.564069 0.0165128 -0.000406627 -0.00660675 0.160815 0.986962 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 4.00062 0.000166802 -0.0500524 3.99987 -0.00394972 3.89718 +EDGE_SE3:QUAT 530 715 5.96205 3.4595 0.0113077 0.00620594 0.00581547 0.244404 0.969636 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 3.99999 0.000136094 0.0249392 4 0.00213262 3.76121 +EDGE_SE3:QUAT 531 715 2.32785 2.91171 0.00318953 0.00134195 0.00134228 0.159537 0.98719 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 4.00001 8.88688e-06 0.00780542 4 0.000543273 3.89821 +EDGE_SE3:QUAT 532 715 -1.12201 2.85824 0.0223416 0.00652439 0.00247036 0.0255154 0.99965 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 3.99991 5.88669e-05 0.0177458 3.99998 0.000218636 3.99747 +EDGE_SE3:QUAT 533 715 -4.24864 3.9033 -0.000597517 0.00235986 0.00384287 -0.132915 0.991117 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 4.00026 -1.3929e-05 0.0336534 3.99993 -0.00230103 3.92962 +EDGE_SE3:QUAT 638 715 3.96649 -0.692149 0.0142899 -0.00549569 -0.00487362 0.995748 0.0918224 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 3.99992 0.000141578 0.02223 4.00027 0.0230906 0.033984 +EDGE_SE3:QUAT 639 715 -0.344547 0.0659087 0.00349259 0.00598606 0.00375871 -0.995444 0.0950851 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 3.99983 7.02475e-06 0.024292 4.00061 0.0101857 0.03634 +EDGE_SE3:QUAT 640 715 -4.40211 -0.433394 -0.00975977 0.00763279 0.00365406 -0.974485 0.224294 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 3.99977 -0.000240199 0.0330756 4.00104 -0.000197877 0.201519 +EDGE_SE3:QUAT 716 717 4.15662 0.523016 0.00472962 0.000313376 -0.00199299 0.146938 0.989144 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 4.00006 1.16984e-05 -0.0159752 3.99999 -0.00117438 3.9137 +EDGE_SE3:QUAT 532 716 2.95147 3.61529 0.024498 0.00658097 -0.00524012 0.185675 0.982575 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 4.00056 -4.32621e-06 -0.0541048 3.99981 -0.00540296 3.86283 +EDGE_SE3:QUAT 533 716 -0.132585 3.34631 -0.0147214 0.00156875 -0.00282441 0.0282574 0.999595 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 4.00012 -1.2651e-05 -0.0231005 3.99997 -0.000328474 3.99694 +EDGE_SE3:QUAT 534 716 -3.17762 4.04425 -0.0315322 -0.000658342 -0.00169297 -0.148015 0.988983 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 4.00005 -6.38247e-06 -0.0142535 3.99999 0.00107253 3.91242 +EDGE_SE3:QUAT 637 716 3.95176 -1.2369 -0.013004 -0.00133038 -0.00652485 0.993212 0.116127 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 4 -5.02481e-06 0.00534641 3.99983 0.0264423 0.0541266 +EDGE_SE3:QUAT 638 716 -0.183372 -0.468913 -0.0139002 -0.000239786 0.00522596 -0.997533 0.0699987 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 4 1.02401e-05 -0.000951788 3.99989 0.0207816 0.019708 +EDGE_SE3:QUAT 639 716 -4.28148 -1.2445 -0.0289341 6.24146e-05 0.00305246 -0.967181 0.254071 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 3.99999 1.35923e-05 0.000673175 3.99998 0.0101659 0.258238 +EDGE_SE3:QUAT 717 718 4.33205 0.452308 -0.0303778 -0.00175325 0.0173542 0.110223 0.993754 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 4.0048 0.000678776 0.138758 3.99886 0.0076546 3.95621 +EDGE_SE3:QUAT 533 717 3.9893 4.09579 0.0142761 0.0014442 -0.00512461 0.174747 0.984599 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 4.00043 8.59313e-05 -0.0421043 3.9999 -0.00371113 3.8783 +EDGE_SE3:QUAT 534 717 0.944407 3.34531 -0.0163274 -0.000932735 -0.00378557 -0.00140247 0.999991 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 4.00023 1.36535e-05 -0.0303017 3.99994 2.09344e-05 4.00022 +EDGE_SE3:QUAT 535 717 -2.50947 3.57932 -0.0670387 0.00259552 -0.0132728 -0.140681 0.989963 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 4.00241 -0.000662134 -0.0987708 3.99947 0.00679177 3.92327 +EDGE_SE3:QUAT 636 717 3.65986 -1.34026 -0.0261234 0.00302965 -0.0070133 0.991594 0.129166 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 3.99991 -8.21475e-05 -0.0125393 4.0001 0.0238131 0.0669207 +EDGE_SE3:QUAT 637 717 -0.233695 -0.78342 -0.0209599 1.83493e-05 0.00627885 -0.999492 0.031247 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 4 1.02649e-05 7.51029e-05 3.99984 0.025049 0.00406252 +EDGE_SE3:QUAT 638 717 -4.2288 -1.55847 -0.0141382 -0.00161915 0.0049029 -0.976513 0.215394 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 4 1.12525e-05 -0.00651949 3.9999 0.0200345 0.185695 +EDGE_SE3:QUAT 718 719 4.05849 0.187185 0.0343405 -0.00538166 0.000599241 0.061076 0.998118 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 3.9999 -2.55233e-05 0.00870137 3.99999 0.000305475 3.9851 +EDGE_SE3:QUAT 534 718 5.28415 3.77291 -0.0167389 -0.00325796 0.0134311 0.108304 0.994022 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 4.00297 0.000307542 0.109837 3.99927 0.00598693 3.95609 +EDGE_SE3:QUAT 535 718 1.79044 2.78527 0.0132202 0.00187999 0.00381688 -0.0306205 0.999522 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 4.00023 1.84521e-05 0.031184 3.99994 -0.000480136 3.99649 +EDGE_SE3:QUAT 536 718 -2.49842 2.83994 0.0678968 0.00946542 0.00631626 -0.090006 0.995876 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 4.00054 0.000185815 0.0600912 3.99976 -0.00283771 3.9685 +EDGE_SE3:QUAT 537 718 -6.5126 3.01804 0.108084 0.00982693 0.00832866 -0.101453 0.994757 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 4.00111 0.000183406 0.0775025 3.9996 -0.00409864 3.96033 +EDGE_SE3:QUAT 635 718 3.26273 -0.815754 0.0171298 -0.00856519 -0.00534901 0.996094 0.0877149 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 3.99978 0.000293923 0.0346274 4.00085 0.026959 0.0312602 +EDGE_SE3:QUAT 636 718 -0.648601 -0.645246 -0.029146 -0.0149563 -0.00708143 0.999674 0.0194282 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 3.99914 0.000518874 0.0598586 4.00328 0.0306594 0.00264088 +EDGE_SE3:QUAT 637 718 -4.51659 -1.47416 -0.062964 0.0179497 0.00875674 -0.989859 0.140642 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 3.99857 -0.000534722 0.0740733 4.00562 0.0135256 0.0805702 +EDGE_SE3:QUAT 719 720 4.23562 0.0748247 0.0341243 -0.0043322 -0.00316224 0.0299272 0.999538 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 4.00007 5.67132e-05 -0.0237091 3.99997 -0.000347816 3.99656 +EDGE_SE3:QUAT 535 719 5.84737 2.72408 0.0165151 -0.003205 0.00433211 0.0302021 0.999529 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 4.00028 -4.36326e-05 0.0357724 3.99992 0.000544399 3.99667 +EDGE_SE3:QUAT 536 719 1.53535 2.28244 0.0429779 0.00449896 0.0068862 -0.0288332 0.99955 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 4.00072 9.42391e-05 0.0565851 3.9998 -0.000817985 3.99747 +EDGE_SE3:QUAT 537 719 -2.50592 2.37658 0.0671707 0.00502307 0.00873937 -0.0404441 0.999131 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 4.0012 0.000105364 0.072197 3.99967 -0.00146676 3.99476 +EDGE_SE3:QUAT 538 719 -6.6511 2.47599 -0.0175213 0.00702392 0.000807482 -0.0440038 0.999006 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 3.99983 3.85136e-05 0.0101447 3.99999 -0.000250037 3.99228 +EDGE_SE3:QUAT 634 719 3.55308 -0.332214 0.0245249 -0.00902399 -0.00414089 0.999514 0.0295414 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 3.99969 0.000201166 0.0361424 4.00118 0.0186663 0.00390477 +EDGE_SE3:QUAT 635 719 -0.751533 -0.291925 -0.0196174 -0.00983611 -0.0101413 0.999529 0.0272458 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 3.99966 0.000435518 0.0393922 4.00101 0.0426512 0.00381247 +EDGE_SE3:QUAT 636 719 -4.69581 -0.666089 -0.124489 0.0162545 0.011418 -0.99895 0.041286 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 3.99883 0.000506455 0.0651874 4.00406 0.040176 0.00828643 +EDGE_SE3:QUAT 720 721 4.25833 -0.0331896 -0.00144112 -0.00175917 -0.000425754 0.00871595 0.99996 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 3.99999 2.81444e-06 -0.00322164 4 -1.3779e-05 3.9997 +EDGE_SE3:QUAT 536 720 5.76415 2.10401 0.0118597 0.000161431 0.00349786 0.00139039 0.999993 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 4.0002 2.66698e-06 0.0279813 3.99995 1.95017e-05 4.00019 +EDGE_SE3:QUAT 537 720 1.71482 2.09704 0.020595 0.000459184 0.00531259 -0.0107762 0.999928 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 4.00045 2.46287e-06 0.0425569 3.99989 -0.00022915 3.99999 +EDGE_SE3:QUAT 538 720 -2.43566 2.17244 0.00167836 0.00245128 -0.00244244 -0.0140052 0.999896 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 4.00007 -2.52067e-05 -0.0191221 3.99998 0.000133276 3.99931 +EDGE_SE3:QUAT 539 720 -6.67537 2.2648 0.0782361 0.00253035 0.00545086 -0.0143193 0.999879 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 4.00046 4.55365e-05 0.0440325 3.99988 -0.00031453 3.99966 +EDGE_SE3:QUAT 633 720 3.34374 -0.22659 -0.00852343 -0.000800762 0.00621879 -0.999962 0.00609142 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 4 -1.81153e-05 -0.00320339 3.99985 0.0249115 0.000306144 +EDGE_SE3:QUAT 634 720 -0.682489 -0.142235 -0.0250202 0.00565528 0.00847313 -0.999948 0.000554241 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 3.99987 0.000191622 0.0226232 4.00023 0.0338722 0.000415981 +EDGE_SE3:QUAT 635 720 -4.97969 -0.123973 -0.0698187 0.0072255 0.0146979 -0.999861 0.00303762 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 3.99979 0.000426315 0.0289109 3.99999 0.0586255 0.00110504 +EDGE_SE3:QUAT 721 722 4.28309 -0.0609426 0.0342827 -0.00111002 -0.00874518 0.00553798 0.999946 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 4.00122 4.89649e-05 -0.0699029 3.9997 -0.000195679 4.0011 +EDGE_SE3:QUAT 537 721 5.95652 1.97279 -0.0281195 -0.00109118 0.00506482 -0.00213139 0.999984 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 4.00041 -2.34048e-05 0.0404939 3.9999 -4.38269e-05 4.00039 +EDGE_SE3:QUAT 538 721 1.80656 2.01995 0.017883 0.00089219 -0.00289624 -0.00529873 0.999981 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 4.00013 -1.13655e-05 -0.0231128 3.99997 6.13676e-05 4.00002 +EDGE_SE3:QUAT 539 721 -2.4857 2.11138 0.0296716 0.000987258 0.00513993 -0.00544298 0.999971 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 4.00042 1.68867e-05 0.0411859 3.99989 -0.000111547 4.00031 +EDGE_SE3:QUAT 540 721 -6.72354 2.19204 0.0128132 -0.000916391 0.00676852 -0.00426846 0.999968 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 4.00073 -2.94845e-05 0.0541084 3.99982 -0.000116507 4.00066 +EDGE_SE3:QUAT 632 721 3.27044 -0.326209 0.0164879 0.00690067 0.00635575 -0.999786 0.0184282 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 3.9998 0.000159488 0.0276178 4.00064 0.0243905 0.00169789 +EDGE_SE3:QUAT 633 721 -0.840611 -0.248695 -0.00355801 -0.00114534 0.0079056 -0.999863 0.0144772 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 4 -2.93171e-05 -0.00458299 3.99977 0.0317376 0.00109549 +EDGE_SE3:QUAT 634 721 -4.8724 -0.120756 -0.0782367 0.00547202 0.0101616 -0.99989 0.00929185 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 3.99987 0.000223161 0.0218939 4.00009 0.0402359 0.000869939 +EDGE_SE3:QUAT 722 723 4.22188 -0.0777388 0.0249667 0.0029546 0.00496583 0.0047046 0.999972 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 4.00036 6.11423e-05 0.0395614 3.9999 9.46892e-05 4.0003 +EDGE_SE3:QUAT 538 722 6.07403 1.909 0.0726449 -0.000190542 -0.0115777 0.000573198 0.999933 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 4.00215 1.06857e-05 -0.0926633 3.99946 -2.72078e-05 4.00214 +EDGE_SE3:QUAT 539 722 1.81243 1.99695 0.0161233 9.5301e-05 -0.00358406 0.000191077 0.999994 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 4.00021 -1.30761e-06 -0.028674 3.99995 -2.71047e-06 4.00021 +EDGE_SE3:QUAT 540 722 -2.3992 2.08695 -0.00985553 -0.00199801 -0.00178372 0.000673099 0.999996 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 4.00003 1.42859e-05 -0.0142537 3.99999 -4.94772e-06 4.00005 +EDGE_SE3:QUAT 541 722 -6.64933 2.17002 0.0441612 -0.00350438 0.00254244 0.00309498 0.999986 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 4.00006 -3.54596e-05 0.0204695 3.99997 3.11962e-05 4.00007 +EDGE_SE3:QUAT 631 722 3.31927 -0.504586 0.0109256 0.00786494 0.00574632 -0.999567 0.0277508 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 3.99973 0.000144863 0.0314971 4.00092 0.0212034 0.00344111 +EDGE_SE3:QUAT 632 722 -0.998584 -0.422119 -0.00789206 -0.00195759 0.00706485 -0.99968 0.0242006 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 3.99999 -4.73845e-05 -0.00783698 3.99985 0.0285966 0.00256261 +EDGE_SE3:QUAT 633 722 -5.18445 -0.3012 0.0420605 -0.00963711 0.00887713 -0.999708 0.0203224 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 3.99966 -0.000372786 -0.0385754 4.00109 0.0370547 0.00236743 +EDGE_SE3:QUAT 723 724 4.12159 -0.0816414 0.043888 0.00283563 -0.00139272 0.00461528 0.999984 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 4 -1.58737e-05 -0.0112984 3.99999 -2.60587e-05 3.99995 +EDGE_SE3:QUAT 539 723 6.03571 1.92371 0.0708335 0.00316652 0.00141024 0.00461314 0.999983 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 3.99999 1.77064e-05 0.0111062 3.99999 2.563e-05 3.99995 +EDGE_SE3:QUAT 540 723 1.69989 2.03007 0.0291242 0.00109536 0.00317472 0.00561806 0.999979 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 4.00016 1.52098e-05 0.0253236 3.99996 7.13356e-05 4.00003 +EDGE_SE3:QUAT 541 723 -2.4398 2.11843 0.0471362 -0.000271311 0.0076116 0.00752139 0.999943 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 4.00093 2.19605e-06 0.0609245 3.99977 0.000228905 4.0007 +EDGE_SE3:QUAT 542 723 -6.67878 2.16675 0.0511104 -0.000569812 0.00628945 0.0116488 0.999912 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 4.00063 -3.28386e-06 0.050392 3.99984 0.000293218 4.00009 +EDGE_SE3:QUAT 630 723 3.51683 -0.767283 0.0205505 0.0109418 0.00615316 -0.999272 0.0360349 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 3.99949 0.000171681 0.0438529 4.00187 0.0213964 0.00579008 +EDGE_SE3:QUAT 631 723 -0.87646 -0.664547 -0.030371 0.0130129 0.00263876 -0.999389 0.0323469 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 3.99931 5.86265e-06 0.0521294 4.00273 0.00716945 0.00487834 +EDGE_SE3:QUAT 632 723 -5.16437 -0.537986 0.0326635 0.0033526 0.00415636 -0.999568 0.028891 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 3.99995 5.11986e-05 0.0134282 4.00013 0.0158174 0.00344647 +EDGE_SE3:QUAT 724 725 4.42163 -0.0707044 0.0361517 0.0015677 -0.003505 0.00469211 0.999982 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 4.00019 -2.06839e-05 -0.0281285 3.99995 -6.56032e-05 4.00011 +EDGE_SE3:QUAT 540 724 5.80572 1.99029 0.0452305 0.00388449 0.00190704 0.0102565 0.999938 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 3.99999 2.92397e-05 0.0147757 3.99999 7.52771e-05 3.99963 +EDGE_SE3:QUAT 541 724 1.63189 2.09942 0.0281134 0.00264092 0.00636902 0.0120331 0.999904 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 4.00061 7.82037e-05 0.0505663 3.99984 0.000306116 4.00006 +EDGE_SE3:QUAT 542 724 -2.56918 2.17921 0.0460909 0.00226384 0.00515671 0.016102 0.999854 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 4.0004 5.61318e-05 0.0408037 3.9999 0.000328804 3.99938 +EDGE_SE3:QUAT 543 724 -6.67324 2.22184 -0.186809 -0.00173581 -0.0103954 0.0211185 0.999721 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 4.0017 0.000126016 -0.0826979 3.99958 -0.00087693 3.99993 +EDGE_SE3:QUAT 629 724 3.42734 -1.06525 0.00439361 0.00495582 0.00330898 -0.999027 0.0436874 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 3.99989 4.17489e-05 0.019882 4.00038 0.0114456 0.00776619 +EDGE_SE3:QUAT 630 724 -0.584796 -0.974079 -0.0253823 0.00983779 0.00343276 -0.999115 0.040758 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 3.9996 4.10727e-05 0.039449 4.00156 0.0104769 0.00706211 +EDGE_SE3:QUAT 631 724 -4.99979 -0.845036 -0.0893832 0.0116511 -0.000282836 -0.999249 0.0369521 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 3.99946 -0.00013306 0.0466968 4.00216 -0.00457113 0.00601301 +EDGE_SE3:QUAT 725 726 4.49269 -0.0624159 -0.0396326 0.000737085 0.00735732 0.00532617 0.999958 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 4.00086 2.8596e-05 0.05882 3.99978 0.000157644 4.00075 +EDGE_SE3:QUAT 541 725 6.06993 2.12113 0.00786587 0.00417012 0.0027747 0.0172317 0.999839 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 4.00004 4.68547e-05 0.0213255 3.99997 0.000181969 3.99893 +EDGE_SE3:QUAT 542 725 1.82537 2.24981 0.0295721 0.00415721 0.00167261 0.0210294 0.999769 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 3.99997 2.61258e-05 0.012323 3.99999 0.000126113 3.99827 +EDGE_SE3:QUAT 543 725 -2.3644 2.34255 -0.0600207 -0.000137684 -0.0136409 0.0256987 0.999577 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 4.00297 0.000122178 -0.109048 3.99926 -0.0014039 4.00033 +EDGE_SE3:QUAT 544 725 -6.53216 2.38927 -0.0742704 0.00076486 -0.0125102 0.0306751 0.999451 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 4.00251 7.71828e-05 -0.100277 3.99937 -0.00153837 3.99875 +EDGE_SE3:QUAT 628 725 3.41708 -1.46844 -0.038371 -0.00684343 0.0065909 -0.998634 0.0513763 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 3.99985 -0.000212728 -0.0274767 4.00046 0.0290011 0.010958 +EDGE_SE3:QUAT 629 725 -0.945892 -1.37291 -0.00120318 0.00165722 0.00155948 -0.998828 0.0483449 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 3.99999 7.71013e-06 0.00665349 4.00004 0.00556216 0.00936777 +EDGE_SE3:QUAT 630 725 -4.94441 -1.25549 -0.080881 0.00663002 0.00152817 -0.99894 0.0455177 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 3.99982 -7.79364e-06 0.0266029 4.00071 0.0036725 0.00846815 +EDGE_SE3:QUAT 726 727 3.9444 -0.100254 0.0172694 -0.0014746 0.00751754 -0.00538424 0.999956 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 4.00089 -5.15661e-05 0.060054 3.99977 -0.000163676 4.00079 +EDGE_SE3:QUAT 542 726 6.29993 2.37229 -0.0273792 0.00475744 0.00910352 0.0263804 0.999599 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 4.00118 0.000219151 0.0712638 3.99969 0.000942965 3.99849 +EDGE_SE3:QUAT 543 726 2.02604 2.51353 0.0164938 0.000555195 -0.00640291 0.0310309 0.999498 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 4.00066 1.63996e-05 -0.0513633 3.99984 -0.000797406 3.99681 +EDGE_SE3:QUAT 544 726 -2.11153 2.5999 -0.00694539 0.00136304 -0.00540366 0.0359136 0.999339 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 4.00047 -4.2854e-06 -0.0437371 3.99988 -0.000787664 3.99532 +EDGE_SE3:QUAT 545 726 -6.37805 2.63876 0.0601583 0.00436191 -0.000105645 0.0412057 0.999141 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 3.99993 -8.00617e-06 -0.00299734 4 -7.65409e-05 3.99321 +EDGE_SE3:QUAT 626 726 6.89242 -2.03419 0.0690054 0.00521906 0.00401271 -0.998142 0.060578 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 3.99987 4.72387e-05 0.0209978 4.00043 0.0133858 0.0148344 +EDGE_SE3:QUAT 627 726 2.97313 -1.9581 0.00105935 0.00221419 0.00654097 -0.998218 0.0592668 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 3.99997 6.77263e-05 0.00891471 3.99995 0.0248887 0.0142256 +EDGE_SE3:QUAT 628 726 -1.03878 -1.86334 -0.015834 0.000746075 0.00643149 -0.998368 0.0567367 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 3.99999 3.59566e-05 0.00300835 3.99986 0.0251813 0.0130376 +EDGE_SE3:QUAT 629 726 -5.46888 -1.74177 -0.053568 0.0093132 0.00154427 -0.998521 0.0535331 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 3.99965 -5.49228e-05 0.0374128 4.0014 0.00215631 0.0118153 +EDGE_SE3:QUAT 727 728 4.06564 -0.0992559 0.0481946 -0.0018632 0.000994813 -0.0068393 0.999974 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 4 -7.38115e-06 0.00780502 4 -2.65586e-05 3.99983 +EDGE_SE3:QUAT 543 727 6.0598 2.65254 0.0805387 -0.00140909 0.00111251 0.0255304 0.999672 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 4.00001 -5.85213e-06 0.0093229 3.99999 0.000120765 3.99741 +EDGE_SE3:QUAT 544 727 1.79858 2.7805 0.0484844 -0.000598651 0.00210921 0.0304438 0.999534 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 4.00007 -1.81809e-06 0.0170691 3.99998 0.000260761 3.99637 +EDGE_SE3:QUAT 545 727 -2.45882 2.86207 0.0695717 0.002547 0.0075192 0.035688 0.999331 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 4.00084 0.000121586 0.0589593 3.99979 0.00104886 3.99577 +EDGE_SE3:QUAT 546 727 -6.81116 2.90254 0.0927451 0.00305511 0.00740942 0.0416825 0.999099 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 4.00079 0.000139766 0.0576039 3.9998 0.00119337 3.99388 +EDGE_SE3:QUAT 626 727 3.01182 -2.40602 0.0410648 0.0127936 0.00630486 -0.998382 0.0550513 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 3.99929 0.000109873 0.0514105 4.00265 0.019428 0.0128802 +EDGE_SE3:QUAT 627 727 -0.96413 -2.32374 -0.005163 0.00974452 0.00870719 -0.998479 0.0535645 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 3.99955 0.000234925 0.0391562 4.00143 0.0304316 0.0120933 +EDGE_SE3:QUAT 628 727 -4.93871 -2.20893 -0.00920224 0.00818362 0.00827813 -0.998621 0.051188 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 3.99968 0.000205746 0.0328724 4.00096 0.0295644 0.0109709 +EDGE_SE3:QUAT 728 729 4.09007 -0.104314 0.028185 -0.00142944 -0.00690489 -0.00662086 0.999953 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 4.00076 3.20102e-05 -0.0553582 3.99981 0.000181831 4.00059 +EDGE_SE3:QUAT 544 728 5.7976 2.92629 0.07447 -0.0022006 0.00305096 0.0238665 0.999708 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 4.00014 -2.22105e-05 0.0250175 3.99996 0.000300482 3.99788 +EDGE_SE3:QUAT 545 728 1.5413 3.04858 0.0533761 0.000775604 0.00846966 0.0290958 0.99954 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 4.00113 7.58391e-05 0.0674172 3.99972 0.000981107 3.99775 +EDGE_SE3:QUAT 546 728 -2.65706 3.1316 0.0783218 0.00128057 0.00830277 0.0348377 0.999358 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 4.00107 9.88175e-05 0.0657816 3.99973 0.00114494 3.99623 +EDGE_SE3:QUAT 625 728 3.40389 -2.84298 0.021939 0.00741568 0.00627746 -0.998742 0.0491997 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 3.99975 0.000129842 0.0297761 4.00083 0.022053 0.0100266 +EDGE_SE3:QUAT 626 728 -1.05246 -2.74762 -0.0192368 0.0137066 0.00781658 -0.998702 0.0484369 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 3.99918 0.000219462 0.0550219 4.00299 0.0258105 0.0103102 +EDGE_SE3:QUAT 627 728 -5.04605 -2.65531 -0.0390111 0.0106142 0.0104854 -0.998777 0.0471443 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 3.99947 0.000344151 0.0426085 4.00161 0.0377379 0.00970207 +EDGE_SE3:QUAT 729 730 3.9867 -0.10375 0.0243296 0.00199567 -0.0105669 -0.0036153 0.999936 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 4.00177 -9.40432e-05 -0.0844791 3.99955 0.000158176 4.00173 +EDGE_SE3:QUAT 545 729 5.72077 3.17407 0.0127709 -0.000242289 0.00156193 0.0222989 0.99975 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 4.00004 -2.07769e-07 0.012551 3.99999 0.000140133 3.99805 +EDGE_SE3:QUAT 546 729 1.37816 3.30738 0.0360641 2.70824e-05 0.00136472 0.028252 0.9996 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 4.00003 1.4068e-06 0.0108956 3.99999 0.000153811 3.99684 +EDGE_SE3:QUAT 547 729 -2.67872 3.39093 0.0471842 0.00094529 0.00450121 0.0352824 0.999367 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 4.00031 3.35539e-05 0.0355449 3.99992 0.000624888 3.99534 +EDGE_SE3:QUAT 624 729 3.84088 -3.25761 -0.000861024 0.00477918 0.00696889 -0.999199 0.0391192 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 3.99989 0.000123714 0.0191647 4.00023 0.0262787 0.00638612 +EDGE_SE3:QUAT 625 729 -0.743275 -3.14438 -0.0111615 0.000585833 0.00757854 -0.999062 0.042639 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 3.99999 3.63226e-05 0.00235474 3.99979 0.0299763 0.00749881 +EDGE_SE3:QUAT 626 729 -5.18153 -3.03839 -0.104039 0.00685335 0.00908158 -0.999057 0.0419049 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 3.99977 0.000222472 0.0274926 4.00055 0.033882 0.00750088 +EDGE_SE3:QUAT 730 731 3.99996 -0.0953483 0.01364 0.000708409 0.00611085 -0.000871951 0.999981 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 4.0006 1.65467e-05 0.0489005 3.99985 -2.06937e-05 4.00059 +EDGE_SE3:QUAT 546 730 5.39549 3.41766 0.0428337 0.00212161 -0.00886755 0.0247497 0.999652 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 4.00126 -2.88162e-05 -0.0715248 3.99968 -0.000884119 3.99883 +EDGE_SE3:QUAT 547 730 1.30334 3.55114 0.0345965 0.00347084 -0.00574722 0.0314989 0.999481 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 4.00051 -5.66564e-05 -0.0472255 3.99986 -0.000747696 3.99659 +EDGE_SE3:QUAT 548 730 -3.09608 3.68619 -0.0779783 -0.00304401 -0.0108507 0.0308445 0.999461 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 4.00179 0.000215091 -0.0855886 3.99955 -0.00132356 3.99802 +EDGE_SE3:QUAT 623 730 3.94335 -3.694 -0.0540794 -0.00364937 0.00712918 -0.999891 0.0124201 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 3.99995 -0.00010274 -0.0146018 3.99999 0.0288695 0.000878732 +EDGE_SE3:QUAT 624 730 -0.15878 -3.46417 -0.0165422 -0.00604402 0.00432169 -0.999337 0.0356461 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 3.99987 -0.000128291 -0.0242211 4.00046 0.0189567 0.00531935 +EDGE_SE3:QUAT 625 730 -4.73086 -3.36705 0.00731729 -0.00969873 0.00549038 -0.99917 0.0391683 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 3.99966 -0.000286848 -0.0388827 4.00128 0.0249238 0.00667059 +EDGE_SE3:QUAT 731 732 4.25208 -0.0325579 0.0597504 0.00306077 0.0146437 0.0252384 0.99957 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 4.00333 0.000305963 0.116195 3.99916 0.00148073 4.00082 +EDGE_SE3:QUAT 547 731 5.30009 3.69571 0.0933297 0.0039918 0.000215508 0.0305176 0.999526 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 3.99994 -4.5024e-07 0.000260699 4 -3.46935e-06 3.99627 +EDGE_SE3:QUAT 548 731 0.869836 3.83974 0.0201045 -0.00244214 -0.00465605 0.0296613 0.999546 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 4.00031 5.88549e-05 -0.0363327 3.99992 -0.000535638 3.99681 +EDGE_SE3:QUAT 549 731 -2.82914 4.08668 -0.0601953 -0.00626821 -0.00429112 -0.0181179 0.999807 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 4.00016 0.000104732 -0.0356751 3.99992 0.00032436 3.99901 +EDGE_SE3:QUAT 622 731 3.32176 -4.1329 -0.0499397 -0.00767477 -0.0136487 0.996838 0.0779041 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 3.99989 0.000374548 0.0309348 3.99983 0.0585291 0.0253778 +EDGE_SE3:QUAT 623 731 -0.0509685 -3.68386 -0.00874469 0.00255201 0.00658053 -0.999911 0.011293 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 3.99997 6.91834e-05 0.0102107 3.99994 0.0260836 0.000706308 +EDGE_SE3:QUAT 624 731 -4.16333 -3.63781 0.047498 0.000121562 0.00395351 -0.999394 0.0345902 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 4 6.17525e-06 0.000488457 3.99994 0.015733 0.00484794 +EDGE_SE3:QUAT 732 733 4.21828 0.174148 0.0166697 0.00302388 -0.00519247 0.0848936 0.996372 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 4.00045 -7.4347e-06 -0.0441616 3.99988 -0.00191012 3.97166 +EDGE_SE3:QUAT 548 732 5.12587 4.05595 0.122155 7.97697e-05 0.0100894 0.0547724 0.998448 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 4.00161 0.000136211 0.0803282 3.9996 0.00219862 3.98961 +EDGE_SE3:QUAT 549 732 1.43576 3.89848 0.0391024 -0.00323956 0.0103646 0.00686626 0.999917 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 4.00169 -0.000117273 0.0832078 3.99957 0.000277886 4.00154 +EDGE_SE3:QUAT 550 732 -1.99816 4.10997 0.0218707 -0.00164014 0.0039511 -0.0881292 0.9961 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 4.00021 -5.34513e-05 0.0295169 3.99995 -0.00127049 3.96915 +EDGE_SE3:QUAT 551 732 -4.93494 5.44788 0.0842236 0.00208144 0.0091804 -0.248143 0.968678 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 4.0013 -0.000434379 0.07273 3.99976 -0.00899012 3.75502 +EDGE_SE3:QUAT 620 732 5.18965 -5.13207 -0.0251606 -0.00557028 -0.00679164 0.931523 0.363576 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 4.00001 2.2418e-05 0.0236338 3.9998 0.0326756 0.529197 +EDGE_SE3:QUAT 621 732 2.46929 -3.82089 -0.0399119 -0.00401333 -0.0108216 0.978392 0.206438 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 4 -2.30541e-05 0.0162855 3.99951 0.0450863 0.171064 +EDGE_SE3:QUAT 622 732 -0.877743 -3.43444 -0.0498924 -0.0223312 -0.00938744 0.998309 0.0528458 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 3.99822 0.00140002 0.0896941 4.00705 0.0468267 0.0137359 +EDGE_SE3:QUAT 623 732 -4.3024 -3.74692 0.0252407 0.0174284 0.00367452 -0.999179 0.0363959 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 3.99876 -9.31714e-06 0.0698423 4.0049 0.00959548 0.00654317 +EDGE_SE3:QUAT 733 734 4.25313 0.499846 0.0219355 -0.00103074 -0.00554331 0.154717 0.987943 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 4.00041 0.000122285 -0.040884 3.99991 -0.00307322 3.90467 +EDGE_SE3:QUAT 549 733 5.62544 4.12989 -0.0295591 0.000609982 0.00542122 0.0918038 0.995762 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 4.00044 7.49651e-05 0.0421584 3.99989 0.00191742 3.96673 +EDGE_SE3:QUAT 550 733 2.17063 3.53641 0.00255449 0.00121516 -0.00127209 -0.00348735 0.999992 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 4.00002 -6.27635e-06 -0.0101257 3.99999 1.76734e-05 3.99998 +EDGE_SE3:QUAT 551 733 -1.15393 3.5686 0.0171552 0.00456367 0.00328849 -0.16537 0.986216 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 4.00021 1.79095e-05 0.034129 3.99992 -0.00303973 3.8909 +EDGE_SE3:QUAT 552 733 -3.71861 4.77497 -0.00821171 0.005885 0.00256196 -0.362883 0.931813 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 4.00026 -4.95865e-05 0.0399636 3.99991 -0.00851535 3.47366 +EDGE_SE3:QUAT 619 733 5.27752 -3.58631 -0.013746 -0.00364343 -0.00324002 0.903046 0.429516 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 4.00001 1.81909e-05 0.0159633 3.99995 0.0175949 0.738096 +EDGE_SE3:QUAT 620 733 1.98405 -2.40226 -0.0345815 -0.000373903 -0.00544986 0.958885 0.283741 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 3.99997 -4.45179e-05 0.000668925 3.99993 0.018318 0.32213 +EDGE_SE3:QUAT 621 733 -1.44681 -2.26881 -0.0371287 0.000612245 -0.0088157 0.992401 0.122731 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 3.99997 -8.65548e-05 -0.00263483 3.99976 0.0333492 0.060536 +EDGE_SE3:QUAT 622 733 -5.08739 -3.15219 -0.215161 0.0175956 0.00509999 -0.99933 0.0316963 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 3.99873 0.000125897 0.0704787 4.00498 0.0159169 0.00532542 +EDGE_SE3:QUAT 734 735 4.11979 0.559263 -0.0082947 0.00173831 0.000695036 0.1706 0.985339 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 3.99999 9.30516e-07 0.00182968 4 4.78806e-05 3.88358 +EDGE_SE3:QUAT 551 734 3.02793 2.64102 0.0111507 0.00298425 -0.00268155 -0.0106878 0.999935 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 4.00008 -3.30368e-05 -0.0210663 3.99997 0.000112396 3.99965 +EDGE_SE3:QUAT 552 734 -0.255705 2.23755 -0.0150742 0.00307983 -0.00304605 -0.214553 0.976703 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 4.00002 -4.19861e-05 -0.0150189 4 0.0012661 3.81592 +EDGE_SE3:QUAT 553 734 -3.23695 3.39161 -0.0169106 -0.00140448 -0.00205736 -0.46459 0.885522 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 4.00007 -4.86212e-05 -0.0181326 4 0.00432058 3.1367 +EDGE_SE3:QUAT 618 734 6.12846 -1.6482 -0.00269303 0.00105 -0.00418308 0.915559 0.402161 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 3.99996 9.98334e-06 -0.00726576 4.00008 0.00753254 0.646974 +EDGE_SE3:QUAT 619 734 2.20502 -0.590252 -0.0128585 0.000352174 -0.00581503 0.958732 0.284253 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 3.99996 -4.76312e-05 -0.00263745 3.99997 0.0179609 0.323292 +EDGE_SE3:QUAT 620 734 -1.86349 -0.490765 -0.00863077 0.00378429 -0.00776705 0.991212 0.131999 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 3.99988 -0.000100221 -0.0156709 4.00019 0.0257993 0.0699283 +EDGE_SE3:QUAT 621 734 -5.70148 -1.69646 -0.011563 -0.00475235 0.0102815 -0.999417 0.0321976 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 3.99993 -0.000182528 -0.0190391 3.99987 0.0422442 0.00468404 +EDGE_SE3:QUAT 735 736 4.05189 0.533347 0.00462661 -0.000833785 0.00695402 0.160976 0.986933 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 4.00076 0.000163432 0.0550757 3.99983 0.00441832 3.8971 +EDGE_SE3:QUAT 552 735 3.70806 1.01239 -0.00464389 0.00440555 -0.00318561 -0.0446049 0.99899 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 4.00006 -5.83182e-05 -0.0230538 3.99997 0.000497022 3.99217 +EDGE_SE3:QUAT 553 735 -0.446502 0.324936 -0.00597272 8.94374e-07 -0.00179281 -0.306725 0.951796 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 4.00004 -1.96933e-05 -0.0123639 4 0.00178516 3.62372 +EDGE_SE3:QUAT 554 735 -4.17126 1.63276 -0.0398064 0.00539395 -0.00472399 -0.533244 0.845931 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 3.99984 6.55102e-05 0.00509411 3.99997 -0.00603494 2.86256 +EDGE_SE3:QUAT 617 735 7.18352 0.370528 0.0230206 5.16367e-05 -5.37034e-06 0.954785 0.297298 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 4 1.63046e-08 -0.000233197 4 -9.50725e-05 0.353544 +EDGE_SE3:QUAT 618 735 2.92249 0.996546 0.00298574 0.000435185 -0.00237475 0.970751 0.240075 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 3.99999 -7.65399e-06 -0.0021475 4 0.00737065 0.23056 +EDGE_SE3:QUAT 619 735 -1.538 1.19225 -0.0079556 -0.000777981 -0.00420843 0.99318 0.116509 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 4 -3.56445e-06 0.00312141 3.99993 0.0169803 0.0543727 +EDGE_SE3:QUAT 620 735 -5.9761 0.0572016 0.0153477 -0.00187709 0.00674566 -0.999208 0.0391794 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 3.99999 -3.85434e-05 -0.00752283 3.99985 0.0274663 0.00634314 +EDGE_SE3:QUAT 736 737 4.16822 0.476717 0.034335 -0.00404513 -0.00133878 0.133025 0.991104 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 3.99994 5.13724e-06 -0.00404597 4 -0.000119622 3.92922 +EDGE_SE3:QUAT 553 736 3.1579 -1.61112 0.0126866 0.00120695 0.00519548 -0.149122 0.988804 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 4.00044 -7.47752e-05 0.0423171 3.9999 -0.00317397 3.9115 +EDGE_SE3:QUAT 554 736 -1.9488 -1.79998 -0.0139334 0.00766484 0.000803504 -0.390166 0.920712 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 4.0001 3.53766e-05 0.0372639 3.99989 -0.00946516 3.39141 +EDGE_SE3:QUAT 555 736 -6.46863 0.426952 0.0590903 0.00118954 0.0024157 -0.600888 0.799329 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 4.00006 -6.82344e-05 0.0163829 4.00003 -0.00436018 2.5558 +EDGE_SE3:QUAT 617 736 3.54047 2.23308 0.0291612 -0.00679111 0.00124138 0.990189 0.139563 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 3.99983 0.000124018 0.0279729 4.00074 0.00271046 0.0781123 +EDGE_SE3:QUAT 618 736 -0.903687 2.42288 0.0166697 -0.0070814 -0.00176216 0.996714 0.0806703 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 3.99983 0.000138788 0.0285934 4.00073 0.0114778 0.0262695 +EDGE_SE3:QUAT 619 736 -5.58616 1.62141 -0.0102395 0.00842202 0.00413529 -0.998966 0.044487 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 3.9997 6.56006e-05 0.0337898 4.00114 0.013473 0.00824789 +EDGE_SE3:QUAT 737 738 4.26914 0.408802 0.0301531 0.000893632 -0.00176708 0.11291 0.993603 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 4.00005 2.5398e-06 -0.0150679 3.99999 -0.000868257 3.94906 +EDGE_SE3:QUAT 554 737 1.29235 -4.46527 -0.00539994 0.00338916 -3.01968e-05 -0.264392 0.964409 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 3.99998 1.68907e-05 0.010035 3.99999 -0.00180032 3.72041 +EDGE_SE3:QUAT 555 737 -4.86443 -3.44014 0.06457 -0.00238085 0.00342605 -0.489162 0.872183 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 3.99997 -1.86151e-05 0.00643877 4.00001 0.000479515 3.04288 +EDGE_SE3:QUAT 616 737 3.73721 2.82676 0.0217057 -0.00628615 -0.00246398 0.999759 0.0208982 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 3.99985 8.03491e-05 0.0251607 4.00059 0.010898 0.00193497 +EDGE_SE3:QUAT 617 737 -0.582198 2.94793 -0.000539841 -0.00588222 -0.00198171 0.99996 0.00639431 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 3.99986 5.17284e-05 0.0235301 4.00053 0.00822846 0.000318899 +EDGE_SE3:QUAT 618 737 -5.08174 2.62858 -0.0131237 0.00599679 0.00473431 -0.998594 0.0524632 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 3.99983 7.28682e-05 0.0240913 4.00055 0.0163003 0.0112217 +EDGE_SE3:QUAT 738 739 4.04383 0.205779 0.0252 -0.00646333 -0.00463911 0.0511483 0.998659 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 4.0001 0.000124346 -0.0330067 3.99994 -0.000811994 3.98981 +EDGE_SE3:QUAT 555 738 -2.31201 -6.8599 0.0792482 -0.00226936 0.00167372 -0.387385 0.921914 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 3.99997 2.48752e-06 0.00099768 4 0.000696648 3.39973 +EDGE_SE3:QUAT 615 738 3.72085 2.52079 0.0118994 0.00556547 0.000546221 -0.995563 0.0939263 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 3.99988 -5.80286e-05 0.0225578 4.00049 -0.00200876 0.0354179 +EDGE_SE3:QUAT 616 738 -0.524937 2.61488 0.00208974 0.00488186 0.00102398 -0.995749 0.0919679 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 3.9999 -3.37349e-05 0.0197797 4.00039 0.000448092 0.0339311 +EDGE_SE3:QUAT 617 738 -4.84572 2.60012 -0.020315 0.0042922 0.000243594 -0.994319 0.106353 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 3.99993 -4.25734e-05 0.0174598 4.00029 -0.00266403 0.0453226 +EDGE_SE3:QUAT 739 740 4.12896 -0.124645 -0.00899146 0.00347464 0.015214 -0.0183768 0.999709 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 4.0037 0.000110636 0.122515 3.99906 -0.00111113 4.0024 +EDGE_SE3:QUAT 614 739 4.11973 1.49017 -0.00110367 -0.00140849 0.00657977 -0.989144 0.146798 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 4 1.46803e-05 -0.00564661 3.99982 0.0265297 0.0863861 +EDGE_SE3:QUAT 615 739 -0.200006 1.56886 -0.0046818 0.000441131 0.00635444 -0.989462 0.144653 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 3.99998 4.92531e-05 0.0019732 3.99989 0.0235979 0.083841 +EDGE_SE3:QUAT 616 739 -4.46879 1.6808 -0.0110674 -0.000147005 0.00692467 -0.989727 0.142804 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 3.99999 4.69544e-05 -0.000444107 3.99983 0.0264607 0.0817507 +EDGE_SE3:QUAT 740 741 4.05025 -0.217123 0.0175392 -0.00252791 -0.0034712 -0.0515037 0.998664 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 4.00019 2.13994e-05 -0.0292199 3.99995 0.000764233 3.9896 +EDGE_SE3:QUAT 613 740 4.33888 0.312573 0.0316918 0.00707779 0.00668899 -0.991409 0.130437 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 3.99972 3.00102e-05 0.0291419 4.00089 0.0183701 0.0683588 +EDGE_SE3:QUAT 614 740 0.22375 0.413645 -0.000264187 0.0140081 0.0050636 -0.991588 0.128577 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 3.99918 -0.000352716 0.0574834 4.00332 0.00525266 0.0669759 +EDGE_SE3:QUAT 615 740 -4.11247 0.51748 -0.0178448 0.0160687 0.00460324 -0.991804 0.126669 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 3.99895 -0.000520834 0.0658679 4.0043 0.00165212 0.0652838 +EDGE_SE3:QUAT 741 742 4.24065 -0.366175 0.0126544 -4.14434e-05 0.000824977 -0.0638819 0.997957 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 4.00001 -1.16267e-06 0.00652779 4 -0.000207736 3.98369 +EDGE_SE3:QUAT 612 741 4.62132 -0.600304 0.00619205 0.0031709 0.0102382 -0.996675 0.0807733 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 3.99991 0.000162896 0.0128521 3.99988 0.0382524 0.0265074 +EDGE_SE3:QUAT 613 741 0.363011 -0.510968 -0.00579373 0.00301367 0.00905996 -0.996792 0.0794666 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 3.99992 0.000131844 0.012206 3.99993 0.0337666 0.0255843 +EDGE_SE3:QUAT 614 741 -3.72355 -0.398182 -0.095942 0.010192 0.00750573 -0.996924 0.0773397 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 3.99951 0.000120504 0.0411578 4.0017 0.0233201 0.024489 +EDGE_SE3:QUAT 742 743 4.19336 -0.232039 0.0104495 0.000988302 -0.00075724 -0.0356702 0.999363 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 4 -3.14529e-06 -0.00562369 4 9.77278e-05 3.99492 +EDGE_SE3:QUAT 611 742 4.82326 -1.01041 0.00902893 0.00387218 0.00998194 -0.999787 0.0176245 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 3.99993 0.000161538 0.0154985 3.99987 0.0393527 0.00168985 +EDGE_SE3:QUAT 612 742 0.351648 -0.906637 -0.00724679 0.00326817 0.010388 -0.99979 0.017355 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 3.99995 0.000145656 0.0130811 3.99977 0.0410677 0.00166937 +EDGE_SE3:QUAT 613 742 -3.8868 -0.815334 -0.020378 0.0032559 0.00903355 -0.999832 0.0155955 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 3.99995 0.000123397 0.0130301 3.99987 0.035707 0.00133416 +EDGE_SE3:QUAT 743 744 4.1627 -0.186763 0.0185246 -7.9178e-08 0.00107222 -0.0191814 0.999815 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 4.00002 -5.29236e-07 0.00857307 4 -8.22075e-05 3.99855 +EDGE_SE3:QUAT 610 743 4.99471 -1.02518 0.0192183 -0.00558521 -0.00947081 0.999752 0.0193622 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 3.99989 0.000210976 0.0223557 4.00009 0.0387169 0.00199943 +EDGE_SE3:QUAT 611 743 0.599265 -0.919604 -0.0089167 -0.00275167 -0.00913566 0.999794 0.0179308 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 3.99998 9.13294e-05 0.0110128 3.99977 0.0369076 0.00165705 +EDGE_SE3:QUAT 612 743 -3.81578 -0.81422 -0.01722 -0.00222242 -0.00946974 0.999777 0.0187499 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 3.99999 7.24902e-05 0.00889497 3.9997 0.038178 0.00179056 +EDGE_SE3:QUAT 744 745 4.2349 -0.125718 0.0219729 0.00299388 -0.000154213 -0.00702956 0.999971 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 3.99996 -1.34535e-06 -0.000981059 4 3.15341e-06 3.9998 +EDGE_SE3:QUAT 609 744 5.27494 -0.796622 0.0202168 -0.00500174 -0.00769117 0.999029 0.0430893 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 3.99993 0.000154899 0.0200595 4.00009 0.0323457 0.00778952 +EDGE_SE3:QUAT 610 744 0.858706 -0.672901 -0.00450044 -0.00644075 -0.00945577 0.999187 0.0386503 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 3.99987 0.000248778 0.0258199 4.00019 0.0396764 0.00653634 +EDGE_SE3:QUAT 611 744 -3.54255 -0.576589 -0.0123293 -0.00377322 -0.00931804 0.999261 0.0370936 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 3.99996 0.000124575 0.0151221 3.99982 0.0382628 0.00592747 +EDGE_SE3:QUAT 745 746 4.21796 -0.117722 0.0207168 0.00287602 -0.00191083 -0.00240326 0.999991 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 4.00002 -2.20326e-05 -0.0152036 3.99999 1.84863e-05 4.00003 +EDGE_SE3:QUAT 608 745 5.37408 -0.491823 0.0204482 -0.00515115 -0.00784576 0.997976 0.0628891 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 3.99993 0.000160828 0.0207129 4.00006 0.0336572 0.016212 +EDGE_SE3:QUAT 609 745 1.05935 -0.303754 0.00416076 -0.00459391 -0.00485279 0.998721 0.0501171 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 3.99993 0.000101548 0.0184406 4.00019 0.0211285 0.010244 +EDGE_SE3:QUAT 610 745 -3.38471 -0.213821 -0.0284826 -0.00610507 -0.00649533 0.998923 0.0455445 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 3.99988 0.000178779 0.0244929 4.00034 0.028071 0.0086448 +EDGE_SE3:QUAT 746 747 3.96393 -0.0756146 0.0172075 0.00317485 0.00079293 0.0162939 0.999862 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 3.99997 8.96027e-06 0.00572017 4 4.49501e-05 3.99895 +EDGE_SE3:QUAT 607 746 5.42881 -0.0719165 0.0258248 -0.00395374 -0.00568922 0.996533 0.0829132 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 3.99997 9.00598e-05 0.0159522 4.00003 0.0249723 0.0277193 +EDGE_SE3:QUAT 608 746 1.25254 0.146772 0.00309074 -0.00314689 -0.00491405 0.997826 0.0656386 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 3.99998 6.06551e-05 0.012658 4.00001 0.0210908 0.0173855 +EDGE_SE3:QUAT 609 746 -3.07093 0.232583 -0.00923181 -0.00282215 -0.00191409 0.998583 0.0531104 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 3.99997 2.91997e-05 0.011334 4.0001 0.00879847 0.0113345 +EDGE_SE3:QUAT 747 748 4.1367 0.133149 0.0191462 -0.00227686 -0.00496235 0.0785666 0.996894 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 4.00032 8.3515e-05 -0.0371963 3.99992 -0.00142982 3.97565 +EDGE_SE3:QUAT 606 747 5.62303 -0.0216901 0.0305521 -0.00489465 -0.00434896 0.990015 0.140813 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 3.99996 0.000117301 0.0200561 4.00016 0.0219458 0.0795371 +EDGE_SE3:QUAT 607 747 1.53536 0.660298 0.0135653 -0.00459427 -0.00216534 0.997758 0.0667299 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 3.99993 6.80578e-05 0.0184944 4.00028 0.011008 0.0179278 +EDGE_SE3:QUAT 608 747 -2.6455 0.74397 0.0049633 -0.00389844 -0.00184912 0.998779 0.0492082 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 3.99995 4.42643e-05 0.0156486 4.00021 0.00888341 0.00976693 +EDGE_SE3:QUAT 609 747 -6.98399 0.729653 -0.0115917 -0.00353709 0.00171039 0.999339 0.0361539 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 3.99995 -1.37089e-05 0.0141766 4.0002 -0.00579789 0.00528713 +EDGE_SE3:QUAT 748 749 4.27628 0.616618 0.00421387 0.00136683 0.0147563 0.188865 0.981891 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 4.00295 0.00095805 0.108833 3.99942 0.0100044 3.86027 +EDGE_SE3:QUAT 605 748 6.15669 -0.284755 -0.0527592 0.00938916 -0.00858929 0.97783 0.209012 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 3.9995 0.000200453 -0.0405583 4.00178 0.0156559 0.175245 +EDGE_SE3:QUAT 606 748 1.62128 1.00466 0.0128198 -0.000329096 -0.00714583 0.998026 0.0624 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 4 -1.6061e-05 0.00131008 3.9998 0.0284684 0.0157789 +EDGE_SE3:QUAT 607 748 -2.57408 1.08127 -0.00441433 -9.39292e-05 0.00472064 -0.999914 0.0122557 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 4 4.11512e-07 -0.000375734 3.99991 0.0188845 0.000690016 +EDGE_SE3:QUAT 608 748 -6.80749 1.02613 -0.00900599 -0.00112202 0.00423971 -0.999547 0.0297824 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 4 -1.53906e-05 -0.00449325 3.99994 0.0171883 0.00362694 +EDGE_SE3:QUAT 749 750 4.07218 0.675834 0.00455054 0.00167986 -0.00177132 0.194271 0.980945 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 4.00006 4.98882e-06 -0.0171939 3.99998 -0.00177003 3.84911 +EDGE_SE3:QUAT 487 749 2.24433 -7.00847 0.0452911 -0.00410841 0.00334476 0.78101 0.624495 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 4.00011 0.000273565 0.0293651 4.00023 0.010224 1.56026 +EDGE_SE3:QUAT 604 749 6.41943 -0.603441 0.0393 -0.00391851 -0.00864365 0.981694 0.190231 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 4 2.98898e-05 0.0160266 3.99972 0.0372329 0.145175 +EDGE_SE3:QUAT 605 749 2.00379 0.904567 0.0364454 -0.00646227 -0.00572263 0.999753 0.020462 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 3.99985 0.000162149 0.0258659 4.0005 0.0239288 0.00198528 +EDGE_SE3:QUAT 606 749 -2.6505 0.9264 0.0051428 0.0164838 0.00431873 -0.991714 0.127328 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 3.99891 -0.000576098 0.0675805 4.0045 5.27416e-05 0.0660106 +EDGE_SE3:QUAT 607 749 -6.80742 0.366439 -0.0090799 0.015606 0.00303547 -0.979501 0.200813 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 3.9992 -0.0010045 0.0662792 4.00384 -0.0131525 0.162486 +EDGE_SE3:QUAT 750 751 4.2522 0.714861 0.00976297 -0.000762961 -0.00221073 0.177747 0.984074 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 4.00006 2.23856e-05 -0.0152614 3.99999 -0.00128286 3.87368 +EDGE_SE3:QUAT 486 750 5.40721 -2.77748 0.00873548 -0.00215738 -0.000178476 0.930161 0.367146 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 4 2.99175e-05 0.0101202 4.00004 0.00596758 0.539221 +EDGE_SE3:QUAT 487 750 0.694499 -3.18592 0.00424968 -0.000868595 0.00421448 0.887494 0.460799 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 3.99996 2.10929e-05 0.00769174 4.00008 -0.00608574 0.849384 +EDGE_SE3:QUAT 488 750 -4.77545 -2.10789 -0.0166729 -0.00173724 0.00565117 0.769676 0.638408 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 4.00002 0.000207823 0.0214716 4.00023 0.00204148 1.63043 +EDGE_SE3:QUAT 603 750 6.57106 -1.21739 0.0185976 -0.00373446 -0.00669389 0.987195 0.159336 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 3.99999 6.06065e-05 0.0152802 3.99988 0.0297307 0.101837 +EDGE_SE3:QUAT 604 750 2.39237 0.299197 0.0134762 0.00310405 0.00657936 -0.999964 0.00428177 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 3.99996 8.21635e-05 0.0124173 3.99999 0.0262108 0.000283634 +EDGE_SE3:QUAT 605 750 -2.06064 0.39809 -0.0197477 0.00544898 0.0026568 -0.984719 0.174047 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 3.99987 -7.79959e-05 0.0228751 4.00053 0.00247381 0.121306 +EDGE_SE3:QUAT 606 750 -6.43856 -0.741563 -0.12865 0.0152424 -0.000663751 -0.948016 0.317858 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 3.99978 -0.00143632 0.06934 4.00254 -0.0368978 0.40577 +EDGE_SE3:QUAT 682 750 2.26502 5.29782 0.116847 0.0104166 0.00618001 -0.626987 0.778936 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 4.00119 -0.00118153 0.0812403 4.00028 -0.0288509 2.42918 +EDGE_SE3:QUAT 683 750 -3.56524 5.20773 0.151454 0.0119498 0.00893326 -0.503582 0.863818 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 4.00224 -0.00142526 0.106159 3.99989 -0.0298321 2.98843 +EDGE_SE3:QUAT 751 752 4.48942 0.513217 0.0280303 -0.00620561 0.00919048 0.11259 0.99358 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 4.00146 7.57651e-06 0.0804697 3.99959 0.00465076 3.95091 +EDGE_SE3:QUAT 485 751 6.02576 -0.271365 -0.0180723 0.00142224 0.000112639 0.985413 0.170173 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 3.99999 8.16402e-06 -0.00592624 4.00003 -0.00229845 0.115846 +EDGE_SE3:QUAT 486 751 1.82456 -0.353691 0.00520632 -0.000158044 -0.00106063 0.980688 0.195577 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 4 -1.07705e-06 0.000603917 4 0.00408013 0.153007 +EDGE_SE3:QUAT 487 751 -2.30619 -0.0652843 -0.00345372 0.00120912 0.00227504 0.95541 0.295271 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 4 -1.86738e-06 -0.00495806 3.99998 -0.00978546 0.348772 +EDGE_SE3:QUAT 488 751 -6.20165 1.97527 -0.0443421 0.000113495 0.00357547 0.870892 0.491462 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 3.99997 -4.52756e-06 0.00280903 4.00002 -0.00677709 0.966166 +EDGE_SE3:QUAT 602 751 6.3201 -1.58178 -0.0216564 0.000924545 -0.000336539 0.994363 0.106022 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 4 1.01585e-06 -0.00376322 4.00001 0.000533116 0.0449662 +EDGE_SE3:QUAT 603 751 2.30695 -0.539739 -0.00216923 0.00268785 0.00694458 -0.999797 0.0187141 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 3.99997 7.82138e-05 0.0107581 3.99994 0.0273523 0.00161693 +EDGE_SE3:QUAT 604 751 -1.86154 -0.419165 -0.0143133 0.00213163 0.00683707 -0.983256 0.182091 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 3.99993 6.78197e-05 0.00927042 4.00005 0.0221066 0.132779 +EDGE_SE3:QUAT 605 751 -5.82712 -1.71206 -0.0629552 0.00345785 0.00195904 -0.937936 0.346785 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 3.99997 -9.19632e-05 0.016747 4.00021 -0.00285778 0.481118 +EDGE_SE3:QUAT 682 751 3.83733 1.26477 0.0365866 0.00931591 0.00291024 -0.47785 0.878387 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 4.00058 -0.000231339 0.0610809 3.99983 -0.0179696 3.08756 +EDGE_SE3:QUAT 683 751 -0.878697 1.81764 0.0472973 0.011417 0.00512484 -0.341645 0.939746 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 4.00095 -0.000144204 0.0772195 3.99963 -0.015379 3.53459 +EDGE_SE3:QUAT 684 751 -5.21711 1.29109 -0.156574 0.0123517 -0.012993 -0.242189 0.970063 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 4.00023 -0.000732957 -0.060418 3.99996 0.00551371 3.76622 +EDGE_SE3:QUAT 752 753 4.37219 0.101325 -0.00303816 -0.000961869 0.000767485 0.0309691 0.99952 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 4.00001 -2.69883e-06 0.00648829 4 0.000102253 3.99617 +EDGE_SE3:QUAT 484 752 5.76819 0.711614 0.0414731 -0.0047838 -0.00401556 0.998667 0.0512284 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 3.99993 9.51109e-05 0.0192066 4.00025 0.0179142 0.0106703 +EDGE_SE3:QUAT 485 752 1.6361 0.770823 0.0233496 -0.00881667 -0.00453464 0.998283 0.0577234 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 3.99973 0.000249279 0.0354366 4.00104 0.0220543 0.0137648 +EDGE_SE3:QUAT 486 752 -2.50732 0.907613 0.0297808 -0.0106703 -0.00520847 0.996419 0.0837153 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 3.99964 0.000406144 0.043106 4.00146 0.0275816 0.0286916 +EDGE_SE3:QUAT 487 752 -6.2908 2.06376 0.0342667 -0.00891381 -0.000634954 0.982596 0.185538 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 3.99978 0.000341931 0.0374171 4.00109 0.0151065 0.138115 +EDGE_SE3:QUAT 601 752 5.98589 -1.57291 0.0247781 -0.00384383 -0.00648778 0.998809 0.0482028 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 3.99996 9.70162e-05 0.015424 4.00001 0.0272805 0.00954008 +EDGE_SE3:QUAT 602 752 1.81732 -1.11317 0.0166548 0.00910566 0.00571383 -0.999919 0.00687256 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 3.99966 0.000196303 0.0364253 4.00121 0.0223619 0.000645635 +EDGE_SE3:QUAT 603 752 -2.1495 -1.18868 -0.00797564 0.0127369 0.0131114 -0.991196 0.131138 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 3.99907 0.000160828 0.0524743 4.00289 0.0371087 0.0698442 +EDGE_SE3:QUAT 604 752 -5.86829 -2.4961 -0.0247877 0.0108867 0.0139948 -0.956323 0.291774 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 3.99915 -0.000564426 0.0515091 4.00296 0.021191 0.341412 +EDGE_SE3:QUAT 682 752 6.69753 -2.2173 0.00262353 0.00882795 0.0130305 -0.376072 0.926457 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 4.00323 -0.00149237 0.11911 3.99958 -0.0233382 3.43782 +EDGE_SE3:QUAT 683 752 2.89569 -0.675833 0.00516787 0.00929963 0.0147762 -0.233587 0.972179 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 4.00413 -0.000884413 0.133917 3.99903 -0.0162449 3.78623 +EDGE_SE3:QUAT 684 752 -1.02623 -0.382765 -0.0360818 0.00674447 -0.00360903 -0.131063 0.991345 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 3.99989 -6.67119e-05 -0.017644 3.99999 0.000909177 3.93136 +EDGE_SE3:QUAT 685 752 -5.17771 -0.641348 -0.0382791 0.00234403 -0.00258258 -0.0646619 0.997901 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 4.00007 -3.00855e-05 -0.0187176 3.99998 0.000584514 3.98336 +EDGE_SE3:QUAT 753 754 4.07392 -0.043239 -0.0124961 0.00154472 -0.00472609 0.0114713 0.999922 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 4.00035 -2.32199e-05 -0.0380168 3.99991 -0.00021766 3.99983 +EDGE_SE3:QUAT 483 753 5.64623 0.992399 0.0608805 -0.0072066 -0.00899061 0.999759 0.0186698 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 3.99981 0.000269056 0.0288442 4.00045 0.0370156 0.0019449 +EDGE_SE3:QUAT 484 753 1.41947 1.05643 -0.000229731 -0.00554037 -0.00482721 0.999759 0.0206824 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 3.99989 0.000117662 0.0221759 4.00037 0.0202076 0.00193616 +EDGE_SE3:QUAT 485 753 -2.69647 1.18586 -0.0565046 -0.00955984 -0.00475899 0.999577 0.0270342 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 3.99966 0.000234423 0.0382808 4.00131 0.0210774 0.00340112 +EDGE_SE3:QUAT 486 753 -6.79694 1.54653 -0.0673498 -0.0117017 -0.00498565 0.998507 0.053113 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 3.99951 0.000386563 0.0469996 4.00193 0.0247782 0.0119915 +EDGE_SE3:QUAT 600 753 5.6701 -1.38218 0.0355014 -0.00406236 -0.00707555 0.999551 0.0288286 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 3.99995 0.000113354 0.0162695 4.00002 0.0291811 0.00360364 +EDGE_SE3:QUAT 601 753 1.62877 -1.24491 -0.00665647 -0.00457959 -0.00739653 0.999812 0.0173465 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 3.99993 0.000136006 0.0183277 4.00009 0.0302016 0.0015157 +EDGE_SE3:QUAT 602 753 -2.50889 -1.26275 -0.069094 0.0100908 0.00646955 -0.999237 0.037178 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 3.99956 0.000177452 0.0404487 4.00157 0.0228043 0.00606861 +EDGE_SE3:QUAT 603 753 -6.28697 -2.3929 -0.136251 0.0138285 0.0134359 -0.986748 0.16111 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 3.9989 -5.42778e-05 0.0578618 4.00362 0.0329645 0.104973 +EDGE_SE3:QUAT 683 753 6.79947 -2.57629 -0.140879 0.00880537 0.0153691 -0.203464 0.978922 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 4.00434 -0.000765799 0.13644 3.99895 -0.0143224 3.83906 +EDGE_SE3:QUAT 684 753 3.22075 -1.4411 -0.0151507 0.0058118 -0.0031825 -0.0999901 0.994966 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 3.99995 -6.03191e-05 -0.0181511 3.99999 0.000785747 3.96009 +EDGE_SE3:QUAT 685 753 -0.847973 -1.12381 -0.0207727 0.00121112 -0.00198062 -0.0339293 0.999422 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 4.00005 -1.22106e-05 -0.015325 3.99999 0.000257158 3.99545 +EDGE_SE3:QUAT 686 753 -5.31762 -1.09513 0.0951561 -0.00346339 0.00777427 -0.0160653 0.999835 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 4.0009 -0.000129101 0.061514 3.99977 -0.000497515 3.99991 +EDGE_SE3:QUAT 754 755 4.28061 -0.0611521 0.00641849 -0.000427699 0.00311357 0.00924857 0.999952 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 4.00015 -3.18208e-06 0.0249537 3.99996 0.000115373 3.99981 +EDGE_SE3:QUAT 482 754 5.88565 1.06645 -0.005463 0.00210649 -0.00860652 0.999909 0.0101996 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 3.99998 -7.73472e-05 -0.0084283 3.99978 0.0342449 0.00072711 +EDGE_SE3:QUAT 483 754 1.58489 1.18321 -0.00757116 -0.00252436 -0.00732103 0.999944 0.00715791 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 3.99998 7.18875e-05 0.010099 3.99988 0.0294251 0.000446916 +EDGE_SE3:QUAT 484 754 -2.64924 1.27602 -0.0558669 -0.000892442 -0.0030444 0.999955 0.00892852 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 4 1.03627e-05 0.00357022 3.99997 0.0122389 0.000359512 +EDGE_SE3:QUAT 485 754 -6.72085 1.44099 -0.143436 -0.00482287 -0.00281233 0.999856 0.0160016 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 3.99991 6.19659e-05 0.0192989 4.00033 0.0118608 0.00115251 +EDGE_SE3:QUAT 599 754 5.88226 -1.18271 0.00829056 -0.000655246 -0.00395935 0.999842 0.017323 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 4 8.33614e-06 0.00262205 3.99994 0.0159162 0.00126541 +EDGE_SE3:QUAT 600 754 1.60835 -1.09727 -0.0105941 0.00036241 -0.00567509 0.999836 0.0172078 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 4 -1.25609e-05 -0.00145061 3.99988 0.0226334 0.00131307 +EDGE_SE3:QUAT 601 754 -2.42387 -1.0556 -0.0584621 -5.6646e-05 -0.00586003 0.999966 0.00587606 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 4 -2.86574e-07 0.000226588 3.99986 0.0234404 0.000275498 +EDGE_SE3:QUAT 602 754 -6.5492 -1.51702 -0.16244 0.00568341 0.00457061 -0.998784 0.048761 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 3.99985 7.04329e-05 0.0228187 4.00049 0.0159649 0.00970493 +EDGE_SE3:QUAT 685 754 3.21959 -1.44607 -0.0178946 0.0029155 -0.00685408 -0.0218366 0.999734 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 4.0007 -0.000102494 -0.0540375 3.99982 0.000590571 3.99882 +EDGE_SE3:QUAT 686 754 -1.24378 -1.268 0.0206136 -0.00160327 0.00278244 -0.00442509 0.999985 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 4.00011 -1.85715e-05 0.0221743 3.99997 -4.92984e-05 4.00004 +EDGE_SE3:QUAT 687 754 -5.20218 -1.19627 0.0124587 -0.000684577 0.00138835 -0.00117524 0.999998 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 4.00003 -3.85169e-06 0.0110972 3.99999 -6.55078e-06 4.00003 +EDGE_SE3:QUAT 755 756 4.30448 -0.0896963 0.0569835 -7.03394e-05 0.00146415 0.00434579 0.999989 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 4.00003 -1.88425e-07 0.0117166 3.99999 2.54584e-05 3.99996 +EDGE_SE3:QUAT 481 755 5.97287 1.06698 0.0103166 -0.00457768 -0.00762408 0.999914 0.00968126 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 3.99992 0.000139783 0.0183147 4.00009 0.0308462 0.000696652 +EDGE_SE3:QUAT 482 755 1.6408 1.19917 0.0183604 -0.00126368 -0.00906375 0.999957 0.00135493 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 3.99999 4.49685e-05 0.00505536 3.9997 0.0362674 0.000342587 +EDGE_SE3:QUAT 483 755 -2.66272 1.30968 -0.0177711 0.00584742 0.00731665 -0.999954 0.00213406 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 3.99986 0.000170349 0.0233913 4.00034 0.0291712 0.000367719 +EDGE_SE3:QUAT 484 755 -6.82226 1.42668 -0.0509827 -0.00454117 -0.00302234 0.999985 0.000302593 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 3.99992 5.50422e-05 0.0181647 4.00029 0.0121017 0.000119466 +EDGE_SE3:QUAT 598 755 6.08054 -1.08518 0.00941958 -0.00478403 -0.00414938 0.999947 0.00817118 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 3.99991 8.27031e-05 0.0191383 4.00029 0.0169094 0.000430128 +EDGE_SE3:QUAT 599 755 1.60629 -0.969479 0.0105874 -0.00386167 -0.00458705 0.99995 0.00801343 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 3.99994 7.23125e-05 0.0154485 4.00015 0.0185941 0.000402964 +EDGE_SE3:QUAT 600 755 -2.62617 -0.896831 0.00311295 -0.00272141 -0.00579808 0.999945 0.0083305 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 3.99997 6.22884e-05 0.0108873 3.99998 0.0233702 0.000443774 +EDGE_SE3:QUAT 601 755 -6.60172 -0.936505 -0.0484415 0.00371158 0.0063432 -0.999971 0.00218487 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 3.99994 9.41578e-05 0.0148472 4.00006 0.0253091 0.000234336 +EDGE_SE3:QUAT 686 755 3.02645 -1.37185 -0.00614248 -0.00233097 0.00552158 0.00511898 0.999969 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 4.00047 -4.7959e-05 0.0443185 3.99988 0.000111875 4.00039 +EDGE_SE3:QUAT 687 755 -0.926375 -1.27073 0.00883602 -0.00103609 0.00442407 0.0082101 0.999956 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 4.00031 -1.45342e-05 0.0354934 3.99992 0.000145378 4.00005 +EDGE_SE3:QUAT 688 755 -4.95914 -1.16449 -0.0944071 -0.000810493 -0.00245881 0.00780431 0.999966 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 4.00009 9.05559e-06 -0.0195932 3.99998 -7.64763e-05 3.99985 +EDGE_SE3:QUAT 756 757 4.27491 -0.0779388 0.0391737 -0.00248578 -0.00474311 0.00310508 0.999981 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 4.00033 4.86914e-05 -0.0378543 3.99991 -6.0073e-05 4.00032 +EDGE_SE3:QUAT 480 756 5.70635 1.11965 0.0691465 -0.011635 -0.00580439 0.999861 0.0104766 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 3.99947 0.000301375 0.0465475 4.002 0.0242038 0.00112719 +EDGE_SE3:QUAT 481 756 1.67913 1.23389 0.0277476 -0.00589841 -0.00763425 0.999938 0.00555114 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 3.99986 0.000182143 0.0235964 4.00031 0.0308015 0.000499623 +EDGE_SE3:QUAT 482 756 -2.63492 1.30523 0.0609637 0.00281528 0.00934228 -0.999949 0.0025027 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 3.99997 0.000106459 0.0112627 3.99978 0.0373122 0.000404832 +EDGE_SE3:QUAT 483 756 -6.91621 1.38798 -0.0266569 0.00758829 0.00767383 -0.999927 0.00548922 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 3.99976 0.000227976 0.0303562 4.0007 0.0303686 0.000581425 +EDGE_SE3:QUAT 597 756 5.85802 -1.03383 0.0631666 -0.0110075 -0.0023257 0.999912 0.00696942 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 3.99952 0.000122468 0.0440312 4.00191 0.00992205 0.000703654 +EDGE_SE3:QUAT 598 756 1.79205 -0.912728 0.0258345 -0.00613461 -0.0041085 0.999965 0.00393092 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 3.99985 0.000103861 0.0245392 4.00053 0.0166296 0.000281482 +EDGE_SE3:QUAT 599 756 -2.67166 -0.819156 0.032049 -0.00529696 -0.00467665 0.999967 0.00401642 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 3.99989 0.000101099 0.0211888 4.00036 0.0188787 0.000265862 +EDGE_SE3:QUAT 600 756 -6.90843 -0.736154 0.0255356 -0.00430559 -0.00613214 0.999962 0.00451987 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 3.99993 0.000106246 0.0172237 4.00014 0.024685 0.000308213 +EDGE_SE3:QUAT 686 756 7.33281 -1.4167 -0.00599968 -0.00241667 0.00719873 0.00883592 0.999932 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 4.00081 -5.89734e-05 0.0578495 3.99979 0.000253056 4.00052 +EDGE_SE3:QUAT 687 756 3.3717 -1.29269 0.018971 -0.00131076 0.00574967 0.0123558 0.999906 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 4.00053 -2.04538e-05 0.0461864 3.99987 0.000284765 3.99992 +EDGE_SE3:QUAT 688 756 -0.650587 -1.1861 -0.0215623 -0.000834983 -0.001061 0.0120077 0.999927 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 4.00001 3.79296e-06 -0.00836591 4 -5.00059e-05 3.99944 +EDGE_SE3:QUAT 689 756 -5.16729 -1.05399 -0.0652228 -0.000146397 0.000488436 0.00829397 0.999965 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 4 -2.39648e-07 0.00392166 4 1.62819e-05 3.99973 +EDGE_SE3:QUAT 757 758 4.26512 -0.0842164 -0.00658311 0.000415787 -0.00358595 0.00282072 0.99999 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 4.00021 -5.09762e-06 -0.0287026 3.99995 -4.03646e-05 4.00017 +EDGE_SE3:QUAT 479 757 5.56618 1.25343 0.0579638 -0.00762992 -0.0075678 0.99994 0.00221345 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 3.99977 0.000233188 0.0305217 4.0007 0.0304147 0.000483703 +EDGE_SE3:QUAT 480 757 1.46169 1.29152 0.00794792 -0.00710587 -0.00854593 0.999909 0.00766523 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 3.99981 0.000247619 0.0284285 4.00049 0.0346226 0.00073672 +EDGE_SE3:QUAT 481 757 -2.58539 1.36941 0.0135492 -0.00131847 -0.0102465 0.999943 0.00273295 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 3.99999 5.1841e-05 0.00527473 3.99961 0.0410124 0.000457379 +EDGE_SE3:QUAT 482 757 -6.91512 1.36996 0.0745137 -0.0018484 0.0119267 -0.99991 0.00581463 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 3.99999 -8.19729e-05 -0.00739544 3.99948 0.047786 0.000719879 +EDGE_SE3:QUAT 596 757 5.77045 -0.981007 0.0558411 -0.00732459 -0.00551376 0.999952 0.0035907 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 3.99979 0.000165372 0.0292996 4.00073 0.0222709 0.000390167 +EDGE_SE3:QUAT 597 757 1.62331 -0.891648 0.0073026 -0.00631749 -0.00497574 0.999959 0.00408969 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 3.99984 0.000128874 0.0252711 4.00053 0.0201129 0.00032768 +EDGE_SE3:QUAT 598 757 -2.46369 -0.799909 0.00895848 -0.00132801 -0.00676458 0.999975 0.00139737 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 3.99999 3.54779e-05 0.00531243 3.99984 0.0270727 0.000198105 +EDGE_SE3:QUAT 599 757 -6.91495 -0.707172 0.0284248 -0.000830783 -0.00706718 0.999974 0.00145549 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 4 2.29248e-05 0.00332339 3.99981 0.0282777 0.000211151 +EDGE_SE3:QUAT 688 757 3.59951 -1.16033 0.0260035 -0.00327838 -0.00594495 0.0147482 0.999868 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 4.00051 8.89631e-05 -0.0469688 3.99986 -0.00034774 3.99968 +EDGE_SE3:QUAT 689 757 -0.90773 -1.072 -0.0309809 -0.00268565 -0.00413901 0.0114286 0.999923 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 4.00024 4.84196e-05 -0.0327389 3.99993 -0.000187484 3.99975 +EDGE_SE3:QUAT 690 757 -5.38438 -0.941563 -0.0105957 6.68122e-05 0.000377783 0.00791164 0.999969 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 4 1.27675e-07 0.00301564 4 1.19208e-05 3.99975 +EDGE_SE3:QUAT 758 759 4.18394 -0.0753331 -0.00729732 -0.00130745 0.0133396 0.00225724 0.999908 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 4.00284 -6.03141e-05 0.106818 3.99929 0.000115204 4.00283 +EDGE_SE3:QUAT 478 758 5.72318 1.34769 -0.0384917 -0.00877967 0.0058368 -0.999856 0.0133034 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 3.9997 -0.000225587 -0.0351287 4.00106 0.0242808 0.00116386 +EDGE_SE3:QUAT 479 758 1.31327 1.36865 -0.0171942 0.00378399 0.00755663 -0.999964 0.000794927 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 3.99994 0.000114476 0.0151372 4 0.0302039 0.000287875 +EDGE_SE3:QUAT 480 758 -2.80224 1.43873 -0.0516226 -0.00344793 -0.00819568 0.99995 0.00457313 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 3.99995 0.000111845 0.0137934 3.99992 0.0329081 0.000401962 +EDGE_SE3:QUAT 481 758 -6.82866 1.4721 0.00284478 0.00241253 -0.0100163 0.999947 0.000325505 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 3.99998 -9.68624e-05 -0.00965154 3.99969 0.0400581 0.000424901 +EDGE_SE3:QUAT 595 758 5.68865 -0.915554 -0.0535955 -0.00962506 0.00488279 -0.999934 0.00389382 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 3.99963 -0.000196094 -0.0385008 4.00138 0.0198401 0.000529621 +EDGE_SE3:QUAT 596 758 1.51014 -0.860493 -0.0130157 -0.00361426 -0.00505173 0.99998 0.000693063 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 3.99995 7.31178e-05 0.0144575 4.00011 0.0202281 0.000156466 +EDGE_SE3:QUAT 597 758 -2.6598 -0.769599 -0.0473352 -0.002639 -0.00460394 0.999985 0.00113918 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 3.99997 4.8598e-05 0.0105563 4.00003 0.0184403 0.000118059 +EDGE_SE3:QUAT 598 758 -6.7468 -0.704151 -0.01009 -0.00219124 0.00646665 -0.999976 0.00146718 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 3.99998 -5.63553e-05 -0.00876553 3.99991 0.0258923 0.000195425 +EDGE_SE3:QUAT 689 758 3.38265 -1.05786 -0.00147979 -0.00220981 -0.00790718 0.0146342 0.999859 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 4.00097 9.10997e-05 -0.0628621 3.99975 -0.000462556 4.00013 +EDGE_SE3:QUAT 690 758 -1.11097 -0.97556 -0.0191809 0.000450547 -0.00328445 0.0110012 0.999934 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 4.00017 -3.07873e-06 -0.0263313 3.99996 -0.000144837 3.99969 +EDGE_SE3:QUAT 691 758 -5.54371 -0.83733 -0.0188902 -0.000866499 -0.00612318 0.00672512 0.999958 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 4.0006 2.72303e-05 -0.0489185 3.99985 -0.000165252 4.00042 +EDGE_SE3:QUAT 759 760 4.07269 -0.121313 0.0382557 0.0027934 0.00531728 -0.00210267 0.99998 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 4.00042 5.8136e-05 0.0426122 3.99989 -4.29369e-05 4.00044 +EDGE_SE3:QUAT 477 759 5.886 1.31427 -0.00637001 -0.000614909 0.00886165 -0.999562 0.0282382 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 4 -4.09521e-06 -0.00246111 3.99969 0.0355134 0.00350668 +EDGE_SE3:QUAT 478 759 1.56839 1.31839 0.0253544 0.00457264 0.0072432 -0.999842 0.0155637 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 3.99991 0.000130716 0.0182986 4.00015 0.0283888 0.00125416 +EDGE_SE3:QUAT 479 759 -2.85598 1.43723 -0.0515604 0.0171978 0.00842189 -0.999813 0.0028101 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 3.99881 0.000563231 0.0687886 4.00447 0.0333534 0.00149256 +EDGE_SE3:QUAT 480 759 -6.964 1.56739 -0.09252 -0.0169266 -0.00935905 0.999809 0.00266179 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 3.99886 0.000652473 0.0677067 4.00422 0.0378539 0.00153237 +EDGE_SE3:QUAT 594 759 5.8237 -0.944062 -0.015218 -0.000262426 0.00923456 -0.999908 0.00997416 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 4 -2.89174e-06 -0.00104986 3.99966 0.0369484 0.000739571 +EDGE_SE3:QUAT 595 759 1.54693 -0.870542 0.0185387 0.00368949 0.00612595 -0.999958 0.00572389 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 3.99994 9.02186e-05 0.0147594 4.00007 0.0243343 0.000333552 +EDGE_SE3:QUAT 596 759 -2.64236 -0.776474 -0.0482918 0.0167574 0.00609941 -0.99984 0.00131307 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 3.99887 0.000401942 0.0670241 4.00435 0.0242585 0.00127715 +EDGE_SE3:QUAT 597 759 -6.82577 -0.680145 -0.084251 0.0160536 0.00578266 -0.999854 0.00100384 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 3.99897 0.000366695 0.0642095 4.004 0.0230339 0.00116745 +EDGE_SE3:QUAT 690 759 3.05279 -0.945735 0.000181276 -0.000983127 0.00990356 0.0129297 0.999867 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 4.00157 -8.55452e-06 0.0793884 3.99961 0.000511727 4.00091 +EDGE_SE3:QUAT 691 759 -1.37616 -0.852634 0.0319257 -0.00207488 0.00730398 0.00879801 0.999932 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 4.00084 -4.96267e-05 0.0586548 3.99978 0.000255806 4.00055 +EDGE_SE3:QUAT 692 759 -5.79768 -0.71409 -0.00553617 -0.00480781 0.00272092 0.00428476 0.999976 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 4.00003 -5.23454e-05 0.0220138 3.99997 4.64717e-05 4.00005 +EDGE_SE3:QUAT 760 761 4.34625 -0.117541 0.0547725 0.0017266 -0.00555845 -0.00495321 0.999971 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 4.00048 -4.19452e-05 -0.0443679 3.99988 0.000111107 4.00039 +EDGE_SE3:QUAT 476 760 6.29911 1.21574 0.0442488 0.00935903 0.00899929 -0.99915 0.0391268 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 3.9996 0.000272203 0.0375275 4.00123 0.0329501 0.00674806 +EDGE_SE3:QUAT 477 760 1.82815 1.21441 0.0342098 0.00471992 0.00619054 -0.999626 0.0262321 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 3.9999 0.000109631 0.0189007 4.00024 0.0237324 0.00298277 +EDGE_SE3:QUAT 478 760 -2.51158 1.31874 0.0250961 0.00984222 0.0044806 -0.999847 0.0137331 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 3.9996 0.000146375 0.039379 4.0015 0.0168416 0.00121307 +EDGE_SE3:QUAT 479 760 -6.89024 1.53655 -0.148019 0.0224877 0.00538523 -0.999732 0.000916868 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 3.99798 0.000476869 0.0899321 4.00799 0.0214351 0.00214086 +EDGE_SE3:QUAT 593 760 6.01814 -0.971026 0.0491103 0.0108966 0.00737453 -0.99984 0.0121545 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 3.99951 0.000291827 0.0435966 4.00173 0.0284458 0.00126842 +EDGE_SE3:QUAT 594 760 1.77617 -0.902638 0.024717 0.00491008 0.00649235 -0.999936 0.007838 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 3.9999 0.000125528 0.0196431 4.00023 0.0256605 0.000506817 +EDGE_SE3:QUAT 595 760 -2.5128 -0.801793 0.0246052 0.00884507 0.00332342 -0.999948 0.00390528 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 3.99969 0.000110692 0.0353802 4.00121 0.0130223 0.000416351 +EDGE_SE3:QUAT 596 760 -6.69802 -0.669476 -0.149585 -0.0222181 -0.00348935 0.999747 0.000833111 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 3.99803 0.000322055 0.0888522 4.00786 0.0141439 0.00202729 +EDGE_SE3:QUAT 690 760 7.11235 -0.972911 -0.0477187 0.00194374 0.0153282 0.0109641 0.999821 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 4.00373 0.000180886 0.122447 3.99907 0.00068334 4.00326 +EDGE_SE3:QUAT 691 760 2.69005 -0.896261 0.0116977 0.00100549 0.0124534 0.00682644 0.999899 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 4.00247 7.55288e-05 0.099592 3.99938 0.000344121 4.00229 +EDGE_SE3:QUAT 692 760 -1.75446 -0.799079 0.0129496 -0.0016759 0.00771705 0.00223701 0.999966 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 4.00094 -4.8623e-05 0.0617936 3.99976 6.67774e-05 4.00093 +EDGE_SE3:QUAT 693 760 -6.16181 -0.649624 -0.0793957 -0.00376082 0.00234209 -0.00202189 0.999988 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 4.00003 -3.52696e-05 0.0186453 3.99998 -1.93109e-05 4.00007 +EDGE_SE3:QUAT 761 762 4.2836 -0.130879 0.0117282 0.000638452 -0.00566731 -0.00726642 0.999957 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 4.00051 -2.00454e-05 -0.0452843 3.99987 0.000165002 4.0003 +EDGE_SE3:QUAT 475 761 6.43593 0.978455 0.0790399 0.00970901 0.00701536 -0.99888 0.0457778 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 3.99958 0.000178351 0.0389626 4.00145 0.0243789 0.0089117 +EDGE_SE3:QUAT 476 761 1.95506 0.990159 0.0160025 0.00392992 0.00698755 -0.999378 0.034352 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 3.99992 0.000108431 0.0157506 4.0001 0.026791 0.004962 +EDGE_SE3:QUAT 477 761 -2.48297 1.11036 0.0443438 -0.000715108 0.00427582 -0.999762 0.0213918 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 4 -9.28078e-06 -0.00286213 3.99993 0.0172059 0.00190653 +EDGE_SE3:QUAT 478 761 -6.81932 1.31898 -0.00172712 0.0041124 0.00278121 -0.99995 0.00869247 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 3.99993 4.27148e-05 0.0164515 4.00024 0.0108378 0.000399269 +EDGE_SE3:QUAT 592 761 6.16997 -1.0261 0.0524643 0.00848256 0.0097669 -0.99985 0.0115432 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 3.9997 0.000319846 0.0339403 4.00082 0.0382852 0.00118739 +EDGE_SE3:QUAT 593 761 1.68125 -0.958438 0.00797685 0.00518974 0.00549514 -0.999944 0.00744459 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 3.99989 0.000110995 0.0207613 4.00032 0.0216714 0.000446857 +EDGE_SE3:QUAT 594 761 -2.56879 -0.853423 0.0302114 -0.000663668 0.00503289 -0.999983 0.00280302 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 4 -1.282e-05 -0.0026548 3.99991 0.0201458 0.000134656 +EDGE_SE3:QUAT 595 761 -6.85767 -0.713352 0.00543805 -0.00333675 -0.00153504 0.999992 0.00126618 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 3.99996 2.08053e-05 0.013347 4.00017 0.00617433 6.04792e-05 +EDGE_SE3:QUAT 691 761 7.00428 -0.960509 -0.0483872 0.00245845 0.00703159 0.00169479 0.999971 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 4.00077 7.11205e-05 0.0562117 3.9998 5.05576e-05 4.00078 +EDGE_SE3:QUAT 692 761 2.58298 -0.88911 -0.00326668 9.15288e-06 0.00202622 -0.00281524 0.999994 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 4.00007 -2.03217e-07 0.0162101 3.99998 -2.28178e-05 4.00003 +EDGE_SE3:QUAT 693 761 -1.81895 -0.788673 -0.0447478 -0.00191286 -0.00317842 -0.00712577 0.999968 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 4.00015 2.2784e-05 -0.0255898 3.99996 9.09066e-05 3.99996 +EDGE_SE3:QUAT 694 761 -6.19768 -0.646769 -0.0141534 -0.00224769 0.00298801 -0.0112133 0.99993 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 4.00012 -2.87627e-05 0.0235976 3.99997 -0.000132214 3.99964 +EDGE_SE3:QUAT 762 763 4.28395 -0.137984 -0.00357486 0.00121568 -0.00444651 -0.00724447 0.999963 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 4.00031 -2.49619e-05 -0.035466 3.99992 0.000128936 4.0001 +EDGE_SE3:QUAT 474 762 6.7044 0.640607 0.0854725 0.00940468 0.00841887 -0.999013 0.0425932 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 3.9996 0.000241741 0.0377267 4.00129 0.0303388 0.00784374 +EDGE_SE3:QUAT 475 762 2.16261 0.720613 0.00661339 0.00372287 0.00602899 -0.999236 0.0384391 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 3.99993 8.60281e-05 0.0149278 4.00012 0.0228854 0.0060972 +EDGE_SE3:QUAT 476 762 -2.29482 0.840227 -0.00851216 -0.0016948 0.00605551 -0.999616 0.0269882 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 3.99999 -3.45384e-05 -0.00678599 3.99989 0.0245434 0.00307567 +EDGE_SE3:QUAT 477 762 -6.80913 1.05583 0.0597043 -0.00618265 0.00330736 -0.999875 0.0142047 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 3.99985 -9.33563e-05 -0.0247381 4.00055 0.013928 0.00100862 +EDGE_SE3:QUAT 591 762 6.24871 -1.06558 0.0648283 0.00944524 0.00909504 -0.99989 0.00695154 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 3.99963 0.000333449 0.0377864 4.00113 0.0358669 0.000871776 +EDGE_SE3:QUAT 592 762 1.90326 -0.996612 -0.00815044 0.00261989 0.00889274 -0.999949 0.00405473 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 3.99997 9.50594e-05 0.0104811 3.9998 0.0354845 0.000408031 +EDGE_SE3:QUAT 593 762 -2.57426 -0.889154 -0.0275723 -0.000577396 0.00477281 -0.999988 3.85714e-05 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 4 -1.1016e-05 -0.00230966 3.99991 0.0190912 9.24604e-05 +EDGE_SE3:QUAT 594 762 -6.85686 -0.738702 0.0448112 0.00628671 -0.00409193 0.999963 0.00421683 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 3.99984 -9.94883e-05 -0.0251476 4.00057 0.0161583 0.000294496 +EDGE_SE3:QUAT 692 762 6.88477 -1.04603 -0.0089641 0.000889356 -0.00364179 -0.00992606 0.999944 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 4.00021 -1.60337e-05 -0.0290254 3.99995 0.000144173 3.99982 +EDGE_SE3:QUAT 693 762 2.44605 -0.97898 -0.0104464 -0.00103886 -0.00918845 -0.0145867 0.999851 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 4.00135 8.66604e-06 -0.0736877 3.99966 0.000536179 4.00051 +EDGE_SE3:QUAT 694 762 -1.9698 -0.874708 -0.0327443 -0.00155106 -0.00293475 -0.018894 0.999816 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 4.00013 1.4566e-05 -0.0238177 3.99996 0.000225765 3.99871 +EDGE_SE3:QUAT 695 762 -6.22044 -0.718948 -0.0171884 -7.24566e-05 0.00195271 -0.0252891 0.999678 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 4.00006 -2.87076e-06 0.0155849 3.99998 -0.000196923 3.9975 +EDGE_SE3:QUAT 763 764 4.28321 -0.113379 0.0149811 -0.00260179 0.00528743 -0.00538271 0.999968 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 4.00042 -5.83425e-05 0.0421332 3.99989 -0.000115011 4.00033 +EDGE_SE3:QUAT 473 763 6.87053 0.279097 0.0024861 0.000534433 0.00386128 -0.999489 0.0317383 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 4 1.16726e-05 0.002142 3.99995 0.0152706 0.00408878 +EDGE_SE3:QUAT 474 763 2.43576 0.414638 0.000857953 0.00486705 0.00702475 -0.999335 0.0354526 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 3.99989 0.00012786 0.0195083 4.00024 0.0266353 0.00530041 +EDGE_SE3:QUAT 475 763 -2.08782 0.536569 -0.0306497 -0.000572074 0.00474811 -0.999492 0.0315137 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 4 -5.28095e-06 -0.00229057 3.99991 0.0190892 0.00406497 +EDGE_SE3:QUAT 476 763 -6.56518 0.743835 0.00901233 -0.00598419 0.00460984 -0.999766 0.0202765 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 3.99987 -0.000123641 -0.0239517 4.00046 0.0193942 0.00188208 +EDGE_SE3:QUAT 590 763 5.92862 -1.08119 -0.0279455 -0.00233942 0.00456975 -0.999987 0.000770638 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 3.99998 -4.27358e-05 -0.00935796 4 0.0182937 0.000107933 +EDGE_SE3:QUAT 591 763 1.91944 -0.999539 -0.0106817 0.00479956 0.00772811 -0.999959 2.07664e-05 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 3.99991 0.000148395 0.0191998 4.00013 0.0309146 0.000331071 +EDGE_SE3:QUAT 592 763 -2.35497 -0.897078 -0.0225669 0.00196367 -0.00753916 0.999965 0.00302619 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 3.99998 -6.03015e-05 -0.00785544 3.99984 0.0301082 0.000278694 +EDGE_SE3:QUAT 593 763 -6.84845 -0.751117 -0.0220272 0.00482203 -0.00351744 0.999954 0.007478 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 3.99991 -6.4372e-05 -0.0192899 4.00033 0.013781 0.00036419 +EDGE_SE3:QUAT 693 763 6.73914 -1.24036 0.0665917 0.000395644 -0.0136275 -0.0213909 0.999678 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 4.00296 -0.000116782 -0.108914 3.99926 0.00116828 4.00113 +EDGE_SE3:QUAT 694 763 2.28114 -1.16673 -0.00763391 -0.000295082 -0.00730749 -0.0259375 0.999637 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 4.00086 -2.46518e-05 -0.0585037 3.99979 0.000758909 3.99816 +EDGE_SE3:QUAT 695 763 -1.93708 -1.07175 -0.0307471 0.00126217 -0.00243571 -0.0324746 0.999469 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 4.00008 -1.62939e-05 -0.0189637 3.99998 0.00030528 3.99587 +EDGE_SE3:QUAT 696 763 -6.49032 -0.768549 0.0364352 0.000970887 0.00284243 -0.0565634 0.998394 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 4.00013 -6.98125e-09 0.0232887 3.99997 -0.000663686 3.98734 +EDGE_SE3:QUAT 764 765 4.11395 -0.0937928 0.0485709 -0.00414164 -0.00440418 -0.00174132 0.99998 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 4.00024 7.24042e-05 -0.0353213 3.99992 2.88484e-05 4.0003 +EDGE_SE3:QUAT 472 764 6.86935 -0.157617 0.00641742 0.00610751 0.00520758 -0.999928 0.00896263 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 3.99985 0.00012104 0.0244335 4.0005 0.0203922 0.00057453 +EDGE_SE3:QUAT 473 764 2.61377 0.129292 0.0125752 0.00552852 0.00668947 -0.999633 0.0256798 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 3.99986 0.000136779 0.0221377 4.00036 0.0255828 0.00292413 +EDGE_SE3:QUAT 474 764 -1.83703 0.227891 -0.0260459 0.0100981 0.00991185 -0.999444 0.0301985 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 3.99955 0.000344912 0.0404519 4.00138 0.0371399 0.00440233 +EDGE_SE3:QUAT 475 764 -6.31936 0.391055 -0.0193343 0.00470019 0.00778635 -0.999624 0.0258699 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 3.9999 0.000143668 0.018822 4.00016 0.0301244 0.00299265 +EDGE_SE3:QUAT 589 764 5.71508 -1.21616 0.0247375 -0.00919158 -0.00431763 0.999701 0.0222522 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 3.99968 0.000199444 0.0367932 4.00123 0.0188932 0.00240851 +EDGE_SE3:QUAT 590 764 1.64281 -0.975901 0.010409 -0.00262097 -0.00732849 0.999959 0.00469218 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 3.99997 7.55604e-05 0.010485 3.99989 0.029411 0.000331811 +EDGE_SE3:QUAT 591 764 -2.32359 -0.871913 -0.0426764 -0.0102798 -0.0106149 0.999875 0.00563659 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 3.99959 0.000446004 0.0411261 4.00121 0.0429419 0.00101076 +EDGE_SE3:QUAT 592 764 -6.63183 -0.74996 0.00216006 -0.00349259 -0.0104008 0.999902 0.00865521 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 3.99996 0.000140166 0.0139741 3.99975 0.0418377 0.000786122 +EDGE_SE3:QUAT 694 764 6.56802 -1.50459 0.0688793 -0.0026818 -0.00173084 -0.0315852 0.999496 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 4.00003 1.7814e-05 -0.0148418 3.99999 0.000239425 3.99606 +EDGE_SE3:QUAT 695 764 2.33979 -1.4662 0.00509424 -0.00105683 0.00263165 -0.0378425 0.99928 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 4.0001 -1.6809e-05 0.020529 3.99997 -0.000385317 3.99438 +EDGE_SE3:QUAT 696 764 -2.23368 -1.37086 0.028715 -0.00109055 0.00847173 -0.0619385 0.998043 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 4.0011 -0.000140125 0.0665915 3.99973 -0.00205324 3.98576 +EDGE_SE3:QUAT 697 764 -6.54017 -0.850537 -0.0153084 0.00218213 0.00545864 -0.103718 0.994589 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 4.0005 -2.94093e-05 0.0456679 3.99987 -0.00240207 3.95749 +EDGE_SE3:QUAT 765 766 4.03125 -0.0701928 0.0281049 0.00175453 0.00415772 0.0201351 0.999787 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 4.00026 3.68498e-05 0.0328194 3.99993 0.000329692 3.99865 +EDGE_SE3:QUAT 471 765 7.01846 -1.06036 -0.11659 0.00806503 -0.00776534 0.997452 0.0704601 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 3.99968 -0.000155172 -0.032521 4.001 0.0261627 0.0202965 +EDGE_SE3:QUAT 472 765 2.73769 -0.128656 0.00404622 0.00168693 0.00921661 -0.99993 0.00725709 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 3.99999 6.65658e-05 0.00674916 3.99971 0.0367627 0.000559965 +EDGE_SE3:QUAT 473 765 -1.50258 0.00338061 0.0140013 0.000990824 0.0105832 -0.999651 0.0241658 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 3.99999 6.25709e-05 0.00396883 3.99958 0.0420775 0.00278281 +EDGE_SE3:QUAT 474 765 -5.95562 0.076009 -0.0596948 0.00534328 0.013825 -0.999491 0.0282578 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 3.99985 0.000315471 0.0214068 3.9998 0.0539878 0.00403795 +EDGE_SE3:QUAT 588 765 5.86489 -1.76342 -0.0390307 -0.00026687 -0.0094793 0.993188 0.116136 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 3.99999 -7.02873e-05 0.000969467 3.99967 0.0368879 0.0542959 +EDGE_SE3:QUAT 589 765 1.60197 -0.927787 -0.00644665 -0.00464478 -0.00864916 0.99966 0.024164 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 3.99993 0.000157284 0.0185964 4 0.0354459 0.00273636 +EDGE_SE3:QUAT 590 765 -2.4836 -0.821114 0.0375086 0.00178519 -0.0113163 0.999914 0.00643686 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 3.99999 -8.68372e-05 -0.00714264 3.99955 0.0451665 0.000688566 +EDGE_SE3:QUAT 591 765 -6.35801 -0.722429 -0.0754311 -0.00579966 -0.0150393 0.999844 0.0072895 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 3.99988 0.000341286 0.023208 3.9996 0.060491 0.00126208 +EDGE_SE3:QUAT 695 765 6.46218 -1.87087 0.0252104 -0.00530551 -0.00172734 -0.0395234 0.999203 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 3.99995 4.17587e-05 -0.0162997 3.99998 0.000337986 3.99382 +EDGE_SE3:QUAT 696 765 1.85295 -1.96235 0.00223198 -0.00541938 0.00432817 -0.0635256 0.997956 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 4.00011 -0.000101497 0.0302957 3.99995 -0.000918446 3.98409 +EDGE_SE3:QUAT 697 765 -2.53007 -1.79401 -0.0165887 -0.00218944 0.00150427 -0.105874 0.994376 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 4 -1.26136e-05 0.00907149 4 -0.00042762 3.95518 +EDGE_SE3:QUAT 698 765 -6.88439 -0.922126 -0.187854 -0.00429198 -0.0121037 -0.181888 0.983235 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 4.00249 -0.000476856 -0.101283 3.99943 0.00934465 3.87023 +EDGE_SE3:QUAT 766 767 4.09067 0.215492 -0.01341 0.00281674 0.00894915 0.106646 0.994253 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 4.00108 0.000277142 0.0668125 3.99975 0.00348434 3.95562 +EDGE_SE3:QUAT 470 766 6.61538 -2.46062 -0.0617023 0.00715271 -0.0124602 0.971342 0.23725 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 3.9995 -1.40021e-05 -0.0322496 4.00124 0.0301682 0.225685 +EDGE_SE3:QUAT 471 766 3.0213 -0.429314 -0.0126476 0.00378181 -0.00583977 0.998704 0.0504267 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 3.99992 -8.11432e-05 -0.0151913 4.00015 0.0216906 0.0103472 +EDGE_SE3:QUAT 472 766 -1.30544 -0.118745 0.021285 0.00609702 0.00735714 -0.999581 0.0273369 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 3.99983 0.000164808 0.0244177 4.00044 0.0280466 0.00333518 +EDGE_SE3:QUAT 473 766 -5.54981 -0.123149 0.0359336 0.00546197 0.00903807 -0.998965 0.0442459 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 3.99985 0.000188456 0.02192 4.00026 0.0340511 0.00824162 +EDGE_SE3:QUAT 587 766 5.69193 -2.00586 -0.0630158 0.00783624 -0.0112736 0.971753 0.235601 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 3.99951 7.39959e-05 -0.0350188 4.00143 0.025021 0.222537 +EDGE_SE3:QUAT 588 766 1.95192 -0.775164 -0.000458898 -0.00430488 -0.00731661 0.99535 0.0959524 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 3.99997 0.000110162 0.0174055 3.99995 0.0318701 0.0371598 +EDGE_SE3:QUAT 589 766 -2.42509 -0.667508 -0.0135457 -0.00918533 -0.00667501 0.999928 0.00398958 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 3.99967 0.00025211 0.0367433 4.00116 0.027004 0.00058344 +EDGE_SE3:QUAT 590 766 -6.51765 -0.705324 0.0803425 0.00251725 0.00987115 -0.999853 0.0138113 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 3.99997 0.000107738 0.0100736 3.99973 0.0391873 0.00117239 +EDGE_SE3:QUAT 696 766 5.85754 -2.55446 -0.000590637 -0.00320902 0.0084692 -0.0435088 0.999012 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 4.00104 -0.000176631 0.0659023 3.99974 -0.00142645 3.99351 +EDGE_SE3:QUAT 697 766 1.40871 -2.72313 0.00190827 0.000219748 0.00550425 -0.08611 0.99627 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 4.00048 -5.74696e-05 0.0437756 3.99988 -0.00188139 3.97082 +EDGE_SE3:QUAT 698 766 -3.14958 -2.43875 -0.0607271 -0.0020941 -0.00843955 -0.162175 0.986724 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 4.00117 -0.000217243 -0.0688923 3.99973 0.00562368 3.89598 +EDGE_SE3:QUAT 767 768 4.24867 0.650931 0.0185345 0.00117994 -0.00451328 0.19059 0.981659 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 4.00033 7.58879e-05 -0.0367929 3.99993 -0.00352783 3.85504 +EDGE_SE3:QUAT 469 767 6.06086 -3.3535 -0.0096513 -0.00475717 -0.0108019 0.917411 0.397766 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 3.99991 -0.000201154 0.0175428 3.99953 0.0398367 0.633432 +EDGE_SE3:QUAT 470 767 2.88221 -0.753451 0.00455784 -0.00236 -0.00818944 0.991126 0.132649 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 4 7.50287e-06 0.00953336 3.99973 0.0337849 0.070696 +EDGE_SE3:QUAT 471 767 -1.07387 -0.208798 -0.00368447 0.00577945 0.00267328 -0.998388 0.0564041 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 3.99986 1.69133e-05 0.0232313 4.00054 0.00800997 0.0128772 +EDGE_SE3:QUAT 472 767 -5.38766 -0.548524 -0.0499579 0.0161457 0.00384149 -0.990848 0.133956 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 3.99898 -0.000618159 0.066363 4.00429 -0.00232187 0.0728992 +EDGE_SE3:QUAT 586 767 5.72575 -1.73189 0.019674 -0.00496223 -0.00847267 0.952774 0.303521 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 4 -1.18752e-05 0.0205028 3.99968 0.0372792 0.368987 +EDGE_SE3:QUAT 587 767 1.94224 -0.30443 0.00422379 -0.00150088 -0.00723962 0.991396 0.130689 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 4 -1.19851e-05 0.00602615 3.99979 0.029271 0.0685453 +EDGE_SE3:QUAT 588 767 -2.11684 -0.183976 -0.0492129 0.0137889 0.00287827 -0.999846 0.0105129 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 3.99923 0.000111585 0.0551597 4.00303 0.0103609 0.00122977 +EDGE_SE3:QUAT 589 767 -6.53788 -0.839322 -0.104531 0.0188601 0.00256696 -0.994545 0.102554 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 3.99862 -0.000692672 0.0766312 4.00573 -0.00533091 0.04356 +EDGE_SE3:QUAT 697 767 5.48395 -3.21436 -0.0626309 0.00460769 0.0142013 0.0207332 0.999674 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 4.00307 0.000357501 0.112465 3.99922 0.00118605 4.00144 +EDGE_SE3:QUAT 698 767 0.803482 -3.56128 -0.00572796 0.00154722 0.000453285 -0.0561262 0.998422 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 4 3.44887e-06 0.00464904 4 -0.000140043 3.9874 +EDGE_SE3:QUAT 699 767 -3.88432 -3.11562 0.0283696 -0.00211436 0.00479147 -0.147049 0.989115 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 4.00026 -9.99006e-05 0.0334196 3.99994 -0.00233624 3.91378 +EDGE_SE3:QUAT 768 769 4.0962 0.64137 0.0161729 -0.00116505 -0.00169333 0.192507 0.981294 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 4.00002 1.39962e-05 -0.0101758 4 -0.000868402 3.85179 +EDGE_SE3:QUAT 468 768 5.86182 -3.0976 -0.0256236 -0.000761933 -0.00341379 0.880879 0.473329 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 3.99998 -1.84983e-05 0.000991507 3.99999 0.00887757 0.896193 +EDGE_SE3:QUAT 469 768 2.67142 -0.685398 -0.00825596 -0.00221103 -0.0103131 0.976451 0.215481 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 3.99998 -9.6043e-05 0.00861226 3.99958 0.0401744 0.186172 +EDGE_SE3:QUAT 470 768 -1.39951 -0.257502 -0.000711605 -0.000612145 0.00705928 -0.998236 0.0589393 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 4 6.27706e-06 -0.00244976 3.9998 0.0282791 0.0140975 +EDGE_SE3:QUAT 471 768 -5.23529 -1.34928 -0.0359896 0.00200789 0.000351025 -0.969215 0.246208 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 3.99999 -2.07947e-05 0.00876998 4.00006 -0.00251931 0.242495 +EDGE_SE3:QUAT 585 768 5.76456 -1.16356 0.024174 -0.00498515 -0.00354319 0.958185 0.286084 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 4 0.000112849 0.0215724 4.00008 0.0218341 0.327624 +EDGE_SE3:QUAT 586 768 1.87273 0.199122 0.00454475 -0.00204164 -0.00768718 0.993209 0.116071 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 4 9.18332e-06 0.00823408 3.99977 0.0315873 0.0541602 +EDGE_SE3:QUAT 587 768 -2.34045 0.173797 0.00796183 -0.00152016 0.00621278 -0.998109 0.0611348 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 4 -2.03312e-05 -0.00610352 3.99986 0.0253596 0.0151205 +EDGE_SE3:QUAT 588 768 -6.35373 -0.915625 -0.150826 0.00979792 -0.000656882 -0.979541 0.201003 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 3.99975 -0.000438617 0.0414534 4.0013 -0.0174948 0.16213 +EDGE_SE3:QUAT 654 768 5.20397 -4.4723 -0.0297958 -0.000655693 -0.00032967 0.871741 0.489966 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 4 1.32255e-06 0.00307393 4 0.00255075 0.960272 +EDGE_SE3:QUAT 655 768 1.19279 -4.37987 -0.0537888 -0.00146591 -0.00188104 0.871911 0.489659 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 4 -6.65312e-06 0.00579753 3.99998 0.00777999 0.959094 +EDGE_SE3:QUAT 656 768 -3.17468 -4.31353 -0.0782388 0.000479693 -0.000861639 0.877411 0.479738 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 4 4.44634e-06 -0.00321957 4.00001 0.000214771 0.920599 +EDGE_SE3:QUAT 698 768 5.10784 -3.3882 0.00984971 0.00243418 -0.00421257 0.135292 0.990794 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 4.00031 2.05778e-05 -0.0366858 3.99992 -0.0025489 3.92712 +EDGE_SE3:QUAT 699 768 0.378717 -3.73119 0.0023897 -0.000349589 0.000393223 0.0441362 0.999025 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 4 -4.12332e-07 0.00332151 4 7.45925e-05 3.99221 +EDGE_SE3:QUAT 700 768 -5.00045 -2.92794 0.00504551 -0.000457711 0.00231218 -0.0885885 0.996066 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 4.00008 -1.47666e-05 0.0177964 3.99998 -0.000777958 3.96869 +EDGE_SE3:QUAT 769 770 4.1528 0.756939 0.00866841 -0.00288631 0.00741504 0.216948 0.976151 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 4.00094 0.000226312 0.0624739 3.99979 0.00689151 3.81271 +EDGE_SE3:QUAT 467 769 6.58366 -2.61596 -0.135 0.0140635 -0.00427264 0.847979 0.529825 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 4.00051 0.00187988 -0.0796173 4.00185 -0.0365661 1.12502 +EDGE_SE3:QUAT 468 769 3.07806 -0.0246936 0.00407437 -8.96611e-05 -0.00581988 0.95544 0.295129 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 3.99996 -5.03084e-05 -0.000794676 3.99994 0.0185611 0.348502 +EDGE_SE3:QUAT 469 769 -1.29484 0.477385 -0.000828102 -0.0026248 -0.0113464 0.999656 0.0235057 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 3.99998 9.77872e-05 0.0105085 3.99956 0.0458147 0.00276277 +EDGE_SE3:QUAT 470 769 -5.39125 -1.34246 0.00928113 -0.000883349 0.00803325 -0.968192 0.250079 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 3.99996 8.78196e-05 -0.00284336 3.9998 0.0288766 0.250385 +EDGE_SE3:QUAT 515 769 5.1298 4.07508 0.0436368 0.0041737 -0.0018502 -0.32292 0.946415 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 3.99992 1.84819e-05 0.00250135 4 -0.00140388 3.58288 +EDGE_SE3:QUAT 516 769 0.781817 4.02722 0.0028177 0.00111184 -0.00064166 -0.341267 0.939966 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 3.99999 8.61557e-07 -6.34657e-05 4 -0.000301832 3.53415 +EDGE_SE3:QUAT 517 769 -3.66327 4.08698 -0.0344518 0.00699984 -0.00587252 -0.335769 0.9419 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 3.99981 -5.55919e-05 -0.0131756 4.00002 0.000162397 3.54904 +EDGE_SE3:QUAT 584 769 6.11696 -0.681018 -0.0177637 0.00318269 -0.00655115 0.969544 0.244807 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 3.99988 -1.71132e-05 -0.0145913 4.00026 0.0165039 0.239856 +EDGE_SE3:QUAT 585 769 1.98901 0.560878 0.000826315 -0.00436825 -0.00416786 0.995337 0.0962722 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 3.99995 9.26556e-05 0.0176852 4.00015 0.019621 0.0372491 +EDGE_SE3:QUAT 586 769 -2.25693 0.541454 0.0105281 0.00207262 0.00866606 -0.996978 0.0771746 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 3.99995 0.000102298 0.00839706 3.99985 0.0328775 0.0241135 +EDGE_SE3:QUAT 587 769 -6.32593 -0.931233 0.0303047 -0.00194391 0.00779371 -0.967737 0.251833 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 3.99998 6.51485e-05 -0.0074834 3.99976 0.0300101 0.253934 +EDGE_SE3:QUAT 653 769 6.60185 -1.3565 -0.072534 0.00789447 0.000628901 0.950592 0.310343 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 3.99994 0.000376323 -0.0356537 4.00067 -0.0196493 0.38569 +EDGE_SE3:QUAT 654 769 2.52864 -1.28649 -0.0100201 -6.83818e-05 -0.0023477 0.949798 0.312855 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 3.99999 -8.20874e-06 -0.000264481 3.99999 0.00732777 0.391527 +EDGE_SE3:QUAT 655 769 -1.48373 -1.20696 -0.0404513 -0.00112736 -0.00334422 0.949805 0.312823 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 4 -1.45186e-05 0.00430235 3.99995 0.0127639 0.391484 +EDGE_SE3:QUAT 656 769 -5.91904 -1.19229 -0.0517752 0.000959475 -0.00264732 0.953328 0.301923 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 3.99998 -1.35969e-06 -0.00490871 4.00003 0.00614845 0.364648 +EDGE_SE3:QUAT 699 769 4.41537 -2.74922 0.0231592 -0.00156556 -0.0011876 0.235692 0.971826 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 3.99999 4.87984e-06 -0.0044563 4 -0.000319111 3.7778 +EDGE_SE3:QUAT 700 769 -0.853472 -3.04037 0.0112416 -0.00132575 0.000907578 0.104631 0.99451 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 4.00001 -3.35114e-06 0.00879416 3.99999 0.000486968 3.95623 +EDGE_SE3:QUAT 701 769 -5.98494 -1.92679 -0.164262 0.00573103 -0.0125586 -0.0383146 0.99917 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 4.00225 -0.000416444 -0.09766 3.99942 0.0018764 3.99651 +EDGE_SE3:QUAT 770 771 4.21115 0.833802 -0.00505884 0.0010306 0.00453559 0.232977 0.972471 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 4.00023 0.000105608 0.0305952 3.99996 0.00333392 3.78312 +EDGE_SE3:QUAT 467 770 4.09543 0.813659 0.00243189 0.00493428 -0.00604994 0.942708 0.333527 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 3.99985 0.000174832 -0.024541 4.00062 0.00603733 0.445149 +EDGE_SE3:QUAT 468 770 -0.708094 1.70522 0.0266038 -0.00941608 -0.00651642 0.996662 0.0808284 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 3.99974 0.000363489 0.0380077 4.00099 0.0317028 0.0267487 +EDGE_SE3:QUAT 469 770 -5.45489 -0.0350512 -0.0244836 0.0127487 0.013605 -0.980944 0.193396 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 3.99899 -0.000168631 0.0545486 4.00329 0.0304418 0.150635 +EDGE_SE3:QUAT 516 770 4.44632 1.92419 0.0139634 0.000930849 0.00708526 -0.129284 0.991582 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 4.0008 -0.000130761 0.0567049 3.99981 -0.00366646 3.93395 +EDGE_SE3:QUAT 517 770 0.0474172 2.03091 0.00928212 0.00529953 0.000775781 -0.123668 0.992309 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 3.99993 3.66319e-05 0.0138486 3.99998 -0.00101514 3.93887 +EDGE_SE3:QUAT 518 770 -4.54113 2.07091 -0.0120416 0.00302496 -0.00358573 -0.112622 0.993627 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 4.00011 -6.08697e-05 -0.0240885 3.99997 0.00127024 3.94941 +EDGE_SE3:QUAT 583 770 6.20037 0.182873 0.0140899 4.23047e-05 -0.00350131 0.996325 0.0855872 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 4 -8.63786e-06 -0.000188659 3.99995 0.0137206 0.0293481 +EDGE_SE3:QUAT 584 770 2.11596 0.647899 0.0255684 -0.00648276 -0.00840286 0.999535 0.0285922 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 3.99986 0.000227833 0.0259639 4.00032 0.0350305 0.00374571 +EDGE_SE3:QUAT 585 770 -2.16684 0.685513 -0.00991423 0.0129608 0.00578932 -0.992443 0.121887 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 3.99926 -0.000217371 0.0530629 4.00288 0.00985772 0.0601658 +EDGE_SE3:QUAT 586 770 -6.19788 -0.769124 -0.013636 0.0110722 0.0112897 -0.956394 0.291652 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 3.9993 -0.000662195 0.0517993 4.00278 0.0122133 0.341037 +EDGE_SE3:QUAT 652 770 6.80519 0.442049 0.0184363 0.00042938 -0.00155148 0.995511 0.0946303 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 4 -3.62359e-06 -0.00175096 4 0.00574529 0.0358287 +EDGE_SE3:QUAT 653 770 2.82426 0.498568 0.000514808 -1.1231e-06 -0.00157418 0.995276 0.0970783 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 4 -1.8372e-06 -6.96891e-06 3.99999 0.00614972 0.0377063 +EDGE_SE3:QUAT 654 770 -1.21688 0.591112 0.00529209 -0.00851229 -0.00303236 0.995004 0.0994212 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 3.99977 0.000249994 0.0345274 4.00097 0.0185413 0.0399255 +EDGE_SE3:QUAT 655 770 -5.23612 0.684015 -0.0281396 -0.0100193 -0.00385522 0.994968 0.0996137 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 3.99969 0.000354804 0.0406407 4.00132 0.0229569 0.0402408 +EDGE_SE3:QUAT 700 770 3.11825 -1.40335 0.00674911 -0.00484412 0.00806757 0.317717 0.948139 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 4.00121 0.000444243 0.072266 3.99979 0.011896 3.59753 +EDGE_SE3:QUAT 701 770 -1.79215 -1.51581 -0.0497822 0.000430519 -0.00603162 0.1793 0.983776 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 4.00055 0.000141991 -0.0468569 3.99988 -0.00415842 3.87195 +EDGE_SE3:QUAT 702 770 -6.22224 -0.473999 -0.0668628 0.000140651 -0.00562891 0.0626348 0.998021 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 4.0005 4.43146e-05 -0.0448769 3.99988 -0.00140412 3.98481 +EDGE_SE3:QUAT 771 772 4.1744 0.921179 0.00115765 -0.00126813 0.00112784 0.244537 0.969638 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 4.00003 3.76597e-06 0.0117986 3.99999 0.00155947 3.76084 +EDGE_SE3:QUAT 466 771 5.68195 1.50471 0.0676965 -0.003231 -0.00580244 0.945925 0.324318 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 4 -1.97262e-05 0.0132139 3.99985 0.0248371 0.420946 +EDGE_SE3:QUAT 467 771 0.344458 2.7954 0.0501086 -0.00048855 -0.00457792 0.994499 0.104643 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 4 -8.70061e-06 0.00194405 3.99992 0.0182166 0.0438857 +EDGE_SE3:QUAT 468 771 -4.91749 1.60531 -0.0694316 0.0154843 0.00166745 -0.98794 0.15405 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 3.99916 -0.000780773 0.064148 4.00374 -0.0123757 0.0960158 +EDGE_SE3:QUAT 517 771 4.33863 1.78687 0.00505569 0.006851 0.00377445 0.111036 0.993786 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 3.99992 8.09979e-05 0.0205839 3.99998 0.000964823 3.95079 +EDGE_SE3:QUAT 518 771 -0.260813 1.91814 0.0168479 0.0035706 0.000141685 0.122003 0.992523 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 3.99995 -1.00092e-05 -0.00406732 4 -0.000354904 3.94046 +EDGE_SE3:QUAT 519 771 -4.3132 1.963 0.0194432 0.00275331 0.00253174 0.132023 0.99124 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 4.00003 3.25238e-05 0.0154153 3.99999 0.000910148 3.93034 +EDGE_SE3:QUAT 582 771 6.27017 0.0425351 0.0424296 0.00579768 0.00122601 -0.988829 0.14894 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 3.99987 -9.51259e-05 0.0239815 4.00055 -0.00212138 0.0888799 +EDGE_SE3:QUAT 583 771 1.9137 0.102726 0.011382 0.00524851 0.00261908 -0.988852 0.148789 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 3.99988 -5.1094e-05 0.0217481 4.00048 0.00379228 0.0886779 +EDGE_SE3:QUAT 584 771 -2.08106 0.083643 -0.0417196 0.0128006 0.00526331 -0.978698 0.20484 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 3.99936 -0.000611284 0.0546791 4.00284 -0.00122654 0.168619 +EDGE_SE3:QUAT 585 771 -6.0196 -1.10853 -0.138397 0.0188688 0.00145245 -0.936318 0.350644 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 3.99973 -0.00242571 0.0886079 4.00413 -0.0424101 0.494392 +EDGE_SE3:QUAT 651 771 6.65601 0.363103 0.0481521 0.0060129 -0.000717537 -0.98988 0.14178 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 3.99989 -0.000129831 0.0247496 4.00051 -0.00941196 0.0805847 +EDGE_SE3:QUAT 652 771 2.53702 0.431966 0.0143743 0.00445847 0.000306725 -0.990192 0.139641 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 3.99993 -6.03627e-05 0.0183544 4.00031 -0.00371659 0.0780873 +EDGE_SE3:QUAT 653 771 -1.40409 0.52176 -0.00119912 0.00491866 0.00010545 -0.990488 0.13751 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 3.99992 -7.5629e-05 0.0202269 4.00037 -0.00490743 0.0757459 +EDGE_SE3:QUAT 654 771 -5.46199 0.623784 -0.0747155 0.0134666 -0.00100363 -0.990742 0.135087 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 3.99941 -0.000606525 0.0553012 4.00266 -0.0181408 0.0738546 +EDGE_SE3:QUAT 700 771 5.95744 1.77055 -0.0764244 -0.00344439 0.0134576 0.52963 0.848115 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 4.00157 0.00164168 0.0835242 4.00046 0.0191086 2.87959 +EDGE_SE3:QUAT 701 771 1.88793 0.743019 -0.00179033 -0.000986402 -0.00141443 0.403599 0.914934 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 4 6.28288e-06 -0.00440793 4 -0.000363476 3.34843 +EDGE_SE3:QUAT 702 771 -2.11867 0.862405 -0.0219113 -0.000666686 -0.000879049 0.293609 0.955925 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 4 3.34256e-06 -0.00392898 4 -0.000414882 3.65518 +EDGE_SE3:QUAT 703 771 -6.31011 1.49683 -0.000603565 0.0021344 0.00178658 0.228402 0.973563 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 3.99999 1.26221e-05 0.00754229 4 0.000594778 3.79134 +EDGE_SE3:QUAT 772 773 4.19119 0.882806 0.0139557 -0.000758226 -0.00364235 0.217708 0.976007 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 4.00016 6.56589e-05 -0.0251744 3.99997 -0.00259121 3.81057 +EDGE_SE3:QUAT 465 772 6.71457 2.11524 0.0666475 -0.00336255 -0.00672765 0.973733 0.22757 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 4 1.17467e-05 0.0138201 3.99982 0.0292943 0.207427 +EDGE_SE3:QUAT 466 772 1.84226 3.35009 0.0508793 -0.00593847 -0.00571994 0.996515 0.0830042 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 3.99991 0.00016935 0.0239735 4.0003 0.0264065 0.0278786 +EDGE_SE3:QUAT 467 772 -3.9072 2.78405 0.0441393 0.00295236 0.00549634 -0.989858 0.141926 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 3.99993 4.70399e-05 0.0122866 4.00014 0.0176026 0.0806906 +EDGE_SE3:QUAT 518 772 3.56536 3.81442 0.0262294 0.00195687 0.00019322 0.361183 0.932493 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 3.99999 -5.91716e-06 -0.00649049 4 -0.00169805 3.4782 +EDGE_SE3:QUAT 519 772 -0.526675 3.93555 0.0129808 0.00195383 0.00249005 0.370555 0.928805 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 4 1.96781e-05 0.00806883 4 0.000683839 3.45077 +EDGE_SE3:QUAT 520 772 -4.71896 3.98492 -0.0214007 0.00093249 0.002004 0.378656 0.925535 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 4.00001 1.90673e-05 0.0088786 4 0.00117502 3.4265 +EDGE_SE3:QUAT 581 772 6.91233 -2.07482 0.00203683 0.00606458 0.000734008 -0.919439 0.393185 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 4 -0.000272202 0.0295595 4.00041 -0.0142653 0.618671 +EDGE_SE3:QUAT 582 772 2.5216 -2.05357 -0.00335908 0.00665068 0.00107742 -0.922229 0.386586 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 3.99998 -0.00033141 0.0323678 4.00052 -0.0147122 0.598137 +EDGE_SE3:QUAT 583 772 -1.83723 -1.98806 -0.0395061 0.00666754 0.00225771 -0.922178 0.386702 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 3.99996 -0.000361151 0.0329973 4.00063 -0.0117093 0.598489 +EDGE_SE3:QUAT 584 772 -5.59998 -2.42123 -0.160032 0.0146697 0.003351 -0.89869 0.438327 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 4.00012 -0.0017983 0.0752943 4.00242 -0.0341885 0.770403 +EDGE_SE3:QUAT 650 772 7.08767 -1.75476 0.0124298 0.00579654 -0.000596926 -0.924268 0.3817 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 4.00001 -0.000215109 0.0274115 4.00028 -0.0166877 0.583058 +EDGE_SE3:QUAT 651 772 2.9055 -1.66696 0.00665207 0.00636843 -0.000811824 -0.925001 0.379911 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 4.00001 -0.0002553 0.030012 4.00032 -0.0187017 0.577666 +EDGE_SE3:QUAT 652 772 -1.23713 -1.59262 -0.0171999 0.00530089 0.000540787 -0.925874 0.377794 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 3.99999 -0.000201655 0.0254706 4.00031 -0.0123054 0.57113 +EDGE_SE3:QUAT 653 772 -5.17826 -1.48126 -0.0404029 0.00581874 0.00026154 -0.926689 0.375785 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 3.99999 -0.000235364 0.0277733 4.00035 -0.0143295 0.565121 +EDGE_SE3:QUAT 701 772 4.04955 4.43422 0.00382552 -0.00309738 -0.000576178 0.615524 0.788112 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 4.00001 1.36487e-06 0.0148433 3.99998 0.00705515 2.48458 +EDGE_SE3:QUAT 702 772 0.83022 3.95842 -0.0133595 -0.00235574 -2.9453e-05 0.518487 0.855082 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 4.00001 8.92959e-07 0.011883 3.99999 0.00430386 2.92472 +EDGE_SE3:QUAT 703 772 -2.95488 4.15524 -0.00674549 0.00124655 0.00191911 0.459724 0.888059 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 4 9.18272e-06 0.00484477 4 0.000165652 3.15462 +EDGE_SE3:QUAT 773 774 4.26837 0.572815 0.0408281 -0.00904057 0.0178615 0.121262 0.992419 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 4.00551 0.000331661 0.152967 3.99856 0.00943238 3.94702 +EDGE_SE3:QUAT 465 773 2.57599 3.18467 0.0560136 -0.00107695 -0.0072532 0.999921 0.0101636 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 4 2.71981e-05 0.00430871 3.9998 0.0290923 0.000629458 +EDGE_SE3:QUAT 466 773 -2.44225 3.22148 0.00878181 0.00371922 0.00524664 -0.99063 0.136422 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 3.99991 3.90557e-05 0.0153929 4.00024 0.0160344 0.0745708 +EDGE_SE3:QUAT 581 773 4.61686 -5.69937 -0.029252 0.00263552 -0.00131494 -0.811414 0.584464 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 4.00001 -9.43132e-06 0.012298 3.99999 -0.00946547 1.36647 +EDGE_SE3:QUAT 582 773 0.202176 -5.64609 -0.0406896 0.00302414 -0.00118601 -0.815876 0.578218 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 4.00002 -2.24369e-05 0.0146347 3.99999 -0.0105943 1.33744 +EDGE_SE3:QUAT 583 773 -4.14238 -5.57767 -0.0875558 0.00397135 0.000246514 -0.816025 0.578002 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 4.00005 -0.000109109 0.0220063 4.00007 -0.0119621 1.33653 +EDGE_SE3:QUAT 650 773 4.71711 -5.31735 -0.0115105 0.00211886 -0.00232228 -0.81887 0.573971 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 3.99999 1.50447e-05 0.00800022 3.99997 -0.0091187 1.31782 +EDGE_SE3:QUAT 651 773 0.524543 -5.23072 -0.0222659 0.00257976 -0.00300544 -0.820191 0.572076 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 3.99999 2.55139e-05 0.00950186 3.99995 -0.0113487 1.30916 +EDGE_SE3:QUAT 652 773 -3.64893 -5.13718 -0.050542 0.00223084 -0.00131243 -0.821227 0.570596 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 4.00001 -4.19067e-06 0.0101495 3.99999 -0.00837169 1.30237 +EDGE_SE3:QUAT 774 775 4.25964 0.103679 -0.0216982 -0.00268505 0.0109829 0.0345283 0.99934 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 4.00194 -1.80956e-05 0.0888554 3.99951 0.00153356 3.9972 +EDGE_SE3:QUAT 465 774 -1.69265 2.74065 0.0802179 0.0201165 0.0163318 -0.993476 0.111055 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 3.99794 0.000234289 0.0820958 4.00699 0.0457745 0.0515743 +EDGE_SE3:QUAT 466 774 -6.39434 1.51151 0.00109706 0.0208355 0.0163031 -0.966653 0.25472 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 3.99787 -0.00191393 0.0931564 4.00879 0.0151775 0.26194 +EDGE_SE3:QUAT 775 776 4.20641 -0.0397015 -0.0074006 -0.00161139 0.00477457 0.00888448 0.999948 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 4.00036 -2.60695e-05 0.0383668 3.99991 0.000169835 4.00005 +EDGE_SE3:QUAT 465 775 -5.828 1.69279 -0.132112 0.0312701 0.0193995 -0.98879 0.144708 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 3.99534 -0.00122035 0.129303 4.01753 0.0382952 0.0884261 +EDGE_SE3:QUAT 776 777 4.31457 -0.0812845 0.0294708 0.000669969 0.00727851 0.00419458 0.999964 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 4.00084 2.48337e-05 0.0582036 3.99979 0.000122964 4.00078 +EDGE_SE3:QUAT 777 778 4.32846 -0.0934176 0.0628643 -0.000499076 -0.00358197 0.000569271 0.999993 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 4.0002 7.32612e-06 -0.0286536 3.99995 -8.31027e-06 4.0002 +EDGE_SE3:QUAT 461 777 3.55132 2.42444 0.0981322 -0.0123051 -0.00616224 0.99987 0.00838364 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 3.99941 0.000331513 0.0492253 4.00224 0.0254906 0.00104937 +EDGE_SE3:QUAT 462 777 -0.913763 2.50434 0.048397 -0.0174684 -0.00886612 0.999766 0.00918241 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 3.9988 0.000682729 0.0698818 4.0045 0.0368002 0.00189659 +EDGE_SE3:QUAT 463 777 -5.23184 2.49376 -0.000218527 0.0157765 0.0100964 -0.99981 0.00542891 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 3.99899 0.000610928 0.0631098 4.00362 0.03975 0.00150836 +EDGE_SE3:QUAT 778 779 4.3663 -0.105466 0.050334 -0.00145826 -0.0046516 -0.00286922 0.999984 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 4.00034 2.56962e-05 -0.0372653 3.99991 5.27381e-05 4.00031 +EDGE_SE3:QUAT 460 778 3.29275 2.48839 0.0676947 -0.00144104 -0.00717049 0.999967 0.00359107 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 3.99999 4.0022e-05 0.00576468 3.99983 0.028722 0.00026614 +EDGE_SE3:QUAT 461 778 -0.76552 2.58679 0.0554205 -0.00877463 -0.00666313 0.99991 0.00765207 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 3.9997 0.000245298 0.0351028 4.00103 0.0271965 0.000727156 +EDGE_SE3:QUAT 462 778 -5.28099 2.67434 -0.034269 -0.0138754 -0.00914314 0.999818 0.009327 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 3.99925 0.000544892 0.0555116 4.00269 0.0376377 0.00147237 +EDGE_SE3:QUAT 779 780 4.31953 -0.096571 0.00687569 0.000296537 -0.00115428 -3.56823e-06 0.999999 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 4.00002 -1.36928e-06 -0.00923424 3.99999 2.59574e-08 4.00002 +EDGE_SE3:QUAT 459 779 3.0598 2.53946 0.0756223 0.00187189 -0.00853426 0.999957 0.0031624 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 3.99999 -6.54611e-05 -0.00748848 3.99977 0.0340883 0.000344543 +EDGE_SE3:QUAT 460 779 -1.08198 2.63045 0.101474 0.00317804 -0.00865787 0.999937 0.00641394 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 3.99996 -0.000112279 -0.0127143 3.99987 0.0344656 0.000501955 +EDGE_SE3:QUAT 461 779 -5.11182 2.76434 0.0236125 -0.00412714 -0.00807299 0.999903 0.0105929 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 3.99994 0.000131855 0.0165128 4 0.0326345 0.000783287 +EDGE_SE3:QUAT 780 781 4.33862 -0.0924573 0.0059376 0.000692244 0.0074277 0.000961058 0.999972 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 4.00088 2.18519e-05 0.059425 3.99978 2.94873e-05 4.00088 +EDGE_SE3:QUAT 458 780 2.86764 2.56919 0.0742349 0.0048392 0.0076593 -0.999959 0.000153393 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 3.99991 0.000148276 0.0193583 4.00014 0.0306343 0.000328378 +EDGE_SE3:QUAT 459 780 -1.21985 2.65633 0.0993067 0.00295381 -0.00791896 0.99996 0.00289977 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 3.99996 -9.43995e-05 -0.0118165 3.99989 0.0316072 0.000318301 +EDGE_SE3:QUAT 460 780 -5.35729 2.77566 0.132106 0.00414435 -0.00837407 0.999938 0.00610105 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 3.99993 -0.000139661 -0.0165799 4 0.033293 0.000494725 +EDGE_SE3:QUAT 781 782 4.33241 -0.0765058 0.0610864 -0.00328945 0.00286447 0.00216972 0.999988 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 4.00009 -3.74513e-05 0.0230015 3.99997 2.43348e-05 4.00011 +EDGE_SE3:QUAT 457 781 3.07817 2.57085 0.075118 0.00766171 0.00641354 -0.999942 0.00413018 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 3.99976 0.000192188 0.0306485 4.00078 0.0254077 0.000464424 +EDGE_SE3:QUAT 458 781 -1.47159 2.65872 0.0429772 0.0124741 0.00687664 -0.999898 0.0011219 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 3.99938 0.000340061 0.0498959 4.00231 0.0274174 0.000815295 +EDGE_SE3:QUAT 459 781 -5.53789 2.77619 0.127223 -0.00462686 -0.0074006 0.999959 0.00251207 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 3.99992 0.000137168 0.018509 4.00012 0.0296975 0.000331361 +EDGE_SE3:QUAT 782 783 4.19725 -0.0944585 0.0473166 0.00430567 -0.00187417 0.00223955 0.999986 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 3.99998 -3.24194e-05 -0.0151087 3.99999 -1.65946e-05 4.00004 +EDGE_SE3:QUAT 456 782 3.13685 2.51612 0.0772705 0.00703723 0.0111785 -0.99987 0.00928474 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 3.99979 0.000312626 0.028157 4.00033 0.0441916 0.00103124 +EDGE_SE3:QUAT 457 782 -1.23038 2.61774 0.0754676 0.0105616 0.0094043 -0.999881 0.00618986 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 3.99954 0.00038542 0.0422517 4.00146 0.037112 0.000943765 +EDGE_SE3:QUAT 458 782 -5.73722 2.73738 -0.00461351 0.0155552 0.0102979 -0.999823 0.00262577 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 3.99903 0.000629686 0.0622234 4.00347 0.0409164 0.00141374 +EDGE_SE3:QUAT 783 784 4.11241 -0.0714932 0.0186389 0.00095155 -0.00598507 0.00313038 0.999977 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 4.00057 -2.01193e-05 -0.0479215 3.99986 -7.42336e-05 4.00053 +EDGE_SE3:QUAT 455 783 2.99911 2.44873 0.0474906 0.00178032 0.0079941 -0.999872 0.0137205 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 3.99998 6.2718e-05 0.00712418 3.9998 0.0317656 0.00101802 +EDGE_SE3:QUAT 456 783 -1.03667 2.53884 0.0656078 0.00512299 0.00648422 -0.999901 0.0114091 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 3.99989 0.000129288 0.0204969 4.00027 0.0254642 0.000787825 +EDGE_SE3:QUAT 457 783 -5.41829 2.66387 0.0330861 0.00871228 0.00502189 -0.999918 0.00798419 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 3.99969 0.000162073 0.0348523 4.00113 0.0195359 0.00065408 +EDGE_SE3:QUAT 784 785 4.32854 -0.0717106 -0.00145845 -0.00188079 0.00480674 0.00372428 0.99998 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 4.00036 -3.42055e-05 0.0385401 3.99991 7.07896e-05 4.00032 +EDGE_SE3:QUAT 454 784 3.09591 2.34368 0.0260201 -0.00099809 0.00406347 -0.999807 0.0191962 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 4 -1.4054e-05 -0.00399443 3.99995 0.0163921 0.00154517 +EDGE_SE3:QUAT 455 784 -1.08102 2.41607 0.0552323 -0.00408939 0.00717235 -0.999818 0.0172212 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 3.99994 -0.000116608 -0.0163657 4.00004 0.0292331 0.00146695 +EDGE_SE3:QUAT 456 784 -5.17637 2.54263 0.0527001 -0.000704207 0.00588882 -0.999876 0.0145819 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 4 -1.26623e-05 -0.00281771 3.99987 0.0236245 0.000992077 +EDGE_SE3:QUAT 785 786 4.1456 -0.0612538 0.0186165 0.000332817 0.00108964 0.00585129 0.999982 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 4.00002 1.61137e-06 0.00869331 4 2.54201e-05 3.99988 +EDGE_SE3:QUAT 453 785 3.06471 2.16068 0.0545257 0.0052277 0.0082106 -0.999634 0.0252363 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 3.99987 0.000167032 0.0209334 4.00022 0.0317396 0.00290911 +EDGE_SE3:QUAT 454 785 -1.24904 2.25099 0.0401266 0.00404044 0.00664785 -0.999699 0.023281 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 3.99992 0.000105627 0.0161764 4.00011 0.0258052 0.00240004 +EDGE_SE3:QUAT 455 785 -5.4259 2.34553 0.09296 0.000873799 0.00988726 -0.999726 0.0211944 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 3.99999 5.04568e-05 0.00349896 3.99963 0.0393549 0.00218728 +EDGE_SE3:QUAT 786 787 4.13794 -0.067605 0.0594465 0.00441205 0.0018584 0.00264623 0.999985 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 3.99998 3.26013e-05 0.0147267 3.99999 1.97841e-05 4.00003 +EDGE_SE3:QUAT 452 786 3.16279 1.9517 0.0105167 0.00555945 0.00214921 -0.999402 0.0340602 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 3.99987 2.29657e-05 0.0222768 4.00049 0.00705999 0.00477707 +EDGE_SE3:QUAT 453 786 -1.04185 2.01996 0.0263061 0.00628166 0.00828445 -0.99946 0.0311724 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 3.99982 0.000192601 0.0251668 4.00043 0.0314987 0.00429365 +EDGE_SE3:QUAT 454 786 -5.34724 2.12049 0.0310413 0.00493033 0.0063113 -0.999532 0.0295076 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 3.99989 0.000114951 0.0197491 4.00027 0.0240305 0.00372488 +EDGE_SE3:QUAT 787 788 4.3733 -0.12736 0.0187112 -0.00102237 -0.0030261 -0.0116979 0.999926 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 4.00014 9.87699e-06 -0.0243481 3.99996 0.000142468 3.9996 +EDGE_SE3:QUAT 451 787 3.36148 1.57128 0.0399406 0.00205636 0.00372112 -0.999505 0.0311839 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 3.99998 3.04136e-05 0.00823847 4.00002 0.0143361 0.00395817 +EDGE_SE3:QUAT 452 787 -0.954091 1.73921 0.0293714 0.00789088 -0.00206615 -0.999295 0.0366535 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 3.99976 -0.000117279 0.0316258 4.00095 -0.0105513 0.00565216 +EDGE_SE3:QUAT 453 787 -5.13658 1.8241 0.0354313 0.00832035 0.00373296 -0.999383 0.0339225 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 3.99971 6.95777e-05 0.033339 4.0011 0.0126382 0.00492114 +EDGE_SE3:QUAT 788 789 4.07087 -0.357701 0.0694805 -0.00159725 -0.0211336 -0.0958667 0.995169 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 4.0071 -0.00089449 -0.168832 3.99829 0.00810563 3.97035 +EDGE_SE3:QUAT 450 788 3.30921 1.19372 0.0405112 -0.0117392 -0.00510258 0.999552 0.027063 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 3.99948 0.000321043 0.0470073 4.00202 0.0229297 0.00361392 +EDGE_SE3:QUAT 451 788 -0.981429 1.441 0.0418343 -0.00100255 0.0046547 -0.999802 0.0193106 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 4 -1.56783e-05 -0.00401228 3.99993 0.0187561 0.00158361 +EDGE_SE3:QUAT 452 788 -5.31154 1.54925 -0.0164793 0.00504635 -0.000655853 -0.999684 0.0246146 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 3.9999 -2.80595e-05 0.0202035 4.0004 -0.00361309 0.00252889 +EDGE_SE3:QUAT 789 790 4.09232 -0.683856 -0.00222653 -0.000473631 0.0025945 -0.174731 0.984613 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 4.00009 -2.89804e-05 0.0188402 3.99998 -0.00158893 3.87796 +EDGE_SE3:QUAT 449 789 3.81837 1.0985 0.0249349 -0.00371084 -0.0147538 0.958934 0.283222 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 3.9999 -0.000280633 0.0138348 3.99918 0.0552448 0.321743 +EDGE_SE3:QUAT 450 789 -0.714664 1.78677 0.0199552 0.0100243 -0.00829263 0.992369 0.122618 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 3.99948 -2.9459e-05 -0.0411101 4.00177 0.0222575 0.0606975 +EDGE_SE3:QUAT 451 789 -5.05556 1.66683 0.129564 0.0224854 -0.00589296 0.996758 0.0770239 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 3.99791 0.000422124 -0.0907331 4.00831 0.00946601 0.0258252 +EDGE_SE3:QUAT 790 791 4.11578 -0.96187 -0.00389791 0.000748986 -0.000453994 -0.230525 0.973066 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 4 -5.034e-07 -0.0013478 4 6.42918e-05 3.78743 +EDGE_SE3:QUAT 395 790 0.388352 6.09019 -0.0166205 -0.0010918 0.007497 -0.871739 0.489913 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 3.99989 6.21813e-05 0.00141772 4 0.0168455 0.960184 +EDGE_SE3:QUAT 396 790 -3.77665 6.18291 -0.010245 -0.00124047 0.00941659 -0.873662 0.486441 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 3.99983 9.37143e-05 0.00228444 4 0.0210203 0.946698 +EDGE_SE3:QUAT 448 790 6.6397 2.09992 0.0693195 -0.00654935 -0.013452 0.765922 0.64276 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 3.9995 -0.000321814 0.00806738 3.99981 0.0269186 1.65313 +EDGE_SE3:QUAT 449 790 0.759323 3.88772 0.0529038 -0.00368116 -0.0148395 0.894857 0.446091 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 3.99966 -0.000386881 0.00788021 3.99958 0.0425006 0.796641 +EDGE_SE3:QUAT 450 790 -4.5065 3.43381 0.116241 0.00864355 -0.006539 0.955767 0.293925 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 3.99967 0.000442238 -0.0400823 4.00152 0.00210948 0.346012 +EDGE_SE3:QUAT 791 792 4.06419 -1.09746 -0.0057434 -0.00041761 0.00903078 -0.26123 0.965234 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 4.00101 -0.000448282 0.0637419 3.99985 -0.00793748 3.72804 +EDGE_SE3:QUAT 393 791 5.90168 2.90991 -0.00344023 -0.00119625 0.00844772 -0.958206 0.285953 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 3.99995 0.000105025 -0.00375414 3.99979 0.0295965 0.327324 +EDGE_SE3:QUAT 394 791 1.70553 2.97096 -0.00688612 8.67084e-05 0.00711201 -0.959713 0.280892 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 3.99994 7.42153e-05 0.0016467 3.99992 0.0228149 0.315747 +EDGE_SE3:QUAT 395 791 -2.55749 3.09091 -0.029568 -0.00287837 0.00603986 -0.961172 0.275868 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 4 1.51497e-05 -0.0117368 3.99984 0.0255557 0.304624 +EDGE_SE3:QUAT 396 791 -6.74329 3.20699 -0.0270834 -0.00341678 0.00766741 -0.962243 0.272063 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 4 3.06987e-05 -0.0138635 3.99974 0.0320286 0.296399 +EDGE_SE3:QUAT 792 793 3.89995 -1.0969 0.00372008 0.00481161 0.00331292 -0.264718 0.964308 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 4.00027 -2.96381e-05 0.0383401 3.99991 -0.00561645 3.72006 +EDGE_SE3:QUAT 392 792 6.1391 1.52461 0.0244084 0.00541198 0.0107171 -0.99954 0.027856 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 3.99986 0.000235139 0.021678 4.00009 0.0415853 0.00365406 +EDGE_SE3:QUAT 393 792 1.90147 1.60203 -0.00206431 0.00547978 0.0107059 -0.9996 0.0255874 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 3.99986 0.000237245 0.0219452 4.0001 0.0416378 0.00317304 +EDGE_SE3:QUAT 394 792 -2.25296 1.71097 -0.0137668 0.00709792 0.00959388 -0.999716 0.0206423 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 3.99978 0.000260921 0.0284132 4.00051 0.0371723 0.00225187 +EDGE_SE3:QUAT 395 792 -6.53339 1.84583 -0.00454308 0.00441868 0.00778309 -0.99984 0.0154851 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 3.99991 0.000137304 0.0176827 4.0001 0.030569 0.001271 +EDGE_SE3:QUAT 793 794 4.10617 -1.1957 0.00539894 -0.000456464 -0.00144318 -0.272988 0.962016 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 4.00003 -1.17886e-05 -0.0117003 3.99999 0.00160283 3.70195 +EDGE_SE3:QUAT 391 793 6.41863 2.32439 0.0173283 -0.00789688 -0.00614799 0.971468 0.23696 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 3.99996 0.000294343 0.0334847 4.00025 0.0353433 0.225215 +EDGE_SE3:QUAT 392 793 2.19468 2.39713 0.00419193 -0.00602644 -0.00700716 0.971241 0.237918 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 4 0.000140582 0.025312 3.99994 0.0349641 0.226904 +EDGE_SE3:QUAT 393 793 -2.02102 2.49824 -0.0137336 -0.00590709 -0.00689101 0.970665 0.240264 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 4 0.000133245 0.0248222 3.99994 0.0343672 0.231376 +EDGE_SE3:QUAT 394 793 -6.2265 2.64669 -0.0453674 -0.00775241 -0.00630009 0.969312 0.245631 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 3.99998 0.000276631 0.0329448 4.00019 0.0358 0.241955 +EDGE_SE3:QUAT 794 795 3.88138 -0.870023 -0.00773395 -0.00134691 -0.00203826 -0.189484 0.981881 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 4.00008 -1.04505e-05 -0.0184254 3.99998 0.00181376 3.85647 +EDGE_SE3:QUAT 337 794 3.02199 4.60832 0.0787107 0.00254207 0.0149459 -0.924805 0.38014 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 3.99954 7.27678e-05 0.0186877 4.00057 0.0327081 0.578513 +EDGE_SE3:QUAT 338 794 -3.02488 4.57514 0.0684278 0.00346982 0.0144266 -0.834116 0.551389 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 3.99972 -0.000722124 0.0379595 4.00129 0.00820837 1.21676 +EDGE_SE3:QUAT 391 794 3.32223 5.262 -0.0085247 -0.00477161 -0.00851427 0.86975 0.493396 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 3.99991 -0.000164524 0.0165015 3.99971 0.0294468 0.974136 +EDGE_SE3:QUAT 392 794 -0.905765 5.35234 -0.00833487 -0.00252883 -0.00904887 0.869491 0.493859 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 3.99985 -0.000140936 0.00436561 3.99988 0.0236744 0.975817 +EDGE_SE3:QUAT 795 796 4.0695 -0.463408 -0.0200019 0.00558349 0.047573 -0.070687 0.996348 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 4.0367 -0.00281792 0.385539 3.99101 -0.0136668 4.01683 +EDGE_SE3:QUAT 337 795 -0.345554 2.46629 0.041831 -0.00274126 0.0155479 -0.980142 0.197667 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 3.99995 0.000214998 -0.0106258 3.99905 0.0603577 0.157267 +EDGE_SE3:QUAT 338 795 -5.30644 1.33778 0.00319727 -0.00174717 0.0149269 -0.923606 0.383048 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 3.99969 0.000344384 -0.00163534 3.99967 0.0435364 0.587511 +EDGE_SE3:QUAT 796 797 4.05616 -0.114537 0.0411854 -0.00139483 -0.00736549 -0.00464621 0.999961 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 4.00086 3.51328e-05 -0.0590108 3.99978 0.000135405 4.00078 +EDGE_SE3:QUAT 337 796 -4.25456 1.31741 0.0243351 0.0439473 0.0191827 -0.990746 0.126976 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 3.99157 -0.00280994 0.180049 4.03334 0.0299325 0.0729862 +EDGE_SE3:QUAT 797 798 4.38186 -0.0869689 0.0266522 -0.00010448 -0.000840377 0.00364812 0.999993 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 4.00001 4.12654e-07 -0.00671832 4 -1.22536e-05 3.99996 +EDGE_SE3:QUAT 798 799 4.33554 -0.0662398 -0.00177652 0.00170093 -0.00114998 0.00510153 0.999985 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 4.00001 -7.77719e-06 -0.00930364 3.99999 -2.3765e-05 3.99992 +EDGE_SE3:QUAT 799 800 4.30093 -0.0853015 0.0176645 3.68821e-05 0.00434449 0.000222457 0.999991 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 4.0003 7.41882e-07 0.0347581 3.99992 3.88356e-06 4.0003 +EDGE_SE3:QUAT 332 799 4.75245 2.45847 0.0388688 0.00126705 -0.00750605 0.999918 0.0102959 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 3.99999 -4.22162e-05 -0.00506952 3.99981 0.0299114 0.000654156 +EDGE_SE3:QUAT 333 799 0.347867 2.50084 0.0658814 0.00455084 -0.00676594 0.999778 0.0194307 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 3.99991 -0.0001199 -0.018215 4.00018 0.0263337 0.00176661 +EDGE_SE3:QUAT 334 799 -3.75734 2.63254 -0.00216011 -0.00536617 -0.0055165 0.999587 0.0276725 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 3.9999 0.000129381 0.0214893 4.0003 0.0232139 0.0033134 +EDGE_SE3:QUAT 800 801 4.28916 -0.088073 0.0501631 -0.000731111 0.0024988 0.000325405 0.999997 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 4.0001 -7.26085e-06 0.0199937 3.99998 3.1438e-06 4.0001 +EDGE_SE3:QUAT 331 800 4.86993 2.54537 0.0804634 -0.00769118 -0.00708988 0.999933 0.00500145 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 3.99977 0.000223277 0.0307674 4.00073 0.028674 0.000542228 +EDGE_SE3:QUAT 332 800 0.463161 2.63015 0.0734322 -0.00297774 -0.00710403 0.999921 0.00993013 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 3.99997 8.25887e-05 0.0119135 3.99993 0.0286462 0.000635088 +EDGE_SE3:QUAT 333 800 -3.92496 2.75296 0.134496 0.000328922 -0.00631366 0.999797 0.0191426 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 4 -1.43022e-05 -0.00131688 3.99984 0.0251807 0.00162477 +EDGE_SE3:QUAT 801 802 4.26797 -0.0891529 0.0550608 -0.000510165 -0.00304568 0.000552534 0.999995 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 4.00015 6.33784e-06 -0.0243629 3.99996 -6.84455e-06 4.00015 +EDGE_SE3:QUAT 330 801 5.01519 2.59119 0.115718 -0.012431 -0.00797952 0.999889 0.00215667 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 3.99939 0.000404453 0.0497255 4.00221 0.0321584 0.000895178 +EDGE_SE3:QUAT 331 801 0.575364 2.67856 0.0691567 -0.0100597 -0.00793925 0.999905 0.00512581 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 3.9996 0.000329605 0.0402423 4.00135 0.0321842 0.000768829 +EDGE_SE3:QUAT 332 801 -3.8249 2.80449 0.0960345 -0.00565235 -0.00834798 0.999897 0.0101738 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 3.99988 0.000190614 0.0226149 4.00021 0.0338478 0.000828319 +EDGE_SE3:QUAT 802 803 4.22692 -0.0903202 0.0127876 0.000771954 -0.0024682 0.000984881 0.999996 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 4.0001 -7.48256e-06 -0.0197551 3.99998 -9.61738e-06 4.00009 +EDGE_SE3:QUAT 329 802 4.75908 2.60692 0.0702559 -0.00333022 -0.0076665 0.999965 0.000510802 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 3.99996 0.000102024 0.013322 3.99994 0.0306805 0.000280735 +EDGE_SE3:QUAT 330 802 0.77679 2.69384 0.0620366 -0.00946048 -0.00854876 0.999917 0.00168027 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 3.99964 0.000326471 0.0378446 4.00113 0.0343376 0.000664012 +EDGE_SE3:QUAT 331 802 -3.6446 2.80208 0.0371188 -0.00714735 -0.00825071 0.99993 0.00465214 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 3.9998 0.000239105 0.0285926 4.00053 0.0332752 0.000567718 +EDGE_SE3:QUAT 803 804 4.34314 -0.094092 0.00832588 0.00129835 0.00565928 0.00146274 0.999982 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 4.00051 3.05078e-05 0.0452563 3.99987 3.4102e-05 4.0005 +EDGE_SE3:QUAT 328 803 5.00269 2.63138 0.018451 -0.00587587 0.00609466 -0.999964 0.000720489 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 3.99986 -0.000143686 -0.0235044 4.0004 0.0244167 0.000289214 +EDGE_SE3:QUAT 329 803 0.567242 2.71419 0.0516314 0.000792153 0.00697369 -0.999975 0.000631866 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 4 2.23311e-05 0.00316885 3.99982 0.0278901 0.000198581 +EDGE_SE3:QUAT 330 803 -3.45728 2.80821 0.00187157 -0.00701965 -0.00748814 0.999947 0.000888717 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 3.9998 0.000211027 0.0280803 4.00056 0.0300097 0.000425387 +EDGE_SE3:QUAT 804 805 4.27335 -0.0789628 0.0328462 -0.00133664 -0.000830493 0.00197921 0.999997 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 4 4.44451e-06 -0.00661216 4 -6.55495e-06 4 +EDGE_SE3:QUAT 327 804 5.07091 2.65001 0.0500892 0.00233424 0.0072891 -0.999939 0.0079884 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 3.99998 7.0337e-05 0.00933861 3.99988 0.0290028 0.00048737 +EDGE_SE3:QUAT 328 804 0.706998 2.70235 0.0782516 -0.000353395 0.00480426 -0.999985 0.00245965 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 4 -6.34347e-06 -0.00141364 3.99991 0.0192235 0.000117088 +EDGE_SE3:QUAT 329 804 -3.75225 2.7991 0.0553444 0.00648451 0.0053765 -0.999962 0.00203609 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 3.99983 0.000137937 0.0259388 4.00056 0.0214048 0.000299312 +EDGE_SE3:QUAT 805 806 4.2272 -0.080251 0.0457197 -0.00124511 0.00374791 0.00196639 0.99999 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 4.00022 -1.80301e-05 0.0300139 3.99994 2.9103e-05 4.00021 +EDGE_SE3:QUAT 326 805 5.14533 2.62678 0.0703936 0.00617381 0.00807503 -0.999775 0.0186396 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 3.99983 0.000191063 0.0247102 4.00039 0.0313577 0.00178832 +EDGE_SE3:QUAT 327 805 0.824971 2.65399 0.0645114 0.00136487 0.00845266 -0.999914 0.00997802 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 3.99999 5.13229e-05 0.00546096 3.99975 0.0336925 0.000689541 +EDGE_SE3:QUAT 328 805 -3.52645 2.78015 0.114648 -0.000939215 0.00607614 -0.999973 0.00395568 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 4 -2.17356e-05 -0.00375715 3.99987 0.024333 0.000214149 +EDGE_SE3:QUAT 806 807 4.23847 -0.085425 0.02388 0.00231204 -0.00636305 0.00235264 0.999974 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 4.00063 -5.66882e-05 -0.0509761 3.99984 -5.77634e-05 4.00063 +EDGE_SE3:QUAT 325 806 5.25036 2.52201 0.102588 0.0116 0.00798557 -0.999475 0.0291697 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 3.99942 0.000286908 0.0464602 4.00202 0.029191 0.00415676 +EDGE_SE3:QUAT 326 806 0.929268 2.55192 0.0692288 0.00979639 0.00983421 -0.999688 0.0207491 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 3.99959 0.000351444 0.0392142 4.00124 0.037688 0.00246184 +EDGE_SE3:QUAT 327 806 -3.38153 2.67171 0.102716 0.00525477 0.0103329 -0.99986 0.0120255 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 3.99988 0.000219029 0.0210267 4.00005 0.0408157 0.00110551 +EDGE_SE3:QUAT 807 808 4.1525 -0.0709792 -0.000385074 -0.000329812 -0.000426831 0.0021357 0.999998 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 4 5.70535e-07 -0.00340617 4 -3.6357e-06 3.99998 +EDGE_SE3:QUAT 324 807 5.13355 2.31911 0.03714 -0.000762771 0.00557913 -0.999228 0.0388828 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 4 -7.53527e-06 -0.00305546 3.99988 0.0224688 0.00617625 +EDGE_SE3:QUAT 325 807 1.01064 2.3531 0.0306518 0.00532904 0.00539731 -0.99947 0.0316489 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 3.99987 9.90615e-05 0.0213499 4.00038 0.0201903 0.00422269 +EDGE_SE3:QUAT 326 807 -3.28134 2.46442 0.0134634 0.00370658 0.0072697 -0.999683 0.0238111 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 3.99993 0.000109017 0.0148407 4.00004 0.0283336 0.00252378 +EDGE_SE3:QUAT 808 809 4.15233 -0.109902 0.00323756 -3.0908e-06 0.00649189 -0.0124346 0.999902 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 4.00067 -1.26563e-05 0.0519303 3.99983 -0.000322986 4.00006 +EDGE_SE3:QUAT 323 808 4.98073 1.97709 0.011172 -0.00435252 0.00673245 -0.999006 0.0438478 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 3.99994 -0.00011773 -0.0174569 4.00006 0.0283261 0.00796779 +EDGE_SE3:QUAT 324 808 0.995698 2.06215 0.0404292 -0.00109305 0.00622898 -0.999137 0.0410487 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 4 -1.5028e-05 -0.00437999 3.99985 0.025169 0.00690343 +EDGE_SE3:QUAT 325 808 -3.11788 2.16644 -0.0167071 0.0054044 0.006116 -0.999381 0.0342268 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 3.99987 0.000116035 0.0216581 4.00037 0.0229179 0.00493476 +EDGE_SE3:QUAT 809 810 4.06575 -0.235219 0.033063 -0.00157492 -0.0152673 -0.060871 0.998028 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 4.00375 -0.0002466 -0.122709 3.99907 0.00373981 3.98894 +EDGE_SE3:QUAT 322 809 5.26675 1.20985 0.117119 -0.0170799 -0.0112146 0.99938 0.0286703 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 3.99893 0.000930716 0.0684106 4.00389 0.0487533 0.00505289 +EDGE_SE3:QUAT 323 809 0.841087 1.71497 0.0509272 0.00212464 0.00699467 -0.999474 0.0316015 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 3.99997 6.73914e-05 0.00851367 3.9999 0.0273725 0.00420026 +EDGE_SE3:QUAT 324 809 -3.11729 1.84088 0.0529899 0.00544515 0.00627407 -0.999552 0.0287408 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 3.99987 0.000123496 0.0218094 4.00036 0.0237972 0.00356483 +EDGE_SE3:QUAT 810 811 4.10644 -0.600074 0.0173586 0.00288982 -0.00281865 -0.150915 0.988538 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 4.00003 -3.95034e-05 -0.0166292 3.99999 0.00110391 3.90897 +EDGE_SE3:QUAT 321 810 5.54644 0.639893 0.0507044 -0.00858541 -0.0164611 0.975507 0.219183 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 4.00002 0.000130899 0.0353488 3.99897 0.072393 0.193854 +EDGE_SE3:QUAT 322 810 1.23102 1.67326 0.0208854 -0.00114638 -0.0142903 0.995906 0.0892551 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 3.99999 -8.06014e-05 0.00455802 3.99919 0.0568321 0.0326853 +EDGE_SE3:QUAT 323 810 -3.20056 1.71332 0.0665995 0.0136594 -0.00822352 0.999442 0.0293371 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 3.99921 -0.000328859 -0.0547075 4.00287 0.0296502 0.00441147 +EDGE_SE3:QUAT 324 810 -7.178 1.86468 0.0474451 0.0104401 -0.00777959 0.999391 0.0323774 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 3.99952 -0.000250966 -0.0418279 4.00162 0.0283522 0.00483219 +EDGE_SE3:QUAT 811 812 4.20613 -0.967857 0.00819396 0.00230363 -0.00333041 -0.228244 0.973596 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 4.00006 -5.40209e-05 -0.0184983 3.99999 0.00178958 3.7917 +EDGE_SE3:QUAT 320 811 7.14991 0.846101 0.0515625 -0.00780417 -0.0134509 0.832496 0.553812 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 3.99965 -0.000458897 0.0236502 3.9994 0.0412797 1.22769 +EDGE_SE3:QUAT 321 811 2.10951 2.95965 0.0524161 -0.00258144 -0.0150921 0.931243 0.364077 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 3.99974 -0.000376508 0.00633566 3.99947 0.0478385 0.530916 +EDGE_SE3:QUAT 322 811 -2.68547 2.99789 0.0632632 0.00407423 -0.0114931 0.971131 0.238233 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 3.99972 -0.000130805 -0.018867 4.0004 0.0322627 0.227403 +EDGE_SE3:QUAT 812 813 4.01311 -1.01662 -0.00278032 -0.000442588 0.00440396 -0.247194 0.968956 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 4.00023 -0.000102773 0.0307943 3.99996 -0.00361378 3.75582 +EDGE_SE3:QUAT 264 812 5.52946 4.80037 0.0270187 0.00108176 0.00848163 -0.934185 0.356686 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 3.99987 5.79287e-05 0.00814992 4.0001 0.0209373 0.509062 +EDGE_SE3:QUAT 265 812 1.35791 4.84939 -0.0205593 -0.00119228 0.00692414 -0.937477 0.347976 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 3.99995 7.83965e-05 -0.00321943 3.99988 0.0225942 0.484503 +EDGE_SE3:QUAT 266 812 -2.84423 4.96978 -0.0554757 -0.00216127 0.00499472 -0.941224 0.337739 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 3.99999 3.09182e-05 -0.00845398 3.99989 0.0196879 0.4564 +EDGE_SE3:QUAT 321 812 -0.316003 6.50432 0.121095 0.00503366 -0.0139837 0.823674 0.566869 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 3.99987 0.00107175 -0.04762 4.00158 0.000956784 1.28621 +EDGE_SE3:QUAT 813 814 3.9503 -1.13785 -0.0110991 0.00150337 0.00724563 -0.27624 0.96106 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 4.00078 -0.000302767 0.0561981 3.99987 -0.00767028 3.69555 +EDGE_SE3:QUAT 263 813 6.16427 2.82173 0.00344467 0.00153688 0.00812345 -0.992676 0.120523 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 3.99995 9.13448e-05 0.00639451 3.99987 0.0298597 0.0583405 +EDGE_SE3:QUAT 264 813 1.87648 2.88091 0.00390756 0.00277499 0.0103176 -0.993316 0.114934 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 3.9999 0.000162022 0.0114446 3.99989 0.0373978 0.053228 +EDGE_SE3:QUAT 265 813 -2.31139 2.9923 -0.0175699 0.00132085 0.00833929 -0.994427 0.105086 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 3.99996 8.76211e-05 0.00544836 3.99983 0.0313415 0.0444285 +EDGE_SE3:QUAT 266 813 -6.54501 3.18641 -0.0446326 0.000865364 0.00639304 -0.995468 0.0948806 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 3.99998 4.70634e-05 0.00355189 3.99988 0.0243474 0.0361622 +EDGE_SE3:QUAT 814 815 3.98901 -1.17664 -0.00125463 -0.00175449 0.000433857 -0.274068 0.961709 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 3.99999 3.80875e-06 -0.00239403 4 0.000609745 3.69955 +EDGE_SE3:QUAT 262 814 6.50644 2.93674 -0.0075178 -0.00785935 -0.0054466 0.988031 0.153959 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 3.99988 0.000293634 0.0323796 4.00052 0.0299639 0.0953083 +EDGE_SE3:QUAT 263 814 2.05211 2.98988 -0.0127059 -0.00669942 -0.00792331 0.987238 0.158913 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 3.99995 0.000221193 0.0275429 4.00008 0.0380157 0.101576 +EDGE_SE3:QUAT 264 814 -2.20658 3.09559 -0.0164809 -0.00756488 -0.0105755 0.986328 0.164282 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 3.99996 0.000270758 0.0310909 3.99989 0.0491527 0.108819 +EDGE_SE3:QUAT 265 814 -6.42333 3.2791 -0.0282668 -0.00652314 -0.00809694 0.984716 0.173858 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 3.99997 0.000201045 0.0269119 4 0.0387678 0.121476 +EDGE_SE3:QUAT 815 816 3.95965 -0.899238 0.0113581 0.00187678 0.00166309 -0.200655 0.979659 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 4.00006 -2.93467e-06 0.0169073 3.99998 -0.00181946 3.83902 +EDGE_SE3:QUAT 209 815 3.52894 5.35303 0.0611868 0.00422068 0.0127994 -0.914449 0.404477 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 3.99961 -0.000212882 0.027262 4.00097 0.0200833 0.654811 +EDGE_SE3:QUAT 210 815 -3.26075 5.34116 0.0900226 -0.0010271 0.0172841 -0.803452 0.595118 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 3.99945 -0.000293584 0.0234973 4.00078 0.0193587 1.41732 +EDGE_SE3:QUAT 262 815 3.05792 5.26664 -0.0458356 -0.00678596 -0.00886077 0.907833 0.419184 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 3.99999 -6.58913e-05 0.028084 3.9996 0.039624 0.703537 +EDGE_SE3:QUAT 263 815 -1.36163 5.34623 -0.0332948 -0.00492128 -0.0109318 0.905912 0.423296 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 3.99989 -0.000225423 0.0175904 3.99953 0.0390942 0.717279 +EDGE_SE3:QUAT 816 817 4.31125 -0.679321 -0.0673986 0.00567872 0.0381672 -0.116245 0.992471 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 4.02354 -0.00326519 0.308615 3.99441 -0.0180476 3.96962 +EDGE_SE3:QUAT 209 816 0.213007 3.02218 0.0187852 0.00368091 0.0123467 -0.977195 0.211954 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 3.99974 0.000201009 0.0166233 4.00021 0.0379731 0.180157 +EDGE_SE3:QUAT 210 816 -5.27592 1.82803 0.0577592 -0.0020769 0.0162359 -0.906559 0.421761 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 3.99958 0.000383237 -0.000464361 3.99974 0.0436965 0.712197 +EDGE_SE3:QUAT 817 818 4.40724 -0.21231 0.0325436 0.00185854 0.000772041 -0.0188383 0.999821 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 4 5.95735e-06 0.00659307 4 -6.33807e-05 3.99859 +EDGE_SE3:QUAT 209 817 -3.97538 1.86417 -0.0865932 0.0407029 0.0151683 -0.994404 0.0962962 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 3.99291 -0.00145887 0.16499 4.02788 0.0283955 0.0441804 +EDGE_SE3:QUAT 818 819 4.14558 -0.082666 0.038771 0.00197874 -0.00248182 0.00545054 0.99998 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 4.00008 -1.90007e-05 -0.0199834 3.99997 -5.4285e-05 3.99998 +EDGE_SE3:QUAT 819 820 4.37245 -0.0590294 0.0331504 -0.00196189 0.000466202 0.00674997 0.999975 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 3.99999 -3.82847e-06 0.00388825 4 1.32904e-05 3.99982 +EDGE_SE3:QUAT 820 821 4.00478 -0.0546544 0.0284317 -0.00267101 0.00319586 0.00554599 0.999976 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 4.00014 -3.30894e-05 0.0257441 3.99996 7.08972e-05 4.00004 +EDGE_SE3:QUAT 204 820 4.30842 2.57205 0.053775 -0.00100131 -0.00679153 0.999962 0.00540462 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 4 2.53228e-05 0.00400566 3.99983 0.0272069 0.000305918 +EDGE_SE3:QUAT 205 820 0.263814 2.65851 0.0511717 -0.00529861 -0.00632904 0.999941 0.00702258 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 3.99989 0.000136557 0.021197 4.00028 0.0256141 0.000473611 +EDGE_SE3:QUAT 206 820 -4.08813 2.7726 -0.00632562 -0.0097714 -0.00665967 0.99985 0.0126644 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 3.99963 0.000284475 0.0390961 4.00131 0.0276315 0.00121457 +EDGE_SE3:QUAT 821 822 4.09256 -0.0841269 0.0172416 0.00353658 -0.00114545 0.0034837 0.999987 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 3.99997 -1.64395e-05 -0.00931114 3.99999 -1.61903e-05 3.99997 +EDGE_SE3:QUAT 203 821 4.48168 2.57775 0.0744608 0.00530912 0.00904445 -0.999945 0.000754346 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 3.99989 0.000192099 0.0212388 4.00013 0.0361499 0.000441726 +EDGE_SE3:QUAT 204 821 0.32093 2.67193 0.0760036 0.00443474 0.0093244 -0.999947 9.2681e-05 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 3.99992 0.000165443 0.0177411 3.99997 0.0372967 0.000426473 +EDGE_SE3:QUAT 205 821 -3.73118 2.76627 0.0367977 -0.00843862 -0.00889158 0.999923 0.00166117 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 3.99972 0.000302156 0.0337575 4.00082 0.0356907 0.000614298 +EDGE_SE3:QUAT 822 823 4.22074 -0.0758131 0.0198838 -0.000207337 -0.00247348 0.00194285 0.999995 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 4.0001 2.33604e-06 -0.0197833 3.99998 -1.9248e-05 4.00008 +EDGE_SE3:QUAT 202 822 4.52078 2.55636 0.0678836 0.00457488 0.00646432 -0.999956 0.00503583 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 3.99991 0.000117425 0.0183011 4.00017 0.0256738 0.000349951 +EDGE_SE3:QUAT 203 822 0.403437 2.65787 0.0537579 0.00423609 0.00576942 -0.999965 0.00438071 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 3.99993 9.70277e-05 0.0169455 4.00016 0.0229301 0.000279992 +EDGE_SE3:QUAT 204 822 -3.72484 2.74663 0.0647876 0.00338714 0.00575392 -0.999973 0.00319581 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 3.99995 7.79188e-05 0.0135494 4.00005 0.0229296 0.000218188 +EDGE_SE3:QUAT 823 824 4.26399 -0.0827924 0.0148696 -0.000412671 0.0022666 0.00236084 0.999995 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 4.00008 -3.45349e-06 0.0181447 3.99998 2.1373e-05 4.00006 +EDGE_SE3:QUAT 201 823 4.63163 2.51151 0.0446971 0.00120972 0.00530714 -0.999956 0.00770276 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 3.99999 2.712e-05 0.00483953 3.99991 0.0211508 0.000355033 +EDGE_SE3:QUAT 202 823 0.318475 2.59648 0.0494708 0.00237248 0.00658089 -0.999947 0.00750697 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 3.99998 6.39821e-05 0.00949134 3.99992 0.0261777 0.00041927 +EDGE_SE3:QUAT 203 823 -3.80154 2.6903 0.0380916 0.00211771 0.0060588 -0.999959 0.00637919 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 3.99998 5.24759e-05 0.00847182 3.99993 0.0241249 0.000326229 +EDGE_SE3:QUAT 824 825 4.42194 -0.0985378 0.0285092 0.00171166 0.00408522 -0.000225603 0.99999 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 4.00026 2.78914e-05 0.0326882 3.99993 -3.0023e-06 4.00027 +EDGE_SE3:QUAT 200 824 4.49568 2.42682 0.057692 0.00420964 0.0050736 -0.999929 0.00996738 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 3.99993 8.31272e-05 0.0168416 4.00019 0.0199555 0.00056787 +EDGE_SE3:QUAT 201 824 0.37962 2.52161 0.0495131 0.0035698 0.00574182 -0.999929 0.00978664 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 3.99995 8.14605e-05 0.0142819 4.00008 0.0226836 0.000562755 +EDGE_SE3:QUAT 202 824 -3.91303 2.6162 0.0442577 0.00462967 0.00701527 -0.999919 0.00953358 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 3.99991 0.000128602 0.0185224 4.00016 0.0277043 0.000641221 +EDGE_SE3:QUAT 825 826 4.21218 -0.094331 0.023298 9.77723e-05 -0.000975392 -0.00139649 0.999999 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 4.00002 -4.13239e-07 -0.0078015 4 5.44925e-06 4.00001 +EDGE_SE3:QUAT 199 825 4.29108 2.34351 0.0632432 0.00438672 0.00493388 -0.999941 0.00861272 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 3.99992 8.41907e-05 0.0175493 4.00022 0.0194315 0.000468111 +EDGE_SE3:QUAT 200 825 0.0749044 2.44022 0.0477611 0.00835808 0.00289734 -0.999914 0.00964442 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 3.99972 8.12901e-05 0.0334361 4.0011 0.010946 0.000681544 +EDGE_SE3:QUAT 201 825 -4.00843 2.54663 0.0451232 0.00767016 0.00397226 -0.999917 0.00954588 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 3.99976 0.000109517 0.0306846 4.00089 0.0153046 0.00065846 +EDGE_SE3:QUAT 826 827 4.09733 -0.102207 0.037841 -0.000184264 -0.000128399 -0.00177767 0.999998 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 4 9.44116e-08 -0.00103112 4 9.17581e-07 3.99999 +EDGE_SE3:QUAT 198 826 4.26795 2.27167 0.0380109 0.00273041 0.00500757 -0.999965 0.00607497 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 3.99997 5.47934e-05 0.0109226 4.00002 0.0198963 0.000276416 +EDGE_SE3:QUAT 199 826 0.0735232 2.37516 0.0539413 0.00349075 0.00472582 -0.999953 0.00770269 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 3.99995 6.50562e-05 0.0139646 4.00011 0.0186865 0.000373379 +EDGE_SE3:QUAT 200 826 -4.10357 2.45885 0.00609937 0.00742342 0.00308333 -0.999932 0.00848345 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 3.99978 8.09437e-05 0.0296964 4.00085 0.0118309 0.000543358 +EDGE_SE3:QUAT 827 828 4.25604 -0.107965 0.0239498 -0.00014733 0.0019182 -0.00320952 0.999993 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 4.00006 -1.41318e-06 0.0153399 3.99999 -2.46277e-05 4.00002 +EDGE_SE3:QUAT 197 827 4.19589 2.22603 0.0517536 5.85516e-05 0.00755831 -0.999966 0.00323186 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 4 3.24636e-06 0.000234243 3.99977 0.0302301 0.000270273 +EDGE_SE3:QUAT 198 827 0.187202 2.32933 0.0647207 0.0027169 0.00553415 -0.99997 0.00463137 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 3.99997 6.04393e-05 0.0108684 4 0.0220353 0.00023672 +EDGE_SE3:QUAT 199 827 -3.99274 2.41583 0.0630135 0.00331643 0.00538068 -0.999961 0.00611912 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 3.99995 7.11449e-05 0.013267 4.00007 0.0213594 0.000307835 +EDGE_SE3:QUAT 828 829 4.0657 -0.107128 0.0465167 -0.00155127 0.00170787 -0.00282123 0.999993 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 4.00004 -1.07397e-05 0.0136104 3.99999 -1.92827e-05 4.00001 +EDGE_SE3:QUAT 196 828 4.00868 2.22385 0.0654345 -0.00545973 -0.00612091 0.999966 0.00107788 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 3.99988 0.000134165 0.0218399 4.00033 0.0245342 0.000274356 +EDGE_SE3:QUAT 197 828 -0.0374042 2.30424 0.0788292 0.00202916 0.00757404 -0.999969 0.000226701 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 3.99998 6.1554e-05 0.00811734 3.99984 0.0302923 0.000246092 +EDGE_SE3:QUAT 198 828 -4.0215 2.41218 0.0609404 0.0048472 0.00577725 -0.99997 0.0015743 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 3.99991 0.000111572 0.0193896 4.00024 0.0230504 0.000236722 +EDGE_SE3:QUAT 829 830 4.03322 -0.0913718 0.0244717 -0.00218368 0.0064488 -0.00133668 0.999976 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 4.00065 -5.76424e-05 0.0515623 3.99983 -3.66458e-05 4.00066 +EDGE_SE3:QUAT 195 829 4.29004 2.27749 0.0485871 -0.00118535 -0.00590776 0.999981 0.00113434 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 3.99999 2.77305e-05 0.00474164 3.99988 0.0236415 0.000150502 +EDGE_SE3:QUAT 196 829 -0.0345776 2.3316 0.0728253 -0.00704413 -0.00788066 0.999937 0.00386563 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 3.99981 0.000224804 0.0281792 4.00054 0.0317469 0.000510213 +EDGE_SE3:QUAT 197 829 -4.08733 2.41175 0.108185 -0.00401917 -0.00932946 0.999945 0.00250388 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 3.99994 0.000149206 0.0160788 3.99991 0.0373994 0.000439389 +EDGE_SE3:QUAT 830 831 4.10624 -0.105339 0.0260772 0.00497753 -0.00605341 -0.000637425 0.999969 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 4.00049 -0.000121014 -0.0483936 3.99985 1.9798e-05 4.00058 +EDGE_SE3:QUAT 194 830 4.28667 2.42604 0.0709239 0.00440524 0.00757688 -0.999607 0.0266365 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 3.99991 0.000131829 0.017642 4.00012 0.0293184 0.00313092 +EDGE_SE3:QUAT 195 830 0.272125 2.36216 0.0680465 -0.00765447 -0.00797701 0.999936 0.00246012 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 3.99977 0.00024659 0.0306202 4.00068 0.0320674 0.000515632 +EDGE_SE3:QUAT 196 830 -4.05349 2.44625 0.0499342 -0.0133366 -0.0103315 0.999844 0.00524735 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 3.9993 0.000570072 0.0533529 4.00238 0.0419215 0.00126086 +EDGE_SE3:QUAT 831 832 4.06833 -0.0900735 0.0180137 0.00274889 -0.00946074 0.00180669 0.99995 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 4.0014 -0.000100377 -0.0757681 3.99964 -6.2612e-05 4.00142 +EDGE_SE3:QUAT 193 831 3.92643 2.70697 0.0520687 0.00450555 0.00401124 -0.992422 0.122731 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 3.99989 1.17335e-05 0.0184838 4.00036 0.0110881 0.0603698 +EDGE_SE3:QUAT 194 831 0.184354 2.32746 0.0611647 -0.00157339 0.00230871 -0.999655 0.0261347 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 3.99999 -1.48115e-05 -0.00629974 4.00001 0.00954792 0.00276482 +EDGE_SE3:QUAT 195 831 -3.8097 2.48937 0.0360366 -0.00131675 -0.00277609 0.999991 0.00299267 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 3.99999 1.45598e-05 0.00526714 4 0.0111357 7.37612e-05 +EDGE_SE3:QUAT 832 833 4.2276 -0.0775346 0.038994 0.000142105 -0.0142965 0.00573544 0.999881 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 4.00327 2.00141e-05 -0.114458 3.99918 -0.000328244 4.00314 +EDGE_SE3:QUAT 130 832 3.32247 -5.9231 0.0835534 -0.0133876 0.00792299 0.715365 0.698577 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 4.00151 0.00226287 0.0973945 4.00117 0.0378131 1.95524 +EDGE_SE3:QUAT 131 832 -1.02748 -5.85871 0.0735592 -0.0140891 0.007958 0.705223 0.708801 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 4.0017 0.00238849 0.102452 4.00113 0.0399151 2.01314 +EDGE_SE3:QUAT 191 832 6.06787 4.2187 0.116813 0.0143897 0.0111568 -0.863837 0.503442 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 4.00019 -0.00274136 0.0863583 4.0037 -0.0243307 1.01616 +EDGE_SE3:QUAT 192 832 3.38301 2.32621 0.0355857 0.00859435 0.00318016 -0.952294 0.305046 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 3.99981 -0.000474737 0.0395545 4.00119 -0.00916887 0.372655 +EDGE_SE3:QUAT 193 832 -0.0211858 1.79323 0.0321725 -0.00429209 0.000277221 -0.992186 0.124691 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 3.99994 -5.70934e-05 -0.0175598 4.00027 0.00528156 0.0622769 +EDGE_SE3:QUAT 194 832 -3.86538 2.21534 0.0919088 -0.0109615 -0.000979984 -0.999547 0.0280283 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 3.99952 -3.80401e-05 -0.043895 4.00193 -0.00145684 0.00362501 +EDGE_SE3:QUAT 833 834 4.12002 -0.0704803 0.0334555 -0.00340933 -0.00524291 0.00441354 0.999971 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 4.00039 7.4004e-05 -0.0417647 3.99989 -9.42916e-05 4.00036 +EDGE_SE3:QUAT 78 833 -2.19814 5.88858 0.0915899 0.0066864 0.0110419 -0.8532 0.521424 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 3.99991 -0.000982558 0.0477527 4.00153 -0.00312787 1.08828 +EDGE_SE3:QUAT 130 833 3.28812 -1.69224 -0.003762 -0.00271384 -0.00174291 0.719555 0.694428 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 3.99999 -1.38509e-05 0.0106753 3.99997 0.00798428 1.92898 +EDGE_SE3:QUAT 131 833 -0.919627 -1.64057 -0.0158754 -0.00371151 -0.00162709 0.709432 0.704762 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 4.00001 -6.1869e-06 0.0164387 3.99996 0.0105624 1.98689 +EDGE_SE3:QUAT 132 833 -5.1952 -1.60328 -0.0334553 0.000828116 -0.00454481 0.711221 0.702953 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 4.00003 0.000128647 -0.0173139 4.00011 -0.00220519 1.97669 +EDGE_SE3:QUAT 191 833 3.92483 0.580541 0.00694085 0.00236208 0.00361822 -0.860926 0.508712 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 3.99999 -0.000110759 0.0161552 4.00018 -0.00111465 1.03524 +EDGE_SE3:QUAT 192 833 -0.0818869 -0.0512596 -0.00642564 -0.00482149 -0.00157811 -0.950601 0.310375 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 3.99995 -0.000151824 -0.0222434 4.00036 0.0059752 0.385472 +EDGE_SE3:QUAT 193 833 -4.12147 0.838887 0.10418 -0.0183646 -0.00186746 -0.991287 0.130416 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 3.99876 -0.000920096 -0.0753339 4.00533 0.0117118 0.0695102 +EDGE_SE3:QUAT 834 835 4.12927 -0.0678925 0.0291991 -0.00222168 -0.0161033 0.00269435 0.999864 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 4.00413 0.00016029 -0.128869 3.99896 -0.000187881 4.00412 +EDGE_SE3:QUAT 76 834 7.29487 1.22957 0.171626 0.0226266 0.00473532 -0.999663 0.0118043 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 3.99793 0.000287462 0.0905036 4.00817 0.0168441 0.00267718 +EDGE_SE3:QUAT 77 834 2.23227 2.94708 0.0454551 0.00538533 0.0117872 -0.976379 0.215675 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 3.99966 0.00012699 0.0239361 4.00064 0.0329054 0.186509 +EDGE_SE3:QUAT 78 834 -4.12448 2.25101 0.0445936 0.000782698 0.0117785 -0.850769 0.525408 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 3.99973 -0.000136821 0.0177985 4.00046 0.015573 1.10451 +EDGE_SE3:QUAT 130 834 3.21333 2.41162 0.0228564 -0.00168008 -0.00750866 0.722415 0.691417 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 3.9999 6.68071e-05 -0.0103579 4.00012 0.00580161 1.91238 +EDGE_SE3:QUAT 131 834 -0.889028 2.48094 0.00786002 -0.00259907 -0.00816793 0.712646 0.701471 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 3.99985 3.1571e-05 -0.00785361 4.00009 0.00777684 1.96842 +EDGE_SE3:QUAT 132 834 -5.17278 2.51728 0.0306929 0.00234667 -0.0109502 0.713925 0.700132 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 4.0002 0.000791952 -0.04334 4.00069 -0.00610007 1.96146 +EDGE_SE3:QUAT 190 834 6.86912 -1.48382 0.0121838 0.000981702 0.00563604 -0.741431 0.671004 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 4.00002 -0.000171392 0.0191554 4.00018 -0.00123511 1.80114 +EDGE_SE3:QUAT 191 834 1.88369 -2.97787 0.0125916 -0.00385167 0.00387665 -0.85883 0.512231 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 4 2.07688e-05 -0.0160075 3.99991 0.0179708 1.0497 +EDGE_SE3:QUAT 192 834 -3.4281 -2.43137 0.0736166 -0.0108222 -8.5675e-05 -0.949207 0.314465 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 3.99986 -0.00073033 -0.049248 4.00137 0.0242887 0.396352 +EDGE_SE3:QUAT 835 836 4.02983 -0.0479212 0.0371766 -0.00581254 0.0266477 0.00229388 0.999625 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 4.01127 -0.000587053 0.213862 3.99715 0.000147665 4.01138 +EDGE_SE3:QUAT 75 835 7.18098 1.56744 -0.211383 -0.0235857 0.00776274 -0.998839 0.0412787 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 3.99793 -0.00124866 -0.0945745 4.00827 0.0388131 0.00943244 +EDGE_SE3:QUAT 76 835 3.18095 1.18889 0.0151199 0.00638912 0.00661914 -0.999849 0.0147325 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 3.99983 0.000159391 0.0255659 4.00051 0.0257147 0.00119695 +EDGE_SE3:QUAT 77 835 -1.5271 1.27512 0.00691739 -0.010453 0.0104127 -0.975796 0.218184 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 3.99995 -0.000493011 -0.0438376 4.00019 0.0541652 0.191672 +EDGE_SE3:QUAT 78 835 -6.02492 -1.3863 0.0139934 -0.0140275 0.00498705 -0.849285 0.527724 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 4.00037 -0.000720947 -0.06837 4.00012 0.0502413 1.11602 +EDGE_SE3:QUAT 130 835 3.08934 6.51943 0.0879414 0.00803676 -0.0201758 0.724213 0.689234 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 4.00127 0.00369054 -0.0983157 4.00308 -0.0204674 1.90359 +EDGE_SE3:QUAT 131 835 -0.883904 6.59463 0.071411 0.00720678 -0.0207719 0.71449 0.6993 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 4.00128 0.00366527 -0.0976341 4.00299 -0.0194213 1.9595 +EDGE_SE3:QUAT 191 835 -0.147514 -6.58114 0.0570676 -0.0188412 -0.00267495 -0.857226 0.514589 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 4.0008 -0.00286216 -0.101846 4.00267 0.0527995 1.06288 +EDGE_SE3:QUAT 836 837 4.25082 -0.216692 -3.44707e-05 0.0105846 0.00456335 -0.0870329 0.996139 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 4.0001 0.00020249 0.0470911 3.99984 -0.00219609 3.97025 +EDGE_SE3:QUAT 74 836 6.85794 2.72555 0.124782 0.00929002 0.0120247 -0.980238 0.197236 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 3.99938 -1.06863e-05 0.0399969 4.0018 0.0294142 0.15626 +EDGE_SE3:QUAT 75 836 3.168 1.31656 0.0164355 0.00278807 0.0148647 -0.998952 0.0431884 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 3.99993 0.000228471 0.0111973 3.99934 0.058218 0.00834147 +EDGE_SE3:QUAT 76 836 -0.808078 1.12541 0.000845541 0.0329587 0.0126991 -0.999237 0.016644 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 3.99556 0.00127793 0.131837 4.01711 0.0466463 0.00600024 +EDGE_SE3:QUAT 77 836 -5.16665 -0.362095 0.114152 0.0139022 0.0216125 -0.975126 0.220159 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 3.99835 3.49463e-05 0.0613223 4.00438 0.0529337 0.195648 +EDGE_SE3:QUAT 837 838 3.85863 -1.29185 0.0720122 0.0113504 -0.0302051 -0.345677 0.937799 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 4.0052 -0.00486899 -0.156323 4.00018 0.0219118 3.52775 +EDGE_SE3:QUAT 73 837 6.35663 3.06052 0.1809 0.0324882 0.0144829 -0.950572 0.30846 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 3.99706 -0.00691502 0.150543 4.01797 -0.0282801 0.386938 +EDGE_SE3:QUAT 74 837 2.87906 1.29154 0.0379981 0.0148408 0.00312692 -0.993696 0.111081 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 3.99913 -0.000416368 0.0604793 4.0036 -0.000907748 0.050282 +EDGE_SE3:QUAT 75 837 -1.06448 1.1401 0.013064 -0.00616855 -0.00444303 0.999037 0.0432135 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 3.99987 0.000138972 0.024741 4.00047 0.0198214 0.0077213 +EDGE_SE3:QUAT 76 837 -5.03651 1.18354 -0.255892 -0.0360271 -0.00508586 0.996848 0.0705043 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 3.99522 0.00286226 0.145126 4.01981 0.0406266 0.02559 +EDGE_SE3:QUAT 838 839 4.02785 -1.34024 -0.0220607 -0.00215793 -0.00207359 -0.276982 0.960871 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 4.0001 -2.01689e-05 -0.021523 3.99997 0.00321741 3.69324 +EDGE_SE3:QUAT 72 838 5.60218 3.36174 0.0282663 0.0034193 0.00229224 -0.986373 0.164476 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 3.99994 -1.96479e-05 0.0143023 4.00021 0.00417757 0.108266 +EDGE_SE3:QUAT 73 838 2.5064 1.84725 -0.00751082 -0.000374068 -0.00474635 0.999213 0.0393798 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 4 9.8779e-09 0.00149745 3.99991 0.0190293 0.00629431 +EDGE_SE3:QUAT 74 838 -1.15954 1.70543 0.00591303 0.0156096 0.00669901 0.970748 0.239501 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 3.99971 0.00124911 -0.0668668 4.00207 -0.0512725 0.231283 +EDGE_SE3:QUAT 75 838 -4.7837 2.71825 0.0635151 0.026155 0.00363397 0.922166 0.385892 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 4.00025 0.00428629 -0.123757 4.00524 -0.0783489 0.601422 +EDGE_SE3:QUAT 839 840 4.08535 -0.672195 -0.0134806 0.000938385 0.00267718 -0.110197 0.993906 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 4.00012 -9.6804e-06 0.02226 3.99997 -0.00124197 3.95155 +EDGE_SE3:QUAT 71 839 4.78979 3.92158 0.0196122 0.00105102 0.00540852 -0.999835 0.0173164 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 3.99999 2.6216e-05 0.0042064 3.99991 0.0214722 0.00131915 +EDGE_SE3:QUAT 72 839 1.34963 3.31552 -0.0233676 -0.000119582 -0.004893 0.993316 0.115325 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 4 -1.8886e-05 0.000427651 3.99991 0.0190329 0.0532912 +EDGE_SE3:QUAT 73 839 -1.39721 3.50026 -0.0151987 0.00264658 -0.00657588 0.949137 0.314783 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 3.99989 1.09937e-05 -0.0136797 4.00025 0.0140154 0.396469 +EDGE_SE3:QUAT 74 839 -4.11702 4.77545 0.0703395 0.0146672 0.00830978 0.866263 0.499304 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 4.00029 0.000517577 -0.0679272 3.99974 -0.0584187 0.999507 +EDGE_SE3:QUAT 840 841 4.31813 -0.126125 -0.00401007 0.000437427 0.000873152 0.000302265 0.999999 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 4.00001 1.53284e-06 0.00698365 4 1.06338e-06 4.00001 +EDGE_SE3:QUAT 70 840 4.66117 4.58461 0.0260482 -0.00155216 -0.00185781 0.999158 0.0409619 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 3.99999 1.24643e-05 0.00622328 4.00002 0.00790794 0.00673687 +EDGE_SE3:QUAT 71 840 0.687404 4.43436 0.00568535 -0.00318476 -0.00416132 0.995653 0.0929931 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 3.99998 5.5638e-05 0.0128769 4.00004 0.0186359 0.0347201 +EDGE_SE3:QUAT 72 840 -2.45886 4.90305 -0.0238914 -0.00252582 -0.00361935 0.974532 0.224205 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 4 2.1553e-05 0.0105098 3.99997 0.0169931 0.201175 +EDGE_SE3:QUAT 841 842 4.17739 -0.0826102 0.0071524 0.000201619 0.00128309 0.00829728 0.999965 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 4.00003 1.35877e-06 0.0102436 3.99999 4.24765e-05 3.99975 +EDGE_SE3:QUAT 69 841 4.50106 5.01576 0.0740948 -0.00483144 -0.00266304 0.999642 0.0261747 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 3.99991 6.40829e-05 0.0193453 4.00033 0.0116463 0.002868 +EDGE_SE3:QUAT 70 841 0.376633 5.05623 0.0175337 -0.00245482 -0.00145156 0.999157 0.040941 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 3.99998 1.90909e-05 0.00984317 4.00008 0.0065848 0.00673978 +EDGE_SE3:QUAT 71 841 -3.50031 5.34695 -0.0136451 -0.00446898 -0.00416445 0.995668 0.0927824 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 3.99995 9.56874e-05 0.0180793 4.00017 0.0195905 0.0346132 +EDGE_SE3:QUAT 842 843 4.58764 -0.0526285 0.00250899 0.00125344 -0.00120983 0.0136326 0.999906 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 4.00002 -5.74034e-06 -0.00988096 3.99999 -6.77668e-05 3.99928 +EDGE_SE3:QUAT 68 842 4.51071 5.16716 0.0836828 -0.00736837 -0.0027323 0.999604 0.0270308 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 3.99979 0.000113221 0.0295051 4.00081 0.0125052 0.00317957 +EDGE_SE3:QUAT 69 842 0.337438 5.31858 0.0385269 -0.00631681 -0.00182927 0.999823 0.0176328 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 3.99984 6.24239e-05 0.0252786 4.00061 0.00820401 0.0014203 +EDGE_SE3:QUAT 70 842 -3.74161 5.4786 -0.00125694 -0.00393269 -0.000796841 0.999468 0.0323618 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 3.99994 2.41542e-05 0.0157552 4.00024 0.00419648 0.00425567 +EDGE_SE3:QUAT 843 844 4.63795 -0.0280033 0.00754489 -0.00342931 0.000130958 0.0145016 0.999889 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 3.99995 -3.14736e-06 0.00164399 4 1.33588e-05 3.99916 +EDGE_SE3:QUAT 67 843 4.47047 5.39994 0.0587703 -0.00345823 -0.00176354 0.999946 0.00959492 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 3.99995 2.68779e-05 0.0138348 4.00018 0.00731844 0.000429496 +EDGE_SE3:QUAT 68 843 -0.044528 5.46405 0.0257936 -0.00630432 -0.00158376 0.999884 0.0137701 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 3.99984 5.26954e-05 0.0252241 4.00062 0.00702796 0.00092991 +EDGE_SE3:QUAT 69 843 -4.2229 5.5251 -0.0151334 -0.00525557 -0.000539666 0.999978 0.00408331 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 3.99989 1.4044e-05 0.0210225 4.00044 0.00233061 0.000178543 +EDGE_SE3:QUAT 844 845 4.03172 -0.065617 0.00568018 0.0011641 -0.00114254 0.0124615 0.999921 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 4.00002 -5.05169e-06 -0.00931226 3.99999 -5.83427e-05 3.9994 +EDGE_SE3:QUAT 66 844 4.38375 5.4447 0.0735966 0.0035371 0.00653771 -0.999908 0.0113692 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 3.99995 9.27887e-05 0.014152 4.00004 0.0258221 0.000733825 +EDGE_SE3:QUAT 67 844 -0.120802 5.518 0.0330545 0.00362021 0.00469188 -0.99997 0.00499825 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 3.99995 6.72331e-05 0.0144818 4.00013 0.0186228 0.000239061 +EDGE_SE3:QUAT 68 844 -4.64814 5.632 -0.0171268 0.00721204 0.00482804 -0.999962 0.00115607 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 3.99979 0.000138145 0.0288485 4.00074 0.0192507 0.000306036 +EDGE_SE3:QUAT 845 846 4.35191 -0.0623513 0.00219813 0.00323861 0.00230669 0.0115444 0.999925 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 4.00004 3.03254e-05 0.0180013 3.99998 0.00010344 3.99955 +EDGE_SE3:QUAT 65 845 4.9915 5.33821 0.0786279 0.00384633 0.00592732 -0.999504 0.0307041 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 3.99993 8.75454e-05 0.015409 4.00013 0.0227112 0.00395946 +EDGE_SE3:QUAT 66 845 0.376381 5.40982 0.0550908 0.00249283 0.00494052 -0.99969 0.0242563 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 3.99997 4.9913e-05 0.00998097 4.00002 0.0192501 0.00247109 +EDGE_SE3:QUAT 67 845 -4.12009 5.5373 0.0251162 0.00308223 0.00346427 -0.999836 0.017506 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 3.99996 4.01956e-05 0.0123349 4.00011 0.0134156 0.00130889 +EDGE_SE3:QUAT 846 847 4.04694 -0.0875118 0.010531 0.000955872 -0.00200323 0.00346072 0.999992 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 4.00006 -7.35027e-06 -0.0160654 3.99998 -2.77305e-05 4.00002 +EDGE_SE3:QUAT 64 846 5.15299 5.04223 0.086973 0.00924491 0.00312929 -0.998885 0.046193 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 3.99964 2.10826e-05 0.0370986 4.00138 0.00904524 0.00890054 +EDGE_SE3:QUAT 65 846 0.675132 5.1343 0.0456522 0.00626091 0.0025713 -0.999088 0.0421475 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 3.99983 2.52858e-05 0.0251114 4.00063 0.0081339 0.00728018 +EDGE_SE3:QUAT 66 846 -3.97938 5.2645 0.037689 0.00510179 0.00201142 -0.999355 0.0354778 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 3.99989 1.9265e-05 0.0204461 4.00042 0.0065751 0.00515017 +EDGE_SE3:QUAT 847 848 4.08011 -0.117077 0.0281198 0.00150888 -0.00796831 -0.00058775 0.999967 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 4.00101 -4.90203e-05 -0.0637498 3.99975 2.10453e-05 4.00101 +EDGE_SE3:QUAT 63 847 5.47897 4.67926 0.038335 0.00748404 0.00280512 -0.998746 0.0494281 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 3.99976 1.76805e-05 0.0300475 4.00091 0.0082022 0.0100157 +EDGE_SE3:QUAT 64 847 1.116 4.76703 0.0269762 0.00715081 0.00226987 -0.998721 0.0499929 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 3.99979 3.33462e-06 0.0287117 4.00083 0.00617159 0.0102134 +EDGE_SE3:QUAT 65 847 -3.34734 4.88955 0.0069341 0.00439735 0.00159086 -0.998945 0.0456811 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 3.99992 6.85328e-06 0.0176454 4.00031 0.00472707 0.00843067 +EDGE_SE3:QUAT 848 849 4.50699 -0.098882 0.0198164 -0.00888709 -0.00298959 -0.00553378 0.999941 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 3.99983 0.00010853 -0.0245037 3.99996 6.63666e-05 4.00003 +EDGE_SE3:QUAT 62 848 5.90006 4.2811 0.00781962 0.00382627 -0.00571301 -0.998937 0.0455735 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 3.99996 -8.87098e-05 0.0153491 4.00006 -0.0241268 0.00851259 +EDGE_SE3:QUAT 63 848 1.39889 4.38647 0.0112252 -0.000623737 0.000830713 -0.998783 0.0493108 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 4 -2.18127e-06 -0.00250324 4 0.00354813 0.00973094 +EDGE_SE3:QUAT 64 848 -2.92496 4.46579 -0.010975 -0.000394097 0.000198116 -0.998768 0.0496209 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 4 -4.68753e-07 -0.001582 4 0.000943647 0.00984977 +EDGE_SE3:QUAT 849 850 4.38131 -0.151124 0.00838786 -0.00521367 -0.00516263 -0.0126645 0.999893 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 4.00033 0.000102078 -0.0420858 3.99989 0.000264787 3.9998 +EDGE_SE3:QUAT 61 849 5.97808 3.92264 0.0133476 0.00552938 -0.00145851 -0.999058 0.0430081 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 3.99988 -6.20483e-05 0.0221777 4.00046 -0.00770733 0.00753684 +EDGE_SE3:QUAT 62 849 1.41477 3.9473 -0.008259 0.000489554 0.00297529 -0.999188 0.0401771 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 4 8.27017e-06 0.00196453 3.99997 0.011696 0.00649203 +EDGE_SE3:QUAT 63 849 -3.04768 4.02854 0.0372392 -0.00377636 0.00970583 -0.998978 0.0439768 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 3.99997 -0.000124217 -0.0151446 3.99978 0.0399621 0.00819325 +EDGE_SE3:QUAT 850 851 4.08192 -0.0821783 0.0208927 -0.00346735 0.00591712 0.00243643 0.999974 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 4.00051 -8.02844e-05 0.0474429 3.99986 5.49338e-05 4.00054 +EDGE_SE3:QUAT 60 850 6.20811 3.64508 -0.0294413 -0.000599401 0.00368686 -0.999262 0.03823 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 4 -4.83184e-06 -0.00240124 3.99995 0.0148765 0.005903 +EDGE_SE3:QUAT 61 850 1.63317 3.6745 -0.0283364 9.7025e-05 0.00346679 -0.99953 0.0304671 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 4 4.23573e-06 0.000389441 3.99995 0.0138113 0.00376075 +EDGE_SE3:QUAT 62 850 -2.90672 3.74282 -0.00350598 -0.0046822 0.00772154 -0.99958 0.0275217 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 3.99993 -0.000144262 -0.0187504 4.00007 0.0318603 0.00337167 +EDGE_SE3:QUAT 851 852 4.08789 -0.0419192 0.0383314 -0.00408415 -0.00107033 0.00286104 0.999987 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 3.99995 1.71798e-05 -0.00842212 4 -1.20906e-05 3.99998 +EDGE_SE3:QUAT 59 851 6.09143 3.3897 0.0137291 0.00609543 0.00560283 -0.998832 0.0475954 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 3.99983 0.0001013 0.0244694 4.00054 0.0199729 0.00931133 +EDGE_SE3:QUAT 60 851 2.14466 3.41154 -0.00442059 0.00549983 0.00735435 -0.999142 0.0403849 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 3.99985 0.000145755 0.0220579 4.00035 0.027528 0.00683538 +EDGE_SE3:QUAT 61 851 -2.41113 3.50853 -0.0145453 0.00620026 0.00777728 -0.99941 0.0328876 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 3.99982 0.000175197 0.0248447 4.00045 0.0294014 0.0046972 +EDGE_SE3:QUAT 852 853 4.30484 -0.218768 0.0142475 -0.000311525 0.0047001 -0.0509358 0.998691 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 4.00035 -3.24567e-05 0.0372673 3.99991 -0.000946641 3.98997 +EDGE_SE3:QUAT 58 852 6.75715 3.02035 -0.00845353 0.000282039 0.00868119 -0.998342 0.0568951 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 3.99999 4.29812e-05 0.00114682 3.99971 0.034315 0.0132439 +EDGE_SE3:QUAT 59 852 2.02296 3.05625 0.0025475 0.00486132 0.00965547 -0.998678 0.0502624 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 3.99987 0.000188921 0.0195306 4.00012 0.0364326 0.0105336 +EDGE_SE3:QUAT 60 852 -1.90998 3.13598 -0.0103891 0.00445841 0.011699 -0.998978 0.0434313 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 3.99988 0.000228883 0.017895 3.99989 0.0450325 0.00813333 +EDGE_SE3:QUAT 61 852 -6.44992 3.29091 -0.0189031 0.00523795 0.0116724 -0.999276 0.0358256 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 3.99985 0.000254888 0.021 4 0.0450456 0.00575224 +EDGE_SE3:QUAT 853 854 4.03928 -0.508772 0.0209688 -0.00447616 0.00220941 -0.149956 0.98868 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 3.99994 -2.08666e-05 0.00914803 4 -0.000469698 3.91007 +EDGE_SE3:QUAT 58 853 2.44003 2.74807 0.00216724 0.00444876 0.00915985 -0.999933 0.00548712 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 3.99992 0.000164018 0.0177979 3.99999 0.0364439 0.000531666 +EDGE_SE3:QUAT 59 853 -2.29599 2.82346 -0.02355 -0.00925432 -0.0106424 0.9999 0.000772766 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 3.99966 0.000395218 0.0370221 4.00091 0.0426443 0.000799529 +EDGE_SE3:QUAT 60 853 -6.21594 2.97932 -0.0238127 -0.00882553 -0.0125014 0.999852 0.00786061 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 3.9997 0.000446083 0.0353126 4.00058 0.0505701 0.00119812 +EDGE_SE3:QUAT 854 855 4.00809 -1.26006 -0.0175526 -0.00382685 -0.00955126 -0.31201 0.950023 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 4.0015 -0.000603092 -0.0789542 3.99977 0.0124398 3.61215 +EDGE_SE3:QUAT 57 854 3.00789 3.10298 0.0229973 -0.00401365 -0.0147655 0.99011 0.13946 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 4 -5.48339e-06 0.0161976 3.99912 0.0605938 0.0787979 +EDGE_SE3:QUAT 58 854 -1.59545 3.20964 0.00480901 -0.00552288 -0.014428 0.98943 0.144189 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 4 9.84956e-05 0.0224281 3.99923 0.0609678 0.0842364 +EDGE_SE3:QUAT 59 854 -6.32307 3.32514 -0.0549077 -0.0101382 -0.0166116 0.988448 0.150306 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 3.99993 0.000492582 0.0414708 3.99946 0.0746449 0.0922243 +EDGE_SE3:QUAT 855 856 4.10631 -1.34522 -0.00417792 0.00305993 0.002168 -0.255088 0.966911 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 4.00011 -1.1034e-05 0.0246399 3.99996 -0.00346412 3.73987 +EDGE_SE3:QUAT 56 855 4.02961 5.32018 0.026313 0.00393273 -0.0195976 0.899697 0.436057 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 3.99917 0.00027041 -0.0325242 4.00157 0.0326181 0.761416 +EDGE_SE3:QUAT 57 855 -0.471325 5.40866 0.027856 0.00938646 -0.0196405 0.897125 0.44124 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 3.9991 0.00146099 -0.0602811 4.00368 0.0163578 0.780117 +EDGE_SE3:QUAT 856 857 4.15353 -0.435041 -0.00207619 0.00512419 0.00305433 -0.0586403 0.998261 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 4.00009 5.82602e-05 0.0279065 3.99995 -0.000850898 3.98644 +EDGE_SE3:QUAT 857 858 4.16056 -0.0919325 0.00932026 0.000513955 1.47924e-05 0.00558011 0.999984 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 4 1.86343e-08 8.39189e-05 4 2.0213e-07 3.99988 +EDGE_SE3:QUAT 858 859 4.32125 -0.0317424 0.00471605 7.28097e-05 0.000400828 0.012714 0.999919 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 4 1.64906e-07 0.00319474 4 2.02841e-05 3.99936 +EDGE_SE3:QUAT 859 860 4.06521 -0.0638831 0.00267758 -0.00145315 0.00577228 0.00683185 0.999959 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 4.00053 -2.81943e-05 0.0462994 3.99987 0.000157176 4.00035 +EDGE_SE3:QUAT 860 861 4.28134 -0.0910898 0.00790475 0.00165047 0.000607204 0.0033806 0.999993 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 3.99999 3.96419e-06 0.00479058 4 8.07407e-06 3.99996 +EDGE_SE3:QUAT 861 862 4.28399 -0.0919243 0.010477 0.000213737 -1.32421e-05 0.0021431 0.999998 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 4 -1.20946e-08 -0.000111433 4 -1.21368e-07 3.99998 +EDGE_SE3:QUAT 862 863 4.31447 -0.0941592 0.0189963 -0.00029513 0.00261376 0.000760804 0.999996 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 4.00011 -2.96164e-06 0.0209132 3.99997 7.90794e-06 4.00011 +EDGE_SE3:QUAT 863 864 4.46618 -0.0945651 0.00832338 -0.00234782 -0.000526301 -0.000166375 0.999997 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 3.99998 4.94883e-06 -0.00421506 4 3.35135e-07 4 +EDGE_SE3:QUAT 864 865 4.51487 -0.10119 0.01409 -0.00229142 3.8996e-05 0.000348703 0.999997 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 3.99998 -3.72056e-07 0.000321554 4 5.65327e-08 4 +EDGE_SE3:QUAT 865 866 4.65404 -0.0884744 0.0135006 -0.00173072 0.00141775 -0.000607225 0.999997 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 4.00002 -9.82982e-06 0.0113294 3.99999 -3.52188e-06 4.00003 +EDGE_SE3:QUAT 866 867 4.00812 -0.0845723 0.0113711 -0.00220838 -0.000255203 -0.000601985 0.999997 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 3.99998 2.27685e-06 -0.00205756 4 6.17416e-07 4 +EDGE_SE3:QUAT 867 868 4.08697 -0.0776853 0.0199088 -0.00321773 0.00287464 -0.000263232 0.999991 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 4.00009 -3.70331e-05 0.0229872 3.99997 -3.66302e-06 4.00013 +EDGE_SE3:QUAT 868 869 4.03257 -0.0904844 0.0149693 -0.00054024 -0.000382589 -0.000471139 1 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 4 8.26202e-07 -0.00306376 4 7.20069e-07 4 +EDGE_SE3:QUAT 869 870 4.15732 -0.10006 0.0148907 0.00141299 0.001492 -0.000576357 0.999998 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 4.00003 8.4113e-06 0.0119458 3.99999 -3.36795e-06 4.00003 +EDGE_SE3:QUAT 870 871 4.04353 -0.104246 0.0104148 -0.000141946 -0.000245923 -0.00055385 1 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 4 1.38916e-07 -0.00196833 4 5.44961e-07 4 +EDGE_SE3:QUAT 871 872 4.21714 -0.0985864 0.0229087 0.000508508 0.00179126 0.000733751 0.999998 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 4.00005 3.69859e-06 0.0143257 3.99999 5.29452e-06 4.00005 +EDGE_SE3:QUAT 872 873 4.07549 -0.0817345 0.0228059 -0.000967299 0.000318321 0.00112709 0.999999 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 4 -1.23732e-06 0.00255964 4 1.44256e-06 4 +EDGE_SE3:QUAT 873 874 4.10172 -0.112811 0.0227499 0.0021401 1.83612e-05 -0.00228094 0.999995 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 3.99998 2.40718e-07 0.000205464 4 -2.56565e-07 3.99998 +EDGE_SE3:QUAT 874 875 4.4767 -0.123278 0.0207543 0.000733279 0.00346053 -0.00482261 0.999982 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 4.00019 8.78274e-06 0.0277269 3.99995 -6.66885e-05 4.0001 +EDGE_SE3:QUAT 875 876 4.32122 -0.108273 0.0258286 -0.00172 -0.000408231 -0.00454892 0.999988 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 3.99999 2.89714e-06 -0.00335962 4 7.70524e-06 3.99992 +EDGE_SE3:QUAT 876 877 4.131 -0.118604 0.0186119 -0.00137862 0.000834752 -0.00517568 0.999985 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 4 -4.60915e-06 0.00659212 4 -1.7008e-05 3.9999 +EDGE_SE3:QUAT 877 878 4.39439 -0.048008 0.0227832 -0.00117622 0.00122377 0.0297247 0.999557 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 4.00002 -4.93753e-06 0.0101966 3.99999 0.000153516 3.99649 +EDGE_SE3:QUAT 878 879 4.1543 0.277519 0.0314847 -0.000815721 -0.00340164 0.110365 0.993885 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 4.00016 3.8377e-05 -0.0256467 3.99996 -0.00138652 3.95144 +EDGE_SE3:QUAT 879 880 4.1973 0.687599 0.00927741 0.000133331 -0.00104311 0.20361 0.979052 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 4.00002 4.69166e-06 -0.00814815 4 -0.000822411 3.83419 +EDGE_SE3:QUAT 880 881 4.07727 0.789064 -0.0171632 -0.00196127 0.00423606 0.222035 0.975028 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 4.00032 7.34475e-05 0.0364702 3.99993 0.00414568 3.80313 +EDGE_SE3:QUAT 881 882 4.2634 0.846943 -0.00251045 0.000225241 -0.000254796 0.200535 0.979686 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 4 1.34989e-07 -0.00244415 4 -0.000258935 3.83914 +EDGE_SE3:QUAT 882 883 4.27846 0.315445 -0.00435628 -0.00461802 0.000605188 0.0711488 0.997455 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 3.99993 -2.1521e-05 0.00873412 3.99999 0.000356921 3.97977 +EDGE_SE3:QUAT 883 884 4.34621 -0.0454852 0.0043852 -0.00104767 -0.00198632 0.00723497 0.999971 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 4.00006 8.939e-06 -0.0157985 3.99998 -5.71403e-05 3.99985 +EDGE_SE3:QUAT 884 885 4.02657 -0.0924665 0.011851 -0.00341344 0.000604275 -0.0172456 0.999845 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 3.99996 -6.75691e-06 0.00412571 4 -3.35619e-05 3.99881 +EDGE_SE3:QUAT 885 886 4.09672 -0.30704 0.0151775 0.00300451 0.00240973 -0.0615879 0.998094 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 4.00008 2.30601e-05 0.0213834 3.99997 -0.000679694 3.98494 +EDGE_SE3:QUAT 886 887 4.11296 -0.424593 0.0131912 -0.002278 0.00110303 -0.111235 0.993791 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 3.99999 -6.89817e-06 0.00564525 4 -0.000254579 3.95051 +EDGE_SE3:QUAT 887 888 4.0071 -0.875764 0.0199326 0.00318539 0.00577233 -0.22286 0.974828 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 4.00061 -0.000130088 0.0510254 3.99986 -0.0058685 3.80198 +EDGE_SE3:QUAT 888 889 3.95583 -0.896908 0.00934966 -0.00859108 -0.00468287 -0.22578 0.974129 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 4.00051 3.19481e-05 -0.0571276 3.99978 0.00720526 3.7969 +EDGE_SE3:QUAT 889 890 3.99551 -0.809778 0.00433068 0.00583226 0.00346447 -0.174985 0.984548 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 4.00023 3.59976e-05 0.0384513 3.9999 -0.00368095 3.87789 +EDGE_SE3:QUAT 890 891 4.11494 -0.504904 -0.0349971 0.00864724 0.0220381 -0.13789 0.990165 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 4.00831 -0.00093986 0.185773 3.99794 -0.01298 3.93255 +EDGE_SE3:QUAT 891 892 3.89782 -1.23918 0.0664375 0.0055907 -0.0312754 -0.327525 0.944308 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 4.00872 -0.00582811 -0.190887 3.99956 0.0280425 3.57976 +EDGE_SE3:QUAT 892 893 4.2253 -1.37585 -0.0477131 0.00136313 0.00551426 -0.267361 0.96358 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 4.00047 -0.000169236 0.0436392 3.99992 -0.00580685 3.71455 +EDGE_SE3:QUAT 893 894 4.33419 -0.552338 -0.0232281 0.000499023 0.00284272 -0.0750489 0.997176 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 4.00013 -9.09369e-06 0.0229983 3.99997 -0.000866182 3.9776 +EDGE_SE3:QUAT 894 895 4.53302 -0.131557 -0.00907511 -0.00245633 -0.000682457 -0.00299148 0.999992 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 3.99998 6.81531e-06 -0.00554772 4 8.31375e-06 3.99997 +EDGE_SE3:QUAT 895 896 4.34249 -0.0862229 0.00523659 0.000285477 0.000570287 0.00355106 0.999993 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 4 6.76488e-07 0.00455005 4 8.07376e-06 3.99995 +EDGE_SE3:QUAT 896 897 4.59068 -0.0773496 0.000633378 0.00119757 0.00120879 0.00282108 0.999995 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 4.00002 5.85637e-06 0.00962968 3.99999 1.36059e-05 3.99999 +EDGE_SE3:QUAT 897 898 4.15504 -0.0987888 0.0132945 -0.00169712 -7.5203e-05 -0.000583683 0.999998 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 3.99999 5.2388e-07 -0.000613508 4 1.79966e-07 4 +EDGE_SE3:QUAT 898 899 4.87142 -0.115228 0.00796465 0.00283216 0.00219523 -0.000871959 0.999993 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 4.00005 2.48251e-05 0.0175916 3.99998 -7.34581e-06 4.00007 +EDGE_SE3:QUAT 899 900 4.17334 -0.0984728 0.0112646 0.0009807 -0.00178382 -0.000566113 0.999998 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 4.00005 -7.03671e-06 -0.014264 3.99999 4.11187e-06 4.00005 +EDGE_SE3:QUAT 900 901 4.28517 -0.100476 0.00420559 -0.00171488 0.000589991 -0.00115439 0.999998 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 3.99999 -4.02945e-06 0.00469615 4 -2.72024e-06 4 +EDGE_SE3:QUAT 901 902 4.29673 -0.0971427 0.0044557 0.00174346 0.000429922 7.34935e-05 0.999998 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 3.99999 2.99674e-06 0.00343782 4 1.34039e-07 4 +EDGE_SE3:QUAT 902 903 4.31643 -0.113917 0.0183841 -0.000776576 0.00207047 -0.000878647 0.999997 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 4.00007 -6.51796e-06 0.0165558 3.99998 -7.35229e-06 4.00007 +EDGE_SE3:QUAT 903 904 4.22416 -0.101976 0.0155672 0.000363028 -0.000519423 -0.000503976 1 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 4 -7.56992e-07 -0.00415319 4 1.04872e-06 4 +EDGE_SE3:QUAT 904 905 4.40351 -0.0964668 0.012228 0.00261439 0.00202764 0.00614059 0.999976 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 4.00004 2.14624e-05 0.0160276 3.99998 4.92665e-05 3.99991 +EDGE_SE3:QUAT 905 906 4.14127 0.00953035 0.0304392 -0.00498921 -0.00191091 0.0187174 0.999811 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 3.99995 3.58395e-05 -0.0141585 3.99999 -0.000129375 3.99865 +EDGE_SE3:QUAT 906 907 4.05082 -0.0483339 0.0189613 0.00122527 0.00182069 0.0106055 0.999941 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 4.00005 9.62395e-06 0.0144072 3.99999 7.62167e-05 3.9996 +EDGE_SE3:QUAT 907 908 4.45877 -0.066805 0.0207838 -0.000868032 -0.00137323 0.00495997 0.999986 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 4.00003 4.96084e-06 -0.0109338 3.99999 -2.71121e-05 3.99993 +EDGE_SE3:QUAT 908 909 4.25289 -0.103708 0.0230083 0.00223864 0.000128506 -0.00299465 0.999993 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 3.99998 1.26941e-06 0.00110847 4 -1.69889e-06 3.99996 +EDGE_SE3:QUAT 909 910 4.22872 -0.15172 0.0209257 0.00203584 0.00115359 -0.0151966 0.999882 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 4.00001 9.37771e-06 0.00959673 3.99999 -7.37829e-05 3.9991 +EDGE_SE3:QUAT 910 911 4.13459 -0.221377 0.0210761 -0.00285579 0.00232122 -0.0465928 0.998907 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 4.00004 -2.85887e-05 0.0169149 3.99998 -0.000381526 3.99139 +EDGE_SE3:QUAT 911 912 4.16791 -0.641565 0.00626144 0.00578238 0.00245487 -0.188412 0.98207 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 4.00011 4.26563e-05 0.0313676 3.99993 -0.00333007 3.85825 +EDGE_SE3:QUAT 912 913 3.83858 -1.4093 0.140941 -0.021317 -0.0221776 -0.374054 0.926896 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 4.01124 -0.00452721 -0.228946 3.99804 0.0461013 3.45339 +EDGE_SE3:QUAT 913 914 3.92169 -0.894126 -0.0244854 0.00277452 0.0102113 -0.174471 0.984606 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 4.00172 -0.000343431 0.0837122 3.99961 -0.00736174 3.87999 +EDGE_SE3:QUAT 914 915 4.36456 -0.230695 -0.0117789 0.00392756 0.00179346 -0.0162405 0.999859 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 4 2.88061e-05 0.0151071 3.99999 -0.000124405 3.999 +EDGE_SE3:QUAT 915 916 4.16986 -0.0450762 0.000472396 8.93685e-05 -0.000167382 0.0101558 0.999948 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 4 -5.3557e-08 -0.00134974 4 -6.8719e-06 3.99959 +EDGE_SE3:QUAT 916 917 4.04059 -0.0791725 0.00913963 0.00246378 0.0052227 0.00105762 0.999983 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 4.00041 5.21296e-05 0.0417539 3.99989 2.36917e-05 4.00043 +EDGE_SE3:QUAT 917 918 4.00215 -0.0875482 -0.0218876 -0.00123306 0.00600811 0.000658964 0.999981 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 4.00057 -2.90851e-05 0.0480805 3.99986 1.478e-05 4.00058 +EDGE_SE3:QUAT 918 919 4.03593 -0.0860442 0.00982223 0.000473506 -0.000605213 0.00128232 0.999999 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 4 -1.13729e-06 -0.00484899 4 -3.10637e-06 4 +EDGE_SE3:QUAT 919 920 4.04693 -0.0695464 0.00786655 0.000725122 -0.0272282 0.00112342 0.999628 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 4.01189 -5.97396e-05 -0.218401 3.99703 -0.000110686 4.01188 +EDGE_SE3:QUAT 920 921 4.26245 -0.0840348 -0.0116083 0.000848233 0.000463763 0.0012876 0.999999 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 4 1.57271e-06 0.00369699 4 2.38166e-06 4 +EDGE_SE3:QUAT 921 922 4.27189 -0.0996801 0.00190379 -0.00179773 -0.00266292 0.00109736 0.999994 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 4.0001 1.93087e-05 -0.0212801 3.99997 -1.19779e-05 4.00011 +EDGE_SE3:QUAT 922 923 4.36016 -0.101874 -0.0397395 0.0046353 0.00506399 0.000831633 0.999976 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 4.00032 9.42899e-05 0.0404679 3.9999 1.96731e-05 4.00041 +EDGE_SE3:QUAT 923 924 4.28292 -0.094374 -0.00021056 0.000596256 0.00121615 0.00107533 0.999999 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 4.00002 2.93567e-06 0.00972155 3.99999 5.24679e-06 4.00002 +EDGE_SE3:QUAT 924 925 4.33052 -0.0845048 -0.00686642 -0.000217084 0.000621199 0.000120266 1 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 4.00001 -5.38344e-07 0.00496991 4 2.96853e-07 4.00001 +EDGE_SE3:QUAT 925 926 4.33424 -0.0928454 0.00140012 -0.000630018 -0.000420177 0.000742075 0.999999 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 4 1.05966e-06 -0.0033558 4 -1.2471e-06 4 +EDGE_SE3:QUAT 926 927 4.43607 -0.0646881 0.00174979 -0.000704051 0.00207134 0.00470098 0.999987 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 4.00007 -5.36618e-06 0.0166101 3.99998 3.90015e-05 3.99998 +EDGE_SE3:QUAT 927 928 4.39622 -0.0953384 0.00793117 0.00027611 0.00219221 0.0015913 0.999996 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 4.00008 2.6038e-06 0.0175326 3.99998 1.39809e-05 4.00007 +EDGE_SE3:QUAT 928 929 4.42119 -0.0944377 0.00597616 -0.00233051 -0.00209653 -0.00035315 0.999995 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 4.00005 1.95229e-05 -0.0167822 3.99998 2.71795e-06 4.00007 +EDGE_SE3:QUAT 929 930 4.34385 -0.103004 -0.00428808 0.00155541 0.0021193 -0.00126769 0.999996 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 4.00006 1.30738e-05 0.0169782 3.99998 -1.0599e-05 4.00007 +EDGE_SE3:QUAT 930 931 4.29908 -0.103559 0.00448469 0.000197898 0.00170049 -0.0016108 0.999997 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 4.00005 1.23481e-06 0.0136078 3.99999 -1.09473e-05 4.00004 +EDGE_SE3:QUAT 931 932 4.18387 -0.0941878 0.0210381 4.08835e-05 0.00172398 -0.000955731 0.999998 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 4.00005 2.13776e-07 0.0137924 3.99999 -6.58829e-06 4.00004 +EDGE_SE3:QUAT 932 933 4.03311 -0.0849797 0.0281282 -0.000960158 0.00215266 -0.000160317 0.999997 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 4.00007 -8.28474e-06 0.0172197 3.99998 -1.48709e-06 4.00007 +EDGE_SE3:QUAT 933 934 4.29797 -0.10352 0.0270454 0.00220671 -0.00103394 -0.000690639 0.999997 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 4 -9.11723e-06 -0.00825321 4 2.90434e-06 4.00002 +EDGE_SE3:QUAT 934 935 4.24221 -0.111502 0.0551441 -0.00103638 0.0147534 -0.00773631 0.999861 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 4.00347 -0.000101673 0.11801 3.99913 -0.000462798 4.00324 +EDGE_SE3:QUAT 935 936 4.1189 -0.16713 -0.0306703 -0.00137504 0.0134653 -0.00485509 0.999897 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 4.00289 -9.52923e-05 0.107707 3.99928 -0.000267874 4.0028 +EDGE_SE3:QUAT 936 937 4.03218 0.474784 0.00288465 0.00228886 -0.00352095 0.215642 0.976463 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 4.00023 4.22137e-05 -0.0319669 3.99994 -0.00358594 3.81425 +EDGE_SE3:QUAT 937 938 4.10389 1.11424 -0.00327045 -0.000271386 -0.00196987 0.290244 0.956951 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 4.00004 2.23519e-05 -0.0129181 4 -0.00172673 3.66308 +EDGE_SE3:QUAT 938 939 4.06501 0.578606 -0.00752651 0.00419617 -0.00248299 0.170635 0.985322 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 4.00012 -1.98449e-05 -0.0274288 3.99995 -0.00255835 3.88372 +EDGE_SE3:QUAT 939 940 4.31187 0.592336 0.00718368 -2.85266e-05 0.0083954 0.173156 0.984859 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 4.00103 0.000276525 0.0642376 3.99978 0.00547812 3.8811 +EDGE_SE3:QUAT 940 941 3.99229 0.597057 0.0173189 -0.00286587 -0.00213851 0.180523 0.983564 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 3.99999 2.06444e-05 -0.010205 4 -0.000708822 3.86967 +EDGE_SE3:QUAT 941 942 4.28242 0.751489 0.000369747 0.00461296 -0.00482506 0.217886 0.975951 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 4.00048 5.73343e-05 -0.0475695 3.99986 -0.00551446 3.81067 +EDGE_SE3:QUAT 942 943 4.27176 0.836457 -0.0228871 -0.00354983 -0.000116833 0.196274 0.980543 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 3.99996 -1.56763e-05 0.00726494 3.99999 0.000988038 3.84592 +EDGE_SE3:QUAT 943 944 4.18136 0.326261 -0.0155087 0.0022664 -0.0122467 0.0916367 0.995715 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 4.00244 0.000224941 -0.0992741 3.9994 -0.00456665 3.96887 +EDGE_SE3:QUAT 944 945 4.49421 0.0802357 0.0136697 -0.0011595 -0.00296059 0.0251543 0.999679 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 4.00013 1.86096e-05 -0.023313 3.99997 -0.000291914 3.9976 +EDGE_SE3:QUAT 945 946 4.04264 -0.0701997 -0.0144206 0.000999937 -0.00843628 0.00497736 0.999952 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 4.00114 -2.52987e-05 -0.0675642 3.99971 -0.000166608 4.00104 +EDGE_SE3:QUAT 946 947 4.18976 -0.0725958 -0.039961 -0.00123043 0.00659505 0.00278834 0.999974 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 4.00069 -2.95973e-05 0.0528089 3.99983 7.23907e-05 4.00067 +EDGE_SE3:QUAT 947 948 4.28875 -0.0750932 0.016896 0.00149313 0.00515745 0.00161684 0.999984 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 4.00042 3.18164e-05 0.0412342 3.99989 3.42882e-05 4.00041 +EDGE_SE3:QUAT 948 949 4.36939 -0.0838956 0.0357674 -0.000190004 -8.21256e-05 0.0011136 0.999999 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 4 6.22741e-08 -0.000654465 4 -3.63967e-07 4 +EDGE_SE3:QUAT 949 950 4.22958 -0.0768376 0.0139182 0.000534309 -0.00541776 0.00115111 0.999985 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 4.00047 -1.07751e-05 -0.0433538 3.99988 -2.45851e-05 4.00046 +EDGE_SE3:QUAT 950 951 4.40996 -0.0880236 -0.0460718 -0.000726125 -0.00161101 0.00131747 0.999998 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 4.00004 4.75572e-06 -0.0128767 3.99999 -8.52514e-06 4.00003 +EDGE_SE3:QUAT 951 952 3.97782 -0.0784308 -0.0233028 -0.00106763 0.00738554 0.00107727 0.999972 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 4.00087 -3.01626e-05 0.0591092 3.99978 3.04604e-05 4.00087 +EDGE_SE3:QUAT 952 953 4.27911 -0.0950736 0.0246718 0.000757953 0.00342421 0.00118833 0.999993 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 4.00019 1.0712e-05 0.0273839 3.99995 1.64836e-05 4.00018 +EDGE_SE3:QUAT 953 954 4.43226 -0.0882275 0.0164817 -0.00166969 -0.00271621 0.00097249 0.999994 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 4.00011 1.82928e-05 -0.0217106 3.99997 -1.08496e-05 4.00011 +EDGE_SE3:QUAT 954 955 4.33022 -0.0899818 -0.000491669 0.00157809 -0.00371509 -0.00552655 0.999977 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 4.00021 -2.51646e-05 -0.029616 3.99995 8.22712e-05 4.0001 +EDGE_SE3:QUAT 955 956 4.39333 -0.159306 -0.0142584 -0.00014734 0.00118828 -0.00981195 0.999951 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 4.00002 -1.03001e-06 0.00948755 3.99999 -4.65207e-05 3.99964 +EDGE_SE3:QUAT 956 957 4.23269 -0.107504 0.0171553 0.000338455 0.00316747 -0.00296166 0.999991 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 4.00016 3.57774e-06 0.0253524 3.99996 -3.74707e-05 4.00013 +EDGE_SE3:QUAT 957 958 4.22476 -0.0886077 0.043166 0.00138089 0.0328223 0.00707572 0.999435 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 4.01727 0.000367666 0.263431 3.9957 0.000978229 4.01707 +EDGE_SE3:QUAT 958 959 4.31718 0.113628 0.00266089 0.00151069 0.00099712 0.0813654 0.996683 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 4 5.86799e-06 0.00642936 4 0.00024051 3.97353 +EDGE_SE3:QUAT 959 960 4.12817 0.566017 0.00595706 -0.000747124 -0.00859097 0.176014 0.98435 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 4.00102 0.000307007 -0.0640269 3.99979 -0.00549803 3.8771 +EDGE_SE3:QUAT 960 961 4.35145 0.807498 0.00974879 0.00292534 0.00598041 0.22701 0.97387 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 4.00029 0.000179994 0.036499 3.99996 0.00369923 3.79419 +EDGE_SE3:QUAT 961 962 4.11156 0.840838 0.00957946 -0.00248764 -0.00322851 0.227952 0.973664 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 4.00005 4.97775e-05 -0.0172722 3.99999 -0.00163144 3.79222 +EDGE_SE3:QUAT 962 963 4.17015 0.615449 -0.012891 0.00273738 0.00507876 0.186402 0.982457 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 4.00023 0.00012445 0.0325508 3.99996 0.00277801 3.86128 +EDGE_SE3:QUAT 963 964 4.16282 0.726317 0.00878177 -0.00595372 2.63966e-05 0.205242 0.978693 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 3.99991 -4.75841e-05 0.0144495 3.99998 0.00198321 3.83155 +EDGE_SE3:QUAT 964 965 4.18567 0.746315 0.00912005 0.000174476 -0.00456798 0.204746 0.978804 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 4.0003 9.35821e-05 -0.0346891 3.99994 -0.00348563 3.83262 +EDGE_SE3:QUAT 965 966 4.18298 0.533727 0.00655021 0.0030351 -0.00275347 0.139814 0.990169 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 4.00014 -8.05189e-06 -0.0264116 3.99995 -0.00194916 3.92198 +EDGE_SE3:QUAT 966 967 4.18778 0.344897 -0.00251911 0.000528733 -0.017998 0.0958843 0.99523 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 4.00509 0.000701155 -0.142766 3.99878 -0.00684149 3.96831 +EDGE_SE3:QUAT 967 968 4.13442 0.030668 0.010588 0.00754901 -0.00342013 0.0295955 0.999528 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 4 -0.000106982 -0.0300037 3.99994 -0.000454632 3.99672 +EDGE_SE3:QUAT 968 969 4.11483 -0.0215229 -0.0316482 -0.0140315 -0.00233261 -0.00106801 0.999898 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 3.9993 0.000132419 -0.0188355 3.99998 8.23058e-06 4.00008 +EDGE_SE3:QUAT 969 970 4.11731 -0.107634 -0.0454482 0.00588835 0.00397886 -0.00078467 0.999974 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 4.00012 9.36487e-05 0.0318864 3.99994 -1.02759e-05 4.00025 +EDGE_SE3:QUAT 970 971 4.52014 -0.101337 -0.00555742 0.00220851 0.00413635 -0.00175002 0.999987 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 4.00026 3.58971e-05 0.0331388 3.99993 -2.81066e-05 4.00026 +EDGE_SE3:QUAT 971 972 4.24676 -0.0888328 0.0303366 -0.00114552 0.00114148 -0.00133024 0.999998 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 4.00002 -5.2579e-06 0.00911356 3.99999 -6.09334e-06 4.00001 +EDGE_SE3:QUAT 972 973 4.48186 -0.103733 -0.0273515 0.000111315 -0.00759041 -0.0027364 0.999967 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 4.00092 -7.16647e-06 -0.0607312 3.99977 8.32945e-05 4.00089 +EDGE_SE3:QUAT 973 974 4.01885 -0.118732 -0.0471174 0.000815744 0.000910915 -0.00583645 0.999982 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 4.00001 2.88555e-06 0.00734409 4 -2.14707e-05 3.99988 +EDGE_SE3:QUAT 974 975 4.05329 -0.0948463 -0.0135464 -0.000361315 0.00891031 -0.000219486 0.99996 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 4.00127 -1.33102e-05 0.0713013 3.99968 -8.52003e-06 4.00127 +EDGE_SE3:QUAT 975 976 4.0576 -0.0837619 0.0352079 -0.000383427 0.000292223 0.0020493 0.999998 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 4 -4.46365e-07 0.0023472 4 2.40749e-06 3.99998 +EDGE_SE3:QUAT 976 977 3.99253 -0.0869701 0.0127117 -0.000232236 -0.00393887 0.00206444 0.99999 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 4.00025 4.42739e-06 -0.0315067 3.99994 -3.26116e-05 4.00023 +EDGE_SE3:QUAT 977 978 4.32847 -0.0859726 -0.0214244 0.000250854 0.000153915 0.00323637 0.999995 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 4 1.54626e-07 0.00122156 4 1.97159e-06 3.99996 +EDGE_SE3:QUAT 978 979 4.37035 -0.077663 0.00504423 0.000636553 0.00207902 0.00408021 0.999989 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 4.00007 5.70256e-06 0.0166008 3.99998 3.39133e-05 4 +EDGE_SE3:QUAT 979 980 4.13777 -0.086508 0.0425195 0.000870695 -0.00039904 0.000214848 1 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 4 -1.39025e-06 -0.00319456 4 -3.39922e-07 4 +EDGE_SE3:QUAT 980 981 4.06241 -0.220864 0.0338047 -0.00394889 0.0202098 -0.0654559 0.997643 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 4.00615 -0.000928862 0.157753 3.9985 -0.0051766 3.98907 +EDGE_SE3:QUAT 981 982 4.08559 -0.611778 -0.0182338 -0.00773971 0.0123479 -0.162542 0.986594 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 4.00135 -0.000722996 0.0800772 3.99971 -0.00601989 3.89591 +EDGE_SE3:QUAT 982 983 4.17044 -1.00303 -0.000215718 -0.00210095 0.00340202 -0.221334 0.97519 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 4.00008 -5.71912e-05 0.0198431 3.99999 -0.00191443 3.80414 +EDGE_SE3:QUAT 742 982 -1.05868 7.55591 0.108219 0.00311329 0.0127899 -0.847525 0.530592 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 3.99974 -0.000495668 0.0317775 4.00099 0.00944943 1.12658 +EDGE_SE3:QUAT 983 984 3.95444 -0.815911 0.00982375 0.00623469 0.00549157 -0.190557 0.981641 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 4.00061 -1.87808e-05 0.055481 3.9998 -0.00565613 3.85552 +EDGE_SE3:QUAT 612 983 4.28338 -5.02234 -0.0239326 -0.00799917 -0.00486974 0.346061 0.938165 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 3.9997 -3.83213e-05 -0.00160422 4 0.00206447 3.52093 +EDGE_SE3:QUAT 613 983 0.00942162 -4.92817 -0.0224806 -0.00948123 -0.0042052 0.344849 0.938601 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 3.99961 -0.000114361 0.00830409 3.99997 0.00404663 3.52429 +EDGE_SE3:QUAT 614 983 -4.215 -4.81871 -0.115951 -0.0125304 -0.0105717 0.342978 0.9392 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 3.99937 0.000163929 -0.0225481 4.00006 -1.61984e-05 3.52947 +EDGE_SE3:QUAT 740 983 5.54037 3.95745 0.0743162 0.00605539 0.0137768 -0.975508 0.219448 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 3.99954 0.000175512 0.0270703 4.00083 0.0384805 0.193227 +EDGE_SE3:QUAT 741 983 1.05327 4.30744 0.0663186 0.00233304 0.0168505 -0.962902 0.269315 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 3.99959 0.000375841 0.0129269 3.99999 0.0508413 0.290894 +EDGE_SE3:QUAT 742 983 -3.76386 4.23847 0.0438303 0.00184926 0.0166727 -0.943775 0.330164 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 3.99953 0.000300944 0.0133052 4.00018 0.0448826 0.436702 +EDGE_SE3:QUAT 984 985 4.16894 -0.897394 -0.0357989 -9.57638e-05 0.010621 -0.205814 0.978533 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 4.00157 -0.000516155 0.0794234 3.9997 -0.00798362 3.83214 +EDGE_SE3:QUAT 613 984 3.51878 -2.98102 0.00778436 -0.00467401 0.00133467 0.159949 0.987113 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 4 -3.32524e-05 0.0190885 3.99997 0.00175407 3.89775 +EDGE_SE3:QUAT 614 984 -0.654005 -2.88093 -0.0346786 -0.00618258 -0.00546069 0.157777 0.98744 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 4.00007 0.000147507 -0.0305517 3.99997 -0.00206182 3.90065 +EDGE_SE3:QUAT 615 984 -4.98913 -2.77291 -0.0580566 -0.00639307 -0.00732488 0.155701 0.987756 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 4.00033 0.000262717 -0.0447292 3.99992 -0.00312291 3.90352 +EDGE_SE3:QUAT 739 984 5.8525 2.81095 -0.00880547 -0.00484667 0.013505 -0.999836 0.0110763 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 3.99992 -0.000251375 -0.0193952 3.99961 0.0544344 0.0013257 +EDGE_SE3:QUAT 740 984 1.64887 2.97812 0.0326542 0.00997358 0.00987678 -0.999465 0.0295424 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 3.99956 0.000341587 0.0399508 4.00134 0.0370855 0.00423442 +EDGE_SE3:QUAT 741 984 -2.65947 2.93363 0.0493701 0.0059141 0.0126672 -0.996615 0.0810086 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 3.99976 0.0003023 0.0239456 4.00023 0.0460409 0.0269279 +EDGE_SE3:QUAT 985 986 3.9161 -0.924123 -0.000989326 -0.00275545 0.00149719 -0.234609 0.972085 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 3.99997 -3.3351e-06 0.00352948 4 -7.09171e-05 3.77984 +EDGE_SE3:QUAT 614 985 3.55187 -2.42626 -0.0226862 -0.00644929 0.00373678 -0.0487168 0.998785 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 4 -9.29694e-05 0.0260227 3.99996 -0.000604206 3.99068 +EDGE_SE3:QUAT 615 985 -0.771103 -2.34404 -0.0303372 -0.00623699 0.00185313 -0.0508723 0.998684 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 3.99987 -3.28456e-05 0.0109659 3.99999 -0.000246485 3.98968 +EDGE_SE3:QUAT 616 985 -5.04522 -2.24001 -0.0409546 -0.00601132 0.00261063 -0.0526644 0.998591 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 3.99993 -5.35299e-05 0.0170054 3.99998 -0.000414416 3.98898 +EDGE_SE3:QUAT 738 985 5.34035 3.94249 0.0164655 -0.00805234 -0.00676056 0.989483 0.144268 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 3.99988 0.000314988 0.0330412 4.00046 0.0347534 0.0838372 +EDGE_SE3:QUAT 739 985 1.67561 3.59496 0.0216708 -0.00292264 -0.0123584 0.980773 0.194737 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 3.99998 -0.000100692 0.0116059 3.99937 0.0491856 0.152353 +EDGE_SE3:QUAT 740 985 -2.46792 3.60073 -0.0674219 -0.018566 -0.0118256 0.983871 0.17752 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 3.99943 0.0016658 0.0772081 4.00282 0.0692417 0.128802 +EDGE_SE3:QUAT 986 987 3.93533 -1.06947 -0.014313 -0.000370609 0.00110689 -0.243349 0.969938 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 4.00001 -6.37289e-06 0.00704081 4 -0.000779554 3.76314 +EDGE_SE3:QUAT 555 986 3.21217 -4.02441 0.0201654 -0.0112412 -0.00453989 0.711228 0.702856 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 4.0001 -1.45189e-05 0.0509771 3.99968 0.0321279 1.97723 +EDGE_SE3:QUAT 556 986 -2.78432 -4.04321 0.0528325 -0.0112666 0.000964898 0.547171 0.836945 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 4.00049 0.000200441 0.063751 3.99977 0.0234321 2.80342 +EDGE_SE3:QUAT 615 986 3.00733 -3.64735 -0.0291676 -0.00922467 0.00206619 -0.283429 0.958947 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 3.99969 0.000114595 -0.0151162 3.99996 0.00371901 3.6787 +EDGE_SE3:QUAT 616 986 -1.2603 -3.55669 -0.0464216 -0.00904425 0.00267123 -0.285341 0.95838 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 3.99967 9.79391e-05 -0.0104745 3.99997 0.00309401 3.67432 +EDGE_SE3:QUAT 617 986 -5.38557 -3.58223 -0.0587906 -0.00980521 0.00289935 -0.271383 0.962417 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 3.99961 0.000104619 -0.0096849 3.99997 0.00287695 3.7054 +EDGE_SE3:QUAT 738 986 1.84497 5.94051 -0.0271423 -0.00806212 -0.0107641 0.927989 0.372364 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 4.00002 -1.95649e-05 0.033786 3.99945 0.0495593 0.55562 +EDGE_SE3:QUAT 739 986 -1.58489 5.93759 0.0446885 -0.00191579 -0.0150947 0.907722 0.419296 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 3.99964 -0.000332805 0.000498658 3.99977 0.0408371 0.703816 +EDGE_SE3:QUAT 987 988 4.13777 -0.923031 -0.00345399 0.00961777 0.0182948 -0.162953 0.986417 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 4.00596 -0.000725375 0.159257 3.9985 -0.0132871 3.90012 +EDGE_SE3:QUAT 555 987 4.23767 -0.0750642 -0.00873857 -0.010884 -0.00664619 0.51879 0.854806 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 3.99952 -0.000287708 0.0223833 3.99983 0.0136689 2.92342 +EDGE_SE3:QUAT 556 987 -0.216298 -0.850254 0.00104072 -0.0122412 -0.00106367 0.326699 0.945049 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 3.9997 -0.000232309 0.0373913 3.99983 0.00878225 3.57338 +EDGE_SE3:QUAT 557 987 -4.79695 -0.321838 -0.192288 -0.0149424 -0.0210574 0.221293 0.974865 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 4.00248 0.00216044 -0.117844 3.99961 -0.0112389 3.80749 +EDGE_SE3:QUAT 616 987 1.45483 -6.59693 -0.0424114 -0.00950177 0.00144376 -0.510021 0.860108 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 4.00002 8.69493e-05 -0.0407202 3.99982 0.0155928 2.95989 +EDGE_SE3:QUAT 617 987 -2.58494 -6.54557 -0.0565828 -0.0104083 0.00168532 -0.497661 0.867308 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 3.99999 0.000122816 -0.0430992 3.99979 0.0161915 3.00975 +EDGE_SE3:QUAT 988 989 4.19003 -0.352265 0.00578384 0.002923 -0.00182374 -0.0525045 0.998615 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 4.00001 -2.10112e-05 -0.0126913 3.99999 0.000316727 3.98901 +EDGE_SE3:QUAT 556 988 3.59726 0.966084 -0.00259301 -0.00890864 0.0174818 0.16812 0.985571 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 4.00543 0.000726333 0.151789 3.99865 0.0130641 3.89269 +EDGE_SE3:QUAT 557 988 -0.655764 0.63184 -0.0184315 -0.00603729 -0.00338002 0.0592895 0.998217 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 3.99998 7.61885e-05 -0.0226115 3.99997 -0.000627767 3.98607 +EDGE_SE3:QUAT 558 988 -4.89683 0.786515 -0.0399204 -0.00225633 -0.00271383 0.0386503 0.999247 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 4.00009 2.91602e-05 -0.0206169 3.99997 -0.000391766 3.99413 +EDGE_SE3:QUAT 989 990 4.4499 -0.146534 -0.0187476 -0.00111174 -0.00341375 -0.00995731 0.999944 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 4.00018 1.2473e-05 -0.0274399 3.99995 0.000136531 3.99979 +EDGE_SE3:QUAT 557 989 3.53605 0.785308 0.0145715 -0.00292338 -0.00545708 0.00674202 0.999958 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 4.00044 6.81491e-05 -0.0434211 3.99988 -0.000148221 4.00029 +EDGE_SE3:QUAT 558 989 -0.701336 0.761283 -0.0125395 0.000757323 -0.00467444 -0.0137923 0.999894 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 4.00034 -2.12893e-05 -0.0372623 3.99991 0.000257107 3.99959 +EDGE_SE3:QUAT 559 989 -4.77075 0.813355 0.0822137 0.00273719 0.0055546 -0.00737557 0.999954 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 4.00047 5.57692e-05 0.0446799 3.99987 -0.000163072 4.00028 +EDGE_SE3:QUAT 990 991 4.02079 -0.103057 0.0158113 0.000496533 -0.00303537 -0.00375198 0.999988 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 4.00015 -6.85032e-06 -0.0242609 3.99996 4.56128e-05 4.00009 +EDGE_SE3:QUAT 558 990 3.76232 0.49127 0.00800093 -0.000365722 -0.00809455 -0.0240657 0.999678 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 4.00105 -2.60473e-05 -0.0648207 3.99974 0.000780135 3.99873 +EDGE_SE3:QUAT 559 990 -0.281902 0.59643 0.0103581 0.00138068 0.0019082 -0.0172211 0.999849 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 4.00005 9.24715e-06 0.0155443 3.99998 -0.000134525 3.99887 +EDGE_SE3:QUAT 560 990 -4.4659 0.655524 0.0275644 -0.000502453 0.00467761 -0.00910063 0.999948 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 4.00035 -1.41519e-05 0.0373642 3.99991 -0.000170231 4.00002 +EDGE_SE3:QUAT 991 992 4.14172 -0.100698 0.0316662 0.000338782 0.0036403 -0.00251763 0.99999 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 4.00021 4.13505e-06 0.0291337 3.99995 -3.65754e-05 4.00019 +EDGE_SE3:QUAT 559 991 3.69135 0.359589 0.00614079 0.00181874 -0.00111036 -0.0210535 0.999776 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 4 -8.08705e-06 -0.0084176 4 8.70275e-05 3.99824 +EDGE_SE3:QUAT 560 991 -0.34844 0.47015 0.00348404 -4.70117e-05 0.00166804 -0.0126941 0.999918 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 4.00004 -1.16008e-06 0.0133341 3.99999 -8.46158e-05 3.9994 +EDGE_SE3:QUAT 561 991 -4.53805 0.506738 -0.0708769 0.000469576 -0.00388707 -0.00268932 0.999989 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 4.00024 -8.27233e-06 -0.0310827 3.99994 4.19655e-05 4.00021 +EDGE_SE3:QUAT 992 993 4.19676 -0.100138 0.0353196 0.00162868 -0.00368076 -0.00152501 0.999991 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 4.00021 -2.44462e-05 -0.0294174 3.99995 2.29552e-05 4.00021 +EDGE_SE3:QUAT 560 992 3.7496 0.267146 0.0188403 0.000220859 0.00530153 -0.0151877 0.999871 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 4.00045 -5.56787e-06 0.042442 3.99989 -0.000322309 3.99953 +EDGE_SE3:QUAT 561 992 -0.382414 0.378619 -0.0131655 0.000814551 -0.000179512 -0.00526508 0.999986 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 4 -5.60755e-07 -0.00138457 4 3.60032e-06 3.99989 +EDGE_SE3:QUAT 562 992 -4.84664 0.42392 -0.0593838 -0.00126891 -0.000505675 0.00552708 0.999984 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 4 2.52811e-06 -0.00396105 4 -1.08764e-05 3.99988 +EDGE_SE3:QUAT 993 994 4.26635 -0.103814 -0.0101824 0.00228657 -0.00420013 -0.00019994 0.999989 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 4.00026 -3.85009e-05 -0.0335974 3.99993 4.32708e-06 4.00028 +EDGE_SE3:QUAT 561 993 3.63642 0.238351 0.026495 0.00227769 -0.00375912 -0.00640503 0.99997 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 4.0002 -3.61386e-05 -0.0298972 3.99994 9.63368e-05 4.00006 +EDGE_SE3:QUAT 562 993 -0.591256 0.356795 -0.0200709 0.0003986 -0.00405676 0.00394461 0.999984 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 4.00026 -4.91489e-06 -0.0324741 3.99993 -6.39142e-05 4.0002 +EDGE_SE3:QUAT 563 993 -4.8609 0.432567 -0.00307793 -0.00154222 0.000259075 0.0106855 0.999942 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 3.99999 -1.78128e-06 0.00226997 4 1.24765e-05 3.99954 +EDGE_SE3:QUAT 994 995 4.16463 -0.0886599 -0.0274475 -0.000858873 0.0144948 -0.000463134 0.999894 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 4.00336 -5.2278e-05 0.116039 3.99916 -3.12645e-05 4.00336 +EDGE_SE3:QUAT 562 994 3.56741 0.294149 0.00619642 0.00257688 -0.00832304 0.00382393 0.999955 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 4.00109 -7.9696e-05 -0.0667167 3.99972 -0.00012343 4.00105 +EDGE_SE3:QUAT 563 994 -0.738138 0.417559 -0.0129248 0.000674021 -0.0037244 0.0105322 0.999937 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 4.00022 -6.5579e-06 -0.0298769 3.99994 -0.000157274 3.99978 +EDGE_SE3:QUAT 564 994 -5.07518 0.51276 0.00644438 0.00272113 -0.00664157 0.0114057 0.999909 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 4.00069 -6.07852e-05 -0.0535024 3.99982 -0.000303034 4.0002 +EDGE_SE3:QUAT 995 996 4.0503 -0.0833677 0.0456384 -0.00267682 0.00559951 -0.00142474 0.99998 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 4.00047 -6.09695e-05 0.0447546 3.99987 -3.38928e-05 4.00049 +EDGE_SE3:QUAT 563 995 3.39171 0.424336 -0.00817403 -0.000328069 0.0106437 0.0101195 0.999892 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 4.00181 1.35488e-05 0.0852104 3.99955 0.000430811 4.0014 +EDGE_SE3:QUAT 564 995 -0.95414 0.520593 0.0354883 0.00158072 0.00785566 0.010921 0.999908 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 4.00097 6.55755e-05 0.0626401 3.99976 0.000344197 4.0005 +EDGE_SE3:QUAT 565 995 -5.41381 0.641926 -0.0128981 0.00433122 0.001114 0.00842584 0.999955 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 3.99994 1.82644e-05 0.00847292 4 3.51988e-05 3.99973 +EDGE_SE3:QUAT 996 997 4.43995 -0.0898447 0.0554421 -0.00245443 -0.00422178 -0.00165059 0.999987 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 4.00026 4.08299e-05 -0.0338246 3.99993 2.68813e-05 4.00028 +EDGE_SE3:QUAT 564 996 3.09011 0.512423 0.0159411 -0.0013909 0.0133341 0.00928455 0.999867 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 4.00285 -3.47655e-05 0.10688 3.99929 0.00049136 4.00251 +EDGE_SE3:QUAT 565 996 -1.37705 0.607315 0.0243749 0.00147825 0.00681635 0.0068217 0.999952 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 4.00073 4.77897e-05 0.0544146 3.99982 0.000187191 4.00055 +EDGE_SE3:QUAT 566 996 -5.72123 0.735194 -0.0547753 0.00269803 0.00195907 0.00192197 0.999993 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 4.00003 2.12071e-05 0.0156102 3.99998 1.52288e-05 4.00005 +EDGE_SE3:QUAT 997 998 4.34507 -0.0909379 0.0115833 -0.00168247 -0.00560126 -0.00254759 0.99998 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 4.00049 3.58474e-05 -0.0448658 3.99987 5.59209e-05 4.00048 +EDGE_SE3:QUAT 565 997 3.06447 0.580908 0.0190673 -0.0010748 0.00261041 0.00548338 0.999981 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 4.00011 -1.03723e-05 0.0209536 3.99997 5.73393e-05 3.99999 +EDGE_SE3:QUAT 566 997 -1.29281 0.658662 -0.0202143 0.000198271 -0.00215327 0.000375535 0.999998 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 4.00007 -1.66617e-06 -0.0172274 3.99998 -3.21289e-06 4.00007 +EDGE_SE3:QUAT 567 997 -5.55237 0.79492 0.0250529 0.0019384 0.00548698 -0.00574666 0.999967 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 4.00047 3.85592e-05 0.0440318 3.99988 -0.000125276 4.00035 +EDGE_SE3:QUAT 998 999 4.20325 -0.0953006 0.0169216 0.000420593 -0.0100128 -0.00213525 0.999948 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 4.0016 -2.20047e-05 -0.0801188 3.9996 8.66349e-05 4.00159 +EDGE_SE3:QUAT 565 998 7.42695 0.524011 0.00991283 -0.00294459 -0.00295313 0.00266708 0.999988 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 4.0001 3.51559e-05 -0.0235309 3.99997 -3.19527e-05 4.00011 +EDGE_SE3:QUAT 566 998 3.05177 0.563932 0.00675747 -0.00161002 -0.00788202 -0.00234528 0.999965 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 4.00099 4.73512e-05 -0.0631145 3.99975 7.16725e-05 4.00097 +EDGE_SE3:QUAT 567 998 -1.23807 0.647035 -0.013368 -0.000143595 -0.000127006 -0.00823937 0.999966 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 4 7.10399e-08 -0.00103014 4 4.26317e-06 3.99973 +EDGE_SE3:QUAT 568 998 -5.3268 0.788772 0.0839078 -0.000885594 0.0113609 -0.0148487 0.999825 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 4.00205 -8.60878e-05 0.0907397 3.99949 -0.000676865 4.00118 +EDGE_SE3:QUAT 999 1000 4.16988 -0.0934421 0.0149037 0.00121085 0.00926197 -0.00411407 0.999948 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 4.00137 3.64762e-05 0.0741758 3.99966 -0.000150263 4.00131 +EDGE_SE3:QUAT 566 999 7.26107 0.452542 0.0899201 -0.00133526 -0.0176563 -0.00416996 0.999835 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 4.00499 6.35031e-05 -0.141468 3.99875 0.000285955 4.00493 +EDGE_SE3:QUAT 567 999 2.92966 0.482399 -0.000515565 0.000138281 -0.0104087 -0.0104283 0.999891 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 4.00173 -3.28785e-05 -0.08327 3.99957 0.000434981 4.0013 +EDGE_SE3:QUAT 568 999 -1.15786 0.557063 0.00297151 -0.000773316 0.00131095 -0.0170442 0.999854 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 4.00002 -4.65755e-06 0.0103249 3.99999 -8.75602e-05 3.99886 +EDGE_SE3:QUAT 569 999 -5.49056 0.600302 -0.0131392 -0.00153879 -0.00283323 -0.0136739 0.999901 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 4.00012 1.5014e-05 -0.0229125 3.99997 0.000156924 3.99938 +EDGE_SE3:QUAT 1000 1001 4.34142 -0.149933 0.0481081 0.0032524 -0.00516459 -0.018435 0.999811 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 4.00037 -7.7084e-05 -0.0405793 3.9999 0.00037389 3.99905 +EDGE_SE3:QUAT 567 1000 7.11423 0.28275 0.10297 0.0012398 -0.000919061 -0.0146809 0.999891 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 4.00001 -4.65927e-06 -0.00713173 4 5.18342e-05 3.99915 +EDGE_SE3:QUAT 568 1000 3.01595 0.317875 0.0125389 0.000314525 0.0104409 -0.0210045 0.999725 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 4.00175 -4.18584e-05 0.0835827 3.99956 -0.000878071 3.99998 +EDGE_SE3:QUAT 569 1000 -1.31766 0.385095 0.0250826 -0.00040118 0.00654762 -0.0178658 0.999819 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 4.00068 -2.88121e-05 0.0522777 3.99983 -0.000467281 3.99941 +EDGE_SE3:QUAT 570 1000 -5.46883 0.278785 -0.012919 -0.002804 0.00542373 0.00898202 0.999941 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 4.00045 -5.5002e-05 0.0436908 3.99988 0.00019472 4.00015 +EDGE_SE3:QUAT 1001 1002 4.21498 -0.248933 0.0275408 -0.0015767 0.00882281 -0.0519143 0.998611 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 4.00119 -0.00014883 0.0693346 3.99971 -0.00179307 3.99042 +EDGE_SE3:QUAT 568 1001 7.3632 -0.0282829 -0.0358414 0.00319655 0.00529174 -0.039809 0.999188 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 4.00044 4.25269e-05 0.0437628 3.99988 -0.000878537 3.99414 +EDGE_SE3:QUAT 569 1001 3.00981 0.0737079 0.0141484 0.00265275 0.00144776 -0.036475 0.99933 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 4.00001 1.52467e-05 0.0127191 3.99999 -0.000238732 3.99472 +EDGE_SE3:QUAT 570 1001 -1.11714 0.188129 -0.00930189 0.000241151 0.000369322 -0.00976773 0.999952 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 4 3.28279e-07 0.00298242 4 -1.46103e-05 3.99962 +EDGE_SE3:QUAT 571 1001 -5.10988 -0.233401 -0.20203 0.0019187 -0.0159011 0.0613441 0.997988 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 4.00408 0.000253219 -0.128015 3.99899 -0.00393231 3.98904 +EDGE_SE3:QUAT 1002 1003 4.1033 -0.388348 -0.0128327 -0.00505332 0.00496686 -0.0944505 0.995504 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 4.00018 -0.000122699 0.0335112 3.99994 -0.00148662 3.9646 +EDGE_SE3:QUAT 569 1002 7.19235 -0.491328 0.0305329 0.0013128 0.0106266 -0.0883889 0.996028 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 4.00182 -0.000186116 0.0854382 3.99956 -0.00378259 3.97057 +EDGE_SE3:QUAT 570 1002 3.09304 -0.145858 0.0128983 -0.00144404 0.00923848 -0.061295 0.998076 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 4.0013 -0.000173962 0.0724525 3.99968 -0.00221019 3.98628 +EDGE_SE3:QUAT 571 1002 -0.886 0.0376711 -0.0406134 0.000541117 -0.00715694 0.00955999 0.999929 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 4.00082 -3.74858e-06 -0.0573201 3.99979 -0.000273557 4.00046 +EDGE_SE3:QUAT 572 1002 -5.10081 -0.783132 -0.0509711 0.00565643 -0.00643064 0.143279 0.989645 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 4.00075 4.80374e-06 -0.0594715 3.99978 -0.00444938 3.91877 +EDGE_SE3:QUAT 1003 1004 3.97954 -0.61887 0.00117517 -0.00146008 0.00243984 -0.151362 0.988474 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 4.00006 -2.75515e-05 0.0162405 3.99999 -0.00114522 3.90842 +EDGE_SE3:QUAT 570 1003 7.12631 -1.02068 -0.075437 -0.00702661 0.0143298 -0.155243 0.987747 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 4.00217 -0.000929061 0.0976741 3.99954 -0.00717488 3.90597 +EDGE_SE3:QUAT 571 1003 3.2331 -0.277125 -0.000611108 -0.00395348 -0.00216215 -0.0847831 0.996389 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 4.00005 3.11625e-05 -0.0211141 3.99997 0.000948686 3.97136 +EDGE_SE3:QUAT 572 1003 -1.03879 0.015618 -0.00621097 0.000576995 -0.00166896 0.0491623 0.998789 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 4.00005 -5.61005e-07 -0.0136433 3.99999 -0.000337729 3.99038 +EDGE_SE3:QUAT 573 1003 -5.29313 -0.983153 0.0303626 -0.00119885 0.00133078 0.212636 0.97713 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 4.00004 4.36794e-06 0.0128993 3.99999 0.00145323 3.81918 +EDGE_SE3:QUAT 1004 1005 4.25206 -0.977188 0.00781081 0.00585429 0.00197364 -0.209619 0.977764 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 4.00007 4.34409e-05 0.0290552 3.99994 -0.0035204 3.82445 +EDGE_SE3:QUAT 528 1004 1.49821 6.95176 0.0561768 0.00204043 0.0156444 -0.89164 0.452471 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 3.99949 -9.08767e-05 0.0218462 4.00078 0.0270864 0.819426 +EDGE_SE3:QUAT 571 1004 7.06367 -1.56201 0.0227481 -0.00473748 7.47294e-05 -0.234918 0.972004 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 3.99994 3.16858e-05 -0.0123146 3.99998 0.0019704 3.77929 +EDGE_SE3:QUAT 572 1004 2.97328 -0.204617 0.00283208 -0.000809767 0.000659807 -0.102295 0.994754 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 4 -2.32e-06 0.00420873 4 -0.000196903 3.95815 +EDGE_SE3:QUAT 573 1004 -1.39453 0.114346 0.0190063 -0.0033881 0.00316066 0.0622423 0.99805 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 4.00015 -3.09951e-05 0.0276634 3.99995 0.000884798 3.98469 +EDGE_SE3:QUAT 574 1004 -5.35881 -0.876349 -0.0151434 -0.00497727 -0.000890192 0.21216 0.977222 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 3.9999 -2.44521e-05 0.00564541 3.99999 0.00106405 3.81996 +EDGE_SE3:QUAT 641 1004 3.89074 -3.91772 0.00659196 -0.0128896 -0.00488398 0.457789 0.888954 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 3.99951 -0.000335191 0.0334604 3.99977 0.0140177 3.16189 +EDGE_SE3:QUAT 642 1004 -0.136163 -3.79814 -0.00840351 -0.0108428 -0.00363469 0.455478 0.890174 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 3.99969 -0.000228966 0.0305526 3.99983 0.0121454 3.17032 +EDGE_SE3:QUAT 643 1004 -4.29526 -3.64816 -0.0334415 -0.0119101 -0.00413344 0.445172 0.895356 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 3.99959 -0.000277251 0.031478 3.99981 0.0124648 3.20745 +EDGE_SE3:QUAT 712 1004 0.507956 6.27608 0.0155572 0.00131981 0.0138837 -0.927711 0.373038 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 3.99965 0.00015781 0.0120263 4.00023 0.0337995 0.55706 +EDGE_SE3:QUAT 713 1004 -3.36334 6.46414 0.00259451 -0.000119577 0.0142869 -0.936918 0.349258 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 3.9997 0.000278507 0.00431357 3.99986 0.0407802 0.488444 +EDGE_SE3:QUAT 1005 1006 3.97709 -0.750792 0.014677 0.00342561 0.00214424 -0.153516 0.988138 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 4.00008 1.52515e-05 0.022763 3.99996 -0.00189239 3.90586 +EDGE_SE3:QUAT 527 1005 2.39733 4.00228 0.0444207 0.00476508 0.0120698 -0.964525 0.263674 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 3.99965 8.03929e-05 0.0227104 4.00065 0.0307505 0.278508 +EDGE_SE3:QUAT 528 1005 -1.81802 4.10215 0.0148517 0.00315095 0.0114576 -0.966716 0.255577 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 3.99976 0.000141391 0.0153072 4.00025 0.0325029 0.261637 +EDGE_SE3:QUAT 529 1005 -5.91788 4.35365 0.0200933 0.00169791 0.0120142 -0.971621 0.23623 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 3.99982 0.000204045 0.00860444 3.99991 0.0384576 0.223639 +EDGE_SE3:QUAT 572 1005 6.93673 -2.01293 0.00199225 0.00487403 0.0020345 -0.308437 0.95123 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 4.00014 -5.86752e-06 0.0309065 3.99994 -0.00556031 3.6197 +EDGE_SE3:QUAT 573 1005 2.94861 -0.339388 0.000520045 0.00118824 0.00488898 -0.148178 0.988948 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 4.00039 -6.48428e-05 0.0399162 3.99991 -0.00297725 3.91257 +EDGE_SE3:QUAT 574 1005 -1.06684 0.00871712 0.00337345 0.000165483 0.00159258 0.00288219 0.999995 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 4.00004 1.22889e-06 0.0127349 3.99999 1.83598e-05 4.00001 +EDGE_SE3:QUAT 575 1005 -5.02609 -0.832643 -0.0930735 -0.00423171 -0.00719852 0.151022 0.988495 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 4.0005 0.00023905 -0.0480803 3.99989 -0.00339281 3.90934 +EDGE_SE3:QUAT 641 1005 7.20411 -1.03034 0.028126 -0.00746411 -0.00291424 0.260875 0.965339 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 3.99976 -3.63111e-05 0.00133249 3.99999 0.00129622 3.72776 +EDGE_SE3:QUAT 642 1005 3.14413 -0.931242 0.00494802 -0.00585785 -0.00148007 0.258885 0.965889 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 3.99986 -3.82879e-05 0.00671483 3.99999 0.00170656 3.73192 +EDGE_SE3:QUAT 643 1005 -0.893597 -0.855135 -0.0141772 -0.00689309 -0.00198946 0.247766 0.968793 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 3.9998 -4.3623e-05 0.00518336 3.99999 0.00155019 3.75444 +EDGE_SE3:QUAT 644 1005 -4.85939 -0.740571 -0.114644 -0.00670946 -0.0101238 0.23856 0.971052 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 4.00057 0.000500713 -0.0556964 3.99992 -0.00560862 3.77311 +EDGE_SE3:QUAT 710 1005 4.88574 3.87252 0.0558359 0.00760902 0.0108897 -0.977312 0.211388 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 3.99955 -3.59119e-06 0.033226 4.00127 0.0264879 0.179223 +EDGE_SE3:QUAT 711 1005 0.754547 3.86316 0.0216502 0.00391919 0.0111699 -0.981177 0.192745 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 3.99977 0.000169446 0.0171662 4.00024 0.0347708 0.148999 +EDGE_SE3:QUAT 712 1005 -3.21346 4.02323 -0.00866607 0.00234748 0.00907468 -0.985276 0.170711 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 3.9999 0.000123171 0.0101533 3.99999 0.0305704 0.116839 +EDGE_SE3:QUAT 1006 1007 4.32897 -0.434873 -0.0371262 0.000548721 0.00801752 -0.0700377 0.997512 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 4.00103 -9.07091e-05 0.0641429 3.99975 -0.00224674 3.98141 +EDGE_SE3:QUAT 526 1006 2.82673 2.51568 0.0133479 -0.000179605 0.0107137 -0.993243 0.115557 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 3.99998 9.3607e-05 -0.000599481 3.99958 0.0415927 0.0538526 +EDGE_SE3:QUAT 527 1006 -1.43699 2.61518 0.00707491 0.00609452 0.00957925 -0.99357 0.112652 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 3.99975 0.000166765 0.0249478 4.00055 0.0316916 0.0511754 +EDGE_SE3:QUAT 528 1006 -5.65025 2.7732 -3.94007e-05 0.00443913 0.00853669 -0.994506 0.104239 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 3.99986 0.000135062 0.0181217 4.00022 0.0295648 0.043768 +EDGE_SE3:QUAT 573 1006 6.45756 -2.15378 -0.0255926 0.00431439 0.00688388 -0.297957 0.954545 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 4.0009 -0.000292857 0.0624292 3.99982 -0.0096744 3.64586 +EDGE_SE3:QUAT 574 1006 2.91363 -0.720758 0.000372169 0.00323657 0.00361142 -0.150529 0.988594 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 4.00024 -3.63768e-06 0.0336749 3.99993 -0.00265522 3.90965 +EDGE_SE3:QUAT 575 1006 -0.979387 -0.370758 -0.0211164 0.00021472 -0.00503702 -0.00224611 0.999985 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 4.00041 -5.69441e-06 -0.0402937 3.9999 4.53925e-05 4.00039 +EDGE_SE3:QUAT 576 1006 -5.1099 -0.852967 -0.0421299 0.000973735 -0.00811943 0.0999985 0.994954 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 4.00106 0.000128008 -0.0651594 3.99974 -0.00326177 3.96106 +EDGE_SE3:QUAT 642 1006 6.93617 0.416801 0.0256255 -0.00247786 0.000739538 0.107491 0.994203 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 4 -9.61599e-06 0.00898561 3.99999 0.000538281 3.9538 +EDGE_SE3:QUAT 643 1006 2.92421 0.392634 0.0107599 -0.00370165 -1.96755e-05 0.0964101 0.995335 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 3.99995 -9.87861e-06 0.00410074 4 0.000266508 3.96282 +EDGE_SE3:QUAT 644 1006 -1.08781 0.447714 -0.0256579 -0.00204243 -0.00801154 0.0863486 0.996231 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 4.00092 0.000186203 -0.0612828 3.99978 -0.00260965 3.97111 +EDGE_SE3:QUAT 645 1006 -5.08599 0.500282 -0.0321358 -0.00434631 -0.00804922 0.093878 0.995542 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 4.00078 0.000250499 -0.0586852 3.99981 -0.00267216 3.96561 +EDGE_SE3:QUAT 709 1006 5.04753 2.87995 -0.0157624 -0.00777848 0.0119754 -0.997391 0.0707585 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 3.99986 -0.00036544 -0.0313203 4.00009 0.0516929 0.0209444 +EDGE_SE3:QUAT 710 1006 0.865564 2.91866 0.00506337 0.00867747 0.00885162 -0.998134 0.0597975 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 3.99963 0.000219564 0.0349112 4.00111 0.0309672 0.0148495 +EDGE_SE3:QUAT 711 1006 -3.21969 3.05765 0.0036728 0.00512439 0.00838594 -0.999147 0.0401182 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 3.99987 0.000164724 0.0205528 4.00022 0.0317711 0.00679644 +EDGE_SE3:QUAT 1007 1008 4.42019 -0.244377 0.0162914 -1.09384e-05 0.00149542 -0.0257709 0.999667 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 4.00004 -1.44619e-06 0.0119482 3.99999 -0.000153896 3.99738 +EDGE_SE3:QUAT 524 1007 7.10673 1.75827 0.0339882 0.00357696 0.00730665 -0.998803 0.048229 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 3.99993 0.000106312 0.0143651 4.00005 0.0276816 0.0095479 +EDGE_SE3:QUAT 525 1007 2.99615 1.86021 0.00578227 0.00391867 0.00719055 -0.99882 0.0478612 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 3.99992 0.000110637 0.0157356 4.00011 0.0271027 0.00940893 +EDGE_SE3:QUAT 526 1007 -1.47734 1.93455 -0.020073 0.00691189 0.0108148 -0.998873 0.0456992 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 3.99975 0.000279375 0.0277453 4.00046 0.0405219 0.00895794 +EDGE_SE3:QUAT 527 1007 -5.69387 2.05876 -0.0823552 0.0135014 0.0102706 -0.998955 0.0424324 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 3.99919 0.000390532 0.0541566 4.00277 0.036359 0.00826767 +EDGE_SE3:QUAT 574 1007 6.89603 -2.40118 -0.0698711 0.00485647 0.0117868 -0.219847 0.975451 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 4.0024 -0.000576011 0.099996 3.99947 -0.0112011 3.80917 +EDGE_SE3:QUAT 575 1007 3.32994 -0.816531 -0.0142258 0.00119604 0.00293134 -0.0724511 0.997367 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 4.00014 -1.13456e-06 0.0243033 3.99996 -0.000890538 3.97915 +EDGE_SE3:QUAT 576 1007 -0.785333 -0.409758 -0.0127228 0.00137616 -3.61998e-05 0.0299986 0.999549 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 3.99999 -6.48116e-07 -0.000784305 4 -1.42387e-05 3.9964 +EDGE_SE3:QUAT 577 1007 -5.20553 -0.42469 -0.0361119 -0.000117764 -0.001606 0.0572932 0.998356 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 4.00004 4.23594e-06 -0.0127041 3.99999 -0.000362568 3.98691 +EDGE_SE3:QUAT 643 1007 7.22501 0.806018 -0.0263147 -0.00380637 0.00787191 0.0260124 0.999623 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 4.00097 -8.30191e-05 0.0641123 3.99974 0.000833456 3.99832 +EDGE_SE3:QUAT 644 1007 3.23774 0.768584 0.00405409 -0.00161728 -0.000142725 0.0162919 0.999866 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 3.99999 5.86843e-07 -0.000825212 4 -5.86284e-06 3.99894 +EDGE_SE3:QUAT 645 1007 -0.727611 0.884012 -0.00271246 -0.00412748 -0.00022413 0.0237912 0.999708 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 3.99993 4.61206e-07 -0.000613554 4 -2.62104e-06 3.99774 +EDGE_SE3:QUAT 646 1007 -4.76307 0.940013 -0.0227066 -0.00485866 -0.00118515 0.0301617 0.999533 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 3.99992 1.80395e-05 -0.00771053 4 -0.000107495 3.99638 +EDGE_SE3:QUAT 708 1007 4.83071 2.65318 0.0481468 0.00464231 0.0114083 -0.999862 0.0111494 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 3.9999 0.000217276 0.0185762 3.99985 0.045208 0.00109452 +EDGE_SE3:QUAT 709 1007 0.720289 2.68984 0.0215222 -0.000620468 0.0113705 -0.999935 0.0004343 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 4 -2.77677e-05 -0.00248235 3.99949 0.0454812 0.000519496 +EDGE_SE3:QUAT 710 1007 -3.40685 2.82469 -0.104583 -0.0161666 -0.00948556 0.999766 0.010764 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 3.99898 0.00067417 0.0646794 4.00374 0.0393776 0.00189681 +EDGE_SE3:QUAT 1008 1009 4.02257 -0.138616 0.0197125 0.00034255 -0.0015968 -0.00999 0.999949 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 4.00004 -2.78637e-06 -0.0127315 3.99999 6.35448e-05 3.99964 +EDGE_SE3:QUAT 523 1008 6.85919 1.46481 0.0401556 0.0058269 0.0081641 -0.999728 0.0210669 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 3.99985 0.000183067 0.0233254 4.00032 0.0316439 0.00216176 +EDGE_SE3:QUAT 524 1008 2.67122 1.57257 0.0177129 0.00463413 0.00770038 -0.9997 0.0227699 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 3.9999 0.000140638 0.0185529 4.00015 0.0299209 0.0023839 +EDGE_SE3:QUAT 525 1008 -1.45185 1.68058 -0.0139564 0.00530711 0.00744049 -0.999708 0.0223886 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 3.99987 0.000151509 0.0212463 4.00027 0.0287786 0.00232504 +EDGE_SE3:QUAT 526 1008 -5.84603 1.77268 -0.0672494 0.0082841 0.0110845 -0.999704 0.0199859 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 3.9997 0.000351966 0.0331612 4.00069 0.0429845 0.00233477 +EDGE_SE3:QUAT 576 1008 3.6408 -0.38905 0.00160143 0.00135027 0.00159227 0.00423283 0.999989 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 4.00003 8.79355e-06 0.0126693 3.99999 2.6847e-05 3.99997 +EDGE_SE3:QUAT 577 1008 -0.764908 -0.159974 -0.00748312 -0.000248594 -1.67101e-05 0.0316905 0.999498 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 4 9.64943e-10 -3.9006e-05 4 -1.17677e-07 3.99598 +EDGE_SE3:QUAT 578 1008 -4.79871 -0.0569635 -0.0102568 -0.0005179 0.00129854 0.0299058 0.999552 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 4.00003 -1.50729e-06 0.0105602 3.99999 0.000158743 3.99645 +EDGE_SE3:QUAT 645 1008 3.70565 0.85362 0.0168196 -0.00410905 0.00118295 -0.00139813 0.99999 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 3.99995 -1.93004e-05 0.00939441 3.99999 -6.68772e-06 4.00001 +EDGE_SE3:QUAT 646 1008 -0.313226 0.96894 -0.00068292 -0.00467201 0.000265537 0.00452276 0.999979 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 3.99991 -5.74257e-06 0.00237772 4 5.55853e-06 3.99992 +EDGE_SE3:QUAT 647 1008 -4.4765 1.04976 -0.00232599 -0.00480904 0.00215483 0.00829115 0.999952 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 3.99999 -4.20157e-05 0.017715 3.99998 7.35413e-05 3.9998 +EDGE_SE3:QUAT 707 1008 4.69375 2.75103 0.0694542 -0.00636359 -0.0140635 0.999876 0.00311194 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 3.99984 0.000356078 0.0254618 3.99984 0.0564178 0.000996538 +EDGE_SE3:QUAT 708 1008 0.381135 2.79594 0.0329335 -0.00568003 -0.0117208 0.999814 0.0142296 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 3.99989 0.000260858 0.0227312 3.99992 0.0475104 0.00150353 +EDGE_SE3:QUAT 709 1008 -3.66108 2.92598 0.0479111 -0.000709286 -0.0110668 0.999618 0.0253173 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 4 6.64131e-06 0.00283868 3.99951 0.044337 0.0030577 +EDGE_SE3:QUAT 1009 1010 4.09902 -0.149883 0.0211596 0.00229243 -0.00128303 -0.00944402 0.999952 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 4 -1.17246e-05 -0.0100031 3.99999 4.69112e-05 3.99967 +EDGE_SE3:QUAT 522 1009 7.07306 1.28854 0.0620869 0.00796232 0.00934774 -0.999892 0.00806525 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 3.99974 0.000290995 0.0318553 4.00069 0.0368827 0.000853922 +EDGE_SE3:QUAT 523 1009 2.82747 1.41883 0.0160186 0.00390737 0.00790522 -0.999898 0.0112321 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 3.99993 0.000124816 0.0156338 4.00001 0.0312616 0.000810096 +EDGE_SE3:QUAT 524 1009 -1.37803 1.51284 -0.00136982 0.00287465 0.00749112 -0.999883 0.0129927 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 3.99996 8.91588e-05 0.0115025 3.99992 0.0296537 0.000928197 +EDGE_SE3:QUAT 525 1009 -5.49649 1.6268 -0.0355698 0.0036397 0.00689575 -0.999893 0.0123961 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 3.99994 0.00010093 0.0145632 4.00004 0.027213 0.000852848 +EDGE_SE3:QUAT 577 1009 3.26979 -0.030464 0.0137727 0.000389359 -0.00174383 0.0217458 0.999762 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 4.00005 -1.13608e-06 -0.0140425 3.99999 -0.000152991 3.99816 +EDGE_SE3:QUAT 578 1009 -0.76306 0.0594267 -0.00640313 -1.20202e-05 -0.000300161 0.0199578 0.999801 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 4 5.74407e-08 -0.00239697 4 -2.39048e-05 3.99841 +EDGE_SE3:QUAT 579 1009 -4.79698 0.182516 -0.000286179 -0.00403006 0.00228808 0.0169963 0.999845 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 4.00003 -3.67868e-05 0.0191184 3.99998 0.000164243 3.99894 +EDGE_SE3:QUAT 646 1009 3.69823 0.874524 0.0149995 -0.00455834 -0.00134705 -0.00498812 0.999976 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 3.99995 2.5163e-05 -0.0110486 3.99999 2.75762e-05 3.99993 +EDGE_SE3:QUAT 647 1009 -0.45534 0.994617 6.57825e-05 -0.0043773 0.000509025 -0.00149521 0.999989 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 3.99993 -8.6921e-06 0.00399354 4 -2.9924e-06 4 +EDGE_SE3:QUAT 648 1009 -4.5394 1.08393 -0.00221264 -0.00518082 0.00209719 -0.000891836 0.999984 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 3.99996 -4.33631e-05 0.0167216 3.99998 -7.99251e-06 4.00007 +EDGE_SE3:QUAT 706 1009 4.93138 2.92904 0.0488205 0.00526113 0.0122032 -0.999899 0.00496567 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 3.99988 0.000259353 0.0210497 3.99986 0.0486046 0.000800014 +EDGE_SE3:QUAT 707 1009 0.647204 2.91167 0.0424837 -0.00453837 -0.0138215 0.999808 0.0130941 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 3.99993 0.00023666 0.0181629 3.99953 0.0557378 0.00154518 +EDGE_SE3:QUAT 708 1009 -3.61835 3.04204 0.00810785 -0.00387003 -0.0112649 0.999635 0.0242464 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 3.99996 0.000156882 0.0154953 3.99968 0.0457436 0.00293506 +EDGE_SE3:QUAT 1010 1011 3.97089 -0.121422 0.0242756 -0.000296352 0.00422885 -0.00843237 0.999955 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 4.00029 -8.62152e-06 0.0337993 3.99993 -0.000142611 4 +EDGE_SE3:QUAT 521 1010 7.09624 1.20623 0.0178839 -0.00158819 -0.00628389 0.999956 0.0067914 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 3.99999 3.81549e-05 0.00635354 3.99988 0.0252188 0.000353593 +EDGE_SE3:QUAT 522 1010 2.98413 1.36061 0.0175132 -0.00649764 -0.00711006 0.999953 0.00119008 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 3.99983 0.000185605 0.025992 4.00047 0.0285079 0.000377703 +EDGE_SE3:QUAT 523 1010 -1.26175 1.46723 2.93046e-05 0.00258554 0.00578405 -0.999978 0.00177129 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 3.99997 6.00082e-05 0.0103427 3.99997 0.0230998 0.000172693 +EDGE_SE3:QUAT 524 1010 -5.45939 1.54955 -0.00258121 0.00159826 0.00483713 -0.999981 0.00355908 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 3.99999 3.13653e-05 0.00639337 3.99995 0.0193024 0.000154035 +EDGE_SE3:QUAT 577 1010 7.34939 0.0110508 0.0425333 0.00241136 -0.00281132 0.0122588 0.999918 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 4.00011 -2.52992e-05 -0.0228406 3.99997 -0.000140256 3.99953 +EDGE_SE3:QUAT 578 1010 3.29631 0.0810587 0.0174692 0.00233439 -0.00155194 0.0104848 0.999941 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 4.00002 -1.43171e-05 -0.0127072 3.99999 -6.69871e-05 3.9996 +EDGE_SE3:QUAT 579 1010 -0.689967 0.186775 0.00167911 -0.00159899 0.000937987 0.00737023 0.999971 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 4 -5.98926e-06 0.00764469 4 2.831e-05 3.9998 +EDGE_SE3:QUAT 580 1010 -5.12543 0.285682 -0.0186829 0.000252424 -0.00127417 0.00352782 0.999993 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 4.00003 -1.15064e-06 -0.0102039 3.99999 -1.79953e-05 3.99998 +EDGE_SE3:QUAT 647 1010 3.63268 0.842711 0.015757 -0.00214173 -0.000865838 -0.0106398 0.999941 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 3.99999 7.60301e-06 -0.00719893 4 3.87398e-05 3.99956 +EDGE_SE3:QUAT 648 1010 -0.458609 0.940531 0.00136821 -0.00300464 0.000744823 -0.0100336 0.999945 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 3.99997 -8.34642e-06 0.00559587 4 -2.75033e-05 3.99961 +EDGE_SE3:QUAT 649 1010 -4.67057 1.02654 -0.0393917 -0.00253624 -0.00238849 -0.0101797 0.999942 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 4.00007 2.33227e-05 -0.0194149 3.99998 9.89897e-05 3.99968 +EDGE_SE3:QUAT 705 1010 5.24952 3.05313 -0.0041853 -6.51523e-06 0.00598805 -0.999867 0.015151 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 4 4.18607e-06 -2.58787e-05 3.99986 0.0239388 0.00106151 +EDGE_SE3:QUAT 706 1010 0.813279 3.03126 0.0268238 -0.00392267 -0.00988923 0.999935 0.00421263 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 3.99994 0.000153386 0.0156933 3.99985 0.0396887 0.000526364 +EDGE_SE3:QUAT 707 1010 -3.43339 3.15421 0.0269314 -0.00300236 -0.0114332 0.999682 0.0222713 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 3.99998 0.000117769 0.0120195 3.99959 0.0462095 0.00255432 +EDGE_SE3:QUAT 1011 1012 4.34113 -0.14539 0.0284909 -0.000370907 -0.00342523 -0.00660971 0.999972 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 4.00019 3.22525e-06 -0.0274306 3.99995 9.05911e-05 4.00001 +EDGE_SE3:QUAT 520 1011 7.24729 1.20911 0.046077 -0.00774829 -0.00351776 0.999695 0.0231751 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 3.99977 0.000139254 0.0310177 4.00088 0.0154929 0.00244902 +EDGE_SE3:QUAT 521 1011 3.12936 1.36813 0.031509 -0.00559083 -0.00682848 0.999846 0.0151472 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 3.99988 0.000157909 0.0223722 4.00029 0.0279795 0.00123865 +EDGE_SE3:QUAT 522 1011 -0.972865 1.48801 -0.0100443 -0.0106208 -0.00739881 0.99987 0.00964622 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 3.99956 0.000336204 0.0424905 4.00155 0.0304257 0.00105496 +EDGE_SE3:QUAT 523 1011 -5.23236 1.56477 0.00581839 -0.00673559 -0.0059153 0.999939 0.00639612 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 3.99982 0.000164531 0.0269449 4.00057 0.0240089 0.000489243 +EDGE_SE3:QUAT 578 1011 7.31163 0.0484656 0.0501318 0.00181135 0.00270338 0.00194485 0.999993 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 4.0001 1.98778e-05 0.0215851 3.99997 2.12945e-05 4.0001 +EDGE_SE3:QUAT 579 1011 3.26632 0.119573 0.00926794 -0.00190291 0.0049452 -0.00104157 0.999985 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 4.00038 -3.82342e-05 0.0395409 3.9999 -2.17094e-05 4.00039 +EDGE_SE3:QUAT 580 1011 -1.12185 0.202988 0.0126692 -6.18341e-05 0.00295032 -0.00506508 0.999983 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 4.00014 -1.78748e-06 0.0235986 3.99997 -5.97789e-05 4.00004 +EDGE_SE3:QUAT 581 1011 -5.13793 0.312073 0.0103538 -0.000557752 0.0045929 -0.00741559 0.999962 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 4.00034 -1.39767e-05 0.0366932 3.99992 -0.000136298 4.00012 +EDGE_SE3:QUAT 648 1011 3.49592 0.74785 0.0141836 -0.00322262 0.00477775 -0.0181128 0.999819 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 4.00031 -6.96971e-05 0.0375052 3.99991 -0.000339283 3.99904 +EDGE_SE3:QUAT 649 1011 -0.702911 0.827219 0.000145448 -0.00285958 0.00174033 -0.0184216 0.999825 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 4.00001 -1.99339e-05 0.0132836 3.99999 -0.000120586 3.99869 +EDGE_SE3:QUAT 650 1011 -4.92179 0.932557 0.00559933 -0.00142026 0.00429245 -0.019832 0.999793 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 4.00028 -3.26829e-05 0.0339834 3.99993 -0.000336478 3.99872 +EDGE_SE3:QUAT 704 1011 5.19534 3.08353 0.0556246 0.00564637 0.00969442 -0.999548 0.0279073 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 3.99985 0.000215887 0.022616 4.00021 0.0374482 0.0035941 +EDGE_SE3:QUAT 705 1011 1.28295 3.04423 0.018783 0.00422951 0.00634056 -0.999948 0.00682804 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 3.99993 0.000106473 0.0169201 4.00013 0.0251303 0.000415945 +EDGE_SE3:QUAT 706 1011 -3.12734 3.1697 0.0251929 -0.00791639 -0.0101129 0.999838 0.0125754 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 3.99977 0.000328247 0.0316772 4.00055 0.0412434 0.00130869 +EDGE_SE3:QUAT 1012 1013 4.40985 -0.101467 0.021223 0.00179832 0.000480006 0.00150735 0.999997 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 3.99999 3.42202e-06 0.00380749 4 2.87125e-06 3.99999 +EDGE_SE3:QUAT 519 1012 7.09331 1.37198 0.0222552 -0.00330352 -0.0049529 0.999256 0.0381106 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 3.99997 6.6459e-05 0.0132411 4.00005 0.0207462 0.00596131 +EDGE_SE3:QUAT 520 1012 2.93742 1.54333 0.00863489 -0.00413945 -0.00412232 0.999551 0.0293846 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 3.99994 7.54128e-05 0.0165788 4.00018 0.0174273 0.00359856 +EDGE_SE3:QUAT 521 1012 -1.19056 1.64102 0.00898809 -0.00206033 -0.00706998 0.99974 0.0215805 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 3.99999 5.14141e-05 0.00824708 3.99985 0.0286024 0.00208451 +EDGE_SE3:QUAT 522 1012 -5.30652 1.69859 -0.0688758 -0.00724071 -0.00785388 0.999814 0.016088 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 3.99981 0.000238963 0.0289761 4.00055 0.0323348 0.00150665 +EDGE_SE3:QUAT 580 1012 3.1842 0.0271305 0.016201 -0.000325177 -0.000593689 -0.0111728 0.999937 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 4.00001 6.85632e-07 -0.00479222 4 2.6848e-05 3.99951 +EDGE_SE3:QUAT 581 1012 -0.787468 0.110858 -0.00316016 -0.00114355 0.00106346 -0.0139473 0.999902 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 4.00001 -5.08206e-06 0.00831387 4 -5.7558e-05 3.99924 +EDGE_SE3:QUAT 582 1012 -5.19202 0.245402 -0.010416 -0.000380883 0.000763695 -0.0206039 0.999787 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 4.00001 -1.41994e-06 0.00601153 4 -6.15993e-05 3.99831 +EDGE_SE3:QUAT 649 1012 3.62618 0.537511 0.0142882 -0.00328719 -0.00183608 -0.0247227 0.999687 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 4.00002 2.40402e-05 -0.0156499 3.99998 0.00019713 3.99762 +EDGE_SE3:QUAT 650 1012 -0.591533 0.627621 -0.00393514 -0.00197208 0.000776319 -0.0260984 0.999657 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 3.99999 -5.62467e-06 0.00558684 4 -7.02143e-05 3.99728 +EDGE_SE3:QUAT 651 1012 -4.74071 0.735181 -0.0188227 -0.00213292 0.000225952 -0.0283683 0.999595 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 3.99998 -9.08925e-07 0.00107973 4 -1.18729e-05 3.99678 +EDGE_SE3:QUAT 703 1012 5.00783 3.13409 0.0235799 0.00384924 0.00479206 -0.998186 0.0598831 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 3.99992 5.92496e-05 0.015488 4.0002 0.0171606 0.0144781 +EDGE_SE3:QUAT 704 1012 0.868432 2.97273 0.0411038 0.00208701 0.0098071 -0.999712 0.0218209 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 3.99997 9.57125e-05 0.00835611 3.99971 0.0388169 0.00229897 +EDGE_SE3:QUAT 705 1012 -3.04752 3.1217 0.0131521 0.000582292 0.00682563 -0.999976 0.000660316 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 4 1.61372e-05 0.00232933 3.99982 0.0272988 0.000189415 +EDGE_SE3:QUAT 1013 1014 4.3798 -0.0970299 0.0254655 -0.00112882 -0.00234724 -0.00270326 0.999993 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 4.00008 1.02681e-05 -0.0188146 3.99998 2.52986e-05 4.00006 +EDGE_SE3:QUAT 466 1013 1.60676 7.21046 0.113865 0.00869756 0.00398738 -0.478769 0.877889 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 4.00072 -0.000343629 0.0639338 3.99986 -0.018138 3.08414 +EDGE_SE3:QUAT 518 1013 6.75819 1.60919 0.0420382 -0.00600471 -0.00416979 0.99889 0.0465425 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 3.99988 0.00013044 0.024094 4.00045 0.0188232 0.00889896 +EDGE_SE3:QUAT 519 1013 2.72613 1.78875 0.0178416 -0.00387021 -0.003044 0.999334 0.0361461 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 3.99995 5.64475e-05 0.0155102 4.00018 0.0132549 0.00533034 +EDGE_SE3:QUAT 520 1013 -1.46463 1.89806 -0.00369929 -0.00472377 -0.00223497 0.999596 0.0279263 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 3.99992 5.55389e-05 0.0189168 4.00032 0.00997815 0.00323395 +EDGE_SE3:QUAT 521 1013 -5.61221 1.92382 0.0187137 -0.00256551 -0.00522731 0.999783 0.0200217 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 3.99998 5.20918e-05 0.0102683 3.99998 0.0212994 0.0017433 +EDGE_SE3:QUAT 581 1013 3.59193 -0.0985609 0.00935247 0.000647798 0.00157418 -0.0120625 0.999926 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 4.00004 3.39291e-06 0.0126846 3.99999 -7.665e-05 3.99946 +EDGE_SE3:QUAT 582 1013 -0.75978 -0.0314129 -0.00184498 0.00119991 0.00113731 -0.0191647 0.999815 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 4.00002 5.05257e-06 0.00936941 3.99999 -9.06086e-05 3.99855 +EDGE_SE3:QUAT 583 1013 -5.1352 0.0484859 -0.0194573 0.00250571 0.00172075 -0.019074 0.999813 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 4.00003 1.6749e-05 0.0143319 3.99999 -0.000138298 3.9986 +EDGE_SE3:QUAT 650 1013 3.77941 0.311136 0.0111082 -0.000282851 0.00124206 -0.0240568 0.99971 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 4.00002 -2.26671e-06 0.00984631 3.99999 -0.000118086 3.99771 +EDGE_SE3:QUAT 651 1013 -0.367 0.393054 -0.00116423 -0.000650427 0.00058607 -0.0264735 0.999649 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 4 -1.63634e-06 0.0044771 4 -5.8334e-05 3.9972 +EDGE_SE3:QUAT 652 1013 -4.50866 0.497512 -0.0116951 7.83106e-05 0.00226358 -0.0286724 0.999586 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 4.00008 -2.81948e-06 0.0181136 3.99998 -0.000259706 3.99679 +EDGE_SE3:QUAT 702 1013 4.57466 2.99354 0.0265743 0.00750932 0.00119772 -0.991649 0.128741 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 3.99979 -0.000141023 0.0307945 4.00091 -0.00301398 0.0665401 +EDGE_SE3:QUAT 703 1013 0.639238 2.69601 0.00738966 0.00446021 0.00300175 -0.998076 0.0617737 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 3.99991 2.53991e-05 0.0179482 4.00032 0.0096979 0.0153684 +EDGE_SE3:QUAT 704 1013 -3.53142 2.87523 0.0380659 0.0027564 0.00810324 -0.999687 0.023522 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 3.99996 9.65937e-05 0.0110366 3.99989 0.0318503 0.00249736 +EDGE_SE3:QUAT 771 1013 6.75785 -1.99766 0.0355135 -0.00661633 0.000416619 0.985769 0.167973 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 3.99986 0.00016106 0.0275773 4.00066 0.00709219 0.113067 +EDGE_SE3:QUAT 772 1013 0.858951 -3.75837 0.038446 -0.00718269 0.0011083 0.914493 0.404536 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 4 0.000394825 0.0354646 4.00058 0.0167193 0.655016 +EDGE_SE3:QUAT 773 1013 -4.97639 -2.78768 0.0495314 -0.00357673 0.003452 0.804694 0.593669 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 4.00006 0.000227385 0.0254074 4.00023 0.00772281 1.40998 +EDGE_SE3:QUAT 1014 1015 4.12026 -0.25174 0.0149759 -0.0042048 0.00201223 -0.0651007 0.997868 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 3.99997 -2.88031e-05 0.0127197 3.99999 -0.000377573 3.98309 +EDGE_SE3:QUAT 466 1014 3.89499 3.50987 0.0728664 0.00625214 0.00264879 -0.480706 0.876855 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 4.00034 -0.000161204 0.0448019 3.99993 -0.0128741 3.07619 +EDGE_SE3:QUAT 467 1014 -2.14658 3.82669 0.0579532 0.00385009 0.00503921 -0.272835 0.96204 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 4.00051 -0.000130173 0.0478829 3.99988 -0.00688647 3.70282 +EDGE_SE3:QUAT 517 1014 7.01846 1.91037 -0.012008 0.000301694 -0.00820671 0.998167 0.0599648 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 3.99999 -4.09909e-05 -0.00122779 3.99975 0.032387 0.0146467 +EDGE_SE3:QUAT 518 1014 2.41475 2.10119 0.0194709 -0.00369395 -0.00566194 0.998768 0.0491655 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 3.99996 8.39958e-05 0.0148246 4.00004 0.0239615 0.00986789 +EDGE_SE3:QUAT 519 1014 -1.65129 2.20716 0.0137809 -0.00147501 -0.00424765 0.999221 0.0392003 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 3.99999 2.08676e-05 0.00591171 3.99995 0.0173872 0.00623108 +EDGE_SE3:QUAT 520 1014 -5.84472 2.23646 -0.0223637 -0.00250841 -0.00370392 0.999511 0.030932 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 3.99998 3.78796e-05 0.0100473 4.00003 0.0154007 0.00391177 +EDGE_SE3:QUAT 582 1014 3.60874 -0.288765 0.0153829 9.96243e-05 -0.00115143 -0.0217181 0.999763 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 4.00002 -1.14413e-06 -0.00917905 3.99999 9.95626e-05 3.99813 +EDGE_SE3:QUAT 583 1014 -0.746298 -0.213721 -0.0138224 0.00101041 -0.000525426 -0.0218086 0.999762 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 4 -2.07407e-06 -0.00393606 4 4.19542e-05 3.9981 +EDGE_SE3:QUAT 584 1014 -4.75484 -0.53279 -0.10599 0.00553784 -0.00728504 0.0351367 0.999341 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 4.00079 -0.000122221 -0.0605152 3.99977 -0.00106931 3.99598 +EDGE_SE3:QUAT 651 1014 3.98518 0.0742848 0.0150561 -0.00186252 -0.00172981 -0.0288035 0.999582 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 4.00004 1.14478e-05 -0.0144647 3.99999 0.000211188 3.99673 +EDGE_SE3:QUAT 652 1014 -0.138865 0.163665 -0.00276647 -0.00132575 4.80376e-05 -0.0310759 0.999516 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 3.99999 1.82526e-07 -0.000110323 4 4.27765e-06 3.99614 +EDGE_SE3:QUAT 653 1014 -4.13843 0.256758 -0.0228972 -0.000978074 -0.000107973 -0.0333408 0.999444 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 4 6.5949e-07 -0.00125337 4 2.30602e-05 3.99555 +EDGE_SE3:QUAT 701 1014 4.01017 2.3751 0.00759731 0.0052291 0.00251692 -0.970341 0.241672 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 3.9999 -0.000126484 0.0229511 4.00049 -0.000891987 0.233762 +EDGE_SE3:QUAT 702 1014 0.312349 1.95697 -0.0143701 0.00508048 0.00236937 -0.992 0.126117 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 3.99989 -3.44969e-05 0.0208386 4.00044 0.00405879 0.0637364 +EDGE_SE3:QUAT 703 1014 -3.73399 2.24738 -0.00778883 0.00206436 0.00429493 -0.998254 0.0588762 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 3.99997 3.60764e-05 0.00830743 4.00002 0.0160624 0.0139477 +EDGE_SE3:QUAT 770 1014 6.78998 1.5915 -0.0218744 -0.000296934 0.00244514 -0.99796 0.0637924 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 4 1.45574e-07 -0.00118989 3.99998 0.00983207 0.0163025 +EDGE_SE3:QUAT 771 1014 2.6361 -0.467391 0.00595228 -0.00462701 -0.00112109 0.985345 0.170504 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 3.99995 9.28757e-05 0.0192532 4.00027 0.0102908 0.116408 +EDGE_SE3:QUAT 772 1014 -2.01687 -0.47177 0.00426051 -0.00573909 -0.00084504 0.913462 0.406882 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 4.00002 0.000204774 0.02746 4.00023 0.0176558 0.662502 +EDGE_SE3:QUAT 773 1014 -6.18345 1.42131 0.0350339 -0.002586 0.00102577 0.803122 0.595808 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 4.00003 7.04036e-05 0.0159417 4.00006 0.00699508 1.42004 +EDGE_SE3:QUAT 1015 1016 4.11911 -0.613543 -0.0180859 -0.00120816 0.0127128 -0.1404 0.990013 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 4.00233 -0.00056644 0.0967487 3.99948 -0.00668818 3.92349 +EDGE_SE3:QUAT 466 1015 5.86669 -0.0684747 0.0431986 0.00380373 0.00710548 -0.536901 0.843607 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 4.00064 -0.000592808 0.0539374 4.00013 -0.0138699 2.84765 +EDGE_SE3:QUAT 467 1015 1.19321 1.47755 0.0253009 0.000439222 0.00835126 -0.33436 0.942408 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 4.00082 -0.000457318 0.0575659 3.99993 -0.00904981 3.55363 +EDGE_SE3:QUAT 468 1015 -3.58954 0.853217 -0.0457593 -0.000286693 -0.00767414 -0.0823605 0.996573 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 4.00093 -0.000107086 -0.061064 3.99977 0.00251106 3.9738 +EDGE_SE3:QUAT 517 1015 2.94823 2.64607 0.0118822 -0.00146375 -0.0120194 0.992114 0.124752 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 3.99999 -7.48019e-05 0.00580288 3.99942 0.0476517 0.0628374 +EDGE_SE3:QUAT 518 1015 -1.67262 2.76537 0.00988397 -0.00571377 -0.0097033 0.993398 0.114163 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 3.99996 0.000182465 0.0231855 3.99987 0.0427067 0.0527293 +EDGE_SE3:QUAT 519 1015 -5.73492 2.77641 0.0220443 -0.00365286 -0.0083275 0.994531 0.104049 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 3.99999 7.8554e-05 0.0147731 3.9998 0.0354194 0.0436769 +EDGE_SE3:QUAT 583 1015 3.37349 -0.641327 0.00425242 -0.00320331 0.0018315 -0.0868163 0.996218 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 3.99999 -2.06659e-05 0.0111661 3.99999 -0.000434185 3.96988 +EDGE_SE3:QUAT 584 1015 -0.65113 -0.500109 -0.035128 0.00149205 -0.00494843 -0.0300942 0.999534 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 4.00037 -4.62399e-05 -0.0389982 3.99991 0.000584842 3.99676 +EDGE_SE3:QUAT 585 1015 -4.51159 -1.25707 -0.100149 -0.000841671 -0.0120664 0.120348 0.992658 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 4.00217 0.000440471 -0.0932813 3.9995 -0.00555739 3.94424 +EDGE_SE3:QUAT 652 1015 3.92818 -0.338658 0.0146205 -0.00527364 0.00233636 -0.0959849 0.995366 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 3.99993 -3.39739e-05 0.0123956 3.99999 -0.000493951 3.96318 +EDGE_SE3:QUAT 653 1015 -0.0652331 -0.257627 -0.00393131 -0.00483363 0.00198204 -0.0980349 0.995169 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 3.99993 -2.40305e-05 0.0099779 4 -0.000392656 3.96158 +EDGE_SE3:QUAT 654 1015 -4.139 -0.154887 -0.0514028 -0.00366617 -0.00635119 -0.100578 0.994902 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 4.00069 -6.99052e-06 -0.0544438 3.99981 0.00279636 3.96028 +EDGE_SE3:QUAT 700 1015 4.41085 1.19929 -0.0476225 -0.00872447 0.00183792 -0.948504 0.316638 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 3.99996 -0.000442142 -0.0392782 4.00067 0.0254676 0.401619 +EDGE_SE3:QUAT 701 1015 0.238581 0.645663 -0.0236131 0.00604504 0.00723582 -0.983977 0.178048 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 3.99976 6.05089e-06 0.0256278 4.00072 0.018342 0.127063 +EDGE_SE3:QUAT 702 1015 -3.73562 1.16173 -0.037571 0.00664709 0.00689974 -0.998081 0.061181 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 3.99978 0.000131095 0.0267501 4.00065 0.0241058 0.015298 +EDGE_SE3:QUAT 769 1015 6.03337 3.06271 -0.0409671 -0.00758686 0.00375328 -0.976462 0.215524 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 3.99992 -0.000286673 -0.0320898 4.00049 0.0257776 0.186239 +EDGE_SE3:QUAT 770 1015 2.67086 1.30715 -0.00347324 -0.00141165 -0.00662833 0.999976 0.001532 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 3.99999 3.69587e-05 0.00564699 3.99986 0.0265302 0.000193329 +EDGE_SE3:QUAT 771 1015 -1.07638 1.12817 -0.0160497 -0.0075194 -0.00492947 0.972101 0.23439 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 3.99995 0.00027714 0.0319485 4.00033 0.0303926 0.220259 +EDGE_SE3:QUAT 772 1015 -4.57456 2.74787 -0.0233038 -0.00947513 -0.00442435 0.884984 0.465505 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 4.00013 0.000334874 0.044519 4.00008 0.0365171 0.867702 +EDGE_SE3:QUAT 1016 1017 4.10602 -0.79767 0.021455 -0.00335565 -0.000341584 -0.184618 0.982805 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 3.99998 1.58015e-05 -0.00985936 3.99999 0.00113423 3.86369 +EDGE_SE3:QUAT 467 1016 4.00276 -1.593 -0.0562612 0.00216156 0.0209792 -0.463355 0.885922 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 4.0038 -0.00340555 0.127173 4.00057 -0.0256022 3.14503 +EDGE_SE3:QUAT 468 1016 0.355837 -0.420581 -0.002826 0.000274211 0.00499647 -0.22135 0.975182 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 4.00036 -0.000119397 0.0377778 3.99993 -0.00409644 3.80437 +EDGE_SE3:QUAT 469 1016 -3.4222 -1.28759 -0.0422278 0.00491186 0.000906634 0.0527681 0.998594 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 3.99991 7.99925e-06 0.00411808 4 8.10717e-05 3.98887 +EDGE_SE3:QUAT 470 1016 -6.26707 -3.96152 -0.011225 0.00111291 0.00280874 0.32331 0.946288 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 4.00005 4.1868e-05 0.0150237 4 0.00199259 3.58194 +EDGE_SE3:QUAT 516 1016 3.55416 4.14981 0.010308 -0.00725061 -0.00572247 0.963181 0.268696 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 3.99999 0.000234997 0.0310856 4.00014 0.0333283 0.289334 +EDGE_SE3:QUAT 517 1016 -0.823511 4.24408 0.0114779 -0.0129161 -0.011578 0.964583 0.26321 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 3.99999 0.000706993 0.0550835 4.00023 0.0638178 0.278978 +EDGE_SE3:QUAT 518 1016 -5.42843 4.27744 -0.0318515 -0.0175634 -0.00988015 0.967263 0.252976 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 3.99978 0.00154551 0.0754356 4.00196 0.0666757 0.258624 +EDGE_SE3:QUAT 584 1016 3.42925 -1.35562 -0.0139684 0.00135193 0.00806533 -0.169995 0.985411 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 4.00103 -0.000225303 0.0644655 3.99977 -0.00547828 3.88544 +EDGE_SE3:QUAT 585 1016 -0.356544 -0.86999 -0.0187258 -0.00186999 0.000173969 -0.0204266 0.99979 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 3.99999 -7.37056e-07 0.000932633 4 -7.96253e-06 3.99833 +EDGE_SE3:QUAT 586 1016 -3.96641 -1.59554 -0.0246359 0.00180835 0.00111191 0.15251 0.9883 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 3.99999 5.87668e-06 0.0053285 4 0.000314226 3.90697 +EDGE_SE3:QUAT 653 1016 3.86398 -1.66585 -0.0297378 -0.00496113 0.0144727 -0.2371 0.971365 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 4.00202 -0.00108033 0.0925991 3.9997 -0.0100562 3.77725 +EDGE_SE3:QUAT 654 1016 -0.190328 -1.58038 -0.00802539 -0.00250425 0.00604358 -0.239522 0.970869 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 4.00032 -0.000187453 0.0373272 3.99996 -0.00401302 3.77086 +EDGE_SE3:QUAT 655 1016 -4.20944 -1.49673 -0.0430068 -0.00132223 0.00475226 -0.239283 0.970937 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 4.00023 -0.000117247 0.0311496 3.99997 -0.00344105 3.77121 +EDGE_SE3:QUAT 699 1016 5.35238 -0.17937 0.0188231 0.0037142 0.00564493 -0.951138 0.308691 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 3.99988 -7.03362e-05 0.0181519 4.00038 0.00908638 0.38128 +EDGE_SE3:QUAT 700 1016 0.744445 -0.799511 0.00656269 0.00275327 0.00572134 -0.983566 0.180438 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 3.99992 4.08036e-05 0.0118065 4.00014 0.0172001 0.130346 +EDGE_SE3:QUAT 701 1016 -3.75358 -0.189639 -0.0878558 0.0177355 0.0113716 -0.999063 0.0378032 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 3.99863 0.000545779 0.0710936 4.00487 0.0400363 0.0073829 +EDGE_SE3:QUAT 768 1016 5.26068 3.1175 0.027168 0.00468685 0.00571888 -0.963772 0.266625 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 3.99985 -8.0551e-05 0.0215038 4.00052 0.00962757 0.28451 +EDGE_SE3:QUAT 769 1016 2.02031 1.86722 0.0030241 0.00439161 0.0063737 -0.997062 0.0762044 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 3.99989 9.08754e-05 0.0177417 4.00025 0.0224663 0.0234347 +EDGE_SE3:QUAT 770 1016 -1.38352 1.95012 -0.0243808 -0.0135314 -0.00793394 0.989717 0.142175 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 3.99959 0.000830866 0.0555728 4.00184 0.0452583 0.0821589 +EDGE_SE3:QUAT 771 1016 -4.34431 3.52597 -0.0746092 -0.0196837 -0.00398269 0.928956 0.369644 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 4.00009 0.00231626 0.0916107 4.00283 0.0610996 0.549798 +EDGE_SE3:QUAT 1017 1018 4.32575 -0.993678 -0.00168295 0.00488522 -0.00228179 -0.198825 0.98002 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 3.99991 -9.24455e-06 -0.00583372 4 0.000157193 3.84188 +EDGE_SE3:QUAT 468 1017 3.723 -2.90088 -0.0260134 -0.00362175 0.00544427 -0.397645 0.917516 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 4 -0.000101631 0.0181818 4.00003 -0.00171824 3.36757 +EDGE_SE3:QUAT 469 1017 0.749251 -1.64206 -0.0357672 0.00143177 0.00128783 -0.132441 0.991189 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 4.00003 2.24077e-06 0.0122817 3.99999 -0.000857403 3.92987 +EDGE_SE3:QUAT 470 1017 -2.54299 -2.07685 -0.0169703 -0.00248804 0.001751 0.142741 0.989755 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 4.00005 -8.17486e-06 0.0177861 3.99998 0.00136021 3.91858 +EDGE_SE3:QUAT 471 1017 -5.61612 -3.45334 -0.0374756 -0.00992013 -0.0021996 0.326598 0.945109 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 3.99968 -0.000154379 0.0212565 3.99993 0.00574002 3.57341 +EDGE_SE3:QUAT 516 1017 0.448372 6.94516 0.00156996 -0.00630435 -0.0100214 0.896988 0.441897 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 3.99994 -0.000172768 0.0245372 3.99953 0.0398452 0.781749 +EDGE_SE3:QUAT 585 1017 3.72172 -1.81892 0.00516351 -0.00505922 -0.000366059 -0.204633 0.978826 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 3.99995 3.61898e-05 -0.014823 3.99998 0.00193323 3.83255 +EDGE_SE3:QUAT 586 1017 0.17808 -1.11011 -0.0207211 -0.00167368 0.000642104 -0.0322016 0.99948 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 3.99999 -3.82724e-06 0.00448253 4 -6.8672e-05 3.99586 +EDGE_SE3:QUAT 587 1017 -3.45906 -1.65169 -0.00635843 -0.00338141 0.00271828 0.144674 0.98947 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 4.00013 -1.20363e-05 0.0268563 3.99995 0.00206685 3.91646 +EDGE_SE3:QUAT 654 1017 3.06864 -4.19691 -0.0318453 -0.00679349 0.00599142 -0.414826 0.909856 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 3.99977 1.21158e-06 0.00616621 4.00001 0.00199013 3.31163 +EDGE_SE3:QUAT 655 1017 -0.938884 -4.10473 -0.0575075 -0.00523136 0.00500014 -0.414561 0.909993 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 3.99987 -1.50328e-05 0.00710087 4.00001 0.00110404 3.31253 +EDGE_SE3:QUAT 656 1017 -5.30662 -4.08778 -0.071255 -0.00633442 0.00687785 -0.404116 0.91466 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 3.99984 -8.03762e-05 0.0147319 4.00004 8.30808e-05 3.34676 +EDGE_SE3:QUAT 698 1017 5.95235 -1.3993 0.0313934 0.00541287 0.0118325 -0.975783 0.218355 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 3.99965 0.000123145 0.0241281 4.00066 0.032788 0.191163 +EDGE_SE3:QUAT 699 1017 1.55453 -1.95806 0.00537049 0.00136609 0.00902757 -0.991756 0.127817 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 3.99995 0.000108341 0.00574837 3.99982 0.0332699 0.0656396 +EDGE_SE3:QUAT 700 1017 -3.38231 -1.51148 0.00511629 -0.000725448 -0.00928877 0.999948 0.00409475 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 4 2.4168e-05 0.00290221 3.99966 0.0371758 0.000414718 +EDGE_SE3:QUAT 767 1017 4.8708 2.7096 0.0351117 0.00485524 0.0106243 -0.962096 0.27246 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 3.99969 1.24181e-05 0.0231774 4.00068 0.0250274 0.29727 +EDGE_SE3:QUAT 768 1017 1.33814 1.67183 0.00110114 0.00222921 0.00952575 -0.996416 0.0840262 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 3.99994 0.000124585 0.00905729 3.99982 0.0359446 0.0285878 +EDGE_SE3:QUAT 769 1017 -2.16421 2.04186 -0.0110575 -0.00286233 -0.0102299 0.993978 0.10906 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 4 2.96159e-05 0.0115466 3.9996 0.0421734 0.0480594 +EDGE_SE3:QUAT 770 1017 -5.04567 3.88909 -0.0946617 -0.0122376 -0.0133575 0.946259 0.322903 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 4.00008 0.000367799 0.0524101 3.99945 0.0683381 0.419055 +EDGE_SE3:QUAT 1018 1019 4.02234 -0.612559 -0.01156 0.00745806 0.0188887 -0.115532 0.993096 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 4.00605 -0.000470881 0.158556 3.99847 -0.00926678 3.95288 +EDGE_SE3:QUAT 469 1018 4.658 -3.72891 -0.0582198 0.00576058 -0.00137129 -0.32673 0.945099 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 3.99989 5.16314e-05 0.0117171 3.99998 -0.00324006 3.57301 +EDGE_SE3:QUAT 470 1018 1.88289 -1.79976 -0.0336428 0.00229064 -0.000381801 -0.0569225 0.998376 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 3.99998 -1.16084e-06 -0.00147827 4 2.70909e-05 3.98704 +EDGE_SE3:QUAT 471 1018 -1.60651 -1.56593 -0.0302686 -0.00373359 -0.00454734 0.132145 0.991213 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 4.00016 9.91852e-05 -0.0295788 3.99996 -0.0018044 3.93037 +EDGE_SE3:QUAT 472 1018 -5.6966 -1.95959 -0.0849212 -0.00353969 -0.0153257 0.208609 0.977873 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 4.00275 0.00114022 -0.106141 3.99951 -0.0105162 3.82873 +EDGE_SE3:QUAT 586 1018 4.43034 -2.38778 -0.0234764 0.00290509 -0.00216611 -0.230068 0.973168 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 3.99998 -1.64988e-05 -0.00823376 4 0.000585321 3.78829 +EDGE_SE3:QUAT 587 1018 0.960728 -1.3587 -0.0296667 0.00135636 0.000547129 -0.0548982 0.998491 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 4 3.23051e-06 0.005249 4 -0.000152062 3.98795 +EDGE_SE3:QUAT 588 1018 -2.76782 -1.48103 -0.0857673 -0.00424051 -0.012253 0.0862464 0.996189 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 4.00207 0.000478373 -0.0926038 3.9995 -0.00393441 3.97239 +EDGE_SE3:QUAT 589 1018 -6.9414 -2.2366 -0.143811 -0.00508277 -0.017883 0.177949 0.983864 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 4.00383 0.00144331 -0.125789 3.99925 -0.0107296 3.87727 +EDGE_SE3:QUAT 697 1018 6.11162 -1.89521 -0.0800102 -0.0121799 0.0115872 -0.995195 0.0964625 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 3.99964 -0.00072025 -0.0493262 4.00117 0.0546167 0.0385842 +EDGE_SE3:QUAT 698 1018 1.62201 -2.33648 -0.0131823 0.00169733 0.00742185 -0.999773 0.0199031 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 3.99998 5.74472e-05 0.00679442 3.99984 0.0293876 0.00181208 +EDGE_SE3:QUAT 699 1018 -2.86039 -2.1031 -0.00198891 0.00209297 -0.00378332 0.997417 0.0716976 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 3.99997 -2.96375e-05 -0.00844745 4.00004 0.0137452 0.0206277 +EDGE_SE3:QUAT 766 1018 4.47771 1.60678 -0.0313498 -0.00779496 0.0097781 -0.983262 0.181766 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 3.99996 -0.000279554 -0.0322231 3.99997 0.0468841 0.132985 +EDGE_SE3:QUAT 767 1018 0.685487 1.285 -0.012732 0.0018489 0.00606343 -0.997084 0.0760449 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 3.99997 5.63319e-05 0.00748118 3.99995 0.0227858 0.023276 +EDGE_SE3:QUAT 768 1018 -3.08963 1.92821 -0.00738312 0.00134775 -0.00456237 0.993291 0.115545 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 3.99998 -3.25899e-05 -0.00555432 3.99999 0.0164143 0.0534784 +EDGE_SE3:QUAT 769 1018 -6.15591 3.95605 -0.00731413 0.00211644 -0.00610118 0.952525 0.304392 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 3.99991 -9.21215e-06 -0.0109346 4.00016 0.0142634 0.370713 +EDGE_SE3:QUAT 1019 1020 4.37842 -0.405967 0.0139332 -0.00128762 0.000936123 -0.060408 0.998173 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 4 -5.01492e-06 0.0065169 4 -0.000187049 3.98541 +EDGE_SE3:QUAT 470 1019 5.81531 -2.8741 -0.0528466 0.0107536 0.0181644 -0.171681 0.984926 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 4.006 -0.000723284 0.160878 3.99846 -0.0142096 3.88856 +EDGE_SE3:QUAT 471 1019 2.42952 -1.11466 -0.00356277 0.00176153 0.0145529 0.0168804 0.99975 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 4.00335 0.0001878 0.116102 3.99916 0.000989863 4.00223 +EDGE_SE3:QUAT 472 1019 -1.77904 -0.877547 0.0242475 0.00166064 0.00441656 0.0940544 0.995556 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 4.00026 6.65572e-05 0.0330031 3.99994 0.00151626 3.96489 +EDGE_SE3:QUAT 473 1019 -5.98872 -0.907693 0.0356811 0.00298275 0.00463724 0.111026 0.993802 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 4.00023 9.31067e-05 0.0324739 3.99994 0.00171799 3.95096 +EDGE_SE3:QUAT 587 1019 4.90555 -2.41369 -0.0528685 0.00972955 0.019005 -0.170169 0.985184 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 4.00643 -0.000877093 0.16521 3.9984 -0.0143917 3.89098 +EDGE_SE3:QUAT 588 1019 1.30901 -1.38761 -0.000436406 0.00294281 0.00643305 -0.0294328 0.999542 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 4.00065 4.75596e-05 0.0524436 3.99983 -0.000773882 3.99722 +EDGE_SE3:QUAT 589 1019 -2.95521 -1.40937 -0.010749 0.00107989 0.00153589 0.0631252 0.998004 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 4.00003 9.18264e-06 0.011398 3.99999 0.000350431 3.98409 +EDGE_SE3:QUAT 590 1019 -7.01465 -1.45329 0.0882285 0.00420958 0.00763721 0.0803477 0.996729 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 4.00073 0.000215587 0.0564733 3.99982 0.00221292 3.97497 +EDGE_SE3:QUAT 696 1019 6.42084 -1.85873 0.00638678 0.00249292 0.00169847 -0.999731 0.0230083 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 3.99997 1.38959e-05 0.00997974 4.00009 0.00632647 0.00215246 +EDGE_SE3:QUAT 697 1019 2.02675 -2.06632 0.0188281 -0.0057788 -0.00450305 0.999785 0.0193933 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 3.99987 0.000115898 0.0231285 4.00043 0.0188947 0.00172746 +EDGE_SE3:QUAT 698 1019 -2.44294 -1.88261 -0.0300153 -0.0197378 -0.000404452 0.995167 0.0961884 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 3.99857 0.000913049 0.0800282 4.00603 0.0166718 0.0386942 +EDGE_SE3:QUAT 699 1019 -6.77701 -0.893928 0.0098734 -0.0157296 0.0051673 0.982273 0.186723 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 3.99906 0.000855139 0.0663834 4.00416 0.00380336 0.140606 +EDGE_SE3:QUAT 765 1019 4.51703 0.691101 0.0472305 0.00702538 0.0070917 -0.996186 0.0866822 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 3.99974 0.000108079 0.0284531 4.00079 0.0230068 0.0303929 +EDGE_SE3:QUAT 766 1019 0.508763 0.743356 0.0172229 0.0108675 0.00491811 -0.997699 0.0667486 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 3.99949 2.38877e-05 0.0437681 4.00194 0.0136847 0.0183498 +EDGE_SE3:QUAT 767 1019 -3.4009 1.28736 -0.0388115 -0.0203097 -8.30119e-05 0.999 0.0398344 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 3.99837 0.00040059 0.0814164 4.00657 0.00681204 0.00801914 +EDGE_SE3:QUAT 1020 1021 4.00778 -0.111863 0.0289076 -0.00334386 -0.00687304 -0.00715385 0.999945 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 4.00072 8.44425e-05 -0.0552755 3.99981 0.000194329 4.00056 +EDGE_SE3:QUAT 471 1020 6.81736 -1.36506 -0.114448 -0.000476802 0.0157546 -0.0439801 0.998908 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 4.00393 -0.000290514 0.125528 3.99903 -0.00276583 3.9962 +EDGE_SE3:QUAT 472 1020 2.59748 -0.46291 0.0012412 -8.65388e-05 0.00531713 0.0337421 0.999416 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 4.00045 2.10404e-05 0.0425036 3.99989 0.000717023 3.9959 +EDGE_SE3:QUAT 473 1020 -1.63201 -0.338836 0.0163376 0.00114629 0.00582694 0.0505303 0.998705 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 4.00052 6.61054e-05 0.0457483 3.99987 0.00114979 3.99031 +EDGE_SE3:QUAT 474 1020 -6.09947 -0.272458 -0.06525 0.00428718 0.00119182 0.0546556 0.998495 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 3.99994 1.3388e-05 0.0066854 4 0.000156779 3.98806 +EDGE_SE3:QUAT 588 1020 5.64427 -2.05815 -0.040609 0.00127297 0.00778783 -0.0896053 0.995946 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 4.00098 -9.27988e-05 0.0629289 3.99976 -0.00282849 3.96887 +EDGE_SE3:QUAT 589 1020 1.44621 -1.2568 -0.00823447 -0.000546024 0.00249458 0.00251051 0.999994 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 4.0001 -5.07936e-06 0.0199733 3.99998 2.49984e-05 4.00007 +EDGE_SE3:QUAT 590 1020 -2.62782 -1.16444 0.0355135 0.00226111 0.00873206 0.0199254 0.999761 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 4.00118 0.000114192 0.0692919 3.9997 0.000693032 3.99961 +EDGE_SE3:QUAT 591 1020 -6.60547 -1.06772 -0.0771372 0.00539795 0.00127844 0.0192909 0.999799 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 3.9999 2.37053e-05 0.00897214 4 8.26776e-05 3.99853 +EDGE_SE3:QUAT 695 1020 6.61776 -1.5448 0.0297302 -0.00895081 -0.00348959 0.999869 0.0130532 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 3.99969 0.000148562 0.0358118 4.00121 0.0148935 0.00105768 +EDGE_SE3:QUAT 696 1020 2.01403 -1.66375 0.00452271 -0.00329358 -0.00326474 0.999275 0.0378012 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 3.99996 4.86468e-05 0.0132013 4.00011 0.0140076 0.00580846 +EDGE_SE3:QUAT 697 1020 -2.32061 -1.50919 -0.0149998 -0.00688855 -0.00617579 0.996741 0.0801391 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 3.99987 0.000219319 0.0277951 4.00044 0.0287011 0.0260904 +EDGE_SE3:QUAT 698 1020 -6.64436 -0.654985 -0.18608 -0.0209034 -0.00290878 0.987502 0.15619 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 3.99872 0.00171037 0.0865412 4.00603 0.0365067 0.0998296 +EDGE_SE3:QUAT 764 1020 4.27688 0.231314 0.0510651 0.0116244 0.0048467 -0.999618 0.0245904 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 3.99944 0.000148511 0.0465378 4.00213 0.0170844 0.00303358 +EDGE_SE3:QUAT 765 1020 0.153653 0.339077 0.00765399 0.00726921 0.00900803 -0.999579 0.0266175 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 3.99976 0.000242641 0.0291112 4.0006 0.0344309 0.00334253 +EDGE_SE3:QUAT 766 1020 -3.88891 0.566405 -0.0601603 0.0114608 0.00715798 -0.999889 0.00631725 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 3.99947 0.000311179 0.0458461 4.00192 0.0280696 0.000882026 +EDGE_SE3:QUAT 1021 1022 4.20267 -0.0706393 -0.0144483 -0.00176802 -0.00387302 0.00111196 0.99999 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 4.00023 2.7768e-05 -0.030962 3.99994 -1.78483e-05 4.00023 +EDGE_SE3:QUAT 472 1021 6.59811 -0.312662 -0.00703443 -0.00318728 -0.00163644 0.0264718 0.999643 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 4 2.01843e-05 -0.0120657 3.99999 -0.000155357 3.99723 +EDGE_SE3:QUAT 473 1021 2.34361 -0.0510242 -0.0025347 -0.00199684 -0.00143416 0.0435001 0.99905 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 4.00001 1.18732e-05 -0.0103997 3.99999 -0.000218489 3.99246 +EDGE_SE3:QUAT 474 1021 -2.09975 0.0376089 -0.0393793 0.00119324 -0.005702 0.0474173 0.998858 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 4.00053 1.00677e-05 -0.0461455 3.99987 -0.00109763 3.99154 +EDGE_SE3:QUAT 475 1021 -6.56088 0.218388 -0.0229851 -0.000909995 -0.000327355 0.0428103 0.999083 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 4 9.85153e-07 -0.00214473 4 -4.2523e-05 3.99267 +EDGE_SE3:QUAT 589 1021 5.4408 -1.35924 0.00757601 -0.0040715 -0.00432101 -0.00495357 0.99997 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 4.00024 6.87979e-05 -0.0348103 3.99992 8.45884e-05 4.0002 +EDGE_SE3:QUAT 590 1021 1.38879 -1.11662 -0.00732431 -0.000951942 0.00170104 0.0126977 0.999917 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 4.00004 -5.67117e-06 0.0137502 3.99999 8.75338e-05 3.9994 +EDGE_SE3:QUAT 591 1021 -2.56468 -1.03163 -0.0574029 0.00201294 -0.00558769 0.01197 0.999911 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 4.00049 -3.63264e-05 -0.0449857 3.99987 -0.000268363 3.99993 +EDGE_SE3:QUAT 592 1021 -6.92424 -0.906124 -0.00651077 0.00201462 0.00126434 0.00901518 0.999957 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 4.00001 1.02287e-05 0.00989551 3.99999 4.43509e-05 3.9997 +EDGE_SE3:QUAT 694 1021 6.84341 -1.36287 0.0609059 -0.00687741 -0.00542807 0.999866 0.0138178 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 3.99982 0.000161383 0.0275182 4.00061 0.0224674 0.00107927 +EDGE_SE3:QUAT 695 1021 2.61113 -1.31984 -0.0109652 -0.00217011 -0.00679069 0.999769 0.0202555 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 3.99999 5.3386e-05 0.00868589 3.99988 0.0274864 0.00184897 +EDGE_SE3:QUAT 696 1021 -1.95183 -1.22615 0.00806005 0.0031673 -0.00680763 0.998994 0.0442137 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 3.99994 -8.9205e-05 -0.0127117 4.00002 0.0259806 0.008029 +EDGE_SE3:QUAT 697 1021 -6.25096 -0.736381 -0.0305923 -0.000433408 -0.010026 0.996156 0.0870162 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 3.99999 -5.19202e-05 0.00169993 3.99961 0.0396443 0.030684 +EDGE_SE3:QUAT 763 1021 4.5553 0.0464337 0.00253937 -0.000479684 0.00569635 -0.999913 0.0119235 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 4 -7.87691e-06 -0.00191914 3.99987 0.0228227 0.000699842 +EDGE_SE3:QUAT 764 1021 0.265997 0.155061 -0.0103349 0.00480269 0.0081065 -0.9998 0.0176193 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 3.9999 0.000154496 0.0192216 4.00014 0.0317274 0.00158587 +EDGE_SE3:QUAT 765 1021 -3.855 0.253392 -0.0227476 0.000339293 0.0122969 -0.999734 0.0194957 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 4 4.00709e-05 0.00135927 3.9994 0.0490843 0.00212343 +EDGE_SE3:QUAT 1022 1023 4.16431 -0.079918 0.00255477 0.00199409 -0.00141253 0.00344059 0.999991 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 4.00002 -1.12097e-05 -0.0113824 3.99999 -1.9532e-05 3.99999 +EDGE_SE3:QUAT 473 1022 6.55303 0.22738 -0.00376457 -0.00358038 -0.00528956 0.0446109 0.998984 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 4.00035 9.86872e-05 -0.0402787 3.9999 -0.000885715 3.99244 +EDGE_SE3:QUAT 474 1022 2.06694 0.355606 -0.0112037 -0.000204389 -0.00989534 0.0481954 0.998789 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 4.00155 0.000120616 -0.0787957 3.99962 -0.00189805 3.99226 +EDGE_SE3:QUAT 475 1022 -2.43084 0.484253 -0.035902 -0.00253359 -0.00430426 0.0443047 0.999006 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 4.00025 5.96381e-05 -0.0329891 3.99993 -0.000721277 3.99242 +EDGE_SE3:QUAT 476 1022 -6.92226 0.696641 0.00885073 -0.00265653 0.00143514 0.0329919 0.999451 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 4.00001 -1.52109e-05 0.0125133 3.99999 0.000211954 3.99569 +EDGE_SE3:QUAT 590 1022 5.54122 -1.10439 -0.0329727 -0.00267837 -0.00209067 0.0141096 0.999895 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 4.00004 2.29985e-05 -0.016267 3.99998 -0.000113956 3.99927 +EDGE_SE3:QUAT 591 1022 1.62553 -1.00914 -0.0269784 0.000354868 -0.00946528 0.0130496 0.99987 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 4.00143 1.46335e-05 -0.0757823 3.99964 -0.000494244 4.00075 +EDGE_SE3:QUAT 592 1022 -2.69468 -0.906836 -0.0341342 0.000178346 -0.00286652 0.0101294 0.999945 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 4.00013 -4.70975e-08 -0.0229509 3.99997 -0.000116245 3.99972 +EDGE_SE3:QUAT 593 1022 -7.19408 -0.763898 -0.0251687 -0.00367729 0.000481077 0.00571177 0.999977 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 3.99995 -7.65847e-06 0.00410039 4 1.19274e-05 3.99987 +EDGE_SE3:QUAT 693 1022 7.04336 -1.23705 0.0731183 -0.00925024 -0.00740036 0.999891 0.00875687 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 3.99967 0.000287924 0.037007 4.00112 0.030257 0.000877948 +EDGE_SE3:QUAT 694 1022 2.60606 -1.16385 -0.0126093 -0.00294153 -0.00708401 0.999889 0.0127903 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 3.99997 8.0658e-05 0.0117697 3.99993 0.0286259 0.000893899 +EDGE_SE3:QUAT 695 1022 -1.59756 -1.06319 -0.034318 0.00181336 -0.00868925 0.999778 0.0190915 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 3.99998 -7.26608e-05 -0.00725874 3.99977 0.0344479 0.00176791 +EDGE_SE3:QUAT 696 1022 -6.09709 -0.770884 0.0277885 0.00683943 -0.0087899 0.99901 0.0430715 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 3.99977 -0.000211704 -0.0274409 4.00056 0.0326525 0.0078763 +EDGE_SE3:QUAT 762 1022 4.59161 -0.116372 -0.0048593 -0.000104901 0.00858218 -0.999946 0.00589061 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 4 -1.2989e-07 -0.000419628 3.99971 0.0343294 0.0004335 +EDGE_SE3:QUAT 763 1022 0.343945 0.020537 -0.00852087 -0.00448317 0.00719513 -0.999878 0.0130837 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 3.99993 -0.000129589 -0.0179384 4.00009 0.0292397 0.000978952 +EDGE_SE3:QUAT 764 1022 -3.95521 0.0996764 -0.0628399 0.00104358 0.0097107 -0.999774 0.0188712 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 3.99999 5.4018e-05 0.00417779 3.99965 0.0386493 0.00180246 +EDGE_SE3:QUAT 1023 1024 4.11839 -0.076824 0.0300847 0.00182841 0.00539017 0.00355454 0.999977 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 4.00045 4.18131e-05 0.0430467 3.99988 7.77536e-05 4.00041 +EDGE_SE3:QUAT 474 1023 6.20131 0.669714 0.0708883 0.00163778 -0.011122 0.0516896 0.9986 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 4.002 8.18186e-05 -0.0896733 3.9995 -0.00232138 3.99132 +EDGE_SE3:QUAT 475 1023 1.74134 0.76671 0.00284731 -0.000665026 -0.00561326 0.0474627 0.998857 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 4.00049 4.99839e-05 -0.044381 3.99988 -0.00104986 3.99148 +EDGE_SE3:QUAT 476 1023 -2.76211 0.878385 -0.0023055 -0.000695416 0.000246267 0.0361263 0.999347 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 4 -7.57234e-07 0.00226749 4 4.27487e-05 3.99478 +EDGE_SE3:QUAT 477 1023 -7.26286 1.11068 0.0718554 -0.00327639 0.00495247 0.023423 0.999708 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 4.00037 -5.25887e-05 0.0405108 3.9999 0.000476035 3.99822 +EDGE_SE3:QUAT 591 1023 5.76759 -0.990161 0.0539602 0.00220562 -0.0108134 0.0165576 0.999802 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 4.00187 -4.93146e-05 -0.086945 3.99953 -0.000715561 4.00079 +EDGE_SE3:QUAT 592 1023 1.48047 -0.916441 -0.00921771 0.00202012 -0.00417341 0.0137488 0.999895 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 4.00027 -2.83322e-05 -0.033713 3.99993 -0.000231684 3.99953 +EDGE_SE3:QUAT 593 1023 -3.04648 -0.806077 -0.0240537 -0.00196097 -0.000960315 0.00937868 0.999954 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 4 7.44115e-06 -0.0074608 4 -3.46814e-05 3.99966 +EDGE_SE3:QUAT 594 1023 -7.30211 -0.665041 0.0645309 -0.00297888 0.00509702 0.00525318 0.999969 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 4.00038 -5.78253e-05 0.0409655 3.99989 0.000105921 4.00031 +EDGE_SE3:QUAT 692 1023 7.31137 -1.13207 -0.00230645 -0.00243507 -0.00766574 0.999967 0.000602672 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 3.99998 7.44658e-05 0.00974111 3.99986 0.0306748 0.000260416 +EDGE_SE3:QUAT 693 1023 2.8796 -1.06816 -0.00183505 -0.00773918 -0.00542201 0.999944 0.00475899 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 3.99976 0.000173639 0.0309583 4.00083 0.0219883 0.00045105 +EDGE_SE3:QUAT 694 1023 -1.4968 -0.967611 -0.0291828 -0.00152443 -0.00521338 0.999944 0.00911835 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 3.99999 3.02732e-05 0.00609869 3.99993 0.0209603 0.000451721 +EDGE_SE3:QUAT 695 1023 -5.75649 -0.820848 -0.0260887 0.00268676 -0.00659482 0.999851 0.0157186 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 3.99997 -7.33379e-05 -0.0107519 3.99996 0.0260258 0.00118658 +EDGE_SE3:QUAT 761 1023 4.72783 -0.21865 0.0181137 0.00446619 0.0073555 -0.99996 0.00235417 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 3.99992 0.000131307 0.0178662 4.00011 0.0293399 0.000317165 +EDGE_SE3:QUAT 762 1023 0.466247 -0.0834378 -0.00144231 -0.0013398 0.00650609 -0.99993 0.00978264 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 3.99999 -3.19219e-05 -0.00536024 3.99986 0.0261227 0.000560604 +EDGE_SE3:QUAT 763 1023 -3.83068 -0.0010538 0.0291743 -0.005693 0.00526238 -0.999828 0.016825 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 3.99988 -0.000128696 -0.0227822 4.00038 0.0218041 0.00138099 +EDGE_SE3:QUAT 1024 1025 4.02806 -0.0746095 0.0384797 0.002452 -0.005771 0.00207805 0.999978 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 4.00051 -5.50627e-05 -0.0462339 3.99987 -4.61116e-05 4.00052 +EDGE_SE3:QUAT 475 1024 5.86205 1.07194 0.0763387 0.000902906 -0.000228187 0.0512872 0.998684 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 4 -1.05629e-06 -0.00237302 4 -6.55393e-05 3.98948 +EDGE_SE3:QUAT 476 1024 1.30658 1.09125 0.0257555 0.000690526 0.00559475 0.0401366 0.999178 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 4.00049 4.49773e-05 0.0443223 3.99988 0.000887325 3.99405 +EDGE_SE3:QUAT 477 1024 -3.06687 1.22547 0.0618908 -0.00178277 0.0104753 0.0268985 0.999582 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 4.00176 -3.85062e-06 0.0843192 3.99956 0.00113278 3.99888 +EDGE_SE3:QUAT 592 1024 5.54247 -0.885185 0.059084 0.00357891 0.00115149 0.017445 0.999841 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 3.99997 1.51736e-05 0.00845853 4 7.16893e-05 3.9988 +EDGE_SE3:QUAT 593 1024 1.08513 -0.808573 0.0143015 -0.000403974 0.0044456 0.0132185 0.999903 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 4.00032 -9.14372e-07 0.035622 3.99992 0.000235413 3.99962 +EDGE_SE3:QUAT 594 1024 -3.15096 -0.70763 0.0533629 -0.00125527 0.0105033 0.00909416 0.999903 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 4.00176 -2.87769e-05 0.0841857 3.99956 0.000380102 4.00144 +EDGE_SE3:QUAT 595 1024 -7.46638 -0.559839 0.0155353 -0.00445327 0.0065779 0.00474629 0.999957 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 4.00062 -0.000113021 0.0528816 3.99982 0.000121091 4.00061 +EDGE_SE3:QUAT 692 1024 3.21561 -1.04828 0.00752833 0.00761447 0.00595345 -0.999948 0.00333143 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 3.99977 0.000177741 0.030459 4.00079 0.0236173 0.000415751 +EDGE_SE3:QUAT 693 1024 -1.23852 -0.947034 -0.0337555 -0.0130745 -0.00366662 0.999907 0.00112809 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 3.99932 0.000196716 0.0522946 4.00268 0.0147983 0.00074358 +EDGE_SE3:QUAT 694 1024 -5.61695 -0.805307 -0.0131893 -0.00708318 -0.00331119 0.999957 0.0050325 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 3.9998 9.94596e-05 0.0283336 4.00075 0.0135327 0.000347789 +EDGE_SE3:QUAT 760 1024 4.9293 -0.277615 0.0714335 0.0154782 0.00738657 -0.999852 0.000990383 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 3.99904 0.000453537 0.0619106 4.00362 0.0294616 0.00117908 +EDGE_SE3:QUAT 761 1024 0.630436 -0.14924 0.0125079 0.00986661 0.00561204 -0.999916 0.00632084 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 3.99961 0.000208457 0.0394686 4.00145 0.0219585 0.00066979 +EDGE_SE3:QUAT 762 1024 -3.67129 -0.0758519 0.0465836 0.00395554 0.00512693 -0.999892 0.0131661 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 3.99993 7.87327e-05 0.0158268 4.00016 0.0200838 0.000856868 +EDGE_SE3:QUAT 1025 1026 4.01869 -0.0881613 -0.00839314 0.00112589 -0.0014972 0.0026235 0.999995 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 4.00003 -6.62764e-06 -0.012013 3.99999 -1.5713e-05 4.00001 +EDGE_SE3:QUAT 476 1025 5.35349 1.32912 0.0191537 0.0032701 1.10505e-05 0.041839 0.999119 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 3.99996 -3.41045e-06 -0.00155172 4 -4.39097e-05 3.993 +EDGE_SE3:QUAT 477 1025 0.901393 1.35615 0.0206917 0.000626922 0.00480366 0.0292378 0.999561 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 4.00036 2.79621e-05 0.0381632 3.99991 0.000557069 3.99694 +EDGE_SE3:QUAT 478 1025 -3.39169 1.49213 0.00588723 -0.00110996 -0.000226241 0.0163354 0.999866 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 4 8.59432e-07 -0.00159166 4 -1.2407e-05 3.99893 +EDGE_SE3:QUAT 593 1025 5.14652 -0.784981 0.0220476 0.0020119 -0.00142404 0.0153183 0.99988 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 4.00002 -1.11676e-05 -0.0117581 3.99999 -9.08897e-05 3.9991 +EDGE_SE3:QUAT 594 1025 0.860548 -0.706174 0.00886188 0.000956008 0.00482765 0.0109252 0.999928 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 4.00037 2.44623e-05 0.038492 3.99991 0.000210609 3.99989 +EDGE_SE3:QUAT 595 1025 -3.40094 -0.604671 0.0037751 -0.00224074 0.000869729 0.00676241 0.999974 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 3.99999 -7.93846e-06 0.00713915 4 2.43011e-05 3.99983 +EDGE_SE3:QUAT 691 1025 3.58453 -1.09356 -0.0262181 -0.00257815 0.00597075 -0.99993 0.00987085 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 3.99998 -6.02391e-05 -0.0103146 3.99996 0.0240811 0.000561324 +EDGE_SE3:QUAT 692 1025 -0.848177 -0.993934 -0.00980128 0.0018173 0.00344299 -0.999978 0.00544756 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 3.99999 2.51013e-05 0.00726965 4.00001 0.0136919 0.000178784 +EDGE_SE3:QUAT 693 1025 -5.27919 -0.867373 -0.0978055 0.00747378 0.00120287 -0.999971 0.000795252 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 3.99978 3.49306e-05 0.0298944 4.00089 0.0047654 0.000231636 +EDGE_SE3:QUAT 759 1025 4.96848 -0.327599 0.0178655 0.00449281 0.00812868 -0.999956 0.00113785 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 3.99992 0.000146152 0.0179729 4.00006 0.0324763 0.000349599 +EDGE_SE3:QUAT 760 1025 0.903602 -0.204687 -0.0119707 0.00969803 0.00504526 -0.999935 0.00308986 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 3.99962 0.000189588 0.0387922 4.00141 0.0199509 0.000513895 +EDGE_SE3:QUAT 761 1025 -3.38874 -0.119239 -0.0244518 0.00438562 0.00345018 -0.999949 0.00845116 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 3.99992 5.73744e-05 0.0175445 4.00027 0.0135031 0.00040823 +EDGE_SE3:QUAT 1026 1027 4.00759 -0.0822836 -0.0177172 -0.000341901 0.0114364 0.00283099 0.999931 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 4.00209 -6.77786e-06 0.0915434 3.99948 0.000128688 4.00206 +EDGE_SE3:QUAT 477 1026 4.95828 1.51837 -0.0267477 0.0019626 0.00339489 0.0314243 0.999498 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 4.00016 3.39472e-05 0.0263801 3.99996 0.000410969 3.99622 +EDGE_SE3:QUAT 478 1026 0.645769 1.54359 -0.00258381 0.000162241 -0.00171594 0.0189262 0.999819 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 4.00005 2.25359e-07 -0.0137571 3.99999 -0.00013027 3.99861 +EDGE_SE3:QUAT 479 1026 -3.76857 1.68339 -0.100586 0.00147849 -0.0141821 0.00607651 0.99988 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 4.00322 -5.48068e-05 -0.113638 3.99919 -0.000338939 4.00308 +EDGE_SE3:QUAT 594 1026 4.90693 -0.702756 -0.0375608 0.00228074 0.00312809 0.0135761 0.9999 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 4.00013 3.10795e-05 0.0246469 3.99996 0.000166988 3.99941 +EDGE_SE3:QUAT 595 1026 0.61399 -0.63328 -0.00901758 -0.000982311 -0.000650305 0.00936682 0.999955 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 4 2.5744e-06 -0.00509135 4 -2.36812e-05 3.99966 +EDGE_SE3:QUAT 596 1026 -3.55657 -0.523941 -0.0978313 -0.000787983 -0.0138238 0.00458055 0.999894 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 4.00305 6.46771e-05 -0.110617 3.99924 -0.000257431 4.00297 +EDGE_SE3:QUAT 690 1026 3.98988 -1.17924 -0.0456466 -0.00699085 0.00615444 -0.999823 0.0163267 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 3.99982 -0.000185666 -0.0279755 4.0006 0.0255204 0.00142479 +EDGE_SE3:QUAT 691 1026 -0.437141 -1.09658 -0.0131526 -0.00432032 0.00469782 -0.999904 0.0123105 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 3.99993 -8.43455e-05 -0.0172856 4.0002 0.0192113 0.00077318 +EDGE_SE3:QUAT 692 1026 -4.86837 -0.961126 -0.0356408 0.000294242 0.00204657 -0.999968 0.00778687 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 4 2.65106e-06 0.00117709 3.99998 0.0081667 0.000259562 +EDGE_SE3:QUAT 758 1026 5.08765 -0.328694 -0.0616523 -0.0103826 0.00559169 -0.999914 0.0057124 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 3.99957 -0.000245792 -0.0415323 4.00158 0.0228525 0.000692302 +EDGE_SE3:QUAT 759 1026 0.911553 -0.254509 -0.0197178 0.00287833 0.00699409 -0.999965 0.00355649 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 3.99997 8.11953e-05 0.0115144 3.99994 0.0278942 0.000278264 +EDGE_SE3:QUAT 760 1026 -3.12636 -0.150123 -0.0978548 0.0081139 0.00376411 -0.999943 0.00576631 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 3.99973 0.000113752 0.0324567 4.00101 0.0146861 0.00045029 +EDGE_SE3:QUAT 761 1026 -7.46152 -0.109104 -0.0692815 0.0027677 0.00205806 -0.999935 0.0108767 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 3.99997 2.11126e-05 0.0110728 4.00011 0.00798931 0.000519825 +EDGE_SE3:QUAT 1027 1028 4.07099 -0.080407 0.0327583 0.00170088 0.00215717 0.00322104 0.999991 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 4.00006 1.49599e-05 0.0171916 3.99998 2.78421e-05 4.00003 +EDGE_SE3:QUAT 478 1027 4.6522 1.60421 -0.00784258 -0.000369788 0.0097238 0.0217664 0.999716 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 4.00151 3.50564e-05 0.0778575 3.99962 0.00084749 3.99962 +EDGE_SE3:QUAT 479 1027 0.225954 1.65187 -0.00266704 0.00102008 -0.00272449 0.00901776 0.999955 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 4.00012 -9.57221e-06 -0.0219042 3.99997 -9.875e-05 3.99979 +EDGE_SE3:QUAT 480 1027 -3.88919 1.7415 -0.0433021 0.00191339 -0.00215519 0.00377491 0.999989 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 4.00006 -1.61819e-05 -0.0173281 3.99998 -3.25468e-05 4.00002 +EDGE_SE3:QUAT 595 1027 4.63739 -0.639015 -0.0201496 -0.00137937 0.0109234 0.0121834 0.999865 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 4.00191 -2.55127e-05 0.0876059 3.99952 0.000530743 4.00132 +EDGE_SE3:QUAT 596 1027 0.43724 -0.562645 -0.00287286 -0.00124782 -0.00249844 0.00765744 0.999967 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 4.00009 1.35115e-05 -0.0198715 3.99998 -7.6124e-05 3.99986 +EDGE_SE3:QUAT 597 1027 -3.72723 -0.473799 -0.0423403 -0.00175284 -0.00148145 0.00759112 0.999969 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 4.00002 1.05909e-05 -0.0116909 3.99999 -4.42615e-05 3.9998 +EDGE_SE3:QUAT 689 1027 4.45845 -1.31424 0.0257523 0.00887753 0.00401019 -0.999696 0.0226525 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 3.99967 0.000101478 0.0355368 4.00123 0.0144183 0.00242042 +EDGE_SE3:QUAT 690 1027 -0.0333978 -1.22654 -0.00487467 0.00438795 0.00672469 -0.99978 0.0193545 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 3.99991 0.0001154 0.017563 4.00015 0.0261968 0.00174715 +EDGE_SE3:QUAT 691 1027 -4.44915 -1.10904 0.00440268 0.00723289 0.00526927 -0.999843 0.0152828 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 3.99978 0.000136194 0.0289421 4.00075 0.0201863 0.0012456 +EDGE_SE3:QUAT 757 1027 5.33831 -0.37656 0.0151741 0.00492515 0.00673968 -0.9999 0.0114491 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 3.9999 0.000130027 0.0197056 4.00022 0.0265019 0.000797014 +EDGE_SE3:QUAT 758 1027 1.06415 -0.300157 0.00481569 0.00115583 0.00595343 -0.999947 0.00832324 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 3.99999 2.95853e-05 0.00462409 3.99988 0.0237324 0.000423272 +EDGE_SE3:QUAT 759 1027 -3.08703 -0.20392 -0.0603682 0.0145236 0.00739282 -0.999845 0.00664676 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 3.99915 0.000399646 0.0580965 4.00319 0.0288285 0.00122827 +EDGE_SE3:QUAT 760 1027 -7.12544 -0.111512 -0.17676 0.0196148 0.00418454 -0.999761 0.0086984 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 3.99845 0.000250453 0.0784544 4.00613 0.015402 0.00190132 +EDGE_SE3:QUAT 1028 1029 4.09218 -0.0729901 0.0241123 -0.00238471 -0.00534102 0.00266692 0.999979 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 4.00043 5.26657e-05 -0.0426553 3.99989 -5.84902e-05 4.00043 +EDGE_SE3:QUAT 479 1028 4.31062 1.64046 0.0566446 0.00246215 -0.000541108 0.0121025 0.999924 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 3.99998 -5.81816e-06 -0.00468542 4 -2.90523e-05 3.99942 +EDGE_SE3:QUAT 480 1028 0.202329 1.69236 0.0131076 0.00336386 -5.04722e-05 0.00659811 0.999973 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 3.99995 -1.27541e-06 -0.000670077 4 -2.50301e-06 3.99983 +EDGE_SE3:QUAT 481 1028 -3.87155 1.74963 0.0315431 0.00507846 0.00585071 0.0116309 0.999902 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 4.00043 0.000125797 0.0460909 3.99987 0.000270813 3.99999 +EDGE_SE3:QUAT 596 1028 4.49859 -0.592159 0.0495382 0.000319172 -9.72019e-05 0.0109153 0.99994 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 4 -1.30276e-07 -0.000819279 4 -4.54707e-06 3.99952 +EDGE_SE3:QUAT 597 1028 0.325362 -0.491784 0.00438168 -0.000259669 0.000767813 0.0106491 0.999943 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 4.00001 -6.51166e-07 0.00617465 4 3.29309e-05 3.99956 +EDGE_SE3:QUAT 598 1028 -3.73079 -0.422703 0.0200223 0.00164135 0.0055886 0.0131545 0.999897 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 4.00048 4.61809e-05 0.0444428 3.99988 0.000293032 3.9998 +EDGE_SE3:QUAT 688 1028 4.88382 -1.50251 0.0528145 0.0127809 0.00164573 -0.999492 0.0291661 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 3.99934 -3.04415e-05 0.0511848 4.00263 0.00359181 0.00406151 +EDGE_SE3:QUAT 689 1028 0.400757 -1.41827 -0.00763596 0.0111729 0.00245661 -0.999598 0.0259411 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 3.99949 3.23803e-05 0.0447343 4.002 0.00749752 0.0032065 +EDGE_SE3:QUAT 690 1028 -4.08931 -1.30546 -0.00274409 0.00674807 0.00529901 -0.999711 0.0224589 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 3.99981 0.000122475 0.0270134 4.00065 0.0199624 0.0022998 +EDGE_SE3:QUAT 756 1028 5.53658 -0.457769 0.0596234 0.0118054 0.00247062 -0.999779 0.0171911 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 3.99944 5.9674e-05 0.0472395 4.00223 0.00825809 0.00175732 +EDGE_SE3:QUAT 757 1028 1.28744 -0.381227 0.0133508 0.00691338 0.00513961 -0.999859 0.0144305 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 3.9998 0.000128243 0.0276625 4.00068 0.0197548 0.00112187 +EDGE_SE3:QUAT 758 1028 -2.98503 -0.269986 0.0397004 0.00357155 0.00476342 -0.999917 0.011408 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 3.99995 6.64972e-05 0.0142894 4.00012 0.0187227 0.000659266 +EDGE_SE3:QUAT 759 1028 -7.13693 -0.172835 -0.148309 0.0168247 0.0055215 -0.999797 0.00962517 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 3.99885 0.000309389 0.0673007 4.00445 0.0208173 0.00161153 +EDGE_SE3:QUAT 1029 1030 4.12176 -0.0870888 -0.00721339 -5.54306e-06 -0.00203177 0.00185581 0.999996 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 4.00007 2.28914e-07 -0.0162542 3.99998 -1.50835e-05 4.00005 +EDGE_SE3:QUAT 480 1029 4.30107 1.66969 0.0344624 0.000929509 -0.00525734 0.00920828 0.999943 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 4.00044 -1.34835e-05 -0.0421601 3.99989 -0.000193698 4.00011 +EDGE_SE3:QUAT 481 1029 0.24664 1.76706 0.0051323 0.00265408 0.00048555 0.0140597 0.999898 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 3.99997 4.42631e-06 0.00343549 4 2.31113e-05 3.99921 +EDGE_SE3:QUAT 482 1029 -4.09762 1.82024 0.0532011 0.00434262 0.00362498 0.0227708 0.999725 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 4.00012 6.62008e-05 0.0277914 3.99995 0.000313148 3.99812 +EDGE_SE3:QUAT 597 1029 4.43159 -0.490566 0.0258553 -0.00267525 -0.00482647 0.0129643 0.999901 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 4.00034 5.80296e-05 -0.0381885 3.99991 -0.000248153 3.99969 +EDGE_SE3:QUAT 598 1029 0.362131 -0.387068 -0.000421067 -0.000859793 0.000292043 0.0156906 0.999876 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 4 -1.06102e-06 0.00249734 4 2.00116e-05 3.99902 +EDGE_SE3:QUAT 599 1029 -4.1156 -0.289962 0.00783334 -0.000169917 0.000945904 0.0157604 0.999875 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 4.00001 -3.05708e-07 0.00759657 4 5.99365e-05 3.99902 +EDGE_SE3:QUAT 687 1029 4.79302 -1.76218 -0.00426519 0.00069006 0.00380887 -0.999479 0.0320487 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 4 1.36774e-05 0.00276556 3.99995 0.0150196 0.00416684 +EDGE_SE3:QUAT 688 1029 0.781655 -1.6583 -0.0274323 0.00740716 0.00408882 -0.999461 0.0317339 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 3.99977 8.1796e-05 0.0296739 4.00086 0.0144398 0.0043007 +EDGE_SE3:QUAT 689 1029 -3.70182 -1.54385 -0.0843981 0.00591108 0.00470087 -0.999561 0.028659 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 3.99985 9.07911e-05 0.0236744 4.00051 0.017414 0.00350145 +EDGE_SE3:QUAT 755 1029 5.73976 -0.595141 0.0417081 0.00500353 0.00484338 -0.999689 0.0239576 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 3.99989 8.61822e-05 0.0200322 4.00033 0.0183897 0.00248084 +EDGE_SE3:QUAT 756 1029 1.44643 -0.516597 -0.00694444 0.00643608 0.00472 -0.999768 0.0199943 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 3.99983 0.000104496 0.0257602 4.0006 0.017836 0.00184461 +EDGE_SE3:QUAT 757 1029 -2.80633 -0.429458 -0.0218101 0.00170335 0.00736514 -0.999822 0.0172834 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 3.99998 5.62264e-05 0.00681733 3.99984 0.0292029 0.00141976 +EDGE_SE3:QUAT 758 1029 -7.06261 -0.290846 0.0318996 -0.00153772 0.0071229 -0.999866 0.0146502 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 3.99999 -3.8549e-05 -0.00615312 3.99983 0.0286561 0.00107332 +EDGE_SE3:QUAT 1030 1031 4.0353 -0.0907717 0.00771839 -0.00176877 0.00183035 -0.00682024 0.999974 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 4.00004 -1.33185e-05 0.0144971 3.99999 -4.94129e-05 3.99987 +EDGE_SE3:QUAT 481 1030 4.36396 1.8022 -0.00359436 0.00255607 -0.00168178 0.0160839 0.999866 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 4.00002 -1.68727e-05 -0.0139423 3.99999 -0.000113251 3.99901 +EDGE_SE3:QUAT 482 1030 0.031576 1.92907 0.0158371 0.00445724 0.00146741 0.0246699 0.999685 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 3.99995 2.32707e-05 0.0104093 3.99999 0.000123122 3.99759 +EDGE_SE3:QUAT 483 1030 -4.27647 2.00728 -0.0348523 0.00260918 -0.00320603 0.0277032 0.999608 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 4.00015 -2.77336e-05 -0.0264865 3.99996 -0.000370111 3.99711 +EDGE_SE3:QUAT 598 1030 4.45738 -0.337351 -0.0127831 -0.000772835 -0.00166215 0.0182082 0.999833 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 4.00004 6.23094e-06 -0.0131219 3.99999 -0.000118984 3.99872 +EDGE_SE3:QUAT 599 1030 0.00833631 -0.231541 -0.0105925 -7.09347e-05 -0.00108941 0.0179791 0.999838 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 4.00002 8.18597e-07 -0.00869576 4 -7.81155e-05 3.99873 +EDGE_SE3:QUAT 600 1030 -4.2711 -0.151339 -0.00970349 0.00123357 3.59822e-05 0.0182822 0.999832 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 3.99999 -4.50607e-08 1.71449e-05 4 -6.68338e-07 3.99866 +EDGE_SE3:QUAT 686 1030 4.6376 -2.05424 -0.0269398 -0.00272045 0.00279053 -0.999516 0.0308486 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 3.99997 -3.34628e-05 -0.0108968 4.00008 0.0118067 0.00387114 +EDGE_SE3:QUAT 687 1030 0.669983 -1.94013 -0.0131868 -0.00146246 0.00403033 -0.999416 0.0339141 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 3.99999 -2.0496e-05 -0.00585879 3.99996 0.0164713 0.00467716 +EDGE_SE3:QUAT 688 1030 -3.30115 -1.84094 -0.0976536 0.0055444 0.00420921 -0.999384 0.0343865 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 3.99987 7.11573e-05 0.0222183 4.00046 0.0152662 0.00491164 +EDGE_SE3:QUAT 754 1030 5.90066 -0.740171 -0.00950041 -0.000267284 0.00434752 -0.999369 0.0352432 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 4 6.83275e-07 -0.00106961 3.99992 0.0174112 0.0050445 +EDGE_SE3:QUAT 755 1030 1.61321 -0.704378 -0.00867309 0.00288808 0.0046459 -0.999642 0.0262017 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 3.99996 5.23585e-05 0.0115652 4.00006 0.0179474 0.00286016 +EDGE_SE3:QUAT 756 1030 -2.66224 -0.598618 -0.0735142 0.00447009 0.00461097 -0.999736 0.0220647 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 3.99991 7.49977e-05 0.0178941 4.00026 0.0176346 0.00210527 +EDGE_SE3:QUAT 757 1030 -6.9161 -0.492316 -0.0457734 0.000251758 0.00755831 -0.999777 0.0197075 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 4 1.65242e-05 0.00100823 3.99978 0.0301634 0.00178136 +EDGE_SE3:QUAT 1031 1032 4.36666 -0.221949 0.0490212 0.000133251 -0.000955188 -0.0403433 0.999185 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 4.00001 -1.37098e-06 -0.00755844 4 0.000151911 3.9935 +EDGE_SE3:QUAT 482 1031 4.0612 2.02384 0.0104737 0.00254569 0.0032417 0.0174332 0.99984 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 4.00014 3.63451e-05 0.02539 3.99996 0.000220376 3.99895 +EDGE_SE3:QUAT 483 1031 -0.250324 2.13748 0.000211543 0.000946167 -0.00143861 0.0206746 0.999785 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 4.00003 -4.52925e-06 -0.0117362 3.99999 -0.000122059 3.99832 +EDGE_SE3:QUAT 484 1031 -4.47968 2.22869 -0.0440992 -0.00312022 0.000307795 0.0193472 0.999808 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 3.99996 -5.27886e-06 0.00318516 4 3.31327e-05 3.99851 +EDGE_SE3:QUAT 599 1031 4.04553 -0.179448 0.0129519 -0.0020648 0.000807349 0.0111283 0.999936 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 3.99999 -6.86015e-06 0.00673328 4 3.79399e-05 3.99952 +EDGE_SE3:QUAT 600 1031 -0.208751 -0.100792 0.00716096 -0.000674603 0.00175527 0.0113163 0.999934 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 4.00005 -3.93153e-06 0.0141312 3.99999 8.00762e-05 3.99954 +EDGE_SE3:QUAT 601 1031 -4.27438 -0.0981671 -0.0372629 -0.000210513 0.000866057 0.0226596 0.999743 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 4.00001 -3.23781e-07 0.00698036 4 7.92788e-05 3.99796 +EDGE_SE3:QUAT 685 1031 5.00991 -2.45015 0.00290484 0.0082811 0.00887661 -0.999909 0.00593943 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 3.99972 0.000288076 0.0331287 4.0008 0.0351219 0.000723809 +EDGE_SE3:QUAT 686 1031 0.603833 -2.20107 0.0111793 -0.00168948 0.004724 -0.999704 0.0238213 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 3.99999 -2.90226e-05 -0.00676339 3.99995 0.019191 0.00237338 +EDGE_SE3:QUAT 687 1031 -3.33501 -2.11032 0.00824056 0.000301361 0.00562569 -0.99962 0.0269652 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 4 1.34483e-05 0.00120773 3.99988 0.0223966 0.00303434 +EDGE_SE3:QUAT 753 1031 5.9417 -0.93469 0.00816375 0.00589312 0.0078932 -0.999156 0.0398813 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 3.99983 0.00016801 0.0236339 4.0004 0.0295756 0.00672097 +EDGE_SE3:QUAT 754 1031 1.84969 -0.92409 0.00945253 0.00085761 0.00618084 -0.999582 0.0282434 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 3.99999 2.90343e-05 0.00343589 3.99987 0.0244801 0.00334365 +EDGE_SE3:QUAT 755 1031 -2.38236 -0.821118 -0.016022 0.00464613 0.00660826 -0.99978 0.0193356 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 3.9999 0.00011884 0.0185962 4.0002 0.0256926 0.00174703 +EDGE_SE3:QUAT 756 1031 -6.67241 -0.685929 -0.101262 0.00636232 0.00655292 -0.999839 0.0154168 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 3.99983 0.000156537 0.0254594 4.00051 0.0254169 0.00127431 +EDGE_SE3:QUAT 1032 1033 4.18392 -0.361173 0.0344572 -0.000719613 0.00494321 -0.0737902 0.997261 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 4.00037 -5.55497e-05 0.0385913 3.99991 -0.00141277 3.97859 +EDGE_SE3:QUAT 483 1032 4.12504 2.10425 0.062527 0.000922963 -0.002293 -0.0192278 0.999812 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 4.00008 -1.07099e-05 -0.0181212 3.99998 0.000173624 3.9986 +EDGE_SE3:QUAT 484 1032 -0.116122 2.22196 0.000984996 -0.00320375 -0.000681717 -0.0202218 0.99979 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 3.99997 1.0111e-05 -0.00622753 4 6.55308e-05 3.99837 +EDGE_SE3:QUAT 485 1032 -4.23895 2.34016 -0.0606093 -0.00282644 -0.00429588 -0.0269582 0.999623 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 4.00028 3.78086e-05 -0.0352455 3.99992 0.000477808 3.9974 +EDGE_SE3:QUAT 600 1032 4.16072 -0.221534 0.0419306 -0.000438157 0.000642003 -0.0291347 0.999575 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 4.00001 -1.35311e-06 0.00497639 4 -7.17217e-05 3.99661 +EDGE_SE3:QUAT 601 1032 0.0953066 -0.117316 0.00177077 -0.000374002 0.000116277 -0.0173853 0.999849 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 4 -1.5932e-07 0.000851782 4 -7.17706e-06 3.99879 +EDGE_SE3:QUAT 602 1032 -4.20011 -0.311112 -0.0790851 -0.00139185 -0.00539846 0.0376767 0.999274 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 4.00044 5.50925e-05 -0.042471 3.99989 -0.000796744 3.99477 +EDGE_SE3:QUAT 684 1032 4.55534 -2.79167 -0.00789492 -0.00882998 -0.0132999 0.994832 0.100269 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 3.99987 0.000443697 0.0357523 4 0.0588892 0.0414126 +EDGE_SE3:QUAT 685 1032 0.651236 -2.2919 -0.0123274 -0.00702155 -0.00893365 0.999369 0.0336612 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 3.99984 0.00026484 0.0281345 4.00037 0.0375297 0.00508285 +EDGE_SE3:QUAT 686 1032 -3.75882 -2.2115 0.0756447 0.00292628 -0.00429849 0.999855 0.0162231 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 3.99996 -4.91699e-05 -0.0117101 4.00007 0.0168037 0.00115766 +EDGE_SE3:QUAT 752 1032 6.01188 -0.900006 0.00457527 0.00387061 0.00713281 -0.999483 0.031104 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 3.99993 0.000110183 0.0155075 4.00008 0.027502 0.00411928 +EDGE_SE3:QUAT 753 1032 1.5734 -1.06295 0.00575539 -0.00478937 -0.00809693 0.999956 0.000157546 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 3.99991 0.00015515 0.0191592 4.0001 0.0323968 0.000354239 +EDGE_SE3:QUAT 754 1032 -2.49965 -0.961175 0.0528086 0.000115088 -0.00635054 0.999914 0.011457 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 4 -6.60767e-06 -0.000460572 3.99984 0.0253828 0.000686207 +EDGE_SE3:QUAT 755 1032 -6.71507 -0.769277 -0.00736967 -0.00368639 -0.00631405 0.999755 0.0208765 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 3.99995 9.26212e-05 0.0147556 4.00003 0.0258453 0.00196484 +EDGE_SE3:QUAT 1033 1034 4.23972 -0.487065 -0.0191829 -0.00417289 0.00484901 -0.112967 0.993578 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 4.00019 -0.000112063 0.0324438 3.99995 -0.00171408 3.94922 +EDGE_SE3:QUAT 484 1033 4.036 1.67583 0.0367833 -0.00362197 0.00409352 -0.0939723 0.99556 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 4.00015 -7.872e-05 0.0282554 3.99996 -0.00125816 3.96488 +EDGE_SE3:QUAT 485 1033 -0.0921915 1.76191 0.00676126 -0.00288568 0.00029257 -0.100092 0.994974 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 3.99997 3.32549e-06 -0.00113738 4 0.000115329 3.95993 +EDGE_SE3:QUAT 486 1033 -4.18663 1.98523 0.0122276 -0.00136783 -0.00132384 -0.12588 0.992044 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 4.00003 2.04516e-06 -0.0123844 3.99999 0.000817419 3.93665 +EDGE_SE3:QUAT 601 1033 4.25122 -0.6209 0.0298928 -0.00103593 0.00502616 -0.0909113 0.995846 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 4.00037 -7.16423e-05 0.0385909 3.99991 -0.00173049 3.96731 +EDGE_SE3:QUAT 602 1033 -0.0160545 -0.35919 -0.00139194 -0.00190234 -0.000582932 -0.03543 0.99937 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 3.99999 5.07843e-06 -0.00546278 4 0.000101478 3.99499 +EDGE_SE3:QUAT 603 1033 -4.1312 -0.906384 -0.0316048 0.00457696 -0.00478524 0.0893167 0.995981 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 4.00037 -4.26059e-05 -0.0427076 3.99988 -0.00197093 3.96855 +EDGE_SE3:QUAT 683 1033 4.15151 -2.21064 -0.0544737 0.0052429 -0.0145974 0.961466 0.274487 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 3.99951 -0.000123025 -0.0256167 4.00084 0.0370536 0.301952 +EDGE_SE3:QUAT 684 1033 0.539255 -1.59131 -0.0240427 -0.0128857 -0.0142077 0.984666 0.173392 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 3.99984 0.000801499 0.0532477 4.00036 0.0699668 0.122236 +EDGE_SE3:QUAT 685 1033 -3.45173 -1.65971 -0.0295241 -0.0114209 -0.0103784 0.994194 0.106493 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 3.9997 0.000628932 0.0463656 4.00103 0.0499856 0.0465356 +EDGE_SE3:QUAT 751 1033 6.43693 0.155083 0.00852455 -0.00158019 0.00230705 -0.997543 0.0699954 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 3.99999 -1.46872e-05 -0.00636078 4.00001 0.00999594 0.0196326 +EDGE_SE3:QUAT 752 1033 1.82192 -0.79909 0.0116372 -0.00814033 -0.00843359 0.999025 0.0425623 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 3.99978 0.000310289 0.0326481 4.00063 0.036359 0.00784409 +EDGE_SE3:QUAT 753 1033 -2.57621 -0.699441 0.00757956 -0.009172 -0.00920326 0.997223 0.0733258 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 3.99977 0.00040711 0.0369597 4.00071 0.0416847 0.0222861 +EDGE_SE3:QUAT 754 1033 -6.63711 -0.518365 0.0938029 -0.00446636 -0.00717935 0.996403 0.0843241 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 3.99996 0.000119964 0.0180221 3.99999 0.0312012 0.0287688 +EDGE_SE3:QUAT 1034 1035 4.02718 -0.578527 0.0112718 9.86736e-05 7.65791e-05 -0.132142 0.991231 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 4 1.34114e-08 0.000751303 4 -5.27266e-05 3.93015 +EDGE_SE3:QUAT 485 1034 3.96162 0.43538 -0.0126688 -0.0064084 0.00517786 -0.211951 0.977246 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 3.99995 -0.00011108 0.0228498 3.99999 -0.00174642 3.82043 +EDGE_SE3:QUAT 486 1034 -0.202251 0.45614 0.00319067 -0.00436537 0.00367395 -0.236979 0.971498 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 3.99997 -5.15278e-05 0.0150007 4 -0.0011866 3.77541 +EDGE_SE3:QUAT 487 1034 -4.14493 1.11849 -0.000559877 -0.00779155 0.00599198 -0.335974 0.94182 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 3.99974 -3.48463e-05 0.0109992 4.00002 0.000392258 3.54847 +EDGE_SE3:QUAT 602 1034 4.16933 -1.14005 -0.0180485 -0.00582828 0.00416323 -0.148241 0.988925 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 3.99998 -8.65413e-05 0.0219968 3.99998 -0.00134821 3.91222 +EDGE_SE3:QUAT 603 1034 0.131277 -0.638757 -0.0121032 0.000480347 0.000180306 -0.0235241 0.999723 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 4 3.68351e-07 0.0015768 4 -1.90729e-05 3.99779 +EDGE_SE3:QUAT 604 1034 -3.90013 -1.23078 -0.0212627 -8.3833e-05 -9.196e-05 0.140328 0.990105 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 4 4.1576e-08 -0.000574741 4 -3.65094e-05 3.92123 +EDGE_SE3:QUAT 682 1034 5.04565 -0.541976 0.007549 -0.00214694 -0.0134963 0.856995 0.515143 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 3.99963 -0.00017455 -0.00349356 4.00004 0.0282125 1.06189 +EDGE_SE3:QUAT 683 1034 0.816376 0.449067 0.019034 0.000826563 -0.0164388 0.924216 0.381515 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 3.99952 -0.00026029 -0.0112483 4.00019 0.0409378 0.582824 +EDGE_SE3:QUAT 684 1034 -3.28579 0.30347 -0.114364 -0.0166191 -0.0186787 0.958677 0.283396 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 4.00009 0.000866838 0.0706421 3.99922 0.0948035 0.324947 +EDGE_SE3:QUAT 750 1034 6.29364 1.48228 0.0178667 0.00387965 0.00613256 -0.99072 0.135723 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 3.99989 5.77566e-05 0.0160641 4.00025 0.019275 0.0738447 +EDGE_SE3:QUAT 751 1034 2.17266 0.0180726 0.00769609 -0.00273651 -0.00631341 0.999056 0.0428813 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 3.99998 6.11967e-05 0.0109728 3.99993 0.0260749 0.00755566 +EDGE_SE3:QUAT 752 1034 -2.35821 0.0749324 -0.0680467 -0.0123031 -0.0130088 0.9877 0.155335 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 3.9998 0.000751179 0.0505922 4.00056 0.0638684 0.098206 +EDGE_SE3:QUAT 753 1034 -6.70376 0.40949 -0.0739409 -0.0131339 -0.014079 0.982434 0.185616 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 3.99986 0.000817236 0.0544867 4.00035 0.0703807 0.139844 +EDGE_SE3:QUAT 1035 1036 4.04928 -0.614707 0.0140288 0.0051099 0.00315131 -0.13016 0.991475 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 4.00016 4.23268e-05 0.0324647 3.99993 -0.0022703 3.9325 +EDGE_SE3:QUAT 486 1035 3.10486 -1.90768 0.000675964 -0.00462568 0.00317586 -0.363515 0.931571 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 3.9999 8.86039e-06 0.00213992 4 0.00115816 3.47141 +EDGE_SE3:QUAT 487 1035 -1.39005 -1.85324 0.0044126 -0.00852437 0.00499916 -0.457102 0.889359 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 3.99968 0.000143247 -0.0121087 3.99994 0.0073534 3.1642 +EDGE_SE3:QUAT 488 1035 -6.11645 -0.0478365 -0.0289951 -0.00874638 0.00466437 -0.635116 0.772353 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 3.99988 0.000162597 -0.0315389 3.99979 0.0195108 2.3867 +EDGE_SE3:QUAT 603 1035 4.11672 -1.4004 -0.00390986 0.000557754 0.000410502 -0.155652 0.987812 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 4 3.13252e-07 0.00419036 4 -0.000349981 3.90309 +EDGE_SE3:QUAT 604 1035 0.121869 -0.649925 -0.00732816 -5.92549e-05 -2.73771e-05 0.00840905 0.999965 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 4 6.39676e-09 -0.000213015 4 -8.87212e-07 3.99972 +EDGE_SE3:QUAT 605 1035 -3.91204 -1.25053 -0.0448882 -0.00432968 -0.00349838 0.177926 0.984028 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 4 5.71948e-05 -0.0176187 3.99999 -0.00125381 3.87344 +EDGE_SE3:QUAT 682 1035 3.66116 3.26657 0.0738444 -0.000446961 -0.0136146 0.781558 0.623684 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 3.99972 0.00033475 -0.0239352 4.0006 0.0108098 1.55639 +EDGE_SE3:QUAT 683 1035 -1.62197 3.69782 0.104832 0.00273182 -0.016052 0.865777 0.500166 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 3.9995 0.000403002 -0.0302548 4.00117 0.0195854 1.00125 +EDGE_SE3:QUAT 684 1035 -6.33772 2.96644 -0.157179 -0.0141671 -0.0204192 0.912995 0.407213 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 3.99993 -0.000427518 0.0578944 3.99795 0.0883119 0.666489 +EDGE_SE3:QUAT 749 1035 5.81075 2.41495 0.0197231 0.00375709 0.0085857 -0.980083 0.198369 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 3.99983 8.52422e-05 0.016425 4.00028 0.0252868 0.157642 +EDGE_SE3:QUAT 750 1035 2.28625 0.921637 0.000602248 0.00308074 0.00643876 -0.999967 0.00378118 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 3.99996 7.97234e-05 0.0123239 3.99999 0.0256618 0.000259791 +EDGE_SE3:QUAT 751 1035 -1.78544 0.950216 0.0043135 -0.00206805 -0.006704 0.984659 0.17435 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 4 -8.01403e-06 0.00835662 3.99982 0.0275961 0.121806 +EDGE_SE3:QUAT 752 1035 -6.00305 1.82128 -0.112692 -0.0104518 -0.0146362 0.95861 0.284154 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 4.00004 0.00020612 0.0438829 3.99921 0.0689021 0.324746 +EDGE_SE3:QUAT 1036 1037 4.08742 -0.570174 -0.0160882 0.00101797 0.0103748 -0.11364 0.993467 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 4.00171 -0.000252215 0.0828034 3.9996 -0.00470318 3.95006 +EDGE_SE3:QUAT 487 1036 0.474812 -5.50591 0.0274686 -0.00309446 0.0042676 -0.569171 0.822203 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 3.99993 5.47865e-06 0.00240584 4.00001 0.00317342 2.70415 +EDGE_SE3:QUAT 488 1036 -5.93083 -4.11576 0.0130421 -0.00322611 0.00270817 -0.730236 0.683182 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 3.99998 3.17815e-05 -0.0113114 3.99996 0.00992846 1.86704 +EDGE_SE3:QUAT 604 1036 4.16915 -1.18054 0.00491665 0.00486748 0.00310678 -0.121711 0.992549 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 4.00015 4.04835e-05 0.0313438 3.99993 -0.00203891 3.94099 +EDGE_SE3:QUAT 605 1036 0.0769548 -0.392331 -0.00213615 0.000886959 -1.62265e-05 0.0483912 0.998828 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 4 -3.56459e-07 -0.000643604 4 -1.97226e-05 3.99063 +EDGE_SE3:QUAT 606 1036 -4.13508 -0.871007 -0.0595081 -0.00177573 -0.0104581 0.195354 0.980675 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 4.00138 0.000504151 -0.0748851 3.99974 -0.00703035 3.84874 +EDGE_SE3:QUAT 748 1036 5.4882 2.59105 -0.0379634 -0.00871552 0.00819439 -0.966619 0.255938 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 3.99999 -0.000319449 -0.0370245 4.00008 0.0442159 0.262886 +EDGE_SE3:QUAT 749 1036 1.86168 1.38658 0.000120948 0.00662334 0.00442951 -0.997576 0.0691263 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 3.9998 4.69614e-05 0.0266937 4.00071 0.0138648 0.0193412 +EDGE_SE3:QUAT 750 1036 -1.75766 1.50102 0.000398547 -0.00556155 -0.00157199 0.991954 0.126468 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 3.99991 0.000115008 0.0227484 4.00041 0.0115767 0.0641412 +EDGE_SE3:QUAT 751 1036 -5.36674 2.88485 0.0276516 -0.00314845 -0.0010741 0.953644 0.300917 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 4 5.40451e-05 0.0139513 4.00008 0.0102487 0.362284 +EDGE_SE3:QUAT 1037 1038 4.20394 -0.449337 0.0188531 1.68944e-05 0.000212939 -0.0820237 0.99663 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 4 -7.51296e-08 0.0017029 4 -6.98303e-05 3.97309 +EDGE_SE3:QUAT 605 1037 4.19135 -0.56411 -0.0238365 0.00122398 0.0106606 -0.0654151 0.9978 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 4.00183 -0.000127638 0.0857306 3.99955 -0.00280853 3.98472 +EDGE_SE3:QUAT 606 1037 -0.172609 0.168948 0.0075294 -0.00172448 -0.000103198 0.0827756 0.996567 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 3.99999 -1.25351e-06 0.000888006 4 6.05013e-05 3.97259 +EDGE_SE3:QUAT 607 1037 -4.23923 -0.0209666 -0.00373327 -0.00426885 0.000155294 0.156863 0.987611 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 3.99995 -2.19088e-05 0.00910038 3.99999 0.000922465 3.9016 +EDGE_SE3:QUAT 747 1037 5.62901 1.44075 0.0365564 0.00481611 0.00557825 -0.974961 0.222254 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 3.99985 -4.26403e-05 0.0211272 4.0005 0.0114671 0.197743 +EDGE_SE3:QUAT 748 1037 1.66482 1.05978 0.00652937 0.000750122 0.00903037 -0.989452 0.144575 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 3.99996 0.000101868 0.00331226 3.99978 0.033398 0.0838962 +EDGE_SE3:QUAT 749 1037 -2.24113 1.38253 -0.0664686 -0.0168106 -0.00490754 0.998838 0.0449055 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 3.99895 0.000615819 0.0674394 4.00423 0.0255985 0.00936933 +EDGE_SE3:QUAT 750 1037 -5.53554 3.04007 -0.0528057 -0.0155575 2.36562e-07 0.971057 0.238339 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 3.99945 0.001244 0.067313 4.00324 0.0280202 0.228606 +EDGE_SE3:QUAT 1038 1039 4.16226 -0.311105 0.0299391 0.000341609 0.000778464 -0.0637724 0.997964 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 4.00001 1.32631e-07 0.00645049 4 -0.000208051 3.98374 +EDGE_SE3:QUAT 606 1038 4.06809 0.41249 0.0268508 -0.0017753 5.48636e-06 0.000417199 0.999998 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 3.99999 -4.94779e-08 5.27784e-05 4 1.1626e-08 4 +EDGE_SE3:QUAT 607 1038 -0.111822 0.857988 0.00931017 -0.00396328 0.000117106 0.0751048 0.997168 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 3.99994 -1.0864e-05 0.00448738 4 0.000213103 3.97744 +EDGE_SE3:QUAT 608 1038 -4.32236 0.883413 0.00271856 -0.00465193 0.00100218 0.0926364 0.995689 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 3.99996 -2.93324e-05 0.0130559 3.99999 0.000682722 3.96572 +EDGE_SE3:QUAT 746 1038 5.62047 -0.0049715 0.0266938 0.00415064 0.00946807 -0.987444 0.157631 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 3.99982 0.000134632 0.0175069 4.00025 0.0304404 0.0997093 +EDGE_SE3:QUAT 747 1038 1.61501 0.0177562 0.0104873 0.00464757 0.00598639 -0.989935 0.141321 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 3.99986 4.27882e-05 0.0192737 4.00039 0.0176114 0.0800618 +EDGE_SE3:QUAT 748 1038 -2.49482 0.291094 0.0194539 0.000381155 0.0091959 -0.997984 0.0628011 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 3.99999 5.46515e-05 0.00155239 3.99969 0.0362294 0.016106 +EDGE_SE3:QUAT 749 1038 -6.36005 2.19689 -0.180015 -0.0168278 -0.00625907 0.991756 0.126875 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 3.9992 0.00111662 0.0688272 4.00356 0.0408984 0.0660119 +EDGE_SE3:QUAT 1039 1040 4.24478 -0.57471 0.0209589 0.00273794 -0.000517883 -0.126202 0.992001 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 3.99997 1.99149e-06 5.79257e-05 4 -9.29655e-05 3.93629 +EDGE_SE3:QUAT 607 1039 4.04912 1.18095 0.0361429 -0.0037455 0.000603697 0.0114315 0.999927 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 3.99995 -1.02077e-05 0.00534229 4 3.14739e-05 3.99948 +EDGE_SE3:QUAT 608 1039 -0.23087 1.351 0.0157062 -0.00429601 0.00140661 0.0291213 0.999566 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 3.99997 -2.67461e-05 0.0127388 3.99999 0.000192457 3.99665 +EDGE_SE3:QUAT 609 1039 -4.60203 1.39942 0.00199057 -0.00720847 0.00203424 0.0418214 0.999097 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 3.99989 -7.01241e-05 0.0198438 3.99997 0.000438898 3.9931 +EDGE_SE3:QUAT 745 1039 5.74618 -1.13134 0.0350612 0.00650047 0.0122074 -0.995713 0.0914573 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 3.99971 0.000289121 0.0264035 4.00045 0.0431063 0.0341029 +EDGE_SE3:QUAT 746 1039 1.57897 -1.00256 0.0102729 0.00419084 0.00980865 -0.995486 0.0943034 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 3.99986 0.000171871 0.0170528 4.0001 0.0352352 0.0359596 +EDGE_SE3:QUAT 747 1039 -2.45375 -0.844647 -0.00715913 0.0050787 0.0063029 -0.996954 0.0775685 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 3.99986 9.23353e-05 0.0205211 4.00037 0.0217038 0.0242921 +EDGE_SE3:QUAT 748 1039 -6.66038 0.0721525 0.0426015 -0.000684159 -0.00913027 0.999958 0.000955119 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 4 2.43556e-05 0.00273698 3.99967 0.0365248 0.000339064 +EDGE_SE3:QUAT 1040 1041 4.07055 -0.663942 0.00686132 0.00230551 0.00198836 -0.153785 0.9881 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 4.00007 3.44996e-06 0.0195338 3.99998 -0.00159607 3.9055 +EDGE_SE3:QUAT 608 1040 4.05168 1.027 0.0319264 -0.00165768 0.000320457 -0.0974054 0.995243 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 3.99999 8.9793e-09 0.000601895 4 2.73623e-06 3.96205 +EDGE_SE3:QUAT 609 1040 -0.327066 1.18108 0.0072756 -0.004892 0.000622945 -0.0844373 0.996417 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 3.9999 4.06376e-06 -2.98335e-06 4 7.06356e-05 3.97148 +EDGE_SE3:QUAT 610 1040 -4.76812 1.2619 -0.0306456 -0.00333281 -0.000771361 -0.0799864 0.99679 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 3.99998 1.50121e-05 -0.009297 3.99999 0.000413578 3.97443 +EDGE_SE3:QUAT 744 1040 5.76943 -1.49623 0.0178825 -0.00467623 -0.0129725 0.999061 0.0410764 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 3.99995 0.000202683 0.0187494 3.99956 0.0532055 0.00754601 +EDGE_SE3:QUAT 745 1040 1.52582 -1.33728 0.00259708 -0.00463097 -0.0102404 0.999347 0.034328 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 3.99994 0.000175105 0.0185561 3.99985 0.042113 0.00524369 +EDGE_SE3:QUAT 746 1040 -2.68537 -1.24099 0.000466521 -0.00269592 -0.0075234 0.999452 0.0321361 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 3.99998 7.08982e-05 0.0107992 3.99986 0.0307084 0.00439609 +EDGE_SE3:QUAT 747 1040 -6.69644 -0.936556 -0.0244406 -0.00409853 -0.00367663 0.9988 0.0486662 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 3.99995 7.23353e-05 0.0164492 4.00018 0.0162127 0.00960724 +EDGE_SE3:QUAT 1041 1042 4.01444 -0.709587 0.00477545 -0.00128543 0.00228721 -0.16334 0.986566 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 4.00005 -2.44843e-05 0.0150957 3.99999 -0.00114414 3.89334 +EDGE_SE3:QUAT 609 1041 3.51856 -0.144697 0.0171756 -0.00237435 0.00152791 -0.2364 0.971652 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 3.99998 -6.12773e-06 0.00472837 4 -0.000251896 3.77646 +EDGE_SE3:QUAT 610 1041 -0.893433 -0.0444512 -0.0118177 -0.000582432 0.000621785 -0.232124 0.972686 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 4 -1.73086e-06 0.00301363 4 -0.000270912 3.78448 +EDGE_SE3:QUAT 611 1041 -5.29677 0.0499599 -0.00537485 -0.00166997 0.00325722 -0.230401 0.973089 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 4.00008 -5.33686e-05 0.0195571 3.99999 -0.00199353 3.78776 +EDGE_SE3:QUAT 743 1041 5.92867 -0.756367 0.0220816 -0.00385595 -0.0110302 0.976978 0.21302 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 4 -4.38546e-05 0.015585 3.99949 0.0454652 0.182113 +EDGE_SE3:QUAT 744 1041 1.76307 -0.502236 0.00627845 -0.00454703 -0.0111348 0.980836 0.194463 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 4 1.38683e-05 0.0185368 3.9995 0.0471881 0.151928 +EDGE_SE3:QUAT 745 1041 -2.48629 -0.39188 -0.00768941 -0.00496694 -0.00836698 0.982194 0.187618 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 4 9.11994e-05 0.0204488 3.9998 0.0377518 0.141277 +EDGE_SE3:QUAT 746 1041 -6.66647 -0.313349 -0.000737054 -0.00326677 -0.00581433 0.982743 0.184854 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 4 3.78446e-05 0.0134263 3.9999 0.0259603 0.136904 +EDGE_SE3:QUAT 1042 1043 4.03978 -0.709618 0.0262733 -0.000693781 0.000452067 -0.151959 0.988386 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 4 -9.90794e-07 0.00224635 4 -0.000135418 3.90764 +EDGE_SE3:QUAT 609 1042 6.75203 -2.62884 0.013205 -0.00302224 0.00370074 -0.391782 0.920046 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 3.99998 -3.57936e-05 0.0103027 4.00001 -0.000604861 3.38604 +EDGE_SE3:QUAT 610 1042 2.36173 -2.49543 -0.0125833 -0.001299 0.00311992 -0.38778 0.921746 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 4.00004 -4.79107e-05 0.014108 4.00001 -0.00194383 3.39855 +EDGE_SE3:QUAT 611 1042 -2.04219 -2.39103 -0.0202533 -0.00276112 0.00551262 -0.385937 0.922505 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 4.00008 -0.000136725 0.0231058 4.00002 -0.00294116 3.40433 +EDGE_SE3:QUAT 612 1042 -6.49097 -2.27875 -0.032568 -0.00268882 0.00613381 -0.386293 0.922352 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 4.00013 -0.000181386 0.0272824 4.00003 -0.00369057 3.40327 +EDGE_SE3:QUAT 742 1042 6.89461 1.12679 0.0434522 -0.00518692 -0.0133521 0.915361 0.40238 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 3.99984 -0.000323077 0.0181817 3.99934 0.0470476 0.648408 +EDGE_SE3:QUAT 743 1042 2.57908 1.55682 0.0268361 -0.00457852 -0.0121652 0.929029 0.369779 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 3.9999 -0.000240956 0.0167462 3.99943 0.0445344 0.547604 +EDGE_SE3:QUAT 744 1042 -1.65421 1.68993 0.0124084 -0.00523289 -0.0127358 0.935986 0.351769 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 3.99992 -0.000231047 0.0200059 3.99932 0.0487826 0.495754 +EDGE_SE3:QUAT 745 1042 -5.94555 1.73901 -0.0171257 -0.00587935 -0.0101424 0.938428 0.345276 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 3.99999 -7.56753e-05 0.0239942 3.99953 0.0432961 0.47754 +EDGE_SE3:QUAT 1043 1044 4.01907 -0.495425 0.0310367 0.00942357 0.00618801 -0.104598 0.994451 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 4.00056 0.000169482 0.0604421 3.99975 -0.00334255 3.95715 +EDGE_SE3:QUAT 611 1043 0.30148 -5.75731 -0.0268329 -0.00400872 0.00564788 -0.521901 0.852978 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 3.9999 -2.55329e-05 0.00749436 4.00003 0.00208406 2.91044 +EDGE_SE3:QUAT 612 1043 -4.17448 -5.64829 -0.030567 -0.00419373 0.00635232 -0.521945 0.852945 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 3.99989 -4.87613e-05 0.010039 4.00004 0.00176025 2.91026 +EDGE_SE3:QUAT 742 1043 4.7127 4.57421 0.0976533 -0.00385021 -0.0145809 0.843733 0.536551 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 3.99956 -0.000296091 0.00245791 3.99986 0.0326458 1.15208 +EDGE_SE3:QUAT 743 1043 0.141069 4.84494 0.0705373 -0.00324562 -0.012987 0.862072 0.506609 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 3.99968 -0.000257758 0.00342741 3.99983 0.0315746 1.02705 +EDGE_SE3:QUAT 744 1043 -4.22888 4.87302 0.0555017 -0.00368066 -0.0140273 0.871656 0.489903 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 3.99965 -0.00032867 0.00579752 3.99973 0.0363958 0.960562 +EDGE_SE3:QUAT 982 1043 0.165336 6.45359 0.118096 0.00210041 0.0155693 -0.902635 0.43012 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 3.9995 -1.96459e-05 0.0202971 4.0007 0.0295352 0.740516 +EDGE_SE3:QUAT 1044 1045 4.36639 -0.44339 -0.0738444 -0.0027629 0.0315126 -0.0729737 0.996832 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 4.01535 -0.00204917 0.2485 3.9963 -0.00917067 3.99408 +EDGE_SE3:QUAT 982 1044 -2.74561 3.65828 0.0964741 0.0101805 0.00991333 -0.942755 0.333183 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 3.99949 -0.000762066 0.0498456 4.00236 0.00495823 0.444761 +EDGE_SE3:QUAT 1045 1046 4.22245 -0.219073 0.0157738 0.00205056 -0.00165967 -0.0212357 0.999771 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 4.00002 -1.4205e-05 -0.012746 3.99999 0.000133585 3.99824 +EDGE_SE3:QUAT 982 1045 -6.4 1.26305 -0.0857944 0.0382461 0.0237131 -0.963858 0.26259 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 3.99395 -0.00734991 0.171209 4.02788 0.00387066 0.283717 +EDGE_SE3:QUAT 1046 1047 3.99612 -0.11728 0.0397547 -0.00221382 0.000773388 -0.00535047 0.999983 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 3.99999 -6.71246e-06 0.00604467 4 -1.60746e-05 3.99989 +EDGE_SE3:QUAT 1047 1048 4.43866 -0.114171 0.0371778 0.00174316 -0.00316517 -0.0020276 0.999991 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 4.00015 -2.25093e-05 -0.0252795 3.99996 2.60347e-05 4.00014 +EDGE_SE3:QUAT 978 1047 3.10955 2.34153 0.0951782 0.00447831 0.010925 -0.999811 0.0154301 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 3.99991 0.000202267 0.0179229 3.99988 0.0431239 0.0014977 +EDGE_SE3:QUAT 979 1047 -1.22394 2.43069 0.0811201 0.00648363 0.00991622 -0.999865 0.0113552 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 3.99982 0.000254226 0.0259427 4.00031 0.0390707 0.00106567 +EDGE_SE3:QUAT 980 1047 -5.35369 2.51162 0.0354941 0.00649911 0.00937907 -0.999875 0.0109618 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 3.99982 0.000240063 0.0260039 4.00036 0.0369424 0.000990895 +EDGE_SE3:QUAT 1048 1049 4.11023 -0.08603 0.00628452 8.65201e-05 -0.0026216 0.000578436 0.999996 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 4.00011 -8.11986e-07 -0.0209739 3.99997 -6.05224e-06 4.00011 +EDGE_SE3:QUAT 976 1048 6.93517 2.14655 0.112153 0.00513506 0.00872084 -0.999783 0.01821 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 3.99988 0.00017777 0.0205528 4.00016 0.0341107 0.00172302 +EDGE_SE3:QUAT 977 1048 2.94601 2.21931 0.0810137 0.00143591 0.00912204 -0.999828 0.0160993 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 3.99999 6.20781e-05 0.00574697 3.99971 0.0362787 0.00137416 +EDGE_SE3:QUAT 978 1048 -1.32881 2.32069 0.0959996 0.00130565 0.00885528 -0.999869 0.013493 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 3.99999 5.40125e-05 0.00522485 3.99972 0.0352631 0.00104602 +EDGE_SE3:QUAT 979 1048 -5.6776 2.44189 0.0594345 0.00343119 0.00802713 -0.999918 0.00941386 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 3.99995 0.000112211 0.0137279 3.99994 0.0318442 0.000655134 +EDGE_SE3:QUAT 1049 1050 4.04784 -0.093814 0.0081726 -0.000397384 0.006587 -0.000629701 0.999978 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 4.00069 -1.11316e-05 0.052701 3.99983 -1.7014e-05 4.00069 +EDGE_SE3:QUAT 975 1049 6.86683 2.01079 0.120561 0.00211088 0.00789344 -0.99975 0.020807 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 3.99998 7.43117e-05 0.00845035 3.99984 0.0311883 0.00199288 +EDGE_SE3:QUAT 976 1049 2.80817 2.08065 0.0881428 0.00231304 0.00811099 -0.999785 0.0189344 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 3.99997 8.21307e-05 0.00925848 3.99984 0.0320647 0.00171262 +EDGE_SE3:QUAT 977 1049 -1.11307 2.17673 0.0808077 -0.00119891 0.00886832 -0.999815 0.0170455 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 4 -3.22029e-05 -0.00479786 3.9997 0.0356097 0.00148508 +EDGE_SE3:QUAT 978 1049 -5.46067 2.30013 0.0976068 -0.00115228 0.00854148 -0.999868 0.0137615 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 4 -3.16575e-05 -0.00461067 3.99972 0.0342755 0.00105661 +EDGE_SE3:QUAT 1050 1051 4.04593 -0.0983052 0.06121 0.00154249 0.00560638 -0.00178515 0.999982 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 4.00049 3.32916e-05 0.0448887 3.99987 -3.89243e-05 4.00049 +EDGE_SE3:QUAT 974 1050 6.86371 1.8342 0.0478302 -0.000438607 0.00803734 -0.999774 0.0196522 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 4 -3.9646e-06 -0.00175505 3.99974 0.0321862 0.00180471 +EDGE_SE3:QUAT 975 1050 2.78391 1.93075 0.109343 0.0083665 0.00835686 -0.999725 0.0202384 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 3.9997 0.000255399 0.0334888 4.00091 0.0320509 0.00217572 +EDGE_SE3:QUAT 976 1050 -1.26971 2.01702 0.0762304 0.00883053 0.00862983 -0.999762 0.0180001 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 3.99967 0.000280587 0.0353416 4.00102 0.0332337 0.0018845 +EDGE_SE3:QUAT 977 1050 -5.21531 2.13081 0.0930314 0.00533402 0.00929027 -0.999813 0.0161052 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 3.99987 0.000197564 0.021347 4.00015 0.0364545 0.00148375 +EDGE_SE3:QUAT 1051 1052 4.28557 -0.097132 0.0505174 -0.000936425 -0.00550995 -0.0028209 0.99998 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 4.00048 1.86089e-05 -0.0441154 3.99988 6.15739e-05 4.00045 +EDGE_SE3:QUAT 973 1051 6.8352 1.62567 0.0626719 0.00404052 0.00713992 -0.999896 0.0118449 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 3.99993 0.000115341 0.0161666 4.00007 0.0281688 0.000824946 +EDGE_SE3:QUAT 974 1051 2.83638 1.77603 0.103149 0.00505574 0.00652865 -0.999804 0.017968 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 3.99989 0.000126488 0.0202339 4.00027 0.0253702 0.00155474 +EDGE_SE3:QUAT 975 1051 -1.22915 1.86914 0.0942762 0.0140322 0.00668377 -0.999711 0.018364 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 3.99919 0.00029391 0.0561544 4.00305 0.0246779 0.00228985 +EDGE_SE3:QUAT 976 1051 -5.31776 1.97523 0.0605486 0.0144521 0.00722369 -0.999739 0.0161704 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 3.99914 0.000342705 0.0578282 4.00321 0.0270372 0.00206494 +EDGE_SE3:QUAT 1052 1053 4.07018 -0.116026 0.011961 -0.000661596 -0.00466377 -0.00409886 0.999981 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 4.00035 1.02171e-05 -0.0373446 3.99991 7.62283e-05 4.00028 +EDGE_SE3:QUAT 972 1052 7.04754 1.50255 0.0927064 0.00569252 0.00785254 -0.999932 0.00641087 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 3.99987 0.000176923 0.0227731 4.00029 0.0311197 0.000536147 +EDGE_SE3:QUAT 973 1052 2.54676 1.61355 0.0756229 -0.00155529 0.00796877 -0.999922 0.00950406 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 3.99999 -4.5224e-05 -0.00622251 3.99978 0.0319855 0.000626793 +EDGE_SE3:QUAT 974 1052 -1.47774 1.72267 0.112155 -0.000484189 0.00764737 -0.999862 0.0147275 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 4 -7.95733e-06 -0.00193731 3.99977 0.0306291 0.00110314 +EDGE_SE3:QUAT 975 1052 -5.56017 1.807 0.0235749 0.00842167 0.00753725 -0.999822 0.015093 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 3.9997 0.000234381 0.0336996 4.00095 0.029126 0.00140725 +EDGE_SE3:QUAT 1053 1054 4.29688 -0.103026 -0.00059886 0.0015644 0.00775342 -0.00199659 0.999967 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 4.00095 4.5713e-05 0.0620774 3.99976 -5.9763e-05 4.00095 +EDGE_SE3:QUAT 971 1053 7.19901 1.45388 0.0761462 -0.00014869 0.00734788 -0.999972 0.00142527 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 4 -3.75478e-06 -0.000594807 3.99978 0.0293923 0.000224203 +EDGE_SE3:QUAT 972 1053 2.97004 1.55892 0.0603195 0.000908808 0.00843688 -0.999961 0.00238907 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 4 3.19763e-05 0.00363566 3.99973 0.0337286 0.000310561 +EDGE_SE3:QUAT 973 1053 -1.50599 1.64656 0.104221 -0.00620673 0.00877648 -0.999928 0.00529673 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 3.99985 -0.000219509 -0.0248304 4.00029 0.0353724 0.000579133 +EDGE_SE3:QUAT 974 1053 -5.57012 1.70898 0.130101 -0.00516467 0.00775628 -0.999897 0.010911 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 3.9999 -0.000161701 -0.020664 4.00017 0.0314701 0.000830558 +EDGE_SE3:QUAT 1054 1055 4.03555 -0.0900812 0.0485064 0.000876705 0.00231071 -0.000252116 0.999997 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 4.00008 8.07309e-06 0.0184887 3.99998 -2.21852e-06 4.00009 +EDGE_SE3:QUAT 971 1054 2.90541 1.54339 0.0735964 -0.00757605 -0.00573829 0.999955 0.000452817 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 3.99977 0.000174527 0.0303049 4.00079 0.0229875 0.000362494 +EDGE_SE3:QUAT 972 1054 -1.3218 1.64199 0.046076 0.00894628 0.00698671 -0.999935 0.000603784 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 3.99968 0.000249351 0.0357863 4.00109 0.0279152 0.00051638 +EDGE_SE3:QUAT 973 1054 -5.79728 1.7131 0.16044 0.00162393 0.00695151 -0.99997 0.00302267 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 3.99999 4.6123e-05 0.00649627 3.99985 0.0277659 0.00023984 +EDGE_SE3:QUAT 1055 1056 4.10024 -0.0879453 0.0491941 0.000344184 -0.00135431 0.000378337 0.999999 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 4.00003 -1.84827e-06 -0.0108361 3.99999 -2.03483e-06 4.00003 +EDGE_SE3:QUAT 970 1055 3.37637 1.54257 0.0762413 -0.00544676 -0.00674589 0.999958 0.00288952 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 3.99988 0.000148006 0.0217885 4.00029 0.0271127 0.000335838 +EDGE_SE3:QUAT 971 1055 -1.10437 1.65047 0.0666756 -0.0101379 -0.0051031 0.999935 0.00103943 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 3.99959 0.000209571 0.0405513 4.00154 0.020508 0.000520548 +EDGE_SE3:QUAT 972 1055 -5.34133 1.73668 0.0376838 0.0113994 0.00685822 -0.999911 0.000294476 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 3.99948 0.00031245 0.0455979 4.00189 0.027425 0.0007081 +EDGE_SE3:QUAT 1056 1057 4.26932 -0.123501 0.0227123 0.00366747 -0.00433539 -0.00188125 0.999982 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 4.00025 -6.42573e-05 -0.0346017 3.99993 3.41758e-05 4.00029 +EDGE_SE3:QUAT 969 1056 3.39026 1.5457 0.075794 1.90955e-05 -0.0119467 0.999923 0.00326178 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 4 -4.63588e-06 -7.64472e-05 3.99943 0.0477816 0.000613416 +EDGE_SE3:QUAT 970 1056 -0.732057 1.65793 0.0856211 -0.00420997 -0.00645853 0.999968 0.00199912 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 3.99993 0.000108955 0.0168409 4.00011 0.0259032 0.000254625 +EDGE_SE3:QUAT 971 1056 -5.19194 1.75619 0.044793 -0.00874741 -0.00479608 0.99995 0.000629302 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 3.99969 0.000169024 0.0349895 4.00113 0.0192362 0.000400142 +EDGE_SE3:QUAT 1057 1058 4.34203 -0.0867559 -0.000950189 -0.00557641 0.00332662 -0.0103465 0.999925 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 4.00004 -7.42562e-05 0.0259161 3.99996 -0.000134303 3.99974 +EDGE_SE3:QUAT 968 1057 3.23597 1.66992 0.0186572 0.00203224 0.00551237 0.999965 0.00591014 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 3.99998 4.39339e-05 -0.00812975 3.99994 -0.0221438 0.000278835 +EDGE_SE3:QUAT 969 1057 -0.868927 1.70304 0.104245 0.00431121 -0.00843063 0.999943 0.00489769 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 3.99992 -0.000145948 -0.0172471 4.00002 0.0335539 0.000451779 +EDGE_SE3:QUAT 970 1057 -4.97055 1.79587 0.0746438 -0.000238748 -0.00332472 0.999988 0.00358054 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 4 2.86265e-06 0.000955024 3.99996 0.0133052 9.57674e-05 +EDGE_SE3:QUAT 1058 1059 4.3345 -0.259712 0.0615423 0.0018175 -0.0150919 -0.0689262 0.997506 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 4.00349 -0.000473856 -0.118467 3.99915 0.00407479 3.9845 +EDGE_SE3:QUAT 966 1058 6.71328 2.63634 0.172619 0.0222568 0.00839964 -0.993779 0.108801 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 3.99788 -0.000597322 0.0906505 4.00836 0.0134884 0.0494786 +EDGE_SE3:QUAT 967 1058 2.93423 1.79051 0.066485 0.00490851 0.00780845 -0.99988 0.0124093 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 3.9999 0.000151846 0.0196401 4.00016 0.0307379 0.00094863 +EDGE_SE3:QUAT 968 1058 -1.08774 1.80524 0.0388496 -0.001636 -8.39428e-05 0.999856 0.0169103 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 3.99999 1.63157e-06 0.00654679 4.00004 0.000556799 0.00115463 +EDGE_SE3:QUAT 969 1058 -5.20962 1.83752 0.147713 0.00130465 -0.0140457 0.999779 0.0155805 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 3.99999 -9.69136e-05 -0.00522278 3.99925 0.0559815 0.00176165 +EDGE_SE3:QUAT 1059 1060 4.22624 -0.732402 0.0247691 -0.000341414 -0.00422897 -0.1738 0.984772 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 4.00027 -6.73004e-05 -0.0330101 3.99994 0.00284418 3.87945 +EDGE_SE3:QUAT 965 1059 5.96536 3.0897 0.0696494 0.00865338 0.010096 -0.983706 0.179292 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 3.99951 -2.16754e-06 0.0367036 4.00149 0.0251746 0.1291 +EDGE_SE3:QUAT 966 1059 2.42205 1.95595 0.0341636 0.0066156 0.00622712 -0.999163 0.039885 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 3.9998 0.000131204 0.026529 4.00062 0.0227074 0.0066686 +EDGE_SE3:QUAT 967 1059 -1.39795 1.94302 0.0911358 0.0109538 -0.00595257 0.998343 0.0561824 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 3.99947 -0.000102903 -0.044028 4.00194 0.0187269 0.0132001 +EDGE_SE3:QUAT 968 1059 -5.39017 2.23781 0.094716 0.0134457 0.00139554 0.996231 0.0856845 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 3.99934 0.000432275 -0.0543632 4.00275 -0.0146454 0.0301652 +EDGE_SE3:QUAT 1060 1061 4.1512 -0.972752 0.00429874 0.00521249 -0.000278362 -0.223687 0.974647 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 3.99992 3.61358e-05 0.0114629 3.99998 -0.00180934 3.79989 +EDGE_SE3:QUAT 964 1060 4.8752 3.5243 0.0489865 0.00470093 0.0110244 -0.977585 0.210199 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 3.99972 0.000129305 0.0208267 4.00047 0.0317538 0.17712 +EDGE_SE3:QUAT 965 1060 1.74485 2.27491 0.0216027 0.00232514 0.0107749 -0.999923 0.00564663 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 3.99998 0.000104658 0.00930266 3.99963 0.04299 0.000611261 +EDGE_SE3:QUAT 966 1060 -1.83255 2.33493 0.0130861 -0.00107384 -0.00739959 0.990904 0.134364 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 4 -2.77476e-05 0.00426641 3.99978 0.0294035 0.0724399 +EDGE_SE3:QUAT 967 1060 -5.50984 3.13521 0.222356 0.0158933 -0.00455099 0.973353 0.228715 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 3.99917 0.00116745 -0.0687959 4.0041 -0.0117215 0.210517 +EDGE_SE3:QUAT 1061 1062 4.06471 -0.805495 0.00702686 -0.000820004 0.00186283 -0.1758 0.984424 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 4.00004 -1.61858e-05 0.012523 3.99999 -0.00102948 3.87642 +EDGE_SE3:QUAT 963 1061 3.69021 3.47565 -0.0109735 0.00179278 0.00124327 -0.981513 0.191385 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 3.99998 -7.91763e-06 0.00762388 4.00006 0.00187925 0.146528 +EDGE_SE3:QUAT 964 1061 0.662106 2.70979 0.0149426 -0.00301139 -0.00652702 0.999873 0.0142163 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 3.99997 7.66217e-05 0.0120498 3.99996 0.0264379 0.0010195 +EDGE_SE3:QUAT 965 1061 -2.40875 3.18943 0.0284182 0.000275719 -0.0056918 0.975897 0.218157 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 3.99997 -4.60357e-05 -0.00165174 3.99993 0.0196456 0.190474 +EDGE_SE3:QUAT 966 1061 -5.58147 4.38523 0.0261898 0.00112784 -0.00222806 0.935843 0.352408 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 3.99999 9.25066e-06 -0.00605066 4.00004 0.00348408 0.496782 +EDGE_SE3:QUAT 1062 1063 4.24875 -0.609744 -0.00949593 0.00435979 0.001494 -0.106265 0.994327 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 4 3.11676e-05 0.0172677 3.99998 -0.00101193 3.9549 +EDGE_SE3:QUAT 961 1062 5.31401 4.77682 0.00664707 -0.000823085 0.00199756 -0.907671 0.419678 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 4 7.54645e-06 -0.0028598 3.99999 0.00697444 0.704536 +EDGE_SE3:QUAT 962 1062 2.82187 2.97306 -0.00467363 -0.00214805 0.00605679 -0.979351 0.202065 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 4 8.44296e-06 -0.0087025 3.99985 0.0251198 0.163505 +EDGE_SE3:QUAT 963 1062 -0.378771 2.67647 -0.0172536 0.00339779 0.00258525 -0.999863 0.0159892 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 3.99995 3.14238e-05 0.0135965 4.00016 0.00990047 0.00109336 +EDGE_SE3:QUAT 964 1062 -3.31254 3.59308 0.0112761 -0.00392967 -0.00800372 0.981862 0.189388 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 4 4.01788e-05 0.0161076 3.99977 0.03492 0.143852 +EDGE_SE3:QUAT 1063 1064 4.09388 -0.241907 0.0110448 -0.00100625 -3.71153e-05 -0.0270163 0.999634 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 4 3.64877e-07 -0.000622661 4 9.87832e-06 3.99708 +EDGE_SE3:QUAT 960 1063 5.38818 3.44534 0.000161395 -0.00253858 0.00350777 -0.849368 0.527784 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 3.99998 3.02875e-05 -0.00930412 3.99994 0.0130108 1.11431 +EDGE_SE3:QUAT 961 1063 2.07894 1.91804 -0.0019494 0.00203383 -0.00147062 -0.947056 0.321059 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 4 -1.72115e-05 0.00890372 4.00001 -0.00910797 0.412358 +EDGE_SE3:QUAT 962 1063 -1.31158 1.84126 -0.00410645 -0.000635356 0.00152154 -0.995284 0.0969877 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 4 -2.4933e-06 -0.00256593 3.99999 0.00643182 0.0376386 +EDGE_SE3:QUAT 963 1063 -4.64804 3.15713 -0.0548268 -0.00462345 0.00128727 0.995879 0.0905601 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 3.99991 2.38963e-05 0.0187273 4.00035 -0.00172178 0.0328937 +EDGE_SE3:QUAT 1064 1065 4.09879 -0.0887043 0.0216813 0.00122398 -0.000799099 0.000598013 0.999999 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 4 -3.91032e-06 -0.00640157 4 -1.8962e-06 4.00001 +EDGE_SE3:QUAT 960 1064 3.34764 -0.118545 0.0167527 -0.00306464 0.00447826 -0.863365 0.50455 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 3.99998 4.5644e-05 -0.0113706 3.99991 0.016812 1.01842 +EDGE_SE3:QUAT 961 1064 -1.31628 -0.384085 -0.00243648 0.00191145 -0.000570616 -0.955382 0.295366 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 4 -2.01919e-05 0.00846163 4.00003 -0.00592281 0.348993 +EDGE_SE3:QUAT 962 1064 -5.39346 1.31409 0.00965124 -0.000583075 0.00284847 -0.997566 0.0696684 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 4 -2.26975e-06 -0.00234153 3.99997 0.0115792 0.0194498 +EDGE_SE3:QUAT 1065 1066 4.31926 -0.0780797 0.0186118 -0.000958321 -0.00176911 -0.00435872 0.999988 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 4.00005 6.48437e-06 -0.0142028 3.99999 3.09177e-05 3.99997 +EDGE_SE3:QUAT 959 1065 6.56846 -2.39977 0.0886956 0.00328167 -0.00291021 -0.760535 0.649282 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 3.99998 3.19926e-05 0.0120281 3.99995 -0.0112483 1.68637 +EDGE_SE3:QUAT 960 1065 1.25117 -3.63171 0.0429258 -0.00313145 0.00277575 -0.863001 0.505185 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 4 2.72289e-06 -0.0134646 3.99995 0.0141167 1.02096 +EDGE_SE3:QUAT 961 1065 -4.74118 -2.60393 0.0119032 0.00131571 -0.00217972 -0.955236 0.295834 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 4 -2.03445e-07 0.00545578 3.99998 -0.00971213 0.350105 +EDGE_SE3:QUAT 1066 1067 3.98717 -0.308611 -0.000251049 -0.00203295 0.0121314 -0.0923911 0.995647 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 4.00217 -0.00040398 0.0936129 3.99949 -0.0042838 3.96804 +EDGE_SE3:QUAT 960 1066 -0.924988 -7.35882 0.0787189 -0.005123 0.0026753 -0.865387 0.501072 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 4.00004 -7.16857e-05 -0.0239475 3.99998 0.0199905 1.00457 +EDGE_SE3:QUAT 1067 1068 4.06434 -0.843384 0.00828126 -0.00127831 0.00123911 -0.217279 0.976108 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 4 -6.8504e-06 0.00599116 4 -0.000504015 3.81117 +EDGE_SE3:QUAT 1068 1069 3.97144 -0.949047 0.00868671 -0.00126367 6.76613e-06 -0.21835 0.97587 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 4 2.19339e-06 -0.00315552 4 0.000465001 3.8093 +EDGE_SE3:QUAT 427 1068 1.73308 -6.95276 0.0413465 -0.00714069 0.00147709 0.677079 0.735874 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 4.0003 0.000305027 0.0450013 4.00005 0.0196069 2.16676 +EDGE_SE3:QUAT 1069 1070 3.9968 -0.710154 0.00438339 0.00446924 -8.88408e-05 -0.142882 0.98973 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 3.99993 1.96458e-05 0.00686945 3.99999 -0.000673686 3.91835 +EDGE_SE3:QUAT 427 1069 3.04002 -3.09139 0.0138332 -0.00821482 -0.00103618 0.500191 0.865875 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 4.00002 -6.05402e-05 0.035703 3.99987 0.0132004 2.99953 +EDGE_SE3:QUAT 428 1069 -2.26839 -3.12038 0.0190507 -0.005755 0.00139934 0.376328 0.926468 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 4.00012 3.67787e-06 0.0324396 3.99993 0.00754987 3.43377 +EDGE_SE3:QUAT 429 1069 -6.85472 -2.27828 -0.227969 -0.00997877 -0.016252 0.296837 0.954738 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 4.00108 0.00125486 -0.0797431 3.99999 -0.00922781 3.64903 +EDGE_SE3:QUAT 1070 1071 3.99185 -0.419401 -0.0284696 0.00141981 0.0139129 -0.0770139 0.996932 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 4.00311 -0.000281251 0.111698 3.99924 -0.0043074 3.97939 +EDGE_SE3:QUAT 427 1070 5.62787 0.037958 0.000461746 -0.00405566 -0.00022232 0.370876 0.928674 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 3.99998 -2.32918e-05 0.0149701 3.99998 0.00390529 3.44986 +EDGE_SE3:QUAT 428 1070 1.10314 -0.851045 -0.000321507 -0.00167395 0.00205488 0.240179 0.970725 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 4.00009 1.5997e-05 0.0196767 3.99998 0.00249624 3.76935 +EDGE_SE3:QUAT 429 1070 -3.16275 -0.61454 -0.103944 -0.00323137 -0.0162573 0.157616 0.987361 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 4.00351 0.00107313 -0.119316 3.99926 -0.00915515 3.90418 +EDGE_SE3:QUAT 1071 1072 4.27731 -0.2369 0.00871919 -0.000874412 0.0042884 -0.0259605 0.999653 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 4.00029 -2.61282e-05 0.0340024 3.99993 -0.000440496 3.99759 +EDGE_SE3:QUAT 428 1071 4.84716 0.653917 -0.04126 -0.00389815 0.0159363 0.164218 0.986288 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 4.00416 0.00079053 0.130033 3.99905 0.0107483 3.89635 +EDGE_SE3:QUAT 429 1071 0.758991 0.244937 0.0032844 -0.00291809 -0.00253938 0.0806271 0.996737 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 4.00004 3.35764e-05 -0.0173062 3.99998 -0.00065745 3.97407 +EDGE_SE3:QUAT 430 1071 -3.66019 0.369061 -0.0364414 -0.000849653 -0.00456264 0.0486921 0.998803 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 4.00032 3.88702e-05 -0.0358781 3.99992 -0.000869008 3.99084 +EDGE_SE3:QUAT 1072 1073 4.02493 -0.0848876 0.0341119 -0.00172132 -0.00334485 -0.000780331 0.999993 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 4.00017 2.28424e-05 -0.0267758 3.99996 9.98764e-06 4.00018 +EDGE_SE3:QUAT 429 1072 5.01784 0.700991 0.0302949 -0.00405061 0.00173361 0.0547743 0.998489 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 4 -2.99088e-05 0.0164635 3.99998 0.000474252 3.98807 +EDGE_SE3:QUAT 430 1072 0.610632 0.550929 0.0119337 -0.00193642 -0.000443567 0.0227944 0.999738 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 3.99999 2.83251e-06 -0.00301627 4 -3.23613e-05 3.99792 +EDGE_SE3:QUAT 431 1072 -3.54424 0.651623 0.0401101 0.00197332 0.00649792 0.0172245 0.999829 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 4.00065 6.79884e-05 0.0515596 3.99984 0.000444976 3.99948 +EDGE_SE3:QUAT 1073 1074 4.19879 -0.0659609 0.0025063 -0.0021971 -0.00393127 0.00128867 0.999989 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 4.00023 3.49841e-05 -0.0314176 3.99994 -2.10529e-05 4.00024 +EDGE_SE3:QUAT 430 1073 4.61117 0.657166 0.0474718 -0.00323669 -0.0037376 0.0217236 0.999752 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 4.00017 5.34929e-05 -0.029037 3.99995 -0.000313342 3.99832 +EDGE_SE3:QUAT 431 1073 0.464953 0.705535 0.0200551 0.000531283 0.00289121 0.0161626 0.999865 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 4.00013 9.32384e-06 0.0230182 3.99997 0.000185837 3.99909 +EDGE_SE3:QUAT 432 1073 -3.79914 0.809436 0.047742 0.00227455 0.004249 0.0118484 0.999918 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 4.00026 4.32233e-05 0.0336633 3.99993 0.000199783 3.99972 +EDGE_SE3:QUAT 1074 1075 4.16492 -0.0928737 0.0210239 2.44605e-05 -0.00939376 7.23347e-05 0.999956 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 4.00141 -7.66982e-07 -0.0751733 3.99965 -2.66952e-06 4.00141 +EDGE_SE3:QUAT 431 1074 4.635 0.769525 -0.00190242 -0.00159773 -0.00117692 0.0177019 0.999841 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 4.00001 7.71115e-06 -0.00907164 3.99999 -7.93296e-05 3.99877 +EDGE_SE3:QUAT 432 1074 0.369107 0.828383 0.0109331 -0.000125001 1.75979e-05 0.0132194 0.999913 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 4 -1.03272e-08 0.000160573 4 1.10494e-06 3.9993 +EDGE_SE3:QUAT 433 1074 -3.99514 0.94273 0.0613642 -0.00020225 0.00874715 0.00834676 0.999927 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 4.00122 8.25203e-06 0.0700089 3.99969 0.000292055 4.00095 +EDGE_SE3:QUAT 1075 1076 4.18749 -0.107213 0.010419 0.0040416 0.00787455 -0.002438 0.999958 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 4.00093 0.000124088 0.0631263 3.99975 -7.10144e-05 4.00097 +EDGE_SE3:QUAT 432 1075 4.53912 0.841467 0.0332081 0.000207336 -0.00911112 0.0133207 0.99987 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 4.00133 1.89927e-05 -0.0729239 3.99967 -0.000485739 4.00062 +EDGE_SE3:QUAT 433 1075 0.176288 0.926916 0.0106986 0.000170938 -0.000469959 0.00853007 0.999963 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 4 -2.77746e-07 -0.00377676 4 -1.61314e-05 3.99971 +EDGE_SE3:QUAT 434 1075 -4.25822 1.04408 -0.084825 -0.00408401 -0.00868045 0.00391002 0.999946 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 4.00113 0.000148465 -0.0692668 3.9997 -0.000142753 4.00114 +EDGE_SE3:QUAT 1076 1077 4.24278 -0.107816 0.031745 0.00229147 0.000273432 -0.00179629 0.999996 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 3.99998 2.57833e-06 0.00223682 4 -2.01951e-06 3.99999 +EDGE_SE3:QUAT 433 1076 4.36067 0.885717 0.0273361 0.00429581 0.00757901 0.00596555 0.999944 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 4.00084 0.000137601 0.0603316 3.99977 0.000185629 4.00077 +EDGE_SE3:QUAT 434 1076 -0.0654207 0.965271 0.00806316 -0.000270492 -0.000844226 0.00177503 0.999998 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 4.00001 9.42712e-07 -0.00674803 4 -5.99193e-06 4 +EDGE_SE3:QUAT 435 1076 -4.36258 1.07348 -0.0320563 -0.00104858 -0.00110942 -0.00128213 0.999998 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 4.00002 4.62658e-06 -0.00889147 4 5.67245e-06 4.00001 +EDGE_SE3:QUAT 1077 1078 4.16351 -0.102304 0.0203391 0.000900847 -0.00229668 -0.000945529 0.999997 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 4.00008 -8.38987e-06 -0.0183635 3.99998 8.79443e-06 4.00008 +EDGE_SE3:QUAT 434 1077 4.1641 0.881288 0.0408726 0.00224945 -0.000516126 -7.97277e-05 0.999997 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 3.99998 -4.64125e-06 -0.00412683 4 1.78852e-07 4 +EDGE_SE3:QUAT 435 1077 -0.133626 0.95471 0.00855681 0.00122352 -0.000784413 -0.00319418 0.999994 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 4 -3.84729e-06 -0.00622831 4 9.94008e-06 3.99997 +EDGE_SE3:QUAT 436 1077 -4.3298 1.06624 -0.0125219 0.000605817 0.00117405 -0.00678405 0.999976 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 4.00002 2.6385e-06 0.00944109 3.99999 -3.20597e-05 3.99984 +EDGE_SE3:QUAT 1078 1079 4.09612 -0.0929668 -0.0176591 -0.000876647 0.00285223 -0.000921164 0.999995 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 4.00013 -1.01768e-05 0.0228088 3.99997 -1.06757e-05 4.00013 +EDGE_SE3:QUAT 435 1078 4.03173 0.830445 0.0358686 0.00180173 -0.00313272 -0.00412861 0.999985 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 4.00014 -2.34392e-05 -0.0249726 3.99996 5.19164e-05 4.00009 +EDGE_SE3:QUAT 436 1078 -0.154691 0.915587 0.00288332 0.00119313 -0.0012668 -0.0076699 0.999969 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 4.00002 -6.24832e-06 -0.0100238 3.99999 3.83449e-05 3.99979 +EDGE_SE3:QUAT 437 1078 -4.36023 1.0187 0.00709405 0.0015212 -0.00243427 -0.0101582 0.999944 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 4.00008 -1.60452e-05 -0.0192861 3.99998 9.78559e-05 3.99968 +EDGE_SE3:QUAT 1079 1080 4.2802 -0.0911054 0.0155852 -0.00120316 0.00796807 -0.000120748 0.999968 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 4.00101 -3.8564e-05 0.0637568 3.99975 -5.68558e-06 4.00102 +EDGE_SE3:QUAT 436 1079 3.92587 0.759771 -0.00192881 0.000192802 0.0017179 -0.00869688 0.999961 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 4.00005 7.09989e-07 0.0137619 3.99999 -5.98578e-05 3.99974 +EDGE_SE3:QUAT 437 1079 -0.278321 0.845211 0.0104774 0.000500919 0.000502362 -0.011138 0.999938 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 4 9.59476e-07 0.0040851 4 -2.28698e-05 3.99951 +EDGE_SE3:QUAT 438 1079 -4.49818 0.94828 -0.0624951 0.00241895 -0.00718214 -0.0136446 0.999878 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 4.00079 -8.55863e-05 -0.0570546 3.9998 0.000391477 4.00007 +EDGE_SE3:QUAT 1080 1081 3.99168 -0.0966537 0.0378237 -0.000189351 -0.000623147 -0.000463177 1 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 4.00001 4.6779e-07 -0.00498624 4 1.15308e-06 4.00001 +EDGE_SE3:QUAT 437 1080 3.99424 0.646307 0.0229772 -0.000416587 0.00832661 -0.0117112 0.999897 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 4.00111 -3.33305e-05 0.0665567 3.99972 -0.000390564 4.00056 +EDGE_SE3:QUAT 438 1080 -0.220882 0.732697 0.0169527 0.00144309 0.000585306 -0.0141421 0.999899 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 4 3.48696e-06 0.0049259 4 -3.53924e-05 3.99921 +EDGE_SE3:QUAT 439 1080 -4.51254 0.836465 -0.0200899 0.000830074 0.00102073 -0.0161235 0.999869 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 4.00001 3.06087e-06 0.00832325 4 -6.75024e-05 3.99898 +EDGE_SE3:QUAT 1081 1082 4.38003 -0.079376 0.0261833 -0.00158201 -0.00616397 0.000127802 0.99998 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 4.0006 3.91403e-05 -0.0493157 3.99985 -4.59526e-06 4.00061 +EDGE_SE3:QUAT 438 1081 3.77093 0.532376 0.042684 0.00134593 -7.1671e-05 -0.0139921 0.999901 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 3.99999 -1.83775e-07 -0.000347239 4 1.90197e-06 3.99922 +EDGE_SE3:QUAT 439 1081 -0.523084 0.621582 0.00733803 0.00074898 0.000447879 -0.0164863 0.999864 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 4 1.33054e-06 0.00372972 4 -3.1144e-05 3.99892 +EDGE_SE3:QUAT 440 1081 -4.61082 0.73482 0.0404555 0.00232513 0.00601653 -0.022296 0.999731 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 4.00057 3.71471e-05 0.0487242 3.99985 -0.000543505 3.9986 +EDGE_SE3:QUAT 1082 1083 4.08606 -0.0883322 0.0144926 0.00120172 -0.00681027 0.000279446 0.999976 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 4.00074 -3.24495e-05 -0.0544949 3.99981 -6.27998e-06 4.00074 +EDGE_SE3:QUAT 439 1082 3.84011 0.397086 0.0321308 -0.000978845 -0.00556691 -0.0159022 0.999858 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 4.0005 1.00157e-05 -0.04471 3.99987 0.000355328 3.99949 +EDGE_SE3:QUAT 440 1082 -0.246383 0.450733 0.0112491 0.000815339 -4.11769e-05 -0.0212606 0.999774 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 4 -2.13476e-08 -0.000121239 4 5.50935e-07 3.99819 +EDGE_SE3:QUAT 441 1082 -4.29812 0.538641 0.0579573 -0.00110013 0.00721333 -0.0231411 0.999706 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 4.00082 -6.01464e-05 0.0573651 3.9998 -0.00066411 3.99868 +EDGE_SE3:QUAT 1083 1084 4.32642 -0.124728 -0.0130855 0.00211899 0.00169766 -0.0122429 0.999921 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 4.00003 1.39481e-05 0.0138895 3.99999 -8.55039e-05 3.99945 +EDGE_SE3:QUAT 440 1083 3.81625 0.185891 0.0283443 0.00158256 -0.00679273 -0.0213113 0.999749 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 4.00072 -6.58735e-05 -0.0539085 3.99982 0.000574867 3.99891 +EDGE_SE3:QUAT 441 1083 -0.233423 0.254379 0.00892645 -6.14049e-05 0.000435799 -0.0229125 0.999737 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 4 -2.0979e-07 0.00346677 4 -3.96416e-05 3.9979 +EDGE_SE3:QUAT 442 1083 -4.47951 0.221603 -0.000238588 -0.00194655 -0.0017759 -0.000110536 0.999997 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 4.00004 1.3823e-05 -0.0142099 3.99999 6.38041e-07 4.00005 +EDGE_SE3:QUAT 1084 1085 4.34214 -0.335504 0.00635974 -0.00316001 0.0182788 -0.0846033 0.996242 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 4.00497 -0.000869724 0.14162 3.99881 -0.00596778 3.97638 +EDGE_SE3:QUAT 441 1084 4.08743 -0.0473747 0.00112932 0.00192186 0.00196947 -0.0348782 0.999388 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 4.00005 1.26319e-05 0.0165309 3.99998 -0.000292611 3.9952 +EDGE_SE3:QUAT 442 1084 -0.142222 0.105781 0.00765942 0.000158031 -0.000104766 -0.0119258 0.999929 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 4 -6.68343e-08 -0.000815336 4 4.81651e-06 3.99943 +EDGE_SE3:QUAT 443 1084 -4.16298 -0.0903312 -0.164787 0.00081267 -0.0182727 0.0426755 0.998922 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 4.00535 0.000283217 -0.14637 3.99867 -0.00312776 3.99806 +EDGE_SE3:QUAT 1085 1086 4.02888 -0.610589 0.0143941 -0.00382369 -0.00346396 -0.150267 0.988632 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 4.00022 8.59431e-06 -0.0335712 3.99993 0.00266993 3.90996 +EDGE_SE3:QUAT 442 1085 4.19212 -0.349598 0.0132371 -0.00259121 0.0181466 -0.0967538 0.99514 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 4.00489 -0.000908647 0.140295 3.99885 -0.00674766 3.96747 +EDGE_SE3:QUAT 443 1085 0.203127 -0.0614578 0.00492479 -0.00169984 -0.000113072 -0.0420639 0.999113 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 3.99999 1.69882e-06 -0.00175918 4 4.29959e-05 3.99292 +EDGE_SE3:QUAT 444 1085 -3.97724 -0.6025 0.00827168 0.00361889 0.0033912 0.0850113 0.996368 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 4.00008 5.79939e-05 0.0231621 3.99997 0.000928903 3.97123 +EDGE_SE3:QUAT 1086 1087 4.01973 -0.733205 0.00275496 0.00162603 0.000449958 -0.169856 0.985467 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 4 3.96451e-06 0.00669555 4 -0.000657899 3.88461 +EDGE_SE3:QUAT 443 1086 4.1403 -1.02053 0.0215629 -0.00561261 -0.00352099 -0.191607 0.981449 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 4.00026 2.1557e-05 -0.0392225 3.9999 0.00411642 3.85353 +EDGE_SE3:QUAT 444 1086 0.0874594 -0.528011 -0.0073582 -0.000550534 -0.000174978 -0.0653829 0.99786 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 4 4.66903e-07 -0.00182158 4 6.41582e-05 3.9829 +EDGE_SE3:QUAT 445 1086 -3.81564 -1.19368 -0.0130842 -0.00362729 0.000555836 0.114741 0.993389 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 3.99997 -1.69237e-05 0.00930963 3.99999 0.000627814 3.94736 +EDGE_SE3:QUAT 1087 1088 3.96541 -0.714703 0.00498852 0.00444703 0.00346646 -0.168585 0.985671 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 4.00023 1.16262e-05 0.0353857 3.99992 -0.00320007 3.88663 +EDGE_SE3:QUAT 398 1087 4.82273 4.61626 0.0413481 0.00348524 0.00925884 -0.939603 0.342124 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 3.99978 -4.61291e-05 0.0191306 4.00049 0.0182339 0.468417 +EDGE_SE3:QUAT 399 1087 0.659575 4.73617 0.0202429 -0.000147213 0.0103422 -0.936852 0.349573 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 3.99985 0.000147502 0.00284857 3.99992 0.029648 0.489079 +EDGE_SE3:QUAT 400 1087 -3.64153 4.79127 0.0145975 -0.00115505 0.0113365 -0.933263 0.359012 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 3.99984 0.000199734 -0.0012257 3.99979 0.0343024 0.51592 +EDGE_SE3:QUAT 444 1087 3.98615 -1.7909 -0.000147023 0.00119303 0.000329103 -0.233842 0.972274 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 4 1.74629e-06 0.00564559 4 -0.000781587 3.78128 +EDGE_SE3:QUAT 445 1087 0.263984 -1.00263 -0.0090407 -0.00209331 0.000576298 -0.0555163 0.998455 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 3.99998 -3.10904e-06 0.00319737 4 -7.56618e-05 3.98767 +EDGE_SE3:QUAT 446 1087 -3.44066 -1.82261 -0.0458469 -0.00245309 -0.00278249 0.187734 0.982213 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 4.00004 3.74778e-05 -0.015697 3.99999 -0.00126317 3.85908 +EDGE_SE3:QUAT 447 1087 -6.05084 -4.41185 -0.214324 -0.00540554 -0.0172819 0.439429 0.898095 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 4.00108 0.00152242 -0.0753564 4.00038 -0.0111871 3.2288 +EDGE_SE3:QUAT 1088 1089 4.08461 -0.751881 -0.0261016 0.00432918 0.00855619 -0.144821 0.989411 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 4.00128 -0.000125489 0.0737471 3.99967 -0.00546475 3.91747 +EDGE_SE3:QUAT 397 1088 5.4563 2.52158 -0.0211677 -0.00733807 0.00988411 -0.983322 0.181457 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 3.99997 -0.000241679 -0.0302991 3.99989 0.0466243 0.132499 +EDGE_SE3:QUAT 398 1088 1.32006 2.61 0.00996073 0.00666266 0.0067281 -0.983853 0.17873 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 3.99973 -3.31303e-05 0.0282024 4.00087 0.0155692 0.128048 +EDGE_SE3:QUAT 399 1088 -2.80025 2.6767 0.0162931 0.00333521 0.00741342 -0.98244 0.186399 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 3.99988 6.85645e-05 0.0144019 4.00021 0.022311 0.139165 +EDGE_SE3:QUAT 445 1088 4.12448 -2.15644 -0.00562252 0.00249391 0.00360981 -0.22316 0.974772 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 4.00025 -4.60976e-05 0.0332071 3.99994 -0.00386971 3.80107 +EDGE_SE3:QUAT 446 1088 0.507986 -1.02911 -0.0050092 0.00190308 0.00105039 0.0195033 0.999807 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 4 7.89924e-06 0.00795301 4 7.61386e-05 3.99849 +EDGE_SE3:QUAT 447 1088 -3.06554 -1.72121 -0.0819856 -7.74713e-05 -0.0126494 0.281632 0.959439 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 4.00197 0.000927905 -0.0891846 3.99974 -0.0119673 3.68471 +EDGE_SE3:QUAT 448 1088 -5.86515 -4.12096 -0.11715 -0.00030378 -0.0147299 0.523637 0.851814 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 4.00108 0.00143508 -0.0713032 4.00051 -0.0133966 2.90429 +EDGE_SE3:QUAT 1089 1090 4.20239 -0.328984 0.00960138 0.000179818 -0.000342203 -0.0399362 0.999202 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 4 -3.41522e-07 -0.002645 4 5.21988e-05 3.99362 +EDGE_SE3:QUAT 396 1089 5.60501 1.72245 0.0282528 0.00351942 0.00331303 -0.999162 0.0406362 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 3.99994 3.69155e-05 0.0141143 4.00018 0.012056 0.0066915 +EDGE_SE3:QUAT 397 1089 1.39714 1.7731 0.0126018 0.000545915 0.00606841 -0.999282 0.0373816 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 4 2.36314e-05 0.00219095 3.99987 0.0240255 0.00573525 +EDGE_SE3:QUAT 398 1089 -2.74621 1.88055 -0.0744064 0.0148116 0.00487255 -0.999296 0.0341309 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 3.99909 0.000111149 0.059345 4.00352 0.0154115 0.00560078 +EDGE_SE3:QUAT 399 1089 -6.82459 1.89105 -0.0398589 0.0113389 0.00499756 -0.999028 0.0422976 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 3.99945 9.88263e-05 0.0454773 4.00206 0.0160818 0.00773916 +EDGE_SE3:QUAT 446 1089 4.5979 -1.62826 -0.0463891 0.00576192 0.0100786 -0.125537 0.992021 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 4.00177 -9.13993e-05 0.0873535 3.99953 -0.00561473 3.93887 +EDGE_SE3:QUAT 447 1089 0.776785 -0.159649 2.2453e-05 0.00345976 -0.00317009 0.139552 0.990204 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 4.00018 -1.02123e-05 -0.0303433 3.99994 -0.00223363 3.92233 +EDGE_SE3:QUAT 448 1089 -3.34227 -0.822391 -0.0326321 0.000912933 -0.0053452 0.394715 0.918788 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 4.00033 0.00021769 -0.0370458 3.99999 -0.00685729 3.37714 +EDGE_SE3:QUAT 1090 1091 4.01151 -0.0907592 0.0153248 -0.000597843 -0.00059292 0.00136985 0.999999 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 4 1.4255e-06 -0.00473352 4 -3.24491e-06 4 +EDGE_SE3:QUAT 395 1090 5.61935 1.66098 0.0292263 0.00404663 0.00181731 -0.99998 0.00454356 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 3.99993 2.77471e-05 0.016187 4.00025 0.00712241 0.000160764 +EDGE_SE3:QUAT 396 1090 1.4012 1.7055 0.00771806 0.00297995 0.00309034 -0.999991 0.00071553 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 3.99996 3.6742e-05 0.0119199 4.0001 0.0123448 7.56665e-05 +EDGE_SE3:QUAT 397 1090 -2.81793 1.78794 0.0177078 -4.27049e-05 -0.00571417 0.999979 0.00298613 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 4 1.9605e-07 0.000170825 3.99987 0.0228568 0.000166289 +EDGE_SE3:QUAT 398 1090 -6.94527 1.92921 -0.192054 -0.0142741 -0.00517247 0.999869 0.00569077 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 3.99919 0.000322632 0.0570962 4.00313 0.0213617 0.00105867 +EDGE_SE3:QUAT 447 1090 4.88527 0.685989 0.0398844 0.00387468 -0.00319785 0.0998059 0.994994 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 4.00016 -2.91525e-05 -0.0298122 3.99994 -0.00155747 3.96038 +EDGE_SE3:QUAT 448 1090 -0.223622 1.98647 0.029832 0.00167639 -0.00543118 0.357352 0.933953 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 4.00043 0.000220892 -0.0419791 3.99996 -0.00738224 3.48964 +EDGE_SE3:QUAT 449 1090 -5.29209 0.692214 0.00231794 0.00272968 -0.00515083 0.565174 0.824951 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 4.00031 0.000317568 -0.037709 4.00009 -0.0099628 2.72265 +EDGE_SE3:QUAT 790 1090 1.0822 6.76285 0.149989 0.00791609 0.0053224 -0.485947 0.873936 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 4.00088 -0.000503928 0.0673379 3.99991 -0.018533 3.05655 +EDGE_SE3:QUAT 1091 1092 4.08371 -0.0848911 0.0108499 0.00112504 -0.00261675 0.00256323 0.999993 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 4.0001 -1.13804e-05 -0.0209689 3.99997 -2.67053e-05 4.00008 +EDGE_SE3:QUAT 394 1091 5.86526 1.64972 0.0505201 0.00573226 0.00434996 -0.999913 0.0110956 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 3.99986 9.25169e-05 0.0229335 4.00046 0.0168887 0.000695258 +EDGE_SE3:QUAT 395 1091 1.59165 1.70704 0.0117358 0.00332078 0.00239482 -0.999975 0.00584417 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 3.99996 3.05194e-05 0.0132839 4.00016 0.00942376 0.000202936 +EDGE_SE3:QUAT 396 1091 -2.60429 1.79573 0.000355711 0.00237733 0.00385514 -0.999988 0.00210049 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 3.99998 3.66239e-05 0.00950956 4.00003 0.0153808 9.93979e-05 +EDGE_SE3:QUAT 397 1091 -6.84326 1.90343 0.0332484 0.000729993 -0.00651927 0.999977 0.00159112 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 4 -1.95545e-05 -0.00292017 3.99984 0.0260671 0.00018214 +EDGE_SE3:QUAT 448 1091 2.83858 4.60612 0.0920251 0.00131387 -0.00634767 0.358498 0.933508 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 4.00053 0.000292396 -0.0464866 3.99996 -0.00802733 3.48645 +EDGE_SE3:QUAT 449 1091 -3.75311 4.38923 0.0678432 0.00264643 -0.00616438 0.566252 0.824205 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 4.00038 0.000413287 -0.0417557 4.00013 -0.0106081 2.71784 +EDGE_SE3:QUAT 790 1091 3.11658 3.30922 0.0925983 0.00692553 0.00504389 -0.484628 0.874678 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 4.00074 -0.000429982 0.0609888 3.99993 -0.0165699 3.06147 +EDGE_SE3:QUAT 791 1091 -2.80313 3.3745 0.0908719 0.00497537 0.00640947 -0.270192 0.962772 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 4.00083 -0.00020559 0.0611235 3.99981 -0.00871314 3.70892 +EDGE_SE3:QUAT 1092 1093 4.05577 -0.073412 0.0158212 -0.00038164 0.00351124 0.00284885 0.99999 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 4.0002 -4.52068e-06 0.0281038 3.99995 3.99301e-05 4.00016 +EDGE_SE3:QUAT 393 1092 5.99019 1.57384 0.0178527 0.00156391 0.00406672 -0.999816 0.0186617 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 3.99999 2.66689e-05 0.00625927 3.99998 0.0160194 0.00146701 +EDGE_SE3:QUAT 394 1092 1.79079 1.65037 0.00810308 0.00316644 0.00333662 -0.999897 0.0135613 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 3.99996 4.00863e-05 0.0126695 4.00012 0.0129975 0.000818017 +EDGE_SE3:QUAT 395 1092 -2.44984 1.73874 -0.00131817 0.000711589 0.00135324 -0.999961 0.00865218 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 4 3.86877e-06 0.00284669 4 0.00536269 0.000308657 +EDGE_SE3:QUAT 396 1092 -6.69404 1.86943 -0.00587626 -0.000456636 0.00305563 -0.999986 0.00427994 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 4 -5.28127e-06 -0.00182662 3.99997 0.0122375 0.000111546 +EDGE_SE3:QUAT 790 1092 5.19889 -0.195502 0.036638 0.00663955 0.00231739 -0.482508 0.875863 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 4.00033 -0.000141644 0.0449393 3.99991 -0.0132211 3.06925 +EDGE_SE3:QUAT 791 1092 0.66532 1.14897 0.0344886 0.00472534 0.00360079 -0.26783 0.963448 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 4.00031 -4.41864e-05 0.040227 3.9999 -0.00591579 3.71347 +EDGE_SE3:QUAT 792 1092 -4.06601 0.237449 -0.032584 0.00598731 -0.00366057 -0.00705676 0.99995 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 4.00006 -8.78533e-05 -0.0287751 3.99995 0.000102816 4.00001 +EDGE_SE3:QUAT 1093 1094 4.11887 -0.077797 0.0209957 -0.000939877 -0.00237045 0.00311322 0.999992 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 4.00009 9.30887e-06 -0.0189286 3.99998 -2.95741e-05 4.00005 +EDGE_SE3:QUAT 392 1093 6.16589 1.43207 0.039338 0.00541633 0.00482312 -0.999692 0.0237344 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 3.99987 9.1305e-05 0.0216844 4.00041 0.0182403 0.00245413 +EDGE_SE3:QUAT 393 1093 1.94117 1.50626 0.0161708 0.005268 0.0047136 -0.999736 0.0218587 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 3.99988 8.79324e-05 0.0210878 4.00038 0.0179137 0.0021027 +EDGE_SE3:QUAT 394 1093 -2.27467 1.60768 -0.00174472 0.00672538 0.00377547 -0.999837 0.016345 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 3.99981 8.53192e-05 0.0269122 4.00069 0.0142161 0.00130028 +EDGE_SE3:QUAT 395 1093 -6.49676 1.75987 0.00400629 0.00436882 0.00187739 -0.999919 0.0118439 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 3.99992 2.76523e-05 0.0174789 4.0003 0.00709377 0.000650086 +EDGE_SE3:QUAT 791 1093 4.09784 -1.00414 0.0158946 0.00549483 0.00721172 -0.265053 0.964191 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 4.00105 -0.00025186 0.0683979 3.99975 -0.00954899 3.72016 +EDGE_SE3:QUAT 792 1093 -0.0170639 0.0973809 0.0120997 0.00563383 -0.000134094 -0.00402789 0.999976 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 3.99987 -1.99994e-06 -0.000800376 4 1.43062e-06 3.99994 +EDGE_SE3:QUAT 793 1093 -3.97498 -0.973505 -0.0209104 0.000575289 -0.00196855 0.260967 0.965345 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 4.00006 2.08874e-05 -0.0158873 3.99999 -0.00207765 3.72765 +EDGE_SE3:QUAT 1094 1095 4.40634 -0.0867326 0.0185724 0.000470803 0.000806955 0.0035779 0.999993 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 4.00001 1.56894e-06 0.00643531 4 1.15077e-05 3.99996 +EDGE_SE3:QUAT 391 1094 6.25307 1.21958 0.0334673 0.00447909 0.00418488 -0.999599 0.0276559 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 3.99991 6.46445e-05 0.0179378 4.00028 0.015719 0.00320172 +EDGE_SE3:QUAT 392 1094 2.04732 1.31737 0.0133066 0.00301087 0.0056904 -0.999611 0.0271402 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 3.99996 6.88415e-05 0.0120582 4.00004 0.0220673 0.00310457 +EDGE_SE3:QUAT 393 1094 -2.20699 1.39932 -0.00899668 0.00286528 0.00551307 -0.999688 0.0241898 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 3.99996 6.37047e-05 0.0114722 4.00003 0.0214666 0.00248878 +EDGE_SE3:QUAT 394 1094 -6.38171 1.56344 -0.0395562 0.00449191 0.0045247 -0.999791 0.019445 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 3.99991 7.45968e-05 0.0179784 4.00026 0.017385 0.00166886 +EDGE_SE3:QUAT 792 1094 4.11447 -0.0155583 0.0384141 0.00497203 -0.00263393 -0.0011816 0.999983 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 4.00001 -5.23483e-05 -0.0210006 3.99997 1.32176e-05 4.0001 +EDGE_SE3:QUAT 793 1094 -0.366821 1.0433 0.0152911 0.000509573 -0.00463182 0.263606 0.964619 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 4.0003 0.000118751 -0.0347997 3.99995 -0.00447949 3.72235 +EDGE_SE3:QUAT 794 1094 -4.98174 -0.457191 0.0231943 0.00243171 -0.00327001 0.517209 0.855849 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 4.00018 0.000142466 -0.0288023 4.00002 -0.00760039 2.93018 +EDGE_SE3:QUAT 1095 1096 4.26434 -0.0956191 0.0252613 -0.000255038 -0.00216105 -0.00812501 0.999965 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 4.00007 1.29605e-06 -0.0173119 3.99998 7.03356e-05 3.99981 +EDGE_SE3:QUAT 338 1095 1.24413 5.86126 0.151804 0.00995553 0.00678625 -0.425736 0.904767 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 4.00141 -0.000610268 0.0849695 3.99974 -0.0204308 3.2768 +EDGE_SE3:QUAT 339 1095 -5.18919 5.08073 0.0917498 0.00598524 0.00653922 -0.231724 0.972741 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 4.00089 -0.000134714 0.0642182 3.99976 -0.00790868 3.78625 +EDGE_SE3:QUAT 390 1095 6.12967 0.958869 0.0488339 0.00671092 0.00467624 -0.99949 0.030866 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 3.99981 9.57618e-05 0.026883 4.00068 0.017009 0.00406409 +EDGE_SE3:QUAT 391 1095 1.8701 1.06448 0.0176908 0.00538769 0.00363208 -0.999492 0.0312046 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 3.99987 5.86641e-05 0.021583 4.00044 0.0131514 0.00405478 +EDGE_SE3:QUAT 392 1095 -2.37314 1.16258 0.00502958 0.00394215 0.00514481 -0.999523 0.0302017 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 3.99993 7.50827e-05 0.0157917 4.00017 0.0195823 0.00380692 +EDGE_SE3:QUAT 393 1095 -6.61074 1.28255 -0.0141308 0.00372064 0.00491079 -0.999593 0.0278507 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 3.99994 6.83058e-05 0.0149011 4.00015 0.0187781 0.00324643 +EDGE_SE3:QUAT 793 1095 3.48444 3.21749 0.0789924 0.000773214 -0.00381114 0.266811 0.963741 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 4.00022 8.09364e-05 -0.0296516 3.99996 -0.00391326 3.71547 +EDGE_SE3:QUAT 794 1095 -2.85856 3.4153 0.0804746 0.00259012 -0.00235109 0.519841 0.854256 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 4.00013 9.21177e-05 -0.024973 4 -0.00703038 2.91922 +EDGE_SE3:QUAT 1096 1097 4.31549 -0.285742 0.0287451 0.000937185 0.000964811 -0.0671438 0.997742 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 4.00001 2.33174e-06 0.00841922 4 -0.000290492 3.98198 +EDGE_SE3:QUAT 338 1096 3.8648 2.53309 0.0875073 0.00880972 0.00495701 -0.432926 0.901373 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 4.00088 -0.000362911 0.0691138 3.99981 -0.0172731 3.25149 +EDGE_SE3:QUAT 339 1096 -1.41089 3.06034 0.0540213 0.00500088 0.00468053 -0.239453 0.970884 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 4.00048 -6.43633e-05 0.0480963 3.99986 -0.00619467 3.77123 +EDGE_SE3:QUAT 340 1096 -6.81057 0.951257 -0.212256 0.00205763 -0.0129983 0.0114481 0.999848 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 4.0027 -6.09519e-05 -0.10431 3.99932 -0.000590255 4.00219 +EDGE_SE3:QUAT 389 1096 6.10151 0.687428 0.0482192 0.00799135 0.00730871 -0.999697 0.0220914 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 3.99972 0.000207586 0.0319904 4.00087 0.027797 0.00240131 +EDGE_SE3:QUAT 390 1096 1.8881 0.800936 0.0165479 0.00434696 0.00492 -0.999725 0.0225004 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 3.99992 7.90283e-05 0.0174018 4.00023 0.0188749 0.00218993 +EDGE_SE3:QUAT 391 1096 -2.39583 0.903362 0.000597846 0.00304706 0.00381504 -0.999726 0.0228808 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 3.99996 4.36788e-05 0.0121983 4.0001 0.0146834 0.00218527 +EDGE_SE3:QUAT 392 1096 -6.61807 1.01121 0.00299707 0.00172245 0.0054018 -0.999737 0.022219 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 3.99998 4.05179e-05 0.00689567 3.99994 0.0212746 0.00209984 +EDGE_SE3:QUAT 794 1096 -0.80671 7.16608 0.142206 0.00351648 -0.00431988 0.51239 0.858735 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 4.00034 0.000257759 -0.0397269 4.00002 -0.0105494 2.95022 +EDGE_SE3:QUAT 1097 1098 4.23718 -0.637006 -0.0269186 -0.00439445 0.0120124 -0.158273 0.987313 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 4.00169 -0.000630575 0.0843302 3.99965 -0.00637786 3.90157 +EDGE_SE3:QUAT 338 1097 6.34915 -1.01741 0.0404712 0.00974248 0.00640196 -0.492619 0.870167 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 4.0013 -0.000759909 0.0820606 3.99987 -0.0229582 3.03099 +EDGE_SE3:QUAT 339 1097 2.2794 0.797005 0.0296079 0.00590055 0.00553308 -0.304007 0.952635 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 4.00071 -0.000180372 0.0584822 3.99982 -0.00963983 3.63117 +EDGE_SE3:QUAT 340 1097 -2.49657 0.758412 -0.0596224 0.00395431 -0.0116838 -0.0560092 0.998354 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 4.00198 -0.000351517 -0.0904155 3.99951 0.00251893 3.98949 +EDGE_SE3:QUAT 341 1097 -6.64062 -1.81947 -0.107778 0.00635052 -0.0124991 0.220814 0.975215 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 4.00281 0.000617167 -0.109121 3.99936 -0.0123823 3.80794 +EDGE_SE3:QUAT 388 1097 5.93545 0.686666 -0.0463106 0.00878149 -0.00555467 0.998819 0.0474623 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 3.99966 -0.000112405 -0.0352483 4.00122 0.0187747 0.00941038 +EDGE_SE3:QUAT 389 1097 1.75901 0.786267 0.0103123 -0.00862106 -0.00723397 0.998914 0.0452199 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 3.99975 0.000303126 0.0345873 4.00084 0.0319116 0.00873398 +EDGE_SE3:QUAT 390 1097 -2.458 0.884717 0.00948829 -0.00517941 -0.0044382 0.998972 0.044822 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 3.99991 0.000110779 0.0207774 4.0003 0.0195196 0.00823961 +EDGE_SE3:QUAT 391 1097 -6.73062 0.984401 0.00734319 -0.0040055 -0.0032315 0.999006 0.0442881 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 3.99995 6.3488e-05 0.0160671 4.00019 0.0142801 0.00796147 +EDGE_SE3:QUAT 1098 1099 4.18854 -0.895168 0.000527577 -0.000407087 -0.0013459 -0.198064 0.980188 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 4.00003 -6.91181e-06 -0.0110822 3.99999 0.00110788 3.84311 +EDGE_SE3:QUAT 339 1098 5.35921 -2.1736 -0.0573548 0.00455749 0.0191083 -0.451025 0.892295 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 4.00401 -0.00311675 0.130108 4.00029 -0.0271742 3.1904 +EDGE_SE3:QUAT 340 1098 1.63928 -0.346679 0.00388254 0.00190867 0.00119551 -0.213511 0.976938 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 4.00003 1.02426e-06 0.0136594 3.99999 -0.00160789 3.8177 +EDGE_SE3:QUAT 341 1098 -2.54407 -0.581453 -0.0138481 0.00148939 -0.000488818 0.0635394 0.997978 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 4 -3.47028e-06 -0.00501945 4 -0.000171228 3.98386 +EDGE_SE3:QUAT 342 1098 -5.85081 -2.6831 -0.00284772 0.00307358 0.00128609 0.308961 0.951069 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 3.99996 -9.5806e-06 -0.00181903 4 -0.000946375 3.61817 +EDGE_SE3:QUAT 387 1098 5.96012 1.56878 0.0451685 -0.00797249 -0.00754398 0.976993 0.212988 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 3.99996 0.000294606 0.0334077 4.00017 0.039782 0.182152 +EDGE_SE3:QUAT 388 1098 1.76776 1.71708 0.0150262 -0.00266835 -0.00758973 0.978672 0.205272 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 4 -1.58887e-05 0.0108015 3.99976 0.0314046 0.168832 +EDGE_SE3:QUAT 389 1098 -2.38184 1.80685 -0.0776674 -0.019784 -0.0123445 0.9789 0.203007 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 3.99949 0.00192469 0.0831103 4.00289 0.075273 0.168078 +EDGE_SE3:QUAT 390 1098 -6.60437 1.92169 -0.0503405 -0.0166842 -0.00902052 0.979033 0.202815 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 3.99959 0.00136979 0.0701568 4.00234 0.058444 0.166678 +EDGE_SE3:QUAT 1099 1100 3.93134 -0.753067 0.005113 -6.33283e-05 -0.0014507 -0.166808 0.985988 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 4.00003 -7.78599e-06 -0.0112491 3.99999 0.000928012 3.88873 +EDGE_SE3:QUAT 340 1099 5.06839 -2.89982 -0.0149931 0.00090285 0.000273107 -0.402839 0.91527 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 4 -8.32567e-07 0.00556749 4 -0.00137004 3.35089 +EDGE_SE3:QUAT 341 1099 1.71078 -0.935398 -0.0127118 0.00119011 -0.00162317 -0.135416 0.990787 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 4.00002 -1.23693e-05 -0.0107196 3.99999 0.000674061 3.92668 +EDGE_SE3:QUAT 342 1099 -1.94219 -0.958058 -0.00197768 0.00283918 0.000703425 0.114319 0.99344 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 3.99997 7.24099e-07 0.00165646 4 1.8362e-05 3.94772 +EDGE_SE3:QUAT 343 1099 -5.40539 -2.15292 0.0344347 -0.000911839 0.00352629 0.292728 0.956189 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 4.00019 7.60299e-05 0.0276844 3.99997 0.00401952 3.65743 +EDGE_SE3:QUAT 387 1099 2.5343 4.11593 0.0137321 -0.00521306 -0.00947783 0.915419 0.402357 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 3.99995 -0.000136349 0.020331 3.99959 0.0375294 0.648097 +EDGE_SE3:QUAT 388 1099 -1.70107 4.2122 0.0244821 6.43315e-05 -0.0087257 0.918533 0.395248 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 3.99987 -8.0451e-05 -0.0046205 4.00002 0.0218727 0.625057 +EDGE_SE3:QUAT 389 1099 -5.84868 4.30578 -0.18426 -0.0156125 -0.0166219 0.919413 0.392633 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 4.00015 0.000243251 0.0671216 3.99875 0.0837547 0.619843 +EDGE_SE3:QUAT 1100 1101 4.16894 -0.677629 0.0103098 0.0082868 0.0139178 -0.123063 0.992267 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 4.00338 -0.000141188 0.121028 3.99909 -0.00761816 3.94308 +EDGE_SE3:QUAT 341 1100 5.28338 -2.69208 -0.00356038 0.00109835 -0.00286763 -0.298704 0.954341 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 4.00006 -4.40172e-05 -0.0162376 4 0.00206698 3.64317 +EDGE_SE3:QUAT 342 1100 2.04874 -0.77856 -0.0101057 0.00227361 -0.000444419 -0.0529673 0.998594 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 3.99998 -1.94776e-06 -0.00209795 4 4.26766e-05 3.98878 +EDGE_SE3:QUAT 343 1100 -1.7376 -0.572893 0.0187844 -0.00109846 0.00201483 0.129146 0.991623 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 4.00007 4.51584e-06 0.0174007 3.99998 0.00115139 3.93336 +EDGE_SE3:QUAT 344 1100 -5.91918 -1.049 -0.208554 -0.00701315 -0.0194453 0.21172 0.977112 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 4.00386 0.00187383 -0.128015 3.99935 -0.0126347 3.82475 +EDGE_SE3:QUAT 1101 1102 4.1135 -0.321283 -0.00574152 -0.00142041 0.00091023 -0.0494374 0.998776 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 4 -5.15933e-06 0.00641387 4 -0.000151404 3.99023 +EDGE_SE3:QUAT 342 1101 6.11584 -1.88965 0.00342018 0.0114458 0.0133113 -0.175748 0.984279 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 4.00339 -0.000227777 0.125334 3.99903 -0.011534 3.88037 +EDGE_SE3:QUAT 343 1101 2.46394 -0.174445 0.012304 0.00493424 0.0166616 0.00597919 0.999831 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 4.00432 0.000368638 0.133055 3.9989 0.000431353 4.00428 +EDGE_SE3:QUAT 344 1101 -1.86188 0.0683393 -0.0289893 0.000298277 -0.00486834 0.0894281 0.995981 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 4.00038 4.49957e-05 -0.038802 3.99991 -0.00173303 3.96839 +EDGE_SE3:QUAT 345 1101 -5.92363 0.00747032 -0.0768018 0.00237266 -0.00681224 0.111424 0.993747 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 4.00078 6.45628e-05 -0.0566422 3.9998 -0.00319436 3.95114 +EDGE_SE3:QUAT 1102 1103 4.45986 -0.187779 -0.0200992 -0.00281799 -0.00140154 -0.0218137 0.999757 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 4 1.60335e-05 -0.0119417 3.99999 0.000132755 3.99813 +EDGE_SE3:QUAT 343 1102 6.56784 -0.42035 -0.131239 0.00268031 0.017637 -0.0436172 0.998889 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 4.00502 -0.000138321 0.142251 3.99874 -0.00309952 3.99744 +EDGE_SE3:QUAT 344 1102 2.24035 0.464786 0.00543003 -0.000903313 -0.00410185 0.0403181 0.999178 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 4.00026 3.04115e-05 -0.0323 3.99994 -0.000648132 3.99376 +EDGE_SE3:QUAT 345 1102 -1.85641 0.593557 -0.0275667 0.00131384 -0.00622238 0.0618865 0.998063 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 4.00063 2.55519e-05 -0.0504735 3.99984 -0.00156832 3.98532 +EDGE_SE3:QUAT 346 1102 -6.23816 0.718243 0.0637182 0.00266177 0.00285057 0.0608124 0.998142 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 4.00008 3.69532e-05 0.0207408 3.99998 0.00061017 3.98531 +EDGE_SE3:QUAT 1103 1104 3.9804 -0.151182 0.00148336 0.00250307 -0.00675499 -0.0101343 0.999923 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 4.0007 -7.81541e-05 -0.0537351 3.99982 0.0002746 4.00031 +EDGE_SE3:QUAT 344 1103 6.69548 0.654975 0.0232245 -0.00345101 -0.0055142 0.018247 0.999812 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 4.00042 8.73154e-05 -0.0433397 3.99988 -0.000395616 3.99914 +EDGE_SE3:QUAT 345 1103 2.57837 0.961207 0.00597087 -0.00122502 -0.00766251 0.0397986 0.999178 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 4.00091 9.20862e-05 -0.060582 3.99977 -0.00120312 3.99458 +EDGE_SE3:QUAT 346 1103 -1.79734 1.06943 0.0199437 -0.000272557 0.00142957 0.0387367 0.999248 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 4.00003 3.50647e-07 0.0115375 3.99999 0.000224105 3.99403 +EDGE_SE3:QUAT 347 1103 -6.03047 1.23963 0.0883477 -0.000767005 0.00980853 0.030032 0.999501 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 4.00154 3.94206e-05 0.078665 3.99961 0.0011815 3.99794 +EDGE_SE3:QUAT 1104 1105 4.09552 -0.106945 0.026541 0.000126324 0.00319546 -0.00361517 0.999988 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 4.00016 7.29038e-07 0.0255696 3.99996 -4.61961e-05 4.00011 +EDGE_SE3:QUAT 345 1104 6.5415 1.13767 0.0716848 0.00143147 -0.0141461 0.0297028 0.999458 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 4.00322 6.19909e-05 -0.113609 3.9992 -0.00168567 3.9997 +EDGE_SE3:QUAT 346 1104 2.16853 1.23532 0.0134515 0.00227314 -0.00529742 0.0284701 0.999578 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 4.00044 -2.95861e-05 -0.0431081 3.99988 -0.000615697 3.99722 +EDGE_SE3:QUAT 347 1104 -2.06652 1.32318 0.0217385 0.00158086 0.00332169 0.0195642 0.999802 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 4.00016 2.56658e-05 0.0261881 3.99996 0.000255353 3.99864 +EDGE_SE3:QUAT 348 1104 -6.44171 1.51169 0.00549092 -0.000387079 0.00185101 0.01136 0.999934 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 4.00005 -1.93985e-06 0.0148582 3.99999 8.44596e-05 3.99954 +EDGE_SE3:QUAT 1105 1106 3.992 -0.0966934 0.0308864 0.0023847 -0.00307685 -0.000311175 0.999992 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 4.00013 -2.94095e-05 -0.0246065 3.99996 4.36992e-06 4.00015 +EDGE_SE3:QUAT 346 1105 6.25744 1.35101 0.088336 0.00216268 -0.00196764 0.0250511 0.999682 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 4.00005 -1.54612e-05 -0.0163763 3.99998 -0.00020757 3.99756 +EDGE_SE3:QUAT 347 1105 2.03542 1.38641 0.0221389 0.0014912 0.00646653 0.0161128 0.999848 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 4.00065 5.43131e-05 0.0514311 3.99984 0.000415185 3.99962 +EDGE_SE3:QUAT 348 1105 -2.34202 1.48236 0.0247844 -0.000548403 0.00526289 0.00782773 0.999955 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 4.00044 -6.35311e-06 0.0421549 3.99989 0.000164733 4.0002 +EDGE_SE3:QUAT 349 1105 -6.62064 1.59678 -0.0858433 0.000705595 -0.00290125 0.00530771 0.999981 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 4.00013 -7.13463e-06 -0.0232546 3.99997 -6.16158e-05 4.00002 +EDGE_SE3:QUAT 1106 1107 4.4415 -0.107267 -0.01577 0.000223162 0.000480915 0.000109702 1 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 4 4.29855e-07 0.00384703 4 2.12248e-07 4 +EDGE_SE3:QUAT 347 1106 6.01501 1.39301 0.00146007 0.00417912 0.0034718 0.0153895 0.999867 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 4.00011 6.01256e-05 0.0269932 3.99996 0.000206882 3.99923 +EDGE_SE3:QUAT 348 1106 1.65561 1.45651 0.0171926 0.00202303 0.00216804 0.00767245 0.999966 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 4.00006 1.81428e-05 0.0171567 3.99998 6.58043e-05 3.99984 +EDGE_SE3:QUAT 349 1106 -2.63592 1.52785 -0.02983 0.00320066 -0.00601412 0.00480789 0.999965 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 4.00054 -7.32259e-05 -0.0483014 3.99985 -0.000113509 4.00049 +EDGE_SE3:QUAT 350 1106 -6.98922 1.67028 -0.165318 0.00151865 -0.0118975 0.00213774 0.999926 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 4.00226 -6.51825e-05 -0.0952653 3.99943 -9.68255e-05 4.00225 +EDGE_SE3:QUAT 1107 1108 4.13356 -0.0796988 -0.0169406 -0.000435865 0.00913815 -6.34919e-05 0.999958 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 4.00134 -1.60778e-05 0.0731262 3.99967 -3.19737e-06 4.00134 +EDGE_SE3:QUAT 348 1107 6.084 1.41175 -0.0198399 0.00229687 0.00282214 0.00795931 0.999962 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 4.0001 2.709e-05 0.022356 3.99997 8.9115e-05 3.99987 +EDGE_SE3:QUAT 349 1107 1.81335 1.47787 0.0119877 0.00330944 -0.00562975 0.00500829 0.999966 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 4.00047 -7.1156e-05 -0.0452395 3.99987 -0.000110953 4.00041 +EDGE_SE3:QUAT 350 1107 -2.57074 1.57879 -0.0652134 0.00187723 -0.0115557 0.00224621 0.999929 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 4.00213 -7.97857e-05 -0.0925381 3.99947 -9.80693e-05 4.00212 +EDGE_SE3:QUAT 351 1107 -6.81462 1.70333 -0.0545443 0.00131813 -0.00794834 -0.000735518 0.999967 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 4.001 -4.30498e-05 -0.063589 3.99975 2.53981e-05 4.00101 +EDGE_SE3:QUAT 1108 1109 4.09375 -0.0935124 0.0376417 -0.00231508 0.00554506 -0.000331831 0.999982 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 4.00047 -5.16011e-05 0.0443556 3.99988 -9.06921e-06 4.00049 +EDGE_SE3:QUAT 349 1108 5.93793 1.4414 0.0454814 0.00273919 0.00360664 0.004871 0.999978 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 4.00018 4.07369e-05 0.028693 3.99995 7.0608e-05 4.00011 +EDGE_SE3:QUAT 350 1108 1.56147 1.51527 0.0180092 0.000893441 -0.00241706 0.00207369 0.999995 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 4.00009 -8.36057e-06 -0.0193589 3.99998 -1.99556e-05 4.00008 +EDGE_SE3:QUAT 351 1108 -2.70055 1.60804 0.00395753 0.00062168 0.0012586 -0.000831361 0.999999 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 4.00002 3.10078e-06 0.010075 3.99999 -4.16526e-06 4.00002 +EDGE_SE3:QUAT 352 1108 -6.90925 1.71042 0.0289547 0.00491681 0.00165589 -0.0039271 0.999979 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 3.99995 3.30594e-05 0.0134782 3.99999 -2.62845e-05 3.99998 +EDGE_SE3:QUAT 1109 1110 4.47734 -0.0756258 0.0327578 -0.00214075 -0.00301529 0.00174937 0.999992 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 4.00013 2.61392e-05 -0.0240778 3.99996 -2.15151e-05 4.00013 +EDGE_SE3:QUAT 350 1109 5.62469 1.43755 0.0827257 -0.00168079 0.0032023 0.00162048 0.999992 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 4.00015 -2.11695e-05 0.0256518 3.99996 2.03807e-05 4.00015 +EDGE_SE3:QUAT 351 1109 1.37987 1.51968 0.0328423 -0.00177323 0.0068988 -0.00103924 0.999974 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 4.00075 -5.01252e-05 0.0551771 3.99981 -3.07062e-05 4.00076 +EDGE_SE3:QUAT 352 1109 -2.82457 1.58554 0.0532243 0.00238688 0.00734417 -0.00382969 0.999963 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 4.00084 6.53705e-05 0.0588724 3.99978 -0.000109765 4.00081 +EDGE_SE3:QUAT 353 1109 -7.14188 1.73395 0.0164829 0.00594917 0.0041662 -0.00912488 0.999932 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 4.00015 9.78099e-05 0.0339772 3.99993 -0.000153476 3.99996 +EDGE_SE3:QUAT 1110 1111 4.07085 -0.0773819 0.0153034 -0.00268356 -0.00278888 0.00183773 0.999991 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 4.00009 3.01749e-05 -0.0222521 3.99997 -2.0929e-05 4.00011 +EDGE_SE3:QUAT 351 1110 5.85834 1.43316 0.00516689 -0.00406454 0.00394954 0.000850651 0.999984 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 4.00018 -6.40174e-05 0.0316387 3.99994 1.19399e-05 4.00025 +EDGE_SE3:QUAT 352 1110 1.64178 1.48931 0.0212388 0.000221738 0.00431419 -0.00253633 0.999987 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 4.0003 2.69503e-06 0.0345222 3.99993 -4.36921e-05 4.00027 +EDGE_SE3:QUAT 353 1110 -2.67653 1.56826 0.007054 0.00397247 0.0010952 -0.00762817 0.999962 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 3.99996 1.81294e-05 0.00912431 3.99999 -3.51406e-05 3.99979 +EDGE_SE3:QUAT 354 1110 -7.15927 1.72533 0.0501054 0.00279599 0.00679723 -0.0133195 0.999884 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 4.00072 6.19178e-05 0.0548187 3.99981 -0.000363076 4.00004 +EDGE_SE3:QUAT 1111 1112 4.33604 -0.0872129 0.0272172 0.00150469 -0.00961721 0.00268226 0.999949 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 4.00147 -5.20437e-05 -0.07701 3.99963 -0.000100057 4.00145 +EDGE_SE3:QUAT 352 1111 5.68244 1.38418 0.00912841 -0.00273757 0.00165732 -0.00045562 0.999995 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 4.00001 -1.81512e-05 0.0132435 3.99999 -3.1961e-06 4.00004 +EDGE_SE3:QUAT 353 1111 1.35854 1.44607 0.0115859 0.00127439 -0.00158049 -0.00571819 0.999982 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 4.00003 -8.32123e-06 -0.012556 3.99999 3.58912e-05 3.99991 +EDGE_SE3:QUAT 354 1111 -3.13449 1.55106 0.0120713 0.000330191 0.00419709 -0.0110257 0.99993 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 4.00028 8.82829e-07 0.0336164 3.99993 -0.000185286 3.9998 +EDGE_SE3:QUAT 1112 1113 4.26686 -0.0785556 0.00489911 0.00211214 0.00767096 0.00250559 0.999965 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 4.00092 6.83046e-05 0.0613158 3.99977 7.98155e-05 4.00091 +EDGE_SE3:QUAT 353 1112 5.69004 1.29866 0.0543985 0.00280771 -0.0111309 -0.00290451 0.99993 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 4.00195 -0.000133666 -0.0889858 3.99951 0.000137689 4.00194 +EDGE_SE3:QUAT 354 1112 1.18087 1.35753 0.00498975 0.00161601 -0.00547674 -0.00803311 0.999951 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 4.00047 -4.09949e-05 -0.0436583 3.99988 0.000176353 4.00022 +EDGE_SE3:QUAT 355 1112 -3.11073 1.47486 -0.0767612 -0.00220257 -0.00961167 -0.0139549 0.999854 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 4.00147 5.41249e-05 -0.0772644 3.99963 0.000535519 4.00071 +EDGE_SE3:QUAT 356 1112 -7.26728 1.57411 -0.00467515 -0.00317898 -0.00181142 -0.0145888 0.999887 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 4.00002 2.29861e-05 -0.0150432 3.99999 0.000110811 3.99921 +EDGE_SE3:QUAT 1113 1114 4.17024 -0.0744448 0.044555 9.66803e-05 -0.00355234 0.00049011 0.999994 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 4.0002 -1.2256e-06 -0.0284205 3.99995 -6.93627e-06 4.0002 +EDGE_SE3:QUAT 354 1113 5.44316 1.21472 0.0602274 0.00365012 0.00219502 -0.00585172 0.999974 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 4.00003 3.19792e-05 0.0178155 3.99998 -5.19455e-05 3.99994 +EDGE_SE3:QUAT 355 1113 1.14263 1.28197 0.0148339 -0.000295026 -0.00198635 -0.0114115 0.999933 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 4.00006 1.26693e-06 -0.0159283 3.99998 9.09299e-05 3.99954 +EDGE_SE3:QUAT 356 1113 -3.0177 1.36504 0.0220328 -0.0010839 0.00593069 -0.0118619 0.999911 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 4.00055 -3.55687e-05 0.0472869 3.99986 -0.000281144 4 +EDGE_SE3:QUAT 357 1113 -7.16372 1.47554 0.0674773 -0.00242139 0.0101926 -0.0114255 0.99988 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 4.00163 -0.000126616 0.0812217 3.99959 -0.00046984 4.00113 +EDGE_SE3:QUAT 1114 1115 4.31368 -0.194002 0.0335904 0.00319299 -2.83531e-05 -0.0361365 0.999342 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 3.99996 2.57476e-06 0.00115701 4 -2.92461e-05 3.99478 +EDGE_SE3:QUAT 355 1114 5.29975 1.11326 0.0766567 -0.000161755 -0.00552128 -0.01093 0.999925 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 4.00049 -4.42675e-06 -0.0441883 3.99988 0.000241472 4.00001 +EDGE_SE3:QUAT 356 1114 1.1407 1.18801 0.0201799 -0.00107761 0.00230356 -0.011479 0.999931 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 4.00008 -1.12641e-05 0.0182767 3.99998 -0.00010475 3.99956 +EDGE_SE3:QUAT 357 1114 -3.00591 1.2945 0.0310112 -0.00247399 0.00647514 -0.0110035 0.999915 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 4.00064 -7.45233e-05 0.051472 3.99984 -0.000285157 4.00018 +EDGE_SE3:QUAT 358 1114 -6.97581 1.87072 -0.292542 -0.00639262 -0.0160953 -0.0522928 0.998482 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 4.00421 8.81409e-05 -0.13236 3.9989 0.00345923 3.99344 +EDGE_SE3:QUAT 1115 1116 4.33278 -0.393291 -0.0528492 -0.00724414 0.0118311 -0.100367 0.994854 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 4.00157 -0.000579441 0.0845781 3.99961 -0.00410032 3.96149 +EDGE_SE3:QUAT 356 1115 5.43844 0.89071 0.0369589 0.00185341 0.00212679 -0.047827 0.998852 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 4.00007 1.1323e-05 0.0180183 3.99998 -0.000438695 3.99093 +EDGE_SE3:QUAT 357 1115 1.30528 1.00215 0.0171428 0.000558775 0.00638599 -0.0472489 0.998863 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 4.00066 -3.21748e-05 0.0512406 3.99984 -0.00121165 3.99173 +EDGE_SE3:QUAT 358 1115 -2.72585 1.24032 -0.102621 -0.00286405 -0.0165162 -0.0884047 0.995944 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 4.00443 -0.000399214 -0.133737 3.99891 0.00593142 3.9732 +EDGE_SE3:QUAT 359 1115 -6.54661 2.83736 -0.077464 -0.00362766 -0.0114172 -0.233743 0.972225 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 4.00215 -0.000611955 -0.0938061 3.99957 0.0110597 3.78365 +EDGE_SE3:QUAT 1116 1117 4.16663 -0.770066 -0.00503879 -0.00114057 0.00216463 -0.183917 0.982939 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 4.00004 -2.2498e-05 0.0139855 3.99999 -0.00118149 3.86475 +EDGE_SE3:QUAT 357 1116 5.56329 0.194528 -0.0933182 -0.00666114 0.0185996 -0.147338 0.988889 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 4.00419 -0.00145788 0.132475 3.9991 -0.00942729 3.91754 +EDGE_SE3:QUAT 358 1116 1.46216 0.0616577 -0.0144115 -0.00729334 -0.00405315 -0.187933 0.982146 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 4.00033 5.19319e-05 -0.0467868 3.99985 0.00485191 3.85927 +EDGE_SE3:QUAT 359 1116 -2.87711 0.518712 -0.0264443 -0.00642705 0.00129246 -0.329807 0.944026 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 3.99988 6.57609e-05 -0.0148923 3.99997 0.00394548 3.56495 +EDGE_SE3:QUAT 360 1116 -6.77936 2.6217 0.0255188 -0.00685693 0.00832321 -0.511258 0.859359 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 3.99971 -6.47912e-06 0.00752296 4.00004 0.00420168 2.95436 +EDGE_SE3:QUAT 1117 1118 4.17325 -0.91838 0.00225001 0.00226916 0.000246321 -0.202557 0.979268 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 3.99999 7.3852e-06 0.00721529 4 -0.000912549 3.83589 +EDGE_SE3:QUAT 358 1117 5.03118 -2.1667 0.045059 -0.0069272 -0.00330048 -0.364919 0.931008 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 4.0004 -8.95229e-05 -0.0489563 3.99986 0.0104036 3.46793 +EDGE_SE3:QUAT 359 1117 -0.128451 -2.68248 -0.0068106 -0.00707819 0.00226763 -0.497575 0.867389 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 3.99991 9.31498e-05 -0.0234478 3.99991 0.00988185 3.00979 +EDGE_SE3:QUAT 360 1117 -5.47409 -1.41067 0.00950939 -0.00806083 0.00910238 -0.660731 0.750525 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 3.99962 0.000257099 -0.0145196 3.99983 0.018085 2.25362 +EDGE_SE3:QUAT 1118 1119 4.31146 -0.918603 -0.00421855 0.00538616 0.0147439 -0.17107 0.985134 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 4.00371 -0.000637252 0.123757 3.99913 -0.0107454 3.88677 +EDGE_SE3:QUAT 359 1118 1.19892 -6.71569 0.0281223 -0.00498946 -0.000266209 -0.663133 0.748485 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 4.00011 -9.10081e-05 -0.0289588 3.99999 0.0132236 2.24123 +EDGE_SE3:QUAT 1119 1120 4.2375 -0.483988 0.00121709 0.00032062 0.000201019 -0.0827578 0.99657 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 4 2.16459e-07 0.00190861 4 -8.31386e-05 3.97261 +EDGE_SE3:QUAT 1120 1121 4.40538 -0.287417 0.0164961 0.00262812 -0.00021792 -0.0288076 0.999581 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 3.99997 -7.07393e-07 -0.000833165 4 7.62926e-06 3.99668 +EDGE_SE3:QUAT 965 1120 -0.333727 -6.70851 0.0504253 -0.00618149 -0.00371721 0.867101 0.498081 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 4.00005 8.22698e-05 0.028406 3.99994 0.0250162 0.992748 +EDGE_SE3:QUAT 1121 1122 4.01309 -0.0909117 0.0181212 0.00309529 -0.00373037 0.000976836 0.999988 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 4.00018 -4.59423e-05 -0.0298802 3.99994 -1.35662e-05 4.00022 +EDGE_SE3:QUAT 964 1121 3.1597 -2.72703 0.0381312 -0.00786241 -0.00471348 0.941161 0.337834 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 4.00002 0.000277694 0.0349083 4.00018 0.0325228 0.457136 +EDGE_SE3:QUAT 965 1121 -2.31614 -2.76137 0.0421334 -0.00434486 -0.00151011 0.852193 0.523207 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 4.00004 7.18117e-05 0.0211902 4.00002 0.0155373 1.09518 +EDGE_SE3:QUAT 966 1121 -7.15424 -1.35491 0.0838192 -0.00397629 0.00281537 0.770788 0.637073 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 4.0001 0.000232916 0.0280365 4.00018 0.010408 1.62371 +EDGE_SE3:QUAT 1060 1121 4.12287 4.9932 0.140708 0.00883194 0.00791115 -0.527707 0.849344 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 4.00146 -0.00107447 0.0843695 4.00006 -0.0241268 2.88787 +EDGE_SE3:QUAT 1061 1121 -2.63344 5.35861 0.0791972 0.00230002 0.0072181 -0.324326 0.945915 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 4.00079 -0.000355961 0.0572118 3.99989 -0.00922933 3.58007 +EDGE_SE3:QUAT 1122 1123 4.00966 -0.0530646 0.0104778 -0.000985687 -0.00163138 0.00640193 0.999978 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 4.00004 6.78726e-06 -0.0129746 3.99999 -4.15131e-05 3.99988 +EDGE_SE3:QUAT 963 1122 4.3215 0.681258 0.0212146 -0.00469586 0.00207334 0.990632 0.136464 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 3.9999 3.79043e-05 0.0193426 4.00038 -0.0028789 0.0745876 +EDGE_SE3:QUAT 964 1122 0.141043 -0.110595 0.0132947 -0.00336277 -0.00285299 0.941593 0.336723 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 4.00001 3.84084e-05 0.0146667 3.99999 0.0163405 0.453659 +EDGE_SE3:QUAT 965 1122 -4.03321 0.847789 0.0430899 0.00035351 -0.000539789 0.852868 0.522126 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 4 2.60243e-06 -0.0024782 4 -0.00023662 1.09046 +EDGE_SE3:QUAT 1060 1122 5.80819 1.34051 0.0713201 0.009808 0.00301908 -0.526849 0.849897 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 4.00068 -0.000361257 0.0653794 3.99986 -0.0213419 2.89078 +EDGE_SE3:QUAT 1061 1122 0.467301 2.82077 0.0391737 0.00422163 0.00249066 -0.323432 0.946239 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 4.00019 -3.47994e-05 0.0321259 3.99994 -0.00589064 3.58182 +EDGE_SE3:QUAT 1062 1122 -4.64254 2.16076 0.017783 0.00518217 0.00169856 -0.152205 0.988334 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 4.00002 4.16928e-05 0.0224379 3.99996 -0.0019347 3.90746 +EDGE_SE3:QUAT 1123 1124 4.07676 -0.0949487 0.00651155 0.00136494 0.00452848 -0.000682041 0.999989 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 4.00032 2.44057e-05 0.0362415 3.99992 -1.16908e-05 4.00033 +EDGE_SE3:QUAT 962 1123 3.94544 2.4795 -0.00840463 -0.0018827 0.0018478 -0.998371 0.0570018 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 3.99999 -1.64808e-05 -0.00756473 4.00003 0.00818709 0.013028 +EDGE_SE3:QUAT 963 1123 0.505401 1.815 -0.00573616 -0.00341271 0.00111785 0.991497 0.130078 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 3.99995 2.28362e-05 0.0140125 4.0002 -0.000792108 0.0677314 +EDGE_SE3:QUAT 964 1123 -2.89849 2.46716 0.00768037 -0.0022847 -0.00438894 0.94371 0.330736 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 4 -1.60671e-05 0.00924104 3.99991 0.0183267 0.437662 +EDGE_SE3:QUAT 965 1123 -5.78357 4.3885 0.0586582 0.00122708 -0.00218757 0.856041 0.516901 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 4 3.43589e-05 -0.00886403 4.00006 -0.000230724 1.06877 +EDGE_SE3:QUAT 1061 1123 3.57844 0.335712 0.0178048 0.00292531 0.00129674 -0.3175 0.948253 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 4.00006 -5.04879e-06 0.0192422 3.99998 -0.00355172 3.59687 +EDGE_SE3:QUAT 1062 1123 -0.852121 0.907662 0.00669893 0.00390589 0.000212096 -0.146021 0.989274 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 3.99996 1.81826e-05 0.00838955 3.99999 -0.000777644 3.91473 +EDGE_SE3:QUAT 1063 1123 -5.31939 0.399757 0.000235758 -7.42276e-05 -0.00142533 -0.0399069 0.999202 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 4.00003 -1.52591e-06 -0.011411 3.99999 0.000227745 3.99366 +EDGE_SE3:QUAT 1124 1125 4.37812 -0.118688 0.0261177 0.00122731 -0.00166229 -0.00299959 0.999993 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 4.00004 -8.32249e-06 -0.0132541 3.99999 1.99378e-05 4.00001 +EDGE_SE3:QUAT 960 1124 5.91195 4.5627 0.0108596 0.000721729 0.00415041 -0.870223 0.492639 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 3.99997 -2.51502e-05 0.00770136 4.00008 0.0052807 0.970813 +EDGE_SE3:QUAT 961 1124 3.07906 2.70586 0.00800531 0.00534351 -0.00140668 -0.959219 0.282609 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 3.99997 -0.000157797 0.0235248 4.00026 -0.0156532 0.319682 +EDGE_SE3:QUAT 962 1124 -0.0884547 2.1139 0.00680353 0.00274247 0.000661829 -0.998402 0.0564325 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 3.99997 -3.04033e-06 0.0110231 4.00012 0.00139213 0.0127695 +EDGE_SE3:QUAT 963 1124 -3.41683 2.95881 -0.0276473 -0.00777867 0.00294972 0.991336 0.131089 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 3.99974 0.000108973 0.0319582 4.00103 -0.00327801 0.0689999 +EDGE_SE3:QUAT 1061 1124 6.7791 -2.2103 0.00199286 0.00531284 0.00539637 -0.318133 0.948016 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 4.00066 -0.000194029 0.0557089 3.99985 -0.00955498 3.59594 +EDGE_SE3:QUAT 1062 1124 3.03961 -0.360237 0.00284403 0.00582994 0.00464198 -0.146294 0.989213 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 4.00039 3.52886e-05 0.0460426 3.99986 -0.00358451 3.91492 +EDGE_SE3:QUAT 1063 1124 -1.2468 -0.0246807 0.0125822 0.00127211 0.00316045 -0.0406452 0.999168 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 4.00016 6.46746e-06 0.0258416 3.99996 -0.000528688 3.99356 +EDGE_SE3:QUAT 1064 1124 -5.37291 -0.0684427 -0.00305825 0.00234159 0.00311756 -0.0131825 0.999906 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 4.00014 2.66265e-05 0.025305 3.99996 -0.000167049 3.99946 +EDGE_SE3:QUAT 1125 1126 4.29499 -0.107145 0.0270262 0.00031072 -0.00290145 -0.00146725 0.999995 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 4.00013 -3.90177e-06 -0.0232067 3.99997 1.7088e-05 4.00013 +EDGE_SE3:QUAT 960 1125 3.57463 0.892114 0.0183983 5.45719e-05 0.00220235 -0.871505 0.490381 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 3.99999 -3.12918e-07 0.00235939 4.00001 0.0038224 0.961905 +EDGE_SE3:QUAT 961 1125 -0.65791 0.433695 -0.00137987 0.00441999 -0.00333754 -0.960006 0.279926 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 4 -8.72223e-05 0.0190484 4.00005 -0.0199312 0.313634 +EDGE_SE3:QUAT 962 1125 -4.44901 1.74354 0.0103955 0.00113122 -0.000653806 -0.998545 0.0539094 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 4 -4.28616e-06 0.00454373 4.00002 -0.00308271 0.0116324 +EDGE_SE3:QUAT 1062 1125 7.18589 -1.74771 -0.016932 0.00709196 0.00286185 -0.149472 0.988736 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 4.0001 7.87961e-05 0.0346636 3.99991 -0.00288559 3.91093 +EDGE_SE3:QUAT 1063 1125 3.08702 -0.498377 0.0118813 0.00264726 0.00156001 -0.043474 0.99905 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 4.00002 1.59072e-05 0.0138241 3.99999 -0.000310069 3.99249 +EDGE_SE3:QUAT 1064 1125 -0.990501 -0.303661 -0.000640347 0.00361552 0.00161324 -0.0164012 0.999858 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 3.99999 2.392e-05 0.0136121 3.99999 -0.000113315 3.99897 +EDGE_SE3:QUAT 1065 1125 -5.08612 -0.210664 -0.0133356 0.00210782 0.00237449 -0.0168247 0.999853 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 4.00008 1.82525e-05 0.0194136 3.99998 -0.000164199 3.99896 +EDGE_SE3:QUAT 1126 1127 4.2599 -0.0932339 0.0143332 -0.00138401 -0.00251896 0.000876566 0.999995 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 4.00009 1.40662e-05 -0.0201375 3.99997 -9.03491e-06 4.0001 +EDGE_SE3:QUAT 959 1126 6.24602 -1.54638 0.0752669 0.00462645 -0.00490086 -0.77252 0.634954 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 3.99994 8.42039e-05 0.015787 3.99988 -0.0169577 1.61288 +EDGE_SE3:QUAT 960 1126 1.24099 -2.72526 0.0358515 -0.00236506 0.000507166 -0.872208 0.48913 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 4.00001 -2.97905e-05 -0.0117249 4.00002 0.0079633 0.957048 +EDGE_SE3:QUAT 961 1126 -4.34228 -1.78556 -0.00319321 0.0014928 -0.00446235 -0.960528 0.278145 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 4 2.03607e-05 0.00585479 3.99992 -0.0175567 0.309551 +EDGE_SE3:QUAT 1063 1126 7.37668 -0.977787 0.0246621 0.00269529 -0.0013816 -0.0452718 0.99897 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 3.99999 -1.38672e-05 -0.0095565 3.99999 0.000205117 3.99182 +EDGE_SE3:QUAT 1064 1126 3.30819 -0.55343 0.00576258 0.00365132 -0.00126409 -0.0179419 0.999832 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 3.99997 -1.7144e-05 -0.00932174 3.99999 8.13834e-05 3.99873 +EDGE_SE3:QUAT 1065 1126 -0.784896 -0.453793 -0.00886937 0.00260193 -0.000501311 -0.018417 0.999827 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 3.99998 -4.30422e-06 -0.00343351 4 2.98584e-05 3.99865 +EDGE_SE3:QUAT 1066 1126 -5.10693 -0.425686 -0.0220469 0.00298083 0.00128197 -0.013817 0.999899 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 3.99999 1.56752e-05 0.0107469 3.99999 -7.52509e-05 3.99927 +EDGE_SE3:QUAT 1127 1128 4.24016 -0.0627933 0.010865 0.00139241 0.012333 0.00710555 0.999898 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 4.00242 9.46251e-05 0.0985895 3.99939 0.000355752 4.00223 +EDGE_SE3:QUAT 960 1127 -1.0531 -6.29294 0.0719362 -0.00503396 0.000208572 -0.871692 0.490029 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 4.00005 -0.000168553 -0.0257874 4.00015 0.0153748 0.960763 +EDGE_SE3:QUAT 1065 1127 3.45517 -0.703609 0.00824907 0.00110152 -0.00289495 -0.0175029 0.999842 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 4.00013 -1.60433e-05 -0.0229183 3.99997 0.000200097 3.99891 +EDGE_SE3:QUAT 1066 1127 -0.865585 -0.636192 -0.0119949 0.00177416 -0.00103902 -0.0126304 0.999918 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 4 -7.36414e-06 -0.00804131 4 5.02565e-05 3.99938 +EDGE_SE3:QUAT 1067 1127 -4.718 -1.2139 -0.140478 0.0040218 -0.0129723 0.0799974 0.996703 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 4.00278 0.000121554 -0.106693 3.99929 -0.00429654 3.97725 +EDGE_SE3:QUAT 1128 1129 4.29925 -0.0491488 0.0168194 -0.00111164 -0.000250419 0.00935474 0.999956 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 4 1.03358e-06 -0.00187831 4 -8.59207e-06 3.99965 +EDGE_SE3:QUAT 1066 1128 3.36922 -0.809763 0.00642704 0.00304215 0.0110517 -0.0055934 0.999919 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 4.00193 0.000118655 0.0886508 3.99951 -0.000239479 4.00184 +EDGE_SE3:QUAT 1067 1128 -0.498249 -0.60796 -0.00867184 0.00419119 -0.000615459 0.0870111 0.996198 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 3.99995 -2.01097e-05 -0.00922181 3.99999 -0.000463739 3.96974 +EDGE_SE3:QUAT 1068 1128 -4.23005 -1.72296 -0.0355247 0.00527851 -0.0011926 0.301401 0.953482 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 4.00006 -2.40702e-05 -0.0262063 3.99995 -0.00483356 3.6368 +EDGE_SE3:QUAT 1129 1130 4.3181 -0.0527842 0.0240797 -0.000490281 5.68715e-06 0.00961176 0.999954 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 4 -2.96049e-08 0.000102037 4 5.80959e-07 3.99963 +EDGE_SE3:QUAT 1067 1129 3.73941 0.0744688 0.0161615 0.00300702 -0.000943473 0.0962961 0.995348 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 3.99999 -1.43342e-05 -0.0108963 3.99999 -0.000578594 3.96294 +EDGE_SE3:QUAT 1068 1129 -0.673536 0.714786 0.00947369 0.0043903 -0.00175385 0.310232 0.950649 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 4.00011 3.06919e-06 -0.0273511 3.99995 -0.00497047 3.61521 +EDGE_SE3:QUAT 1069 1129 -4.91562 -0.496582 -0.00157156 0.00564857 -0.00128866 0.510496 0.85986 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 4.00018 7.6816e-05 -0.0351478 3.99994 -0.0113859 2.95788 +EDGE_SE3:QUAT 1130 1131 4.28122 -0.0459567 0.0366535 -0.00136299 -0.00359227 0.00389313 0.999985 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 4.0002 2.07316e-05 -0.028675 3.99995 -5.62042e-05 4.00014 +EDGE_SE3:QUAT 426 1130 4.57335 -3.2972 0.0357135 -0.00783558 -0.00161345 0.956657 0.291108 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 3.99994 0.000348063 0.0347517 4.00059 0.0218355 0.339418 +EDGE_SE3:QUAT 427 1130 -1.21645 -3.85839 0.0462859 -0.00183945 0.0050332 0.876696 0.481016 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 3.99995 8.56539e-05 0.0139167 4.00019 -0.00404195 0.925583 +EDGE_SE3:QUAT 428 1130 -6.53389 -2.72477 0.0658807 0.00145137 0.00486401 0.802327 0.596863 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 3.99995 -2.41469e-05 0.000297201 4 -0.00894935 1.42504 +EDGE_SE3:QUAT 1068 1130 2.85194 3.21683 0.0648695 0.00418706 -0.00193327 0.319495 0.947577 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 4.00013 1.34381e-05 -0.0281211 3.99995 -0.00520581 3.59189 +EDGE_SE3:QUAT 1069 1130 -2.7912 3.27143 0.0647828 0.00581902 -0.00131961 0.518766 0.854895 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 4.00019 8.70155e-05 -0.0363243 3.99994 -0.0119746 2.92385 +EDGE_SE3:QUAT 1131 1132 4.31826 -0.240689 0.0203974 -0.00384615 0.000745146 -0.0607591 0.998145 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 3.99994 -4.52191e-06 0.00313072 4 -6.63967e-05 3.98524 +EDGE_SE3:QUAT 425 1131 5.53859 0.711541 0.0188534 -0.00571611 -7.94511e-05 0.999307 0.0367858 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 3.99987 3.05557e-05 0.0229104 4.00052 0.00199707 0.00554517 +EDGE_SE3:QUAT 426 1131 1.05362 -0.871391 0.00968625 -0.00500868 -0.0036306 0.957823 0.287291 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 4 0.000112624 0.0216705 4.00007 0.0221765 0.330397 +EDGE_SE3:QUAT 427 1131 -3.45894 -0.233529 0.044942 0.00045369 0.00227839 0.878531 0.477679 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 3.99999 -7.595e-06 -0.000335218 4 -0.00569087 0.912724 +EDGE_SE3:QUAT 1069 1131 -0.771835 7.03442 0.136349 0.00660214 -0.00505487 0.522271 0.852739 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 4.00069 0.000478178 -0.0589441 4 -0.017089 2.9098 +EDGE_SE3:QUAT 1132 1133 4.28328 -0.685207 0.0002188 0.00113271 0.00364256 -0.162033 0.986778 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 4.00022 -3.79118e-05 0.0301659 3.99995 -0.00247176 3.89521 +EDGE_SE3:QUAT 424 1132 4.80923 2.60533 0.00963049 0.00254764 0.00376601 -0.988503 0.151134 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 3.99995 1.75164e-05 0.0106376 4.00012 0.0112013 0.0914271 +EDGE_SE3:QUAT 425 1132 1.23234 1.27527 -0.0104191 -0.00673016 -0.00443882 0.995171 0.0978246 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 3.99987 0.000191162 0.0272725 4.00049 0.0225532 0.0385942 +EDGE_SE3:QUAT 426 1132 -2.43392 1.71669 0.00371227 -0.00658512 -0.00752535 0.93857 0.344944 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 4.00002 7.23398e-05 0.028139 3.99978 0.0375389 0.476544 +EDGE_SE3:QUAT 427 1132 -5.59418 3.53036 0.0640833 -0.00223359 -0.000636895 0.847874 0.530192 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 4.00001 2.11243e-05 0.0110748 4.00001 0.00775641 1.12447 +EDGE_SE3:QUAT 1133 1134 4.11219 -0.912121 0.00914181 -0.00405845 -0.00123032 -0.214521 0.97671 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 4.00003 2.1327e-05 -0.0192981 3.99997 0.00241754 3.81601 +EDGE_SE3:QUAT 423 1133 3.86379 2.60851 0.021161 0.00310546 0.0105922 -0.984987 0.172275 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 3.99984 0.000167508 0.0133968 4.00005 0.0351083 0.119083 +EDGE_SE3:QUAT 424 1133 0.516469 1.97895 -0.0204673 -0.00585362 -0.00372148 0.99991 0.0114938 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 3.99987 9.51689e-05 0.0234193 4.00048 0.015422 0.000725021 +EDGE_SE3:QUAT 425 1133 -2.80349 2.78596 -0.0532235 -0.0097095 -0.00354464 0.965984 0.258396 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 3.9999 0.000496716 0.0420465 4.00082 0.0306105 0.267779 +EDGE_SE3:QUAT 426 1133 -5.21899 5.00479 -0.0203747 -0.00875038 -0.00626483 0.870037 0.492869 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 4.00008 0.000102954 0.0392548 3.99979 0.0373296 0.972527 +EDGE_SE3:QUAT 1134 1135 4.22477 -0.922836 0.000184678 -0.000304322 -0.000527318 -0.195685 0.980667 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 4.00001 -8.31201e-07 -0.00467495 4 0.000472567 3.84683 +EDGE_SE3:QUAT 421 1134 6.48277 3.75706 0.0457175 0.00477881 0.00576459 -0.958666 0.284437 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 3.99985 -0.00010518 0.022351 4.00055 0.00853553 0.323778 +EDGE_SE3:QUAT 422 1134 3.20443 2.46293 0.00519392 0.00146619 0.00891712 -0.990047 0.140448 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 3.99994 0.000110611 0.00623425 3.99985 0.0323071 0.0791796 +EDGE_SE3:QUAT 423 1134 -0.273254 2.05187 0.00820763 0.00110038 -0.0148672 0.999031 0.0414053 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 3.99998 -0.000135068 -0.0044237 3.99918 0.0588449 0.00772986 +EDGE_SE3:QUAT 424 1134 -3.51133 2.94058 -0.049664 -0.00356125 -0.00879321 0.974575 0.223859 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 4 -1.60926e-05 0.0144863 3.99968 0.0369008 0.200862 +EDGE_SE3:QUAT 1135 1136 4.05914 -0.576037 -0.0241961 0.004698 0.0200465 -0.102814 0.994487 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 4.00661 -0.000641325 0.163831 3.99838 -0.00846722 3.96442 +EDGE_SE3:QUAT 420 1135 6.1951 2.7591 -0.0615381 -0.0149854 0.0128822 -0.984186 0.176033 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 3.99971 -0.0010959 -0.0621328 4.00122 0.0680752 0.126122 +EDGE_SE3:QUAT 421 1135 2.40778 2.23375 0.00296919 0.0029487 0.00691761 -0.995828 0.0909415 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 3.99993 8.57292e-05 0.0119824 4.00004 0.0249737 0.0332751 +EDGE_SE3:QUAT 422 1135 -1.11214 2.18791 0.00369069 0.000709134 -0.00944136 0.998364 0.0563955 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 3.99999 -6.43823e-05 -0.00286429 3.99968 0.0371453 0.01307 +EDGE_SE3:QUAT 423 1135 -4.4127 3.33202 0.0529984 0.00425257 -0.0149171 0.971462 0.236688 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 3.9996 -0.000264609 -0.0199615 4.00038 0.043887 0.224719 +EDGE_SE3:QUAT 1136 1137 4.4071 -0.290613 0.022352 0.0065331 0.000345737 -0.0319745 0.999467 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 3.99984 1.96623e-05 0.00526641 4 -9.74763e-05 3.99592 +EDGE_SE3:QUAT 419 1136 6.42718 1.81916 0.0523442 0.00434697 0.0153558 -0.996514 0.0818826 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 3.99982 0.000351734 0.0176352 3.99966 0.0575717 0.0277323 +EDGE_SE3:QUAT 420 1136 2.1952 1.8793 0.0319372 0.00427131 0.0101646 -0.997223 0.0736593 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 3.99987 0.000186181 0.0172582 4.00004 0.0376082 0.0221334 +EDGE_SE3:QUAT 421 1136 -1.6684 2.06411 -0.0426056 -0.0225375 -0.00427093 0.999656 0.0127101 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 3.99799 0.000540144 0.0901531 4.008 0.0194235 0.00277345 +EDGE_SE3:QUAT 422 1136 -5.07175 3.21694 -0.000105283 -0.0178589 -0.0033522 0.98707 0.159253 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 3.99911 0.00129707 0.0740039 4.00425 0.0348039 0.103152 +EDGE_SE3:QUAT 1137 1138 4.07137 -0.142063 0.0226816 0.00290362 -0.00758122 -0.0118041 0.999897 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 4.00087 -0.000103411 -0.0602369 3.99977 0.000358861 4.00035 +EDGE_SE3:QUAT 418 1137 6.08629 1.26271 0.0805347 0.0107263 0.00887758 -0.998874 0.0453596 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 3.99948 0.000272514 0.0430441 4.00173 0.0314633 0.00894215 +EDGE_SE3:QUAT 419 1137 2.05741 1.38394 0.0318938 0.00469145 0.00890794 -0.998689 0.0501871 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 3.99988 0.0001656 0.0188471 4.00014 0.0335324 0.0104459 +EDGE_SE3:QUAT 420 1137 -2.20625 1.52135 0.0224395 0.00477494 0.00332475 -0.999118 0.041579 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 3.9999 4.27355e-05 0.019151 4.00035 0.0116575 0.00704114 +EDGE_SE3:QUAT 421 1137 -6.07882 2.47672 -0.213658 -0.0226957 0.00191663 0.998729 0.0449698 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 3.99794 0.000384314 0.0910354 4.00828 0.000528518 0.0101663 +EDGE_SE3:QUAT 1138 1139 4.19338 -0.124381 -0.00732353 0.00250372 -0.000397657 -0.00627068 0.999977 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 3.99998 -3.68932e-06 -0.00299264 4 9.19449e-06 3.99984 +EDGE_SE3:QUAT 417 1138 6.45308 0.842762 0.0555072 0.00411093 0.0112861 -0.99965 0.0235714 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 3.99991 0.000198353 0.0164615 3.99982 0.0443089 0.00278133 +EDGE_SE3:QUAT 418 1138 2.02714 1.02935 0.0134614 0.00312282 0.00564573 -0.999419 0.0334727 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 3.99995 6.99412e-05 0.0125144 4.00006 0.0216854 0.00463859 +EDGE_SE3:QUAT 419 1138 -1.99305 1.12904 0.015915 -0.00300453 0.00551738 -0.99926 0.0379408 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 3.99997 -6.3804e-05 -0.0120422 3.99999 0.0229014 0.0059256 +EDGE_SE3:QUAT 420 1138 -6.23058 1.32971 0.00129374 -0.00292782 0.000449445 -0.999556 0.0296553 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 3.99997 -1.12339e-05 -0.0117266 4.00013 0.00248795 0.0035537 +EDGE_SE3:QUAT 1139 1140 4.23812 -0.11972 0.0196043 0.00130369 0.000358588 -0.00438276 0.999989 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 4 1.91543e-06 0.00293718 4 -6.48233e-06 3.99993 +EDGE_SE3:QUAT 416 1139 6.58139 0.663906 0.0290974 0.0038302 0.00526747 -0.999895 0.012981 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 3.99994 7.88075e-05 0.0153252 4.00014 0.0206648 0.000839525 +EDGE_SE3:QUAT 417 1139 2.27719 0.772684 0.0165396 0.00344755 0.00875131 -0.999805 0.017366 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 3.99994 0.00012578 0.0137983 3.99991 0.0345013 0.0015516 +EDGE_SE3:QUAT 418 1139 -2.12283 0.875505 -0.0204375 0.00269965 0.00329069 -0.999615 0.0274066 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 3.99997 3.26903e-05 0.0108114 4.00008 0.0125471 0.00307312 +EDGE_SE3:QUAT 419 1139 -6.12785 0.941919 0.0318676 -0.00312947 0.00321019 -0.99948 0.0319456 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 3.99997 -4.44066e-05 -0.0125364 4.0001 0.0136076 0.00416774 +EDGE_SE3:QUAT 1140 1141 4.21829 -0.0813386 0.0317632 -0.00390118 -0.000697964 -0.000976954 0.999992 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 3.99995 1.09986e-05 -0.00562932 4 2.71104e-06 4 +EDGE_SE3:QUAT 415 1140 6.7478 0.550432 0.0225075 0.00491312 0.00323315 -0.999965 0.00588699 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 3.9999 6.06063e-05 0.0196536 4.00035 0.0127017 0.000275528 +EDGE_SE3:QUAT 416 1140 2.35002 0.654093 0.0161377 0.00398972 0.00411944 -0.999949 0.00832754 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 3.99993 6.36307e-05 0.0159608 4.00019 0.0162104 0.000406778 +EDGE_SE3:QUAT 417 1140 -1.94653 0.736702 0.00334306 0.00385106 0.0074245 -0.99988 0.0130246 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 3.99993 0.000115177 0.0154094 4.00003 0.0292859 0.000952381 +EDGE_SE3:QUAT 418 1140 -6.34969 0.762129 -0.0241097 0.00309735 0.00208887 -0.999736 0.0226706 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 3.99996 2.12451e-05 0.0123991 4.00014 0.00778371 0.00210943 +EDGE_SE3:QUAT 1141 1142 4.20294 -0.0931001 0.0292002 -0.00316397 -0.000767553 -0.000373225 0.999995 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 3.99997 9.73853e-06 -0.00615451 4 1.10449e-06 4.00001 +EDGE_SE3:QUAT 414 1141 6.88732 0.473982 -0.00317744 0.00220717 0.0049839 -0.999983 0.00219734 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 3.99998 4.41784e-05 0.00882905 3.99998 0.0198969 0.000137773 +EDGE_SE3:QUAT 415 1141 2.54644 0.577958 0.00878398 0.00412665 0.00744231 -0.999953 0.00454203 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 3.99993 0.000122979 0.0165083 4.00006 0.0296198 0.000369981 +EDGE_SE3:QUAT 416 1141 -1.84324 0.677978 0.00877446 0.00338574 0.00847375 -0.999931 0.00739009 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 3.99995 0.000116874 0.0135455 3.99991 0.0336912 0.000548117 +EDGE_SE3:QUAT 417 1141 -6.1602 0.70759 -0.00159757 0.00326843 0.0117479 -0.999862 0.0112851 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 3.99995 0.00016282 0.0130791 3.99964 0.0466815 0.00109708 +EDGE_SE3:QUAT 1142 1143 4.05585 -0.0941051 -0.00753405 0.000188912 -0.00174081 0.000216129 0.999998 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 4.00005 -1.29983e-06 -0.0139271 3.99999 -1.49135e-06 4.00005 +EDGE_SE3:QUAT 413 1142 6.67483 0.445704 0.0572936 -0.00599473 -0.00667577 0.99996 0.000371293 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 3.99986 0.000160331 0.0239801 4.0004 0.0267255 0.000322851 +EDGE_SE3:QUAT 414 1142 2.6756 0.542444 0.0055133 0.00140478 0.00821066 -0.999963 0.00207292 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 3.99999 4.71484e-05 0.00561973 3.99976 0.0328183 0.000294359 +EDGE_SE3:QUAT 415 1142 -1.66187 0.637106 0.000312465 0.00338074 0.0107622 -0.999927 0.00437787 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 3.99995 0.000148338 0.0135256 3.99973 0.0429287 0.000583148 +EDGE_SE3:QUAT 416 1142 -6.04984 0.696647 0.0149389 0.0025534 0.0117144 -0.999906 0.00669658 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 3.99997 0.000125842 0.0102164 3.99957 0.0467143 0.000751104 +EDGE_SE3:QUAT 1143 1144 4.55448 -0.098123 -0.0150798 -0.00120113 0.0036213 0.0011869 0.999992 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 4.0002 -1.70415e-05 0.0289887 3.99995 1.68306e-05 4.0002 +EDGE_SE3:QUAT 412 1143 6.78953 0.424938 0.0333741 -0.00105896 -0.00494741 0.999984 0.00258611 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 4 2.05166e-05 0.00423602 3.99992 0.0198111 0.00012936 +EDGE_SE3:QUAT 413 1143 2.62007 0.53702 0.00240328 -0.00428571 -0.0063623 0.999971 1.90587e-05 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 3.99993 0.000109089 0.0171437 4.00013 0.0254519 0.000235418 +EDGE_SE3:QUAT 414 1143 -1.35954 0.614593 -0.0151015 -0.000371431 0.00833275 -0.999963 0.0020633 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 4 -1.12384e-05 -0.00148588 3.99972 0.0333357 0.000295418 +EDGE_SE3:QUAT 415 1143 -5.68581 0.689011 -0.0220137 0.00174022 0.0107061 -0.99993 0.00469519 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 3.99999 7.84472e-05 0.00696232 3.99959 0.0427549 0.000557347 +EDGE_SE3:QUAT 1144 1145 4.4457 -0.102493 0.00427848 0.000466782 0.00749579 0.00129216 0.999971 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 4.0009 1.57469e-05 0.0599707 3.99978 3.93965e-05 4.00089 +EDGE_SE3:QUAT 411 1144 6.59779 0.426114 -0.018349 0.00269874 -0.00701645 0.99996 0.00485531 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 3.99997 -7.67778e-05 -0.0107961 3.99992 0.0279598 0.000318879 +EDGE_SE3:QUAT 412 1144 2.24539 0.53508 0.0125963 -0.00460506 -0.00627383 0.999968 0.00157241 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 3.99992 0.000115891 0.0184212 4.00018 0.0251555 0.000252913 +EDGE_SE3:QUAT 413 1144 -1.90961 0.624265 -0.046492 0.00784975 0.00760908 -0.99994 0.00084101 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 3.99975 0.000238239 0.0314008 4.00076 0.0303929 0.000480207 +EDGE_SE3:QUAT 414 1144 -5.89167 0.695093 -0.0239898 0.00303735 0.00975906 -0.999942 0.00335608 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 3.99996 0.000120353 0.0121513 3.99977 0.0389538 0.000461335 +EDGE_SE3:QUAT 1145 1146 4.36487 -0.0980002 0.0323801 0.00364401 0.00052408 0.00172223 0.999992 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 3.99995 7.46687e-06 0.00411723 4 3.54712e-06 3.99999 +EDGE_SE3:QUAT 410 1145 6.55761 0.403329 0.0246093 -0.00430721 -0.00711927 0.999916 0.00996548 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 3.99993 0.000122877 0.0172326 4.00008 0.0288155 0.000679083 +EDGE_SE3:QUAT 411 1145 2.16144 0.554659 0.0159678 -0.00495634 -0.00657079 0.99996 0.0035237 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 3.9999 0.000131136 0.0198268 4.00021 0.026425 0.000322499 +EDGE_SE3:QUAT 412 1145 -2.17495 0.66749 -0.0257629 -0.0122346 -0.00596139 0.999907 0.000783208 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 3.9994 0.000294922 0.0489376 4.00225 0.0239415 0.00074444 +EDGE_SE3:QUAT 413 1145 -6.32132 0.727099 -0.112984 0.0153828 0.00745923 -0.999852 0.00212043 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 3.99905 0.000449309 0.0615294 4.00358 0.0296134 0.00118362 +EDGE_SE3:QUAT 1146 1147 4.28294 -0.0918932 0.0281174 0.00037103 -0.00510933 0.00148746 0.999986 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 4.00042 -6.65496e-06 -0.0408849 3.9999 -3.01846e-05 4.00041 +EDGE_SE3:QUAT 409 1146 6.63042 0.37197 0.0682188 -0.00951614 -0.00637884 0.999687 0.0222313 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 3.99966 0.000282227 0.0380936 4.00122 0.0271881 0.00252469 +EDGE_SE3:QUAT 410 1146 2.20099 0.562685 0.0186485 -0.00486667 -0.00368235 0.999945 0.00848306 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 3.99991 7.55237e-05 0.019469 4.00032 0.0150588 0.000439307 +EDGE_SE3:QUAT 411 1146 -2.18867 0.687367 0.00632803 -0.00541729 -0.00317692 0.999978 0.00224403 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 3.99988 7.02619e-05 0.0216694 4.00043 0.0128068 0.000178534 +EDGE_SE3:QUAT 412 1146 -6.51099 0.757507 -0.0988901 0.012911 0.00255198 -0.999913 0.001154 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 3.99933 0.000127538 0.0516405 4.00264 0.0100979 0.00069759 +EDGE_SE3:QUAT 1147 1148 4.11684 -0.0829028 0.0101374 -0.00125092 -0.00608648 1.16112e-05 0.999981 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 4.00059 3.04808e-05 -0.0486979 3.99985 -1.3952e-06 4.00059 +EDGE_SE3:QUAT 408 1147 6.71997 0.545307 0.0797749 -0.0110354 -0.00289305 0.999616 0.0252472 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 3.99953 0.000198671 0.0441819 4.00187 0.0137907 0.0030856 +EDGE_SE3:QUAT 409 1147 2.36865 0.636909 0.021722 -0.00443287 -0.00617611 0.999755 0.0207773 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 3.99993 0.000112237 0.0177435 4.00013 0.0254164 0.00196707 +EDGE_SE3:QUAT 410 1147 -2.03663 0.745729 0.00207238 0.000295395 -0.00354319 0.999968 0.00717236 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 4 -4.88818e-06 -0.00118171 3.99995 0.0141539 0.000256206 +EDGE_SE3:QUAT 411 1147 -6.41218 0.803223 -0.00693941 -0.000347523 -0.00268711 0.999996 0.000905396 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 4 3.68556e-06 0.00139011 3.99997 0.0107509 3.26577e-05 +EDGE_SE3:QUAT 1148 1149 4.3184 -0.14505 -0.00874144 -0.00538538 0.00326878 -0.0284951 0.999574 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 4.00003 -7.02142e-05 0.0242775 3.99997 -0.00033826 3.9969 +EDGE_SE3:QUAT 407 1148 6.87823 1.21507 0.0187636 0.000797065 -8.39296e-05 -0.99982 0.0189651 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 4 -5.53966e-07 0.00318997 4.00001 -0.000456306 0.0014413 +EDGE_SE3:QUAT 408 1148 2.61353 0.8221 0.00878927 -0.00500774 -0.00400723 0.999674 0.024698 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 3.99991 9.11945e-05 0.0200492 4.00031 0.0169955 0.00261277 +EDGE_SE3:QUAT 409 1148 -1.74494 0.893898 -0.000186424 0.00165352 -0.00772663 0.99976 0.0204282 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 3.99998 -5.91589e-05 -0.00661938 3.99982 0.0306038 0.00191446 +EDGE_SE3:QUAT 410 1148 -6.13831 0.873878 0.0217793 0.00622062 -0.00487163 0.999943 0.00712624 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 3.99984 -0.000115915 -0.0248847 4.00053 0.0191333 0.000449466 +EDGE_SE3:QUAT 1149 1150 4.22294 -0.429469 0.0135349 -0.00460435 0.0168626 -0.103648 0.99446 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 4.00395 -0.00093628 0.12715 3.99908 -0.00649991 3.96106 +EDGE_SE3:QUAT 406 1149 6.32301 2.2944 -0.0840668 -0.0110204 0.00220588 -0.993004 0.117544 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 3.99961 -0.000406023 -0.044958 4.00171 0.0187531 0.0558667 +EDGE_SE3:QUAT 407 1149 2.5565 1.17574 0.00575149 -0.00380519 -0.00550907 0.999933 0.00945516 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 3.99995 8.47338e-05 0.0152234 4.0001 0.0223205 0.0005401 +EDGE_SE3:QUAT 408 1149 -1.68846 1.17847 -0.0429223 -0.00803667 -0.00992657 0.998506 0.0531194 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 3.99981 0.000345473 0.0322758 4.00044 0.0428427 0.0120078 +EDGE_SE3:QUAT 409 1149 -6.05356 1.21271 0.0092728 -0.00128491 -0.0132262 0.998714 0.048934 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 4 -4.51974e-07 0.00514612 3.9993 0.0530856 0.0102911 +EDGE_SE3:QUAT 1150 1151 4.11886 -0.765881 0.0125244 0.00352771 -0.00316084 -0.172822 0.984942 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 4.00002 -4.81936e-05 -0.0169917 3.99999 0.00122484 3.8806 +EDGE_SE3:QUAT 405 1150 5.50763 2.81076 0.0528434 0.00711515 0.0107147 -0.984821 0.173093 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 3.99961 0.000102391 0.0301535 4.00099 0.0301359 0.120319 +EDGE_SE3:QUAT 406 1150 2.12408 1.69861 0.0262811 0.00516098 0.00740936 -0.99986 0.0141039 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 3.99988 0.000149692 0.0206515 4.00023 0.0290442 0.00111324 +EDGE_SE3:QUAT 407 1150 -1.64434 1.68614 -0.0109519 -0.0201643 -0.0104532 0.993308 0.113244 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 3.99888 0.00166289 0.0821026 4.00475 0.0586248 0.0538666 +EDGE_SE3:QUAT 408 1150 -5.83116 2.04319 -0.0778745 -0.0238612 -0.0141555 0.987253 0.156723 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 3.99885 0.00266353 0.0985432 4.00537 0.0825496 0.102451 +EDGE_SE3:QUAT 1151 1152 4.32593 -0.892921 0.0054401 0.000867897 -0.00156485 -0.189103 0.981956 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 4.00002 -1.18694e-05 -0.00993086 4 0.000855266 3.85698 +EDGE_SE3:QUAT 404 1151 4.65271 2.93035 0.0552333 0.00574784 0.0108869 -0.986817 0.161368 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 3.99971 0.000162311 0.0242377 4.00057 0.0335204 0.104602 +EDGE_SE3:QUAT 405 1151 1.39263 2.12309 0.0109933 0.00273337 0.00763967 -0.999967 0.000707222 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 3.99997 8.373e-05 0.0109344 3.99989 0.0305436 0.000265122 +EDGE_SE3:QUAT 406 1151 -2.00731 2.33125 0.00901203 -0.000862517 -0.00444587 0.98727 0.158987 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 4 -1.0311e-05 0.00343544 3.99992 0.0177388 0.101191 +EDGE_SE3:QUAT 407 1151 -5.47719 3.33804 -0.127146 -0.0146055 -0.0104338 0.958885 0.283227 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 3.99998 0.000971495 0.0631543 4.00068 0.0640715 0.322997 +EDGE_SE3:QUAT 1152 1153 3.96649 -0.751589 -0.00557139 0.00281962 0.00160949 -0.158149 0.98741 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 4.00005 1.06246e-05 0.0176579 3.99998 -0.00152407 3.90003 +EDGE_SE3:QUAT 403 1152 3.85823 2.9374 -0.00138002 0.00147507 0.00892667 -0.990333 0.138418 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 3.99994 0.000110552 0.00625772 3.99985 0.032406 0.0769168 +EDGE_SE3:QUAT 404 1152 0.297069 2.39631 0.0138716 -0.00214974 -0.0106345 0.99955 0.0279712 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 3.99999 6.81655e-05 0.00860843 3.99959 0.0429336 0.00360932 +EDGE_SE3:QUAT 405 1152 -2.899 2.97868 0.00648743 5.42721e-05 -0.00693154 0.982095 0.188261 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 3.99997 -6.16619e-05 -0.000598689 3.99986 0.0252211 0.141934 +EDGE_SE3:QUAT 406 1152 -5.79965 4.51581 0.0162491 0.00148476 -0.00374313 0.939518 0.342476 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 3.99996 9.80937e-06 -0.00809157 4.00009 0.00717657 0.469197 +EDGE_SE3:QUAT 1153 1154 4.04927 -0.565296 -0.0179269 0.00436713 0.00530958 -0.0997971 0.994984 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 4.00048 2.64049e-05 0.0470437 3.99986 -0.00242105 3.96071 +EDGE_SE3:QUAT 402 1153 3.43347 2.80266 0.00466216 -0.000121948 0.00967163 -0.993877 0.110067 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 3.99998 7.40432e-05 -0.000392733 3.99966 0.0376244 0.0488173 +EDGE_SE3:QUAT 403 1153 -0.162569 2.56644 -0.00994492 -0.00205083 -0.00649741 0.99978 0.019837 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 3.99999 4.82761e-05 0.00820825 3.99989 0.0262894 0.00176373 +EDGE_SE3:QUAT 404 1153 -3.62758 3.37777 0.0124154 -0.00190279 -0.00803531 0.982591 0.185599 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 3.99999 -3.74959e-05 0.00758312 3.99973 0.0321336 0.13807 +EDGE_SE3:QUAT 1154 1155 4.16282 -0.243318 0.0220627 0.00159096 -0.000500196 -0.0300063 0.999548 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 3.99999 -2.71208e-06 -0.00342363 4 4.84808e-05 3.9964 +EDGE_SE3:QUAT 401 1154 3.48294 2.40125 0.0228418 0.00544582 0.0040599 -0.998613 0.0522077 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 3.99987 5.44513e-05 0.0218767 4.00046 0.013863 0.0110708 +EDGE_SE3:QUAT 402 1154 -0.623616 2.46229 -0.0107714 0.00460869 0.00576026 -0.999918 0.0104925 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 3.99991 0.000103464 0.0184385 4.00022 0.0226502 0.000653638 +EDGE_SE3:QUAT 403 1154 -4.18241 3.28618 -0.0338854 -0.00663519 -0.00207974 0.992813 0.119474 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 3.99987 0.000161897 0.0270751 4.00058 0.0142783 0.0573333 +EDGE_SE3:QUAT 1155 1156 4.21962 -0.140991 0.0258316 0.000388066 -0.00394703 -0.0132817 0.999904 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 4.00025 -1.10597e-05 -0.0315078 3.99994 0.000209262 3.99954 +EDGE_SE3:QUAT 400 1155 3.37982 2.09713 0.0137944 0.0048118 0.00166275 -0.999891 0.0138684 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 3.99991 2.45171e-05 0.0192526 4.00036 0.00611481 0.000871366 +EDGE_SE3:QUAT 401 1155 -0.69443 2.21174 -0.00140656 0.0048743 0.00295797 -0.999744 0.0219133 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 3.9999 4.62934e-05 0.0195114 4.00036 0.010965 0.00204606 +EDGE_SE3:QUAT 402 1155 -4.79196 2.61325 -0.0243252 -0.00407184 -0.00422398 0.999787 0.0198075 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 3.99994 7.34322e-05 0.016297 4.00018 0.0175257 0.00171259 +EDGE_SE3:QUAT 444 1155 3.99994 5.72701 0.148886 0.0137689 0.00410034 -0.555827 0.831174 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 4.00135 -0.000820439 0.0918101 3.99979 -0.0317762 2.76633 +EDGE_SE3:QUAT 445 1155 -2.36594 6.03013 0.0941486 0.0098957 0.00548309 -0.397768 0.917416 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 4.00105 -0.000348174 0.0761525 3.99972 -0.0174525 3.36857 +EDGE_SE3:QUAT 1086 1155 3.06869 6.70248 0.156718 0.0137247 0.00540693 -0.500337 0.865705 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 4.00158 -0.000797732 0.0967769 3.99968 -0.0292023 3.00099 +EDGE_SE3:QUAT 1087 1155 -3.41521 6.7141 0.124209 0.0114983 0.00615429 -0.345925 0.938172 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 4.00125 -0.000262773 0.0846187 3.99959 -0.0167967 3.52312 +EDGE_SE3:QUAT 1156 1157 4.12738 -0.0975793 0.0043553 -0.00586085 -0.00145697 -0.0049984 0.999969 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 3.9999 3.52602e-05 -0.0120064 3.99999 2.99863e-05 3.99994 +EDGE_SE3:QUAT 399 1156 3.39529 2.01457 0.0151874 -0.00234811 -0.000905643 0.999951 0.00960398 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 3.99998 9.70197e-06 0.00939372 4.00008 0.00380224 0.000394623 +EDGE_SE3:QUAT 400 1156 -0.864952 2.12689 -0.00105821 0.000904523 0.00135639 -0.999998 0.000617553 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 4 4.90452e-06 0.0036181 4.00001 0.00542111 1.21453e-05 +EDGE_SE3:QUAT 401 1156 -4.91198 2.18323 -0.0188189 0.000921534 0.00260644 -0.999961 0.00835865 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 4 9.88073e-06 0.00368657 3.99999 0.0103623 0.000309712 +EDGE_SE3:QUAT 444 1156 5.48233 1.76099 0.0737657 0.0115966 0.000722685 -0.567066 0.823591 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 4.00051 -0.000230625 0.06524 3.99977 -0.0251547 2.71479 +EDGE_SE3:QUAT 445 1156 0.403807 2.84937 0.0418874 0.00847404 0.00189745 -0.40971 0.912175 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 4.00029 -3.39163e-05 0.0485278 3.99984 -0.0124439 3.32913 +EDGE_SE3:QUAT 446 1156 -5.16362 1.64795 -0.00201908 0.00859053 0.000975617 -0.176388 0.984283 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 3.99986 0.000103302 0.0252489 3.99994 -0.00274873 3.8757 +EDGE_SE3:QUAT 1086 1156 5.0387 2.97196 0.0809896 0.0120035 0.00194923 -0.51171 0.859072 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 4.00066 -0.000245852 0.0707476 3.99973 -0.0234997 2.95385 +EDGE_SE3:QUAT 1087 1156 -0.296367 3.84568 0.0640123 0.0102906 0.0026431 -0.358445 0.93349 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 4.00039 5.261e-06 0.0576829 3.99976 -0.0126849 3.48688 +EDGE_SE3:QUAT 1088 1156 -5.52535 2.88513 -0.0170461 0.00678535 -0.000579457 -0.195567 0.980667 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 3.99984 5.18967e-05 0.0111455 3.99998 -0.00161727 3.84704 +EDGE_SE3:QUAT 1157 1158 4.11182 -0.0793112 0.0153426 0.00202246 0.012029 0.00448371 0.999916 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 4.00229 0.000112911 0.096168 3.99942 0.000222854 4.00223 +EDGE_SE3:QUAT 398 1157 3.37825 2.08707 0.0130503 -0.0046988 -0.00687037 0.999716 0.022317 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 3.99992 0.000131531 0.0188099 4.00013 0.0282883 0.00228083 +EDGE_SE3:QUAT 399 1157 -0.740037 2.18808 0.00149086 -0.00109477 -0.00669225 0.999866 0.0148738 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 4 2.43039e-05 0.00438064 3.99984 0.026884 0.00107045 +EDGE_SE3:QUAT 400 1157 -4.97495 2.20801 -0.00155007 0.000240609 -0.00722794 0.999963 0.00466817 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 4 -8.8976e-06 -0.000962563 3.99979 0.0289005 0.000296223 +EDGE_SE3:QUAT 444 1157 6.85309 -2.10793 0.0214833 0.00624872 0.00314267 -0.570988 0.820929 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 4.00041 -0.000304969 0.0474265 4 -0.0158793 2.69645 +EDGE_SE3:QUAT 445 1157 3.06333 -0.306166 -0.00216368 0.00246561 0.00312853 -0.414479 0.91005 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 4.0002 -0.00010196 0.0297245 3.99998 -0.00648898 3.31305 +EDGE_SE3:QUAT 446 1157 -1.29864 0.118865 -0.0141539 0.00242692 0.000711045 -0.181761 0.983339 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 4 8.61029e-06 0.0105857 3.99999 -0.00111348 3.86788 +EDGE_SE3:QUAT 447 1157 -5.19241 -1.64993 -0.148207 0.00360584 -0.0127986 0.083152 0.996448 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 4.0027 0.000149891 -0.104973 3.99932 -0.0043924 3.9751 +EDGE_SE3:QUAT 1086 1157 6.90914 -0.700961 0.020001 0.00644301 0.00390609 -0.516263 0.856397 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 4.00052 -0.000328297 0.0524609 3.99996 -0.0155339 2.93458 +EDGE_SE3:QUAT 1087 1157 2.71476 1.00863 0.0182994 0.0043483 0.00339262 -0.363295 0.931658 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 4.00031 -0.000102027 0.039241 3.99993 -0.00790608 3.47245 +EDGE_SE3:QUAT 1088 1157 -1.75759 1.21619 -0.0123776 0.00085393 -0.000736771 -0.200816 0.979628 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 4 -2.42093e-06 -0.00353878 4 0.000274215 3.8387 +EDGE_SE3:QUAT 1089 1157 -6.12295 0.221279 -0.102985 -0.00159505 -0.00975331 -0.0568757 0.998332 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 4.00154 -6.88989e-05 -0.0787611 3.99962 0.00224509 3.98861 +EDGE_SE3:QUAT 1158 1159 4.13501 -0.0912331 0.0134116 0.00180169 -0.00285197 0.00169401 0.999993 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 4.00012 -2.0268e-05 -0.0228528 3.99997 -1.90158e-05 4.00012 +EDGE_SE3:QUAT 397 1158 3.42219 2.27217 0.0171629 -0.00243429 -0.00523681 0.999866 0.0153181 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 3.99998 4.96215e-05 0.0097408 3.99998 0.0212335 0.00107504 +EDGE_SE3:QUAT 398 1158 -0.705218 2.36251 -0.0118419 -0.0166515 -0.00465993 0.999686 0.0181454 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 3.99892 0.000427592 0.066633 4.00428 0.0210732 0.00253853 +EDGE_SE3:QUAT 399 1158 -4.82338 2.41301 0.0114057 -0.0131964 -0.00481563 0.999845 0.0106199 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 3.99931 0.000296779 0.0527924 4.00266 0.0203975 0.001252 +EDGE_SE3:QUAT 445 1158 5.70418 -3.46194 -0.0211009 0.0089038 0.01325 -0.410554 0.911696 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 4.00323 -0.00173271 0.119397 3.99971 -0.0254066 3.32933 +EDGE_SE3:QUAT 446 1158 2.5095 -1.44298 -0.00914215 0.00625085 0.0122369 -0.177225 0.984074 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 4.00267 -0.000395685 0.106399 3.99934 -0.00967221 3.87719 +EDGE_SE3:QUAT 447 1158 -1.11625 -1.05074 -0.0177384 0.00431505 -0.000704053 0.0877213 0.996135 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 3.99995 -2.22541e-05 -0.0100864 3.99999 -0.000507714 3.96924 +EDGE_SE3:QUAT 448 1158 -4.53806 -2.56421 -0.0506257 0.00152156 -0.00268403 0.345885 0.938272 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 4.00013 5.522e-05 -0.0235491 3.99998 -0.00419152 3.52159 +EDGE_SE3:QUAT 1087 1158 5.68319 -1.84027 -0.0102288 0.0104079 0.0140277 -0.358991 0.933178 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 4.00394 -0.0016354 0.132358 3.99937 -0.0249919 3.48888 +EDGE_SE3:QUAT 1088 1158 1.98238 -0.489652 0.00379758 0.0050329 0.0106814 -0.196173 0.980498 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 4.00202 -0.000378968 0.0921531 3.99952 -0.00925663 3.84819 +EDGE_SE3:QUAT 1089 1158 -2.08082 -0.335593 -0.00305303 0.000869993 0.00207254 -0.0522756 0.99863 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 4.00007 1.84875e-06 0.0170574 3.99998 -0.000449933 3.98914 +EDGE_SE3:QUAT 1090 1158 -6.2505 -0.523893 -0.0078734 0.000584359 0.00239122 -0.0122092 0.999922 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 4.00009 3.93471e-06 0.0192114 3.99998 -0.00011737 3.9995 +EDGE_SE3:QUAT 1159 1160 4.19532 -0.0849092 0.0102361 -0.000212607 0.000229481 0.00251955 0.999997 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 4 -1.92865e-07 0.00184226 4 2.32325e-06 3.99998 +EDGE_SE3:QUAT 396 1159 3.5075 2.41546 0.00854831 -0.00243867 -0.000793701 0.999946 0.0100491 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 3.99998 9.11388e-06 0.00975612 4.00009 0.00337015 0.000430578 +EDGE_SE3:QUAT 397 1159 -0.678848 2.48169 0.00836101 0.000521103 -0.00363713 0.999909 0.0130129 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 4 -8.85191e-06 -0.00208505 3.99995 0.0144881 0.000730919 +EDGE_SE3:QUAT 398 1159 -4.78539 2.60875 -0.132661 -0.0137848 -0.00293024 0.999766 0.0164206 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 3.99925 0.000235083 0.0551574 4.00297 0.0135379 0.00188525 +EDGE_SE3:QUAT 446 1159 6.3331 -2.95902 -0.104208 0.00755588 0.00908748 -0.175245 0.984454 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 4.00157 -0.000114749 0.0849716 3.99956 -0.00779768 3.87896 +EDGE_SE3:QUAT 447 1159 2.95584 -0.417988 0.00491159 0.00631145 -0.00344068 0.0892765 0.995981 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 4.00013 -7.83284e-05 -0.0339232 3.99992 -0.00160767 3.96841 +EDGE_SE3:QUAT 448 1159 -1.3279 0.0512818 -0.0113838 0.00417742 -0.0049045 0.347333 0.93772 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 4.00052 0.000191412 -0.0483719 3.9999 -0.00895128 3.51802 +EDGE_SE3:QUAT 449 1159 -5.3943 -1.52474 -0.0302551 0.00490034 -0.00430937 0.556537 0.830797 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 4.00042 0.000346712 -0.0457457 4.00004 -0.0137416 2.76159 +EDGE_SE3:QUAT 1088 1159 5.75308 -2.15321 -0.0782369 0.0061442 0.00752529 -0.194632 0.980828 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 4.0011 -0.00012025 0.0708202 3.9997 -0.00723711 3.84973 +EDGE_SE3:QUAT 1089 1159 2.02096 -0.857869 -0.00844758 0.00270229 -0.000833166 -0.0506292 0.998714 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 3.99998 -6.55322e-06 -0.00500069 4 0.000112549 3.98975 +EDGE_SE3:QUAT 1090 1159 -2.12617 -0.711701 -0.0161621 0.00224279 -0.000383734 -0.0103624 0.999944 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 3.99998 -3.05642e-06 -0.00279049 4 1.39824e-05 3.99957 +EDGE_SE3:QUAT 1091 1159 -6.14917 -0.599943 -0.0240799 0.00284519 9.01124e-05 -0.0118939 0.999925 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 3.99997 1.79066e-06 0.00112678 4 -7.50442e-06 3.99943 +EDGE_SE3:QUAT 1160 1161 4.23607 -0.103359 0.0229552 -0.000160935 0.000687636 0.000617865 1 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 4.00001 -4.35776e-07 0.00550228 4 1.69814e-06 4.00001 +EDGE_SE3:QUAT 395 1160 3.54571 2.51332 0.00930659 -0.00366356 0.000272608 0.999987 0.00349225 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 3.99995 -2.87193e-06 0.0146544 4.00021 -0.000988117 0.000102717 +EDGE_SE3:QUAT 396 1160 -0.653033 2.57882 0.00166942 -0.00260101 -0.00105539 0.999969 0.00741844 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 3.99997 1.211e-05 0.0104049 4.0001 0.0043755 0.000251987 +EDGE_SE3:QUAT 397 1160 -4.87352 2.6749 0.0222681 0.000162767 -0.00370148 0.99993 0.0112768 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 4 -3.63308e-06 -0.000651252 3.99995 0.0147864 0.000563435 +EDGE_SE3:QUAT 447 1160 7.1001 0.234733 0.0452709 0.00599459 -0.00339213 0.091594 0.995773 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 4.00013 -7.09613e-05 -0.0333489 3.99992 -0.00162052 3.96672 +EDGE_SE3:QUAT 448 1160 1.91381 2.71724 0.0533285 0.00406553 -0.00480755 0.349473 0.936925 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 4.00049 0.000185846 -0.0473016 3.99991 -0.00880134 3.51203 +EDGE_SE3:QUAT 449 1160 -3.7307 2.29728 0.0306551 0.00475327 -0.00420094 0.558575 0.82943 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 4.0004 0.000329852 -0.0444172 4.00004 -0.0133727 2.75247 +EDGE_SE3:QUAT 790 1160 1.41438 4.55629 0.103906 0.00980246 0.00405672 -0.492946 0.869995 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 4.00084 -0.000414334 0.0699856 3.99983 -0.0206912 3.02924 +EDGE_SE3:QUAT 791 1160 -4.8775 3.72329 0.102317 0.00761529 0.00627165 -0.279074 0.960219 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 4.00094 -0.000169497 0.0686223 3.99973 -0.0104629 3.68965 +EDGE_SE3:QUAT 1089 1160 6.1911 -1.36965 0.0105834 0.00256265 -0.00055843 -0.048444 0.998822 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 3.99998 -3.35248e-06 -0.00296428 4 5.96556e-05 3.99061 +EDGE_SE3:QUAT 1090 1160 2.08073 -0.880071 -0.00344315 0.00222419 -0.000329371 -0.00823334 0.999964 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 3.99998 -2.62282e-06 -0.00241495 4 9.64467e-06 3.99973 +EDGE_SE3:QUAT 1091 1160 -1.96268 -0.786066 -0.0139831 0.0026755 0.000447181 -0.00946739 0.999952 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 3.99998 5.27534e-06 0.00388087 4 -1.88351e-05 3.99965 +EDGE_SE3:QUAT 1092 1160 -6.0476 -0.664658 0.00423815 0.00184154 0.00286944 -0.011906 0.999923 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 4.00012 1.90617e-05 0.0232143 3.99997 -0.000138348 3.99957 +EDGE_SE3:QUAT 1161 1162 4.2433 -0.0728516 0.0301479 -0.00265524 -0.00194353 0.00115867 0.999994 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 4.00003 2.06822e-05 -0.0155114 3.99998 -9.2193e-06 4.00005 +EDGE_SE3:QUAT 394 1161 3.55671 2.55097 0.0293262 0.00687416 0.0015551 -0.999973 0.00203187 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 3.99981 4.05197e-05 0.0274962 4.00075 0.00611016 0.000214866 +EDGE_SE3:QUAT 395 1161 -0.685854 2.63684 0.00439707 -0.0042458 0.000317175 0.999987 0.00289259 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 3.99993 -4.13806e-06 0.0169833 4.00029 -0.00117054 0.00010592 +EDGE_SE3:QUAT 396 1161 -4.89405 2.74264 0.00047168 -0.00315888 -0.00127673 0.99997 0.00701714 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 3.99996 1.77105e-05 0.0126364 4.00015 0.00528388 0.000243863 +EDGE_SE3:QUAT 448 1161 5.17091 5.41139 0.121699 0.003436 -0.00436945 0.349912 0.936766 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 4.00039 0.000153072 -0.0419905 3.99993 -0.00777153 3.51069 +EDGE_SE3:QUAT 449 1161 -2.04639 6.18892 0.107361 0.00412569 -0.00378662 0.55872 0.829337 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 4.00031 0.000260992 -0.0391891 4.00004 -0.0117261 2.75171 +EDGE_SE3:QUAT 790 1161 3.51533 0.856664 0.0514954 0.00991261 0.00456965 -0.49255 0.870216 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 4.00095 -0.000486848 0.0732317 3.99983 -0.021379 3.03092 +EDGE_SE3:QUAT 791 1161 -1.32736 1.35563 0.0508259 0.00741939 0.00693928 -0.278961 0.960249 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 4.0011 -0.000226652 0.0727299 3.99971 -0.0109704 3.69004 +EDGE_SE3:QUAT 792 1161 -5.88549 -0.598011 -0.0531555 0.0079501 6.52731e-05 -0.0183335 0.9998 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 3.99975 1.13181e-05 0.00227044 4 -2.61454e-05 3.99866 +EDGE_SE3:QUAT 1090 1161 6.32775 -1.03802 0.021192 0.00206524 0.000247718 -0.00786005 0.999967 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 3.99998 2.3009e-06 0.00217634 4 -8.80446e-06 3.99975 +EDGE_SE3:QUAT 1091 1161 2.29022 -0.948676 -0.000672145 0.00276706 0.000991381 -0.00894724 0.999956 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 3.99999 1.12956e-05 0.00822711 4 -3.71777e-05 3.9997 +EDGE_SE3:QUAT 1092 1161 -1.80069 -0.853179 0.00181592 0.00170741 0.00370095 -0.0114634 0.999926 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 4.00021 2.17274e-05 0.029838 3.99994 -0.000170916 3.9997 +EDGE_SE3:QUAT 1093 1161 -5.83854 -0.737376 -0.0548398 0.00196188 0.000265266 -0.0144804 0.999893 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 3.99999 2.49569e-06 0.0024623 4 -1.86445e-05 3.99916 +EDGE_SE3:QUAT 1162 1163 4.33042 -0.0993379 0.0121204 0.00118952 0.000298688 0.00093705 0.999999 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 4 1.41256e-06 0.00237612 4 1.11371e-06 4 +EDGE_SE3:QUAT 393 1162 3.49906 2.52418 0.0163816 0.00336204 0.00514225 -0.999947 0.00829349 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 3.99995 6.85898e-05 0.01345 4.00008 0.0203434 0.000423824 +EDGE_SE3:QUAT 394 1162 -0.669428 2.62089 0.00434514 0.00513559 0.00419481 -0.999973 0.00308777 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 3.99989 8.46673e-05 0.0205429 4.00035 0.0166543 0.000212976 +EDGE_SE3:QUAT 395 1162 -4.94053 2.75187 -1.92412e-05 -0.00254362 -0.00224557 0.999993 0.0018656 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 3.99997 2.30625e-05 0.0101746 4.00008 0.00902046 6.01442e-05 +EDGE_SE3:QUAT 790 1162 5.64016 -2.83622 0.00350752 0.00676424 0.00444452 -0.491832 0.870652 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 4.00063 -0.000365069 0.0569645 3.99994 -0.015913 3.03321 +EDGE_SE3:QUAT 791 1162 2.21531 -0.986782 0.00888521 0.00452593 0.00591424 -0.277727 0.960631 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 4.00071 -0.000185572 0.0562645 3.99984 -0.00823952 3.69226 +EDGE_SE3:QUAT 792 1162 -1.63683 -0.834428 -0.0207759 0.00523365 -0.00178057 -0.0173783 0.999834 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 3.99993 -3.46135e-05 -0.0131465 3.99999 0.000111406 3.99884 +EDGE_SE3:QUAT 793 1162 -4.88994 -2.60806 -0.0565042 0.000561834 -0.00365632 0.247968 0.968761 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 4.0002 6.96723e-05 -0.0281991 3.99996 -0.00344883 3.75425 +EDGE_SE3:QUAT 1091 1162 6.51526 -1.11772 0.0204006 7.27625e-05 -0.000715887 -0.00763952 0.999971 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 4.00001 -3.01798e-07 -0.00571993 4 2.18406e-05 3.99977 +EDGE_SE3:QUAT 1092 1162 2.43867 -1.03346 0.00232589 -0.000997967 0.00191423 -0.0101836 0.999946 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 4.00005 -8.44335e-06 0.0151897 3.99999 -7.72213e-05 3.99964 +EDGE_SE3:QUAT 1093 1162 -1.60147 -0.945511 -0.0240755 -0.000588888 -0.00170466 -0.0132483 0.999911 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 4.00005 3.11736e-06 -0.0137274 3.99999 9.10926e-05 3.99935 +EDGE_SE3:QUAT 1094 1162 -5.75442 -0.835532 -0.0159619 0.000341097 0.000703607 -0.0162904 0.999867 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 4.00001 7.77607e-07 0.00569329 4 -4.65439e-05 3.99895 +EDGE_SE3:QUAT 1163 1164 4.22662 -0.107332 0.0202086 0.00314676 -0.000562999 0.00108971 0.999994 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 3.99997 -7.16429e-06 -0.00454507 4 -2.4596e-06 4 +EDGE_SE3:QUAT 392 1163 3.39726 2.45441 0.0154233 0.0039296 0.0042366 -0.999917 0.0115575 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 3.99994 6.38391e-05 0.0157219 4.00018 0.0165787 0.000664829 +EDGE_SE3:QUAT 393 1163 -0.81436 2.55588 -0.00328594 0.00386846 0.00410871 -0.999941 0.00923696 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 3.99994 6.14322e-05 0.0154761 4.00018 0.0161467 0.000466349 +EDGE_SE3:QUAT 394 1163 -5.00412 2.68936 -0.0282973 0.0055557 0.00322389 -0.99997 0.00434405 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 3.99988 6.87949e-05 0.0222234 4.00046 0.012704 0.000239301 +EDGE_SE3:QUAT 791 1163 5.83167 -3.38687 -0.0453254 0.00567984 0.00594794 -0.276908 0.960861 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 4.00077 -0.000173124 0.0601371 3.99981 -0.00892449 3.69419 +EDGE_SE3:QUAT 792 1163 2.69089 -1.08742 0.00183775 0.00651673 -0.00152194 -0.0163412 0.999844 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 3.99986 -3.48633e-05 -0.0108923 3.99999 8.58081e-05 3.99896 +EDGE_SE3:QUAT 793 1163 -1.03744 -0.611161 -0.00734573 0.00180775 -0.00315674 0.249093 0.968473 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 4.00018 4.66092e-05 -0.0281216 3.99996 -0.00362409 3.75201 +EDGE_SE3:QUAT 794 1163 -4.68828 -2.20767 -0.000851524 0.00325595 -0.00136411 0.504077 0.863652 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 4.00009 4.95686e-05 -0.0233896 3.99998 -0.00706888 2.98376 +EDGE_SE3:QUAT 1092 1163 6.78119 -1.22589 -0.00331268 0.000164533 0.0022409 -0.0095744 0.999952 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 4.00008 3.21092e-07 0.0179439 3.99998 -8.5912e-05 3.99971 +EDGE_SE3:QUAT 1093 1163 2.70211 -1.16957 -0.000694611 0.000735484 -0.00142482 -0.0120661 0.999926 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 4.00003 -4.71765e-06 -0.0112897 3.99999 6.79286e-05 3.99945 +EDGE_SE3:QUAT 1094 1163 -1.43245 -1.07462 -0.0151507 0.00148442 0.000969883 -0.0149736 0.999886 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 4.00001 5.66402e-06 0.00802314 4 -6.06921e-05 3.99912 +EDGE_SE3:QUAT 1095 1163 -5.83568 -0.951646 -0.0470104 0.00076047 0.000124662 -0.0186332 0.999826 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 4 4.56226e-07 0.00116677 4 -1.13965e-05 3.99861 +EDGE_SE3:QUAT 1164 1165 4.20178 -0.0975152 0.0156758 -0.00071378 -0.00216905 0.0013651 0.999996 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 4.00007 6.34169e-06 -0.0173409 3.99998 -1.19145e-05 4.00007 +EDGE_SE3:QUAT 338 1164 -0.735471 6.34092 0.141612 0.0134074 0.00498576 -0.441715 0.897041 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 4.00132 -0.000454016 0.0906625 3.99959 -0.02414 3.22159 +EDGE_SE3:QUAT 391 1164 3.38542 2.373 0.0146941 0.00498213 -0.000396195 -0.999895 0.0135984 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 3.9999 -1.59569e-05 0.0199338 4.0004 -0.00212625 0.000840159 +EDGE_SE3:QUAT 392 1164 -0.840491 2.47273 0.00294568 0.00362106 0.00122005 -0.999914 0.0125752 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 3.99995 1.38233e-05 0.0144876 4.00021 0.00451436 0.000690117 +EDGE_SE3:QUAT 393 1164 -5.07433 2.58609 -0.0249236 0.00348391 0.00109631 -0.999944 0.00991981 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 3.99995 1.24624e-05 0.0139376 4.00019 0.004108 0.000446399 +EDGE_SE3:QUAT 792 1164 6.92407 -1.32972 0.03365 0.00969218 -0.00209379 -0.0154054 0.999832 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 3.99968 -7.09096e-05 -0.0149508 3.99999 0.000111401 3.99911 +EDGE_SE3:QUAT 793 1164 2.72598 1.34864 0.0397841 0.00508028 -0.00295934 0.250156 0.968188 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 4.00022 5.46346e-06 -0.0361037 3.99992 -0.00505182 3.75001 +EDGE_SE3:QUAT 794 1164 -2.52063 1.43524 0.0402717 0.00643705 -0.000488587 0.504905 0.863151 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 4.00013 3.01412e-05 -0.0348885 3.99992 -0.0118146 2.98058 +EDGE_SE3:QUAT 795 1164 -6.80585 -0.269315 0.0726525 0.00851327 0.00191553 0.659237 0.751885 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 4.00012 3.9349e-05 -0.0413232 3.99985 -0.0215947 2.26204 +EDGE_SE3:QUAT 1093 1164 6.94188 -1.37803 0.0275877 0.00375379 -0.00182296 -0.0109727 0.999931 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 3.99999 -2.69583e-05 -0.0140866 3.99999 7.66609e-05 3.99957 +EDGE_SE3:QUAT 1094 1164 2.80548 -1.29955 -0.00790611 0.00460207 0.00051006 -0.0139155 0.999892 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 3.99992 1.16287e-05 0.00484754 4 -3.54696e-05 3.99923 +EDGE_SE3:QUAT 1095 1164 -1.60357 -1.21535 -0.0321165 0.00407512 -0.000418929 -0.0176205 0.999836 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 3.99994 -4.53114e-06 -0.00248831 4 1.93982e-05 3.99876 +EDGE_SE3:QUAT 1096 1164 -5.84789 -1.21019 -0.0333316 0.00449808 0.00175234 -0.00931245 0.999945 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 3.99997 3.23057e-05 0.0145193 3.99999 -6.80339e-05 3.99971 +EDGE_SE3:QUAT 1165 1166 4.12552 -0.0815627 0.0152637 -0.002479 -0.00180188 0.000945196 0.999995 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 4.00003 1.7895e-05 -0.014387 3.99999 -6.98761e-06 4.00005 +EDGE_SE3:QUAT 337 1165 6.83033 1.2918 0.046978 0.00976981 0.0040137 -0.605414 0.79584 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 4.00084 -0.000692697 0.0698439 4.00005 -0.0254018 2.53511 +EDGE_SE3:QUAT 338 1165 1.76584 2.9534 0.0674143 0.0119154 0.0030701 -0.440539 0.897649 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 4.00073 -0.000185549 0.0726279 3.99969 -0.0199119 3.225 +EDGE_SE3:QUAT 339 1165 -3.51945 2.60354 0.0227966 0.00845765 0.00326285 -0.247321 0.968891 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 4.00028 5.63561e-05 0.0478258 3.99984 -0.00683895 3.75589 +EDGE_SE3:QUAT 390 1165 3.45869 2.24945 0.0181282 0.00404863 0.00120459 -0.99989 0.0142104 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 3.99993 1.40253e-05 0.0161993 4.00026 0.00435613 0.000878104 +EDGE_SE3:QUAT 391 1165 -0.821522 2.34719 -0.0111676 0.00279223 0.000292266 -0.999888 0.0146864 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 3.99997 5.16311e-07 0.0111725 4.00012 0.000840472 0.000894156 +EDGE_SE3:QUAT 392 1165 -5.03229 2.44966 -0.00828217 0.00126861 0.00165703 -0.999898 0.0141429 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 3.99999 8.14607e-06 0.00507603 4.00002 0.00648134 0.000817038 +EDGE_SE3:QUAT 793 1165 6.44382 3.29958 0.0946377 0.00521179 -0.00550035 0.25142 0.967848 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 4.00065 0.000116235 -0.0549673 3.99983 -0.00738176 3.74791 +EDGE_SE3:QUAT 794 1165 -0.381176 5.04995 0.0902839 0.00719588 -0.00264685 0.505776 0.862631 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 4.00041 0.000208402 -0.0498266 3.99991 -0.015319 2.97738 +EDGE_SE3:QUAT 795 1165 -6.15633 3.90946 0.1252 0.00964646 -6.82334e-05 0.65999 0.751213 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 4.00037 0.000281766 -0.0544541 3.99992 -0.0252782 2.25839 +EDGE_SE3:QUAT 1094 1165 7.01689 -1.51755 0.00642287 0.0038896 -0.00177985 -0.0129303 0.999907 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 3.99999 -2.70367e-05 -0.0136316 3.99999 8.70999e-05 3.99938 +EDGE_SE3:QUAT 1095 1165 2.58862 -1.44753 -0.00648709 0.00365823 -0.00262468 -0.016529 0.999853 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 4.00005 -3.92052e-05 -0.0202634 3.99997 0.000166027 3.99901 +EDGE_SE3:QUAT 1096 1165 -1.64984 -1.37991 -0.0329179 0.00371 -0.000431004 -0.00809422 0.99996 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 3.99995 -5.53431e-06 -0.00308729 4 1.20219e-05 3.99974 +EDGE_SE3:QUAT 1097 1165 -5.7655 -1.87437 -0.0800115 0.00282667 -0.0012619 0.0590378 0.998251 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 4 -1.4948e-05 -0.0120403 3.99999 -0.000374465 3.98609 +EDGE_SE3:QUAT 1166 1167 4.00114 -0.0905275 0.020585 0.00253942 0.0145574 0.00179151 0.999889 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 4.00336 0.000157327 0.116489 3.99915 0.00011748 4.00338 +EDGE_SE3:QUAT 338 1166 4.22466 -0.359102 0.0163031 0.00900916 0.0025353 -0.439374 0.898255 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 4.00045 -0.000123146 0.0560981 3.99982 -0.0152316 3.22858 +EDGE_SE3:QUAT 339 1166 0.0514964 0.560004 -0.00143496 0.00555868 0.00203504 -0.24623 0.969193 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 4.00011 2.6907e-05 0.0305839 3.99993 -0.0043733 3.75771 +EDGE_SE3:QUAT 340 1166 -4.32772 -0.530246 -0.162314 0.00330473 -0.014916 0.00410492 0.999875 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 4.00353 -0.00017615 -0.119579 3.99911 -0.000228412 4.0035 +EDGE_SE3:QUAT 389 1166 3.55957 2.10215 0.0189847 0.00578001 0.00614475 -0.999854 0.0148908 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 3.99986 0.00013418 0.0231286 4.00041 0.0238811 0.0011633 +EDGE_SE3:QUAT 390 1166 -0.646358 2.2167 -0.00222178 0.00215308 0.00363299 -0.999874 0.0153235 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 3.99998 3.10846e-05 0.00861561 4.00003 0.0142598 0.00100865 +EDGE_SE3:QUAT 391 1166 -4.92881 2.31778 -0.0159937 0.00103299 0.00270127 -0.999871 0.0157735 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 4 1.16331e-05 0.00413362 3.99999 0.0106681 0.00102794 +EDGE_SE3:QUAT 1095 1166 6.70393 -1.6665 0.0257099 0.00105883 -0.00436031 -0.015093 0.999876 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 4.0003 -2.51541e-05 -0.034681 3.99993 0.000261739 3.99939 +EDGE_SE3:QUAT 1096 1166 2.46605 -1.52916 -0.0170771 0.00114994 -0.00229223 -0.00685521 0.999973 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 4.00008 -1.13284e-05 -0.0182422 3.99998 6.25648e-05 3.9999 +EDGE_SE3:QUAT 1097 1166 -1.66589 -1.47603 -0.0440859 0.000546555 -0.00316234 0.0600427 0.998191 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 4.00016 7.65803e-06 -0.0255558 3.99996 -0.000769737 3.98574 +EDGE_SE3:QUAT 1098 1166 -5.35104 -2.64753 -0.171769 0.00450609 -0.0153128 0.217572 0.975914 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 4.00385 0.00101542 -0.12541 3.9992 -0.0137519 3.81458 +EDGE_SE3:QUAT 1167 1168 4.13715 -0.0869821 0.0196292 0.000607707 -0.00310083 0.0031952 0.99999 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 4.00015 -6.80945e-06 -0.0248304 3.99996 -3.95448e-05 4.00011 +EDGE_SE3:QUAT 339 1167 3.52516 -1.43194 -0.00608706 0.0114739 0.0157117 -0.244428 0.969472 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 4.00487 -0.00102864 0.147084 3.99883 -0.0188347 3.76642 +EDGE_SE3:QUAT 340 1167 -0.32362 -0.582755 -0.0174949 0.00576567 -0.000404849 0.00594185 0.999966 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 3.99987 -1.08876e-05 -0.00364955 4 -1.1222e-05 3.99986 +EDGE_SE3:QUAT 341 1167 -4.08992 -1.82307 -0.0498194 0.00484264 -0.00119361 0.280907 0.959722 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 4.00005 -2.26025e-05 -0.0239068 3.99996 -0.00406284 3.6845 +EDGE_SE3:QUAT 388 1167 3.74247 1.98785 0.0100743 0.00300716 0.00348016 -0.999886 0.0144062 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 3.99996 3.99963e-05 0.0120326 4.0001 0.0135675 0.000912383 +EDGE_SE3:QUAT 389 1167 -0.418646 2.09208 -0.00791704 0.0205609 0.00412351 -0.999638 0.0168698 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 3.99829 0.000170481 0.0822621 4.00677 0.0137386 0.00287843 +EDGE_SE3:QUAT 390 1167 -4.63372 2.18045 0.00513842 0.0170158 0.00140805 -0.999709 0.0170171 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 3.99884 -2.23009e-05 0.0680828 4.00464 0.00331662 0.00232056 +EDGE_SE3:QUAT 1096 1167 6.45445 -1.67954 0.0201311 0.00349004 0.0122157 -0.0053588 0.999905 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 4.00235 0.000152127 0.0979958 3.9994 -0.000250626 4.00228 +EDGE_SE3:QUAT 1097 1167 2.31456 -1.09492 0.00416788 0.00197368 0.0114315 0.0618775 0.998016 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 4.00199 0.000275819 0.0895035 3.99952 0.00275829 3.98669 +EDGE_SE3:QUAT 1098 1167 -1.70033 -1.02589 -0.0222014 0.00372221 -0.000536798 0.219338 0.975642 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 3.99999 -1.99063e-05 -0.0134711 3.99998 -0.00182317 3.80761 +EDGE_SE3:QUAT 1099 1167 -5.35315 -2.41815 -0.0143469 0.00414675 0.00140406 0.40831 0.912833 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 3.99994 -3.18433e-05 -0.00951572 3.99998 -0.00352009 3.33314 +EDGE_SE3:QUAT 1168 1169 4.12306 -0.0702771 0.026403 -0.000548331 -0.00177601 0.00451705 0.999988 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 4.00005 4.22534e-06 -0.0141781 3.99999 -3.20413e-05 3.99997 +EDGE_SE3:QUAT 340 1168 3.81337 -0.622089 0.00701913 0.00620751 -0.00356538 0.00924305 0.999932 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 4.00006 -8.84462e-05 -0.0292076 3.99995 -0.000134089 3.99987 +EDGE_SE3:QUAT 341 1168 -0.570538 0.335189 -0.00045511 0.0063403 -0.00383598 0.284129 0.958757 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 4.0004 4.47318e-05 -0.0475068 3.99986 -0.00757967 3.67764 +EDGE_SE3:QUAT 342 1168 -4.54061 -0.923131 0.00946864 0.00886078 -0.000888368 0.512393 0.858705 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 4.00028 8.53149e-05 -0.0494527 3.99985 -0.0168451 2.95041 +EDGE_SE3:QUAT 387 1168 3.79965 1.83256 0.0219868 0.00487734 0.00127673 -0.999941 0.00966707 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 3.9999 1.94863e-05 0.0195119 4.00038 0.00472915 0.000474589 +EDGE_SE3:QUAT 388 1168 -0.387828 1.94656 0.0118492 6.00744e-05 0.00253001 -0.999837 0.0178706 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 4 1.51709e-06 0.000240533 3.99997 0.0101034 0.00130297 +EDGE_SE3:QUAT 389 1168 -4.57 2.03468 -0.156402 0.0176004 0.00318653 -0.999641 0.0199319 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 3.99875 7.72089e-05 0.070433 4.00497 0.00994384 0.00285491 +EDGE_SE3:QUAT 1097 1168 6.42595 -0.673799 -0.0708556 0.0026784 0.00857232 0.0649805 0.997846 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 4.00106 0.000195838 0.0660766 3.99974 0.00212556 3.9842 +EDGE_SE3:QUAT 1098 1168 2.07889 0.66379 0.0102738 0.00500988 -0.00345016 0.222474 0.97492 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 4.00027 5.834e-06 -0.0385136 3.9999 -0.00469894 3.80239 +EDGE_SE3:QUAT 1099 1168 -2.53521 0.603059 0.0115552 0.00611713 -0.00108571 0.411118 0.911561 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 4.00012 4.99642e-06 -0.0333588 3.99992 -0.00872084 3.3242 +EDGE_SE3:QUAT 1100 1168 -6.54567 -0.838987 0.0292964 0.00708887 0.00126222 0.557181 0.83036 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 4.00003 -3.14573e-05 -0.031807 3.99989 -0.0135526 2.75843 +EDGE_SE3:QUAT 1169 1170 4.15503 -0.0811579 0.0215692 -0.00182119 -0.00180829 0.00163707 0.999995 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 4.00004 1.32579e-05 -0.0144305 3.99999 -1.19449e-05 4.00004 +EDGE_SE3:QUAT 341 1169 2.92814 2.49797 0.0666817 0.00603065 -0.00575342 0.288111 0.957561 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 4.00076 0.000171507 -0.0601245 3.99981 -0.00936318 3.66887 +EDGE_SE3:QUAT 342 1169 -2.53049 2.64294 0.0769395 0.00913458 -0.00287562 0.516559 0.856198 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 4.00059 0.000300221 -0.0610043 3.99987 -0.0194669 2.93359 +EDGE_SE3:QUAT 343 1169 -7.23065 0.997535 0.103636 0.00782567 0.00253545 0.663023 0.748554 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 4.00005 -1.73527e-05 -0.0355088 3.99985 -0.0197895 2.2419 +EDGE_SE3:QUAT 386 1169 3.96197 1.72016 0.0207097 0.00427008 0.00136339 -0.999969 0.00639694 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 3.99993 2.05736e-05 0.0170813 4.00029 0.00523501 0.000243481 +EDGE_SE3:QUAT 387 1169 -0.314618 1.81352 0.00733479 0.00334069 0.00173951 -0.999888 0.0145114 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 3.99995 1.96354e-05 0.013367 4.00017 0.00656704 0.000897786 +EDGE_SE3:QUAT 388 1169 -4.51315 1.8789 0.0297726 -0.00152274 0.00331266 -0.999746 0.0222195 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 3.99999 -1.93072e-05 -0.00609529 3.99999 0.0135049 0.00202974 +EDGE_SE3:QUAT 1098 1169 5.82724 2.38709 0.0687149 0.00450714 -0.00517238 0.226803 0.973916 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 4.00055 8.31209e-05 -0.0500803 3.99985 -0.00601495 3.79487 +EDGE_SE3:QUAT 1099 1169 0.252405 3.65227 0.0659414 0.00624163 -0.0029933 0.415223 0.909693 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 4.00036 0.000121881 -0.0455588 3.9999 -0.0110883 3.31088 +EDGE_SE3:QUAT 1100 1169 -4.91609 2.94801 0.0721972 0.0075986 -0.000729068 0.560818 0.827904 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 4.00024 0.000113059 -0.0437293 3.9999 -0.0164356 2.7424 +EDGE_SE3:QUAT 1170 1171 4.11277 -0.107838 0.0146464 0.000815187 -0.00417019 -0.0121024 0.999918 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 4.00027 -1.85553e-05 -0.0332377 3.99993 0.000201249 3.99969 +EDGE_SE3:QUAT 342 1170 -0.5193 6.27959 0.16177 0.00864142 -0.00522284 0.517756 0.855469 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 4.00094 0.000591738 -0.0702786 3.99994 -0.0208766 2.92895 +EDGE_SE3:QUAT 385 1170 3.85124 1.80147 0.017479 0.00250764 0.00231258 -0.999327 0.0365187 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 3.99997 1.87593e-05 0.0100515 4.00009 0.00848815 0.00537781 +EDGE_SE3:QUAT 386 1170 -0.185714 1.73874 0.00909816 0.00255321 0.00305394 -0.999959 0.00812399 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 3.99997 3.04939e-05 0.010214 4.00007 0.0120482 0.000326371 +EDGE_SE3:QUAT 387 1170 -4.4536 1.78025 0.000742087 0.00157452 0.00358514 -0.999863 0.0160663 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 3.99999 2.31812e-05 0.00630076 3.99999 0.0141291 0.00109236 +EDGE_SE3:QUAT 1099 1170 3.04873 6.74448 0.133403 0.00531426 -0.00525255 0.416333 0.909181 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 4.00065 0.000310832 -0.0550747 3.99991 -0.0124167 3.30742 +EDGE_SE3:QUAT 1171 1172 4.28931 -0.305949 -0.00438124 -0.00496923 0.00601196 -0.0788592 0.996855 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 4.00036 -0.000160212 0.0429669 3.9999 -0.00163062 3.97559 +EDGE_SE3:QUAT 384 1171 3.63936 1.83009 -0.00208478 -0.00103139 0.00308029 -0.993604 0.112873 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 4 -4.88587e-06 -0.00416825 3.99997 0.0128499 0.051007 +EDGE_SE3:QUAT 385 1171 -0.225331 1.60135 0.00947462 -0.00152941 0.00137225 -0.999695 0.0246017 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 3.99999 -9.32389e-06 -0.00612306 4.00003 0.00578158 0.00243871 +EDGE_SE3:QUAT 386 1171 -4.29272 1.78235 0.0112022 0.00176656 -0.00203913 0.999989 0.00392491 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 3.99999 -1.42425e-05 -0.00706643 4.00003 0.00810086 9.05094e-05 +EDGE_SE3:QUAT 1172 1173 4.1737 -0.754582 0.0046485 -0.000598503 0.00183582 -0.187312 0.982299 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 4.00004 -1.57478e-05 0.0126067 3.99999 -0.00111403 3.8597 +EDGE_SE3:QUAT 382 1172 6.52748 3.26791 0.0349942 0.0016694 0.00841907 -0.928577 0.371041 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 3.99985 1.84332e-05 0.0113481 4.0002 0.01839 0.550844 +EDGE_SE3:QUAT 383 1172 3.31615 1.51158 0.00593253 0.00161985 0.00824311 -0.981579 0.190871 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 3.99992 9.9201e-05 0.00728282 3.99996 0.0276254 0.145941 +EDGE_SE3:QUAT 384 1172 -0.59691 1.16991 0.00253051 0.00421803 0.00850644 -0.999368 0.0342458 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 3.99991 0.000145985 0.016906 4.00006 0.0327744 0.00503149 +EDGE_SE3:QUAT 385 1172 -4.51054 1.69591 0.0178024 -0.00450799 -0.00635524 0.998515 0.0539211 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 3.99994 0.00011826 0.0181036 4.00009 0.0271773 0.0118972 +EDGE_SE3:QUAT 1173 1174 4.02319 -0.89406 0.000418747 -0.000525172 -0.0010701 -0.208135 0.978099 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 4.00002 -4.14304e-06 -0.00928445 4 0.000991737 3.82674 +EDGE_SE3:QUAT 381 1173 6.77052 2.65742 0.0515063 0.00408055 0.00437304 -0.926534 0.376164 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 3.99992 -0.000157216 0.0212649 4.0004 0.00107799 0.566131 +EDGE_SE3:QUAT 382 1173 2.98517 0.93362 0.0146996 0.00164217 0.00975608 -0.981599 0.190699 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 3.9999 0.000138446 0.00745938 3.9999 0.0331088 0.145766 +EDGE_SE3:QUAT 383 1173 -0.837262 0.655081 0.0033484 0.00171001 0.00922425 -0.999949 0.00371723 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 3.99999 6.53415e-05 0.00684106 3.99971 0.0368439 0.000406368 +EDGE_SE3:QUAT 384 1173 -4.80343 1.63992 -0.00807054 -0.00431658 -0.00939175 0.988051 0.153782 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 4 7.09555e-05 0.0175964 3.9997 0.0405484 0.0950946 +EDGE_SE3:QUAT 1174 1175 4.22215 -0.905261 -0.0223289 0.0010685 0.000251073 -0.187507 0.982263 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 4 1.67071e-06 0.00425145 4 -0.000470273 3.85937 +EDGE_SE3:QUAT 380 1174 7.19041 1.4323 0.0267474 0.00082388 0.00836255 -0.959559 0.281383 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 3.9999 9.47067e-05 0.00515398 3.99997 0.0253087 0.316896 +EDGE_SE3:QUAT 381 1174 3.26958 0.495687 0.0197725 0.00177318 0.00501012 -0.984544 0.175059 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 3.99996 3.65425e-05 0.00762633 4.00004 0.0161149 0.122666 +EDGE_SE3:QUAT 382 1174 -1.08188 0.234653 0.00944919 0.00151658 -0.0101112 0.999788 0.0178616 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 3.99999 -7.46171e-05 -0.00607073 3.99964 0.0401945 0.00168942 +EDGE_SE3:QUAT 383 1174 -4.85404 1.51172 0.00463076 0.00122156 -0.0100016 0.978823 0.20446 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 3.9999 -0.000144175 -0.00586786 3.99986 0.0339734 0.167529 +EDGE_SE3:QUAT 1175 1176 4.1467 -0.616389 -0.0375449 0.00283306 0.0140276 -0.114938 0.99327 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 4.00321 -0.000397047 0.113959 3.99922 -0.00658108 3.9504 +EDGE_SE3:QUAT 379 1175 7.23895 0.175455 -0.0237566 -0.00859703 0.0099478 -0.990347 0.137984 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 3.99989 -0.000376255 -0.0351547 4.00023 0.0472282 0.0770378 +EDGE_SE3:QUAT 380 1175 3.15081 -0.0901672 0.0017945 -0.000167056 0.00725898 -0.995263 0.0969501 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 3.99999 3.49545e-05 -0.000624428 3.9998 0.0284836 0.0378022 +EDGE_SE3:QUAT 381 1175 -0.993684 -0.123553 -0.0150478 -0.00152431 -0.00446072 0.999916 0.0120993 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 3.99999 2.58838e-05 0.00609868 3.99995 0.0179839 0.000675741 +EDGE_SE3:QUAT 382 1175 -5.27348 1.28504 0.035657 0.00341163 -0.00818507 0.978732 0.204952 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 3.99985 -7.63763e-05 -0.0150426 4.00024 0.023997 0.168235 +EDGE_SE3:QUAT 1176 1177 4.24392 -0.3237 0.011474 0.00333086 0.00271519 -0.0385853 0.999246 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 4.00009 3.1912e-05 0.0232141 3.99997 -0.000456849 3.99418 +EDGE_SE3:QUAT 378 1176 7.29744 -0.444153 0.0433722 0.00466467 0.0113843 -0.999549 0.0274118 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 3.99989 0.000223921 0.0186848 3.9999 0.0444329 0.00358692 +EDGE_SE3:QUAT 379 1176 3.09319 -0.377517 0.0125525 0.00453315 0.00787996 -0.999692 0.023105 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 3.9999 0.00014176 0.0181492 4.00012 0.0306432 0.00245262 +EDGE_SE3:QUAT 380 1176 -1.01188 -0.280083 -0.0317138 -0.0131852 -0.00574554 0.999727 0.01844 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 3.99933 0.000374155 0.0527665 4.00258 0.0249304 0.00221184 +EDGE_SE3:QUAT 381 1176 -5.10925 0.583239 -0.0561145 -0.0148317 -0.00142924 0.991748 0.127337 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 3.99927 0.000714466 0.0607291 4.00322 0.0203782 0.0658994 +EDGE_SE3:QUAT 1177 1178 4.32958 -0.139477 0.030391 0.00349071 -0.00679397 -0.00272427 0.999967 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 4.00069 -9.76635e-05 -0.0542448 3.99982 7.77271e-05 4.00071 +EDGE_SE3:QUAT 377 1177 7.06973 -0.442448 0.0644813 -0.0103523 -0.00990937 0.999838 0.0109123 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 3.99959 0.000429572 0.0414212 4.00127 0.0405507 0.00131625 +EDGE_SE3:QUAT 378 1177 3.05126 -0.35815 0.0231341 -0.006865 -0.00813462 0.999881 0.0111548 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 3.99982 0.000229756 0.0274673 4.00046 0.0331481 0.000961042 +EDGE_SE3:QUAT 379 1177 -1.13087 -0.249046 -0.00375623 -0.00685909 -0.00472633 0.999858 0.0146475 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 3.99982 0.000143225 0.0274456 4.00064 0.0197036 0.00114362 +EDGE_SE3:QUAT 380 1177 -5.22125 0.170515 -0.139037 -0.0156234 -0.00318604 0.998248 0.0569804 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 3.99909 0.00051705 0.0627895 4.00369 0.0197674 0.0140737 +EDGE_SE3:QUAT 1178 1179 4.34549 -0.0953292 0.00590092 -0.000968933 -0.00195563 0.00251305 0.999994 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 4.00006 7.79092e-06 -0.0156159 3.99998 -1.96989e-05 4.00004 +EDGE_SE3:QUAT 376 1178 6.86523 -0.322254 0.0413854 -0.00556043 -0.00346216 0.999874 0.014441 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 3.99988 8.61075e-05 0.0222488 4.00043 0.014486 0.00101041 +EDGE_SE3:QUAT 377 1178 2.75545 -0.221807 0.00313167 -0.00324706 -0.00665614 0.999879 0.0136844 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 3.99996 8.48117e-05 0.0129926 3.99998 0.0269683 0.000973113 +EDGE_SE3:QUAT 378 1178 -1.25265 -0.13687 -0.00341246 6.0578e-05 -0.00481712 0.999896 0.0136014 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 4 -3.68532e-06 -0.000242497 3.99991 0.0192527 0.000832689 +EDGE_SE3:QUAT 379 1178 -5.4303 0.0103171 -0.0344923 8.07941e-05 -0.00144325 0.999848 0.0173956 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 4 -7.50924e-07 -0.000323385 3.99999 0.0057574 0.00121874 +EDGE_SE3:QUAT 1179 1180 4.00986 -0.0585926 -0.00340355 -0.00387237 0.000234206 0.00627861 0.999973 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 3.99994 -4.37013e-06 0.00216524 4 7.0961e-06 3.99984 +EDGE_SE3:QUAT 375 1179 6.83193 -0.192241 0.0698424 -0.00667602 -0.0031128 0.999903 0.0117795 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 3.99983 9.46757e-05 0.0267095 4.00066 0.013079 0.000776172 +EDGE_SE3:QUAT 376 1179 2.54166 -0.103237 0.00200651 -0.00351149 -0.00456851 0.999919 0.011315 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 3.99995 6.55049e-05 0.014049 4.00011 0.018587 0.000647839 +EDGE_SE3:QUAT 377 1179 -1.54996 -0.0114164 -0.0156566 -0.00132617 -0.00766394 0.999909 0.0110312 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 3.99999 3.58565e-05 0.00530599 3.99979 0.0307628 0.00073042 +EDGE_SE3:QUAT 378 1179 -5.53629 0.0675445 0.00507468 0.00216171 -0.00589068 0.99992 0.010964 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 3.99998 -5.26505e-05 -0.00864887 3.99994 0.0233663 0.000636049 +EDGE_SE3:QUAT 1180 1181 4.3935 -0.0623322 0.0151821 0.00144814 0.0051372 0.00918073 0.999944 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 4.00041 3.53889e-05 0.0409364 3.9999 0.000188624 4.00008 +EDGE_SE3:QUAT 374 1180 7.08289 -0.132538 0.00641749 -0.000855541 -0.00764102 0.999955 0.00557492 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 4 2.36274e-05 0.00342259 3.99978 0.0305991 0.000361343 +EDGE_SE3:QUAT 375 1180 2.8246 -0.0325144 0.0107584 -0.00683715 -0.00694632 0.999938 0.00545355 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 3.99982 0.000193999 0.0273512 4.00054 0.028088 0.000503196 +EDGE_SE3:QUAT 376 1180 -1.43909 0.0460135 -0.0303676 -0.00382214 -0.00858293 0.999943 0.00507358 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 3.99994 0.000129962 0.0152907 3.99993 0.034486 0.000458745 +EDGE_SE3:QUAT 377 1180 -5.52959 0.118799 -0.0255348 -0.00179787 -0.011527 0.99992 0.00488589 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 3.99999 7.80323e-05 0.0071931 3.99952 0.0461734 0.000641492 +EDGE_SE3:QUAT 1181 1182 4.46918 -0.0575529 0.0374239 0.000557202 0.00470439 0.00738742 0.999961 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 4.00035 1.43848e-05 0.0375856 3.99991 0.000139093 4.00013 +EDGE_SE3:QUAT 373 1181 6.91859 -0.113675 -0.0201843 -0.000513683 0.00478874 -0.999984 0.0031239 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 4 -9.28435e-06 -0.00205483 3.99991 0.0191671 0.000131938 +EDGE_SE3:QUAT 374 1181 2.68737 -0.0268407 0.0144346 0.00595184 0.00638915 -0.999957 0.00325924 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 3.99986 0.00015044 0.0238087 4.00041 0.0254052 0.000345541 +EDGE_SE3:QUAT 375 1181 -1.54546 0.0678058 -0.0354183 0.0121421 0.005419 -0.999905 0.00351141 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 3.99941 0.000252065 0.0485678 4.00225 0.0213513 0.000752996 +EDGE_SE3:QUAT 376 1181 -5.80497 0.154512 -0.0464413 0.00907354 0.00708269 -0.999926 0.00403519 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 3.99967 0.000250911 0.0362962 4.00113 0.0280488 0.000591116 +EDGE_SE3:QUAT 1182 1183 4.54329 -0.0796867 0.0292503 -0.000354659 -0.00112826 0.0045944 0.999989 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 4.00002 1.73582e-06 -0.00900629 3.99999 -2.06851e-05 3.99994 +EDGE_SE3:QUAT 372 1182 6.83761 -0.259579 0.0198369 0.00477881 0.00704077 -0.999961 0.00225995 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 3.99991 0.000134263 0.0191166 4.00017 0.0280792 0.000308887 +EDGE_SE3:QUAT 373 1182 2.47498 -0.0844691 0.0257232 0.00435804 0.00442281 -0.999922 0.0108402 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 3.99992 7.37277e-05 0.0174356 4.00024 0.0173098 0.000620958 +EDGE_SE3:QUAT 374 1182 -1.75488 0.00796645 -0.00391583 0.0107293 0.00600373 -0.999867 0.0107039 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 3.99953 0.0002311 0.0429239 4.00173 0.0231037 0.00105239 +EDGE_SE3:QUAT 375 1182 -5.9779 0.111654 -0.100383 0.0171153 0.0051497 -0.999779 0.0110845 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 3.99881 0.000277639 0.0684655 4.00463 0.019105 0.00175495 +EDGE_SE3:QUAT 1183 1184 4.40594 -0.0939332 0.00629055 0.00102705 -0.00135193 0.00229636 0.999996 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 4.00003 -5.47231e-06 -0.0108437 3.99999 -1.24163e-05 4.00001 +EDGE_SE3:QUAT 371 1183 6.53654 -0.426678 0.0387989 -0.0052976 -0.0062802 0.999947 0.00621288 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 3.99989 0.000135263 0.0211926 4.00028 0.025385 0.000427774 +EDGE_SE3:QUAT 372 1183 2.29157 -0.218142 0.00925483 0.00362179 0.00706304 -0.999947 0.00652689 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 3.99994 0.000102813 0.0144891 4.00002 0.0280614 0.000419751 +EDGE_SE3:QUAT 373 1183 -2.04139 -0.0964319 0.0133052 0.00318453 0.00468362 -0.999871 0.0150556 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 3.99996 5.84273e-05 0.0127429 4.00009 0.0183413 0.00103141 +EDGE_SE3:QUAT 374 1183 -6.24059 -0.0175487 -0.0650214 0.00965477 0.00606889 -0.999815 0.0154624 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 3.99961 0.000203739 0.0386329 4.00139 0.0230786 0.00146272 +EDGE_SE3:QUAT 1184 1185 4.48704 -0.101918 -0.0124072 0.00332046 0.00025637 0.00252276 0.999991 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 3.99996 3.18612e-06 0.00195039 4 2.42274e-06 3.99998 +EDGE_SE3:QUAT 370 1184 6.52703 -0.48938 0.0446298 -0.00311916 -0.0092392 0.999787 0.018167 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 3.99997 0.00010651 0.0124839 3.99979 0.0373796 0.00170857 +EDGE_SE3:QUAT 371 1184 2.1657 -0.273531 0.00396779 -0.00372128 -0.00524116 0.999972 0.00376179 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 3.99995 7.84317e-05 0.014886 4.00011 0.0210772 0.000223061 +EDGE_SE3:QUAT 372 1184 -2.07712 -0.161957 -0.0153512 0.00214494 0.00607408 -0.999937 0.00913933 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 3.99998 5.37319e-05 0.00858134 3.99993 0.0241346 0.000498154 +EDGE_SE3:QUAT 373 1184 -6.39817 -0.128811 -0.011441 0.00198823 0.00379651 -0.99983 0.0179229 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 3.99998 3.04035e-05 0.00795706 4.00001 0.0148891 0.0013562 +EDGE_SE3:QUAT 1185 1186 4.11728 -0.0854491 0.0168613 -0.000120754 -0.00393029 0.00216842 0.99999 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 4.00025 2.70236e-06 -0.0314406 3.99994 -3.41374e-05 4.00023 +EDGE_SE3:QUAT 369 1185 6.06494 -0.364225 0.0446918 -0.00682407 -0.00525774 0.999759 0.020213 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 3.99983 0.000160774 0.0273134 4.0006 0.0221177 0.00194316 +EDGE_SE3:QUAT 370 1185 2.05541 -0.247873 0.0115259 -0.00329668 -0.00567969 0.999862 0.015257 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 3.99996 7.46677e-05 0.0131918 4.00003 0.0231088 0.00110815 +EDGE_SE3:QUAT 371 1185 -2.31721 -0.139611 -0.0388235 -0.00410334 -0.00169593 0.999989 0.00138433 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 3.99993 2.83691e-05 0.0164133 4.00026 0.00682976 8.66766e-05 +EDGE_SE3:QUAT 372 1185 -6.53345 -0.150158 -0.0490784 0.00273897 0.00281693 -0.999918 0.0121787 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 3.99997 2.9372e-05 0.0109584 4.00009 0.0109971 0.000653542 +EDGE_SE3:QUAT 1186 1187 4.17925 -0.0781549 0.0222259 -0.0030172 0.00558784 -0.0043062 0.999971 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 4.00046 -7.03603e-05 0.0445498 3.99988 -9.80873e-05 4.00042 +EDGE_SE3:QUAT 368 1186 6.33191 -0.136191 -0.028021 0.00251452 -0.00440765 0.99992 0.0115772 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 3.99997 -4.42818e-05 -0.0100604 4.00003 0.0173923 0.00063706 +EDGE_SE3:QUAT 369 1186 1.95717 -0.108972 0.00520751 -0.00301579 -0.0058734 0.999815 0.0180527 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 3.99997 6.94487e-05 0.0120694 3.99999 0.0239106 0.001483 +EDGE_SE3:QUAT 370 1186 -2.0131 -0.0271924 0.00111373 0.000579415 -0.00593611 0.999895 0.0131796 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 4 -1.7325e-05 -0.00231851 3.99987 0.0236727 0.000836281 +EDGE_SE3:QUAT 371 1186 -6.40756 -0.0345192 -0.0524023 0.000227501 0.00219682 -0.999997 0.00117183 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 4 2.04285e-06 0.000910014 3.99998 0.0087851 2.49944e-05 +EDGE_SE3:QUAT 1187 1188 4.02218 -0.149343 0.0368208 -0.000901306 -0.00685553 -0.0185235 0.999805 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 4.00075 3.83125e-06 -0.0550254 3.99981 0.000509393 3.99938 +EDGE_SE3:QUAT 367 1187 6.40301 0.0823979 0.0333795 -0.00886099 -0.00625598 0.999934 0.00375051 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 3.99969 0.000227806 0.0354455 4.00109 0.0252993 0.000530336 +EDGE_SE3:QUAT 368 1187 2.15136 0.0455645 0.0152193 -0.00297716 -0.00758808 0.999836 0.0161533 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 3.99997 8.59883e-05 0.011914 3.99989 0.0307176 0.00131517 +EDGE_SE3:QUAT 369 1187 -2.2099 0.120293 0.00860149 -0.00863271 -0.00870681 0.999682 0.0220528 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 3.99973 0.000324626 0.0345587 4.00081 0.0363199 0.00257386 +EDGE_SE3:QUAT 370 1187 -6.18135 0.159991 0.0292953 -0.00522093 -0.00883341 0.999791 0.0176693 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 3.9999 0.000184125 0.0208954 4.00009 0.0360474 0.00168293 +EDGE_SE3:QUAT 1188 1189 4.40752 -0.254506 0.00676733 -0.00525289 -0.00132049 -0.0542873 0.998511 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 3.99994 3.60061e-05 -0.0139322 3.99999 0.000408371 3.98826 +EDGE_SE3:QUAT 366 1188 6.47902 0.583522 0.0389379 0.00641496 0.000827473 -0.999783 0.0198241 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 3.99983 1.65114e-06 0.0256745 4.00066 0.00229013 0.00173816 +EDGE_SE3:QUAT 367 1188 2.38906 0.269221 0.00478194 -0.00197469 -0.00724681 0.999722 0.0223556 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 3.99999 4.94988e-05 0.00790461 3.99984 0.0293038 0.00222951 +EDGE_SE3:QUAT 368 1188 -1.84337 0.322246 0.0353009 0.00407211 -0.00876261 0.99937 0.0341457 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 3.99991 -0.000147396 -0.0163213 4.00002 0.0338396 0.00501703 +EDGE_SE3:QUAT 369 1188 -6.21647 0.459022 -0.0187265 -0.00140262 -0.00982222 0.99911 0.041003 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 4 2.41413e-05 0.00561971 3.99962 0.0395814 0.00712523 +EDGE_SE3:QUAT 1189 1190 4.03443 -0.407763 -0.0143595 -0.00520397 0.0199441 -0.0993601 0.994838 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 4.0056 -0.00126452 0.151206 3.99869 -0.00744527 3.96621 +EDGE_SE3:QUAT 365 1189 6.26055 1.37568 -0.0501704 -0.0121543 0.00683292 -0.99833 0.0560533 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 3.9995 -0.000493166 -0.0488395 4.00194 0.0325747 0.0134318 +EDGE_SE3:QUAT 366 1189 2.0696 0.661364 -0.0050018 -0.0049141 -0.00643738 0.999387 0.0340726 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 3.99992 0.000132682 0.0196898 4.00017 0.0270154 0.00492345 +EDGE_SE3:QUAT 367 1189 -1.97398 0.716429 -0.00358324 -0.000309374 -0.0133137 0.997038 0.0757513 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 3.99999 -8.95035e-05 0.00120073 3.99931 0.0526742 0.0236512 +EDGE_SE3:QUAT 368 1189 -6.2077 0.893472 0.085117 0.00556823 -0.0142907 0.995963 0.0884487 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 3.99975 -0.000353478 -0.0226168 4.00005 0.0521478 0.0321078 +EDGE_SE3:QUAT 1190 1191 4.21535 -0.767156 0.0238517 0.00220279 -0.00237646 -0.172064 0.98508 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 4.00003 -2.75814e-05 -0.0137151 3.99999 0.00102505 3.88162 +EDGE_SE3:QUAT 364 1190 5.88482 2.72215 0.0341764 0.00609721 0.0127793 -0.991002 0.133094 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 3.99967 0.000270365 0.0252711 4.00048 0.0425021 0.071481 +EDGE_SE3:QUAT 365 1190 2.21194 1.32114 0.024312 -0.00676225 -0.0120222 0.998925 0.044251 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 3.99987 0.000312748 0.027126 3.99999 0.0502492 0.00864926 +EDGE_SE3:QUAT 366 1190 -1.91133 1.35438 -0.0527253 -0.0241693 -0.0114429 0.990658 0.133724 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 3.99851 0.00248932 0.0990727 4.00669 0.069322 0.0752318 +EDGE_SE3:QUAT 367 1190 -5.88556 1.72018 -0.000381322 -0.0193349 -0.0166669 0.984231 0.175038 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 3.99952 0.00182603 0.0801661 4.00204 0.0879592 0.126171 +EDGE_SE3:QUAT 1191 1192 4.34417 -0.892108 -0.00201455 0.00346846 -0.00270299 -0.182993 0.983104 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 3.99999 -3.32232e-05 -0.0131001 4 0.00093283 3.86609 +EDGE_SE3:QUAT 363 1191 4.78928 3.59261 0.0402052 0.00562004 0.0115235 -0.98465 0.174069 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 3.99969 0.000172817 0.0239647 4.00057 0.0350599 0.12167 +EDGE_SE3:QUAT 364 1191 1.62801 2.35447 0.0121509 -0.00162979 -0.0111632 0.999175 0.0390106 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 4 3.4845e-05 0.00652953 3.99952 0.0449881 0.00660477 +EDGE_SE3:QUAT 365 1191 -1.90563 2.46282 0.0272094 -0.00207268 -0.0105437 0.976482 0.215331 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 3.99997 -0.000106426 0.00800412 3.99957 0.0407685 0.185924 +EDGE_SE3:QUAT 366 1191 -5.75488 3.21525 -0.193232 -0.0191322 -0.0134575 0.953096 0.301763 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 4.00005 0.00162206 0.0833625 4.00098 0.0840121 0.367942 +EDGE_SE3:QUAT 1192 1193 4.28582 -0.746128 -0.00137011 0.00111826 0.00761296 -0.148012 0.988956 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 4.00092 -0.000173982 0.0608829 3.99979 -0.00450573 3.9133 +EDGE_SE3:QUAT 362 1192 3.25163 3.59095 -0.0256334 -0.000727027 0.00480484 -0.978224 0.207497 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 3.99999 2.38439e-05 -0.00274629 3.99991 0.0183368 0.172309 +EDGE_SE3:QUAT 363 1192 0.411921 2.92579 -0.0105607 -0.0013533 -0.00839278 0.999923 0.00901014 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 3.99999 4.06879e-05 0.00541433 3.99974 0.0336609 0.000615365 +EDGE_SE3:QUAT 364 1192 -2.63981 3.5597 0.0293986 0.00328177 -0.00746416 0.975146 0.221415 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 3.99987 -5.01307e-05 -0.0147043 4.00025 0.0207349 0.196274 +EDGE_SE3:QUAT 1193 1194 3.95451 -0.477959 0.0116389 0.00547414 -0.00349033 -0.0806935 0.996718 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 4 -7.30508e-05 -0.0223719 3.99997 0.000828881 3.97408 +EDGE_SE3:QUAT 360 1193 5.13771 3.98881 0.00741059 0.00121222 0.00638096 -0.882791 0.469722 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 3.99992 -4.86355e-05 0.0114596 4.00018 0.00903961 0.882645 +EDGE_SE3:QUAT 361 1193 2.16981 2.61325 -0.00257337 0.000224245 0.0064913 -0.96102 0.276401 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 3.99995 6.11433e-05 0.00209059 3.99994 0.020683 0.305712 +EDGE_SE3:QUAT 362 1193 -0.95876 2.52758 -0.0239723 0.00623638 0.00520893 -0.998161 0.0600797 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 3.99982 7.96499e-05 0.0250891 4.0006 0.0176652 0.0146746 +EDGE_SE3:QUAT 363 1193 -3.8469 3.74226 -0.00841723 -0.00757198 -0.00735421 0.987459 0.15752 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 3.99992 0.000282909 0.0311686 4.00027 0.0369192 0.0998451 +EDGE_SE3:QUAT 1194 1195 4.0258 -0.144396 0.0146636 2.16875e-05 0.000119537 -0.00874504 0.999962 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 4 7.39144e-09 0.000958465 4 -4.19406e-06 3.99969 +EDGE_SE3:QUAT 359 1194 6.31937 2.64956 0.0513837 0.00509668 -0.00319484 -0.820215 0.572023 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 4.00002 -1.24311e-05 0.0228817 3.99992 -0.0193134 1.30911 +EDGE_SE3:QUAT 360 1194 2.5242 0.968121 -0.00615247 0.000404774 -6.11949e-06 -0.917856 0.396913 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 4 -1.12046e-06 0.00195128 4 -0.00109819 0.630161 +EDGE_SE3:QUAT 361 1194 -1.42942 0.935387 -0.00790192 -0.00210658 0.00052058 -0.980191 0.198041 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 3.99999 -2.09808e-05 -0.00887499 4.00005 0.0050877 0.156908 +EDGE_SE3:QUAT 362 1194 -4.91748 2.5218 -0.0557922 -0.00271939 0.000150683 0.999778 0.020915 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 3.99997 2.07764e-06 0.0108847 4.00012 -0.000147265 0.00177938 +EDGE_SE3:QUAT 1195 1196 4.10422 -0.0731571 0.0219209 -0.000812745 -0.000964099 0.00103135 0.999999 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 4.00001 3.15181e-06 -0.00770274 4 -3.98849e-06 4.00001 +EDGE_SE3:QUAT 359 1195 4.78447 -1.08264 0.0445963 0.00508507 -0.0029873 -0.825286 0.564685 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 4.00003 -2.50192e-05 0.0231901 3.99993 -0.0192187 1.27575 +EDGE_SE3:QUAT 360 1195 -0.352427 -1.87028 0.00194339 0.000458679 0.000281111 -0.921286 0.388885 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 4 -1.89827e-06 0.00233382 4 -0.000488582 0.604929 +EDGE_SE3:QUAT 361 1195 -5.20196 -0.496825 0.0223173 -0.00180509 0.00040116 -0.981936 0.189202 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 3.99999 -1.49272e-05 -0.00757583 4.00004 0.00409733 0.143209 +EDGE_SE3:QUAT 1117 1195 1.11011 5.02643 0.11627 0.0116625 0.00450615 -0.434862 0.90041 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 4.00103 -0.000344321 0.0795348 3.99968 -0.0207568 3.24515 +EDGE_SE3:QUAT 1118 1195 -5.18128 4.2592 0.0795806 0.00833713 0.00546608 -0.243467 0.969858 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 4.00072 -3.60127e-05 0.0633051 3.99974 -0.00852089 3.76389 +EDGE_SE3:QUAT 1196 1197 4.04667 -0.0767661 0.0133048 -0.00108005 -0.00153911 0.00107019 0.999998 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 4.00003 6.70022e-06 -0.012299 3.99999 -6.64013e-06 4.00003 +EDGE_SE3:QUAT 359 1196 3.23335 -4.86879 0.042046 0.00381075 -0.00265208 -0.824697 0.565556 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 4.00001 -2.75362e-07 0.016775 3.99995 -0.0148785 1.27957 +EDGE_SE3:QUAT 360 1196 -3.25655 -4.71978 0.028424 -0.000581567 0.000594818 -0.920807 0.390018 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 4 -4.54197e-07 -0.00251141 4 0.00306288 0.60846 +EDGE_SE3:QUAT 1117 1196 3.58994 1.77192 0.0612771 0.0104795 0.00392983 -0.433704 0.900986 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 4.0008 -0.000261197 0.070718 3.99974 -0.0184584 3.24884 +EDGE_SE3:QUAT 1118 1196 -1.58527 2.22801 0.0383708 0.00715673 0.00472496 -0.242413 0.970135 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 4.00053 -2.6805e-05 0.0545274 3.99981 -0.00730348 3.76568 +EDGE_SE3:QUAT 1119 1196 -6.60086 0.980927 -0.165239 0.0046047 -0.00970436 -0.0727185 0.997295 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 4.00125 -0.000314672 -0.0730336 3.99969 0.00261118 3.98018 +EDGE_SE3:QUAT 1197 1198 4.02156 -0.0874197 -0.0174916 0.000921517 0.0113717 0.00201992 0.999933 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 4.00207 4.82493e-05 0.0909921 3.99948 9.48761e-05 4.00205 +EDGE_SE3:QUAT 1117 1197 6.04081 -1.42633 0.00515332 0.00884435 0.00325169 -0.432848 0.901418 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 4.00056 -0.00017825 0.0592681 3.99982 -0.0154683 3.25144 +EDGE_SE3:QUAT 1118 1197 1.92354 0.270656 0.00334952 0.00588415 0.0035938 -0.241277 0.970432 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 4.00031 -6.78145e-06 0.0426554 3.99988 -0.005722 3.76759 +EDGE_SE3:QUAT 1119 1197 -2.64886 0.322354 -0.0750933 0.00341908 -0.0110181 -0.0717992 0.997352 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 4.00174 -0.00033931 -0.084559 3.99958 0.00300524 3.98117 +EDGE_SE3:QUAT 1120 1197 -6.93745 -0.350402 -0.0861113 0.00398222 -0.0110441 0.010821 0.999873 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 4.00191 -0.000145574 -0.0888904 3.9995 -0.000470694 4.00151 +EDGE_SE3:QUAT 1198 1199 4.38054 -0.0780974 0.0211697 -0.00249702 -0.00103484 0.00229261 0.999994 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 3.99999 1.02798e-05 -0.00820992 4 -9.44821e-06 4 +EDGE_SE3:QUAT 1118 1198 5.46901 -1.69925 -0.0549821 0.0095683 0.0144371 -0.239301 0.970791 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 4.004 -0.000866705 0.132272 3.99906 -0.0164899 3.77531 +EDGE_SE3:QUAT 1119 1198 1.31628 -0.348472 -0.0102042 0.00496222 0.000167005 -0.0695305 0.997567 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 3.99991 1.64127e-05 0.00545322 4 -0.000237411 3.98067 +EDGE_SE3:QUAT 1120 1198 -2.91096 -0.353336 -0.0144171 0.00466557 0.000436525 0.0129141 0.999906 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 3.99991 5.93637e-06 0.00276829 4 1.63317e-05 3.99933 +EDGE_SE3:QUAT 1121 1198 -7.30462 -0.485912 -0.0272671 0.00186267 0.000805256 0.0420116 0.999115 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 3.99999 5.32543e-06 0.00548704 4 0.000108588 3.99295 +EDGE_SE3:QUAT 1199 1200 4.36937 -0.107743 0.0203208 -0.00135716 -0.00116437 -0.0075371 0.99997 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 4.00001 6.18114e-06 -0.00943697 3.99999 3.56723e-05 3.9998 +EDGE_SE3:QUAT 964 1199 5.53707 -4.43197 0.0637921 -0.00781672 -0.00481842 0.95508 0.296205 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 4 0.000289983 0.034107 4.00025 0.0320807 0.351526 +EDGE_SE3:QUAT 965 1199 -0.823029 -5.26179 0.0452008 -0.00444821 -0.00204829 0.874396 0.485188 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 4.00003 6.88871e-05 0.0210125 4.00001 0.0169926 0.941835 +EDGE_SE3:QUAT 1119 1199 5.65395 -1.03011 0.00560663 0.00245497 -0.000601158 -0.0674774 0.997718 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 3.99998 -2.86863e-06 -0.0027946 4 7.15692e-05 3.98179 +EDGE_SE3:QUAT 1120 1199 1.47121 -0.306495 0.00209819 0.00216001 -0.000674832 0.015321 0.99988 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 3.99999 -6.21255e-06 -0.00579379 4 -4.53662e-05 3.99907 +EDGE_SE3:QUAT 1121 1199 -2.9315 -0.197772 -0.0124875 -0.000584682 -0.000392471 0.0440551 0.999029 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 4 9.32289e-07 -0.00282194 4 -5.98254e-05 3.99224 +EDGE_SE3:QUAT 1122 1199 -6.92407 -0.0767056 0.0190282 -0.00371048 0.00337405 0.0430437 0.999061 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 4.00015 -4.15841e-05 0.0288324 3.99995 0.000632689 3.9928 +EDGE_SE3:QUAT 1200 1201 4.19213 -0.20359 0.019989 0.00178183 -0.00149595 -0.0371888 0.999306 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 4.00002 -1.14803e-05 -0.0111484 3.99999 0.000202305 3.9945 +EDGE_SE3:QUAT 963 1200 6.7392 -0.190111 0.052985 -0.00742614 -0.00260828 0.994862 0.100937 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 3.99983 0.000190916 0.0301342 4.00074 0.0161085 0.0410476 +EDGE_SE3:QUAT 964 1200 2.00006 -1.88422 0.032195 -0.00733186 -0.0067171 0.952886 0.303166 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 4.00002 0.000195013 0.0315914 3.99998 0.037047 0.368267 +EDGE_SE3:QUAT 965 1200 -3.03433 -1.5175 0.045555 -0.00412316 -0.00378598 0.870765 0.491667 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 4.00001 -3.93366e-06 0.0177053 3.99992 0.0191083 0.967146 +EDGE_SE3:QUAT 966 1200 -7.47992 0.015502 0.0808578 -0.00365891 0.000814197 0.793632 0.608386 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 4.00006 0.000112342 0.0216815 4.00007 0.0105461 1.4807 +EDGE_SE3:QUAT 1060 1200 4.82484 3.72902 0.118873 0.00659805 0.00734942 -0.496318 0.868085 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 4.00109 -0.000755261 0.0713339 4.00001 -0.0186997 3.01594 +EDGE_SE3:QUAT 1061 1200 -1.45659 4.54547 0.0702244 0.000306628 0.00610133 -0.289726 0.95709 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 4.00048 -0.000221636 0.0438064 3.99994 -0.00608365 3.66471 +EDGE_SE3:QUAT 1120 1200 5.84256 -0.289359 0.0280132 0.000808092 -0.00177384 0.00753618 0.99997 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 4.00005 -5.19905e-06 -0.0142627 3.99999 -5.37738e-05 3.99982 +EDGE_SE3:QUAT 1121 1200 1.43231 0.0836775 0.00764281 -0.00220644 -0.00157892 0.0364708 0.999331 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 4.00001 1.44042e-05 -0.0116414 3.99999 -0.000206384 3.99471 +EDGE_SE3:QUAT 1122 1200 -2.56782 0.183501 0.0101771 -0.00495595 0.00217456 0.0354298 0.999358 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 4 -4.51558e-05 0.0194688 3.99997 0.00035648 3.99507 +EDGE_SE3:QUAT 1123 1200 -6.55346 0.328641 0.0118872 -0.00395986 0.00360534 0.0291883 0.99956 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 4.00017 -5.08943e-05 0.0301929 3.99994 0.000445941 3.99682 +EDGE_SE3:QUAT 1201 1202 4.06944 -0.390142 0.0158077 0.00218307 0.00307256 -0.0954962 0.995423 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 4.00016 5.17009e-06 0.0267324 3.99995 -0.00131042 3.9637 +EDGE_SE3:QUAT 962 1201 6.35251 2.3889 -0.0104094 0.000202097 0.00405225 -0.998781 0.0491927 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 4 9.49305e-06 0.000815219 3.99994 0.0160316 0.00974426 +EDGE_SE3:QUAT 963 1201 2.66523 0.846686 0.0193108 -0.00585409 -0.000854753 0.990373 0.138295 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 3.99989 0.000123072 0.0240605 4.00048 0.00961142 0.0766723 +EDGE_SE3:QUAT 964 1201 -1.29816 0.697379 0.0185361 -0.00496972 -0.0052391 0.940906 0.33859 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 4.00001 5.71034e-05 0.0213677 3.99991 0.0271155 0.458894 +EDGE_SE3:QUAT 965 1201 -5.03588 2.17638 0.057346 -0.00168208 -0.00287196 0.851724 0.523981 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 3.99999 -2.01527e-05 0.0055721 3.99997 0.00952674 1.09827 +EDGE_SE3:QUAT 1060 1201 6.77822 0.0185552 0.0606153 0.00758246 0.0053512 -0.528467 0.848903 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 4.00083 -0.000578144 0.0653423 3.99999 -0.0193808 2.88395 +EDGE_SE3:QUAT 1061 1201 1.94802 2.02774 0.0385536 0.00154 0.00421847 -0.325241 0.945621 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 4.00028 -0.000122813 0.0341259 3.99996 -0.00556022 3.57716 +EDGE_SE3:QUAT 1062 1201 -2.98916 1.92962 0.0235727 0.00206268 0.00296729 -0.154086 0.988051 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 4.00016 -1.1059e-05 0.0266525 3.99996 -0.00212891 3.90521 +EDGE_SE3:QUAT 1121 1201 5.64795 0.184478 0.0464823 -1.28155e-05 -0.00305389 -0.000818193 0.999995 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 4.00015 -2.65761e-08 -0.024432 3.99996 9.99316e-06 4.00015 +EDGE_SE3:QUAT 1122 1201 1.63594 0.277904 0.0116533 -0.00310923 0.000641795 -0.00175624 0.999993 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 3.99997 -7.86297e-06 0.00506874 4 -4.46189e-06 3.99999 +EDGE_SE3:QUAT 1123 1201 -2.35685 0.368975 0.0126969 -0.0019975 0.00230591 -0.00821875 0.999962 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 4.00007 -1.9192e-05 0.0182487 3.99998 -7.49728e-05 3.99981 +EDGE_SE3:QUAT 1124 1201 -6.42425 0.463552 -0.0619822 -0.00358692 -0.00229749 -0.0078461 0.99996 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 4.00004 3.27463e-05 -0.0187159 3.99998 7.33992e-05 3.99984 +EDGE_SE3:QUAT 1202 1203 4.26227 -0.745608 0.00132133 -0.0023686 0.000349738 -0.179576 0.983741 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 3.99998 4.7507e-06 -0.00233073 4 0.000366102 3.87101 +EDGE_SE3:QUAT 961 1202 5.08104 3.99224 0.0217651 0.00594301 -7.57176e-05 -0.983258 0.182124 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 3.9999 -0.000145978 0.0249216 4.00051 -0.00865174 0.132856 +EDGE_SE3:QUAT 962 1202 2.27642 2.37426 0.00561813 -0.00311643 -0.00190515 0.998906 0.0466129 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 3.99997 3.24098e-05 0.0125048 4.00013 0.00873927 0.00874936 +EDGE_SE3:QUAT 963 1202 -1.1202 2.34623 -0.00364504 -0.00859868 0.00144064 0.972559 0.232495 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 3.99979 0.000360477 0.037214 4.00112 0.0101359 0.216604 +EDGE_SE3:QUAT 964 1202 -4.14439 3.58079 0.0228767 -0.00666901 -0.0025816 0.904167 0.427119 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 4.00005 0.000210925 0.0313147 4.00013 0.0245629 0.730155 +EDGE_SE3:QUAT 1061 1202 4.87992 -0.767014 0.0219339 0.00434099 0.0066088 -0.414224 0.910141 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 4.00079 -0.000433248 0.0589858 3.99994 -0.0126203 3.31454 +EDGE_SE3:QUAT 1062 1202 0.760107 0.323526 0.0166511 0.00486458 0.00578721 -0.247712 0.968804 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 4.00069 -0.00013398 0.0559803 3.99983 -0.00734303 3.75534 +EDGE_SE3:QUAT 1063 1202 -3.63513 0.171259 0.0154935 0.000311605 0.00381452 -0.14352 0.98964 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 4.00023 -4.49195e-05 0.030109 3.99995 -0.00215078 3.91783 +EDGE_SE3:QUAT 1122 1202 5.69131 -0.119723 0.029798 -0.000544136 0.00341218 -0.0974098 0.995238 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 4.00017 -3.28387e-05 0.0262788 3.99996 -0.00126352 3.96222 +EDGE_SE3:QUAT 1123 1202 1.68354 -0.0895293 0.0101031 -7.65509e-05 0.00507292 -0.103457 0.994621 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 4.0004 -6.39419e-05 0.0398426 3.99991 -0.00204864 3.95758 +EDGE_SE3:QUAT 1124 1202 -2.37384 0.000216229 -0.0161017 -0.000722135 0.000429932 -0.103176 0.994663 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 4 -1.07151e-06 0.00249695 4 -0.000112489 3.95742 +EDGE_SE3:QUAT 1125 1202 -6.75149 0.0783477 -0.0184433 -0.00234048 0.0019663 -0.100161 0.994967 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 4.00002 -2.04153e-05 0.0127 3.99999 -0.00058526 3.95991 +EDGE_SE3:QUAT 1203 1204 4.02279 -0.82531 0.0182229 -0.00344733 -0.00324938 -0.196797 0.980433 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 4.00021 -1.27436e-05 -0.0324322 3.99993 0.00340633 3.84535 +EDGE_SE3:QUAT 960 1203 3.71089 4.00286 0.00281538 -0.000893622 0.00738028 -0.973336 0.229263 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 3.99998 6.74581e-05 -0.00313315 3.99981 0.0272663 0.210447 +EDGE_SE3:QUAT 961 1203 0.842769 3.1611 -0.0320828 0.00599056 0.00316033 -0.999974 0.00242014 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 3.99986 7.38668e-05 0.0239624 4.00054 0.0125276 0.00020621 +EDGE_SE3:QUAT 962 1203 -1.8979 3.51817 -0.0105253 -0.00329931 -0.00451012 0.974234 0.225471 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 4 3.85866e-05 0.0137516 3.99995 0.0214376 0.203517 +EDGE_SE3:QUAT 963 1203 -4.5857 4.93103 -0.0743912 -0.00969955 -0.00219773 0.914924 0.403503 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 4.00007 0.000547095 0.0459132 4.00056 0.0316463 0.6521 +EDGE_SE3:QUAT 1062 1203 4.13245 -2.36991 -0.0479854 0.00170012 0.00759456 -0.417693 0.908555 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 4.00068 -0.000467945 0.0531095 4.00001 -0.0104237 3.30282 +EDGE_SE3:QUAT 1063 1203 0.243496 -1.7523 -0.0145255 -0.00238401 0.00476853 -0.318776 0.947815 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 4.00011 -0.000113453 0.0239818 4 -0.00300888 3.59366 +EDGE_SE3:QUAT 1064 1203 -3.78095 -1.71243 -0.0292013 -0.00168864 0.00501049 -0.292586 0.956224 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 4.0002 -0.000136604 0.0294587 3.99998 -0.00375576 3.65778 +EDGE_SE3:QUAT 1123 1203 5.69434 -1.69749 -0.0265154 -0.00281737 0.00573604 -0.280417 0.959857 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 4.00021 -0.000168272 0.0316004 3.99998 -0.00372327 3.68571 +EDGE_SE3:QUAT 1124 1203 1.62456 -1.60575 -0.0138218 -0.00294597 0.00109388 -0.280015 0.959991 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 3.99996 7.9106e-06 -0.00163932 4 0.000740919 3.68636 +EDGE_SE3:QUAT 1125 1203 -2.74124 -1.4951 -0.0231955 -0.00460149 0.00231704 -0.276967 0.960866 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 3.99991 6.14774e-06 0.00193297 4 0.000540303 3.69315 +EDGE_SE3:QUAT 1126 1203 -7.0288 -1.41563 -0.00958774 -0.00584412 0.00513714 -0.275588 0.961244 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 3.99993 -8.56365e-05 0.0181546 4.00001 -0.00139047 3.69627 +EDGE_SE3:QUAT 1204 1205 3.99831 -0.804339 0.000885154 0.000299579 0.00235711 -0.179345 0.983783 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 4.00009 -2.09901e-05 0.0185857 3.99998 -0.0016581 3.87143 +EDGE_SE3:QUAT 959 1204 2.86055 3.22441 0.0189982 0.000873747 0.00725126 -0.977954 0.208692 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 3.99995 7.58291e-05 0.00424342 3.99993 0.0245006 0.174373 +EDGE_SE3:QUAT 960 1204 -0.267888 2.92487 0.0236556 -0.00588638 0.00935496 -0.999395 0.0329701 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 3.99989 -0.000220881 -0.0235843 4.00012 0.0388738 0.00486546 +EDGE_SE3:QUAT 961 1204 -3.21173 3.94719 -0.0529457 -0.00212506 -0.00752687 0.980835 0.194684 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 4 -2.71306e-05 0.00852535 3.99976 0.030476 0.151867 +EDGE_SE3:QUAT 1063 1204 2.96151 -4.83134 -0.0184814 -0.00740392 0.00232662 -0.499187 0.866459 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 3.9999 0.000100454 -0.0248748 3.9999 0.0104584 3.00337 +EDGE_SE3:QUAT 1064 1204 -0.889709 -4.65697 -0.0414084 -0.00665205 0.00265777 -0.475432 0.879724 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 3.99987 9.18854e-05 -0.0177552 3.99993 0.00781289 3.09591 +EDGE_SE3:QUAT 1065 1204 -4.99104 -4.54209 -0.0380723 -0.0081488 0.00272925 -0.47576 0.879533 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 3.99985 0.000129092 -0.0246451 3.99989 0.0101357 3.09472 +EDGE_SE3:QUAT 1124 1204 4.59724 -4.46343 0.00528897 -0.00717556 -0.001621 -0.463604 0.886012 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 4.00025 -7.38112e-05 -0.0432239 3.99989 0.0126446 3.14075 +EDGE_SE3:QUAT 1125 1204 0.245866 -4.32095 -0.00893148 -0.00901327 -0.000739438 -0.460849 0.887432 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 4.00021 -8.51165e-06 -0.0469266 3.99984 0.0143725 3.15101 +EDGE_SE3:QUAT 1126 1204 -4.04893 -4.23569 -0.00224336 -0.0107521 0.00193476 -0.459343 0.888192 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 3.99989 0.000170975 -0.0400838 3.9998 0.0140639 3.15637 +EDGE_SE3:QUAT 1205 1206 4.38347 -0.613 -0.116065 0.00701623 0.0393768 -0.0961338 0.994564 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 4.02532 -0.00254075 0.320483 3.99384 -0.015452 3.98855 +EDGE_SE3:QUAT 959 1205 -1.0926 2.32224 0.0169258 0.00196785 0.00736113 -0.999522 0.0299769 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 3.99998 6.72691e-05 0.00788424 3.99987 0.0289069 0.00381912 +EDGE_SE3:QUAT 960 1205 -4.29189 3.46526 0.0896081 0.00515907 -0.00809538 0.989147 0.146615 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 3.9998 -9.04326e-05 -0.0214948 4.00046 0.024738 0.0862599 +EDGE_SE3:QUAT 1206 1207 4.04676 -0.168803 0.0285684 -0.00120734 0.00219946 -0.0156315 0.999875 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 4.00007 -1.22131e-05 0.017363 3.99998 -0.000135242 3.9991 +EDGE_SE3:QUAT 959 1206 -5.49354 2.69421 -0.109149 -0.0406635 -0.00157317 0.996973 0.0662495 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 3.99369 0.00287092 0.163621 4.02602 0.0279828 0.0244815 +EDGE_SE3:QUAT 1207 1208 4.18907 -0.111741 0.037879 0.00173115 -0.00288407 -0.00219371 0.999992 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 4.00012 -2.0357e-05 -0.0230274 3.99997 2.55877e-05 4.00011 +EDGE_SE3:QUAT 1208 1209 4.46853 -0.0880248 -0.00478441 9.23159e-05 -0.00702015 0.00367749 0.999969 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 4.00079 1.75683e-06 -0.0561738 3.9998 -0.000103235 4.00073 +EDGE_SE3:QUAT 955 1208 3.03694 1.6269 0.0655361 -0.00092599 -0.0079044 0.999929 0.00887916 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 4 2.49835e-05 0.00370467 3.99976 0.0316763 0.00056967 +EDGE_SE3:QUAT 956 1208 -1.38624 1.75161 0.0682844 0.00223629 0.00816771 -0.999964 0.000609608 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 3.99998 7.33086e-05 0.00894603 3.99981 0.0326597 0.000288169 +EDGE_SE3:QUAT 957 1208 -5.61283 1.81754 0.0103171 0.00555631 0.00794383 -0.999946 0.0036854 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 3.99987 0.0001757 0.0222274 4.00025 0.0316149 0.000427696 +EDGE_SE3:QUAT 1209 1210 4.01508 -0.0696355 -0.0346413 0.00168774 0.00166847 0.00496172 0.999985 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 4.00003 1.14781e-05 0.0132468 3.99999 3.28923e-05 3.99995 +EDGE_SE3:QUAT 954 1209 2.94998 1.71002 0.0575454 0.00231659 -0.00961938 0.99989 0.0110588 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 3.99997 -9.57112e-05 -0.00926945 3.99973 0.0382603 0.000876701 +EDGE_SE3:QUAT 955 1209 -1.40938 1.79121 0.0557244 0.005943 -0.00809738 0.999933 0.0057993 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 3.99985 -0.000190586 -0.023775 4.00032 0.0321164 0.000533687 +EDGE_SE3:QUAT 956 1209 -5.8092 1.82685 0.0573126 -0.00459729 0.00880541 -0.999941 0.00440086 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 3.99992 -0.000161398 -0.0183917 4.00002 0.0353844 0.000475043 +EDGE_SE3:QUAT 1210 1211 4.25828 -0.088548 0.018332 -0.00070361 0.00960917 -0.000304107 0.999954 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 4.00148 -2.77523e-05 0.0768956 3.99963 -1.32633e-05 4.00148 +EDGE_SE3:QUAT 953 1210 3.374 1.77801 0.0558222 -0.00214951 -0.00670001 0.999963 0.00494198 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 3.99998 5.63562e-05 0.0085989 3.99989 0.0268834 0.000296866 +EDGE_SE3:QUAT 954 1210 -1.05421 1.87142 0.0464254 0.000445802 -0.0081743 0.999947 0.00624514 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 4 -1.78734e-05 -0.00178353 3.99974 0.0326707 0.000423674 +EDGE_SE3:QUAT 955 1210 -5.41157 1.90786 0.0682644 0.00416735 -0.00688468 0.999967 0.000650017 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 3.99993 -0.000114755 -0.0166705 4.00009 0.027519 0.00026048 +EDGE_SE3:QUAT 1211 1212 4.39688 -0.101113 0.0494481 6.51681e-06 -0.00230313 -0.00141801 0.999996 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 4.00008 -2.40563e-07 -0.0184252 3.99998 1.30651e-05 4.00008 +EDGE_SE3:QUAT 952 1211 3.3901 1.81519 0.106373 -0.00828246 -0.0079593 0.999925 0.00421009 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 3.99973 0.00026863 0.0331328 4.00083 0.0321257 0.0006033 +EDGE_SE3:QUAT 953 1211 -0.874428 1.91813 0.0621582 -0.0117012 -0.00742362 0.999889 0.00549844 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 3.99946 0.000363565 0.046808 4.00195 0.0302287 0.000897044 +EDGE_SE3:QUAT 954 1211 -5.26651 2.00977 0.0732207 -0.00899363 -0.00898806 0.999897 0.0066349 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 3.99969 0.000332013 0.0359801 4.00095 0.0364402 0.000831621 +EDGE_SE3:QUAT 1212 1213 4.33075 -0.086143 0.0209813 -0.00292538 -0.00106284 -0.000662291 0.999995 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 3.99998 1.24642e-05 -0.00852591 4 2.74625e-06 4.00002 +EDGE_SE3:QUAT 951 1212 2.97181 1.85883 0.0761365 0.00137975 -0.00727213 0.999961 0.00477145 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 3.99999 -4.19177e-05 -0.00551965 3.99982 0.0290338 0.000309437 +EDGE_SE3:QUAT 952 1212 -0.988455 1.94224 0.0811499 -0.00590351 -0.00836281 0.99993 0.00594682 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 3.99987 0.000199081 0.0236174 4.00026 0.0337343 0.000565386 +EDGE_SE3:QUAT 953 1212 -5.23639 2.06087 0.0120491 -0.00942086 -0.00740521 0.999902 0.00721573 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 3.99965 0.000291338 0.0376881 4.00118 0.0301745 0.000790942 +EDGE_SE3:QUAT 1213 1214 4.03045 -0.108252 -5.31747e-05 0.00107488 0.000529525 0.0001951 0.999999 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 4 2.27622e-06 0.00423368 4 4.20141e-07 4 +EDGE_SE3:QUAT 950 1213 3.05754 1.89711 0.0546413 0.000751876 -0.00928973 0.999946 0.00461849 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 4 -3.10503e-05 -0.00300802 3.99967 0.0371277 0.000432236 +EDGE_SE3:QUAT 951 1213 -1.33753 1.98779 0.106757 0.00243449 -0.0101044 0.999929 0.00586614 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 3.99997 -0.000102287 -0.00973998 3.99969 0.0402992 0.00056741 +EDGE_SE3:QUAT 952 1213 -5.30951 2.07636 0.0589787 -0.00497933 -0.0110825 0.999904 0.00660126 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 3.99991 0.000218041 0.019922 3.99989 0.0445914 0.000770644 +EDGE_SE3:QUAT 1214 1215 4.43683 -0.0823942 0.0160123 0.00161961 0.00597531 0.00131444 0.99998 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 4.00056 3.98277e-05 0.0477826 3.99986 3.27967e-05 4.00056 +EDGE_SE3:QUAT 949 1214 3.26103 1.95362 0.071587 -0.00512072 -0.00893218 0.999942 0.00303558 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 3.9999 0.000182939 0.0204854 4.00009 0.0358559 0.000463166 +EDGE_SE3:QUAT 950 1214 -0.986822 2.03782 0.0700297 0.000200174 -0.00808261 0.999959 0.00413807 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 4 -8.62757e-06 -0.000800818 3.99974 0.0323214 0.000329844 +EDGE_SE3:QUAT 951 1214 -5.35771 2.13391 0.13854 0.00172809 -0.00873782 0.999947 0.00521158 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 3.99999 -6.31754e-05 -0.00691343 3.99975 0.0348762 0.000424704 +EDGE_SE3:QUAT 1215 1216 4.18643 -0.0768773 0.0649679 -0.00140614 0.00152155 0.00355626 0.999992 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 4.00003 -8.41522e-06 0.0122322 3.99999 2.17077e-05 3.99999 +EDGE_SE3:QUAT 948 1215 3.17031 1.95733 0.0875403 -0.0112012 -0.00703631 0.999913 7.24801e-05 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 3.9995 0.000315973 0.0448053 4.00181 0.0281705 0.000700218 +EDGE_SE3:QUAT 949 1215 -1.178 2.06434 0.0475864 -0.0112913 -0.00719168 0.999909 0.00146486 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 3.99949 0.000329225 0.0451661 4.00183 0.0289184 0.000727562 +EDGE_SE3:QUAT 950 1215 -5.39269 2.16705 0.0915402 -0.00571958 -0.00638106 0.999959 0.00289474 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 3.99987 0.000147353 0.0228797 4.00036 0.0256602 0.000328981 +EDGE_SE3:QUAT 1216 1217 4.06071 -0.0866488 0.0527406 0.00230676 -0.00446295 0.00267365 0.999984 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 4.0003 -4.00219e-05 -0.0357795 3.99992 -4.67672e-05 4.00029 +EDGE_SE3:QUAT 947 1216 3.30629 1.96427 0.0929228 0.00773482 0.0101792 -0.999906 0.00496986 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 3.99975 0.000312 0.0309442 4.00056 0.0404181 0.000746514 +EDGE_SE3:QUAT 948 1216 -0.981011 2.05097 0.0595486 0.0129439 0.00886014 -0.999872 0.00323536 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 3.99932 0.000448691 0.0517781 4.00239 0.0351357 0.00102058 +EDGE_SE3:QUAT 949 1216 -5.33354 2.15939 0.0259498 0.012814 0.00909085 -0.999875 0.00203244 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 3.99934 0.000460259 0.0512582 4.00231 0.0361859 0.00100055 +EDGE_SE3:QUAT 1217 1218 4.17613 -0.0709823 2.46377e-05 -0.00295804 -0.00460193 0.000989869 0.999985 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 4.0003 5.4899e-05 -0.0367825 3.99992 -1.97045e-05 4.00033 +EDGE_SE3:QUAT 946 1217 3.43715 1.9332 0.0532992 -0.00341659 0.00702015 -0.999916 0.0103622 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 3.99996 -9.45989e-05 -0.0136694 3.99998 0.0283573 0.000677274 +EDGE_SE3:QUAT 947 1217 -0.735199 1.99589 0.0851763 0.0033096 0.00796498 -0.999933 0.00778273 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 3.99995 0.000107249 0.0132408 3.99993 0.03165 0.000536562 +EDGE_SE3:QUAT 948 1217 -5.02749 2.10924 0.0162559 0.00851695 0.00679133 -0.999918 0.00668855 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 3.9997 0.00022224 0.034071 4.00099 0.0267167 0.000647575 +EDGE_SE3:QUAT 1218 1219 4.07044 -0.118395 0.00384498 0.00146921 0.0065983 -0.0133699 0.999888 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 4.00069 2.49522e-05 0.053016 3.99982 -0.000353519 3.99999 +EDGE_SE3:QUAT 945 1218 3.28924 1.83323 0.0654605 0.000593339 0.0109386 -0.999797 0.016893 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 4 4.18429e-05 0.00237539 3.99953 0.0436406 0.00161922 +EDGE_SE3:QUAT 946 1218 -0.747822 1.91168 0.0919822 -0.00814607 0.0100589 -0.999848 0.0116786 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 3.99975 -0.000336419 -0.0325951 4.00061 0.0409954 0.00123131 +EDGE_SE3:QUAT 947 1218 -4.863 2.00485 0.0630364 -0.00085969 0.0113822 -0.999888 0.00966201 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 4 -2.92344e-05 -0.00343972 3.99949 0.0455817 0.000895912 +EDGE_SE3:QUAT 1219 1220 4.12446 -0.291431 0.0379514 0.00224657 -0.0201274 -0.0788178 0.996683 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 4.00618 -0.000919879 -0.157614 3.99852 0.00621077 3.98135 +EDGE_SE3:QUAT 944 1219 3.6516 1.81628 0.0804641 0.0100124 0.00875596 -0.999484 0.0292464 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 3.99956 0.000293949 0.0401037 4.00142 0.032626 0.00409011 +EDGE_SE3:QUAT 945 1219 -0.748869 1.79782 0.0669941 0.00695796 0.00977108 -0.999922 0.00345423 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 3.9998 0.000270655 0.0278356 4.0004 0.0388995 0.000619666 +EDGE_SE3:QUAT 946 1219 -4.79427 1.92713 0.159155 0.00148548 -0.00876454 0.999959 0.0016944 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 3.99999 -5.30209e-05 -0.00594262 3.99973 0.0350369 0.000327228 +EDGE_SE3:QUAT 1220 1221 4.14758 -0.717442 0.00439689 0.000670905 0.00215106 -0.168549 0.985691 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 4.00008 -1.39972e-05 0.017812 3.99998 -0.00151816 3.88644 +EDGE_SE3:QUAT 943 1220 3.33306 2.08863 0.0202822 0.000847727 0.00833585 -0.999098 0.0416227 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 3.99999 4.97222e-05 0.00340503 3.99975 0.0329164 0.00720408 +EDGE_SE3:QUAT 944 1220 -0.480546 1.88378 0.0390335 0.0109224 -0.00661028 0.998674 0.0498697 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 3.99947 -0.000152868 -0.0438568 4.0019 0.0219443 0.0105508 +EDGE_SE3:QUAT 945 1220 -4.87913 2.07426 0.0617558 0.0135982 -0.00823981 0.997039 0.0752377 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 3.99916 -0.00011818 -0.0548752 4.00305 0.0243794 0.02355 +EDGE_SE3:QUAT 1221 1222 3.93188 -0.763247 -0.00145198 0.000263118 -0.00206398 -0.179295 0.983793 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 4.00006 -1.82672e-05 -0.0151682 3.99999 0.0013186 3.87147 +EDGE_SE3:QUAT 941 1221 5.40572 4.3237 0.0466614 0.0051299 0.00882636 -0.9583 0.285581 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 3.99974 -7.49694e-05 0.0245149 4.00073 0.0175557 0.326488 +EDGE_SE3:QUAT 942 1221 2.53076 2.75922 -0.00742442 0.000760543 0.0043032 -0.997533 0.0700577 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 3.99999 2.12537e-05 0.00307643 3.99995 0.0165777 0.0197038 +EDGE_SE3:QUAT 943 1221 -0.855032 2.46922 0.0300406 -0.00156004 -0.00767339 0.991774 0.127758 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 4 -1.29717e-05 0.00626313 3.99976 0.0310157 0.0655426 +EDGE_SE3:QUAT 944 1221 -4.52413 3.00384 0.151406 0.00957246 -0.00401464 0.976114 0.217013 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 3.99965 0.000371142 -0.0412241 4.00159 -0.00164056 0.188824 +EDGE_SE3:QUAT 1222 1223 4.0147 -0.79794 0.00817771 0.00626466 0.00424826 -0.169876 0.985436 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 4.00035 3.55289e-05 0.045054 3.99986 -0.00414235 3.88507 +EDGE_SE3:QUAT 940 1222 4.59399 3.81706 0.00786607 0.00199196 0.00547473 -0.957897 0.287052 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 3.99993 1.17526e-05 0.00992605 4.00013 0.0133235 0.329675 +EDGE_SE3:QUAT 941 1222 1.7169 2.78569 -0.000662953 0.00161649 0.00863915 -0.993949 0.109489 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 3.99995 0.000100424 0.00667279 3.99984 0.0321266 0.0482239 +EDGE_SE3:QUAT 942 1222 -1.45028 2.96191 -0.00991066 0.00173406 -0.0039985 0.99394 0.109841 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 3.99997 -2.79848e-05 -0.0071031 4.00002 0.0140085 0.0483231 +EDGE_SE3:QUAT 943 1222 -4.46588 4.16823 0.0413032 0.00158527 -0.00799338 0.952909 0.303147 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 3.99988 -6.11219e-05 -0.00893469 4.0001 0.0213789 0.367752 +EDGE_SE3:QUAT 1223 1224 4.28332 -0.590191 -0.0104682 -0.00162175 -0.00108102 -0.110823 0.993838 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 4.00002 4.81671e-06 -0.0106284 3.99999 0.000625742 3.9509 +EDGE_SE3:QUAT 939 1223 4.29654 3.0031 -0.00453507 -0.00166322 0.00313434 -0.957055 0.289885 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 4 2.94851e-06 -0.00682655 3.99996 0.0135153 0.336196 +EDGE_SE3:QUAT 940 1223 0.824271 2.28531 -0.00785147 0.00695217 0.0010979 -0.992769 0.119836 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 3.99981 -0.000110679 0.0284158 4.00078 -0.00233568 0.0576492 +EDGE_SE3:QUAT 941 1223 -2.35917 2.68009 -0.00209792 -0.00521766 -0.00305965 0.9981 0.0613098 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 3.99991 9.53225e-05 0.0209827 4.00035 0.0146753 0.0152 +EDGE_SE3:QUAT 942 1223 -5.18144 4.5928 0.0271137 -0.00131807 0.00292158 0.960872 0.276975 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 3.99998 -5.82871e-07 0.00633988 4.00005 -0.00680983 0.306886 +EDGE_SE3:QUAT 1224 1225 4.09698 -0.272728 0.0109815 -0.000236837 0.000192393 -0.0328464 0.99946 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 4 -1.93574e-07 0.00144337 4 -2.31803e-05 3.99568 +EDGE_SE3:QUAT 938 1224 4.03842 1.75958 0.00426674 -0.000906863 0.00694754 -0.937717 0.347331 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 3.99995 7.72606e-05 -0.00189306 3.9999 0.021988 0.482699 +EDGE_SE3:QUAT 939 1224 0.408319 1.11429 -0.00392961 -0.00331902 0.0040779 -0.983243 0.182223 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 3.99999 -5.09333e-05 -0.0137238 4 0.0196515 0.132969 +EDGE_SE3:QUAT 940 1224 -3.47465 1.83065 -0.0784999 0.00567086 0.00341305 -0.999937 0.00910517 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 3.99987 7.11716e-05 0.0226863 4.00048 0.0132386 0.000504109 +EDGE_SE3:QUAT 1225 1226 4.36277 -0.126191 0.0209198 -0.000631615 0.000332429 -0.0131754 0.999913 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 4 -8.30454e-07 0.00255889 4 -1.6638e-05 3.99931 +EDGE_SE3:QUAT 937 1225 5.14452 0.974128 0.00787545 -0.00127176 0.00556629 -0.815855 0.578229 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 3.99993 2.2915e-05 0.00168334 4.00001 0.0099342 1.33746 +EDGE_SE3:QUAT 938 1225 0.771005 -0.701014 0.0106823 -0.00101362 0.00698698 -0.948573 0.31648 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 3.99996 7.63818e-05 -0.00284429 3.99987 0.0235095 0.400799 +EDGE_SE3:QUAT 939 1225 -3.51688 -0.0924972 0.0308274 -0.00341001 0.0040328 -0.988697 0.149835 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 3.99999 -5.82554e-05 -0.0139836 4.00003 0.0192292 0.0899464 +EDGE_SE3:QUAT 1226 1227 3.99601 -0.244199 0.0201055 0.00118868 -0.00192429 -0.0541365 0.998531 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 4.00005 -1.29035e-05 -0.0145561 3.99999 0.000386541 3.98833 +EDGE_SE3:QUAT 937 1226 3.56391 -3.11844 0.0159283 -0.00148098 0.00630774 -0.823496 0.567286 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 3.99991 3.63645e-05 0.00119405 4.00001 0.0119629 1.28734 +EDGE_SE3:QUAT 938 1226 -2.80446 -3.21987 0.0216331 -0.000983799 0.00764669 -0.952653 0.303961 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 3.99995 8.97817e-05 -0.00272326 3.99984 0.0259258 0.36976 +EDGE_SE3:QUAT 1227 1228 4.10491 -0.493713 0.00705586 -0.000298434 0.013314 -0.122495 0.99238 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 4.00269 -0.000519366 0.10375 3.99938 -0.00630886 3.94267 +EDGE_SE3:QUAT 937 1227 1.91796 -6.75315 0.0191988 -0.00299761 0.00417567 -0.852715 0.522352 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 3.99998 4.20808e-05 -0.0110429 3.99992 0.0155786 1.09152 +EDGE_SE3:QUAT 1228 1229 3.91867 -0.605625 0.0140486 -0.00190942 0.00270695 -0.151872 0.988395 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 4.00006 -3.48347e-05 0.0174845 3.99999 -0.00122067 3.90782 +EDGE_SE3:QUAT 1229 1230 4.1962 -0.781357 0.0210853 0.000902983 -0.00165642 -0.178191 0.983994 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 4.00003 -1.30987e-05 -0.0107353 3.99999 0.000880027 3.87302 +EDGE_SE3:QUAT 298 1229 3.62766 -4.66082 0.0540011 -0.0137078 -0.00407107 0.702272 0.711765 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 4.00029 0.000129689 0.0658021 3.99961 0.0383455 2.0283 +EDGE_SE3:QUAT 299 1229 -2.72528 -4.79571 0.0391088 -0.0101468 0.00223146 0.5212 0.853372 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 4.00058 0.000261732 0.063079 3.99982 0.0209423 2.91439 +EDGE_SE3:QUAT 1230 1231 4.04563 -0.695669 0.00909816 0.00344374 -0.00494473 -0.145818 0.989293 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 4.00021 -0.000115179 -0.0323632 3.99995 0.00218398 3.91521 +EDGE_SE3:QUAT 298 1230 4.47702 -0.454809 0.0344595 -0.0110279 -0.00704188 0.564054 0.825634 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 3.99955 -0.000324853 0.0270973 3.99976 0.0174015 2.72741 +EDGE_SE3:QUAT 299 1230 -0.116648 -1.43458 0.0156841 -0.00881817 -0.000372797 0.360889 0.932567 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 3.99993 -0.000110061 0.0324541 3.99989 0.00816902 3.47928 +EDGE_SE3:QUAT 300 1230 -4.56397 -0.9112 -0.0198935 -0.00839259 -0.00159007 0.256998 0.966374 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 3.99975 -8.85395e-05 0.0132617 3.99997 0.00286682 3.73583 +EDGE_SE3:QUAT 1231 1232 4.17224 -0.543958 -0.0730698 0.00278445 0.0197861 -0.100023 0.994785 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 4.00632 -0.000731831 0.159461 3.99847 -0.0079975 3.96633 +EDGE_SE3:QUAT 298 1231 6.56397 3.04215 0.0678757 -0.00435378 -0.0107219 0.437708 0.899043 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 4.00028 0.0005185 -0.0423914 4.00014 -0.00558783 3.234 +EDGE_SE3:QUAT 299 1231 3.33977 0.760827 0.0145909 -0.00369438 -0.00529439 0.221185 0.975211 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 4.00016 0.000136708 -0.0297993 3.99997 -0.00281786 3.80453 +EDGE_SE3:QUAT 300 1231 -0.721445 0.503532 -0.00145723 -0.00368489 -0.00670047 0.11323 0.993539 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 4.00051 0.000186375 -0.0476163 3.99988 -0.00258611 3.94928 +EDGE_SE3:QUAT 301 1231 -4.77121 0.598596 -0.048555 -0.00024379 -0.0171599 0.100548 0.994784 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 4.00455 0.000712485 -0.135043 3.99892 -0.00677158 3.96411 +EDGE_SE3:QUAT 1232 1233 4.06971 -0.254054 0.0131586 -0.00377122 -0.000438454 -0.0363515 0.999332 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 3.99995 1.04182e-05 -0.00514422 4 0.000103392 3.99472 +EDGE_SE3:QUAT 300 1232 3.47193 0.927567 -0.0161276 -0.00244309 0.0129489 0.0130469 0.999828 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 4.00268 -7.45886e-05 0.104008 3.99932 0.00067057 4.00202 +EDGE_SE3:QUAT 301 1232 -0.574991 0.912082 0.0283217 0.00229669 0.00302343 0.000398409 0.999993 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 4.00013 2.78493e-05 0.024177 3.99996 5.31941e-06 4.00015 +EDGE_SE3:QUAT 302 1232 -5.05292 0.903923 0.0419166 0.00209281 0.00372959 0.016896 0.999848 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 4.0002 3.61309e-05 0.0294009 3.99995 0.000247866 3.99907 +EDGE_SE3:QUAT 1233 1234 4.13991 -0.162665 0.0213623 0.0029158 -0.00489452 -0.0167388 0.999844 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 4.00034 -6.53303e-05 -0.0385567 3.99991 0.000322732 3.99925 +EDGE_SE3:QUAT 301 1233 3.47257 0.660489 0.0149675 -0.00167128 0.0024675 -0.0360824 0.999344 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 4.00008 -2.06121e-05 0.0189787 3.99998 -0.000338065 3.99488 +EDGE_SE3:QUAT 302 1233 -0.987291 0.794189 0.0264404 -0.00202413 0.00325938 -0.0196613 0.999799 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 4.00015 -3.05964e-05 0.0255833 3.99996 -0.000250414 3.99862 +EDGE_SE3:QUAT 303 1233 -5.09782 0.787934 0.0364512 -0.00138234 0.00649092 -0.00426934 0.999969 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 4.00066 -4.01536e-05 0.0518626 3.99983 -0.000112102 4.0006 +EDGE_SE3:QUAT 1234 1235 4.34762 -0.120675 0.0336497 -4.37966e-05 -0.00871914 -0.00618674 0.999943 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 4.00122 -9.76317e-06 -0.0697709 3.9997 0.000215919 4.00106 +EDGE_SE3:QUAT 302 1234 3.13456 0.444781 0.0206286 0.000633544 -0.001892 -0.0359631 0.999351 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 4.00005 -7.66339e-06 -0.0148337 3.99999 0.00026498 3.99488 +EDGE_SE3:QUAT 303 1234 -0.970376 0.572468 0.00777516 0.00113634 0.00132936 -0.0208646 0.999781 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 4.00002 5.33134e-06 0.0109124 3.99999 -0.000114758 3.99829 +EDGE_SE3:QUAT 304 1234 -5.21225 0.604924 -0.000422741 -0.00160817 0.00518469 -0.00795252 0.999954 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 4.00042 -3.82959e-05 0.0413238 3.99989 -0.000165183 4.00017 +EDGE_SE3:QUAT 1235 1236 4.33421 -0.101638 -0.0221362 0.00239534 0.00287819 -2.18399e-05 0.999993 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 4.00011 2.75765e-05 0.0230266 3.99997 2.2479e-07 4.00013 +EDGE_SE3:QUAT 302 1235 7.42094 0.0146879 0.0696555 0.000309751 -0.0102409 -0.0421161 0.99906 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 4.00166 -0.00011803 -0.0815822 3.99959 0.00171799 3.99457 +EDGE_SE3:QUAT 303 1235 3.35431 0.267409 0.0273866 0.000691153 -0.00720643 -0.0269954 0.999609 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 4.00082 -5.32122e-05 -0.0573749 3.9998 0.000774413 3.99791 +EDGE_SE3:QUAT 304 1235 -0.85909 0.397143 -0.00672545 -0.00196234 -0.00364869 -0.0139347 0.999894 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 4.0002 2.45341e-05 -0.0295103 3.99995 0.000205742 3.99944 +EDGE_SE3:QUAT 305 1235 -5.07183 0.473851 0.0149781 -0.00125682 -0.00162579 -0.0105953 0.999942 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 4.00004 7.62072e-06 -0.013164 3.99999 6.99368e-05 3.99959 +EDGE_SE3:QUAT 1236 1237 4.39458 -0.101868 0.00200279 0.00176007 0.00459084 0.00176385 0.999986 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 4.00032 3.31771e-05 0.0366918 3.99992 3.32445e-05 4.00032 +EDGE_SE3:QUAT 304 1236 3.44779 0.186147 0.00317008 0.000292866 -0.000796482 -0.0143071 0.999897 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 4.00001 -1.13794e-06 -0.00631964 4 4.50879e-05 3.99919 +EDGE_SE3:QUAT 305 1236 -0.753769 0.284566 0.0125801 0.0010381 0.00135498 -0.0108462 0.99994 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 4.00003 5.2316e-06 0.0109731 3.99999 -5.97036e-05 3.99956 +EDGE_SE3:QUAT 306 1236 -5.06677 0.378814 -0.0166649 -0.00231317 -0.00254149 -0.00977875 0.999946 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 4.00008 2.23843e-05 -0.0206007 3.99997 0.000100803 3.99972 +EDGE_SE3:QUAT 1237 1238 4.36537 -0.0749585 0.0334369 -0.000498591 0.00973279 0.0017546 0.999951 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 4.00152 -1.54482e-05 0.0778982 3.99962 6.72768e-05 4.0015 +EDGE_SE3:QUAT 305 1237 3.62689 0.0918877 0.00325318 0.00284457 0.00593823 -0.00939234 0.999934 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 4.00054 6.01633e-05 0.0478256 3.99986 -0.000222739 4.00022 +EDGE_SE3:QUAT 306 1237 -0.676716 0.197736 0.0154189 -0.000424211 0.00208199 -0.00805453 0.999965 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 4.00007 -4.35562e-06 0.0166136 3.99998 -6.6897e-05 3.99981 +EDGE_SE3:QUAT 307 1237 -4.98299 0.281823 -0.13332 0.00108437 -0.00992637 -0.00764424 0.999921 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 4.00157 -6.10859e-05 -0.0793317 3.99961 0.000305953 4.00134 +EDGE_SE3:QUAT 1238 1239 4.01047 -0.0832888 0.0278924 -0.00238523 -0.00354607 0.00214812 0.999989 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 4.00018 3.43864e-05 -0.0283079 3.99995 -3.11037e-05 4.00018 +EDGE_SE3:QUAT 306 1238 3.6969 0.0502191 0.0323766 -0.00105788 0.0116832 -0.00630371 0.999911 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 4.00218 -7.01066e-05 0.0934243 3.99946 -0.000298254 4.00202 +EDGE_SE3:QUAT 307 1238 -0.607058 0.128892 -0.00408112 0.00040811 -0.000218439 -0.00576643 0.999983 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 4 -3.5532e-07 -0.00171919 4 4.93001e-06 3.99987 +EDGE_SE3:QUAT 308 1238 -4.94104 0.223551 -0.0549936 0.00398645 -0.000843899 -0.00551845 0.999976 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 3.99995 -1.28426e-05 -0.00648675 4 1.77193e-05 3.99989 +EDGE_SE3:QUAT 1239 1240 4.38825 -0.0768462 -0.00850983 -0.00348524 -0.00190626 0.00280704 0.999988 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 4.00001 2.65444e-05 -0.0151324 3.99999 -2.14846e-05 4.00003 +EDGE_SE3:QUAT 307 1239 3.38881 0.0190673 0.0252429 -0.00190671 -0.00385076 -0.00380565 0.999984 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 4.00022 2.81245e-05 -0.0308939 3.99994 5.8168e-05 4.00018 +EDGE_SE3:QUAT 308 1239 -0.937206 0.0965132 -0.0145724 0.00137449 -0.00435306 -0.00334843 0.999984 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 4.00029 -2.54071e-05 -0.0347708 3.99992 5.88178e-05 4.00026 +EDGE_SE3:QUAT 309 1239 -5.27239 0.194696 0.00513082 0.00332883 0.000196753 -0.00339411 0.999989 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 3.99996 2.917e-06 0.00170955 4 -2.97435e-06 3.99995 +EDGE_SE3:QUAT 1240 1241 4.39317 -0.0782749 0.00117039 -0.000137438 0.00280211 0.003612 0.99999 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 4.00013 -8.60186e-07 0.022423 3.99997 4.04768e-05 4.00007 +EDGE_SE3:QUAT 308 1240 3.44975 -0.0120601 0.0171999 -0.00222923 -0.00614213 -0.000492225 0.999979 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 4.00058 5.43708e-05 -0.0491563 3.99985 1.00842e-05 4.0006 +EDGE_SE3:QUAT 309 1240 -0.888799 0.0862435 -0.000971144 -0.000286315 -0.00152706 -0.000576665 0.999999 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 4.00004 1.71703e-06 -0.0122186 3.99999 3.50725e-06 4.00004 +EDGE_SE3:QUAT 310 1240 -5.32893 0.165892 0.0143379 0.000920137 -0.000474465 -0.000490558 0.999999 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 4 -1.74561e-06 -0.0037903 4 9.34199e-07 4 +EDGE_SE3:QUAT 1241 1242 4.29742 -0.0812807 0.0350216 -2.39898e-06 -0.00157653 0.001041 0.999998 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 4.00004 7.72256e-08 -0.0126123 3.99999 -6.56503e-06 4.00004 +EDGE_SE3:QUAT 309 1241 3.49233 0.00680438 0.00555718 -0.000456687 0.00125127 0.00284436 0.999995 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 4.00002 -2.18337e-06 0.0100257 3.99999 1.42487e-05 3.99999 +EDGE_SE3:QUAT 310 1241 -0.940028 0.0943873 0.0217563 0.000531555 0.00259396 0.00323319 0.999991 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 4.00011 6.02976e-06 0.0207312 3.99997 3.35908e-05 4.00007 +EDGE_SE3:QUAT 311 1241 -5.16295 0.198978 0.00333553 -0.000453287 0.0036231 0.0039281 0.999986 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 4.00021 -5.33769e-06 0.0290069 3.99995 5.68494e-05 4.00015 +EDGE_SE3:QUAT 1242 1243 4.41356 -0.10973 0.0494247 0.00130954 -0.00279041 -0.00491362 0.999983 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 4.00012 -1.54633e-05 -0.0222458 3.99997 5.48376e-05 4.00003 +EDGE_SE3:QUAT 310 1242 3.34706 0.0371117 0.03013 0.000829639 0.00110724 0.00460395 0.999988 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 4.00002 3.78337e-06 0.00881184 4 2.02737e-05 3.99993 +EDGE_SE3:QUAT 311 1242 -0.877948 0.139121 0.00801981 -0.000341058 0.00215083 0.00536632 0.999983 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 4.00007 -2.34228e-06 0.0172281 3.99998 4.62091e-05 3.99996 +EDGE_SE3:QUAT 312 1242 -5.07574 0.22769 -0.0519265 -0.000962894 0.000981281 0.00619315 0.99998 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 4.00001 -3.68002e-06 0.00792137 4 2.45802e-05 3.99986 +EDGE_SE3:QUAT 1243 1244 4.21939 -0.133589 0.0256481 -0.000235212 -0.00729081 -0.00989811 0.999924 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 4.00085 -5.77016e-06 -0.0583567 3.99979 0.000288704 4.00046 +EDGE_SE3:QUAT 311 1243 3.53803 0.0762828 0.0363643 0.00090294 -0.000580999 0.000189638 0.999999 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 4 -2.09813e-06 -0.00465005 4 -4.33657e-07 4.00001 +EDGE_SE3:QUAT 312 1243 -0.651019 0.170898 -0.00893512 0.000303229 -0.00181354 0.00129434 0.999997 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 4.00005 -2.09849e-06 -0.0145131 3.99999 -9.36984e-06 4.00005 +EDGE_SE3:QUAT 313 1243 -4.7964 0.234541 0.00173069 -0.00136401 0.00462712 0.00355405 0.999982 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 4.00034 -2.34747e-05 0.0370771 3.99991 6.52332e-05 4.00029 +EDGE_SE3:QUAT 1244 1245 4.18351 -0.165785 -0.00227905 0.00176286 -0.00126338 -0.02435 0.999701 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 4.00001 -9.15232e-06 -0.00958316 3.99999 0.000114612 3.99765 +EDGE_SE3:QUAT 312 1244 3.55302 0.0478986 0.0352311 -0.000108387 -0.00904988 -0.00851283 0.999923 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 4.00131 -1.2813e-05 -0.072423 3.99967 0.000308319 4.00102 +EDGE_SE3:QUAT 313 1244 -0.574973 0.144295 -0.00404447 -0.00166146 -0.0025674 -0.00585648 0.999978 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 4.0001 1.62575e-05 -0.0206553 3.99997 6.03356e-05 3.99997 +EDGE_SE3:QUAT 314 1244 -4.64969 0.0986302 0.00174633 -0.0015008 0.000508271 0.0119308 0.999928 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 4 -3.18521e-06 0.00428014 4 2.59483e-05 3.99944 +EDGE_SE3:QUAT 1245 1246 4.22228 -0.28535 -0.0135961 -0.00467568 0.0227838 -0.0737539 0.997005 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 4.00772 -0.00129124 0.176951 3.99814 -0.00654635 3.98605 +EDGE_SE3:QUAT 313 1245 3.59288 -0.0581483 0.0116333 0.00027557 -0.0038759 -0.0303429 0.999532 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 4.00024 -1.51142e-05 -0.0308657 3.99994 0.000467725 3.99656 +EDGE_SE3:QUAT 314 1245 -0.467032 0.0338509 0.00325977 0.000274972 -0.000485385 -0.0121988 0.999925 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 4 -5.94184e-07 -0.00384197 4 2.33517e-05 3.99941 +EDGE_SE3:QUAT 315 1245 -4.65168 -0.456411 -0.146545 0.00659222 -0.0203235 0.0772079 0.996786 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 4.00683 0.00024414 -0.167472 3.99826 -0.00648536 3.98315 +EDGE_SE3:QUAT 1246 1247 4.0228 -0.605478 0.0246658 0.00100961 0.000427022 -0.150432 0.98862 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 4 1.58599e-06 0.00509591 4 -0.000426012 3.90949 +EDGE_SE3:QUAT 314 1246 3.76118 -0.348887 -0.0056122 -0.00405022 0.0223669 -0.0857755 0.996055 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 4.00741 -0.00132965 0.173086 3.99824 -0.0074193 3.97804 +EDGE_SE3:QUAT 315 1246 -0.450916 -0.0811379 0.0156137 0.00142153 0.00251281 0.00367786 0.999989 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 4.00009 1.47841e-05 0.0200397 3.99997 3.70297e-05 4.00005 +EDGE_SE3:QUAT 316 1246 -4.54153 -0.877939 -0.0210546 -0.000583256 0.000389695 0.160653 0.987011 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 4 -3.72371e-07 0.00410273 4 0.000356356 3.89677 +EDGE_SE3:QUAT 1247 1248 4.22082 -0.925436 0.0182567 0.00505598 -0.00583646 -0.205189 0.978692 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 4.00014 -0.000162697 -0.0316735 3.99997 0.00272319 3.83183 +EDGE_SE3:QUAT 271 1247 -1.48883 7.31104 -0.0251178 0.000979546 0.00948189 -0.858612 0.512538 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 3.99983 -0.000100605 0.0153436 4.00033 0.0124955 1.05097 +EDGE_SE3:QUAT 315 1247 3.57552 -0.648453 0.0136093 0.00201393 0.00346382 -0.146828 0.989154 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 4.00021 -1.78241e-05 0.0303182 3.99994 -0.00228994 3.914 +EDGE_SE3:QUAT 316 1247 -0.535014 -0.178962 0.00279739 0.000419388 0.000992075 0.0107705 0.999941 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 4.00001 1.9004e-06 0.00788104 4 4.23519e-05 3.99955 +EDGE_SE3:QUAT 317 1247 -4.48142 -1.0264 0.0150089 -0.00375612 0.00500607 0.185653 0.982595 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 4.00048 5.17468e-05 0.0461768 3.99987 0.00447798 3.86266 +EDGE_SE3:QUAT 1248 1249 4.01439 -0.829551 -0.00593072 0.00129927 0.00655299 -0.185172 0.982683 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 4.00068 -0.000160851 0.0525799 3.99985 -0.00487277 3.86354 +EDGE_SE3:QUAT 269 1248 4.01497 3.83352 0.00933374 0.00142572 0.00308832 -0.9476 0.319442 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 3.99997 -7.29615e-06 0.00731223 4.00007 0.00604545 0.408199 +EDGE_SE3:QUAT 270 1248 -0.254235 3.94695 -0.0209427 -0.00200072 0.00331076 -0.946429 0.322889 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 4 3.44e-06 -0.00826199 3.99995 0.0145494 0.417106 +EDGE_SE3:QUAT 271 1248 -4.31564 4.03432 -0.0402614 -0.0035016 0.00230095 -0.945517 0.325547 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 4 -5.36409e-05 -0.0154158 4.00003 0.0150111 0.424046 +EDGE_SE3:QUAT 316 1248 3.71376 -1.01615 0.010536 0.00504736 -0.00476396 -0.194956 0.980787 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 4.00004 -0.000105746 -0.0244496 3.99998 0.00192902 3.84811 +EDGE_SE3:QUAT 317 1248 -0.237066 -0.318989 -0.00607211 0.00115964 -0.000591082 -0.0199538 0.9998 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 4 -2.67722e-06 -0.00444823 4 4.34558e-05 3.99841 +EDGE_SE3:QUAT 318 1248 -3.93239 -1.26993 -0.0699165 0.00124213 -0.0076381 0.194505 0.980871 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 4.00091 0.000235865 -0.0605085 3.99981 -0.00586487 3.84959 +EDGE_SE3:QUAT 1249 1250 4.15409 -0.620166 -0.0260729 0.00271131 0.00519733 -0.11002 0.993912 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 4.00046 -1.8033e-05 0.0443813 3.99988 -0.00249187 3.95207 +EDGE_SE3:QUAT 268 1249 4.51886 1.94449 -0.0166831 -0.00580242 0.00876761 -0.990905 0.134155 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 3.99996 -0.000174922 -0.0236616 3.99993 0.0396199 0.0725304 +EDGE_SE3:QUAT 269 1249 0.327533 2.07122 -0.0101893 0.00743604 0.004379 -0.990341 0.138387 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 3.99974 -6.66599e-05 0.0306777 4.00098 0.0086104 0.0768633 +EDGE_SE3:QUAT 270 1249 -3.90254 2.15167 -0.00898782 0.00415646 0.00352611 -0.989868 0.141887 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 3.99991 -3.69334e-06 0.0172006 4.00031 0.00877742 0.0806235 +EDGE_SE3:QUAT 317 1249 3.75104 -1.32476 -0.0134965 0.00247947 0.00605357 -0.205011 0.978738 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 4.00063 -0.00013702 0.0513441 3.99986 -0.00536348 3.83254 +EDGE_SE3:QUAT 318 1249 0.0890517 -0.512097 -0.010177 0.00251655 -0.000688775 0.00914788 0.999955 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 3.99998 -7.28317e-06 -0.0057857 4 -2.68527e-05 3.99967 +EDGE_SE3:QUAT 319 1249 -3.71317 -1.52687 -0.0555969 0.000274947 -0.00860898 0.281586 0.959497 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 4.00095 0.000431398 -0.0617371 3.99987 -0.00833407 3.68378 +EDGE_SE3:QUAT 1250 1251 4.0311 -0.26273 0.00626284 0.000318169 0.00330248 -0.0338787 0.99942 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 4.00018 -4.69584e-06 0.0265046 3.99996 -0.000449413 3.99558 +EDGE_SE3:QUAT 267 1250 4.57824 1.32814 0.0138677 0.00124641 0.00224416 -0.999768 0.0214025 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 3.99999 1.117e-05 0.00498926 4.00001 0.00875312 0.00185766 +EDGE_SE3:QUAT 268 1250 0.388487 1.41808 0.00852292 -0.00115958 0.00575799 -0.999677 0.0247375 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 4 -2.06988e-05 -0.00464207 3.99988 0.0232258 0.00258811 +EDGE_SE3:QUAT 269 1250 -3.81857 1.51989 -0.0965254 0.012506 0.00282559 -0.999503 0.028801 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 3.99936 3.35946e-05 0.0500826 4.00251 0.00840648 0.00396335 +EDGE_SE3:QUAT 318 1250 4.25055 -1.04821 -0.0328415 0.00536893 0.00484855 -0.100601 0.994901 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 4.00038 5.39092e-05 0.0446423 3.99987 -0.00234109 3.96002 +EDGE_SE3:QUAT 319 1250 0.113156 0.20249 0.000217391 0.0026311 -0.00281727 0.174537 0.984643 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 4.00015 7.40779e-06 -0.0269159 3.99995 -0.00247806 3.87833 +EDGE_SE3:QUAT 320 1250 -4.12122 -0.848624 -0.0219088 0.00336867 -0.00702575 0.423926 0.905663 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 4.00075 0.000464766 -0.0568512 3.99997 -0.0120236 3.28195 +EDGE_SE3:QUAT 1251 1252 4.15123 -0.114171 0.0248869 0.00166388 -0.00225969 -0.0023717 0.999993 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 4.00007 -1.52772e-05 -0.0180303 3.99998 2.15666e-05 4.00006 +EDGE_SE3:QUAT 266 1251 4.65659 1.3859 0.0356548 -0.00640447 -0.00220135 0.999963 0.00536189 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 3.99984 6.14707e-05 0.0256187 4.00063 0.0090815 0.000299704 +EDGE_SE3:QUAT 267 1251 0.559371 1.41805 0.0089041 -0.00438995 -0.00227587 0.999911 0.0124257 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 3.99992 4.51066e-05 0.0175638 4.00028 0.00953726 0.000717467 +EDGE_SE3:QUAT 268 1251 -3.64827 1.48075 0.0230234 -0.00188753 -0.00571248 0.99994 0.00913552 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 3.99999 4.14685e-05 0.00755139 3.99992 0.0229831 0.000480157 +EDGE_SE3:QUAT 319 1251 3.97145 1.32346 0.0337345 0.00241247 0.000660193 0.141049 0.989999 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 3.99998 -1.7913e-07 0.00109552 4 -2.24696e-05 3.92042 +EDGE_SE3:QUAT 320 1251 -1.32654 2.07559 0.0469209 0.0022692 -0.00372411 0.392726 0.919645 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 4.00025 0.00012655 -0.0327698 3.99997 -0.00662126 3.38333 +EDGE_SE3:QUAT 321 1251 -6.10068 0.52496 0.0751133 0.00501325 -0.00221341 0.579608 0.814877 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 4.00023 0.000177355 -0.0366443 4 -0.012664 2.65655 +EDGE_SE3:QUAT 1252 1253 4.2569 -0.0881383 0.0151824 0.000775765 -0.000382424 0.00164596 0.999998 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 4 -1.18878e-06 -0.0030747 4 -2.53188e-06 3.99999 +EDGE_SE3:QUAT 265 1252 4.77764 1.5059 0.0260807 0.00441121 0.00246512 -0.999983 0.00304212 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 3.99992 4.22287e-05 0.017645 4.00029 0.00975392 0.000138639 +EDGE_SE3:QUAT 266 1252 0.517815 1.54509 0.00547179 -0.00413243 -0.000447008 0.999963 0.00747422 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 3.99993 1.04354e-05 0.016531 4.00027 0.00203506 0.000292814 +EDGE_SE3:QUAT 267 1252 -3.57033 1.6557 -0.00315797 -0.00206132 -0.00053732 0.999893 0.0144946 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 3.99998 5.85986e-06 0.00824787 4.00007 0.00238718 0.000858812 +EDGE_SE3:QUAT 320 1252 1.60097 4.98919 0.107503 0.00496541 -0.00526255 0.391024 0.920352 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 4.00062 0.000274965 -0.0537567 3.9999 -0.0113056 3.38912 +EDGE_SE3:QUAT 321 1252 -4.63373 4.38074 0.138561 0.00767277 -0.00316851 0.577976 0.816011 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 4.00052 0.000386627 -0.0551499 3.99999 -0.0191668 2.66453 +EDGE_SE3:QUAT 811 1252 5.94645 3.52329 0.152855 0.0107162 0.0022022 -0.549859 0.835186 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 4.00065 -0.000344399 0.0667386 3.99983 -0.0235639 2.79173 +EDGE_SE3:QUAT 812 1252 -0.413312 4.78343 0.111667 0.00607296 0.00604821 -0.344802 0.938636 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 4.00085 -0.000288343 0.0631685 3.99982 -0.0117804 3.52544 +EDGE_SE3:QUAT 813 1252 -6.65557 2.96204 0.0639939 0.00640455 0.0034962 -0.101967 0.994761 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 4.00015 7.73969e-05 0.0353177 3.99991 -0.00192387 3.95872 +EDGE_SE3:QUAT 1253 1254 4.11135 -0.0829875 0.0158614 0.000818386 -0.00125115 0.00215887 0.999997 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 4.00002 -4.02592e-06 -0.0100303 3.99999 -1.0804e-05 4.00001 +EDGE_SE3:QUAT 264 1253 4.77461 1.50052 0.0372057 0.00561342 0.00384006 -0.99987 0.0146068 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 3.99987 7.6644e-05 0.022461 4.00046 0.0146987 0.0010336 +EDGE_SE3:QUAT 265 1253 0.534502 1.55462 0.00962314 0.00395802 0.00161388 -0.99998 0.00469259 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 3.99994 2.38809e-05 0.0158325 4.00024 0.00630711 0.000160696 +EDGE_SE3:QUAT 266 1253 -3.72451 1.70323 -0.0124971 -0.00380829 0.00043965 0.999976 0.00572785 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 3.99994 -4.71022e-06 0.0152338 4.00023 -0.00158408 0.00018988 +EDGE_SE3:QUAT 812 1253 2.76811 1.95913 0.0604421 0.0066475 0.00547475 -0.343039 0.939282 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 4.00077 -0.000231359 0.061529 3.99982 -0.0116216 3.53024 +EDGE_SE3:QUAT 813 1253 -2.52515 2.02129 0.047541 0.00687684 0.00287151 -0.100205 0.994939 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 4.00005 8.31752e-05 0.0308407 3.99993 -0.00167546 3.96007 +EDGE_SE3:QUAT 814 1253 -7.15335 -0.776925 -0.0537775 0.00527746 -0.00282814 0.178869 0.983855 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 4.00015 -3.19816e-05 -0.0326353 3.99993 -0.0032216 3.87229 +EDGE_SE3:QUAT 1254 1255 4.01975 -0.0783207 0.0143827 -0.00139272 0.00158682 0.00217691 0.999995 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 4.00003 -8.74182e-06 0.0127309 3.99999 1.3786e-05 4.00002 +EDGE_SE3:QUAT 263 1254 4.97293 1.41368 0.00965815 0.00331488 0.000789824 -0.999741 0.0225017 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 3.99996 4.57255e-06 0.0132696 4.00018 0.00255902 0.00207098 +EDGE_SE3:QUAT 264 1254 0.674783 1.46859 0.00610962 0.00447584 0.00296615 -0.999845 0.0167884 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 3.99992 4.59912e-05 0.017911 4.0003 0.0112565 0.00123931 +EDGE_SE3:QUAT 265 1254 -3.55738 1.60804 -0.00311461 0.00284621 0.000906116 -0.999971 0.00706876 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 3.99997 8.98108e-06 0.0113857 4.00013 0.00346322 0.000235278 +EDGE_SE3:QUAT 812 1254 5.85048 -0.766536 0.0168539 0.00730087 0.00396837 -0.341285 0.939923 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 4.00051 -0.00010424 0.053951 3.99983 -0.0105476 3.53482 +EDGE_SE3:QUAT 813 1254 1.49944 1.09791 0.0344679 0.00781292 0.00166447 -0.098256 0.995129 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 3.99988 8.35485e-05 0.0222752 3.99996 -0.00124084 3.9615 +EDGE_SE3:QUAT 814 1254 -3.27121 0.585727 -0.00106035 0.00657578 -0.00374256 0.180945 0.983464 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 4.00027 -4.48786e-05 -0.0424514 3.99988 -0.00422253 3.86948 +EDGE_SE3:QUAT 815 1254 -7.09529 -2.33583 -0.0152669 0.00852134 -0.00255784 0.443448 0.896256 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 4.00043 0.000129918 -0.0541423 3.99984 -0.014766 3.21414 +EDGE_SE3:QUAT 1255 1256 3.97739 -0.0725255 0.03029 3.92368e-05 -0.00104369 0.00275981 0.999996 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 4.00002 -9.16722e-08 -0.00835076 4 -1.15229e-05 3.99999 +EDGE_SE3:QUAT 262 1255 5.43097 1.25255 0.020783 0.00561847 -0.000637283 -0.999545 0.029632 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 3.99988 -3.64483e-05 0.0225031 4.0005 -0.00387499 0.00364269 +EDGE_SE3:QUAT 263 1255 0.951838 1.30585 0.000416941 0.00491313 0.00206145 -0.999685 0.0245082 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 3.9999 2.6784e-05 0.0196703 4.00038 0.00727164 0.00251262 +EDGE_SE3:QUAT 264 1255 -3.3341 1.41429 -0.0217096 0.00619553 0.0043906 -0.999792 0.0189365 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 3.99984 9.37211e-05 0.0247957 4.00056 0.0166118 0.00165713 +EDGE_SE3:QUAT 813 1255 5.42316 0.24291 0.0264076 0.00674685 0.00342478 -0.0959762 0.995355 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 4.00012 8.58932e-05 0.0347438 3.99992 -0.00178294 3.96345 +EDGE_SE3:QUAT 814 1255 0.5103 1.94127 0.0462001 0.00471684 -0.00247486 0.182912 0.983115 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 4.00012 -2.50103e-05 -0.0289367 3.99994 -0.00292979 3.86638 +EDGE_SE3:QUAT 815 1255 -4.59921 0.803307 0.0491206 0.00675592 -0.0016875 0.445808 0.895101 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 4.00023 6.0747e-05 -0.0410392 3.9999 -0.0114271 3.20544 +EDGE_SE3:QUAT 1256 1257 4.0782 -0.0656403 0.0280312 -0.000252686 -0.00288414 0.00197869 0.999994 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 4.00013 3.30931e-06 -0.0230676 3.99997 -2.28722e-05 4.00012 +EDGE_SE3:QUAT 210 1256 1.11943 6.22944 0.13474 0.00889449 0.00825381 -0.45167 0.892103 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 4.00164 -0.000902204 0.0885852 3.99984 -0.0217887 3.18594 +EDGE_SE3:QUAT 261 1256 5.91034 0.965084 0.0357511 0.00622296 0.00360325 -0.999486 0.031227 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 3.99983 6.25964e-05 0.0249288 4.0006 0.0128275 0.0040972 +EDGE_SE3:QUAT 262 1256 1.45596 1.09073 0.002662 0.00450829 -0.000623405 -0.999461 0.0325168 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 3.99992 -2.67867e-05 0.0180614 4.00032 -0.00365899 0.00431436 +EDGE_SE3:QUAT 263 1256 -3.02523 1.19524 -0.0137142 0.00404155 0.00208657 -0.999612 0.0274907 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 3.99993 2.35237e-05 0.0161848 4.00025 0.00744302 0.00310235 +EDGE_SE3:QUAT 264 1256 -7.2948 1.34124 -0.0424124 0.00521736 0.00458572 -0.999744 0.0215179 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 3.99988 8.4593e-05 0.0208845 4.00038 0.0174264 0.00203713 +EDGE_SE3:QUAT 814 1256 4.25988 3.30078 0.103472 0.00512025 -0.00356553 0.185717 0.982584 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 4.00026 -1.4009e-05 -0.0382122 3.9999 -0.00385258 3.8624 +EDGE_SE3:QUAT 815 1256 -2.14554 3.92326 0.115383 0.0070848 -0.00283264 0.447876 0.894063 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 4.0004 0.000150378 -0.0491884 3.99989 -0.0132032 3.19823 +EDGE_SE3:QUAT 1257 1258 4.0165 -0.14355 0.000528269 -0.00333231 0.00111688 -0.0323616 0.99947 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 3.99997 -1.27434e-05 0.00762769 4 -0.000116446 3.99583 +EDGE_SE3:QUAT 210 1257 3.4608 2.92782 0.0680338 0.00732973 0.00590683 -0.449844 0.893057 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 4.00094 -0.000486849 0.0679101 3.99988 -0.0169277 3.19171 +EDGE_SE3:QUAT 211 1257 -2.82258 3.10795 0.0681153 0.0093877 0.00264993 -0.190298 0.981678 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 4.00006 0.000126642 0.0409789 3.99987 -0.00453689 3.85556 +EDGE_SE3:QUAT 260 1257 6.32142 0.56915 0.0232138 0.00305735 0.005047 -0.999761 0.0210702 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 3.99996 6.08516e-05 0.0122383 4.00006 0.0196513 0.00190985 +EDGE_SE3:QUAT 261 1257 1.86033 0.776268 0.0108511 0.00332778 0.00415446 -0.999433 0.0332537 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 3.99995 5.00795e-05 0.0133346 4.00013 0.0156885 0.00452935 +EDGE_SE3:QUAT 262 1257 -2.60877 0.895788 -0.00995842 0.00199655 -0.000133169 -0.999401 0.034554 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 3.99998 -4.33699e-06 0.00800044 4.00006 -0.00108237 0.00479222 +EDGE_SE3:QUAT 263 1257 -7.06902 1.03554 -0.0165385 0.00136789 0.00211128 -0.999549 0.0299147 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 3.99999 1.11083e-05 0.00547938 4.00002 0.00809923 0.00360349 +EDGE_SE3:QUAT 815 1257 0.347749 7.1392 0.187703 0.00825742 -0.00541422 0.449799 0.893075 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 4.00093 0.000447531 -0.0694354 3.99985 -0.0177379 3.19193 +EDGE_SE3:QUAT 1258 1259 4.00008 -0.398483 -0.0061603 -0.00243598 0.0096987 -0.105121 0.994409 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 4.00132 -0.000305953 0.0732766 3.99969 -0.00378356 3.95714 +EDGE_SE3:QUAT 210 1258 5.72472 -0.369432 0.000483191 0.00509153 0.00871151 -0.478518 0.87802 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 4.00117 -0.000848307 0.0719772 4.00005 -0.0172409 3.08536 +EDGE_SE3:QUAT 211 1258 0.850966 1.47102 0.0328259 0.00634991 0.00451654 -0.221679 0.975089 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 4.00046 -1.38782e-05 0.0498457 3.99984 -0.00604258 3.80405 +EDGE_SE3:QUAT 212 1258 -3.98979 0.619645 -0.0670869 0.00319663 -0.00927104 0.0479446 0.998802 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 4.00139 -1.9693e-05 -0.0757721 3.99964 -0.00182393 3.99224 +EDGE_SE3:QUAT 259 1258 6.4786 0.300298 -0.024705 0.00496992 -0.00699372 0.99957 0.028057 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 3.99989 -0.000131656 -0.0199054 4.00025 0.0268085 0.00342772 +EDGE_SE3:QUAT 260 1258 2.29498 0.531418 0.00633697 -0.00404856 -0.0081398 0.999894 0.0113982 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 3.99994 0.000129999 0.0161988 3.99998 0.0329194 0.000856238 +EDGE_SE3:QUAT 261 1258 -2.15744 0.662541 -0.0128381 0.0044686 0.00746045 -0.999962 0.000769664 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 3.99992 0.000133346 0.0178757 4.0001 0.0298167 0.000304501 +EDGE_SE3:QUAT 262 1258 -6.60287 0.770452 -0.0141326 0.00294176 0.00293342 -0.999989 0.00209994 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 3.99997 3.42273e-05 0.0117672 4.0001 0.0116846 8.63876e-05 +EDGE_SE3:QUAT 1259 1260 4.20627 -0.80123 0.00175093 -0.00220126 0.00289576 -0.18362 0.982991 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 4.00005 -4.08467e-05 0.0172631 3.99999 -0.0014002 3.86521 +EDGE_SE3:QUAT 211 1259 4.2745 -0.616321 -0.0198638 0.00584219 0.0152672 -0.322964 0.94627 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 4.00374 -0.00160114 0.124711 3.99947 -0.0202613 3.58665 +EDGE_SE3:QUAT 212 1259 0.000358266 0.602079 0.00464908 0.00145194 0.000919273 -0.0571691 0.998363 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 4.00001 4.85815e-06 0.00831207 4 -0.00024671 3.98694 +EDGE_SE3:QUAT 213 1259 -4.50356 -0.650219 -0.0106052 0.00453136 -0.00211681 0.217534 0.97604 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 4.0001 -1.75809e-05 -0.027203 3.99995 -0.00334119 3.8109 +EDGE_SE3:QUAT 258 1259 6.972 0.673099 0.0199888 -0.00432402 -0.00899615 0.988466 0.151115 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 3.99999 7.71337e-05 0.0176317 3.99974 0.0390542 0.0918108 +EDGE_SE3:QUAT 259 1259 2.54358 0.922409 0.0154079 -0.0040866 -0.00872761 0.991065 0.133033 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 3.99999 7.99073e-05 0.0166118 3.99977 0.0376474 0.071221 +EDGE_SE3:QUAT 260 1259 -1.65821 1.02717 -0.0192441 -0.0130541 -0.0108812 0.99302 0.116718 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 3.99962 0.000808521 0.0531508 4.00142 0.0541083 0.0559462 +EDGE_SE3:QUAT 261 1259 -6.13754 1.05012 -0.0401747 -0.0135145 -0.0101187 0.994386 0.104458 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 3.99953 0.000820935 0.0548578 4.00178 0.0505844 0.0450501 +EDGE_SE3:QUAT 1260 1261 3.92032 -0.768615 0.0071855 0.00352869 -0.0008826 -0.181085 0.983461 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 3.99995 6.09369e-06 0.000783991 4 -0.000313027 3.86883 +EDGE_SE3:QUAT 212 1260 4.09822 -0.670737 -0.00813335 -0.000854209 0.00414332 -0.239853 0.9708 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 4.00019 -8.9414e-05 0.0279644 3.99997 -0.00313703 3.77008 +EDGE_SE3:QUAT 213 1260 -0.338676 0.428526 0.0109009 0.00207972 0.00126592 0.0343974 0.999405 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 4 1.04682e-05 0.00925159 4 0.000154163 3.99529 +EDGE_SE3:QUAT 214 1260 -4.47134 -0.577596 0.00719768 -0.00234026 0.00030516 0.256499 0.966542 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 4 -7.54574e-06 0.00909172 3.99999 0.0014624 3.73685 +EDGE_SE3:QUAT 258 1260 3.18956 2.66899 0.015403 -0.00583411 -0.0113825 0.94397 0.329785 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 3.99998 -0.000111266 0.0235571 3.99941 0.0473459 0.435802 +EDGE_SE3:QUAT 259 1260 -1.31361 2.80386 0.0119829 -0.0056013 -0.0109693 0.949702 0.312913 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 3.99999 -8.10914e-05 0.0227591 3.99946 0.046157 0.392379 +EDGE_SE3:QUAT 260 1260 -5.54935 2.78661 -0.100823 -0.0140556 -0.015147 0.954627 0.297085 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 4.00008 0.000604466 0.0600133 3.99949 0.0781025 0.355614 +EDGE_SE3:QUAT 1261 1262 3.98043 -0.804755 0.00342582 0.00356994 0.00353122 -0.170589 0.98533 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 4.00024 -5.57079e-06 0.0341937 3.99993 -0.0030874 3.88389 +EDGE_SE3:QUAT 213 1261 3.59808 -0.0759889 0.00852126 0.00544596 0.000882031 -0.146899 0.989136 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 3.99995 4.15889e-05 0.0162908 3.99998 -0.00142545 3.91375 +EDGE_SE3:QUAT 214 1261 -0.703315 0.681173 0.0150895 0.00118677 8.6513e-06 0.0769629 0.997033 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 3.99999 -8.06774e-07 -0.00102312 4 -5.34377e-05 3.97631 +EDGE_SE3:QUAT 215 1261 -4.83187 0.0474415 -0.120524 -0.00481215 -0.0116106 0.217558 0.975967 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 4.00127 0.000674424 -0.0742159 3.99979 -0.00739085 3.81203 +EDGE_SE3:QUAT 258 1261 0.620736 5.69804 0.0307161 -0.00155212 -0.00920626 0.868816 0.495048 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 3.99984 -0.000101054 -0.000897457 3.99998 0.0209538 0.980484 +EDGE_SE3:QUAT 259 1261 -4.0034 5.74128 0.0202255 -0.00156508 -0.0088745 0.877297 0.479863 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 3.99985 -0.00010579 0.00017655 3.99995 0.0214255 0.921264 +EDGE_SE3:QUAT 1262 1263 4.22623 -0.517963 -0.0444016 -0.000178205 0.00732299 -0.0894533 0.995964 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 4.00083 -0.000118011 0.0577023 3.9998 -0.0025691 3.96882 +EDGE_SE3:QUAT 213 1262 7.16444 -2.00545 -0.00812331 0.00926406 0.0047914 -0.31358 0.949505 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 4.00072 -9.27365e-05 0.0654063 3.99974 -0.0117425 3.60773 +EDGE_SE3:QUAT 214 1262 3.35411 0.478073 0.015473 0.00456906 0.00395792 -0.0941255 0.995542 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 4.00025 4.24708e-05 0.0363756 3.99991 -0.00178442 3.96489 +EDGE_SE3:QUAT 215 1262 -0.8952 0.981754 -0.0221827 0.000144987 -0.00799477 0.0482092 0.998805 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 4.00102 6.91838e-05 -0.0638333 3.99975 -0.00153837 3.99172 +EDGE_SE3:QUAT 216 1262 -5.33337 0.800417 -0.0225707 0.000643651 -0.00871799 0.101508 0.994796 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 4.0012 0.000162611 -0.0694657 3.99971 -0.0035222 3.95999 +EDGE_SE3:QUAT 1263 1264 4.10957 -0.20373 -0.0112258 -0.00078834 0.00613159 -0.022805 0.999721 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 4.00059 -3.96324e-05 0.0488051 3.99985 -0.000556458 3.99852 +EDGE_SE3:QUAT 214 1263 7.398 -0.80331 -0.0676996 0.00459961 0.0117214 -0.182994 0.983033 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 4.00237 -0.000436385 0.0990286 3.99945 -0.00921909 3.8685 +EDGE_SE3:QUAT 215 1263 3.35812 0.875833 0.00642874 0.000291058 -0.00065116 -0.041453 0.99914 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 4.00001 -1.12993e-06 -0.00505125 4 0.000103605 3.99313 +EDGE_SE3:QUAT 216 1263 -1.09274 1.16365 0.00892234 0.000578298 -0.00133937 0.0118406 0.999929 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 4.00003 -2.61335e-06 -0.0107949 3.99999 -6.40428e-05 3.99947 +EDGE_SE3:QUAT 217 1263 -5.12877 1.21537 0.0534399 0.00333779 0.000294982 0.0169155 0.999851 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 3.99996 2.44987e-06 0.00168141 4 1.23121e-05 3.99886 +EDGE_SE3:QUAT 1264 1265 4.27514 -0.113246 0.0399614 -0.00181323 -0.000450286 -0.00478201 0.999987 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 3.99999 3.36718e-06 -0.0037062 4 8.93517e-06 3.99991 +EDGE_SE3:QUAT 215 1264 7.41881 0.320921 0.00174995 -0.0001083 0.00528171 -0.0640569 0.997932 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 4.00044 -4.47039e-05 0.0419149 3.99989 -0.00133926 3.98403 +EDGE_SE3:QUAT 216 1264 3.01092 1.03205 0.0114778 -0.000328609 0.00449164 -0.0108315 0.999931 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 4.00032 -1.11291e-05 0.0358866 3.99992 -0.000194464 3.99985 +EDGE_SE3:QUAT 217 1264 -1.02956 1.14375 0.0397435 0.00243296 0.00634637 -0.00630004 0.999957 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 4.00063 5.59648e-05 0.0509587 3.99984 -0.000158413 4.00049 +EDGE_SE3:QUAT 218 1264 -5.27095 1.22187 -0.0226374 0.00555286 0.00159877 -0.00564051 0.999967 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 3.99992 3.65372e-05 0.0131649 3.99999 -3.71253e-05 3.99992 +EDGE_SE3:QUAT 1265 1266 4.38717 -0.0894744 0.0224271 -0.00264 -0.00714265 -0.00181007 0.999969 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 4.00079 7.33596e-05 -0.0572079 3.9998 4.85815e-05 4.0008 +EDGE_SE3:QUAT 216 1265 7.25024 0.843815 0.0122555 -0.00240593 0.00420748 -0.015575 0.999867 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 4.00025 -4.6238e-05 0.0331997 3.99993 -0.00025839 3.99931 +EDGE_SE3:QUAT 217 1265 3.23826 0.97586 0.0215264 0.000423782 0.00595349 -0.0106395 0.999926 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 4.00057 1.0437e-06 0.0476799 3.99986 -0.00025346 4.00012 +EDGE_SE3:QUAT 218 1265 -1.01637 1.0509 0.0106926 0.00333086 0.00108367 -0.0101986 0.999942 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 3.99998 1.50315e-05 0.00907549 3.99999 -4.68686e-05 3.9996 +EDGE_SE3:QUAT 219 1265 -5.38336 1.15666 0.0253461 0.0048687 0.00635528 -0.0112982 0.999904 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 4.00057 0.000114772 0.0514982 3.99983 -0.00028745 4.00015 +EDGE_SE3:QUAT 1266 1267 4.30436 -0.0952666 0.0239535 0.00169146 -0.00627775 0.00021884 0.999979 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 4.00062 -4.22953e-05 -0.0502331 3.99984 -3.89856e-06 4.00063 +EDGE_SE3:QUAT 218 1266 3.36611 0.888498 0.0213189 0.000495796 -0.00596599 -0.0122561 0.999907 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 4.00057 -2.22535e-05 -0.0476501 3.99986 0.000292363 3.99997 +EDGE_SE3:QUAT 219 1266 -0.999849 0.958339 0.00272893 0.0017734 -0.000673804 -0.0128857 0.999915 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 3.99999 -4.58341e-06 -0.00511488 4 3.23805e-05 3.99934 +EDGE_SE3:QUAT 220 1266 -5.2328 1.08618 -0.00346361 -0.000763695 0.00358649 -0.0155628 0.999872 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 4.0002 -1.56454e-05 0.0285401 3.99995 -0.000221949 3.99923 +EDGE_SE3:QUAT 1267 1268 4.20989 -0.101247 -0.00227339 0.00203031 0.00196216 0.00114479 0.999995 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 4.00004 1.60036e-05 0.0156695 3.99998 9.1512e-06 4.00006 +EDGE_SE3:QUAT 219 1267 3.29876 0.750526 0.0241228 0.00346411 -0.00716474 -0.0125269 0.99989 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 4.00076 -0.000113326 -0.0567927 3.9998 0.000358998 4.00018 +EDGE_SE3:QUAT 220 1267 -0.941581 0.857693 -0.00987499 0.000839454 -0.00268202 -0.0155395 0.999875 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 4.00011 -1.15659e-05 -0.0212924 3.99997 0.000165167 3.99915 +EDGE_SE3:QUAT 221 1267 -5.10138 0.96164 -0.0143174 -0.00381389 -0.00121692 -0.0180768 0.999829 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 3.99997 1.9926e-05 -0.0105576 3.99999 9.77487e-05 3.99872 +EDGE_SE3:QUAT 1268 1269 4.09038 -0.0985277 0.0174486 0.00268807 0.00666051 0.00103644 0.999974 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 4.00068 7.27017e-05 0.0532583 3.99982 3.04663e-05 4.0007 +EDGE_SE3:QUAT 220 1268 3.25353 0.62682 0.00951496 0.00301418 -0.000684387 -0.0143103 0.999893 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 3.99997 -7.34598e-06 -0.00495581 4 3.42501e-05 3.99919 +EDGE_SE3:QUAT 221 1268 -0.927725 0.715128 0.00663054 -0.00208781 0.000790321 -0.0172987 0.999848 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 3.99999 -6.22532e-06 0.00588639 4 -4.96839e-05 3.99881 +EDGE_SE3:QUAT 222 1268 -5.03385 0.824324 -0.0498473 -0.00397839 -0.004422 -0.0202489 0.999777 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 4.00027 6.29895e-05 -0.0363225 3.99992 0.000369063 3.99869 +EDGE_SE3:QUAT 1269 1270 4.23211 -0.0903724 0.0395441 0.000709835 0.00264673 0.00243862 0.999993 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 4.00011 7.91516e-06 0.0211534 3.99997 2.59051e-05 4.00009 +EDGE_SE3:QUAT 220 1269 7.32433 0.414748 0.0344494 0.00577956 0.00618676 -0.0129536 0.99988 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 4.0005 0.000134275 0.0503845 3.99984 -0.000322913 3.99996 +EDGE_SE3:QUAT 221 1269 3.14714 0.497187 0.0128739 0.00089145 0.00749025 -0.0164202 0.999837 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 4.0009 4.61411e-06 0.0600852 3.99977 -0.000492806 3.99982 +EDGE_SE3:QUAT 222 1269 -0.955849 0.581056 0.0057295 -0.00127143 0.00223952 -0.0188071 0.99982 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 4.00007 -1.33454e-05 0.0176201 3.99998 -0.00016492 3.99866 +EDGE_SE3:QUAT 223 1269 -5.08211 0.670943 -0.0881416 -0.00133559 -0.0043421 -0.0201637 0.999786 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 4.0003 1.42217e-05 -0.035041 3.99992 0.00035375 3.99868 +EDGE_SE3:QUAT 1270 1271 4.23793 -0.0832059 0.0130887 -0.000949972 -0.00253657 0.00220791 0.999994 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 4.0001 9.96378e-06 -0.0202676 3.99997 -2.25132e-05 4.00008 +EDGE_SE3:QUAT 221 1270 7.38797 0.260756 -0.0145438 0.00184278 0.0102643 -0.0135984 0.999853 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 4.00168 4.15268e-05 0.0824227 3.99958 -0.000556974 4.00096 +EDGE_SE3:QUAT 222 1270 3.26604 0.323479 0.0234663 -0.000419196 0.00482364 -0.0167414 0.999848 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 4.00037 -1.7376e-05 0.0384918 3.99991 -0.000322234 3.99925 +EDGE_SE3:QUAT 223 1270 -0.876083 0.419203 -0.0142207 -0.000474467 -0.00168664 -0.0180849 0.999835 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 4.00005 1.98291e-06 -0.0135896 3.99999 0.000123145 3.99874 +EDGE_SE3:QUAT 224 1270 -4.95148 0.491512 -0.0265904 0.00100352 0.000693533 -0.0158991 0.999873 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 4 2.71716e-06 0.00573759 4 -4.6101e-05 3.999 +EDGE_SE3:QUAT 1271 1272 4.33299 -0.0821596 -0.00795936 -0.000902129 0.00165453 0.00248715 0.999995 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 4.00004 -5.8228e-06 0.0132631 3.99999 1.64458e-05 4.00002 +EDGE_SE3:QUAT 223 1271 3.35564 0.179728 0.0123482 -0.00133851 -0.00430558 -0.0151384 0.999875 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 4.00029 1.64575e-05 -0.0346781 3.99992 0.000262519 3.99938 +EDGE_SE3:QUAT 224 1271 -0.727843 0.256734 -0.00961536 -0.000146099 -0.00174537 -0.0130642 0.999913 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 4.00005 6.46159e-08 -0.0139824 3.99999 9.13688e-05 3.99937 +EDGE_SE3:QUAT 225 1271 -4.80117 0.321211 -0.0110984 0.00210569 -0.0014285 -0.00850863 0.999961 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 4.00001 -1.21331e-05 -0.0112117 3.99999 4.74926e-05 3.99974 +EDGE_SE3:QUAT 1272 1273 4.42034 -0.081149 -0.00529332 -0.00212979 0.00404544 0.00278921 0.999986 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 4.00024 -3.34728e-05 0.0324361 3.99993 4.44368e-05 4.00023 +EDGE_SE3:QUAT 224 1272 3.62236 0.0749069 0.00153173 -0.00102153 -9.30275e-05 -0.0107471 0.999942 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 4 4.66858e-07 -0.000875821 4 4.94174e-06 3.99954 +EDGE_SE3:QUAT 225 1272 -0.484099 0.172441 0.00125782 0.00111549 0.000420093 -0.00577574 0.999983 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 4 1.90647e-06 0.00343789 4 -9.99755e-06 3.99987 +EDGE_SE3:QUAT 226 1272 -5.00704 0.182254 -0.00109274 0.0019123 -0.00200763 0.00744329 0.999968 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 4.00005 -1.48417e-05 -0.0162306 3.99998 -6.04294e-05 3.99984 +EDGE_SE3:QUAT 1273 1274 4.36446 -0.0716169 0.0385608 -0.000368409 -0.00407892 0.00281621 0.999988 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 4.00027 7.13302e-06 -0.0326204 3.99993 -4.60821e-05 4.00023 +EDGE_SE3:QUAT 225 1273 3.94067 0.0428971 -0.0115886 -0.000905426 0.00450074 -0.00303837 0.999985 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 4.00032 -1.77598e-05 0.0359749 3.99992 -5.50867e-05 4.00029 +EDGE_SE3:QUAT 226 1273 -0.595701 0.164392 0.00588739 -3.31521e-05 0.00189674 0.0101296 0.999947 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 4.00006 6.23257e-07 0.0151758 3.99999 7.68652e-05 3.99965 +EDGE_SE3:QUAT 227 1273 -4.81902 0.133634 -0.00253428 0.00017842 0.00456679 0.0323942 0.999465 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 4.00033 1.93821e-05 0.0364102 3.99992 0.000589272 3.99613 +EDGE_SE3:QUAT 1274 1275 4.13866 -0.0952871 0.0521526 0.00312975 -0.00249384 -0.00654027 0.999971 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 4.00006 -3.16647e-05 -0.0197039 3.99998 6.46274e-05 3.99993 +EDGE_SE3:QUAT 226 1274 3.75015 0.189225 0.0243536 -0.000466938 -0.00211637 0.0135641 0.999906 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 4.00007 5.37544e-06 -0.0168505 3.99998 -0.000114154 3.99934 +EDGE_SE3:QUAT 227 1274 -0.473774 0.34572 8.54175e-05 -0.000161106 0.000568885 0.0355686 0.999367 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 4.00001 -9.09123e-08 0.00461115 4 8.23615e-05 3.99494 +EDGE_SE3:QUAT 228 1274 -4.56176 0.427569 -0.057038 -0.00462065 0.000664233 0.0463926 0.998912 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 3.99993 -1.92126e-05 0.00786522 4 0.000202109 3.99141 +EDGE_SE3:QUAT 1275 1276 4.36841 -0.24339 0.0256051 -0.00212862 -0.00291465 -0.0533952 0.998567 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 4.00013 1.47717e-05 -0.0245795 3.99996 0.000667052 3.98875 +EDGE_SE3:QUAT 227 1275 3.6599 0.540678 0.0433282 0.00293156 -0.00171413 0.0288765 0.999577 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 4.00002 -1.97777e-05 -0.0147112 3.99999 -0.000216986 3.99672 +EDGE_SE3:QUAT 228 1275 -0.443547 0.694602 -0.00374544 -0.00152003 -0.00142803 0.0397207 0.999209 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 4.00002 9.67333e-06 -0.0106734 3.99999 -0.000207073 3.99372 +EDGE_SE3:QUAT 229 1275 -4.75883 1.05193 -0.0375091 -0.0035471 0.000630055 0.00479851 0.999982 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 3.99996 -9.37324e-06 0.00524443 4 1.27099e-05 3.99991 +EDGE_SE3:QUAT 1276 1277 4.08961 -0.509676 -0.0318739 -0.0033163 0.0171753 -0.130332 0.991316 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 4.0041 -0.00105234 0.128898 3.99909 -0.008256 3.9362 +EDGE_SE3:QUAT 228 1276 3.93986 0.801219 0.0307274 -0.00325409 -0.00465141 -0.0136668 0.99989 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 4.00031 5.44433e-05 -0.0377368 3.99991 0.000257393 3.99961 +EDGE_SE3:QUAT 229 1276 -0.392004 0.863975 -0.015082 -0.00561615 -0.00230957 -0.0483492 0.998812 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 3.99999 5.58587e-05 -0.0216648 3.99997 0.000548575 3.99077 +EDGE_SE3:QUAT 230 1276 -4.30043 1.58044 -0.120491 -0.00898266 -0.0148421 -0.158032 0.987282 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 4.00397 -0.000380463 -0.131186 3.99896 0.0106663 3.9044 +EDGE_SE3:QUAT 1277 1278 3.93899 -0.681423 0.0119591 0.0015929 -0.00393197 -0.161705 0.98683 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 4.00017 -6.90974e-05 -0.0271938 3.99996 0.00208229 3.89559 +EDGE_SE3:QUAT 229 1277 3.6381 -0.0514941 -0.0158776 -0.00755921 0.0142463 -0.17866 0.983779 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 4.0019 -0.000968489 0.0927202 3.99963 -0.00767526 3.87445 +EDGE_SE3:QUAT 230 1277 -0.588981 -0.1697 -0.00938582 -0.00740225 0.00153178 -0.285721 0.958283 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 3.99981 7.61414e-05 -0.0132138 3.99997 0.00316791 3.67348 +EDGE_SE3:QUAT 231 1277 -4.65957 1.03207 0.0370582 -0.00463506 0.011217 -0.461812 0.886895 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 4.00021 -0.000524465 0.0405743 4.00018 -0.00487593 3.14721 +EDGE_SE3:QUAT 1278 1279 4.27577 -0.813417 0.00322983 -0.00135424 -0.000938552 -0.181341 0.983419 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 4.00002 1.16459e-06 -0.0100235 3.99999 0.000986347 3.86849 +EDGE_SE3:QUAT 229 1278 7.06111 -2.06389 -0.0855142 -0.00869378 0.00854004 -0.335109 0.9421 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 3.99979 -0.000187959 0.0247883 4.00004 -0.00152033 3.55089 +EDGE_SE3:QUAT 230 1278 2.32418 -2.87482 0.0196845 -0.00701297 -0.00401845 -0.436731 0.899556 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 4.00057 -0.000242548 -0.055493 3.99988 0.0139684 3.23783 +EDGE_SE3:QUAT 231 1278 -2.9707 -2.58582 0.00395463 -0.00662469 0.00585875 -0.599058 0.800657 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 3.99978 0.000136875 -0.0121701 3.99991 0.0112677 2.56447 +EDGE_SE3:QUAT 1279 1280 3.99586 -0.694316 -0.0130077 0.00567712 0.0139756 -0.142107 0.989736 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 4.00335 -0.000391159 0.118075 3.99917 -0.00852693 3.9227 +EDGE_SE3:QUAT 231 1279 -2.54084 -6.90835 0.020314 -0.00901636 0.00455068 -0.734516 0.678516 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 4.00003 4.33256e-05 -0.0395151 3.99976 0.0274641 1.8423 +EDGE_SE3:QUAT 1280 1281 4.32974 -0.484958 -0.00176581 0.00429947 2.32967e-05 -0.0773933 0.996991 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 3.99993 1.14989e-05 0.00416171 4 -0.00021251 3.97604 +EDGE_SE3:QUAT 1281 1282 4.11636 -0.154358 0.0191801 -0.00174376 -0.000513261 -0.0149288 0.999887 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 3.99999 3.83568e-06 -0.00441704 4 3.3732e-05 3.99911 +EDGE_SE3:QUAT 942 1281 1.70074 -6.19389 0.0773484 -0.0021136 0.00666387 0.910734 0.412935 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 3.9999 5.98181e-05 0.0140788 4.00026 -0.0102065 0.682171 +EDGE_SE3:QUAT 1282 1283 3.97622 -0.107225 0.0188768 -0.00106707 -0.00159982 -0.00439981 0.999988 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 4.00004 6.5964e-06 -0.0128546 3.99999 2.82547e-05 3.99996 +EDGE_SE3:QUAT 941 1282 4.7811 -2.35544 0.0296608 -0.00598579 -0.00211369 0.975602 0.219453 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 3.99994 0.000179629 0.025432 4.00036 0.0174596 0.192884 +EDGE_SE3:QUAT 942 1282 -0.871707 -3.00061 0.0560006 -0.0024626 0.00477159 0.904359 0.426739 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 3.99994 8.84451e-05 0.015119 4.00023 -0.00409829 0.728506 +EDGE_SE3:QUAT 943 1282 -6.21487 -1.54224 0.0613108 0.000229496 0.00193581 0.802859 0.596166 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 3.99999 1.63188e-06 0.00202045 4.00001 -0.00250324 1.42166 +EDGE_SE3:QUAT 1221 1282 4.1652 5.23658 0.112859 0.00894575 0.00343664 -0.488818 0.872333 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 4.00065 -0.00030509 0.0623819 3.99985 -0.0184259 3.0452 +EDGE_SE3:QUAT 1222 1282 -1.87425 5.68078 0.121915 0.00741819 0.00639869 -0.324756 0.945747 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 4.00101 -0.000277879 0.0702036 3.99975 -0.0124768 3.57936 +EDGE_SE3:QUAT 1283 1284 4.04094 -0.0977465 0.0156894 0.00137796 -0.00179812 -0.0025284 0.999994 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 4.00004 -1.00681e-05 -0.0143431 3.99999 1.8222e-05 4.00003 +EDGE_SE3:QUAT 940 1283 5.32677 0.52163 0.0353238 -0.00681718 -0.00185296 0.998994 0.0442912 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 3.99983 9.70037e-05 0.0273473 4.0007 0.00978887 0.00805817 +EDGE_SE3:QUAT 941 1283 1.2336 -0.556444 0.00927388 -0.00484391 -0.0035755 0.97461 0.223827 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 3.99998 0.000113335 0.0204565 4.00012 0.0207829 0.200614 +EDGE_SE3:QUAT 942 1283 -3.2985 0.121161 0.0437816 -0.00160086 0.00317405 0.902432 0.430818 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 3.99998 3.87534e-05 0.00995412 4.0001 -0.00271098 0.742454 +EDGE_SE3:QUAT 1221 1283 6.15522 1.78917 0.0787877 0.007641 0.00247427 -0.492865 0.870069 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 4.00041 -0.000183809 0.0509194 3.99989 -0.0154276 3.02898 +EDGE_SE3:QUAT 1222 1283 1.21305 3.14767 0.0656334 0.00561887 0.00537775 -0.329099 0.944263 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 4.00068 -0.000205945 0.0568232 3.99985 -0.0101428 3.56758 +EDGE_SE3:QUAT 1223 1283 -3.95406 2.78494 -0.0171833 6.20738e-05 0.000223565 -0.163941 0.98647 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 4 -1.50314e-07 0.00183684 4 -0.000151891 3.89249 +EDGE_SE3:QUAT 1284 1285 4.07159 -0.0966004 -0.0245987 -0.000589586 0.00168056 -0.00177186 0.999997 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 4.00004 -4.07846e-06 0.013432 3.99999 -1.19363e-05 4.00003 +EDGE_SE3:QUAT 939 1284 5.20569 1.9598 -0.0131958 -0.00361274 0.00101636 -0.991942 0.126634 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 3.99996 -4.85189e-05 -0.014778 4.00017 0.00750521 0.0642147 +EDGE_SE3:QUAT 940 1284 1.3167 0.970081 -0.00301288 -0.00503171 -0.000663311 0.998887 0.046889 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 3.9999 4.11028e-05 0.0201924 4.00039 0.00452266 0.0089016 +EDGE_SE3:QUAT 941 1284 -2.34628 1.30086 -0.0127903 -0.0028338 -0.00266031 0.974071 0.226208 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 4 3.63779e-05 0.0119253 4.00002 0.0141706 0.204768 +EDGE_SE3:QUAT 942 1284 -5.7771 3.3456 0.0319999 0.000612505 0.00374473 0.901276 0.433228 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 3.99998 -2.14882e-05 -0.000601088 3.99998 -0.010157 0.750784 +EDGE_SE3:QUAT 1222 1284 4.30008 0.563229 0.0207443 0.00618113 0.00325866 -0.33139 0.943468 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 4.00034 -5.98603e-05 0.04468 3.99988 -0.00849291 3.56122 +EDGE_SE3:QUAT 1223 1284 -0.173562 1.37988 -0.00161477 0.00112821 -0.00195625 -0.166456 0.986046 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 4.00004 -1.80553e-05 -0.0127922 3.99999 0.000983862 3.88921 +EDGE_SE3:QUAT 1224 1284 -4.79634 0.946115 0.0227948 0.00287137 -0.000475038 -0.0561453 0.998418 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 3.99997 -1.83319e-06 -0.00185181 4 3.3719e-05 3.98739 +EDGE_SE3:QUAT 1285 1286 4.00001 -0.0817985 0.0139858 -0.00140021 -0.000308229 -0.00177821 0.999997 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 3.99999 1.75008e-06 -0.00249569 4 2.22453e-06 3.99999 +EDGE_SE3:QUAT 938 1285 4.89018 1.9714 0.00264059 0.00066891 0.00508625 -0.956282 0.292402 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 3.99996 3.20046e-05 0.00401353 4.00001 0.0146982 0.342062 +EDGE_SE3:QUAT 939 1285 1.24809 1.01929 -0.00943287 -0.00201524 0.00167304 -0.992145 0.125069 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 3.99999 -1.94018e-05 -0.00822173 4.00003 0.00841682 0.0626042 +EDGE_SE3:QUAT 940 1285 -2.7127 1.455 -0.0656828 -0.00673829 -0.00110063 0.998781 0.0488961 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 3.99983 8.11426e-05 0.0270483 4.0007 0.00700759 0.00975896 +EDGE_SE3:QUAT 941 1285 -5.93084 3.16423 -0.0476456 -0.00442102 -0.00276432 0.973617 0.228128 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 3.99998 9.65136e-05 0.0187481 4.00013 0.0172948 0.208338 +EDGE_SE3:QUAT 1223 1285 3.61832 -0.0423043 -0.0105471 0.00111905 -0.00032173 -0.167838 0.985814 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 3.99999 2.65883e-07 -0.000254348 4 -4.47831e-05 3.88732 +EDGE_SE3:QUAT 1224 1285 -0.758577 0.389993 0.00220349 0.00238026 0.00107988 -0.058001 0.998313 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 4 1.0706e-05 0.0102484 3.99999 -0.000312718 3.98657 +EDGE_SE3:QUAT 1225 1285 -4.89509 0.330614 -0.0135145 0.00249884 0.000990741 -0.0251459 0.99968 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 3.99999 1.04636e-05 0.00867208 4 -0.000112095 3.99749 +EDGE_SE3:QUAT 1286 1287 3.98949 -0.0943994 0.017585 -0.000656589 -0.000787206 -0.00170681 0.999998 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 4.00001 2.0479e-06 -0.00631107 4 5.37996e-06 4 +EDGE_SE3:QUAT 937 1286 5.47639 1.79532 0.0036651 -0.000170916 0.00514489 -0.8312 0.555949 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 3.99995 -1.4813e-05 0.00615275 4.00006 0.00705698 1.23637 +EDGE_SE3:QUAT 938 1286 1.52022 -0.195685 0.00567432 5.0366e-05 0.00617978 -0.956753 0.290837 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 3.99996 5.59395e-05 0.0014418 3.99995 0.0195424 0.338453 +EDGE_SE3:QUAT 939 1286 -2.64607 0.119088 0.0206418 -0.0024875 0.00308283 -0.992376 0.12318 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 3.99999 -3.2397e-05 -0.010128 4.00002 0.0142804 0.0607705 +EDGE_SE3:QUAT 940 1286 -6.66561 1.92635 -0.107441 -0.00635004 -0.00273758 0.998678 0.0509391 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 3.99986 0.000112741 0.0254961 4.00057 0.0134632 0.0105875 +EDGE_SE3:QUAT 1224 1286 3.19065 -0.15893 0.00349765 0.000980206 0.000926722 -0.0597188 0.998214 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 4.00001 2.65577e-06 0.00807495 4 -0.000247688 3.98575 +EDGE_SE3:QUAT 1225 1286 -0.916005 0.0521741 -0.0072907 0.00105992 0.00072494 -0.0268387 0.999639 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 4 2.94049e-06 0.00613445 4 -8.38052e-05 3.99713 +EDGE_SE3:QUAT 1226 1286 -5.27656 0.0339834 -0.0333989 0.00182073 0.000315992 -0.0133581 0.999909 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 3.99999 2.61674e-06 0.00281907 4 -1.94718e-05 3.99929 +EDGE_SE3:QUAT 1287 1288 4.2919 -0.104411 0.0221751 0.00157695 -0.00190921 -0.00182021 0.999995 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 4.00005 -1.21659e-05 -0.0152393 3.99999 1.39969e-05 4.00004 +EDGE_SE3:QUAT 937 1287 3.87007 -1.83764 0.000888673 -0.00111755 0.00513823 -0.832084 0.554624 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 3.99994 2.46836e-05 0.00100497 4 0.0100138 1.23049 +EDGE_SE3:QUAT 938 1287 -1.83207 -2.33686 0.0102823 -0.000776773 0.00631683 -0.957195 0.289373 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 3.99997 5.9709e-05 -0.00224744 3.99989 0.0217831 0.335081 +EDGE_SE3:QUAT 939 1287 -6.49232 -0.748304 0.0522829 -0.00321906 0.00347991 -0.992521 0.12198 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 3.99998 -5.27832e-05 -0.0131102 4.00005 0.0164996 0.0596286 +EDGE_SE3:QUAT 1224 1287 7.10997 -0.732849 0.0112383 0.000538245 0.000169978 -0.0609932 0.998138 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 4 4.4125e-07 0.00174522 4 -5.71501e-05 3.98512 +EDGE_SE3:QUAT 1225 1287 3.0459 -0.26361 0.00554542 0.000615431 -2.44799e-05 -0.0280127 0.999607 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 4 2.4671e-08 1.11622e-05 4 -1.1233e-06 3.99686 +EDGE_SE3:QUAT 1226 1287 -1.29547 -0.170761 -0.0168085 0.0012783 -0.000153795 -0.0150525 0.999886 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 3.99999 -5.955e-07 -0.000999072 4 6.93947e-06 3.99909 +EDGE_SE3:QUAT 1227 1287 -5.27775 -0.49289 -0.0252514 5.10793e-05 0.00167713 0.0388781 0.999243 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 4.00004 2.95089e-06 0.013363 3.99999 0.000259423 3.994 +EDGE_SE3:QUAT 1288 1289 4.28342 -0.0813795 0.0206019 0.000303418 0.00937722 -0.00114922 0.999955 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 4.00141 8.96918e-06 0.0750449 3.99965 -4.25216e-05 4.0014 +EDGE_SE3:QUAT 937 1288 2.10869 -5.77464 0.0057648 -0.00197997 0.00301378 -0.832946 0.553343 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 3.99998 2.40726e-05 -0.00655166 3.99996 0.00997327 1.2248 +EDGE_SE3:QUAT 938 1288 -5.47744 -4.62019 0.0295805 -0.00224761 0.00410802 -0.957757 0.287541 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 4 3.06207e-06 -0.00925341 3.99993 0.0178782 0.330828 +EDGE_SE3:QUAT 1225 1288 7.33475 -0.609347 0.026647 0.00193177 -0.00180076 -0.0301137 0.999543 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 4.00003 -1.51578e-05 -0.0136889 3.99999 0.000202655 3.99642 +EDGE_SE3:QUAT 1226 1288 2.98266 -0.401653 0.00194717 0.00268873 -0.00223057 -0.0168027 0.999853 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 4.00005 -2.49174e-05 -0.0172951 3.99998 0.000144075 3.99895 +EDGE_SE3:QUAT 1227 1288 -0.986649 -0.263321 -0.010821 0.0017807 -2.23089e-05 0.0371355 0.999309 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 3.99999 -1.09113e-06 -0.000970894 4 -2.29359e-05 3.99448 +EDGE_SE3:QUAT 1228 1288 -4.97436 -1.01706 -0.160094 0.00123608 -0.0130397 0.15905 0.987184 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 4.00263 0.000578791 -0.102763 3.99942 -0.00813761 3.90145 +EDGE_SE3:QUAT 1289 1290 3.98265 -0.0852554 0.0153703 -2.74809e-05 0.000855425 -0.00109487 0.999999 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 4.00001 -1.13252e-07 0.00684305 4 -3.74657e-06 4.00001 +EDGE_SE3:QUAT 1226 1289 7.24854 -0.654385 0.0367962 0.00304588 0.00724099 -0.0180063 0.999807 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 4.00082 6.65121e-05 0.058568 3.99978 -0.000525579 3.99956 +EDGE_SE3:QUAT 1227 1289 3.31417 -0.0508118 0.0086286 0.00148106 0.00931933 0.0361041 0.999303 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 4.00135 0.000128601 0.0737894 3.99966 0.00133155 3.99615 +EDGE_SE3:QUAT 1228 1289 -0.864636 0.241039 -0.0231782 -0.000109495 -0.00378668 0.157813 0.987462 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 4.00021 5.28518e-05 -0.0289662 3.99995 -0.00225022 3.90059 +EDGE_SE3:QUAT 1229 1289 -4.8078 -0.614356 -0.0657487 0.00194495 -0.00691714 0.305998 0.952005 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 4.00072 0.000306559 -0.0544547 3.99989 -0.00827171 3.6262 +EDGE_SE3:QUAT 1290 1291 4.38913 -0.0885862 0.0172109 -0.00200245 -0.00093536 -0.00111955 0.999997 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 4 7.50434e-06 -0.00750975 4 4.16655e-06 4.00001 +EDGE_SE3:QUAT 298 1290 1.97921 -6.14513 0.043929 -0.00872332 -0.00269427 0.885766 0.464042 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 4.00011 0.000371729 0.0420737 4.00022 0.0308499 0.862092 +EDGE_SE3:QUAT 299 1290 -4.86102 -5.37246 0.0479914 -0.00402399 0.00129913 0.756471 0.654013 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 4.00009 0.000148354 0.0255015 4.00008 0.0114812 1.71116 +EDGE_SE3:QUAT 1227 1290 7.30965 0.14688 -0.0514133 0.00151317 0.0103517 0.0346337 0.999345 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 4.00167 0.000149833 0.0820656 3.99958 0.00142205 3.99688 +EDGE_SE3:QUAT 1228 1290 2.93415 1.39021 0.0213147 -0.000199311 -0.00293707 0.156675 0.987646 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 4.00012 3.23893e-05 -0.0222687 3.99997 -0.00171187 3.90194 +EDGE_SE3:QUAT 1229 1290 -1.52152 1.62959 0.00639261 0.00179929 -0.00597557 0.304763 0.952408 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 4.00055 0.000228216 -0.0474803 3.99992 -0.007207 3.62904 +EDGE_SE3:QUAT 1230 1290 -6.18409 0.261995 -0.00081929 0.00245233 -0.0037241 0.469536 0.882902 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 4.00023 0.000158998 -0.0322939 4 -0.00773017 3.1184 +EDGE_SE3:QUAT 1291 1292 4.4124 -0.136042 0.0202371 7.31488e-05 -0.00253575 -0.0173615 0.999846 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 4.0001 -3.41554e-06 -0.0202621 3.99997 0.000175842 3.9989 +EDGE_SE3:QUAT 297 1291 4.96413 -1.46528 0.0315603 -0.00727803 -0.00213369 0.97565 0.219201 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 3.99991 0.000264898 0.0309559 4.00057 0.0196814 0.192544 +EDGE_SE3:QUAT 298 1291 -0.429487 -2.4832 0.00546907 -0.00912018 -0.00486761 0.885153 0.465185 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 4.00011 0.000270106 0.0423565 4 0.0363735 0.86646 +EDGE_SE3:QUAT 299 1291 -5.39507 -1.05896 0.0347018 -0.00474252 -0.00106669 0.755569 0.655051 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 4.00006 5.84594e-05 0.0242365 3.99998 0.0146457 1.71661 +EDGE_SE3:QUAT 1229 1291 2.10863 4.08569 0.0821068 0.00029022 -0.00743418 0.303394 0.952836 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 4.00068 0.000339253 -0.0524528 3.99992 -0.00756987 3.63249 +EDGE_SE3:QUAT 1230 1291 -3.64737 3.8491 0.0621461 0.00125968 -0.00545175 0.468467 0.883463 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 4.00031 0.000256041 -0.0361234 4.00004 -0.00768828 3.12247 +EDGE_SE3:QUAT 1292 1293 4.32428 -0.273987 0.00712551 -0.000480625 -0.000870538 -0.0608368 0.998147 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 4.00001 5.86439e-07 -0.0072757 4 0.000224472 3.98521 +EDGE_SE3:QUAT 296 1292 4.71603 1.7174 0.00329986 0.0030696 0.00216843 -0.999992 0.00115297 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 3.99996 2.64102e-05 0.0122784 4.00013 0.0086458 6.16944e-05 +EDGE_SE3:QUAT 297 1292 1.05374 0.546657 0.000936759 -0.00454324 -0.00272763 0.971665 0.236303 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 3.99998 0.000102426 0.0193432 4.00013 0.0175278 0.223532 +EDGE_SE3:QUAT 298 1292 -2.80165 1.19969 -0.0114518 -0.00633542 -0.00589237 0.876897 0.4806 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 4.00002 -3.03852e-06 0.0272574 3.9998 0.0298513 0.924382 +EDGE_SE3:QUAT 299 1292 -5.87673 3.31923 0.0315393 -0.00280425 -0.00262557 0.744164 0.667985 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 3.99998 -2.74726e-05 0.00953593 3.99996 0.00913958 1.78489 +EDGE_SE3:QUAT 1230 1292 -1.05223 7.42064 0.132842 0.00265217 -0.00773897 0.453014 0.891466 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 4.00075 0.000549866 -0.0563218 4.00004 -0.012157 3.17989 +EDGE_SE3:QUAT 1293 1294 4.18693 -0.531612 -0.00391373 0.000955533 0.00696192 -0.130701 0.991397 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 4.00077 -0.000126975 0.0557655 3.99982 -0.00364623 3.93245 +EDGE_SE3:QUAT 295 1293 3.97289 2.54682 -0.0140311 -0.00160565 0.00620931 -0.993735 0.11158 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 4 -6.28088e-06 -0.0064726 3.99985 0.0254825 0.0499757 +EDGE_SE3:QUAT 296 1293 0.419709 1.98581 -0.0117203 -0.00260335 -0.00290204 0.998203 0.0597878 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 3.99998 3.41975e-05 0.0104643 4.00005 0.0127456 0.0143665 +EDGE_SE3:QUAT 297 1293 -2.64716 2.7544 -0.0200018 -0.00411564 -0.00355411 0.955319 0.295528 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 4 6.67331e-05 0.0177412 4.00001 0.02009 0.349538 +EDGE_SE3:QUAT 298 1293 -4.89047 4.97955 -0.0181093 -0.00566232 -0.00707074 0.845902 0.533261 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 3.99994 -0.000121005 0.0214784 3.99975 0.0276025 1.13787 +EDGE_SE3:QUAT 1294 1295 4.21621 -0.755625 0.0166424 0.000415251 -0.00183412 -0.16925 0.985571 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 4.00004 -1.44398e-05 -0.0132199 3.99999 0.00107685 3.88546 +EDGE_SE3:QUAT 293 1294 6.25393 4.02828 0.0567663 0.00615605 0.00648926 -0.945048 0.326809 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 3.99979 -0.000265393 0.0300533 4.00089 0.00491521 0.427483 +EDGE_SE3:QUAT 294 1294 3.2549 2.5598 -0.00280824 0.00410395 0.00505602 -0.986645 0.162757 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 3.99989 1.55175e-05 0.0172291 4.00032 0.0136968 0.106084 +EDGE_SE3:QUAT 295 1294 -0.212275 2.13685 -0.0130558 -0.00458689 -0.00603569 0.999782 0.0194422 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 3.99992 0.000114246 0.0183585 4.00017 0.0248353 0.00175053 +EDGE_SE3:QUAT 296 1294 -3.66953 3.02636 -0.032836 -0.00891602 -0.0017314 0.981769 0.18986 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 3.99981 0.000362289 0.0374472 4.001 0.019372 0.144644 +EDGE_SE3:QUAT 1295 1296 4.16265 -0.78406 0.00993943 -0.00317185 -0.000858517 -0.174253 0.984695 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 4 1.49821e-05 -0.0130559 3.99999 0.00132061 3.87859 +EDGE_SE3:QUAT 292 1295 6.16681 3.0536 0.0170603 0.00338713 0.00523788 -0.954934 0.296752 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 3.9999 -4.87807e-05 0.0163113 4.00031 0.00915166 0.352348 +EDGE_SE3:QUAT 293 1295 2.4851 2.0163 0.00269275 0.00326352 0.00670753 -0.986733 0.162179 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 3.9999 6.37727e-05 0.0137878 4.00018 0.0209612 0.105371 +EDGE_SE3:QUAT 294 1295 -0.964944 1.9153 -0.0286688 -0.00167199 -0.00527916 0.999965 0.00624752 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 3.99999 3.43105e-05 0.0066886 3.99993 0.0211982 0.000279657 +EDGE_SE3:QUAT 295 1295 -4.38497 3.05491 -0.0207953 -0.00182021 -0.00627077 0.982197 0.187743 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 4 -1.50443e-05 0.00732359 3.99984 0.0255372 0.141171 +EDGE_SE3:QUAT 1296 1297 4.29947 -0.775887 0.0158614 0.00515125 0.0175305 -0.148315 0.988771 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 4.00513 -0.00078495 0.144842 3.99878 -0.0108479 3.91725 +EDGE_SE3:QUAT 291 1296 6.3362 1.99697 -0.0769328 -0.00993612 0.0109833 -0.975572 0.219179 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 3.99997 -0.000424627 -0.0415908 4 0.0553397 0.193397 +EDGE_SE3:QUAT 292 1296 2.29653 1.34375 0.00297333 0.000642278 0.00844174 -0.99206 0.125479 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 3.99997 8.16029e-05 0.00276318 3.99979 0.0318101 0.0632396 +EDGE_SE3:QUAT 293 1296 -1.69361 1.42364 0.0031329 -0.0007278 -0.00991855 0.999875 0.0122744 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 4 1.93025e-05 0.00291205 3.99961 0.0397288 0.000999455 +EDGE_SE3:QUAT 294 1296 -5.09501 2.72964 -0.0122082 0.000172746 -0.00842724 0.983581 0.180273 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 3.99996 -9.04192e-05 -0.00111948 3.9998 0.0307601 0.130239 +EDGE_SE3:QUAT 1297 1298 4.01589 -0.451845 0.0104953 0.00746813 -0.00238503 -0.0769607 0.997003 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 3.99981 -4.14962e-05 -0.0120399 3.99999 0.000373162 3.97634 +EDGE_SE3:QUAT 290 1297 6.0394 1.02026 0.0649871 0.00741307 0.0113624 -0.993844 0.109959 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 3.99964 0.000238448 0.0303069 4.00082 0.0376528 0.0489565 +EDGE_SE3:QUAT 291 1297 2.11878 0.856786 0.024361 0.00658667 0.00800222 -0.99732 0.0724226 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 3.99977 0.000154906 0.026578 4.00062 0.0278007 0.0213522 +EDGE_SE3:QUAT 292 1297 -2.03859 1.02426 0.0168732 -0.0173033 -0.00540269 0.999569 0.0230958 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 3.99884 0.000532885 0.0692631 4.00457 0.0248184 0.00348775 +EDGE_SE3:QUAT 293 1297 -5.94392 2.29798 0.0245335 -0.0162858 -0.00466105 0.98687 0.160628 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 3.99932 0.00113298 0.0674736 4.00329 0.0378921 0.104732 +EDGE_SE3:QUAT 1298 1299 4.27508 -0.185129 -0.00128738 0.00114929 -0.00489394 -0.0158481 0.999862 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 4.00037 -3.13545e-05 -0.0389214 3.99991 0.000308529 3.99937 +EDGE_SE3:QUAT 289 1298 6.1603 0.476349 0.078477 0.00928791 0.00680155 -0.999375 0.0334146 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 3.99962 0.000191729 0.0372157 4.00129 0.0246618 0.004965 +EDGE_SE3:QUAT 290 1298 2.02492 0.580788 0.00857917 0.00483779 0.00425453 -0.999435 0.032995 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 3.9999 6.71811e-05 0.0193841 4.00033 0.0156982 0.0045104 +EDGE_SE3:QUAT 291 1298 -1.9183 0.745275 -0.0218045 -0.00420791 -0.000702137 0.99998 0.00470823 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 3.99993 1.37991e-05 0.0168321 4.00028 0.00296717 0.000161703 +EDGE_SE3:QUAT 292 1298 -6.03182 1.67132 -0.105023 -0.0139055 0.000630599 0.994872 0.100183 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 3.99927 0.00042692 0.0564544 4.00304 0.00858579 0.0409693 +EDGE_SE3:QUAT 1299 1300 4.43781 -0.129506 -0.00805127 0.000794024 -0.00345744 -0.00888298 0.999954 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 4.00019 -1.34726e-05 -0.0275727 3.99995 0.000122576 3.99987 +EDGE_SE3:QUAT 288 1299 6.22949 0.20253 0.0588741 0.00621482 0.00701542 -0.999919 0.00860453 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 3.99984 0.000169683 0.0248633 4.00044 0.027634 0.000641605 +EDGE_SE3:QUAT 289 1299 1.88134 0.375826 0.00464228 0.0042707 0.00562114 -0.999825 0.0173343 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 3.99992 9.23759e-05 0.0170913 4.00019 0.0218776 0.00139464 +EDGE_SE3:QUAT 290 1299 -2.23663 0.489573 -0.0314744 8.27637e-05 0.0029193 -0.999845 0.0173858 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 4 2.14262e-06 0.000331335 3.99997 0.0116568 0.00124307 +EDGE_SE3:QUAT 291 1299 -6.16761 0.963794 -0.0598024 0.000941512 0.000199879 0.999786 0.0206446 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 4 1.17991e-06 -0.00376844 4.00001 -0.000954101 0.00170858 +EDGE_SE3:QUAT 1300 1301 4.30512 -0.116485 0.022315 -0.00357259 0.00493922 -0.00651316 0.99996 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 4.00033 -7.37059e-05 0.0392346 3.9999 -0.000129565 4.00022 +EDGE_SE3:QUAT 287 1300 6.30135 0.0741105 -0.0152974 0.000861781 -0.00342568 0.999941 0.0102341 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 4 -1.25668e-05 -0.00344776 3.99997 0.0136286 0.000468363 +EDGE_SE3:QUAT 288 1300 1.79968 0.259096 -0.00365685 -0.00267422 -0.00654629 0.999975 0.000108821 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 3.99997 7.00073e-05 0.0106975 3.99994 0.026188 0.000200109 +EDGE_SE3:QUAT 289 1300 -2.5109 0.348811 -0.0433579 0.000602309 0.00503074 -0.99995 0.00859435 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 4 1.377e-05 0.00240963 3.99991 0.0200776 0.000397691 +EDGE_SE3:QUAT 290 1300 -6.65379 0.475134 -0.04084 -0.00351401 0.00260059 -0.999957 0.00823197 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 3.99995 -3.85142e-05 -0.0140575 4.00017 0.0106327 0.000348732 +EDGE_SE3:QUAT 1301 1302 4.21707 -0.102771 0.0415821 -0.000702186 -6.76693e-05 -0.00119024 0.999999 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 4 1.94625e-07 -0.000551382 4 3.30046e-07 3.99999 +EDGE_SE3:QUAT 286 1301 6.31785 0.162574 0.00590056 -0.00521667 -0.00559111 0.999723 0.0222698 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 3.9999 0.000124751 0.0208826 4.00028 0.0232686 0.00222825 +EDGE_SE3:QUAT 287 1301 2.01973 0.285805 0.00857322 -0.00417806 -0.00748738 0.999823 0.0167443 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 3.99994 0.000124094 0.0167203 4.00003 0.0304899 0.00142386 +EDGE_SE3:QUAT 288 1301 -2.47188 0.37191 -0.00886701 -0.00746621 -0.0105923 0.999893 0.006847 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 3.99979 0.000319284 0.0298713 4.00042 0.0427838 0.000868157 +EDGE_SE3:QUAT 289 1301 -6.79417 0.386814 -0.0309811 0.00562047 0.0089055 -0.999942 0.00235136 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 3.99987 0.000199962 0.0224843 4.00019 0.0355206 0.000463902 +EDGE_SE3:QUAT 1302 1303 4.13516 -0.0825121 0.0102226 0.00173938 -0.00259953 0.00526835 0.999981 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 4.0001 -1.73529e-05 -0.0209058 3.99997 -5.48847e-05 4 +EDGE_SE3:QUAT 285 1302 6.35096 0.345879 0.0408231 -0.00698645 -0.00745054 0.999646 0.0245607 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 3.99983 0.000224174 0.0279723 4.0005 0.0311361 0.0028511 +EDGE_SE3:QUAT 286 1302 2.12009 0.462518 0.0062231 -0.00502244 -0.00634369 0.99969 0.0235619 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 3.99991 0.000133025 0.020107 4.00021 0.0262886 0.00249463 +EDGE_SE3:QUAT 287 1302 -2.18117 0.52271 0.0255288 -0.00404655 -0.00788377 0.999795 0.0181936 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 3.99994 0.000125055 0.0161953 3.99999 0.0320994 0.00164728 +EDGE_SE3:QUAT 288 1302 -6.67024 0.532297 -0.0268474 -0.00743608 -0.011033 0.999877 0.00826901 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 3.99979 0.000330894 0.0297522 4.00037 0.0446266 0.000992647 +EDGE_SE3:QUAT 1303 1304 4.19205 -0.0605684 -0.0268907 0.00205164 0.00554389 0.011473 0.999917 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 4.00047 5.34951e-05 0.0440643 3.99988 0.000253796 3.99996 +EDGE_SE3:QUAT 284 1303 6.50842 0.51753 0.0208515 0.00146515 -0.00723405 0.99976 0.0206109 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 3.99999 -4.96563e-05 -0.00586532 3.99984 0.0286637 0.00191334 +EDGE_SE3:QUAT 285 1303 2.23359 0.631057 0.00208728 -0.00454326 -0.00576581 0.999788 0.0192587 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 3.99993 0.000108602 0.0181837 4.00017 0.0237437 0.00170726 +EDGE_SE3:QUAT 286 1303 -1.9953 0.732779 -0.0191926 -0.00271727 -0.00460905 0.999819 0.0182628 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 3.99997 4.99667e-05 0.0108746 4.00002 0.0188182 0.00145225 +EDGE_SE3:QUAT 287 1303 -6.28811 0.766386 0.00529337 -0.00160595 -0.0062485 0.999893 0.0131561 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 3.99999 3.67339e-05 0.00642569 3.99988 0.025152 0.000860845 +EDGE_SE3:QUAT 1304 1305 4.32801 -0.0417177 0.00253848 -0.00116952 0.00615824 0.0129009 0.999897 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 4.00061 -1.71479e-05 0.0494412 3.99985 0.000318337 3.99995 +EDGE_SE3:QUAT 283 1304 6.53132 0.645883 0.00345526 0.00165552 -0.00431922 0.999934 0.0105233 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 3.99999 -2.94294e-05 -0.00662339 3.99997 0.0171329 0.000527323 +EDGE_SE3:QUAT 284 1304 2.32148 0.739675 0.0120546 -0.00403754 -0.00514172 0.999937 0.00907534 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 3.99994 8.45754e-05 0.0161527 4.00015 0.0208573 0.000503439 +EDGE_SE3:QUAT 285 1304 -1.92256 0.844404 -0.0540229 -0.0103063 -0.00350821 0.999909 0.00798386 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 3.99958 0.000164263 0.041228 4.00164 0.0146974 0.000733948 +EDGE_SE3:QUAT 286 1304 -6.15242 0.942063 -0.0587078 -0.00830349 -0.00232019 0.999938 0.00711128 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 3.99973 8.85371e-05 0.0332157 4.00108 0.00975563 0.000501919 +EDGE_SE3:QUAT 1305 1306 4.30152 -0.0650826 0.0407779 0.00671822 0.00203539 0.0127169 0.999894 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 3.99988 5.12286e-05 0.0152532 3.99999 9.5411e-05 3.99941 +EDGE_SE3:QUAT 282 1305 6.58259 0.652172 0.006346 0.0025423 0.0103286 -0.999943 0.000992629 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 3.99997 0.000105712 0.0101708 3.99968 0.0412934 0.000456118 +EDGE_SE3:QUAT 283 1305 2.22607 0.777049 0.0269808 0.00445502 0.00535 -0.999972 0.00263012 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 3.99992 9.46976e-05 0.0178208 4.00021 0.0213079 0.000220565 +EDGE_SE3:QUAT 284 1305 -1.99137 0.86847 -0.0232441 0.0103685 0.00622558 -0.99992 0.00373035 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 3.99957 0.000250042 0.0414749 4.00158 0.0246062 0.000637034 +EDGE_SE3:QUAT 285 1305 -6.22228 0.95241 -0.137145 0.0165184 0.00448024 -0.999839 0.00529823 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 3.9989 0.000263131 0.066069 4.00431 0.0172451 0.00127812 +EDGE_SE3:QUAT 1306 1307 4.29674 -0.0457047 0.0362866 -0.0013692 -0.00743648 0.00981211 0.999923 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 4.00087 5.35735e-05 -0.0593333 3.99978 -0.000292793 4.00049 +EDGE_SE3:QUAT 281 1306 6.67332 0.611668 0.0868566 0.0124406 0.00457307 -0.999834 0.0125051 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 3.99937 0.000183111 0.0497712 4.00243 0.017055 0.00131767 +EDGE_SE3:QUAT 282 1306 2.29247 0.713468 0.0334496 0.00478969 0.00338591 -0.999887 0.0138117 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 3.9999 5.8355e-05 0.0191644 4.00033 0.0130096 0.000897207 +EDGE_SE3:QUAT 283 1306 -2.05149 0.817398 0.0302182 0.00652044 -0.00132554 -0.999862 0.0152161 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 3.99983 -4.97738e-05 0.0260903 4.00067 -0.00609411 0.00110563 +EDGE_SE3:QUAT 284 1306 -6.24742 0.899188 -0.0649432 0.0125031 -0.000501233 -0.999785 0.0165154 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 3.99938 -8.69588e-05 0.0500289 4.00249 -0.00365859 0.00172037 +EDGE_SE3:QUAT 1307 1308 4.15563 -0.061551 0.0285268 -0.00168569 -0.00574114 0.00442193 0.999972 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 4.00051 4.21144e-05 -0.0458434 3.99987 -0.000102656 4.00045 +EDGE_SE3:QUAT 280 1307 6.7092 0.407841 0.0657746 0.0104558 0.00363593 -0.999784 0.0176056 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 3.99955 0.000107215 0.0418408 4.00173 0.0130679 0.00172037 +EDGE_SE3:QUAT 281 1307 2.38373 0.536972 0.0141956 0.00486625 0.00581796 -0.999728 0.0220674 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 3.9999 0.00010583 0.0194803 4.00027 0.0223876 0.00216815 +EDGE_SE3:QUAT 282 1307 -1.95986 0.637753 0.0292221 -0.00256096 0.00463325 -0.9997 0.0239122 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 3.99998 -4.66939e-05 -0.0102525 4.00001 0.0189965 0.00240373 +EDGE_SE3:QUAT 283 1307 -6.30768 0.735475 0.00611936 -0.000868034 6.94448e-05 -0.999678 0.0253485 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 4 -6.95526e-07 -0.00347547 4.00001 0.000453249 0.00257326 +EDGE_SE3:QUAT 1308 1309 4.36673 -0.0743382 0.00200614 -0.00443135 0.00249556 -0.00194655 0.999985 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 4.00002 -4.42194e-05 0.0198607 3.99998 -1.99544e-05 4.00008 +EDGE_SE3:QUAT 279 1308 6.98969 0.160269 0.0498522 0.00472517 0.00334545 -0.999889 0.0137263 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 3.99991 5.69344e-05 0.0189061 4.00032 0.0128583 0.000884363 +EDGE_SE3:QUAT 280 1308 2.55245 0.323411 0.0119835 0.00467032 0.0051502 -0.999727 0.0223231 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 3.9999 8.85229e-05 0.0186961 4.00027 0.0197437 0.0021782 +EDGE_SE3:QUAT 281 1308 -1.76058 0.419834 0.00458029 -0.000754032 0.00745682 -0.999592 0.027578 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 4 -1.03653e-05 -0.00301848 3.99978 0.029936 0.00326868 +EDGE_SE3:QUAT 282 1308 -6.09582 0.504762 0.0777434 -0.00826596 0.00628882 -0.999524 0.0290329 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 3.99975 -0.000243691 -0.033106 4.00086 0.0270297 0.00382861 +EDGE_SE3:QUAT 1309 1310 4.15199 -0.164637 0.0336918 -0.00364572 -2.80226e-06 -0.0324943 0.999465 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 3.99995 3.47887e-06 -0.00144295 4 3.11409e-05 3.99578 +EDGE_SE3:QUAT 278 1309 6.93393 0.148733 0.00169472 0.00336695 0.00433914 -0.999775 0.0204793 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 3.99995 5.55659e-05 0.0134768 4.00012 0.0167879 0.00179353 +EDGE_SE3:QUAT 279 1309 2.61042 0.112336 0.00738482 0.0071774 0.00775734 -0.999879 0.0113712 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 3.99978 0.000213804 0.0287169 4.00061 0.0303744 0.000954044 +EDGE_SE3:QUAT 280 1309 -1.79024 0.196691 -0.0362758 0.00724169 0.00991106 -0.999712 0.020631 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 3.99977 0.000275547 0.0289889 4.00052 0.0384173 0.00228179 +EDGE_SE3:QUAT 281 1309 -6.11767 0.261974 0.00900424 0.00164569 0.0122782 -0.9996 0.0254356 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 3.99998 0.000108904 0.00659254 3.99947 0.0486962 0.00319204 +EDGE_SE3:QUAT 1310 1311 4.04566 -0.35011 0.0210602 -0.00419825 0.006998 -0.0850477 0.996343 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 4.00058 -0.000191122 0.051119 3.99985 -0.00210968 3.97172 +EDGE_SE3:QUAT 277 1310 6.89002 0.779273 -0.0892926 -0.0071333 0.00385265 -0.998327 0.0572538 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 3.99983 -0.00016706 -0.028668 4.00067 0.0185458 0.0134043 +EDGE_SE3:QUAT 278 1310 2.77996 0.133997 0.0064476 -0.00330666 -0.00835256 0.999887 0.0120736 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 3.99996 0.000106652 0.0132307 3.99988 0.0337181 0.000911132 +EDGE_SE3:QUAT 279 1310 -1.51127 0.171619 -0.0128647 -0.00701333 -0.011804 0.999686 0.020962 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 3.99983 0.000330326 0.0280766 4.00015 0.0483483 0.00253934 +EDGE_SE3:QUAT 280 1310 -5.93176 0.194849 -0.0531746 -0.00686434 -0.0137969 0.999808 0.0121166 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 3.99983 0.000373277 0.0274706 3.99994 0.0558407 0.00155554 +EDGE_SE3:QUAT 1311 1312 4.09621 -0.560096 -0.021428 0.000438467 0.00886457 -0.133261 0.991041 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 4.00121 -0.000231862 0.0697473 3.99972 -0.00462339 3.93018 +EDGE_SE3:QUAT 276 1311 6.67186 2.10484 -0.00785017 -0.00433276 0.00779748 -0.991889 0.126792 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 3.99998 -9.91388e-05 -0.0176184 3.99987 0.0342682 0.0646808 +EDGE_SE3:QUAT 277 1311 2.82517 0.668446 -0.00166541 0.000505131 -0.00765284 0.999578 0.0280323 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 4 -2.81826e-05 -0.00202452 3.99978 0.0304373 0.00337607 +EDGE_SE3:QUAT 278 1311 -1.23921 0.57589 0.0154614 -0.009487 -0.0126488 0.995166 0.0969307 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 3.99982 0.000495629 0.0383983 4.00026 0.0567124 0.0387642 +EDGE_SE3:QUAT 279 1311 -5.54039 0.688187 -0.0371882 -0.0129972 -0.0167322 0.994138 0.106027 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 3.99969 0.00091127 0.0527272 4.00051 0.0759912 0.047125 +EDGE_SE3:QUAT 1312 1313 4.23722 -0.771716 0.0111117 0.00397892 -0.00327549 -0.16894 0.985613 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 4.00001 -5.15678e-05 -0.0171768 3.99999 0.00119227 3.88591 +EDGE_SE3:QUAT 275 1312 5.96739 3.05313 0.077333 0.0102218 0.0113888 -0.983672 0.179318 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 3.99934 -2.94026e-05 0.0433303 4.00207 0.0277608 0.129312 +EDGE_SE3:QUAT 276 1312 2.57257 1.59604 0.00815559 -0.00348569 -0.00774491 0.99994 0.00694436 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 3.99995 0.0001066 0.0139449 3.99995 0.0311706 0.000484426 +EDGE_SE3:QUAT 277 1312 -1.22514 1.44748 -0.0105212 -0.00725396 -0.00671074 0.986822 0.161505 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 3.99993 0.000258478 0.0299064 4.00027 0.0342419 0.104863 +EDGE_SE3:QUAT 278 1312 -5.16635 1.90951 -0.0610666 -0.0163798 -0.0123735 0.973044 0.229705 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 3.99981 0.00128555 0.0693399 4.00125 0.0716492 0.213631 +EDGE_SE3:QUAT 1313 1314 4.18653 -0.804951 0.0181659 -0.000154036 0.00251094 -0.174986 0.984568 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 4.00009 -2.57897e-05 0.0188555 3.99998 -0.00161289 3.87761 +EDGE_SE3:QUAT 274 1313 4.86022 3.36356 -0.00101389 0.00211974 0.00730262 -0.981008 0.19382 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 3.99992 7.5566e-05 0.00936879 4.00005 0.0233414 0.150431 +EDGE_SE3:QUAT 275 1313 1.754 2.28081 0.00415793 0.00543158 0.00843134 -0.999883 0.0115818 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 3.99987 0.000181228 0.0217326 4.00021 0.0332153 0.000930466 +EDGE_SE3:QUAT 276 1313 -1.62845 2.41303 0.00935749 0.00118673 -0.00387889 0.984449 0.175621 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 3.99998 -2.22472e-05 -0.00512952 4.00001 0.0127165 0.12342 +EDGE_SE3:QUAT 277 1313 -4.95927 3.52274 -0.0357775 -0.0021223 -0.00431239 0.945429 0.325792 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 4 -1.67494e-05 0.00853683 3.99992 0.0177905 0.424669 +EDGE_SE3:QUAT 1314 1315 4.17714 -0.729813 0.00565795 0.00228544 0.00136276 -0.143207 0.989689 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 4.00003 7.74669e-06 0.0144423 3.99999 -0.00111958 3.91802 +EDGE_SE3:QUAT 273 1314 4.03642 3.04622 0.00698725 0.00173912 0.00732639 -0.985634 0.168726 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 3.99994 8.00864e-05 0.00752911 3.99997 0.0249608 0.11405 +EDGE_SE3:QUAT 274 1314 0.697517 2.52403 -0.00131456 0.00330423 0.00825574 -0.999779 0.0190728 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 3.99995 0.000113874 0.0132259 3.99993 0.03249 0.00176283 +EDGE_SE3:QUAT 275 1314 -2.41959 2.98111 -0.00565044 -0.00644093 -0.00935735 0.986399 0.163977 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 3.99997 0.000194297 0.0264558 3.99988 0.0431614 0.108209 +EDGE_SE3:QUAT 276 1314 -5.25596 4.59463 0.050574 -0.000716355 -0.00341466 0.938727 0.344645 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 3.99999 -1.90886e-05 0.00221053 3.99997 0.0115163 0.475161 +EDGE_SE3:QUAT 1315 1316 4.31125 -0.488837 0.00757137 0.00400862 -2.30355e-05 -0.0706152 0.997496 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 3.99994 8.53348e-06 0.0032026 4 -0.000153061 3.98006 +EDGE_SE3:QUAT 272 1315 3.74117 2.37515 0.00604857 0.00319409 0.00335171 -0.996566 0.0826716 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 3.99995 2.53908e-05 0.0129218 4.00016 0.0110809 0.0274114 +EDGE_SE3:QUAT 273 1315 -0.149814 2.32859 -0.00418054 0.00249283 0.00562222 -0.99965 0.0257326 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 3.99997 5.81246e-05 0.0099824 3.99999 0.0219394 0.00279402 +EDGE_SE3:QUAT 274 1315 -3.49324 3.07678 -0.0142152 -0.00342071 -0.00633972 0.992203 0.124422 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 3.99999 6.23053e-05 0.0139 3.99991 0.0277352 0.0621675 +EDGE_SE3:QUAT 1316 1317 4.00705 -0.139021 0.0100869 0.000749923 -0.00144915 -0.00843999 0.999963 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 4.00003 -4.72955e-06 -0.0115161 3.99999 4.85277e-05 3.99975 +EDGE_SE3:QUAT 271 1316 3.43553 2.03483 -0.00269067 0.00309501 -0.00213996 -0.999913 0.0126142 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 3.99996 -2.8866e-05 0.012383 4.00013 -0.00886916 0.000694483 +EDGE_SE3:QUAT 272 1316 -0.597051 2.14415 -0.0199773 0.00317973 -0.00018879 -0.999922 0.0121152 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 3.99996 -5.33163e-06 0.0127216 4.00016 -0.00106308 0.000627866 +EDGE_SE3:QUAT 273 1316 -4.49681 2.60605 -0.0120851 -0.00247784 -0.00147299 0.998979 0.045077 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 3.99998 1.99691e-05 0.00994048 4.00008 0.00675399 0.00816393 +EDGE_SE3:QUAT 316 1316 1.61639 6.70546 0.153881 0.0125888 0.00189105 -0.492176 0.870403 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 4.00065 -0.000192344 0.0723406 3.99968 -0.0231502 3.03234 +EDGE_SE3:QUAT 1247 1316 2.30383 6.8269 0.149529 0.0128533 0.000590074 -0.501691 0.864951 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 4.00044 -6.72717e-05 0.0674654 3.99967 -0.0229701 2.99433 +EDGE_SE3:QUAT 1317 1318 4.06188 -0.0846746 0.00987483 -0.0014118 -0.000439404 0.00134589 0.999998 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 4 2.46611e-06 -0.00349242 4 -2.35156e-06 4 +EDGE_SE3:QUAT 270 1317 3.4715 1.96324 0.00311804 0.00293884 -0.00164659 -0.999992 0.00191646 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 3.99997 -1.9713e-05 0.0117554 4.00013 -0.00663166 6.02334e-05 +EDGE_SE3:QUAT 271 1317 -0.555452 2.08295 -0.0170907 0.00178094 -0.00287272 -0.999984 0.00445119 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 3.99999 -2.05036e-05 0.00712405 4.00002 -0.0115539 0.000125314 +EDGE_SE3:QUAT 272 1317 -4.60541 2.18888 -0.0299983 0.00195979 -0.00116287 -0.999992 0.00330902 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 3.99998 -9.384e-06 0.00783929 4.00006 -0.00470333 6.46927e-05 +EDGE_SE3:QUAT 316 1317 3.56712 3.20676 0.099497 0.0128021 0.000161509 -0.499459 0.866243 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 4.00036 -1.5363e-05 0.0648199 3.99967 -0.0222895 3.00317 +EDGE_SE3:QUAT 317 1317 -1.81174 3.57007 0.0558812 0.00707953 0.00378155 -0.340085 0.94036 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 4.00047 -9.20499e-05 0.0518294 3.99984 -0.0101121 3.53804 +EDGE_SE3:QUAT 318 1317 -6.9905 1.61511 -0.0464932 0.00829923 -0.00174924 -0.130975 0.991349 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 3.99972 1.4923e-05 -0.000739717 4 -0.000244214 3.93138 +EDGE_SE3:QUAT 1247 1317 4.17659 3.29926 0.0978728 0.0127392 -0.000876215 -0.508802 0.860789 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 4.0002 6.70007e-05 0.0598924 3.99967 -0.0218474 2.96533 +EDGE_SE3:QUAT 1248 1317 -1.7508 3.84831 0.0541034 0.0055868 0.0041606 -0.321168 0.946996 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 4.00046 -0.000108995 0.0483268 3.99987 -0.00860725 3.58799 +EDGE_SE3:QUAT 1249 1317 -7.03584 2.26147 -0.0443403 0.00545853 -0.00154438 -0.140101 0.990121 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 3.99988 -5.99734e-07 -0.00293584 4 -1.71657e-05 3.92149 +EDGE_SE3:QUAT 1318 1319 4.14237 -0.0740926 0.0150441 -0.00074704 0.00651032 0.0026249 0.999975 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 4.00068 -1.68044e-05 0.0521132 3.99983 6.7676e-05 4.00065 +EDGE_SE3:QUAT 269 1318 3.66988 1.92893 0.0170267 -0.00560032 -0.000544121 0.999984 0.000453258 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 3.99987 1.25345e-05 0.0224009 4.0005 0.00219717 0.000127483 +EDGE_SE3:QUAT 270 1318 -0.560647 2.03101 -0.00674662 0.00239346 -0.00023808 -0.999993 0.00283573 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 3.99998 -2.66782e-06 0.00957394 4.00009 -0.00100663 5.53341e-05 +EDGE_SE3:QUAT 271 1318 -4.61148 2.12796 -0.0212757 0.00134423 -0.00163263 -0.999982 0.0055391 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 3.99999 -8.89647e-06 0.00537716 4.00002 -0.00658966 0.000140811 +EDGE_SE3:QUAT 316 1318 5.52246 -0.338069 0.0548313 0.0114426 0.000527356 -0.498404 0.866869 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 4.00034 -4.69413e-05 0.0598612 3.99974 -0.0202384 3.00724 +EDGE_SE3:QUAT 317 1318 1.25726 0.906343 0.0150113 0.00556408 0.00382988 -0.338918 0.940792 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 4.00041 -0.000105776 0.0464161 3.99989 -0.00880874 3.54108 +EDGE_SE3:QUAT 318 1318 -3.1077 0.483875 -0.0340958 0.00698089 -0.00192551 -0.130009 0.991486 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 3.99981 -3.82205e-06 -0.0042462 4 3.15918e-05 3.93239 +EDGE_SE3:QUAT 319 1318 -6.96298 -2.36156 -0.13145 0.0062059 -0.00877196 0.145582 0.989288 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 4.00139 7.22122e-05 -0.0786697 3.99962 -0.00592595 3.91677 +EDGE_SE3:QUAT 1247 1318 6.0776 -0.329603 0.0648513 0.0114257 -0.000660267 -0.507538 0.861554 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 4.00018 4.53268e-05 0.0542644 3.99974 -0.0196336 2.97032 +EDGE_SE3:QUAT 1248 1318 1.43252 1.3062 0.0168057 0.00417009 0.0041655 -0.320122 0.947358 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 4.0004 -0.000116905 0.0432643 3.99991 -0.00747936 3.59056 +EDGE_SE3:QUAT 1249 1318 -3.18949 1.063 -0.0235852 0.0043652 -0.00157447 -0.139002 0.990281 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 3.99993 -7.77254e-06 -0.0050447 4 0.000173446 3.92272 +EDGE_SE3:QUAT 1319 1320 4.11105 -0.0891463 -0.00711485 0.00295323 0.000383059 0.000404589 0.999995 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 3.99997 4.49816e-06 0.00305009 4 6.26373e-07 4 +EDGE_SE3:QUAT 268 1319 3.74242 1.88735 -0.0049875 0.00148427 -0.00431566 0.999988 0.00186274 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 3.99999 -2.58e-05 -0.00593728 3.99996 0.0172404 9.7001e-05 +EDGE_SE3:QUAT 269 1319 -0.468967 2.00705 -0.0215546 0.0122896 0.00155831 -0.999922 0.00187506 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 3.9994 6.99963e-05 0.0491549 4.00241 0.00605384 0.000627362 +EDGE_SE3:QUAT 270 1319 -4.72082 2.08905 -0.011953 0.00905493 0.000584723 -0.999943 0.0056309 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 3.99967 1.01232e-05 0.03622 4.00131 0.00193164 0.000455769 +EDGE_SE3:QUAT 317 1319 4.41595 -1.80007 -0.0175098 0.00717023 0.0103064 -0.336424 0.941627 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 4.00208 -0.000793721 0.0956694 3.99964 -0.016852 3.54956 +EDGE_SE3:QUAT 318 1319 0.858595 -0.660529 -0.00672444 0.00686412 0.00464848 -0.126995 0.991869 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 4.00035 7.57718e-05 0.0466432 3.99985 -0.00315955 3.93603 +EDGE_SE3:QUAT 319 1319 -2.95316 -1.24259 -0.0345276 0.00427963 -0.00255758 0.148233 0.98894 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 4.00011 -2.59856e-05 -0.0272916 3.99995 -0.00219296 3.91229 +EDGE_SE3:QUAT 320 1319 -6.0395 -3.61222 -0.0814602 0.00507958 -0.00631006 0.399488 0.916703 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 4.00082 0.00039512 -0.0606647 3.9999 -0.0128133 3.36256 +EDGE_SE3:QUAT 1248 1319 4.67449 -1.25707 -0.0176964 0.0054839 0.0106427 -0.31755 0.948166 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 4.002 -0.000770713 0.09213 3.99967 -0.0149978 3.59877 +EDGE_SE3:QUAT 1249 1319 0.781158 -0.167455 -0.000495286 0.00428377 0.00483496 -0.13624 0.990655 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 4.00042 3.21763e-06 0.0445287 3.99987 -0.00316536 3.92625 +EDGE_SE3:QUAT 1250 1319 -3.37917 -0.302158 -0.0131326 0.00139799 -0.000224261 -0.026658 0.999644 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 3.99999 -8.56476e-07 -0.00134517 4 1.59354e-05 3.99716 +EDGE_SE3:QUAT 1251 1319 -7.38343 -0.536939 -0.0668985 0.00149819 -0.00342571 0.00732205 0.999966 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 4.00018 -1.85844e-05 -0.0275362 3.99995 -0.000100556 3.99998 +EDGE_SE3:QUAT 1320 1321 4.17228 -0.0890464 0.0106899 -0.00154177 0.00242271 0.000189351 0.999996 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 4.00008 -1.49191e-05 0.0193855 3.99998 1.6183e-06 4.00009 +EDGE_SE3:QUAT 267 1320 3.86376 1.91809 -0.00215521 -0.00140971 0.0021832 0.999986 0.00465438 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 3.99999 -1.22621e-05 0.00563905 4.00001 -0.00867992 0.000113439 +EDGE_SE3:QUAT 268 1320 -0.356062 2.00847 0.000743337 0.00112327 -0.00133278 0.999997 0.00170782 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 3.99999 -5.96066e-06 -0.00449311 4.00001 0.00531578 2.3778e-05 +EDGE_SE3:QUAT 269 1320 -4.57713 2.09624 -0.13054 0.0127316 -0.00126874 -0.999915 0.0023396 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 3.99935 -7.38315e-05 0.0509227 4.00259 -0.00531799 0.000677348 +EDGE_SE3:QUAT 318 1320 4.81752 -1.79501 -0.0608415 0.00979333 0.00462015 -0.126783 0.991871 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 4.00026 0.000162512 0.0508155 3.99982 -0.00350955 3.93635 +EDGE_SE3:QUAT 319 1320 0.988956 -0.125278 -0.0138111 0.00708779 -0.00169336 0.148756 0.988847 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 3.99996 -7.54532e-05 -0.0255649 3.99995 -0.00220244 3.91165 +EDGE_SE3:QUAT 320 1320 -3.17593 -0.677354 -0.0180588 0.00785306 -0.00465337 0.400041 0.916452 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 4.00072 0.000252956 -0.0623476 3.99982 -0.0142762 3.36084 +EDGE_SE3:QUAT 321 1320 -6.63219 -2.76575 -0.00370747 0.0103732 -0.00223248 0.58592 0.810299 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 4.00065 0.000424844 -0.0657628 3.9999 -0.0247279 2.62787 +EDGE_SE3:QUAT 1249 1320 4.70359 -1.36364 -0.0550144 0.00712505 0.00490291 -0.13565 0.990719 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 4.00041 7.4342e-05 0.0496058 3.99983 -0.00359692 3.92701 +EDGE_SE3:QUAT 1250 1320 0.719165 -0.612078 -0.014625 0.00467663 0.000124873 -0.0262187 0.999645 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 3.99991 6.87353e-06 0.0024686 4 -3.87787e-05 3.99725 +EDGE_SE3:QUAT 1251 1320 -3.28777 -0.567957 -0.0379921 0.00442495 -0.00297214 0.00791229 0.999954 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 4.00007 -5.21201e-05 -0.0241951 3.99996 -9.53146e-05 3.9999 +EDGE_SE3:QUAT 1252 1320 -7.42155 -0.495143 -0.0327135 0.00255524 -0.000774673 0.0101456 0.999945 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 3.99998 -8.28844e-06 -0.00650745 4 -3.34959e-05 3.9996 +EDGE_SE3:QUAT 1321 1322 4.14256 -0.0971924 0.0218536 0.000459184 -0.00152591 0.000999077 0.999998 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 4.00004 -2.74859e-06 -0.0122129 3.99999 -6.07619e-06 4.00003 +EDGE_SE3:QUAT 266 1321 3.79233 1.99339 0.0203396 0.00577219 -0.000617402 -0.99998 0.00236264 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 3.99987 -1.61428e-05 0.0230886 4.00053 -0.00257915 0.000157267 +EDGE_SE3:QUAT 267 1321 -0.310299 2.03769 -0.00087563 -0.00367266 0.000694119 0.999982 0.00467377 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 3.99995 -8.70039e-06 0.014691 4.00021 -0.0026392 0.000143076 +EDGE_SE3:QUAT 268 1321 -4.5115 2.10781 0.0193869 -0.00130937 -0.0027156 0.999994 0.00143277 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 3.99999 1.4197e-05 0.00523756 4 0.0108774 4.46488e-05 +EDGE_SE3:QUAT 319 1321 4.98766 1.00699 0.0222815 0.00528374 0.000413804 0.148717 0.988866 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 3.9999 -2.36339e-05 -0.00608908 3.99999 -0.000689174 3.91154 +EDGE_SE3:QUAT 320 1321 -0.288348 2.29346 0.0502091 0.00503814 -0.00325318 0.400007 0.916493 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 4.00033 0.000121871 -0.0416438 3.99992 -0.0094499 3.36041 +EDGE_SE3:QUAT 321 1321 -5.25315 1.14454 0.0751043 0.00765566 -0.00119603 0.586312 0.810049 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 4.00031 0.000187921 -0.0466113 3.99993 -0.017932 2.6255 +EDGE_SE3:QUAT 812 1321 -3.23031 6.52584 0.148081 0.00778614 0.00723078 -0.335133 0.942111 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 4.00125 -0.000386521 0.0773729 3.99972 -0.0141064 3.55224 +EDGE_SE3:QUAT 1250 1321 4.85475 -0.915934 -0.00624266 0.0031254 0.00259391 -0.0261309 0.99965 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 4.00008 2.9898e-05 0.0217099 3.99997 -0.000287303 3.99739 +EDGE_SE3:QUAT 1251 1321 0.890978 -0.592657 -0.00369099 0.00297048 -0.00068196 0.00775423 0.999965 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 3.99997 -8.5558e-06 -0.00573152 4 -2.25425e-05 3.99977 +EDGE_SE3:QUAT 1252 1321 -3.27281 -0.489751 -0.0113695 0.00119878 0.00176375 0.00994703 0.999948 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 4.00004 9.07255e-06 0.013965 3.99999 6.93045e-05 3.99965 +EDGE_SE3:QUAT 1322 1323 4.10995 -0.0843843 0.017451 -0.000813309 -0.00136763 0.00126061 0.999998 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 4.00003 4.49913e-06 -0.0109287 3.99999 -6.92243e-06 4.00002 +EDGE_SE3:QUAT 265 1322 3.92208 1.99429 0.0164306 0.00447523 0.000861707 -0.99989 0.0141143 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 3.99992 8.68189e-06 0.0179061 4.00032 0.0029402 0.00087919 +EDGE_SE3:QUAT 266 1322 -0.347618 2.05937 -0.00449478 0.00417433 -0.00118935 -0.999985 0.00339127 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 3.99993 -2.12401e-05 0.0166975 4.00027 -0.00487099 0.000121638 +EDGE_SE3:QUAT 267 1322 -4.4331 2.19096 -0.0109618 -0.00226779 0.000884694 0.999991 0.0034333 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 3.99998 -7.62199e-06 0.00907131 4.00008 -0.00347648 7.07442e-05 +EDGE_SE3:QUAT 320 1322 2.57735 5.24725 0.114011 0.00622049 -0.00456739 0.401094 0.916005 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 4.0006 0.000235758 -0.0548244 3.99988 -0.0123038 3.35725 +EDGE_SE3:QUAT 321 1322 -3.87276 5.03938 0.141936 0.00898656 -0.00208864 0.586998 0.809536 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 4.00051 0.000339252 -0.0576375 3.99993 -0.0215806 2.62256 +EDGE_SE3:QUAT 811 1322 5.83912 2.5028 0.127789 0.012291 0.00124364 -0.540718 0.841113 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 4.00061 -0.000244651 0.0701458 3.99973 -0.025297 2.83171 +EDGE_SE3:QUAT 812 1322 -0.0688573 3.82918 0.0887151 0.00760147 0.00551523 -0.334461 0.942363 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 4.00083 -0.00021409 0.0651771 3.99978 -0.0121364 3.5536 +EDGE_SE3:QUAT 813 1322 -5.90395 2.29112 0.0467173 0.0080308 0.00316466 -0.090995 0.995814 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 4.00002 0.000111984 0.0337238 3.99992 -0.00165967 3.96716 +EDGE_SE3:QUAT 1251 1322 5.03865 -0.633585 0.0201068 0.0032224 -0.00227415 0.00902553 0.999951 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 4.00004 -2.89056e-05 -0.01854 3.99998 -8.37807e-05 3.99976 +EDGE_SE3:QUAT 1252 1322 0.867692 -0.503694 -0.00571091 0.0014243 0.000115194 0.0110105 0.999938 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 3.99999 4.79923e-07 0.000733213 4 3.69119e-06 3.99952 +EDGE_SE3:QUAT 1253 1322 -3.36688 -0.40604 -0.0148016 0.00090165 0.000350434 0.0092698 0.999957 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 4 1.22919e-06 0.00270282 4 1.23743e-05 3.99966 +EDGE_SE3:QUAT 1254 1322 -7.48769 -0.274801 -0.016477 -6.87047e-05 0.00163487 0.00715297 0.999973 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 4.00004 9.59373e-09 0.013084 3.99999 4.67974e-05 3.99984 +EDGE_SE3:QUAT 1323 1324 4.08645 -0.0881598 0.0161695 0.00171766 -0.000133559 0.00154181 0.999997 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 3.99999 -9.53328e-07 -0.00110024 4 -8.55576e-07 3.99999 +EDGE_SE3:QUAT 264 1323 4.03603 1.8985 0.0217741 0.00451172 0.00384231 -0.999667 0.0251054 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 3.99991 5.93672e-05 0.0180645 4.00029 0.014441 0.00265493 +EDGE_SE3:QUAT 265 1323 -0.177256 1.96197 -0.00463293 0.00282991 0.00173292 -0.999877 0.0153305 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 3.99997 1.6967e-05 0.0113237 4.00012 0.00658091 0.000982986 +EDGE_SE3:QUAT 266 1323 -4.44048 2.12582 -0.0235081 0.00262696 -0.00040423 -0.999985 0.0048252 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 3.99997 -5.03925e-06 0.0105082 4.00011 -0.0017183 0.000121474 +EDGE_SE3:QUAT 812 1323 3.04863 1.17886 0.0368756 0.0061064 0.00457543 -0.333232 0.942814 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 4.00056 -0.000147118 0.0532974 3.99985 -0.00985771 3.55653 +EDGE_SE3:QUAT 813 1323 -1.88342 1.46257 0.0288831 0.00670513 0.00182701 -0.0902427 0.995896 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 3.99994 6.68206e-05 0.021659 3.99996 -0.00108281 3.96754 +EDGE_SE3:QUAT 814 1323 -6.32586 -0.907717 -0.059618 0.00518465 -0.00392657 0.189185 0.98192 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 4.00032 -5.25945e-06 -0.0412338 3.99989 -0.00421456 3.85726 +EDGE_SE3:QUAT 1252 1323 4.98602 -0.494317 0.00808892 0.000608399 -0.00152149 0.0121633 0.999925 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 4.00004 -3.05445e-06 -0.0122581 3.99999 -7.46917e-05 3.99945 +EDGE_SE3:QUAT 1253 1323 0.714944 -0.403127 -0.00515366 0.000117383 -0.00114103 0.0105653 0.999944 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 4.00002 -2.05903e-07 -0.00914162 3.99999 -4.83123e-05 3.99957 +EDGE_SE3:QUAT 1254 1323 -3.38933 -0.301206 -0.0143812 -0.000987088 0.000211837 0.00832502 0.999965 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 4 -8.91386e-07 0.00179313 4 7.59932e-06 3.99972 +EDGE_SE3:QUAT 1255 1323 -7.4089 -0.191858 -0.0531872 0.000272919 -0.00151986 0.00591351 0.999981 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 4.00004 -1.33402e-06 -0.0121777 3.99999 -3.60107e-05 3.9999 +EDGE_SE3:QUAT 1324 1325 4.33537 -0.0947048 0.0174326 -2.15444e-05 0.000591255 0.00216832 0.999997 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 4.00001 -3.27651e-08 0.00473057 4 5.12872e-06 3.99999 +EDGE_SE3:QUAT 263 1324 4.25888 1.71649 0.00816247 0.00335813 2.56173e-05 -0.999472 0.0323202 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 3.99996 -8.39256e-06 0.0134535 4.00018 -0.000765237 0.00422383 +EDGE_SE3:QUAT 264 1324 -0.0218445 1.77779 -0.00269925 0.00437806 0.00235322 -0.999636 0.0265178 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 3.99992 2.97451e-05 0.017531 4.0003 0.0084691 0.00290761 +EDGE_SE3:QUAT 265 1324 -4.25273 1.93741 -0.00808897 0.00292713 -5.46061e-05 -0.999858 0.0166202 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 3.99997 -4.05229e-06 0.0117133 4.00014 -0.000607395 0.00113933 +EDGE_SE3:QUAT 812 1324 6.16173 -1.45004 -0.000658263 0.00767511 0.00382955 -0.332154 0.943186 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 4.00049 -7.85827e-05 0.0540579 3.99982 -0.010352 3.55942 +EDGE_SE3:QUAT 813 1324 2.11112 0.645241 0.0247499 0.00855226 0.00154373 -0.0884506 0.996043 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 3.99982 9.12017e-05 0.0212341 3.99996 -0.00106959 3.96882 +EDGE_SE3:QUAT 814 1324 -2.51276 0.52395 -0.00451288 0.0066595 -0.00373513 0.190296 0.981697 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 4.00028 -4.11171e-05 -0.0431157 3.99987 -0.00452831 3.85561 +EDGE_SE3:QUAT 815 1324 -6.41017 -1.97534 -0.00766463 0.00905183 -0.00241841 0.452136 0.8919 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 4.00045 0.000133238 -0.0561561 3.99982 -0.0157871 3.18307 +EDGE_SE3:QUAT 1253 1324 4.79657 -0.408212 0.0184673 0.00166596 -0.00129302 0.0119289 0.999927 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 4.00002 -8.38318e-06 -0.0105804 3.99999 -6.35078e-05 3.99946 +EDGE_SE3:QUAT 1254 1324 0.688725 -0.332687 -0.00335221 0.000493894 2.60546e-05 0.0101129 0.999949 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 4 3.18278e-08 0.000148473 4 6.49675e-07 3.99959 +EDGE_SE3:QUAT 1255 1324 -3.33743 -0.232962 -0.0276133 0.00190749 -0.00165476 0.00765196 0.999968 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 4.00003 -1.23342e-05 -0.0134121 3.99999 -5.14099e-05 3.99981 +EDGE_SE3:QUAT 1256 1324 -7.30975 -0.1104 -0.0397745 0.00198378 -0.00072439 0.00464468 0.999987 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 3.99999 -5.83387e-06 -0.00590548 4 -1.37743e-05 3.99992 +EDGE_SE3:QUAT 1325 1326 4.2451 -0.0863959 0.0225609 -0.00159996 -0.00089633 0.0018825 0.999997 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 4 5.73383e-06 -0.00713445 4 -6.73462e-06 4 +EDGE_SE3:QUAT 262 1325 4.41803 1.46289 0.00488664 0.00466459 -0.00231151 -0.999209 0.0394292 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 3.99992 -6.09289e-05 0.0187008 4.00031 -0.0106804 0.00633475 +EDGE_SE3:QUAT 263 1325 -0.0527557 1.53596 -0.00947499 0.00406106 0.000372058 -0.999391 0.034645 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 3.99993 -7.71647e-06 0.0162735 4.00026 0.00035956 0.00486744 +EDGE_SE3:QUAT 264 1325 -4.34948 1.64933 -0.0278097 0.00534501 0.00264549 -0.999576 0.0285005 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 3.99988 3.79239e-05 0.0214064 4.00045 0.0093442 0.00338561 +EDGE_SE3:QUAT 813 1325 6.35552 -0.214963 0.0187676 0.00838287 0.0022008 -0.0863016 0.996231 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 3.99989 0.000102071 0.0260473 3.99995 -0.00124421 3.97038 +EDGE_SE3:QUAT 814 1325 1.56067 2.06502 0.0579699 0.00660234 -0.00310548 0.192438 0.981282 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 4.00019 -4.97898e-05 -0.0383484 3.9999 -0.00413047 3.85223 +EDGE_SE3:QUAT 815 1325 -3.77753 1.44528 0.0590003 0.00870975 -0.00193555 0.45439 0.890758 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 4.00036 9.29044e-05 -0.0519064 3.99984 -0.0148785 3.17478 +EDGE_SE3:QUAT 1254 1325 5.02194 -0.337111 0.0150828 0.000547564 0.000636889 0.012067 0.999927 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 4.00001 1.48022e-06 0.00501472 4 3.00998e-05 3.99942 +EDGE_SE3:QUAT 1255 1325 1.00244 -0.268137 0.000600798 0.00186662 -0.000957939 0.00989463 0.999949 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 4 -7.19909e-06 -0.00788399 4 -3.93256e-05 3.99962 +EDGE_SE3:QUAT 1256 1325 -2.96994 -0.172038 -0.0169957 0.00205211 -6.38886e-05 0.00679664 0.999975 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 3.99998 -7.52294e-07 -0.000678434 4 -2.49477e-06 3.99982 +EDGE_SE3:QUAT 1257 1325 -7.03284 -0.0757845 -0.0123288 0.00242403 0.00256781 0.00479623 0.999982 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 4.00008 2.54242e-05 0.0204025 3.99997 4.91984e-05 4.00001 +EDGE_SE3:QUAT 1326 1327 4.26232 -0.0890389 0.0118568 -0.0013951 -0.00203044 0.00100023 0.999996 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 4.00006 1.14145e-05 -0.016227 3.99998 -8.25068e-06 4.00006 +EDGE_SE3:QUAT 210 1326 1.70477 5.1019 0.109026 0.00885158 0.00734946 -0.443589 0.896157 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 4.00142 -0.000724999 0.0832953 3.99982 -0.0204023 3.21465 +EDGE_SE3:QUAT 211 1326 -5.43746 4.03391 0.0778093 0.0103884 0.00436344 -0.183683 0.982921 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 4.00033 0.000142895 0.0555429 3.99978 -0.00573775 3.8658 +EDGE_SE3:QUAT 261 1326 4.62887 1.07514 0.0261777 0.00539547 0.00340856 -0.999184 0.0398926 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 3.99987 4.76112e-05 0.0216349 4.00045 0.0118627 0.00651812 +EDGE_SE3:QUAT 262 1326 0.175077 1.20363 -0.00647438 0.00377272 -0.000798408 -0.999136 0.0413906 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 3.99995 -2.56074e-05 0.0151291 4.00022 -0.00442742 0.00691496 +EDGE_SE3:QUAT 263 1326 -4.30585 1.32149 -0.0175645 0.00313441 0.00182869 -0.999324 0.0365734 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 3.99996 1.48104e-05 0.0125635 4.00015 0.00637478 0.00540015 +EDGE_SE3:QUAT 814 1326 5.51277 3.58602 0.115819 0.00548735 -0.00445355 0.194449 0.980887 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 4.00041 6.33729e-06 -0.0461127 3.99986 -0.00482786 3.84929 +EDGE_SE3:QUAT 815 1326 -1.20385 4.84707 0.131174 0.00784307 -0.00366661 0.455638 0.890123 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 4.00058 0.000248512 -0.0576485 3.99987 -0.0155028 3.17041 +EDGE_SE3:QUAT 1255 1326 5.26568 -0.271135 0.0370619 0.000443532 -0.00187088 0.011579 0.999931 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 4.00006 -2.35797e-06 -0.0150258 3.99999 -8.70706e-05 3.99952 +EDGE_SE3:QUAT 1256 1326 1.27755 -0.189812 0.00519063 0.000218457 -0.000806818 0.00887425 0.99996 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 4.00001 -5.68904e-07 -0.00647706 4 -2.87696e-05 3.9997 +EDGE_SE3:QUAT 1257 1326 -2.8048 -0.12096 -0.00496811 0.000547874 0.00195404 0.00685299 0.999974 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 4.00006 4.89078e-06 0.0155864 3.99998 5.3406e-05 3.99987 +EDGE_SE3:QUAT 1258 1326 -6.79887 -0.40824 -0.0322238 0.00367967 0.000844918 0.0393118 0.99922 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 3.99995 8.57178e-06 0.0050095 4 8.703e-05 3.99382 +EDGE_SE3:QUAT 1327 1328 4.17618 -0.0825821 0.00753388 -0.00133382 0.00494257 0.000769875 0.999987 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 4.00038 -2.59383e-05 0.0395562 3.9999 1.44496e-05 4.00039 +EDGE_SE3:QUAT 210 1327 4.21637 1.64917 0.0321363 0.00681312 0.00604578 -0.442712 0.896618 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 4.00091 -0.000476071 0.0663507 3.99989 -0.0160916 3.21713 +EDGE_SE3:QUAT 211 1327 -1.481 2.39967 0.0449936 0.00873974 0.00270257 -0.182642 0.983137 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 4.00007 0.000110772 0.0392773 3.99988 -0.00413223 3.86695 +EDGE_SE3:QUAT 212 1327 -6.49725 0.207507 -0.132135 0.00536556 -0.0103832 0.0881045 0.996043 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 4.00181 9.5171e-06 -0.0877784 3.99952 -0.00392533 3.97088 +EDGE_SE3:QUAT 260 1327 4.83399 0.656952 0.00958888 0.00303793 0.00570756 -0.999565 0.0287747 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 3.99995 6.95522e-05 0.0121683 4.00004 0.0220852 0.00347103 +EDGE_SE3:QUAT 261 1327 0.364538 0.828502 -0.00408927 0.0033259 0.0046811 -0.999148 0.0408602 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 3.99995 5.69183e-05 0.0133397 4.00012 0.0175619 0.00680004 +EDGE_SE3:QUAT 262 1327 -4.08487 0.954849 -0.0179451 0.0017119 0.000480322 -0.999099 0.0424042 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 3.99999 2.99672e-07 0.00686633 4.00005 0.00133299 0.00720473 +EDGE_SE3:QUAT 1256 1327 5.52655 -0.214525 0.0299332 -0.00107182 -0.00294778 0.0099394 0.999946 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 4.00013 1.46007e-05 -0.0234515 3.99997 -0.000116562 3.99974 +EDGE_SE3:QUAT 1257 1327 1.47273 -0.1546 -0.00824033 -0.000693504 -6.96114e-05 0.00777833 0.99997 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 4 1.63901e-07 -0.000492111 4 -1.82998e-06 3.99976 +EDGE_SE3:QUAT 1258 1327 -2.52627 -0.175447 -0.0188986 0.00233809 -0.00127434 0.0399685 0.999197 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 4.00001 -1.17963e-05 -0.0112905 3.99999 -0.000232836 3.99364 +EDGE_SE3:QUAT 1259 1327 -6.4197 -1.1287 -0.15247 0.00430329 -0.0109397 0.14508 0.98935 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 4.00205 0.000254955 -0.0921986 3.9995 -0.00679691 3.91793 +EDGE_SE3:QUAT 1328 1329 4.2631 -0.0956563 -0.00168812 0.00143755 0.00327893 0.000795174 0.999993 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 4.00016 1.90491e-05 0.0262186 3.99996 1.07942e-05 4.00017 +EDGE_SE3:QUAT 210 1328 6.68105 -1.69925 -0.0323548 0.00796141 0.0111464 -0.441888 0.896966 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 4.00229 -0.00136831 0.101153 3.99988 -0.0231886 3.22148 +EDGE_SE3:QUAT 211 1328 2.38059 0.813984 0.0149316 0.00809412 0.00775858 -0.181657 0.983298 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 4.00119 -4.23013e-05 0.0762988 3.99963 -0.0073579 3.86945 +EDGE_SE3:QUAT 212 1328 -2.36709 0.860539 -0.0313049 0.00367612 -0.00562369 0.0888544 0.996022 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 4.00053 -1.51576e-05 -0.0483624 3.99985 -0.00219635 3.969 +EDGE_SE3:QUAT 213 1328 -6.65831 -1.68401 -0.0653451 0.0079987 -0.00814583 0.357699 0.933767 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 4.00153 0.000562377 -0.084507 3.9997 -0.0163204 3.48999 +EDGE_SE3:QUAT 259 1328 4.8311 0.319793 -0.00589854 -0.00110829 0.00633977 -0.999895 0.0129592 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 4 -2.4246e-05 -0.0044344 3.99985 0.0254629 0.000838801 +EDGE_SE3:QUAT 260 1328 0.644129 0.495663 -0.0128334 0.00797733 0.0071987 -0.999505 0.0295823 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 3.99972 0.000193789 0.0319534 4.00089 0.0268547 0.00393636 +EDGE_SE3:QUAT 261 1328 -3.7929 0.571163 -0.0249341 0.00846562 0.00622194 -0.999059 0.0420777 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 3.99968 0.000145717 0.0339557 4.00109 0.0219416 0.00749149 +EDGE_SE3:QUAT 1257 1328 5.66186 -0.169836 0.00236002 -0.00201382 0.00486808 0.00863116 0.999949 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 4.00037 -3.45509e-05 0.039152 3.9999 0.000168144 4.00009 +EDGE_SE3:QUAT 1258 1328 1.64879 0.0779654 0.00241923 0.00099567 0.0036771 0.0412425 0.999142 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 4.0002 2.72674e-05 0.0288508 3.99995 0.000591433 3.9934 +EDGE_SE3:QUAT 1259 1328 -2.39381 -0.014607 -0.0443289 0.00234883 -0.00619864 0.145939 0.989271 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 4.00066 8.47068e-05 -0.052076 3.99984 -0.00386015 3.91548 +EDGE_SE3:QUAT 1260 1328 -6.43786 -1.65404 -0.0908025 0.00528705 -0.00888832 0.325365 0.945532 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 4.00146 0.000558137 -0.0793335 3.99975 -0.0133584 3.57812 +EDGE_SE3:QUAT 1329 1330 4.37576 -0.0983018 0.0139524 -0.000403703 -0.000220518 0.000243138 1 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 4 3.56061e-07 -0.00176296 4 -2.14745e-07 4 +EDGE_SE3:QUAT 211 1329 6.34429 -0.801025 -0.0613846 0.0103052 0.0105343 -0.180753 0.983418 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 4.00217 -0.000106284 0.102095 3.99935 -0.00974847 3.87191 +EDGE_SE3:QUAT 212 1329 1.86526 1.51716 0.0172856 0.00465183 -0.00235926 0.0899503 0.995933 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 4.00005 -4.14348e-05 -0.0236398 3.99996 -0.0011342 3.96777 +EDGE_SE3:QUAT 213 1329 -3.41091 1.10234 0.0210421 0.00805019 -0.00472672 0.358594 0.933447 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 4.00071 0.000185054 -0.0624433 3.99979 -0.0127643 3.48661 +EDGE_SE3:QUAT 258 1329 4.99475 0.1175 0.00178158 -0.00219605 -0.00534324 0.999975 0.00402461 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 3.99998 4.64709e-05 0.00878476 3.99996 0.0214431 0.000199036 +EDGE_SE3:QUAT 259 1329 0.571731 0.3017 0.00275193 0.00206862 0.00471712 -0.99989 0.0139107 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 3.99998 3.99577e-05 0.00827722 3.99999 0.0186295 0.000877943 +EDGE_SE3:QUAT 260 1329 -3.58187 0.345198 -0.0814326 0.0113796 0.00598698 -0.999447 0.0306641 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 3.99945 0.000182488 0.0455822 4.00202 0.0211174 0.00439269 +EDGE_SE3:QUAT 1258 1329 5.91793 0.329822 -0.0322812 0.00211853 0.00685165 0.0419597 0.999094 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 4.0007 0.000102102 0.0536109 3.99982 0.00111912 3.99368 +EDGE_SE3:QUAT 1259 1329 1.73202 1.13066 0.0148164 0.00349138 -0.00271923 0.146892 0.989143 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 4.00013 -1.30559e-05 -0.0271201 3.99995 -0.00212429 3.91387 +EDGE_SE3:QUAT 1260 1329 -3.00812 0.889771 -0.0042055 0.00550089 -0.00536276 0.326157 0.945285 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 4.00067 0.000201208 -0.0562543 3.99985 -0.00993301 3.57528 +EDGE_SE3:QUAT 1261 1329 -7.05317 -0.904994 -0.00435821 0.00350194 -0.00231055 0.491836 0.870678 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 4.00017 9.8413e-05 -0.0295378 3.99998 -0.00824741 3.03261 +EDGE_SE3:QUAT 1330 1331 4.34551 -0.118715 0.0206071 -0.00143771 0.000221916 -0.0140168 0.999901 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 3.99999 -1.05717e-06 0.001533 4 -1.01791e-05 3.99921 +EDGE_SE3:QUAT 212 1330 6.18171 2.19975 0.0595813 0.00470266 -0.00259743 0.0896341 0.99596 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 4.00007 -4.36208e-05 -0.0255609 3.99996 -0.0012164 3.96803 +EDGE_SE3:QUAT 213 1330 -0.108571 3.94966 0.104483 0.00809113 -0.00511688 0.358781 0.933373 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 4.0008 0.000220742 -0.0651511 3.99978 -0.0132279 3.48616 +EDGE_SE3:QUAT 214 1330 -5.76838 2.6906 0.0652378 0.00456167 -0.00303125 0.557645 0.830062 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 4.00028 0.000212864 -0.0380703 4.00001 -0.0119774 2.75649 +EDGE_SE3:QUAT 257 1330 5.01673 0.0847562 0.00986003 -0.00313215 -0.00569799 0.999812 0.0182775 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 3.99997 7.05708e-05 0.0125352 4.00001 0.0232315 0.00151053 +EDGE_SE3:QUAT 258 1330 0.627066 0.233871 0.00297115 -0.0020941 -0.0055531 0.999975 0.00380972 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 3.99998 4.59651e-05 0.00837694 3.99994 0.0222756 0.000199652 +EDGE_SE3:QUAT 259 1330 -3.81469 0.276381 -0.00406688 0.00188713 0.00519604 -0.999891 0.0137258 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 3.99998 4.08937e-05 0.00755104 3.99996 0.0205674 0.000873623 +EDGE_SE3:QUAT 1259 1330 5.94697 2.29793 0.0530212 0.00305723 -0.00300798 0.146734 0.989167 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 4.00017 -3.69449e-06 -0.0285979 3.99995 -0.0022098 3.91408 +EDGE_SE3:QUAT 1260 1330 0.485842 3.49634 0.0724297 0.0055083 -0.00584698 0.326036 0.945323 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 4.00076 0.000241024 -0.0595545 3.99984 -0.0104326 3.57569 +EDGE_SE3:QUAT 1261 1330 -4.7143 2.77203 0.0464517 0.00348656 -0.00263905 0.491687 0.870761 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 4.00019 0.000118268 -0.0311974 3.99999 -0.00855297 3.03322 +EDGE_SE3:QUAT 1331 1332 4.36123 -0.27452 0.0209637 0.00175313 -0.00260529 -0.0576804 0.99833 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 4.00008 -2.52437e-05 -0.0195279 3.99998 0.000550816 3.98679 +EDGE_SE3:QUAT 256 1331 4.78678 0.311583 0.0193727 -0.00449704 -0.00763304 0.99955 0.0286631 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 3.99993 0.000136097 0.0180104 4.00004 0.031502 0.00361573 +EDGE_SE3:QUAT 257 1331 0.709668 0.367267 0.00186041 -0.0035606 -0.00738892 0.999447 0.0322348 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 3.99996 9.92665e-05 0.0142637 3.99994 0.0303971 0.00443845 +EDGE_SE3:QUAT 258 1331 -3.69627 0.387133 0.00673651 -0.00210413 -0.00694733 0.999811 0.0180111 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 3.99999 5.31344e-05 0.00842084 3.99987 0.0280698 0.00151237 +EDGE_SE3:QUAT 1260 1331 3.99116 6.07434 0.159431 0.00417144 -0.00602072 0.312558 0.94987 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 4.00071 0.000240706 -0.0559195 3.99986 -0.00915454 3.61001 +EDGE_SE3:QUAT 1261 1331 -2.37447 6.40162 0.100807 0.00211536 -0.00311513 0.47977 0.877386 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 4.00016 0.00011513 -0.0271435 4 -0.00664441 3.07947 +EDGE_SE3:QUAT 1332 1333 4.2216 -0.482494 0.00531712 -0.00313351 0.00563749 -0.115571 0.993278 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 4.00036 -0.000133256 0.0398948 3.99991 -0.00220671 3.94697 +EDGE_SE3:QUAT 255 1332 4.4804 1.41661 0.00149555 0.00295575 0.00501233 -0.999693 0.0241038 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 3.99996 5.84989e-05 0.0118342 4.00006 0.0194514 0.00245365 +EDGE_SE3:QUAT 256 1332 0.441037 0.835582 0.00587199 -0.00136768 -0.00645678 0.996218 0.0866404 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 4 7.0229e-06 0.00549853 3.99984 0.026284 0.0302078 +EDGE_SE3:QUAT 257 1332 -3.62962 0.925318 -0.00184914 -0.000440721 -0.00593553 0.995934 0.0898938 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 4 -1.48835e-05 0.00174957 3.99986 0.0235778 0.0324645 +EDGE_SE3:QUAT 1333 1334 4.27558 -0.733198 0.00420037 -0.00201143 0.000644819 -0.170581 0.985341 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 3.99998 3.51935e-07 0.000897549 4 4.69943e-05 3.88361 +EDGE_SE3:QUAT 254 1333 3.64695 2.40712 -0.00168924 0.00367603 0.00634889 -0.992219 0.124292 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 3.9999 6.87985e-05 0.0151386 4.0002 0.0208233 0.0619626 +EDGE_SE3:QUAT 255 1333 0.247466 1.71528 -0.0153478 -0.0080913 -0.00869294 0.995689 0.0919864 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 3.99985 0.000332509 0.0327243 4.00043 0.0399517 0.0345174 +EDGE_SE3:QUAT 256 1333 -3.63193 2.05258 0.0132533 -0.00658826 -0.00917876 0.979445 0.201394 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 3.99999 0.000174251 0.0273113 3.99984 0.0432309 0.162912 +EDGE_SE3:QUAT 1334 1335 4.24243 -0.817869 0.00827914 -0.00121207 -0.000795097 -0.181508 0.983388 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 4.00001 1.12206e-06 -0.00863109 4 0.000853356 3.86824 +EDGE_SE3:QUAT 252 1334 5.85809 3.77505 0.0257479 0.00332033 0.00763049 -0.93558 0.353016 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 3.99984 -7.12179e-05 0.0182075 4.00042 0.0132323 0.498643 +EDGE_SE3:QUAT 253 1334 2.64491 2.32545 -0.010593 0.000153988 0.00911532 -0.98581 0.167614 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 3.99996 0.000100566 0.00098558 3.99975 0.0337243 0.112672 +EDGE_SE3:QUAT 254 1334 -0.694197 2.07681 -0.0274174 -0.00294278 -0.00922122 0.998854 0.0468735 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 3.99998 8.28577e-05 0.0118036 3.99974 0.037783 0.00918106 +EDGE_SE3:QUAT 255 1334 -3.81931 3.23198 -0.0563575 -0.00740001 -0.0118208 0.965289 0.26081 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 4.00002 9.0883e-05 0.0307903 3.99947 0.0538231 0.273101 +EDGE_SE3:QUAT 1335 1336 4.32407 -0.80188 0.0225925 0.00515975 0.0162572 -0.157425 0.987384 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 4.00444 -0.000718019 0.134974 3.99895 -0.0107472 3.90542 +EDGE_SE3:QUAT 251 1335 5.91667 1.99888 -0.0473802 -0.00636582 0.0108468 -0.967148 0.253904 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 4.00001 -5.63646e-05 -0.0263871 3.99954 0.0486487 0.258675 +EDGE_SE3:QUAT 252 1335 2.1473 1.57078 0.00151426 0.000688307 0.00878918 -0.984014 0.177872 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 3.99995 0.000104913 0.00327726 3.99982 0.0314584 0.126814 +EDGE_SE3:QUAT 253 1335 -1.63113 1.66121 0.00297096 0.00237558 -0.00999601 0.999847 0.0141902 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 3.99997 -0.000104081 -0.00950689 3.99971 0.0396937 0.00122205 +EDGE_SE3:QUAT 254 1335 -4.82556 3.25811 -0.0185533 -0.000684714 -0.0105993 0.973805 0.227137 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 3.99994 -0.00014916 0.00194754 3.99966 0.0382076 0.206753 +EDGE_SE3:QUAT 1336 1337 3.96824 -0.489335 0.00478694 0.00951063 -0.00203649 -0.0839891 0.996419 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 3.99965 -1.81787e-05 -0.00657777 4 0.00013987 3.97179 +EDGE_SE3:QUAT 250 1336 5.98872 0.474584 0.0526684 0.00719705 0.0145115 -0.994556 0.102939 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 3.99961 0.000387766 0.029373 4.00054 0.050667 0.0432539 +EDGE_SE3:QUAT 251 1336 1.76155 0.582698 0.0214766 0.00881306 0.00869597 -0.995046 0.098638 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 3.99959 0.000136099 0.0358285 4.00128 0.0270663 0.0394278 +EDGE_SE3:QUAT 252 1336 -2.17515 0.823321 0.00946987 0.0160846 0.00695221 -0.999638 0.0204093 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 3.99893 0.000327042 0.0643734 4.00405 0.0251898 0.00286133 +EDGE_SE3:QUAT 253 1336 -5.8875 2.59228 0.0584931 -0.0122689 -0.0043877 0.985128 0.171329 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 3.99966 0.000680715 0.0510197 4.00172 0.0326224 0.118351 +EDGE_SE3:QUAT 1337 1338 4.26833 -0.192812 -0.0150981 0.00255096 -0.00357877 -0.0156425 0.999868 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 4.00017 -4.0373e-05 -0.0281418 3.99995 0.000219621 3.99922 +EDGE_SE3:QUAT 249 1337 6.12934 0.014093 0.069811 0.0070322 0.00889762 -0.999831 0.0144579 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 3.99979 0.000241582 0.0281402 4.00052 0.0347672 0.00133633 +EDGE_SE3:QUAT 250 1337 2.00133 0.146763 0.00389295 0.00495207 0.00532758 -0.999794 0.0189411 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 3.99989 9.81104e-05 0.0198197 4.0003 0.0205437 0.00163885 +EDGE_SE3:QUAT 251 1337 -2.20572 0.299696 -0.0388122 0.00706929 -0.000174719 -0.999866 0.0147634 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 3.9998 -2.26276e-05 0.0282857 4.0008 -0.00153374 0.0010725 +EDGE_SE3:QUAT 252 1337 -6.15151 1.1562 -0.107759 -0.0137712 0.00123947 0.997844 0.064156 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 3.99925 0.00022532 0.0554212 4.00304 0.00213626 0.0172363 +EDGE_SE3:QUAT 1338 1339 4.44659 -0.115661 -0.00711488 0.000836464 0.00585783 -0.00131215 0.999982 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 4.00055 1.85349e-05 0.0468812 3.99986 -3.00823e-05 4.00054 +EDGE_SE3:QUAT 248 1338 6.18449 -0.0465093 -0.0174813 0.00337218 -0.00676359 0.999954 0.00588413 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 3.99995 -9.17358e-05 -0.0134903 4.00001 0.0268944 0.00036482 +EDGE_SE3:QUAT 249 1338 1.87093 0.070329 -0.00606415 -0.00319742 -0.00649615 0.999973 0.00125556 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 3.99996 8.29704e-05 0.0127904 3.99999 0.0260175 0.00021643 +EDGE_SE3:QUAT 250 1338 -2.24402 0.182685 -0.0518709 0.00137273 0.00285572 -0.99999 0.00314525 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 3.99999 1.57412e-05 0.00549106 4 0.0113881 7.9531e-05 +EDGE_SE3:QUAT 251 1338 -6.46304 0.354169 -0.106321 -0.00372852 0.00311477 0.999987 0.00128292 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 3.99994 -4.61323e-05 0.0149142 4.00018 -0.0124216 0.000100764 +EDGE_SE3:QUAT 1339 1340 4.34964 -0.0920062 0.0370007 0.000578995 -0.00513687 0.000539848 0.999986 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 4.00042 -1.15607e-05 -0.0411024 3.99989 -1.07312e-05 4.00042 +EDGE_SE3:QUAT 247 1339 6.11379 -0.00394214 0.0413665 -0.00824555 -0.00666025 0.999891 0.0102804 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 3.99974 0.00023261 0.0329887 4.00088 0.0273215 0.000881426 +EDGE_SE3:QUAT 248 1339 1.74855 0.11896 0.0112563 -0.00256408 -0.00621868 0.999952 0.00711039 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 3.99998 6.26522e-05 0.0102576 3.99995 0.0250178 0.000385017 +EDGE_SE3:QUAT 249 1339 -2.54021 0.189148 -0.0303737 -0.00925419 -0.00553826 0.999938 0.00258977 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 3.99966 0.000209907 0.0370173 4.00124 0.0223546 0.000494301 +EDGE_SE3:QUAT 250 1339 -6.6445 0.260027 -0.0600082 0.00731169 0.00182062 -0.99997 0.00168451 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 3.99979 5.11672e-05 0.0292462 4.00084 0.00718598 0.000238103 +EDGE_SE3:QUAT 1340 1341 4.46968 -0.0848371 0.0467123 -0.000583994 -0.00243696 0.00250807 0.999994 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 4.00009 6.04321e-06 -0.0194783 3.99998 -2.45036e-05 4.00007 +EDGE_SE3:QUAT 246 1340 6.18912 0.0792665 0.0278917 -0.0078002 -0.00506112 0.999902 0.0104508 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 3.99976 0.000170879 0.0312063 4.00085 0.0208977 0.000789532 +EDGE_SE3:QUAT 247 1340 1.77447 0.190047 0.00988704 -0.00296638 -0.00617336 0.999933 0.00928294 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 3.99997 7.2283e-05 0.0118677 3.99998 0.0249091 0.000535032 +EDGE_SE3:QUAT 248 1340 -2.5599 0.277629 0.0282132 0.00263997 -0.00563244 0.99996 0.00637119 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 3.99997 -5.99927e-05 -0.010561 3.99999 0.0223935 0.000315624 +EDGE_SE3:QUAT 249 1340 -6.86408 0.322669 -0.073459 -0.00406084 -0.00517071 0.999976 0.0020203 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 3.99993 8.43663e-05 0.016244 4.00015 0.0207498 0.000189926 +EDGE_SE3:QUAT 1341 1342 4.33528 -0.0684279 0.0132651 -0.00321046 -0.00200972 0.00358175 0.999986 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 4.00002 2.5856e-05 -0.0159394 3.99998 -2.87711e-05 4.00001 +EDGE_SE3:QUAT 245 1341 6.18775 0.172651 0.035497 -0.0064379 -0.00308292 0.999934 0.00897085 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 3.99984 8.75735e-05 0.0257546 4.00062 0.012794 0.000528664 +EDGE_SE3:QUAT 246 1341 1.72773 0.25476 0.00244879 -0.0054616 -0.00588755 0.999939 0.00763889 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 3.99988 0.000131896 0.0218492 4.00033 0.023884 0.000495366 +EDGE_SE3:QUAT 247 1341 -2.70135 0.345582 0.0295662 -0.000501083 -0.00700597 0.999953 0.00664293 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 4 1.14632e-05 0.00200458 3.99981 0.0280467 0.000374192 +EDGE_SE3:QUAT 248 1341 -7.02866 0.408013 0.0987426 0.00493101 -0.00633909 0.99996 0.00384751 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 3.9999 -0.000124028 -0.0197254 4.00023 0.0252066 0.000315318 +EDGE_SE3:QUAT 1342 1343 4.32965 -0.0772407 -0.0081332 0.000423186 0.000839742 0.00419268 0.999991 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 4.00001 1.48603e-06 0.00669648 4 1.40303e-05 3.99994 +EDGE_SE3:QUAT 244 1342 6.20405 0.201238 0.0272753 -0.00268428 -0.00757176 0.99994 0.00741107 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 3.99997 7.9109e-05 0.0107389 3.99988 0.0304423 0.000480228 +EDGE_SE3:QUAT 245 1342 1.85283 0.310597 -0.0064946 -0.00462606 -0.00660178 0.999953 0.00535071 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 3.99992 0.000123013 0.0185061 4.00016 0.0266058 0.0003771 +EDGE_SE3:QUAT 246 1342 -2.59849 0.396903 -0.0370484 -0.0037137 -0.00994105 0.999937 0.0035945 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 3.99995 0.000145988 0.0148572 3.99982 0.0398707 0.000504297 +EDGE_SE3:QUAT 247 1342 -7.01424 0.489363 0.0378319 0.0010942 -0.0107238 0.999937 0.00310823 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 3.99999 -4.96887e-05 -0.00437763 3.99956 0.0428649 0.000502839 +EDGE_SE3:QUAT 1343 1344 4.38422 -0.0698371 -0.00374509 -0.00204264 0.00749776 0.0053824 0.999955 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 4.00089 -5.41965e-05 0.0601229 3.99977 0.000159248 4.00079 +EDGE_SE3:QUAT 243 1343 6.29256 0.232213 -0.0207528 0.00370829 -0.00493006 0.999964 0.00577953 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 3.99994 -7.23164e-05 -0.0148343 4.00013 0.0195484 0.000284161 +EDGE_SE3:QUAT 244 1343 1.8888 0.346387 -0.000531695 -0.00348677 -0.00709564 0.999964 0.0030116 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 3.99995 9.86214e-05 0.0139482 3.99999 0.0284671 0.00028751 +EDGE_SE3:QUAT 245 1343 -2.46461 0.440193 -0.0515132 -0.00540034 -0.00604116 0.999967 0.00105367 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 3.99988 0.000130968 0.0216023 4.00032 0.0242135 0.000267663 +EDGE_SE3:QUAT 246 1343 -6.8913 0.494553 -0.0671753 0.00457509 0.00916266 -0.999947 0.000563254 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 3.99992 0.000167796 0.0183025 4 0.0366327 0.000420491 +EDGE_SE3:QUAT 1344 1345 4.32395 -0.0818646 0.0251249 0.00320912 0.00273632 0.00661103 0.999969 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 4.00008 3.57464e-05 0.0216348 3.99997 7.18034e-05 3.99994 +EDGE_SE3:QUAT 242 1344 6.26922 0.231146 -0.00415996 -0.00118235 -0.00819299 0.999958 0.00385675 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 3.99999 3.67928e-05 0.00472997 3.99975 0.0328064 0.000334176 +EDGE_SE3:QUAT 243 1344 1.91278 0.352804 0.0111512 -0.00376064 -0.00667819 0.99997 0.000656213 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 3.99994 0.000100456 0.0150435 4.00005 0.026734 0.000236969 +EDGE_SE3:QUAT 244 1344 -2.4751 0.438733 -0.0293937 0.0110452 0.00893948 -0.999897 0.00211978 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 3.99951 0.000390688 0.0441837 4.00164 0.0355927 0.000822592 +EDGE_SE3:QUAT 245 1344 -6.80389 0.518953 -0.0924476 0.0129188 0.00760636 -0.999878 0.00437364 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 3.99933 0.000378316 0.0516766 4.00246 0.0299987 0.000969031 +EDGE_SE3:QUAT 1345 1346 4.23329 -0.06705 0.0288213 -0.000495661 0.000803168 0.00684034 0.999976 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 4.00001 -1.49877e-06 0.00646559 4 2.21517e-05 3.99982 +EDGE_SE3:QUAT 241 1345 6.21128 0.260833 0.013367 0.00444993 0.00534301 -0.99997 0.00352004 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 3.99992 9.42376e-05 0.0178006 4.00021 0.0212481 0.000241643 +EDGE_SE3:QUAT 242 1345 1.92721 0.342625 0.0101335 0.00394748 0.00507867 -0.999975 0.00284634 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 3.99994 7.97177e-05 0.0157906 4.00015 0.0202259 0.000197009 +EDGE_SE3:QUAT 243 1345 -2.40423 0.441004 0.0109011 0.00645017 0.00342892 -0.999954 0.00615306 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 3.99983 8.28991e-05 0.025802 4.00063 0.0133999 0.00036277 +EDGE_SE3:QUAT 244 1345 -6.78236 0.499722 -0.0982392 0.0138052 0.00595758 -0.999847 0.00893108 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 3.99923 0.000291086 0.0552246 4.00294 0.0228628 0.00121225 +EDGE_SE3:QUAT 1346 1347 4.06441 -0.0676831 0.0146504 0.000663842 -0.00587806 0.00438376 0.999973 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 4.00055 -1.1991e-05 -0.0470637 3.99986 -0.000102669 4.00048 +EDGE_SE3:QUAT 240 1346 6.29487 0.23009 0.0659573 0.0098682 0.00606027 -0.999845 0.013229 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 3.9996 0.000211827 0.039483 4.00145 0.0231984 0.00122436 +EDGE_SE3:QUAT 241 1346 1.98732 0.303653 0.00772511 0.00527893 0.00569828 -0.999919 0.010126 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 3.99988 0.000116024 0.0211197 4.00033 0.0223628 0.000646686 +EDGE_SE3:QUAT 242 1346 -2.28492 0.384597 0.0112263 0.00478173 0.00564478 -0.999927 0.00957799 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 3.9999 0.000105023 0.0191302 4.00025 0.0222101 0.000581774 +EDGE_SE3:QUAT 243 1346 -6.6065 0.450649 -0.0190183 0.00750923 0.0041024 -0.999883 0.0126408 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 3.99977 0.000107599 0.0300439 4.00085 0.0156485 0.000926081 +EDGE_SE3:QUAT 1347 1348 4.39162 -0.12672 0.0174775 5.93783e-05 -0.000178554 -0.0148064 0.99989 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 4 -5.31677e-08 -0.00141741 4 1.04663e-05 3.99912 +EDGE_SE3:QUAT 239 1347 6.48874 0.167385 0.0231361 0.00355792 0.00651182 -0.999657 0.0250969 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 3.99994 9.26259e-05 0.0142467 4.00006 0.0252938 0.00273023 +EDGE_SE3:QUAT 240 1347 2.23778 0.179651 0.00798818 0.00402312 0.00522094 -0.999822 0.0176912 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 3.99993 8.05973e-05 0.0161007 4.00017 0.0202998 0.00141979 +EDGE_SE3:QUAT 241 1347 -2.06697 0.285868 -0.0217765 -0.000550067 0.00527888 -0.99988 0.0145431 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 4 -8.4416e-06 -0.00220091 3.99989 0.0211681 0.000959268 +EDGE_SE3:QUAT 242 1347 -6.32334 0.368267 -0.0204206 -0.00089492 0.00524224 -0.99989 0.0138314 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 4 -1.59349e-05 -0.00358073 3.9999 0.0210577 0.000879314 +EDGE_SE3:QUAT 1348 1349 4.16708 -0.235277 0.0126594 -0.00501954 -0.00121926 -0.0472982 0.998867 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 3.99994 3.13632e-05 -0.0125658 3.99999 0.000319106 3.99109 +EDGE_SE3:QUAT 238 1348 6.31859 0.175233 0.0117135 0.0037285 0.00361245 -0.999547 0.029655 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 3.99994 4.63339e-05 0.0149345 4.00019 0.0135353 0.00361933 +EDGE_SE3:QUAT 239 1348 2.11202 0.0616301 0.00435017 0.00338548 0.00678936 -0.999918 0.0103442 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 3.99995 9.27588e-05 0.013545 4.00001 0.0268712 0.000654411 +EDGE_SE3:QUAT 240 1348 -2.15698 0.14548 -0.0217945 0.00368792 0.00564424 -0.999974 0.00266213 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 3.99994 8.30728e-05 0.0147524 4.00009 0.0224994 0.000209307 +EDGE_SE3:QUAT 241 1348 -6.42837 0.277884 -0.00235945 -0.000619681 0.00531236 -0.999986 2.30351e-05 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 4 -1.31622e-05 -0.00247883 3.99989 0.0212493 0.000114424 +EDGE_SE3:QUAT 1349 1350 4.14572 -0.370734 0.0234942 -0.00362164 0.0109809 -0.0888496 0.995978 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 4.00167 -0.000383907 0.0829965 3.9996 -0.00362843 3.97014 +EDGE_SE3:QUAT 237 1349 6.09893 0.679851 -0.0544556 -0.00419966 0.00476145 -0.99877 0.0491659 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 3.99995 -8.88112e-05 -0.0168555 4.00014 0.0205801 0.00984642 +EDGE_SE3:QUAT 238 1349 2.15512 0.160479 -0.000677492 -0.00233818 -0.00862802 0.999811 0.0172758 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 3.99998 7.2294e-05 0.00935753 3.99977 0.034809 0.00151873 +EDGE_SE3:QUAT 239 1349 -2.04952 0.226176 -0.00480799 -0.00201093 -0.0119779 0.999254 0.0366515 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 3.99999 5.59907e-05 0.00805646 3.99945 0.0483365 0.00597453 +EDGE_SE3:QUAT 240 1349 -6.29524 0.394403 -0.0330475 -0.00232553 -0.0108103 0.998967 0.0440692 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 3.99999 6.22798e-05 0.00932302 3.99957 0.0438479 0.00827177 +EDGE_SE3:QUAT 1350 1351 4.13957 -0.617798 -0.00283299 -0.000390843 0.00448003 -0.141709 0.989898 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 4.00029 -7.04111e-05 0.0341125 3.99994 -0.00237611 3.91996 +EDGE_SE3:QUAT 236 1350 5.61419 1.74914 0.00371303 0.000753406 0.00632836 -0.993901 0.110094 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 3.99998 4.73089e-05 0.00313578 3.99989 0.023894 0.0486303 +EDGE_SE3:QUAT 237 1350 1.94258 0.641763 0.0112925 -0.00621359 -0.00817765 0.999149 0.0399491 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 3.99988 0.000213821 0.0249122 4.00025 0.034568 0.00683824 +EDGE_SE3:QUAT 238 1350 -1.98383 0.677283 0.0180585 -0.0125721 -0.0120751 0.994167 0.106433 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 3.99964 0.000776682 0.0510364 4.00115 0.0575546 0.0468049 +EDGE_SE3:QUAT 239 1350 -6.15172 0.895701 0.0244935 -0.011771 -0.0152415 0.991911 0.125464 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 3.99979 0.00072846 0.0479639 4.00025 0.070232 0.0647964 +EDGE_SE3:QUAT 1351 1352 4.03901 -0.719261 0.0197285 0.00541533 -0.00559518 -0.158928 0.98726 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 4.00015 -0.000154303 -0.0329219 3.99996 0.0023 3.89923 +EDGE_SE3:QUAT 235 1351 5.00205 2.63298 0.0559131 0.00910341 0.012808 -0.984424 0.175105 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 3.99939 0.000114935 0.0385957 4.00163 0.0350063 0.123357 +EDGE_SE3:QUAT 236 1351 1.43908 1.41925 0.00566416 -0.00406246 -0.00689625 0.999446 0.0323027 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 3.99995 0.000110742 0.0162745 4.00003 0.0285634 0.0044443 +EDGE_SE3:QUAT 237 1351 -2.108 1.5651 -0.0169878 -0.0093518 -0.00867316 0.983391 0.181049 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 3.9999 0.000424269 0.0387976 4.00038 0.0449941 0.132019 +EDGE_SE3:QUAT 238 1351 -5.86547 2.12521 -0.0543371 -0.015037 -0.0132753 0.968973 0.24635 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 3.99994 0.00100633 0.0638191 4.0005 0.0730853 0.245205 +EDGE_SE3:QUAT 1352 1353 4.09999 -0.737473 0.0106132 0.000779237 6.11661e-05 -0.159717 0.987163 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 4 7.88889e-07 0.00193881 4 -0.000194064 3.89796 +EDGE_SE3:QUAT 234 1352 4.26572 2.8287 0.0117739 0.00354389 0.00809255 -0.975879 0.218132 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 3.99984 6.17935e-05 0.0158223 4.00028 0.0226972 0.190532 +EDGE_SE3:QUAT 235 1352 0.978881 1.91835 -0.00402829 0.00240949 0.00806595 -0.999831 0.0163454 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 3.99997 8.36254e-05 0.00964303 3.99985 0.0319274 0.00134686 +EDGE_SE3:QUAT 236 1352 -2.52241 2.40093 0.00575764 0.00282547 -0.002244 0.981664 0.190587 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 3.99996 1.65098e-05 -0.0120249 4.00015 0.00401999 0.145336 +EDGE_SE3:QUAT 237 1352 -5.62124 3.67837 -0.0459362 -0.00137615 -0.00570558 0.942041 0.335446 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 3.99997 -5.18235e-05 0.00462955 3.99989 0.0199385 0.450217 +EDGE_SE3:QUAT 1353 1354 4.29491 -0.706786 -0.0121775 0.00472754 0.00288016 -0.127733 0.991793 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 4.00013 3.69866e-05 0.029648 3.99994 -0.0020344 3.93496 +EDGE_SE3:QUAT 233 1353 3.62934 2.39724 -0.0120124 -0.00234208 0.00647696 -0.965294 0.261075 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 3.99999 3.23463e-05 -0.00935412 3.99982 0.0261575 0.272847 +EDGE_SE3:QUAT 234 1353 0.248359 1.75242 -0.0110527 0.00254726 0.00788901 -0.998182 0.059697 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 3.99995 9.5829e-05 0.0102577 3.99992 0.0300638 0.0145082 +EDGE_SE3:QUAT 235 1353 -3.12054 2.52544 0.000999497 -0.00128843 -0.0074663 0.989647 0.14332 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 4 -2.64722e-05 0.00513415 3.99977 0.0297886 0.0823961 +EDGE_SE3:QUAT 1354 1355 4.37966 -0.453383 0.0117579 0.00284037 0.00137362 -0.0629488 0.998012 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 4.00001 1.57818e-05 0.0130636 3.99999 -0.00043283 3.98419 +EDGE_SE3:QUAT 232 1354 3.44262 1.32582 0.00103746 0.00132751 0.00266217 -0.940936 0.338572 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 3.99998 -1.04527e-05 0.00696845 4.00006 0.00453919 0.458546 +EDGE_SE3:QUAT 233 1354 -0.42343 0.859541 -0.0127229 0.000739798 0.00239733 -0.990746 0.135708 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 3.99999 9.04605e-06 0.00308776 4 0.00836232 0.0736873 +EDGE_SE3:QUAT 234 1354 -4.09073 1.93189 -0.04633 -0.00444415 -0.00381996 0.997643 0.0683646 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 3.99994 8.71806e-05 0.0178915 4.0002 0.0175223 0.0188523 +EDGE_SE3:QUAT 1355 1356 4.0354 -0.111361 0.0142879 -0.00114212 -0.00285723 -0.0026517 0.999992 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 4.00013 1.25613e-05 -0.0228946 3.99997 3.0149e-05 4.0001 +EDGE_SE3:QUAT 231 1355 4.56407 -0.28997 0.0242292 0.00455925 -0.0023696 -0.877063 0.480348 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 4.00003 -6.45453e-05 0.0212764 4 -0.0179548 0.923156 +EDGE_SE3:QUAT 232 1355 -0.221816 -1.10513 -0.00803078 0.00328463 0.000603887 -0.960305 0.278934 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 3.99998 -6.28013e-05 0.0146853 4.00016 -0.00480096 0.311279 +EDGE_SE3:QUAT 233 1355 -4.75981 0.107839 -0.0128069 0.00243905 -0.000151836 -0.99734 0.0728507 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 3.99998 -1.16437e-05 0.00983307 4.00009 -0.00201333 0.0212542 +EDGE_SE3:QUAT 1356 1357 4.04303 -0.0489484 0.0203255 -0.00399731 0.000417542 0.00603008 0.999974 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 3.99994 -7.41755e-06 0.00362932 4 1.12139e-05 3.99986 +EDGE_SE3:QUAT 231 1356 2.30847 -3.60335 0.0130717 0.00148679 -0.00253789 -0.878363 0.477985 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 3.99999 1.38491e-05 0.0053935 3.99997 -0.00922867 0.913913 +EDGE_SE3:QUAT 232 1356 -3.68365 -3.15876 -0.0144104 0.00030478 0.000849257 -0.961005 0.27653 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 4 3.97747e-07 0.00149442 4 0.0021426 0.305878 +EDGE_SE3:QUAT 1278 1356 2.47185 4.76915 0.0951431 0.0107885 0.00187784 -0.416903 0.908885 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 4.00038 -2.21721e-05 0.0590088 3.99975 -0.015673 3.30562 +EDGE_SE3:QUAT 1279 1356 -3.67942 4.58665 0.113325 0.0112429 0.00505427 -0.245031 0.969437 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 4.00066 7.07987e-05 0.0685943 3.99967 -0.00958353 3.761 +EDGE_SE3:QUAT 1357 1358 4.37138 -0.0470951 0.0170058 -0.00254519 0.00623002 0.00679773 0.999954 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 4.0006 -5.74328e-05 0.0500507 3.99984 0.00016803 4.00044 +EDGE_SE3:QUAT 231 1357 0.0837362 -6.94575 0.0305683 -0.000208029 0.0014075 -0.87541 0.48338 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 4 2.32013e-06 0.000202906 4 0.00324188 0.934629 +EDGE_SE3:QUAT 1278 1357 5.07653 1.68656 0.0613116 0.00729607 0.00393601 -0.411256 0.911482 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 4.00056 -0.000199688 0.0558034 3.99986 -0.0132822 3.32425 +EDGE_SE3:QUAT 1279 1357 -0.142674 2.62495 0.0618236 0.00726503 0.00647964 -0.239559 0.970833 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 4.00093 -0.000115345 0.0675405 3.99973 -0.00873017 3.77158 +EDGE_SE3:QUAT 1280 1357 -4.89869 2.01432 -0.084662 0.00372104 -0.00737941 -0.0992122 0.995032 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 4.00067 -0.000209619 -0.0537714 3.99984 0.00258521 3.96135 +EDGE_SE3:QUAT 1358 1359 4.01376 -0.0668597 0.00742652 0.000189437 0.00236666 0.00733867 0.99997 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 4.00009 2.77626e-06 0.0189155 3.99998 6.94144e-05 3.99987 +EDGE_SE3:QUAT 1279 1358 3.72111 0.532509 0.0105946 0.00628394 0.0131395 -0.232433 0.972503 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 4.00307 -0.000753148 0.113691 3.99933 -0.0135449 3.78713 +EDGE_SE3:QUAT 1280 1358 -0.616153 1.10194 -0.00471426 0.00187137 -0.00104435 -0.0921825 0.99574 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 4 -6.65491e-06 -0.00619015 4 0.000251895 3.96602 +EDGE_SE3:QUAT 1281 1358 -5.11215 0.807426 -0.0121148 -0.0024861 -0.0011682 -0.0151139 0.999882 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 4 1.18264e-05 -0.00979317 3.99999 7.50474e-05 3.99911 +EDGE_SE3:QUAT 1359 1360 4.4019 -0.0410306 0.0257839 -0.00028656 -0.000822508 0.00780868 0.999969 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 4.00001 1.06352e-06 -0.00655262 4 -2.55527e-05 3.99977 +EDGE_SE3:QUAT 1279 1359 7.2689 -1.35051 -0.0930462 0.00725987 0.0153048 -0.225383 0.974123 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 4.00416 -0.000975604 0.132326 3.99907 -0.01528 3.80118 +EDGE_SE3:QUAT 1280 1359 3.34222 0.294629 0.00481095 0.00202424 0.00131939 -0.0848445 0.996391 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 4.00002 8.65512e-06 0.0124924 3.99999 -0.00055738 3.97124 +EDGE_SE3:QUAT 1281 1359 -1.10269 0.613121 0.00325674 -0.00240497 0.00123803 -0.0077081 0.999967 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 4 -1.18254e-05 0.0096809 3.99999 -3.71096e-05 3.99979 +EDGE_SE3:QUAT 1282 1359 -5.22893 0.625805 -0.00909385 -0.000627837 0.00149541 0.0072703 0.999972 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 4.00003 -3.38519e-06 0.0120172 3.99999 4.37166e-05 3.99982 +EDGE_SE3:QUAT 1360 1361 4.33126 -0.0925165 0.0263792 -0.00317568 -0.000372866 -0.0123482 0.999919 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 3.99996 5.67914e-06 -0.00345272 4 2.22711e-05 3.99939 +EDGE_SE3:QUAT 941 1360 5.26971 -3.29198 0.0412408 -0.00691039 -0.00265006 0.978817 0.204605 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 3.99991 0.000233649 0.0291424 4.00049 0.0203493 0.167779 +EDGE_SE3:QUAT 942 1360 -0.823941 -4.04345 0.0714088 -0.00355566 0.00435393 0.910746 0.412928 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 3.99994 0.000148244 0.0198229 4.00034 -0.000708778 0.682158 +EDGE_SE3:QUAT 943 1360 -6.57001 -2.53607 0.0672046 -0.000953673 0.00161238 0.811846 0.583869 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 4 2.51897e-05 0.00777593 4.00003 0.00126998 1.36363 +EDGE_SE3:QUAT 1222 1360 -2.15464 6.70911 0.142781 0.00676811 0.00729687 -0.310346 0.950572 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 4.00118 -0.000339642 0.0737567 3.99973 -0.0122705 3.6161 +EDGE_SE3:QUAT 1281 1360 3.29307 0.487979 0.0172975 -0.00250373 0.000328337 0.000121688 0.999997 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 3.99998 -3.29401e-06 0.00263033 4 1.53621e-07 4 +EDGE_SE3:QUAT 1282 1360 -0.841109 0.638219 0.00339233 -0.000886458 0.000832841 0.0151439 0.999885 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 4.00001 -2.78542e-06 0.00682152 4 5.20382e-05 3.99909 +EDGE_SE3:QUAT 1283 1360 -4.82738 0.691013 0.00193826 0.000423164 0.00220115 0.019798 0.999801 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 4.00008 5.97492e-06 0.0174986 3.99998 0.000172911 3.99851 +EDGE_SE3:QUAT 1361 1362 3.97898 -0.26987 0.0253594 0.00136659 -0.00321303 -0.063237 0.997992 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 4.00014 -3.10725e-05 -0.0245166 3.99996 0.000763014 3.98415 +EDGE_SE3:QUAT 940 1361 5.74817 -0.296555 0.0446095 -0.00884832 -0.00468269 0.999264 0.0370376 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 3.99971 0.000225246 0.0354648 4.00109 0.0212934 0.00591544 +EDGE_SE3:QUAT 941 1361 1.32576 -1.45456 0.012639 -0.00735911 -0.00587956 0.976135 0.216959 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 3.99996 0.000259355 0.0309641 4.00025 0.0329732 0.188813 +EDGE_SE3:QUAT 942 1361 -3.61489 -0.723194 0.0553879 -0.0045757 0.00140794 0.905425 0.42448 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 4 0.000180176 0.0234063 4.00027 0.00947853 0.72091 +EDGE_SE3:QUAT 1221 1361 6.56828 2.58974 0.0991681 0.00619239 0.0054983 -0.486673 0.873545 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 4.00074 -0.000461919 0.0597909 3.99997 -0.0158872 3.05349 +EDGE_SE3:QUAT 1222 1361 1.2988 4.05835 0.0861086 0.00366367 0.00804405 -0.322118 0.946658 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 4.00109 -0.000446497 0.0678006 3.99983 -0.011098 3.58611 +EDGE_SE3:QUAT 1223 1361 -4.17262 3.67486 -0.00631894 -0.00242955 0.00270004 -0.156834 0.987618 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 4.00004 -3.57854e-05 0.0163108 3.99999 -0.00113869 3.90168 +EDGE_SE3:QUAT 1282 1361 3.4878 0.666798 0.0214312 -0.00407631 0.000489031 0.00279549 0.999988 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 3.99994 -8.32808e-06 0.00404885 4 5.69823e-06 3.99997 +EDGE_SE3:QUAT 1283 1361 -0.496398 0.772958 0.00981186 -0.00291685 0.00195133 0.00726817 0.999967 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 4.00003 -2.2579e-05 0.0158638 3.99998 5.76858e-05 3.99985 +EDGE_SE3:QUAT 1284 1361 -4.53692 0.867131 0.00295381 -0.00438253 0.00370896 0.00973259 0.999936 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 4.00015 -6.32125e-05 0.03018 3.99994 0.000146223 3.99985 +EDGE_SE3:QUAT 1362 1363 4.18666 -0.565547 -0.0152752 -8.18212e-05 0.00571536 -0.143486 0.989636 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 4.00049 -0.000109545 0.0441838 3.99989 -0.00313335 3.91813 +EDGE_SE3:QUAT 939 1362 5.91424 1.44964 -0.0164037 -0.00375697 0.00404293 -0.997292 0.0733295 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 3.99996 -7.08035e-05 -0.0151363 4.00011 0.0181478 0.0216491 +EDGE_SE3:QUAT 940 1362 1.81979 0.276119 0.0016835 -0.00537972 -0.00407327 0.994949 0.100153 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 3.99992 0.000129346 0.0218084 4.00028 0.0201556 0.0403449 +EDGE_SE3:QUAT 941 1362 -2.1717 0.481847 -0.00420433 -0.00367606 -0.00565976 0.9605 0.278198 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 4 1.8579e-05 0.0153357 3.99987 0.0259272 0.309817 +EDGE_SE3:QUAT 942 1362 -5.93468 2.48552 0.0495499 -0.00125662 0.00104911 0.876858 0.480747 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 4 2.04926e-05 0.00737736 4.00003 0.0017372 0.924486 +EDGE_SE3:QUAT 1222 1362 4.27414 1.41546 0.039395 0.00329449 0.00503984 -0.381535 0.924335 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 4.00047 -0.000226241 0.0454687 3.99994 -0.0090002 3.41824 +EDGE_SE3:QUAT 1223 1362 -0.486301 2.18489 0.000298121 -0.00175693 -0.0010323 -0.218985 0.975726 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 4.00002 1.10451e-06 -0.0121409 3.99999 0.00147512 3.80822 +EDGE_SE3:QUAT 1224 1362 -5.2717 1.66699 0.030499 -0.000230161 0.000126588 -0.109446 0.993993 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 4 -9.1751e-08 0.000694696 4 -3.21674e-05 3.95209 +EDGE_SE3:QUAT 1282 1362 7.45652 0.426663 0.0462751 -0.00279508 -0.00308226 -0.0604376 0.998163 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 4.00014 2.24856e-05 -0.026546 3.99995 0.000820612 3.98557 +EDGE_SE3:QUAT 1283 1362 3.47581 0.557681 0.016765 -0.0016296 -0.00146481 -0.0558747 0.998435 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 4.00003 7.38256e-06 -0.0127541 3.99999 0.000365891 3.98755 +EDGE_SE3:QUAT 1284 1362 -0.565125 0.657177 0.00382065 -0.00307234 0.000310795 -0.0534079 0.998568 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 3.99996 2.12566e-07 0.000510412 4 3.99121e-06 3.98859 +EDGE_SE3:QUAT 1285 1362 -4.61871 0.747094 0.0157926 -0.00259139 -0.00124755 -0.0515899 0.998664 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 4.00001 1.32033e-05 -0.011542 3.99999 0.000311058 3.98939 +EDGE_SE3:QUAT 1363 1364 4.1841 -0.893636 0.0184806 -0.00283111 -0.000431723 -0.208702 0.977975 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 3.99999 1.15778e-05 -0.010115 3.99999 0.00129372 3.8258 +EDGE_SE3:QUAT 938 1363 5.18597 2.48651 0.0178078 0.00289553 0.00827038 -0.994868 0.100805 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 3.99992 0.000113128 0.011826 3.99999 0.0299342 0.040909 +EDGE_SE3:QUAT 939 1363 1.7151 1.39951 -0.00326795 -0.0015391 -0.00391139 0.997502 0.0705171 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 4 1.77079e-05 0.0061913 3.99996 0.0163153 0.0199671 +EDGE_SE3:QUAT 940 1363 -2.13849 1.65661 -0.0463162 -0.0105604 -0.0041434 0.970221 0.241954 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 3.99986 0.000575554 0.0453237 4.00099 0.0334576 0.234991 +EDGE_SE3:QUAT 941 1363 -5.32565 3.15138 -0.0330087 -0.00847861 -0.0050057 0.910532 0.413322 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 4.00007 0.000262521 0.0386117 4.00005 0.035251 0.684088 +EDGE_SE3:QUAT 1222 1363 6.81777 -1.91203 -0.0318759 0.00453399 0.0108601 -0.510022 0.860081 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 4.00139 -0.00122405 0.0782534 4.00023 -0.0187683 2.96099 +EDGE_SE3:QUAT 1223 1363 3.04806 -0.11228 -0.00292955 -0.000158687 0.00433914 -0.356579 0.934255 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 4.00019 -0.000122855 0.0276871 3.99999 -0.00446541 3.49159 +EDGE_SE3:QUAT 1224 1363 -1.33829 0.198831 0.0110466 0.000312799 0.00583092 -0.250905 0.967994 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 4.00046 -0.000181024 0.043219 3.99992 -0.00526991 3.74865 +EDGE_SE3:QUAT 1225 1363 -5.46144 0.104575 -0.00150266 0.00025259 0.00576283 -0.218641 0.975788 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 4.00047 -0.000157564 0.0434826 3.99991 -0.0046543 3.80926 +EDGE_SE3:QUAT 1284 1363 3.54242 -0.348866 -0.0106654 -0.00296115 0.00567219 -0.19604 0.980575 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 4.00029 -0.000156904 0.0360006 3.99995 -0.00321596 3.84659 +EDGE_SE3:QUAT 1285 1363 -0.549964 -0.259718 0.00967945 -0.00212927 0.00412295 -0.194202 0.98095 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 4.00015 -8.26762e-05 0.0262986 3.99997 -0.002332 3.84931 +EDGE_SE3:QUAT 1286 1363 -4.52465 -0.187412 -0.0010986 -0.000707793 0.0047564 -0.192729 0.98124 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 4.00029 -0.000102723 0.0343566 3.99994 -0.00318926 3.85172 +EDGE_SE3:QUAT 1364 1365 3.89348 -0.802366 0.00531605 0.00356307 0.00373244 -0.190239 0.981724 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 4.00028 -1.96922e-05 0.0361934 3.99992 -0.00364663 3.85556 +EDGE_SE3:QUAT 937 1364 3.46316 3.67907 0.00583593 -0.000706907 0.0112284 -0.982842 0.184104 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 3.99995 0.000140582 -0.00240584 3.99957 0.042157 0.13604 +EDGE_SE3:QUAT 938 1364 0.908642 2.52436 0.0136467 -0.000628149 -0.0114979 0.993982 0.108935 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 3.99999 -8.46104e-05 0.00243721 3.99949 0.0451709 0.047985 +EDGE_SE3:QUAT 939 1364 -2.30473 2.88742 0.0117979 -0.000680806 -0.00688393 0.960878 0.276887 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 3.99996 -6.97633e-05 0.00184856 3.99987 0.0237942 0.306823 +EDGE_SE3:QUAT 940 1364 -5.40914 4.41903 -0.0967583 -0.0102205 -0.00918402 0.898301 0.439165 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 4.00008 0.000114019 0.0446797 3.99959 0.049251 0.772716 +EDGE_SE3:QUAT 1223 1364 5.57801 -3.57402 -0.0177777 -0.0039145 0.00496106 -0.543831 0.839171 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 3.9999 7.6886e-06 0.00294545 4.00001 0.00336447 2.81695 +EDGE_SE3:QUAT 1224 1364 1.89782 -2.62235 -0.0210127 -0.00370056 0.00636816 -0.447279 0.894364 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 3.99999 -0.000129626 0.0192338 4.00005 -0.00153849 3.19982 +EDGE_SE3:QUAT 1225 1364 -2.04138 -2.49138 -0.0328018 -0.00360573 0.00616541 -0.417603 0.908601 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 4.00002 -0.000137804 0.0210303 4.00004 -0.0021371 3.30251 +EDGE_SE3:QUAT 1226 1364 -6.34717 -2.53423 -0.0644188 -0.00263776 0.00624462 -0.405198 0.914204 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 4.00012 -0.000184946 0.0267503 4.00004 -0.00363224 3.34341 +EDGE_SE3:QUAT 1285 1364 2.99862 -2.67871 0.000123299 -0.00561321 0.00384406 -0.394799 0.918742 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 3.99985 2.79154e-05 1.95351e-05 4 0.00225289 3.37651 +EDGE_SE3:QUAT 1286 1364 -0.996629 -2.59484 -0.0224659 -0.0042974 0.00499739 -0.393069 0.919485 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 3.99994 -5.79543e-05 0.0128975 4.00002 -0.000545508 3.382 +EDGE_SE3:QUAT 1287 1364 -4.97101 -2.50818 -0.0366005 -0.00423872 0.00581341 -0.391528 0.920138 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 3.99998 -0.000106319 0.0183524 4.00003 -0.00153087 3.38688 +EDGE_SE3:QUAT 1365 1366 3.97214 -0.67891 0.0192919 0.00681586 0.0154843 -0.14285 0.9896 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 4.00415 -0.000455562 0.13175 3.99896 -0.00957907 3.92271 +EDGE_SE3:QUAT 936 1365 2.33186 3.03165 0.0362277 0.0034021 0.0101029 -0.977709 0.209696 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 3.99981 0.000129434 0.0152215 4.00021 0.0305856 0.176201 +EDGE_SE3:QUAT 937 1365 -0.443059 3.02964 0.0271276 -0.00161378 -0.00772175 0.999952 0.00583898 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 3.99999 4.73934e-05 0.00645598 3.9998 0.0309592 0.000386433 +EDGE_SE3:QUAT 938 1365 -2.71654 4.11955 0.0445617 -0.00196147 -0.00727589 0.955146 0.29604 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 3.99998 -7.06642e-05 0.00729723 3.9998 0.0271638 0.350778 +EDGE_SE3:QUAT 1224 1365 3.59023 -6.2011 -0.0352971 0.000379906 0.00728329 -0.60925 0.792945 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 4.00017 -0.000341205 0.0311424 4.00019 -0.00547011 2.51543 +EDGE_SE3:QUAT 1225 1365 -0.109376 -5.94161 -0.049267 0.000432081 0.00739784 -0.582817 0.81257 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 4.00023 -0.0003737 0.0340931 4.00018 -0.00648768 2.64153 +EDGE_SE3:QUAT 1226 1365 -4.32887 -5.93891 -0.0778458 0.00112847 0.00743159 -0.571783 0.82037 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 4.00032 -0.000436806 0.0388848 4.00019 -0.00830928 2.69258 +EDGE_SE3:QUAT 1286 1365 1.12108 -5.94404 -0.0257119 -0.000340429 0.00599957 -0.560865 0.827885 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 4.00012 -0.000212989 0.0254252 4.0001 -0.00428401 2.74184 +EDGE_SE3:QUAT 1287 1365 -2.83909 -5.84929 -0.0472449 -0.00029516 0.00706469 -0.559717 0.828654 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 4.00018 -0.000303236 0.0305929 4.00014 -0.00529625 2.74705 +EDGE_SE3:QUAT 1366 1367 4.19865 -0.372599 -0.0591598 0.00163049 0.0140044 -0.05013 0.998643 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 4.00316 -0.000146121 0.11267 3.99921 -0.00282686 3.99312 +EDGE_SE3:QUAT 936 1366 -1.55004 2.0403 0.0276764 0.0185539 0.00721125 -0.997464 0.0683272 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 3.99853 -3.47143e-05 0.0747368 4.00567 0.0184453 0.0201637 +EDGE_SE3:QUAT 937 1366 -4.38319 3.76612 0.0435333 -0.0157226 -0.00111158 0.988796 0.148439 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 3.99922 0.000890921 0.0649076 4.00358 0.0224974 0.0893384 +EDGE_SE3:QUAT 1367 1368 3.97384 -0.101077 0.0101211 0.000440283 0.000930608 -0.00437431 0.99999 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 4.00001 1.55431e-06 0.00746778 4 -1.63408e-05 3.99994 +EDGE_SE3:QUAT 936 1367 -5.74685 1.83382 -0.191034 0.0319609 0.00725849 -0.999312 0.0173716 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 3.99586 0.000516446 0.127839 4.01636 0.0247044 0.0054501 +EDGE_SE3:QUAT 1368 1369 4.02344 -0.0998056 0.0296246 -0.00235443 0.00292875 -0.0026664 0.999989 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 4.00011 -2.80127e-05 0.0233549 3.99997 -3.15882e-05 4.00011 +EDGE_SE3:QUAT 1369 1370 4.30292 -0.101731 0.0174511 0.00200369 0.000631199 -0.00128892 0.999997 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 3.99999 5.08783e-06 0.00508055 4 -3.26153e-06 4 +EDGE_SE3:QUAT 931 1369 7.14829 1.53188 0.0903239 -0.00466344 -0.0084551 0.999948 0.0031769 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 3.99992 0.00015756 0.0186559 4.00006 0.0339409 0.000415366 +EDGE_SE3:QUAT 932 1369 2.95838 1.6297 0.0776823 -0.00639881 -0.00825063 0.999943 0.00241346 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 3.99984 0.000212305 0.0255976 4.00038 0.0331319 0.000461499 +EDGE_SE3:QUAT 933 1369 -1.0684 1.71451 0.0406358 -0.00861002 -0.00911024 0.99992 0.00193774 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 3.99971 0.000316171 0.0344434 4.00085 0.0365874 0.000646169 +EDGE_SE3:QUAT 934 1369 -5.33866 1.80308 0.0136808 -0.00775954 -0.00705563 0.999944 0.00151147 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 3.99976 0.00022073 0.0310397 4.00076 0.0283248 0.000450531 +EDGE_SE3:QUAT 1370 1371 4.04771 -0.0879435 0.0212344 -0.000279311 -0.000993681 0.000646811 0.999999 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 4.00002 1.12512e-06 -0.0079473 4 -2.57661e-06 4.00001 +EDGE_SE3:QUAT 930 1370 7.15139 1.54459 0.0668147 -0.0035939 -0.00714737 0.999946 0.00660563 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 3.99995 0.000102032 0.0143776 3.99999 0.0287775 0.000433259 +EDGE_SE3:QUAT 931 1370 2.83474 1.65533 0.0673095 -0.00522539 -0.0065058 0.999954 0.00478722 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 3.99989 0.000137487 0.0209034 4.00026 0.0262251 0.000372836 +EDGE_SE3:QUAT 932 1370 -1.35599 1.75644 0.0448861 -0.00707758 -0.00633301 0.999947 0.00400127 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 3.9998 0.000182881 0.0283121 4.00063 0.0255641 0.000427788 +EDGE_SE3:QUAT 933 1370 -5.3859 1.83704 -0.00880369 -0.00909093 -0.00782901 0.999921 0.00379478 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 3.99967 0.000290585 0.0363665 4.00106 0.0316042 0.000637865 +EDGE_SE3:QUAT 1371 1372 4.08302 -0.0870167 0.0220204 -0.000439979 0.0023122 0.000769286 0.999997 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 4.00008 -3.97203e-06 0.018502 3.99998 7.0611e-06 4.00008 +EDGE_SE3:QUAT 930 1371 3.09784 1.67306 0.0637835 -0.00259526 -0.00736865 0.999953 0.00579227 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 3.99997 7.48724e-05 0.0103824 3.99989 0.0295926 0.000380093 +EDGE_SE3:QUAT 931 1371 -1.20233 1.78574 0.0541885 -0.00432615 -0.00702525 0.999957 0.00415091 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 3.99993 0.00012178 0.0173062 4.0001 0.0282456 0.000343244 +EDGE_SE3:QUAT 932 1371 -5.39698 1.86837 0.0140281 -0.00626907 -0.00783606 0.999943 0.00353209 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 3.99985 0.000198139 0.0250786 4.00037 0.0315262 0.000455581 +EDGE_SE3:QUAT 1372 1373 4.33349 -0.103353 0.0223909 0.0015406 0.000432204 0.00099711 0.999998 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 3.99999 2.6489e-06 0.00343918 4 1.71841e-06 4 +EDGE_SE3:QUAT 929 1372 3.39287 1.71445 0.0718607 -0.00286476 -0.00933274 0.999933 0.00624475 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 3.99997 0.00010375 0.0114611 3.99977 0.0374704 0.000539864 +EDGE_SE3:QUAT 930 1372 -0.958182 1.82073 0.064105 -0.00509773 -0.00788002 0.999944 0.0049911 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 3.9999 0.000161287 0.0203934 4.00016 0.0317251 0.000455226 +EDGE_SE3:QUAT 931 1372 -5.24875 1.90163 0.0383459 -0.00685294 -0.00716259 0.999945 0.00350707 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 3.99981 0.000198922 0.0274138 4.00054 0.0288484 0.000445101 +EDGE_SE3:QUAT 1373 1374 4.17327 -0.0996524 0.0307436 -0.00091559 0.00272038 0.000308826 0.999996 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 4.00012 -9.91121e-06 0.0217669 3.99997 3.19887e-06 4.00012 +EDGE_SE3:QUAT 928 1373 3.52025 1.76287 0.066719 -0.00543358 -0.00557488 0.999954 0.00566584 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 3.99988 0.000123752 0.0217361 4.00034 0.0225473 0.000373609 +EDGE_SE3:QUAT 929 1373 -0.92892 1.85889 0.0728146 -0.00334229 -0.00774571 0.99995 0.00538548 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 3.99996 0.000102368 0.0133709 3.99993 0.0311255 0.000402915 +EDGE_SE3:QUAT 930 1373 -5.24329 1.95102 0.0500597 -0.00559325 -0.00621075 0.999956 0.00428646 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 3.99988 0.000140857 0.0223746 4.00034 0.0250374 0.000355355 +EDGE_SE3:QUAT 1374 1375 4.42072 -0.0941162 0.0404787 -0.000920576 0.000967586 -0.000565914 0.999999 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 4.00001 -3.57185e-06 0.00773445 4 -2.20861e-06 4.00001 +EDGE_SE3:QUAT 927 1374 3.72641 1.80684 0.0743134 -0.00589359 -0.00666935 0.999954 0.0036219 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 3.99986 0.000158985 0.023576 4.00037 0.0268518 0.000371664 +EDGE_SE3:QUAT 928 1374 -0.678457 1.89701 0.0603562 -0.00793914 -0.00649603 0.999933 0.00545432 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 3.99975 0.000212766 0.0317591 4.00083 0.0263371 0.00054454 +EDGE_SE3:QUAT 929 1374 -5.06924 1.99638 0.0852824 -0.00603578 -0.00865756 0.999932 0.00504896 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 3.99986 0.000210395 0.0241464 4.00027 0.0348774 0.000551812 +EDGE_SE3:QUAT 1375 1376 4.23409 -0.0944502 0.0350317 0.00136332 -0.00101356 0.000396773 0.999998 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 4.00001 -5.52343e-06 -0.00811502 4 -1.5767e-06 4.00002 +EDGE_SE3:QUAT 926 1375 3.72753 1.85632 0.0702278 0.00462269 0.00694167 -0.999965 0.000313415 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 3.99991 0.000128343 0.0184919 4.00015 0.0277577 0.000278489 +EDGE_SE3:QUAT 927 1375 -0.68322 1.92123 0.0637512 -0.00699312 -0.00737256 0.999939 0.00425456 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 3.99981 0.000209429 0.0279749 4.00055 0.029734 0.000489046 +EDGE_SE3:QUAT 928 1375 -5.07791 2.03772 0.0323104 -0.00921956 -0.0070713 0.999915 0.00589549 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 3.99967 0.000270583 0.0368815 4.00114 0.0287302 0.000685397 +EDGE_SE3:QUAT 1376 1377 4.00259 -0.0764111 0.0282165 -0.00134697 -0.000277562 0.00161279 0.999998 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 3.99999 1.47498e-06 -0.00219442 4 -1.765e-06 3.99999 +EDGE_SE3:QUAT 925 1376 3.85085 1.85005 0.0661568 0.00397971 0.00476513 -0.99998 0.00137527 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 3.99994 7.55937e-05 0.0159193 4.00016 0.0190181 0.000161338 +EDGE_SE3:QUAT 926 1376 -0.49228 1.94934 0.0651295 0.00360377 0.00558773 -0.999977 0.00103146 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 3.99995 8.0492e-05 0.0144157 4.00008 0.0223224 0.000180776 +EDGE_SE3:QUAT 927 1376 -4.88889 2.05262 0.0419072 -0.00599295 -0.00619119 0.999957 0.00355909 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 3.99986 0.000150423 0.0239733 4.00041 0.024939 0.000349818 +EDGE_SE3:QUAT 1377 1378 4.23124 -0.0800016 0.0258573 7.75226e-05 0.00111536 0.00305243 0.999995 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 4.00002 4.36806e-07 0.00891997 4 1.36148e-05 3.99998 +EDGE_SE3:QUAT 924 1377 4.18557 1.83088 0.0589675 0.00311079 0.00585469 -0.999972 0.00347954 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 3.99996 7.29879e-05 0.012444 4.00002 0.0233323 0.00022324 +EDGE_SE3:QUAT 925 1377 -0.140984 1.9207 0.0708119 0.00375037 0.00690166 -0.999965 0.00300721 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 3.99994 0.000103662 0.0150026 4.00004 0.0275173 0.000281739 +EDGE_SE3:QUAT 926 1377 -4.46768 2.01568 0.0708707 0.00355194 0.00682458 -0.999968 0.00219558 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 3.99995 9.71162e-05 0.0142088 4.00002 0.0272369 0.000255213 +EDGE_SE3:QUAT 1378 1379 4.03117 -0.0727733 0.0243355 0.00230788 -0.00118877 0.00175687 0.999995 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 4 -1.09889e-05 -0.0095587 3.99999 -8.33216e-06 4.00001 +EDGE_SE3:QUAT 923 1378 4.22474 1.7796 0.0596991 0.00289561 0.00617524 -0.999948 0.00752418 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 3.99996 7.22439e-05 0.011584 3.99999 0.0245239 0.000410365 +EDGE_SE3:QUAT 924 1378 -0.0552244 1.87019 0.0623085 0.00434298 0.00597436 -0.99995 0.00674215 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 3.99992 0.000102604 0.0173738 4.00017 0.0236626 0.000397269 +EDGE_SE3:QUAT 925 1378 -4.35834 1.97381 0.0706303 0.00512428 0.00646239 -0.999945 0.00646928 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 3.99989 0.000130495 0.0204994 4.00026 0.0255849 0.000436104 +EDGE_SE3:QUAT 1379 1380 4.19313 -0.123412 -0.00211379 -0.00159094 0.00667309 -0.0202739 0.999771 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 4.00069 -6.3458e-05 0.0529727 3.99983 -0.000537492 3.99906 +EDGE_SE3:QUAT 922 1379 4.53804 1.70747 0.0445726 -0.003058 0.00881291 -0.999909 0.00971947 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 3.99997 -0.000103777 -0.012235 3.99983 0.0354814 0.00073007 +EDGE_SE3:QUAT 923 1379 0.180687 1.79425 0.0641332 0.00177469 0.00393351 -0.99995 0.00899321 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 3.99999 2.83204e-05 0.00709979 3.99999 0.0156033 0.000396985 +EDGE_SE3:QUAT 924 1379 -4.04989 1.90649 0.0506104 0.00330138 0.00366159 -0.999954 0.00818824 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 3.99995 4.70441e-05 0.0132071 4.00013 0.0144285 0.000363845 +EDGE_SE3:QUAT 1380 1381 4.02186 -0.314244 0.03126 0.00369166 -0.00271659 -0.0735159 0.997284 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 4.00003 -4.17376e-05 -0.0183116 3.99998 0.000631567 3.97847 +EDGE_SE3:QUAT 921 1380 4.62747 1.66078 0.0755027 -0.00565287 -0.00860252 0.999902 0.00943746 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 3.99988 0.000195944 0.0226167 4.00019 0.0348338 0.000787497 +EDGE_SE3:QUAT 922 1380 0.353487 1.74201 0.0700844 -0.00317678 -0.0101299 0.999888 0.0105243 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 3.99996 0.000122396 0.012711 3.99974 0.0407756 0.000899172 +EDGE_SE3:QUAT 923 1380 -3.9835 1.86261 0.0522135 -0.00825349 -0.00530008 0.999888 0.0113263 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 3.99974 0.000190744 0.0330208 4.00095 0.0219491 0.0009062 +EDGE_SE3:QUAT 1381 1382 4.25532 -0.680451 0.0123061 -0.00102157 -0.00690104 -0.16916 0.985564 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 4.00075 -0.000166426 -0.0548989 3.99983 0.00463476 3.88629 +EDGE_SE3:QUAT 920 1381 4.89459 1.9808 0.055934 -0.00178357 -0.00613567 0.996613 0.0819845 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 4 2.13307e-05 0.00717911 3.99986 0.0252929 0.0270598 +EDGE_SE3:QUAT 921 1381 0.62531 2.05988 0.0709965 -0.00230498 -0.00546313 0.996539 0.0829142 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 3.99999 3.61188e-05 0.00928999 3.99992 0.0229963 0.0276538 +EDGE_SE3:QUAT 922 1381 -3.63349 2.16155 0.0837374 0.000189674 -0.00710831 0.996449 0.083896 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 3.99999 -3.75593e-05 -0.00080052 3.99982 0.0278072 0.0283491 +EDGE_SE3:QUAT 1382 1383 4.17473 -1.03738 0.0160361 0.00680821 -0.00394918 -0.22355 0.974661 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 3.99984 -3.73168e-05 -0.0115977 4 0.000525789 3.80012 +EDGE_SE3:QUAT 919 1382 4.83742 3.2452 0.132702 -0.0200082 -0.0151102 0.968541 0.247587 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 3.99982 0.00188314 0.0852937 4.00158 0.0886647 0.249134 +EDGE_SE3:QUAT 920 1382 0.819226 3.33581 0.06536 0.00597463 -0.00766338 0.968463 0.248968 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 3.99974 9.14381e-05 -0.0269593 4.00083 0.0148488 0.248201 +EDGE_SE3:QUAT 921 1382 -3.44638 3.40287 0.0717411 0.00512396 -0.00702332 0.968158 0.250187 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 3.9998 5.93678e-05 -0.0232066 4.00062 0.0141836 0.250578 +EDGE_SE3:QUAT 1383 1384 4.0373 -0.831769 -0.0129455 0.0017493 -0.000575698 -0.183739 0.982973 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 3.99999 5.26605e-07 -0.000604148 4 -6.98649e-05 3.86496 +EDGE_SE3:QUAT 919 1383 1.6696 6.12369 0.0627376 -0.0101139 -0.0133311 0.888798 0.457993 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 3.99993 -0.000264534 0.0408034 3.99908 0.0567849 0.840489 +EDGE_SE3:QUAT 920 1383 -2.34331 6.21897 0.161474 0.0132509 -0.000723144 0.888289 0.459094 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 4.00022 0.00129973 -0.067522 4.00142 -0.0369537 0.844698 +EDGE_SE3:QUAT 1384 1385 4.11875 -0.653373 0.00426646 0.00877145 -0.00485321 -0.11665 0.993123 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 3.99985 -0.000130576 -0.0258655 3.99997 0.00125723 3.94573 +EDGE_SE3:QUAT 1385 1386 4.18345 -0.221305 0.00574187 0.000551589 0.00108779 -0.0242945 0.999704 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 4.00002 1.74722e-06 0.00885536 4 -0.000108173 3.99766 +EDGE_SE3:QUAT 1386 1387 4.09803 -0.0394673 0.00936116 -0.000195155 0.00260429 0.0151977 0.999881 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 4.00011 4.42576e-07 0.0208632 3.99997 0.000158587 3.99918 +EDGE_SE3:QUAT 1387 1388 4.07658 -0.0368326 0.0165601 -0.00101348 -3.68372e-06 0.00889598 0.99996 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 4 -5.81565e-08 7.87191e-05 4 5.10559e-07 3.99968 +EDGE_SE3:QUAT 1388 1389 4.26152 -0.100293 -0.0222022 -0.000113307 0.00889619 -0.0031717 0.999955 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 4.00127 -1.0062e-05 0.0711838 3.99968 -0.000113193 4.00123 +EDGE_SE3:QUAT 1389 1390 4.1766 -0.0640516 0.00611047 -0.00450007 0.00485652 0.00354523 0.999972 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 4.0003 -8.59942e-05 0.0390449 3.9999 6.67738e-05 4.00033 +EDGE_SE3:QUAT 1390 1391 4.22739 -0.0747426 0.0225899 0.00392271 -0.00098008 0.00755472 0.999963 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 3.99996 -1.61196e-05 -0.00819542 4 -3.13072e-05 3.99979 +EDGE_SE3:QUAT 108 1390 3.63147 -5.96817 0.0345463 -0.0033375 0.00067104 0.916052 0.401044 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 4 8.70701e-05 0.0165098 4.00013 0.00731832 0.643435 +EDGE_SE3:QUAT 109 1390 -3.29795 -5.96148 0.0504203 -0.00578368 0.000957184 0.804564 0.593837 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 4.00013 0.000263416 0.0333486 4.00017 0.0168814 1.41097 +EDGE_SE3:QUAT 1391 1392 4.17496 -0.0377541 0.0261426 -0.00274718 -6.90851e-05 0.00263709 0.999993 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 3.99997 6.00152e-07 -0.000465735 4 -5.76121e-07 3.99997 +EDGE_SE3:QUAT 107 1391 6.25229 -1.05281 -0.0207358 -0.0011176 -0.0049158 0.990924 0.13433 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 4 -4.23713e-06 0.00449447 3.9999 0.0199609 0.0722848 +EDGE_SE3:QUAT 108 1391 0.811543 -2.81749 0.0331588 -0.000749795 0.00401057 0.919105 0.393992 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 3.99997 -5.82208e-07 0.00557457 4.00005 -0.00817076 0.620952 +EDGE_SE3:QUAT 109 1391 -4.47896 -1.88991 0.021721 -0.00268291 0.00362713 0.809051 0.587722 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 4.00003 0.000165312 0.0205718 4.00019 0.00462919 1.38181 +EDGE_SE3:QUAT 1392 1393 4.34533 -0.209813 0.0259799 -0.00712717 -0.00249127 -0.0558844 0.998409 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 3.99995 8.16029e-05 -0.0246057 3.99996 0.000729742 3.98766 +EDGE_SE3:QUAT 106 1392 6.05863 1.77211 0.0568646 0.00821727 0.00595416 -0.994574 0.103535 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 3.99967 2.61142e-05 0.0334446 4.00115 0.0164536 0.0432295 +EDGE_SE3:QUAT 107 1392 2.23742 0.0934394 0.00481804 -0.00159417 -0.00766446 0.991267 0.13164 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 4 -1.37463e-05 0.00640047 3.99976 0.0309865 0.0695705 +EDGE_SE3:QUAT 108 1392 -2.02312 0.222693 0.0373699 -0.00179102 0.00138035 0.920068 0.391753 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 3.99999 3.06164e-05 0.00927855 4.00006 0.00123094 0.613908 +EDGE_SE3:QUAT 109 1392 -5.7165 2.07373 0.0143471 -0.00453159 0.00138065 0.810635 0.585532 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 4.00008 0.000194884 0.0269887 4.00015 0.0125438 1.37164 +EDGE_SE3:QUAT 1393 1394 4.13826 -0.524232 0.00897793 -0.00260035 0.0022921 -0.136983 0.990567 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 4.00002 -2.67101e-05 0.0136021 3.99999 -0.000822349 3.92499 +EDGE_SE3:QUAT 105 1393 5.32572 2.2048 0.0358589 0.00531542 0.00692798 -0.973739 0.2275 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 3.99979 -4.06977e-05 0.0234985 4.00063 0.0150214 0.207236 +EDGE_SE3:QUAT 106 1393 1.76231 1.06903 0.00418498 0.00504081 0.0135351 -0.998741 0.0480433 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 3.99984 0.000303412 0.0202498 3.99984 0.0519002 0.0100105 +EDGE_SE3:QUAT 107 1393 -1.88783 1.43292 0.027962 5.76549e-05 -0.0152281 0.982267 0.186868 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 3.99988 -0.000294593 -0.00104123 3.99933 0.055574 0.140483 +EDGE_SE3:QUAT 108 1393 -4.8724 3.50478 0.0488529 -0.00274111 -0.00621514 0.896543 0.442906 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 3.99996 -7.73303e-05 0.00936676 3.99986 0.0213509 0.784834 +EDGE_SE3:QUAT 1394 1395 4.06299 -0.887173 -0.00125761 0.00191021 0.00144412 -0.212501 0.977158 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 4.00005 -1.37837e-06 0.0155039 3.99998 -0.00179087 3.81943 +EDGE_SE3:QUAT 104 1394 5.16943 1.83 0.000758903 0.000262617 0.00678776 -0.965145 0.261628 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 3.99995 6.7069e-05 0.00212543 3.99993 0.0221059 0.273932 +EDGE_SE3:QUAT 105 1394 1.38476 0.829232 -0.00333219 0.00607855 0.0106923 -0.99571 0.0917063 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 3.99976 0.000226083 0.0246867 4.00043 0.037459 0.0341484 +EDGE_SE3:QUAT 106 1394 -2.38444 1.19293 -0.0159584 -0.00550432 -0.0167973 0.995834 0.089454 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 3.99998 0.000192119 0.0221908 3.99902 0.0697506 0.0333577 +EDGE_SE3:QUAT 107 1394 -5.51865 3.41287 0.081772 -0.000801145 -0.0172607 0.947257 0.32001 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 3.99965 -0.000448696 -0.000872328 3.99952 0.0538557 0.410473 +EDGE_SE3:QUAT 1395 1396 4.18648 -0.984684 -0.0247833 0.00074389 0.000565386 -0.209919 0.977718 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 4.00001 -1.85157e-07 0.00604627 4 -0.000689296 3.82374 +EDGE_SE3:QUAT 103 1395 5.13867 1.38384 0.018302 0.00213936 0.00788185 -0.97892 0.204082 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 3.9999 8.6413e-05 0.00961145 4.00005 0.0249469 0.166788 +EDGE_SE3:QUAT 104 1395 1.23271 0.534973 -0.00290927 0.000942666 0.00521838 -0.9987 0.0507051 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 3.99999 2.87111e-05 0.00379081 3.99992 0.020358 0.0103915 +EDGE_SE3:QUAT 105 1395 -2.77221 0.964886 -0.0374922 -0.00560287 -0.00984783 0.992503 0.121695 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 3.99997 0.000170211 0.0227653 3.99982 0.0433158 0.0598454 +EDGE_SE3:QUAT 106 1395 -6.20729 2.78923 -0.0173729 -0.00336253 -0.0152288 0.954156 0.298904 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 3.99986 -0.000333742 0.0118712 3.99919 0.0550584 0.358255 +EDGE_SE3:QUAT 1396 1397 3.97576 -0.628341 -0.00535626 0.00794413 0.0222141 -0.115066 0.993078 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 4.00832 -0.000715116 0.185411 3.99791 -0.0107668 3.95562 +EDGE_SE3:QUAT 102 1396 5.09957 1.15502 -0.0683843 -0.0112011 0.00783888 -0.992842 0.118647 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 3.9997 -0.000567114 -0.0456441 4.00122 0.0407611 0.0572551 +EDGE_SE3:QUAT 103 1396 0.919778 0.586988 -0.0225241 -0.00136963 -0.00769306 0.999954 0.00556091 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 3.99999 3.97395e-05 0.00547922 3.99979 0.0308302 0.000368844 +EDGE_SE3:QUAT 104 1396 -3.02967 1.08201 -0.0231753 -0.000858834 -0.00464981 0.987054 0.160319 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 4 -1.22786e-05 0.00341191 3.99991 0.0184879 0.1029 +EDGE_SE3:QUAT 105 1396 -6.58433 2.92679 -0.0718489 -0.0040447 -0.00991001 0.944873 0.327263 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 3.99997 -0.000119808 0.0157832 3.99958 0.0388859 0.428893 +EDGE_SE3:QUAT 1397 1398 4.42518 -0.365969 0.000401096 0.00276705 -0.00564073 -0.0536828 0.998538 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 4.00043 -9.71226e-05 -0.0431555 3.99989 0.001143 3.98894 +EDGE_SE3:QUAT 101 1397 5.28145 0.939102 0.0423975 0.00554219 0.00762814 -0.99866 0.0508905 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 3.99984 0.000148264 0.0222637 4.00036 0.0280694 0.0106812 +EDGE_SE3:QUAT 102 1397 1.08514 0.821777 0.0213411 0.0111082 0.00100241 -0.999931 0.00360679 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 3.99951 3.39493e-05 0.0444309 4.00197 0.00369144 0.000549034 +EDGE_SE3:QUAT 103 1397 -3.05735 1.26226 -0.0260995 -0.0225456 0.000527068 0.992403 0.120944 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 3.99818 0.00140236 0.0921369 4.00786 0.019533 0.0607577 +EDGE_SE3:QUAT 104 1397 -6.60675 2.9134 -0.0224487 -0.0205319 0.00667338 0.961751 0.273075 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 3.9988 0.00238793 0.0918785 4.0068 0.0197423 0.300626 +EDGE_SE3:QUAT 1398 1399 4.22216 -0.166651 0.0137838 0.00499255 -0.00290445 -0.0102361 0.999931 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 4.00003 -5.79405e-05 -0.0226185 3.99997 0.000115688 3.99971 +EDGE_SE3:QUAT 100 1398 4.83804 0.817434 0.0511754 0.00707123 0.0100528 -0.999859 0.0114069 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 3.99979 0.000279436 0.0282938 4.00043 0.0395624 0.00111191 +EDGE_SE3:QUAT 101 1398 0.854991 0.859885 0.00440446 0.000410194 -0.00455156 0.999985 0.00300322 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 4 -7.95229e-06 -0.00164085 3.99992 0.0181958 0.000119524 +EDGE_SE3:QUAT 102 1398 -3.32868 1.16266 -0.0696142 -0.00543118 0.00151733 0.998724 0.0501763 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 3.99988 2.79674e-06 0.0218078 4.00048 -0.00385703 0.0101936 +EDGE_SE3:QUAT 1399 1400 4.37823 -0.0927296 0.00623383 0.00100187 -0.00296485 -0.000716405 0.999995 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 4.00014 -1.20283e-05 -0.0237109 3.99996 8.7043e-06 4.00014 +EDGE_SE3:QUAT 99 1399 5.05626 0.798385 0.0420441 0.00620209 0.00769552 -0.999949 0.00224399 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 3.99984 0.00018997 0.0248102 4.00038 0.030676 0.00040925 +EDGE_SE3:QUAT 100 1399 0.633773 0.885939 0.00573223 0.00409068 0.00518084 -0.999978 0.00092751 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 3.99993 8.46136e-05 0.0163633 4.00016 0.0206946 0.00017744 +EDGE_SE3:QUAT 101 1399 -3.34568 1.05301 0.019138 0.00306999 0.000323181 0.99991 0.0130498 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 3.99996 6.89848e-06 -0.012283 4.00015 -0.00161271 0.000719562 +EDGE_SE3:QUAT 1400 1401 4.02 -0.0900594 0.00151063 -0.000203521 0.00152902 0.000105022 0.999999 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 4.00004 -1.23894e-06 0.0122325 3.99999 6.30945e-07 4.00004 +EDGE_SE3:QUAT 98 1400 4.96329 0.798681 0.00814228 0.00149031 0.00515504 -0.99998 0.00325904 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 3.99999 3.12436e-05 0.00596156 3.99993 0.0205808 0.000157265 +EDGE_SE3:QUAT 99 1400 0.691753 0.874558 -0.00305034 0.00313626 0.00659989 -0.999972 0.00134704 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 3.99996 8.29492e-05 0.0125458 3.99998 0.0263665 0.000220403 +EDGE_SE3:QUAT 100 1400 -3.72913 0.972403 -0.0279618 -0.00134017 -0.00426481 0.99999 5.06115e-05 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 3.99999 2.28569e-05 0.00536083 3.99996 0.0170598 7.99547e-05 +EDGE_SE3:QUAT 1401 1402 4.09149 -0.0932733 0.00983335 0.000664083 0.00128166 0.000164185 0.999999 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 4.00002 3.41048e-06 0.010252 3.99999 8.67764e-07 4.00003 +EDGE_SE3:QUAT 97 1401 5.21669 0.771275 0.0146076 0.00158412 0.00777277 -0.999954 0.00540876 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 3.99999 5.15131e-05 0.00633736 3.9998 0.0310198 0.000367634 +EDGE_SE3:QUAT 98 1401 0.966979 0.847108 0.000665781 0.00342621 0.00519724 -0.999974 0.00350911 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 3.99995 7.09911e-05 0.0137056 4.00008 0.0206932 0.000203266 +EDGE_SE3:QUAT 99 1401 -3.32804 0.937698 -0.0233723 0.00486855 0.00685843 -0.999964 0.0013697 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 3.9999 0.000133327 0.0194754 4.00019 0.0273832 0.000289771 +EDGE_SE3:QUAT 1402 1403 4.4885 -0.0770272 0.0176782 -0.00481728 -0.00457546 -0.0026053 0.999975 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 4.00024 8.7352e-05 -0.0367553 3.99992 4.55185e-05 4.00031 +EDGE_SE3:QUAT 96 1402 5.51846 0.754473 0.0365442 0.00571973 0.00359939 -0.999944 0.00811648 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 3.99987 7.67676e-05 0.0228812 4.00048 0.0140263 0.000443588 +EDGE_SE3:QUAT 97 1402 1.12937 0.815607 0.00774077 0.00313156 0.0070705 -0.999953 0.00585849 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 3.99996 8.9486e-05 0.0125278 3.99996 0.0281337 0.000374407 +EDGE_SE3:QUAT 98 1402 -3.12228 0.908867 -0.0179145 0.00486196 0.00453927 -0.999969 0.00419328 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 3.9999 8.65922e-05 0.0194487 4.0003 0.0179953 0.000245851 +EDGE_SE3:QUAT 1403 1404 4.27632 -0.116334 0.0117292 -0.00119275 -0.0007411 -0.00842713 0.999964 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 4 3.51659e-06 -0.00604878 4 2.56394e-05 3.99973 +EDGE_SE3:QUAT 95 1403 5.45225 0.72015 0.0217228 0.00558448 0.00421038 -0.999915 0.0109792 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 3.99987 8.72481e-05 0.0223422 4.00044 0.0163487 0.0006738 +EDGE_SE3:QUAT 96 1403 1.02944 0.76137 0.00356993 0.0011492 0.00864928 -0.999947 0.00541643 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 3.99999 4.28045e-05 0.00459753 3.99972 0.0345438 0.000420982 +EDGE_SE3:QUAT 97 1403 -3.35472 0.849307 0.00449087 -0.00125639 0.0118577 -0.999923 0.00337165 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 3.99999 -5.59006e-05 -0.00502666 3.99946 0.0474603 0.000614989 +EDGE_SE3:QUAT 1404 1405 4.36988 -0.140229 -0.0251525 -0.000999124 0.0136555 -0.00938724 0.999862 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 4.00297 -9.66065e-05 0.109188 3.99926 -0.000517758 4.00263 +EDGE_SE3:QUAT 94 1404 5.55473 0.727457 -0.0534403 -0.0101739 0.00382345 -0.99987 0.0118704 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 3.99959 -0.00018357 -0.0407031 4.00158 0.0162636 0.001044 +EDGE_SE3:QUAT 95 1404 1.17954 0.7388 -0.00817726 0.00503059 0.00558483 -0.999968 0.00258436 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 3.9999 0.000111476 0.0201232 4.00028 0.0222377 0.00025157 +EDGE_SE3:QUAT 96 1404 -3.22543 0.829113 0.0122735 -0.000527028 -0.0099491 0.999947 0.00259121 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 4 1.8933e-05 0.00210842 3.99961 0.0398047 0.000424114 +EDGE_SE3:QUAT 1405 1406 4.37843 -0.126145 0.0187733 0.00275644 -0.00234481 -0.00253434 0.99999 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 4.00006 -2.60326e-05 -0.0186746 3.99998 2.39908e-05 4.00006 +EDGE_SE3:QUAT 93 1405 5.3863 0.711797 0.0480495 0.00650686 0.00746834 -0.999879 0.0120092 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 3.99982 0.000187187 0.0260346 4.00048 0.0292437 0.000960153 +EDGE_SE3:QUAT 94 1405 1.18682 0.743662 0.00744671 0.0035253 0.00482718 -0.99998 0.00208333 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 3.99995 6.78401e-05 0.0141017 4.00011 0.0192508 0.000159721 +EDGE_SE3:QUAT 95 1405 -3.16925 0.869185 -0.081713 -0.0187376 -0.00681765 0.999777 0.00697993 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 3.99861 0.000569339 0.0749491 4.00539 0.0283678 0.00180055 +EDGE_SE3:QUAT 1406 1407 4.19945 -0.122223 0.0180464 0.00493353 0.000311763 -0.00100498 0.999987 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 3.9999 6.34532e-06 0.00255351 4 -1.28112e-06 4 +EDGE_SE3:QUAT 92 1406 5.18091 0.658627 0.0259253 0.00359403 0.0105308 -0.999821 0.0152841 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 3.99994 0.000159634 0.0143838 3.99979 0.0416601 0.00142016 +EDGE_SE3:QUAT 93 1406 1.01528 0.738927 0.00848448 0.00432594 0.00476449 -0.999934 0.00953663 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 3.99992 7.97908e-05 0.0173065 4.00022 0.0187254 0.000526337 +EDGE_SE3:QUAT 94 1406 -3.17868 0.870108 -0.00181723 -0.00138688 -0.0019205 0.999997 0.000638663 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 3.99999 1.06648e-05 0.00554754 4.00002 0.00768916 2.41061e-05 +EDGE_SE3:QUAT 1407 1408 3.99695 -0.0685413 0.0296404 -0.00144163 -0.00367106 0.00395069 0.999984 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 4.00021 2.238e-05 -0.0293008 3.99995 -5.83064e-05 4.00015 +EDGE_SE3:QUAT 91 1407 5.03971 0.525798 0.0369249 0.00600749 0.00871822 -0.999867 0.0124232 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 3.99985 0.000205853 0.0240378 4.0003 0.0342682 0.0010554 +EDGE_SE3:QUAT 92 1407 0.997267 0.644249 0.0159749 0.00404483 0.00566085 -0.999865 0.0148935 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 3.99993 8.9249e-05 0.0161854 4.00015 0.0221508 0.00107546 +EDGE_SE3:QUAT 93 1407 -3.16184 0.778176 -0.00378332 0.004772 -0.000268343 -0.999952 0.00851465 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 3.99991 -9.7663e-06 0.0190899 4.00036 -0.00139839 0.0003816 +EDGE_SE3:QUAT 1408 1409 4.25988 -0.0606783 0.0196423 0.000173403 0.00199976 0.00693476 0.999974 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 4.00006 2.04993e-06 0.0159828 3.99998 5.54192e-05 3.99987 +EDGE_SE3:QUAT 90 1408 5.47239 0.219539 -0.000104659 -0.00089872 -0.00812681 0.999945 0.00652918 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 4 2.58689e-05 0.00359542 3.99975 0.0325498 0.000438652 +EDGE_SE3:QUAT 91 1408 1.0297 0.490506 0.0205474 0.00275017 0.00982202 -0.999807 0.0167682 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 3.99996 0.000117439 0.0110073 3.99976 0.0388916 0.00153325 +EDGE_SE3:QUAT 92 1408 -2.98506 0.602387 0.0137626 0.000593875 0.00703289 -0.999787 0.0194098 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 4 2.41074e-05 0.00237748 3.99981 0.0280123 0.00170462 +EDGE_SE3:QUAT 93 1408 -7.14679 0.778461 -0.00896522 0.00105405 0.0010362 -0.999914 0.013042 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 4 4.12129e-06 0.00421728 4.00001 0.00403312 0.000688893 +EDGE_SE3:QUAT 1409 1410 4.31148 -0.0741179 0.0389895 -0.00450659 -0.0111536 -0.00282882 0.999924 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 4.00192 0.000193386 -0.0894169 3.9995 0.00011321 4.00197 +EDGE_SE3:QUAT 89 1409 5.53105 0.0657673 0.0711399 -0.0133294 -0.0057117 0.999456 0.0296335 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 3.99933 0.000419506 0.0533865 4.0026 0.0259787 0.00439452 +EDGE_SE3:QUAT 90 1409 1.23443 0.349662 0.0196666 0.00325339 0.00835357 -0.99996 0.000308511 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 3.99996 0.000108804 0.0130149 3.99989 0.033407 0.000321737 +EDGE_SE3:QUAT 91 1409 -3.18921 0.410467 0.0180332 0.0049097 0.0098477 -0.999656 0.0238277 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 3.99988 0.00019635 0.019659 4.00005 0.0384034 0.00273661 +EDGE_SE3:QUAT 92 1409 -7.17974 0.498385 0.0358604 0.00279128 0.00668263 -0.999647 0.0255724 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 3.99996 7.81689e-05 0.0111776 3.99997 0.0261169 0.00281769 +EDGE_SE3:QUAT 1410 1411 4.12087 -0.244002 0.0355759 -0.00288043 0.0201693 -0.0529483 0.998389 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 4.00628 -0.00073504 0.159065 3.99846 -0.00423419 3.9951 +EDGE_SE3:QUAT 88 1410 5.21553 0.467342 -0.0242104 0.00247995 -0.00635253 0.999831 0.0170614 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 3.99997 -6.57076e-05 -0.00992494 3.99995 0.0250537 0.00134597 +EDGE_SE3:QUAT 89 1410 1.22031 0.389619 -0.003482 -0.00231704 -0.0106252 0.999418 0.0323427 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 3.99999 7.18984e-05 0.00928114 3.9996 0.0429869 0.00466824 +EDGE_SE3:QUAT 90 1410 -3.06547 0.405535 0.0343643 0.00794074 -0.0127802 0.999885 0.00207279 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 3.99974 -0.000405712 -0.0317699 4.00037 0.0510023 0.000919705 +EDGE_SE3:QUAT 1411 1412 4.24695 -0.463925 0.00543364 -0.000291252 -1.17526e-05 -0.103621 0.994617 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 4 7.79643e-08 -0.000452076 4 2.96501e-05 3.95705 +EDGE_SE3:QUAT 87 1411 4.98437 1.67583 0.0164497 0.00236408 0.00348073 -0.998234 0.0592496 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 3.99997 2.8831e-05 0.00951186 4.00006 0.0126846 0.0141052 +EDGE_SE3:QUAT 88 1411 1.11876 0.863908 0.0359103 -0.0172922 -0.00874971 0.997349 0.07014 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 3.99901 0.0010172 0.0696634 4.00392 0.0442917 0.021389 +EDGE_SE3:QUAT 89 1411 -2.85285 0.901436 0.0184708 -0.0219958 -0.0134485 0.996017 0.0853563 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 3.99855 0.00191199 0.0889108 4.0057 0.0678826 0.0322881 +EDGE_SE3:QUAT 90 1411 -7.17458 0.669857 0.1496 -0.0113341 -0.0154757 0.998292 0.0551749 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 3.99964 0.000733022 0.0455402 4.00064 0.0664501 0.0138035 +EDGE_SE3:QUAT 1412 1413 4.18277 -0.761056 0.00317041 0.00256305 0.000446674 -0.191112 0.981565 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 3.99999 9.56484e-06 0.00911425 3.99999 -0.00105156 3.85392 +EDGE_SE3:QUAT 86 1412 4.12119 2.59343 0.0226328 0.00346307 0.00860996 -0.983833 0.17885 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 3.99986 0.00010274 0.0148951 4.00019 0.0269233 0.128197 +EDGE_SE3:QUAT 87 1412 0.718707 1.60746 -0.00131864 -0.00237522 -0.00424067 0.998993 0.0445965 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 3.99998 3.86692e-05 0.00952645 4 0.0177244 0.00805681 +EDGE_SE3:QUAT 88 1412 -3.00359 1.89182 -0.0899438 -0.0165903 -0.0105002 0.984814 0.172498 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 3.99952 0.00132256 0.0688577 4.00231 0.0611861 0.121189 +EDGE_SE3:QUAT 89 1412 -6.93076 2.07366 -0.120598 -0.0204949 -0.0150307 0.981906 0.187653 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 3.99944 0.00205056 0.0854741 4.00277 0.0846952 0.144563 +EDGE_SE3:QUAT 1413 1414 3.87889 -0.955237 0.0131276 0.00407397 0.00223555 -0.225034 0.97434 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 4.00012 7.10455e-06 0.027174 3.99995 -0.003416 3.79762 +EDGE_SE3:QUAT 85 1413 3.2619 2.36428 0.0261569 0.00367396 0.0100379 -0.978277 0.207027 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 3.9998 0.000124178 0.0163226 4.00026 0.0300947 0.171754 +EDGE_SE3:QUAT 86 1413 -0.0410085 1.80831 0.00128894 -0.00244861 -0.00664899 0.999902 0.0121049 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 3.99998 6.24325e-05 0.00979711 3.99991 0.0268235 0.000790018 +EDGE_SE3:QUAT 87 1413 -3.35364 2.70686 0.009307 -0.00159383 -0.00129389 0.972312 0.233678 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 4 1.19009e-05 0.00674377 4.00001 0.0072996 0.218447 +EDGE_SE3:QUAT 1414 1415 4.08842 -0.826766 0.00109623 0.00125231 -0.0075754 -0.161756 0.986801 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 4.00077 -0.000232935 -0.0558607 3.99984 0.00439109 3.89612 +EDGE_SE3:QUAT 83 1414 7.06683 2.1188 0.109831 0.0120539 0.0121268 -0.980328 0.196633 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 3.99913 -0.000207864 0.0516565 4.00293 0.0256753 0.155535 +EDGE_SE3:QUAT 84 1414 3.11673 1.83738 0.0386996 0.00613294 0.010616 -0.988367 0.151591 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 3.9997 0.000158639 0.0256585 4.00065 0.0327867 0.092367 +EDGE_SE3:QUAT 85 1414 -0.648295 1.63256 0.0124031 -0.0045716 -0.00689086 0.999788 0.0188786 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 3.99993 0.000127615 0.018297 4.00012 0.0282314 0.00170864 +EDGE_SE3:QUAT 86 1414 -3.89787 2.87294 0.00931899 -0.00353412 -0.00267756 0.971473 0.237109 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 3.99999 5.93515e-05 0.0149925 4.00005 0.0155623 0.225005 +EDGE_SE3:QUAT 1415 1416 4.10289 -0.32851 0.0185181 0.00237073 0.00413603 -0.044256 0.999009 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 4.00027 2.1871e-05 0.0342504 3.99993 -0.000765574 3.99246 +EDGE_SE3:QUAT 82 1415 7.1221 1.36489 0.0226199 0.00219389 0.00851764 -0.998641 0.0513788 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 3.99996 9.51571e-05 0.00882048 3.99984 0.0329467 0.0108508 +EDGE_SE3:QUAT 83 1415 2.96733 1.31041 0.0178427 0.00291694 0.0109403 -0.999289 0.0359721 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 3.99995 0.000151917 0.0116966 3.99972 0.0427815 0.00566842 +EDGE_SE3:QUAT 84 1415 -0.993204 1.39947 -0.0126062 0.0027832 -0.0091288 0.999907 0.00975687 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 3.99996 -0.000106158 -0.0111358 3.9998 0.0362895 0.000741065 +EDGE_SE3:QUAT 85 1415 -4.70578 2.62775 -0.00690938 0.00413983 -0.00639964 0.983633 0.180023 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 3.99986 -3.36493e-05 -0.0176429 4.00034 0.0177816 0.129798 +EDGE_SE3:QUAT 1416 1417 4.32603 -0.163377 0.019813 0.000791775 -0.00213219 -0.0151915 0.999882 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 4.00007 -8.30909e-06 -0.0169075 3.99998 0.000128136 3.99915 +EDGE_SE3:QUAT 81 1416 7.19895 1.25864 0.0246683 0.00428374 0.00586964 -0.999843 0.0161356 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 3.99992 9.75173e-05 0.0171425 4.00018 0.0229125 0.00124619 +EDGE_SE3:QUAT 82 1416 3.0512 1.27702 0.0284892 0.00595212 0.00637229 -0.999937 0.00713396 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 3.99985 0.000147907 0.0238113 4.00042 0.0251507 0.00050345 +EDGE_SE3:QUAT 83 1416 -1.13396 1.32682 0.0138592 -0.0064063 -0.0085176 0.999905 0.00874143 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 3.99984 0.000221624 0.0256305 4.00034 0.0345182 0.000767748 +EDGE_SE3:QUAT 84 1416 -5.09539 1.82634 0.0488224 -0.000812757 -0.00623589 0.998501 0.0543705 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 4 3.48363e-06 0.00325748 3.99985 0.0251114 0.0119854 +EDGE_SE3:QUAT 126 1416 0.562816 7.15025 0.136229 0.0103999 0.00612502 -0.488018 0.87275 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 4.00132 -0.00072921 0.0838505 3.99983 -0.0235609 3.04911 +EDGE_SE3:QUAT 1417 1418 3.99778 -0.0669883 0.0233761 -0.000855413 -0.000588502 0.00794196 0.999968 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 4 2.03115e-06 -0.00462605 4 -1.82685e-05 3.99975 +EDGE_SE3:QUAT 80 1417 6.87306 1.22481 0.0171508 0.00333305 0.00452096 -0.999981 0.00266638 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 3.99995 5.99997e-05 0.0133327 4.0001 0.0180134 0.000153996 +EDGE_SE3:QUAT 81 1417 2.87089 1.29284 0.00332225 0.00209022 0.00503648 -0.999985 0.000806859 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 3.99998 4.21886e-05 0.0083612 3.99997 0.0201326 0.000121412 +EDGE_SE3:QUAT 82 1417 -1.27777 1.37321 -0.0110608 -0.00374075 -0.00595123 0.999939 0.00854894 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 3.99995 8.94037e-05 0.0149653 4.00007 0.0240577 0.00049303 +EDGE_SE3:QUAT 83 1417 -5.4215 1.58264 -0.0197477 -0.0042836 -0.00801628 0.999679 0.0236649 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 3.99994 0.000134411 0.0171495 4 0.0328326 0.00258331 +EDGE_SE3:QUAT 126 1417 2.67889 3.38234 0.0557041 0.00974785 0.00392563 -0.501565 0.865056 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 4.00081 -0.000416741 0.0691829 3.99984 -0.0208855 2.99493 +EDGE_SE3:QUAT 127 1417 -3.48127 3.16673 0.019483 0.00581495 0.00339251 -0.24531 0.969421 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 4.00029 -4.04615e-06 0.0411613 3.99989 -0.00564028 3.75971 +EDGE_SE3:QUAT 1418 1419 4.14463 -0.0393857 0.0114906 -0.000714769 0.00509848 0.0124386 0.999909 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 4.00042 -6.83816e-06 0.0408888 3.9999 0.000254123 3.9998 +EDGE_SE3:QUAT 79 1418 7.15437 0.684007 -0.0384769 0.00363915 -0.00531354 0.999462 0.0321699 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 3.99994 -7.31067e-05 -0.014581 4.00013 0.0202649 0.00429559 +EDGE_SE3:QUAT 80 1418 2.85937 1.26601 0.01198 0.00297226 0.00557554 -0.999924 0.0106077 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 3.99996 6.65613e-05 0.0118916 4.00003 0.0220445 0.000606952 +EDGE_SE3:QUAT 81 1418 -1.1153 1.34834 0.0201946 0.00175086 0.00582135 -0.999944 0.00865152 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 3.99999 4.2428e-05 0.00700459 3.99992 0.0231599 0.000445769 +EDGE_SE3:QUAT 82 1418 -5.25665 1.49914 -0.00874357 0.00371904 0.00644794 -0.999972 0.000100308 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 3.99994 9.59314e-05 0.014877 4.00006 0.0257902 0.000221649 +EDGE_SE3:QUAT 126 1418 4.60777 -0.131813 0.0181042 0.00891704 0.00381565 -0.493921 0.869453 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 4.00071 -0.000360167 0.0643374 3.99986 -0.0189928 3.0252 +EDGE_SE3:QUAT 127 1418 0.0111949 1.20955 0.00691832 0.00471988 0.00289872 -0.236937 0.971509 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 4.0002 -2.79475e-06 0.0341839 3.99992 -0.00449717 3.77573 +EDGE_SE3:QUAT 128 1418 -4.38603 0.512568 -0.0717947 0.00211321 -0.00563905 -0.0444747 0.998992 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 4.00046 -7.84283e-05 -0.0438565 3.99988 0.000967757 3.99257 +EDGE_SE3:QUAT 1419 1420 4.25272 -0.0623232 -0.00338636 -0.00164912 0.00471904 0.00457618 0.999977 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 4.00035 -2.87818e-05 0.0378445 3.99991 8.57953e-05 4.00027 +EDGE_SE3:QUAT 78 1419 7.20816 -1.60766 -0.0570491 0.00491885 -0.0096964 0.969387 0.245296 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 3.99973 -2.71033e-05 -0.022513 4.00061 0.0240093 0.24098 +EDGE_SE3:QUAT 79 1419 3.04676 0.986134 0.00234728 -0.00159044 -0.00606719 0.999792 0.0193908 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 3.99999 3.38398e-05 0.00636532 3.99988 0.0244924 0.00166417 +EDGE_SE3:QUAT 80 1419 -1.24457 1.22408 -0.00135448 0.00838478 0.00646725 -0.999668 0.0234864 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 3.9997 0.000183441 0.0335678 4.00102 0.0242679 0.00263558 +EDGE_SE3:QUAT 81 1419 -5.21113 1.33751 0.00938378 0.00742143 0.00680546 -0.999715 0.0216438 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 3.99976 0.000180071 0.0297079 4.00075 0.0259131 0.00226249 +EDGE_SE3:QUAT 127 1419 3.64883 -0.737565 -0.0202658 0.00506567 0.00805767 -0.224798 0.974359 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 4.00122 -0.000244479 0.072863 3.99971 -0.00850796 3.79919 +EDGE_SE3:QUAT 128 1419 -0.28855 0.108658 -0.00878978 0.00145226 -0.00052125 -0.0315322 0.999502 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 3.99999 -2.65543e-06 -0.00361462 4 5.40756e-05 3.99603 +EDGE_SE3:QUAT 129 1419 -4.25322 0.0291621 -0.0296366 0.000742225 -0.00404918 0.0165834 0.999854 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 4.00026 -5.5217e-06 -0.0325296 3.99993 -0.000269849 3.99916 +EDGE_SE3:QUAT 1420 1421 4.34354 -0.116002 0.0076474 -0.0013673 0.000761475 -0.00572788 0.999982 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 4 -4.15655e-06 0.00599752 4 -1.71052e-05 3.99988 +EDGE_SE3:QUAT 78 1420 3.50196 0.457363 -0.000399951 -5.09359e-05 -0.010228 0.970526 0.240778 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 3.99992 -0.00014995 -0.000922682 3.99976 0.0351962 0.23223 +EDGE_SE3:QUAT 79 1420 -1.20034 1.2014 -0.0192384 -0.00639001 -0.00768254 0.999848 0.0143113 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 3.99985 0.000203074 0.0255697 4.00038 0.0314517 0.00123005 +EDGE_SE3:QUAT 80 1420 -5.47967 1.09153 -0.0765546 0.0133338 0.00849214 -0.999483 0.0280143 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 3.99924 0.000345031 0.0533979 4.0027 0.0309457 0.00409213 +EDGE_SE3:QUAT 128 1420 3.96256 -0.221806 -0.012841 -0.000109956 0.00421186 -0.0268287 0.999631 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 4.00028 -1.32373e-05 0.0336252 3.99993 -0.000450869 3.9974 +EDGE_SE3:QUAT 129 1420 -0.00569833 0.120875 0.000508692 -0.000958139 0.000569793 0.0213769 0.999771 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 4 -2.15806e-06 0.00480093 4 5.21711e-05 3.99818 +EDGE_SE3:QUAT 130 1420 -4.30764 0.247273 -0.003204 0.000596636 0.000281349 0.0108905 0.99994 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 4 6.59866e-07 0.00217242 4 1.16882e-05 3.99953 +EDGE_SE3:QUAT 1421 1422 4.15025 -0.107698 0.0188875 0.00145564 -0.000818117 0.000147188 0.999999 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 4 -4.76368e-06 -0.0065475 4 -4.58527e-07 4.00001 +EDGE_SE3:QUAT 77 1421 5.45535 0.824247 0.0463938 -0.00457637 -0.0121151 0.833724 0.55203 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 3.99969 -0.000274333 0.00825843 3.99977 0.0298285 1.21939 +EDGE_SE3:QUAT 78 1421 -0.27008 2.58844 0.0318162 -0.00105007 -0.0116752 0.969188 0.246043 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 3.99992 -0.000186869 0.00317114 3.99959 0.0417246 0.242619 +EDGE_SE3:QUAT 79 1421 -5.51444 1.46422 -0.0695863 -0.00750762 -0.00853314 0.999727 0.0203949 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 3.9998 0.000270409 0.0300516 4.00055 0.0353306 0.00220179 +EDGE_SE3:QUAT 129 1421 4.34147 0.176223 -0.00527192 -0.00254266 0.00139894 0.0157882 0.999871 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 4.00001 -1.42461e-05 0.011669 3.99999 9.32467e-05 3.99904 +EDGE_SE3:QUAT 130 1421 0.0153649 0.228225 0.0038884 -0.000841761 0.00115577 0.00575718 0.999982 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 4.00002 -3.7376e-06 0.00930387 3.99999 2.68105e-05 3.99989 +EDGE_SE3:QUAT 131 1421 -4.16901 0.386087 -0.0178393 -0.00117603 0.000480458 -0.00861933 0.999962 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 4 -2.20985e-06 0.0037216 4 -1.58697e-05 3.99971 +EDGE_SE3:QUAT 191 1421 5.74403 -2.7701 0.00101578 -0.00322761 -0.00297298 0.965465 0.260495 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 4 4.37721e-05 0.0137363 4.00001 0.0161932 0.271549 +EDGE_SE3:QUAT 192 1421 0.15712 -3.86036 0.0464705 -0.00161153 0.00664214 0.886218 0.463218 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 3.99991 7.03573e-05 0.0134451 4.00023 -0.00875128 0.858386 +EDGE_SE3:QUAT 193 1421 -5.27482 -2.8119 0.203069 0.00796383 0.0170926 0.785881 0.61809 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 3.99925 -0.000549541 -0.0118733 3.99963 -0.0370035 1.52906 +EDGE_SE3:QUAT 832 1421 6.22875 3.17261 0.122172 0.0133667 -0.00657399 -0.711476 0.702552 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 4.00002 0.000153273 0.0573697 3.99947 -0.0382678 1.97595 +EDGE_SE3:QUAT 833 1421 2.04216 3.21513 0.0229254 0.00326355 0.00301023 -0.715616 0.69848 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 4.00012 -0.000196939 0.0266652 4.00012 -0.00913165 1.95173 +EDGE_SE3:QUAT 834 1421 -2.03992 3.28676 0.0254475 0.00203997 0.00896005 -0.718753 0.695204 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 4.00013 -0.000536355 0.0356211 4.00048 -0.00500935 1.93372 +EDGE_SE3:QUAT 835 1421 -6.1294 3.40441 0.209766 -0.00769711 0.0218773 -0.720503 0.693064 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 3.99885 -1.62259e-06 0.0147585 4.00048 0.0246352 1.92259 +EDGE_SE3:QUAT 1422 1423 4.40083 -0.0707191 0.0140953 -0.00451711 -0.00102212 0.00152721 0.999988 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 3.99993 1.82559e-05 -0.00809393 4 -6.27097e-06 4.00001 +EDGE_SE3:QUAT 77 1422 3.94596 4.65981 0.0821573 -0.0033042 -0.0114385 0.833812 0.55192 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 3.99972 -0.000184351 0.00234967 3.99992 0.0250532 1.21879 +EDGE_SE3:QUAT 78 1422 -3.85106 4.65639 0.063569 0.000140927 -0.0102673 0.96914 0.246299 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 3.99991 -0.000152876 -0.00184104 3.99979 0.0347137 0.24298 +EDGE_SE3:QUAT 130 1422 4.16373 0.185473 0.00586748 0.00074596 0.000265258 0.00579532 0.999983 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 4 7.75053e-07 0.00207008 4 5.9494e-06 3.99987 +EDGE_SE3:QUAT 131 1422 -0.00577884 0.218271 -0.00260419 0.00023658 -0.000449241 -0.00872358 0.999962 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 4 -4.62952e-07 -0.00356875 4 1.55307e-05 3.9997 +EDGE_SE3:QUAT 132 1422 -4.3118 0.258163 -0.00458643 0.00565074 0.00105858 -0.00634038 0.999963 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 3.99989 2.53592e-05 0.00889764 3.99999 -2.84967e-05 3.99986 +EDGE_SE3:QUAT 190 1422 6.25266 0.880058 0.0301504 -0.0036203 -0.00782949 0.997762 0.0663003 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 3.99997 9.42529e-05 0.0145594 3.99988 0.0328866 0.0179076 +EDGE_SE3:QUAT 191 1422 2.21522 -0.587336 -0.00188087 -0.00204859 -0.00175497 0.965403 0.260748 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 4 1.83409e-05 0.00873781 4.00001 0.00983836 0.272003 +EDGE_SE3:QUAT 192 1422 -2.12114 -0.391852 0.0172378 -0.000338842 0.00753858 0.886176 0.463287 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 3.99989 -8.27035e-06 0.00771328 4.00012 -0.0142657 0.858656 +EDGE_SE3:QUAT 193 1422 -6.13797 1.2283 0.181667 0.00954776 0.0179259 0.785817 0.618125 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 3.99916 -0.000720001 -0.0190739 3.9994 -0.0424497 1.52949 +EDGE_SE3:QUAT 832 1422 6.07596 -0.990398 0.0905898 0.0140091 -0.00812321 -0.711435 0.702565 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 3.99989 0.000303512 0.0566986 3.99935 -0.0401462 1.97611 +EDGE_SE3:QUAT 833 1422 1.83838 -0.941665 -0.000338637 0.00352988 0.00158073 -0.715568 0.698532 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 4.00009 -0.000128646 0.0242751 4.00006 -0.00999226 1.95199 +EDGE_SE3:QUAT 834 1422 -2.2832 -0.848545 -0.018855 0.00227086 0.00767237 -0.718699 0.695275 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 4.00014 -0.000450517 0.0334718 4.00039 -0.0057985 1.93404 +EDGE_SE3:QUAT 835 1422 -6.40279 -0.736351 0.147612 -0.00715144 0.0200416 -0.720706 0.692914 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 3.99903 1.76839e-05 0.0129187 4.00038 0.0228883 1.92156 +EDGE_SE3:QUAT 1423 1424 4.15721 -0.0864854 0.0140122 -0.00201766 -0.00806045 0.00112054 0.999965 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 4.00102 6.68214e-05 -0.0644706 3.99974 -3.92855e-05 4.00103 +EDGE_SE3:QUAT 131 1423 4.38365 0.0693851 0.00700322 -0.00434951 -0.00137561 -0.00717497 0.999964 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 3.99996 2.46727e-05 -0.0113782 3.99999 4.10584e-05 3.99983 +EDGE_SE3:QUAT 132 1423 0.109013 0.131854 -0.00246475 0.00102808 4.04727e-05 -0.00485175 0.999988 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 4 2.07203e-07 0.000383624 4 -9.78961e-07 3.99991 +EDGE_SE3:QUAT 133 1423 -4.20829 0.19428 0.0380162 0.0030301 0.00731017 0.00123486 0.999968 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 4.00082 9.0158e-05 0.0584464 3.99979 3.99799e-05 4.00085 +EDGE_SE3:QUAT 189 1423 5.7223 1.768 0.0857488 -0.0100476 -0.0197834 0.999751 0.00229761 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 3.9996 0.000793894 0.0402126 4.00003 0.0793454 0.00199903 +EDGE_SE3:QUAT 190 1423 1.90966 1.52724 0.0143516 -0.00309464 -0.0125677 0.997826 0.0646268 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 3.99999 7.9789e-05 0.0124309 3.99942 0.0513368 0.0174069 +EDGE_SE3:QUAT 191 1423 -1.53484 1.68422 -0.000763433 -0.00257612 -0.00682555 0.965808 0.259157 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 3.99999 -3.21065e-05 0.0103389 3.9998 0.0278087 0.268883 +EDGE_SE3:QUAT 192 1423 -4.55288 3.2358 -0.00143504 -0.00182707 0.0027174 0.886951 0.461853 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 3.99999 5.33951e-05 0.0113891 4.0001 -0.000217049 0.853274 +EDGE_SE3:QUAT 833 1423 1.64725 -5.31501 -0.0185248 -0.000217459 0.00416778 -0.714387 0.699739 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 3.99999 -5.59143e-05 0.0101936 4.00006 0.000867866 1.9586 +EDGE_SE3:QUAT 834 1423 -2.51722 -5.22736 -0.0684068 -0.00166508 0.0102911 -0.717431 0.696551 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 3.99986 -0.000204714 0.0184071 4.00028 0.00564854 1.94104 +EDGE_SE3:QUAT 1424 1425 4.01811 -0.0835901 0.00647509 0.00122664 0.00280931 0.00245139 0.999992 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 4.00012 1.42191e-05 0.0224388 3.99997 2.77223e-05 4.0001 +EDGE_SE3:QUAT 132 1424 4.23619 0.0157886 0.0121534 -0.00114135 -0.00783151 -0.00351189 0.999963 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 4.00098 3.06435e-05 -0.0627124 3.99975 0.000108535 4.00093 +EDGE_SE3:QUAT 133 1424 -0.0773032 0.115336 -0.00582704 0.00106404 -0.000696048 0.00236336 0.999996 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 4 -2.95616e-06 -0.00559851 4 -6.61506e-06 3.99999 +EDGE_SE3:QUAT 134 1424 -4.27869 0.241757 -0.0242768 -0.000247774 -0.00270568 -0.00128836 0.999995 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 4.00012 2.45606e-06 -0.0216498 3.99997 1.39047e-05 4.00011 +EDGE_SE3:QUAT 188 1424 5.62551 1.78264 0.0379915 0.00306565 0.0176189 -0.99984 0.000885466 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 3.99996 0.000217945 0.0122683 3.99891 0.0704465 0.00128176 +EDGE_SE3:QUAT 189 1424 1.58811 1.86105 0.0232974 -0.00210148 -0.0217114 0.999762 0.000920911 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 3.99998 0.000178967 0.0084118 3.99818 0.0868426 0.00190733 +EDGE_SE3:QUAT 190 1424 -2.14879 2.1475 0.0179707 0.00469599 -0.0152576 0.997864 0.0633502 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 3.99983 -0.000350878 -0.0189339 3.99966 0.0580528 0.0169893 +EDGE_SE3:QUAT 191 1424 -5.06221 3.80626 0.0121422 0.00462613 -0.0106409 0.966017 0.25822 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 3.99971 -4.99616e-05 -0.0217249 4.00059 0.0267232 0.267042 +EDGE_SE3:QUAT 1425 1426 4.2085 -0.0806619 0.0237718 0.00238313 -0.0002627 0.00337576 0.999991 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 3.99998 -2.65148e-06 -0.00219808 4 -3.76016e-06 3.99996 +EDGE_SE3:QUAT 133 1425 3.92896 0.0661189 -0.00214478 0.00190208 0.00212656 0.00472247 0.999985 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 4.00006 1.65506e-05 0.0169043 3.99998 4.0036e-05 3.99998 +EDGE_SE3:QUAT 134 1425 -0.26575 0.153544 -0.000306286 0.000590881 9.3304e-05 0.0011135 0.999999 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 4 2.17644e-07 0.000738535 4 4.09837e-07 4 +EDGE_SE3:QUAT 135 1425 -4.29947 0.296251 -0.0206353 -0.0020729 0.000775768 -0.00888164 0.999958 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 3.99999 -6.24731e-06 0.00598446 4 -2.62762e-05 3.99969 +EDGE_SE3:QUAT 187 1425 5.6485 1.77811 0.0385486 0.0066827 0.0140161 -0.999876 0.00269508 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 3.99982 0.000376056 0.0267383 3.99994 0.0559276 0.000989718 +EDGE_SE3:QUAT 188 1425 1.62617 1.86808 0.0193129 0.0059691 0.0165866 -0.999839 0.00332561 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 3.99985 0.000400421 0.0238862 3.99949 0.0661901 0.00128224 +EDGE_SE3:QUAT 189 1425 -2.39775 1.94327 0.0175462 0.00498538 0.0204495 -0.999777 0.00150854 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 3.9999 0.000411729 0.0199539 3.99873 0.0817314 0.0017791 +EDGE_SE3:QUAT 190 1425 -6.13093 2.72937 0.0700599 0.00191385 -0.0140172 0.998006 0.0615198 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 3.99995 -0.000190491 -0.00772803 3.99937 0.054598 0.015902 +EDGE_SE3:QUAT 1426 1427 4.05138 -0.0724202 0.0300052 -0.000761701 -0.000635275 0.00346045 0.999994 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 4 1.95265e-06 -0.00505048 4 -8.72752e-06 3.99996 +EDGE_SE3:QUAT 134 1426 3.90011 0.0805854 0.0174307 0.00301784 -0.000185488 0.0046981 0.999984 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 3.99996 -2.57664e-06 -0.00165397 4 -4.01547e-06 3.99991 +EDGE_SE3:QUAT 135 1426 -0.107558 0.138366 6.45111e-06 0.000361132 0.000602104 -0.00532919 0.999986 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 4.00001 8.28558e-07 0.00483973 4 -1.29131e-05 3.99989 +EDGE_SE3:QUAT 136 1426 -4.21958 0.240003 -0.0485494 0.00108103 -0.000501309 -0.0100502 0.999949 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 4 -2.1309e-06 -0.00387949 4 1.92817e-05 3.9996 +EDGE_SE3:QUAT 186 1426 5.51494 1.7511 0.0363511 0.00581692 0.0110206 -0.999897 0.00714044 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 3.99986 0.000257419 0.0232732 4.00008 0.0437504 0.000817873 +EDGE_SE3:QUAT 187 1426 1.41535 1.82893 0.0131421 0.00660666 0.0116872 -0.999891 0.00617852 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 3.99982 0.000309056 0.0264329 4.00017 0.0464261 0.000866181 +EDGE_SE3:QUAT 188 1426 -2.56394 1.91982 -0.00136204 0.00590355 0.0142833 -0.999857 0.00685093 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 3.99985 0.000342523 0.0236226 3.99977 0.0568087 0.00113409 +EDGE_SE3:QUAT 189 1426 -6.59273 2.02134 0.00203768 0.00488974 0.0185859 -0.999804 0.00479785 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 3.9999 0.000373771 0.0195697 3.99902 0.0741492 0.00156265 +EDGE_SE3:QUAT 1427 1428 4.27456 -0.0863521 0.0264765 0.00159377 0.00796378 0.00218842 0.999965 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 4.001 5.40981e-05 0.0636818 3.99975 7.21364e-05 4.00099 +EDGE_SE3:QUAT 135 1427 3.93202 0.0228907 0.0217357 -0.00043112 -1.2254e-05 -0.00183442 0.999998 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 4 2.38515e-08 -0.000107521 4 1.01519e-07 3.99999 +EDGE_SE3:QUAT 136 1427 -0.157189 0.068424 -0.0103712 0.000400829 -0.00116334 -0.00648488 0.999978 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 4.00002 -2.06626e-06 -0.00927497 3.99999 3.00525e-05 3.99985 +EDGE_SE3:QUAT 137 1427 -4.27033 -0.200563 -0.121854 0.000519778 -0.00922667 0.0460798 0.998895 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 4.00136 7.51662e-05 -0.0738874 3.99966 -0.00170322 3.99287 +EDGE_SE3:QUAT 185 1427 5.95844 1.66711 -0.019098 -0.000659146 0.0102366 -0.999911 0.00856992 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 4 -1.98603e-05 -0.00263716 3.99959 0.0409822 0.000715471 +EDGE_SE3:QUAT 186 1427 1.48644 1.76817 0.0246752 0.00542766 0.0119758 -0.999863 0.0100214 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 3.99987 0.000264035 0.0217183 3.99993 0.0474607 0.00108281 +EDGE_SE3:QUAT 187 1427 -2.60198 1.86901 -0.0109616 0.00616619 0.0127166 -0.999854 0.00960481 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 3.99984 0.000316925 0.0246736 4 0.0503878 0.00115597 +EDGE_SE3:QUAT 188 1427 -6.59096 1.94064 -0.0195365 0.00557256 0.0153252 -0.999809 0.0107323 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 3.99986 0.000353135 0.0223017 3.9996 0.0608086 0.00150965 +EDGE_SE3:QUAT 1428 1429 4.0201 -0.0809439 0.00838509 0.000774624 0.00131618 0.00159573 0.999998 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 4.00003 4.13678e-06 0.0105146 3.99999 8.41757e-06 4.00002 +EDGE_SE3:QUAT 136 1428 4.10083 -0.0751169 0.0250144 0.00206783 0.0068102 -0.00446304 0.999965 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 4.00073 5.15316e-05 0.0545993 3.99981 -0.00011967 4.00067 +EDGE_SE3:QUAT 137 1428 0.00223756 0.124031 -0.00914875 0.00174565 -0.00127881 0.0482335 0.998834 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 4.00002 -7.8765e-06 -0.0112036 3.99999 -0.000277955 3.99073 +EDGE_SE3:QUAT 138 1428 -4.17201 -0.714692 -0.0573493 0.00447406 -0.00477061 0.223944 0.97458 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 4.00047 6.29778e-05 -0.0469567 3.99987 -0.00559299 3.79995 +EDGE_SE3:QUAT 184 1428 6.02265 1.55295 -0.00190506 -6.53141e-05 0.0108655 -0.999911 0.007791 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 4 4.51989e-06 -0.000261206 3.99953 0.0434569 0.000715026 +EDGE_SE3:QUAT 185 1428 1.65751 1.67086 0.0208075 0.00772425 0.00886459 -0.999875 0.0106041 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 3.99975 0.000265072 0.0309047 4.00068 0.0348036 0.000991372 +EDGE_SE3:QUAT 186 1428 -2.7589 1.76625 -0.00404574 0.0136067 0.0106451 -0.999776 0.0122082 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 3.99923 0.000536215 0.054442 4.00259 0.0412763 0.00176297 +EDGE_SE3:QUAT 187 1428 -6.86171 1.86689 -0.038401 0.0141319 0.0113577 -0.999768 0.0115889 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 3.99917 0.000598712 0.0565428 4.00277 0.0441519 0.00182364 +EDGE_SE3:QUAT 1429 1430 4.02752 -0.0784492 0.00161242 -0.000575947 3.56643e-06 0.00171515 0.999998 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 4 -1.27668e-08 4.03853e-05 4 3.80221e-08 3.99999 +EDGE_SE3:QUAT 137 1429 4.02858 0.419684 0.00941058 0.00224115 0.000181311 0.0497969 0.998757 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 3.99998 -3.78484e-07 0.000108077 4 -8.46878e-06 3.99008 +EDGE_SE3:QUAT 138 1429 -0.510352 0.969646 0.00315369 0.00483011 -0.00325539 0.225318 0.974268 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 4.00024 4.98979e-06 -0.0367051 3.99991 -0.00454613 3.79726 +EDGE_SE3:QUAT 139 1429 -4.78095 -0.126832 0.00337432 0.00470016 -0.0028984 0.426252 0.904588 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 4.00028 0.000115422 -0.0382966 3.99994 -0.00932611 3.2736 +EDGE_SE3:QUAT 183 1429 6.04471 1.51414 0.0232899 0.000789623 0.0128617 -0.99984 0.0123672 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 4 5.66803e-05 0.00316039 3.99936 0.051345 0.00127357 +EDGE_SE3:QUAT 184 1429 1.97085 1.57422 0.0075703 0.00138992 0.0102548 -0.999903 0.00937091 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 3.99999 6.4369e-05 0.0055614 3.99962 0.0409044 0.000777357 +EDGE_SE3:QUAT 185 1429 -2.35608 1.67545 -0.0308414 0.00916913 0.00822822 -0.999854 0.0118404 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 3.99965 0.000283952 0.0366861 4.00112 0.032047 0.001154 +EDGE_SE3:QUAT 186 1429 -6.78895 1.74716 -0.0971325 0.0151528 0.0098011 -0.999741 0.0139003 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 3.99905 0.000528108 0.0606288 4.00339 0.0375469 0.0020443 +EDGE_SE3:QUAT 1430 1431 4.16351 -0.0969986 0.0175407 0.00220307 -0.000984547 -0.0024 0.999994 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 4 -8.63798e-06 -0.00781283 4 9.40066e-06 3.99999 +EDGE_SE3:QUAT 138 1430 3.15375 2.66803 0.0407377 0.00435115 -0.00337392 0.226969 0.973886 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 4.00025 1.6836e-05 -0.0363789 3.99992 -0.00449294 3.79427 +EDGE_SE3:QUAT 139 1430 -2.16737 2.89807 0.0371919 0.00412683 -0.00305365 0.427387 0.904054 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 4.00027 0.000121234 -0.036642 3.99995 -0.00876543 3.2697 +EDGE_SE3:QUAT 140 1430 -6.9897 1.37015 0.0569079 0.00123564 0.00275563 0.580985 0.813909 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 3.99999 1.43066e-05 0.00521003 4.00001 -0.000635045 2.64982 +EDGE_SE3:QUAT 182 1430 6.13781 1.54465 0.00366774 0.00119375 0.0117937 -0.999458 0.0307026 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 3.99999 8.84224e-05 0.00478582 3.99949 0.0467682 0.00432374 +EDGE_SE3:QUAT 183 1430 2.01386 1.48261 0.0189217 0.000753715 0.0133824 -0.999809 0.0142522 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 3.99999 6.0406e-05 0.00301716 3.9993 0.0534122 0.00152826 +EDGE_SE3:QUAT 184 1430 -2.0427 1.57177 0.000718448 0.00142923 0.0107405 -0.999881 0.0110021 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 3.99999 7.08803e-05 0.00571915 3.99958 0.0428215 0.00095088 +EDGE_SE3:QUAT 185 1430 -6.38481 1.65768 -0.100682 0.00939127 0.00860193 -0.999826 0.0136004 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 3.99963 0.000301803 0.0375776 4.00117 0.0333856 0.00137157 +EDGE_SE3:QUAT 1431 1432 4.30152 -0.110267 0.0129347 -0.0114672 0.000760951 -0.027107 0.999566 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 3.99948 -6.44118e-06 0.00235176 4 -1.50298e-05 3.99706 +EDGE_SE3:QUAT 139 1431 0.540214 6.03912 0.0926914 0.00641468 -0.00292981 0.425287 0.905031 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 4.00037 0.000128147 -0.046171 3.9999 -0.0115809 3.27705 +EDGE_SE3:QUAT 181 1431 5.95726 1.64584 0.00453604 0.00196855 0.0060191 -0.99786 0.0650828 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 3.99997 5.6697e-05 0.00793773 3.99996 0.0228016 0.0170895 +EDGE_SE3:QUAT 182 1431 2.01216 1.37988 0.0132621 0.000167234 0.00984406 -0.999561 0.0279607 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 4 2.80819e-05 0.000671749 3.99962 0.0392601 0.00351299 +EDGE_SE3:QUAT 183 1431 -2.13677 1.46261 0.0327875 -0.000127972 0.011448 -0.999867 0.0116004 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 4 6.30386e-06 -0.000511809 3.99948 0.0457856 0.00106256 +EDGE_SE3:QUAT 184 1431 -6.19262 1.58612 0.00849458 0.000468012 0.00869649 -0.99993 0.00805561 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 4 2.10909e-05 0.00187252 3.9997 0.0347489 0.000562362 +EDGE_SE3:QUAT 1432 1433 4.33261 -0.372593 0.0210474 0.00250376 -0.00649112 -0.0943623 0.995514 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 4.00056 -0.0001452 -0.048424 3.99987 0.00223235 3.96497 +EDGE_SE3:QUAT 180 1432 5.48235 2.13869 0.0910964 0.013466 0.0194374 -0.983085 0.181616 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 3.99863 0.00024177 0.05738 4.00364 0.0525615 0.133524 +EDGE_SE3:QUAT 181 1432 1.69636 1.19885 -0.00383156 0.00187261 0.0176552 -0.999113 0.0381708 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 3.99996 0.000220449 0.00751951 3.99888 0.0697848 0.00706181 +EDGE_SE3:QUAT 182 1432 -2.28124 1.25856 0.0236452 0.000611785 0.0215215 -0.999768 0.000944711 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 4 5.61081e-05 0.00244892 3.99815 0.0860613 0.00185756 +EDGE_SE3:QUAT 183 1432 -6.42468 1.47078 0.0489396 -0.000285684 -0.0231676 0.999614 0.0152982 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 4 -3.92252e-05 0.00114187 3.99785 0.0926261 0.00308302 +EDGE_SE3:QUAT 1433 1434 4.12804 -0.743362 -0.00384929 0.00266931 0.00177148 -0.171342 0.985206 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 4.00006 6.56799e-06 0.0189336 3.99998 -0.00176026 3.88266 +EDGE_SE3:QUAT 179 1433 5.17271 1.85338 0.00899976 0.00364084 0.00962547 -0.970579 0.240565 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 3.99979 8.24253e-05 0.0168433 4.00033 0.0264483 0.231756 +EDGE_SE3:QUAT 180 1433 1.30933 0.95852 -0.0155773 0.00556092 0.016769 -0.995967 0.0879674 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 3.99972 0.000453995 0.0225996 3.99982 0.0619084 0.0320486 +EDGE_SE3:QUAT 181 1433 -2.6383 1.25332 0.0143026 0.00623939 -0.0149092 0.998273 0.0564717 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 3.99975 -0.000399857 -0.0251048 4 0.0563624 0.0137112 +EDGE_SE3:QUAT 182 1433 -6.5989 1.63779 0.0654299 0.00801873 -0.0187835 0.995438 0.0932012 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 3.9995 -0.000631388 -0.0326226 4.00035 0.0676065 0.0361688 +EDGE_SE3:QUAT 1434 1435 4.13565 -0.772161 -0.0162739 -0.00621964 0.00505451 -0.178114 0.983977 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 4 -0.000119508 0.0255128 3.99998 -0.00182143 3.87326 +EDGE_SE3:QUAT 178 1434 5.14105 1.36633 -0.00851536 0.000245552 0.00101028 -0.97705 0.213007 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 4 1.41262e-06 0.00112486 4 0.00319064 0.181491 +EDGE_SE3:QUAT 179 1434 1.18276 0.589263 -0.0259518 0.0046232 0.0080111 -0.997438 0.0709334 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 3.99987 0.000135871 0.0186557 4.00022 0.0290352 0.0204256 +EDGE_SE3:QUAT 180 1434 -2.87618 0.946524 -0.0514114 -0.00500902 -0.0151616 0.996333 0.0840585 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 3.99998 0.000169851 0.0201807 3.99922 0.0629186 0.0293622 +EDGE_SE3:QUAT 181 1434 -6.64306 2.44371 0.0936685 0.00676066 -0.0109049 0.97396 0.226356 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 3.99959 -7.25369e-06 -0.0300485 4.00106 0.026528 0.205383 +EDGE_SE3:QUAT 1435 1436 3.9336 -0.713284 -0.0114789 0.00479909 0.00703954 -0.161109 0.9869 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 4.00091 -7.5779e-05 0.0632686 3.99976 -0.00528174 3.89718 +EDGE_SE3:QUAT 177 1435 5.02353 0.98892 -0.0103554 0.00075875 0.0065966 -0.986981 0.160699 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 3.99997 5.93585e-05 0.00336963 3.99991 0.0237481 0.103446 +EDGE_SE3:QUAT 178 1435 1.0526 0.318689 -0.02645 0.00380273 0.00819723 -0.999336 0.0353055 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 3.99992 0.000128868 0.0152435 4.00002 0.031616 0.0052943 +EDGE_SE3:QUAT 179 1435 -3.00546 0.765442 -0.071334 -0.00794681 -0.0152257 0.994019 0.10785 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 3.99993 0.000365257 0.0321954 3.99952 0.0659192 0.0478858 +EDGE_SE3:QUAT 180 1435 -6.81273 2.4116 -0.0671926 -0.0078301 -0.0214463 0.96531 0.260105 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 3.99994 -0.000344515 0.0313144 3.99804 0.0867867 0.272889 +EDGE_SE3:QUAT 1436 1437 4.14484 -0.65144 -0.0385551 0.00435543 0.0138166 -0.121242 0.992517 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 4.0032 -0.000338331 0.114461 3.99921 -0.00701047 3.94447 +EDGE_SE3:QUAT 176 1436 5.2606 0.972978 -0.0483692 -0.00979812 0.00651154 -0.993777 0.110763 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 3.99975 -0.000419976 -0.0398412 4.001 0.0338405 0.0497633 +EDGE_SE3:QUAT 177 1436 1.0777 0.398697 -0.0283892 -0.00761031 -0.00325506 0.999966 0.000551507 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 3.99977 9.9886e-05 0.0304409 4.00088 0.0130579 0.000275505 +EDGE_SE3:QUAT 178 1436 -2.90473 0.776164 -0.0558833 -0.00975159 -0.00424021 0.99197 0.126028 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 3.99974 0.000386722 0.0398597 4.00114 0.0259788 0.0641057 +EDGE_SE3:QUAT 179 1436 -6.68857 2.29225 -0.094984 -0.0116776 -0.0105128 0.963609 0.266852 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 4 0.000570562 0.0498473 4.00016 0.0579208 0.28637 +EDGE_SE3:QUAT 1437 1438 4.00433 -0.276245 0.0167635 0.00478511 -0.00649821 -0.0351906 0.999348 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 4.00053 -0.000151155 -0.0498749 3.99985 0.000870057 3.99567 +EDGE_SE3:QUAT 175 1437 5.3589 0.89062 0.0482317 0.00898123 0.00949735 -0.998662 0.0500265 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 3.99961 0.000267226 0.0360703 4.00113 0.0341818 0.0106296 +EDGE_SE3:QUAT 176 1437 1.07651 0.702044 -0.00017502 -0.00364983 -0.00235937 0.999934 0.0105973 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 3.99995 3.7305e-05 0.0146018 4.00019 0.0097449 0.000526265 +EDGE_SE3:QUAT 177 1437 -3.04786 1.07302 -0.122678 -0.0207663 0.000430909 0.992353 0.121669 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 3.99846 0.00119991 0.084888 4.00665 0.0183087 0.0611248 +EDGE_SE3:QUAT 178 1437 -6.73942 2.42982 -0.160228 -0.0224959 0.000786443 0.969051 0.245831 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 3.99885 0.00265908 0.0978877 4.00688 0.039015 0.244629 +EDGE_SE3:QUAT 1438 1439 4.16382 -0.149904 0.0146043 -0.000684359 0.000186481 -0.0105613 0.999944 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 4 -4.78829e-07 0.00140487 4 -7.26602e-06 3.99955 +EDGE_SE3:QUAT 174 1438 5.34788 0.6966 0.0195124 0.00342181 0.00539578 -0.999726 0.0225128 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 3.99995 7.21753e-05 0.0136986 4.00009 0.020941 0.00218393 +EDGE_SE3:QUAT 175 1438 1.34882 0.766879 -0.00675729 0.00219314 0.00486823 -0.999874 0.0149415 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 3.99998 4.36615e-05 0.00877591 3.99999 0.0192003 0.00100444 +EDGE_SE3:QUAT 176 1438 -2.91083 1.06939 -0.0179821 0.00303006 0.0016771 0.998913 0.0464789 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 3.99997 2.87938e-05 -0.0121581 4.00012 -0.00779681 0.00869342 +EDGE_SE3:QUAT 177 1438 -6.86373 2.33066 -0.271633 -0.0136963 0.00344272 0.987444 0.157336 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 3.99928 0.000547587 0.056884 4.00309 0.00389614 0.0998517 +EDGE_SE3:QUAT 1439 1440 4.20962 -0.119147 0.0245 0.00246211 -0.00236417 -0.00288601 0.99999 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 4.00006 -2.3529e-05 -0.0188281 3.99998 2.74573e-05 4.00006 +EDGE_SE3:QUAT 173 1439 5.43584 0.584331 0.0325209 0.0058462 0.00851084 -0.999837 0.0148053 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 3.99985 0.000194832 0.0233947 4.00029 0.0333378 0.00129153 +EDGE_SE3:QUAT 174 1439 1.16465 0.649832 0.0047554 0.0036766 0.00606308 -0.999909 0.0114883 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 3.99994 8.86397e-05 0.0147101 4.00008 0.0239079 0.000724941 +EDGE_SE3:QUAT 175 1439 -2.78041 0.80614 -0.0149123 0.00257798 0.00561769 -0.999972 0.00425582 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 3.99997 5.83098e-05 0.0103126 3.99998 0.0223824 0.000224281 +EDGE_SE3:QUAT 176 1439 -7.01551 1.60171 0.0261836 0.00265632 0.00125994 0.998375 0.0569017 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 3.99998 2.15641e-05 -0.0106749 4.0001 -0.00620453 0.0129894 +EDGE_SE3:QUAT 1440 1441 4.17023 -0.0698099 0.0214255 -0.0044941 6.42649e-05 0.00259952 0.999987 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 3.99992 -1.57482e-06 0.000654286 4 9.1049e-07 3.99997 +EDGE_SE3:QUAT 172 1440 5.58834 0.480388 0.0132969 0.00275815 0.00363862 -0.999915 0.012241 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 3.99997 3.9112e-05 0.0110353 4.00007 0.0142795 0.000680799 +EDGE_SE3:QUAT 173 1440 1.25824 0.568951 0.000400522 0.00344604 0.00627766 -0.999904 0.0118327 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 3.99995 8.6704e-05 0.0137879 4.00004 0.0247769 0.000761075 +EDGE_SE3:QUAT 174 1440 -3.01194 0.666914 -0.00811227 0.00125306 0.00411053 -0.999953 0.00868142 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 3.99999 2.14239e-05 0.00501294 3.99996 0.016352 0.000374604 +EDGE_SE3:QUAT 175 1440 -6.97634 0.865802 -0.0105764 -3.56729e-05 0.00324971 -0.999994 0.000826215 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 4 -3.93913e-07 -0.000142694 3.99996 0.012999 4.49794e-05 +EDGE_SE3:QUAT 1441 1442 4.19675 -0.0711301 0.0278722 -0.00206169 -0.00371842 0.00149092 0.99999 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 4.0002 3.11136e-05 -0.0297116 3.99994 -2.28256e-05 4.00021 +EDGE_SE3:QUAT 171 1441 5.70192 0.335949 0.0298122 0.00795232 0.00510744 -0.999888 0.0116057 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 3.99974 0.000147059 0.0318158 4.00093 0.0196913 0.0008888 +EDGE_SE3:QUAT 172 1441 1.39609 0.440541 0.00520628 0.00254973 0.00874106 -0.999857 0.0142635 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 3.99997 9.53413e-05 0.0102034 3.99981 0.0346556 0.00114015 +EDGE_SE3:QUAT 173 1441 -2.93581 0.542306 -0.00944413 0.00345067 0.010918 -0.999834 0.0141491 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 3.99994 0.000159647 0.0138095 3.99974 0.0432602 0.00131645 +EDGE_SE3:QUAT 174 1441 -7.15249 0.665206 0.00335757 0.00125955 0.00852333 -0.999904 0.0108372 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 3.99999 4.8739e-05 0.00503978 3.99974 0.0339732 0.000764728 +EDGE_SE3:QUAT 1442 1443 4.12068 -0.0872214 0.0103695 0.000989156 0.010783 0.000909253 0.999941 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 4.00186 4.52647e-05 0.0862881 3.99954 4.20364e-05 4.00186 +EDGE_SE3:QUAT 170 1442 5.92389 0.18767 -0.0559445 -0.00560593 0.00618377 -0.999926 0.0088913 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 3.99988 -0.000142523 -0.0224274 4.00034 0.0251327 0.000599883 +EDGE_SE3:QUAT 171 1442 1.51224 0.312323 -0.0048428 0.00432479 0.00686349 -0.999877 0.0134155 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 3.99992 0.000117445 0.0173049 4.00013 0.0269798 0.000976785 +EDGE_SE3:QUAT 172 1442 -2.7862 0.400535 0.012852 -0.00105432 0.0105801 -0.999819 0.0157804 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 4 -3.07377e-05 -0.00421908 3.99956 0.042425 0.00145066 +EDGE_SE3:QUAT 173 1442 -7.11012 0.502864 -0.011195 -7.33431e-05 0.0129723 -0.999796 0.0155061 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 4 1.70587e-05 -0.000292895 3.99933 0.0518626 0.00163448 +EDGE_SE3:QUAT 1443 1444 4.16671 -0.0943611 -0.000377939 0.001178 0.00426674 0.000638207 0.99999 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 4.00029 2.03816e-05 0.034127 3.99993 1.14057e-05 4.00029 +EDGE_SE3:QUAT 169 1443 6.06885 0.0572136 0.00209941 -0.00143753 0.00772129 -0.999958 0.00480034 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 3.99999 -4.23268e-05 -0.00575082 3.99979 0.030938 0.000339748 +EDGE_SE3:QUAT 170 1443 1.79847 0.200836 0.0015434 0.00513821 0.0053189 -0.99992 0.0102482 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 3.99989 0.000104996 0.0205566 4.00032 0.0208516 0.000634456 +EDGE_SE3:QUAT 171 1443 -2.61195 0.287729 -0.0292732 0.0149149 0.00616409 -0.999772 0.0139734 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 3.99909 0.000297332 0.0596727 4.00347 0.023005 0.00180378 +EDGE_SE3:QUAT 172 1443 -6.90993 0.358279 0.036762 0.00960366 0.0100145 -0.999768 0.0164753 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 3.99961 0.000360228 0.0384338 4.00115 0.0387839 0.00183115 +EDGE_SE3:QUAT 1444 1445 4.2536 -0.104796 0.0126211 0.00346651 -0.00492343 0.00150115 0.999981 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 4.00034 -6.75586e-05 -0.0394524 3.9999 -2.7613e-05 4.00038 +EDGE_SE3:QUAT 168 1444 6.11793 -0.0595446 0.0443158 -0.00722654 -0.00980326 0.999921 0.00295538 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 3.99979 0.000284917 0.02891 4.00044 0.0393924 0.000631757 +EDGE_SE3:QUAT 169 1444 1.93359 0.105268 0.0148833 0.00278836 0.00661531 -0.999957 0.0059248 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 3.99997 7.47124e-05 0.0111547 3.99995 0.0263274 0.000344809 +EDGE_SE3:QUAT 170 1444 -2.34256 0.202331 -0.042073 0.00934909 0.00432329 -0.999892 0.0104353 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 3.99964 0.000141254 0.0374017 4.00134 0.0165159 0.000853539 +EDGE_SE3:QUAT 171 1444 -6.73261 0.275983 -0.153626 0.0192833 0.00515748 -0.999687 0.015102 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 3.99849 0.000266696 0.0771466 4.00592 0.0183253 0.00248489 +EDGE_SE3:QUAT 1445 1446 4.32139 -0.109167 0.0208526 0.00298709 -0.00193403 0.00196688 0.999992 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 4.00002 -2.30717e-05 -0.0155426 3.99998 -1.50388e-05 4.00004 +EDGE_SE3:QUAT 167 1445 6.1726 -0.122407 0.0309354 -0.00518632 -0.00952992 0.999876 0.0113717 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 3.9999 0.000196406 0.0207519 4.00004 0.0385828 0.000997122 +EDGE_SE3:QUAT 168 1445 1.85409 0.0755979 0.00088765 -0.00238783 -0.00622432 0.999977 0.00133648 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 3.99998 5.92175e-05 0.00955187 3.99994 0.024923 0.000185244 +EDGE_SE3:QUAT 169 1445 -2.33374 0.165706 0.00911456 -0.00199829 0.00306991 -0.999968 0.00717012 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 3.99998 -2.46656e-05 -0.00799387 4.00002 0.0123929 0.000260016 +EDGE_SE3:QUAT 170 1445 -6.59575 0.237176 -0.107803 0.00466501 0.000397775 -0.99992 0.0117425 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 3.99991 1.29108e-06 0.0186637 4.00035 0.0011525 0.000638978 +EDGE_SE3:QUAT 1446 1447 4.30953 -0.0868236 0.0208533 0.00107327 -0.00126262 0.00277802 0.999995 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 4.00002 -5.33931e-06 -0.0101367 3.99999 -1.40554e-05 3.99999 +EDGE_SE3:QUAT 166 1446 5.93396 -0.0783229 0.0210334 -0.00467739 -0.0070968 0.999791 0.0185969 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 3.99992 0.000134344 0.0187202 4.00012 0.0290608 0.00168222 +EDGE_SE3:QUAT 167 1446 1.84228 0.0778119 0.00692743 -0.00334198 -0.00635928 0.999928 0.00965496 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 3.99996 8.43543e-05 0.0133705 4.00001 0.0256903 0.000582579 +EDGE_SE3:QUAT 168 1446 -2.46146 0.172219 0.0127351 0.000427024 0.00289925 -0.999996 0.000452567 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 4 4.98057e-06 0.00170812 3.99997 0.0115954 3.51624e-05 +EDGE_SE3:QUAT 169 1446 -6.63988 0.200725 0.0479644 -0.00370733 -0.000220845 -0.999952 0.00901684 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 3.99994 3.00791e-07 -0.014831 4.00022 -0.000615835 0.000380303 +EDGE_SE3:QUAT 1447 1448 4.14426 -0.0735955 0.0225615 0.000620684 0.000383484 0.00514799 0.999986 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 4 9.53992e-07 0.00302941 4 7.76684e-06 3.9999 +EDGE_SE3:QUAT 165 1447 5.67576 -0.00723464 0.0113765 -0.00357221 -0.00723136 0.999598 0.0271724 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 3.99996 9.90926e-05 0.0143046 3.99996 0.029649 0.00322446 +EDGE_SE3:QUAT 166 1447 1.64768 0.174153 0.00224904 -0.00345826 -0.00595502 0.999854 0.0156351 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 3.99996 8.21154e-05 0.0138386 4.00003 0.024239 0.00117263 +EDGE_SE3:QUAT 167 1447 -2.41748 0.250566 0.00113623 -0.00221222 -0.00567512 0.99996 0.00656878 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 3.99998 4.92631e-05 0.00884985 3.99995 0.0228145 0.000322308 +EDGE_SE3:QUAT 168 1447 -6.74104 0.262814 0.0252457 -0.000974906 0.00219819 -0.999991 0.00337918 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 4 -8.51705e-06 -0.00389972 4 0.0088189 6.89209e-05 +EDGE_SE3:QUAT 1448 1449 4.29777 -0.0313945 0.0241531 -0.00898123 -0.00408337 0.00558753 0.999936 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 3.99993 0.000145261 -0.0320611 3.99994 -9.25119e-05 4.00013 +EDGE_SE3:QUAT 164 1448 6.03043 0.300859 0.0326816 -0.00593953 0.000928183 0.999835 0.0171401 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 3.99986 -7.57048e-06 0.0237682 4.00057 -0.00289633 0.00131851 +EDGE_SE3:QUAT 165 1448 1.53041 0.281473 0.00671943 -0.0039611 -0.0068448 0.999733 0.0217125 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 3.99995 0.000107693 0.0158561 4.00004 0.0280362 0.00214521 +EDGE_SE3:QUAT 166 1448 -2.50718 0.380274 -0.00119574 -0.00406967 -0.00561512 0.999921 0.0104732 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 3.99994 9.27823e-05 0.016282 4.00013 0.0227969 0.000634965 +EDGE_SE3:QUAT 167 1448 -6.55681 0.373744 0.00138216 -0.00274055 -0.00514377 0.999982 0.00138723 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 3.99997 5.63446e-05 0.0109626 4.00001 0.020606 0.000143892 +EDGE_SE3:QUAT 1449 1450 4.08842 -0.102209 0.0165987 -0.00142759 -0.0038176 -0.0172194 0.999843 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 4.00023 1.59613e-05 -0.0308236 3.99994 0.000265725 3.99905 +EDGE_SE3:QUAT 163 1449 5.95926 0.957562 0.0416588 0.00770508 0.00591402 -0.998441 0.05496 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 3.99973 0.000110924 0.0309671 4.00092 0.0201067 0.0124243 +EDGE_SE3:QUAT 164 1449 1.75272 0.483621 0.00263895 -0.001953 -0.00826459 0.9999 0.0113153 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 3.99999 5.92811e-05 0.00781417 3.99978 0.033224 0.000803416 +EDGE_SE3:QUAT 165 1449 -2.74986 0.513148 -0.00299904 -0.000325844 -0.0161745 0.999733 0.0164825 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 4 -1.34288e-05 0.00130328 3.99895 0.0646884 0.00213382 +EDGE_SE3:QUAT 166 1449 -6.76651 0.497141 -0.0162982 -0.000193326 -0.0152447 0.999871 0.00499394 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 4 2.50039e-06 0.000773444 3.99907 0.0609758 0.00102966 +EDGE_SE3:QUAT 1450 1451 4.23803 -0.356542 0.0107587 -0.00664041 0.0205962 -0.0901007 0.995698 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 4.00588 -0.00135388 0.155813 3.9986 -0.00697283 3.97358 +EDGE_SE3:QUAT 162 1450 5.85281 1.38582 -0.121321 -0.0141622 -0.00137369 -0.989544 0.14353 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 3.99929 -0.000610744 -0.0584017 4.00314 0.0107294 0.0833013 +EDGE_SE3:QUAT 163 1450 1.89469 0.621915 -0.012099 0.00370134 0.00783072 -0.999246 0.0378416 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 3.99993 0.000119334 0.0148416 4.00003 0.0300937 0.00600984 +EDGE_SE3:QUAT 164 1450 -2.32931 0.705999 0.00671164 0.00178971 -0.00991316 0.999533 0.0288363 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 3.99998 -9.0386e-05 -0.00717083 3.99969 0.0391568 0.00372267 +EDGE_SE3:QUAT 165 1450 -6.83396 0.770911 0.0174307 0.00384414 -0.0181788 0.99927 0.0333696 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 3.9999 -0.000350428 -0.015416 3.99904 0.0714843 0.00579284 +EDGE_SE3:QUAT 1451 1452 4.21783 -0.759888 -0.00450217 0.00376157 -0.000143499 -0.177009 0.984202 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 3.99995 1.60555e-05 0.00672859 3.99999 -0.000832705 3.87468 +EDGE_SE3:QUAT 161 1451 5.78719 1.53807 0.0279111 0.0032059 0.0108979 -0.979687 0.200209 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 3.99981 0.000164474 0.0142716 4.00013 0.0343602 0.160702 +EDGE_SE3:QUAT 162 1451 1.69318 0.514427 0.0145732 0.00536525 0.0067531 -0.99855 0.0531312 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 3.99986 0.000121079 0.0215604 4.00037 0.0245518 0.0115594 +EDGE_SE3:QUAT 163 1451 -2.35356 0.632682 -0.0284455 -0.0233387 -0.0152914 0.99822 0.0527097 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 3.99816 0.00196235 0.0937601 4.00683 0.0707451 0.0145681 +EDGE_SE3:QUAT 164 1451 -6.53581 1.2863 0.0417269 -0.0178507 -0.0160347 0.992609 0.118959 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 3.99932 0.00154919 0.0727337 4.00238 0.0787197 0.0595074 +EDGE_SE3:QUAT 1452 1453 4.00718 -0.778389 0.00685924 0.00382277 0.00513423 -0.184933 0.98273 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 4.0005 -5.43601e-05 0.0472804 3.99987 -0.00456495 3.86376 +EDGE_SE3:QUAT 160 1452 5.37982 1.69868 -0.00801329 -0.00093576 0.0098557 -0.979814 0.199666 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 3.99996 0.000109598 -0.00333161 3.99966 0.0369825 0.159826 +EDGE_SE3:QUAT 161 1452 1.60871 0.567927 -0.00494286 0.00178623 0.00743207 -0.999699 0.023298 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 3.99998 6.11258e-05 0.00715212 3.99985 0.0293551 0.00239954 +EDGE_SE3:QUAT 162 1452 -2.56392 0.821443 -0.0203428 -0.00425882 -0.00341778 0.992224 0.124342 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 3.99996 8.58342e-05 0.0173737 4.00015 0.0173177 0.0619959 +EDGE_SE3:QUAT 163 1452 -6.4501 1.86464 -0.195568 -0.0198244 -0.0153532 0.973197 0.2286 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 3.99974 0.00187545 0.0838762 4.00174 0.0879862 0.212856 +EDGE_SE3:QUAT 1453 1454 4.11783 -0.853563 -0.00119101 2.44321e-05 0.000951827 -0.186271 0.982498 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 4.00001 -3.75129e-06 0.00727514 4 -0.00066665 3.86123 +EDGE_SE3:QUAT 159 1453 5.25302 2.27599 0.0147045 0.00133923 0.0101299 -0.971104 0.23844 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 3.99987 0.00014538 0.00689339 3.99993 0.0324682 0.227713 +EDGE_SE3:QUAT 160 1453 1.39743 0.838874 0.0040033 0.00306498 0.00692393 -0.999863 0.0147422 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 3.99996 8.69222e-05 0.0122649 3.99997 0.0273202 0.00109358 +EDGE_SE3:QUAT 161 1453 -2.42678 1.18358 -0.00862531 -0.00593804 -0.00399978 0.986771 0.161965 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 3.99994 0.000168417 0.0245338 4.00029 0.0224547 0.105212 +EDGE_SE3:QUAT 162 1453 -6.24803 2.57151 -0.0468228 -0.00836526 0.000133226 0.952115 0.305626 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 3.99991 0.00042953 0.0378453 4.00084 0.0181375 0.374095 +EDGE_SE3:QUAT 1454 1455 4.0696 -0.641098 0.0236781 0.00716441 -0.00628116 -0.11344 0.993499 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 4.00018 -0.000204443 -0.0396122 3.99992 0.00204931 3.94891 +EDGE_SE3:QUAT 158 1454 4.58061 2.34126 0.0410824 0.00693102 0.011724 -0.959118 0.28268 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 3.99953 -0.000133422 0.0329563 4.00131 0.0233815 0.320099 +EDGE_SE3:QUAT 159 1454 1.21955 1.10884 0.00541902 0.000433759 0.0102427 -0.99851 0.0535928 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 3.99999 6.11115e-05 0.00175581 3.9996 0.0404897 0.0119006 +EDGE_SE3:QUAT 160 1454 -2.73876 1.57348 -0.00900394 -0.00297044 -0.00718411 0.98512 0.171693 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 4 1.90853e-05 0.0121051 3.9998 0.0305997 0.118192 +EDGE_SE3:QUAT 161 1454 -6.04299 3.27588 -0.0404674 -0.00610072 -0.00459108 0.939359 0.34285 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 4.00002 0.000139915 0.0268352 4.00002 0.0279629 0.470587 +EDGE_SE3:QUAT 1455 1456 4.2222 -0.235785 0.0240465 9.86771e-05 0.00054445 -0.0270457 0.999634 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 4 2.23349e-08 0.00438284 4 -5.93907e-05 3.99708 +EDGE_SE3:QUAT 157 1455 4.63671 1.8734 -0.00287331 0.00284556 0.00131313 -0.913328 0.407212 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 3.99999 -7.27037e-05 0.0145529 4.00012 -0.00452686 0.663351 +EDGE_SE3:QUAT 158 1455 0.814509 0.677769 -0.00880068 0.0014857 0.00395568 -0.985006 0.172466 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 3.99997 2.27475e-05 0.00636436 4.00003 0.0126698 0.11903 +EDGE_SE3:QUAT 159 1455 -2.90255 1.31877 0.0348415 0.00671931 -0.00296912 0.998165 0.0601011 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 3.99981 -1.47213e-05 -0.027027 4.00074 0.00855231 0.0146502 +EDGE_SE3:QUAT 160 1455 -6.34779 3.54467 0.0195831 0.00557203 -0.00129096 0.959387 0.282035 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 3.99993 0.000182733 -0.0250171 4.00047 -0.00740785 0.318356 +EDGE_SE3:QUAT 1456 1457 4.24721 -0.0952227 0.0105473 -0.000152269 0.000316926 0.000618953 1 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 4 -1.91654e-07 0.00253654 4 7.8475e-07 4 +EDGE_SE3:QUAT 156 1456 6.27449 0.444794 0.005387 -0.000378536 -0.000859419 -0.822822 0.568298 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 4 -4.97331e-06 -0.00331251 4.00001 0.000163636 1.29186 +EDGE_SE3:QUAT 157 1456 1.65724 -1.10927 -0.00807572 0.00346607 0.0015667 -0.923908 0.382595 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 3.99998 -0.00010086 0.0172616 4.00019 -0.00496163 0.585606 +EDGE_SE3:QUAT 158 1456 -3.22943 -0.534512 -0.00462598 0.00201814 0.00399861 -0.989288 0.145907 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 3.99996 2.47031e-05 0.00842561 4.00006 0.0128444 0.0852156 +EDGE_SE3:QUAT 159 1456 -7.05233 2.05686 0.11324 0.00626143 -0.00256071 0.996192 0.0869225 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 3.99983 1.97911e-05 -0.0253408 4.00065 0.00572972 0.0303922 +EDGE_SE3:QUAT 1457 1458 4.11729 -0.0598758 0.0182609 0.000470941 -0.00014419 0.00457837 0.999989 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 4 -2.77367e-07 -0.00117936 4 -2.71924e-06 3.99992 +EDGE_SE3:QUAT 156 1457 4.67479 -3.47966 0.0247515 0.000174899 -0.000717354 -0.822595 0.568627 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 4 4.94734e-07 -0.000107495 4 -0.00137235 1.29335 +EDGE_SE3:QUAT 157 1457 -1.41956 -4.01392 -0.0272337 0.00396599 0.0016138 -0.923782 0.382894 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 3.99998 -0.000130032 0.0196771 4.00024 -0.00615359 0.586549 +EDGE_SE3:QUAT 1458 1459 4.14776 -0.0904354 -0.00878508 0.00189668 0.00905596 0.00343526 0.999951 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 4.0013 7.54352e-05 0.0723886 3.99967 0.000128126 4.00126 +EDGE_SE3:QUAT 1459 1460 4.31429 -0.0918263 -0.0042769 -0.000607753 -0.0015478 0.00254373 0.999995 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 4.00004 3.90118e-06 -0.0123638 3.99999 -1.57524e-05 4.00001 +EDGE_SE3:QUAT 1460 1461 4.37333 -0.0788884 -0.00873544 0.000413866 -0.00104587 0.00146919 0.999998 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 4.00002 -1.69481e-06 -0.00837424 4 -6.14263e-06 4.00001 +EDGE_SE3:QUAT 918 1460 3.36163 -4.01027 -0.0180584 -0.000328158 -0.00459792 0.717313 0.696736 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 3.99998 6.19757e-05 -0.0105852 4.00007 0.00132495 1.94183 +EDGE_SE3:QUAT 919 1460 -0.685487 -3.91142 -0.0253431 -0.000222591 -0.00365462 0.716479 0.697599 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 3.99999 4.10096e-05 -0.00866661 4.00005 0.000917261 1.94662 +EDGE_SE3:QUAT 920 1460 -4.72648 -3.8182 0.215699 0.0185886 0.015233 0.715415 0.698286 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 3.99918 -0.00106379 -0.0635875 3.99862 -0.0542231 1.95329 +EDGE_SE3:QUAT 1461 1462 4.34012 -0.0942681 -0.00302115 -0.0012744 0.00291479 -0.00313658 0.99999 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 4.00013 -1.54566e-05 0.0232706 3.99997 -3.67321e-05 4.0001 +EDGE_SE3:QUAT 917 1461 7.31391 0.283487 -0.0558388 0.00427591 2.84415e-05 0.719033 0.694963 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 4.00007 7.66115e-05 -0.0241023 4 -0.012294 1.93211 +EDGE_SE3:QUAT 918 1461 3.31897 0.362715 0.00327353 0.000919664 -0.00489562 0.71823 0.695788 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 4.00003 0.000147291 -0.0183932 4.00013 -0.00219522 1.93662 +EDGE_SE3:QUAT 919 1461 -0.70904 0.441845 -0.00854569 0.000657658 -0.00425857 0.717705 0.696334 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 4.00002 0.000103527 -0.0152219 4.0001 -0.00151813 1.93962 +EDGE_SE3:QUAT 920 1461 -4.74058 0.530093 0.215581 0.0189576 0.0144043 0.716692 0.696983 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 3.99933 -0.000973256 -0.0681485 3.99861 -0.0554622 1.94618 +EDGE_SE3:QUAT 1382 1461 3.5256 5.12094 0.16128 0.0209596 -0.00579273 -0.4971 0.867421 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 3.99938 0.000744714 0.0741684 3.9992 -0.0301132 3.0127 +EDGE_SE3:QUAT 1383 1461 -3.25558 5.26128 0.0788779 0.0134574 -0.000739464 -0.290677 0.956726 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 3.99961 0.000273004 0.0391142 3.99983 -0.00798511 3.66237 +EDGE_SE3:QUAT 1462 1463 4.01831 -0.0716419 0.0143178 -0.00555429 -0.00148365 0.000346347 0.999983 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 3.99991 3.28941e-05 -0.0118456 3.99999 -2.34255e-06 4.00003 +EDGE_SE3:QUAT 918 1462 3.29162 4.69366 0.0370012 -0.00267852 -0.00386749 0.716206 0.697874 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 3.99995 -3.73145e-05 0.00463192 3.99997 0.00795827 1.94817 +EDGE_SE3:QUAT 919 1462 -0.73687 4.75807 0.0202396 -0.00210556 -0.00301603 0.71534 0.698767 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 3.99997 -2.29192e-05 0.00367595 3.99998 0.00622544 1.95314 +EDGE_SE3:QUAT 920 1462 -4.76373 4.87735 0.245995 0.0160687 0.0158887 0.714289 0.699486 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 3.99903 -0.00101881 -0.0473359 3.99893 -0.0468499 1.95923 +EDGE_SE3:QUAT 1382 1462 5.63992 1.30913 0.106199 0.0210131 -0.00224818 -0.499695 0.865944 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 4.00026 0.000344726 0.0933654 3.99913 -0.0340851 3.00324 +EDGE_SE3:QUAT 1383 1462 0.310027 2.74175 0.0453116 0.0128239 0.00243056 -0.293669 0.955818 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 4.0002 0.000174291 0.0595823 3.99971 -0.0108106 3.65589 +EDGE_SE3:QUAT 1384 1462 -4.76831 1.99701 0.0562679 0.0104281 0.0046217 -0.113086 0.99352 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 4.00019 0.000190051 0.0502982 3.99982 -0.00308924 3.94947 +EDGE_SE3:QUAT 1463 1464 4.46728 -0.104763 0.0345597 0.00505653 -0.00497299 0.00338114 0.999969 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 4.0003 -9.92807e-05 -0.0399904 3.9999 -6.47131e-05 4.00035 +EDGE_SE3:QUAT 1383 1463 3.58216 0.42705 0.00744167 0.00706628 0.00265065 -0.293354 0.955974 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 4.00023 1.22657e-05 0.0419784 3.99988 -0.00722347 3.65621 +EDGE_SE3:QUAT 1384 1463 -0.890165 1.02097 0.017039 0.00469925 0.00363106 -0.112716 0.993609 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 4.00021 3.85105e-05 0.0348005 3.99992 -0.00206852 3.94948 +EDGE_SE3:QUAT 1385 1463 -5.23809 0.468809 0.0405158 -0.00494222 0.00793237 0.00388558 0.999949 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 4.00092 -0.000151798 0.0636998 3.99975 0.000116477 4.00095 +EDGE_SE3:QUAT 1464 1465 4.14569 -0.0654485 0.0212429 -0.000168478 -0.00210075 0.00449228 0.999988 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 4.00007 1.89013e-06 -0.0167967 3.99998 -3.77401e-05 3.99999 +EDGE_SE3:QUAT 1384 1464 3.43129 -0.0812878 0.0104045 0.00902996 -0.00187857 -0.109496 0.993944 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 3.99967 3.53718e-06 -0.00298771 4 -5.78482e-05 3.95204 +EDGE_SE3:QUAT 1385 1464 -0.792823 0.406429 0.00990173 0.00012062 0.00300925 0.00677899 0.999972 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 4.00014 2.92347e-06 0.0240633 3.99996 8.15835e-05 3.99996 +EDGE_SE3:QUAT 1386 1464 -5.01712 0.394402 -0.00757751 -0.000679233 0.00208979 0.0312614 0.999509 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 4.00007 -2.43354e-06 0.0169487 3.99998 0.000266059 3.99616 +EDGE_SE3:QUAT 1465 1466 4.29887 -0.0637197 0.0155035 -0.000486185 0.00283325 0.00236219 0.999993 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 4.00013 -5.05943e-06 0.0226802 3.99997 2.67013e-05 4.00011 +EDGE_SE3:QUAT 1385 1465 3.35834 0.390558 0.00204623 0.00022986 0.000822166 0.0115337 0.999933 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 4.00001 9.36524e-07 0.00654422 4 3.768e-05 3.99948 +EDGE_SE3:QUAT 1386 1465 -0.870077 0.588001 0.000244507 -0.000409886 6.28726e-05 0.0355015 0.99937 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 4 -1.45091e-07 0.000676502 4 1.30359e-05 3.99496 +EDGE_SE3:QUAT 1387 1465 -4.96614 0.780007 -0.0316415 -0.000215348 -0.00255044 0.019881 0.999799 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 4.0001 5.27743e-06 -0.0203405 3.99997 -0.000202032 3.99852 +EDGE_SE3:QUAT 1466 1467 4.02354 -0.155753 0.0110258 -0.000359939 -0.0019256 -0.0293576 0.999567 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 4.00006 1.56188e-07 -0.0155118 3.99998 0.000228194 3.99661 +EDGE_SE3:QUAT 1386 1466 3.42929 0.830536 0.0150358 -0.000924628 0.00274341 0.0381007 0.99927 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 4.00012 -3.30707e-06 0.0223224 3.99997 0.000427494 3.99432 +EDGE_SE3:QUAT 1387 1466 -0.639148 0.884406 0.00655828 -0.000690756 0.000159963 0.022313 0.999751 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 4 -5.09753e-07 0.00146364 4 1.70128e-05 3.99801 +EDGE_SE3:QUAT 1388 1466 -4.676 1.01208 -0.0218591 -9.75695e-06 0.000275526 0.0131291 0.999914 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 4 1.31794e-08 0.00220517 4 1.44781e-05 3.99931 +EDGE_SE3:QUAT 1467 1468 4.27584 -0.339327 -0.0185309 -0.00321788 0.0114379 -0.0819032 0.996569 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 4.00187 -0.000379321 0.0874691 3.99955 -0.00354033 3.97508 +EDGE_SE3:QUAT 1387 1467 3.40871 0.909236 0.00929212 -0.00116284 -0.00198201 -0.00733335 0.99997 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 4.00006 8.59959e-06 -0.0159573 3.99998 5.85253e-05 3.99985 +EDGE_SE3:QUAT 1388 1467 -0.635145 0.95988 -0.00693206 -8.27066e-05 -0.0019545 -0.0158534 0.999872 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 4.00006 -8.07921e-07 -0.0156461 3.99998 0.000124045 3.99906 +EDGE_SE3:QUAT 1389 1467 -4.90055 1.02835 -0.0748854 0.000126563 -0.0106126 -0.0127229 0.999863 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 4.0018 -3.97646e-05 -0.0848941 3.99955 0.000540946 4.00115 +EDGE_SE3:QUAT 1468 1469 4.08031 -0.685818 0.0012634 -0.00193414 0.00545399 -0.185884 0.982555 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 4.00033 -0.000139368 0.0371774 3.99994 -0.00325189 3.86213 +EDGE_SE3:QUAT 1388 1468 3.61417 0.496346 -0.00774407 -0.00279489 0.00954295 -0.0979112 0.995145 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 4.00126 -0.00029506 0.0720042 3.9997 -0.00346215 3.96295 +EDGE_SE3:QUAT 1389 1468 -0.640783 0.590367 3.32495e-05 -0.00185985 0.000625102 -0.0946406 0.99551 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 3.99999 -2.34914e-06 0.00283417 4 -9.97391e-05 3.96417 +EDGE_SE3:QUAT 1390 1468 -4.81844 0.692284 -0.0457763 0.00288588 -0.00372728 -0.0980635 0.995169 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 4.00014 -6.23454e-05 -0.0260154 3.99996 0.00121394 3.9617 +EDGE_SE3:QUAT 1469 1470 3.89518 -0.875517 0.000446126 -0.0024938 -0.000245116 -0.215815 0.976431 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 3.99999 8.9539e-06 -0.0080834 3.99999 0.00109917 3.81371 +EDGE_SE3:QUAT 109 1469 -2.29603 -6.62736 0.0412932 -0.00633769 0.00262594 0.605137 0.796092 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 4.00035 0.000293403 0.0453927 4.00002 0.016484 2.53575 +EDGE_SE3:QUAT 1389 1469 3.24833 -0.84924 0.0056109 -0.00333438 0.00612318 -0.278165 0.960508 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 4.00021 -0.000187616 0.0328554 3.99998 -0.00377903 3.69075 +EDGE_SE3:QUAT 1390 1469 -0.947926 -0.775083 -0.0244532 0.00216426 0.00265353 -0.281321 0.959608 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 4.00015 -3.77066e-05 0.0256804 3.99997 -0.00382825 3.6836 +EDGE_SE3:QUAT 1391 1469 -5.18866 -0.630151 -0.0287087 -0.00191143 0.00215308 -0.288425 0.957498 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 4 -1.83052e-05 0.00887174 4 -0.000852795 3.66726 +EDGE_SE3:QUAT 1470 1471 4.27517 -0.833613 0.00253522 0.00576428 0.000611783 -0.158333 0.987369 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 3.99992 4.46219e-05 0.0154802 3.99998 -0.00150913 3.89978 +EDGE_SE3:QUAT 108 1470 5.02445 -2.15042 -0.0160686 -0.00650507 -7.3767e-05 0.609646 0.792647 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 4.00014 7.43929e-05 0.0355062 3.99993 0.0152853 2.51364 +EDGE_SE3:QUAT 109 1470 -0.399015 -3.1067 0.00756808 -0.00853372 -0.000313319 0.419023 0.907935 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 4.00001 -7.93828e-05 0.036012 3.99987 0.0105412 3.29798 +EDGE_SE3:QUAT 110 1470 -5.27314 -2.47853 -0.0794223 -0.0110883 -0.00689228 0.320832 0.947046 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 3.99945 -2.29786e-05 -0.00707876 4.00001 0.00162489 3.58821 +EDGE_SE3:QUAT 1389 1470 6.06625 -3.68242 -0.0258038 -0.00706276 0.00569826 -0.47892 0.877812 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 3.99974 8.07317e-05 -0.00354678 3.99998 0.00546937 3.08248 +EDGE_SE3:QUAT 1390 1470 1.86347 -3.59877 -0.0424186 -0.000574439 0.00350821 -0.481675 0.876343 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 4.00005 -7.11145e-05 0.0160821 4.00002 -0.00268883 3.07201 +EDGE_SE3:QUAT 1391 1470 -2.42823 -3.50312 -0.0332404 -0.0045714 0.00225457 -0.488573 0.872508 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 3.99993 4.64101e-05 -0.0105559 3.99997 0.00531434 3.04519 +EDGE_SE3:QUAT 1392 1470 -6.60036 -3.42167 -0.0861644 -0.00192375 0.00377505 -0.490751 0.871289 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 4 -4.28892e-05 0.0104658 4.00002 -0.000611711 3.03666 +EDGE_SE3:QUAT 1471 1472 4.04856 -0.4236 -0.0227621 0.00603443 0.0109232 -0.0698172 0.997482 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 4.00196 6.53053e-05 0.0918261 3.99947 -0.00324241 3.98261 +EDGE_SE3:QUAT 108 1471 6.9198 1.76209 -0.0401665 -0.00227339 0.00257388 0.476044 0.879415 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 4.00014 8.70619e-05 0.0250302 4 0.00630468 3.09369 +EDGE_SE3:QUAT 109 1471 3.00754 -0.393878 -0.00700376 -0.00330229 0.0014959 0.269555 0.962978 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 4.00006 -1.93256e-06 0.0208516 3.99997 0.00322675 3.70947 +EDGE_SE3:QUAT 110 1471 -1.38361 -0.558293 -0.0251374 -0.00453622 -0.00601002 0.166702 0.985979 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 4.00026 0.0001751 -0.0371843 3.99994 -0.00279403 3.88918 +EDGE_SE3:QUAT 111 1471 -5.73554 -0.228541 -0.0836403 -0.00545028 -0.0119341 0.129516 0.991491 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 4.00167 0.00059275 -0.0847304 3.99962 -0.0052744 3.93469 +EDGE_SE3:QUAT 1472 1473 4.08355 -0.211975 0.0102326 -0.000846254 -2.30561e-05 -0.0268514 0.999639 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 4 2.3014e-07 -0.000456794 4 7.35212e-06 3.99712 +EDGE_SE3:QUAT 109 1472 6.67012 1.31941 -0.0411394 -0.000666321 0.013655 0.202226 0.979243 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 4.00271 0.000824445 0.104242 3.99946 0.0103795 3.83913 +EDGE_SE3:QUAT 110 1472 2.56242 0.37191 0.00201844 0.000279255 0.00547048 0.097703 0.995201 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 4.00046 7.40883e-05 0.0428176 3.99989 0.00207694 3.96227 +EDGE_SE3:QUAT 111 1472 -1.74248 0.41739 -0.00854583 -0.000104836 -0.000896606 0.0600687 0.998194 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 4.00001 1.50046e-06 -0.0070587 4 -0.000210861 3.98558 +EDGE_SE3:QUAT 112 1472 -6.03424 0.542343 0.00975383 0.00527585 0.00122543 0.05104 0.998682 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 3.9999 1.53828e-05 0.00653907 4 0.000139165 3.98959 +EDGE_SE3:QUAT 1473 1474 4.23839 -0.143759 0.00982269 -0.00429372 -0.00290335 -0.0133816 0.999897 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 4.00007 4.89921e-05 -0.0239101 3.99996 0.000160605 3.99943 +EDGE_SE3:QUAT 110 1473 6.59781 0.946342 -0.0348838 -0.000955076 0.00531723 0.0707374 0.99748 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 4.00046 2.8358e-05 0.0430314 3.99989 0.00152754 3.98045 +EDGE_SE3:QUAT 111 1473 2.32587 0.682854 0.0078952 -0.000991146 -0.000925705 0.0333744 0.999442 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 4.00001 4.02875e-06 -0.00699663 4 -0.000114497 3.99556 +EDGE_SE3:QUAT 112 1473 -1.96518 0.744387 0.0116552 0.00439033 0.0012195 0.0241126 0.999699 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 3.99994 1.83677e-05 0.00847739 4 9.71931e-05 3.99769 +EDGE_SE3:QUAT 113 1473 -6.56345 0.820083 0.0212472 0.00412216 0.00279343 0.0244108 0.99969 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 4.00004 4.6881e-05 0.0211204 3.99997 0.000253515 3.99773 +EDGE_SE3:QUAT 1474 1475 3.98922 -0.10484 0.00900901 5.00975e-05 0.000583363 -0.00361272 0.999993 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 4.00001 8.74425e-08 0.00466899 4 -8.43476e-06 3.99995 +EDGE_SE3:QUAT 111 1474 6.54847 0.825137 0.0205086 -0.00511925 -0.00387087 0.0198343 0.999783 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 4.00012 8.17523e-05 -0.0297307 3.99995 -0.000292524 3.99865 +EDGE_SE3:QUAT 112 1474 2.2734 0.813765 0.00770636 0.000307909 -0.00166986 0.0108784 0.999939 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 4.00004 -1.33323e-06 -0.0133968 3.99999 -7.29177e-05 3.99957 +EDGE_SE3:QUAT 113 1474 -2.35229 0.897666 0.00244581 0.000167863 3.81729e-05 0.010654 0.999943 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 4 2.3557e-08 0.000283872 4 1.47399e-06 3.99955 +EDGE_SE3:QUAT 114 1474 -6.39054 0.990139 -0.00310044 0.00268583 3.32002e-05 0.00980574 0.999948 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 3.99997 -2.0925e-07 -5.04561e-05 4 -7.63948e-07 3.99962 +EDGE_SE3:QUAT 1475 1476 4.03803 -0.113248 0.0139855 -0.00120185 -0.00111537 -0.00705802 0.999974 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 4.00001 5.22867e-06 -0.00902411 3.99999 3.1929e-05 3.99982 +EDGE_SE3:QUAT 112 1475 6.25136 0.781443 0.0270484 0.000254614 -0.00122135 0.00735653 0.999972 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 4.00002 -9.83312e-07 -0.00979257 3.99999 -3.60377e-05 3.99981 +EDGE_SE3:QUAT 113 1475 1.63134 0.868596 0.0103566 0.000331621 0.000424355 0.00731224 0.999973 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 4 5.87588e-07 0.00336547 4 1.22702e-05 3.99979 +EDGE_SE3:QUAT 114 1475 -2.40058 0.972219 0.0120254 0.00238561 0.000593029 0.00592371 0.999979 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 3.99998 5.43606e-06 0.00457437 4 1.34e-05 3.99986 +EDGE_SE3:QUAT 115 1475 -6.53388 1.06738 -0.00157368 0.00183038 0.00134722 0.00514496 0.999984 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 4.00002 9.94588e-06 0.0106643 3.99999 2.74153e-05 3.99992 +EDGE_SE3:QUAT 1476 1477 4.10552 -0.110055 0.0112503 -1.31279e-05 -0.00314302 -0.00339448 0.999989 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 4.00016 -6.39761e-07 -0.0251451 3.99996 4.26787e-05 4.00011 +EDGE_SE3:QUAT 113 1476 5.68552 0.822915 0.0155433 -0.00105142 -0.000695087 6.63937e-06 0.999999 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 4 2.92334e-06 -0.00556061 4 -3.06511e-08 4.00001 +EDGE_SE3:QUAT 114 1476 1.62254 0.90536 0.015738 0.00125794 -0.000524126 -0.00101751 0.999999 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 4 -2.63106e-06 -0.00417763 4 2.13103e-06 4 +EDGE_SE3:QUAT 115 1476 -2.49546 0.99158 -0.000391617 0.000598129 0.000275632 -0.0019348 0.999998 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 4 6.61425e-07 0.00221893 4 -2.14997e-06 3.99999 +EDGE_SE3:QUAT 116 1476 -6.76573 1.08286 0.0571105 -0.00473279 0.00606688 7.36175e-05 0.99997 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 4.0005 -0.000114855 0.0485439 3.99985 -2.39438e-06 4.00059 +EDGE_SE3:QUAT 1477 1478 4.02654 -0.111934 0.0194357 0.00553886 -0.00232018 0.000444295 0.999982 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 3.99996 -5.14568e-05 -0.0185904 3.99998 -3.41483e-06 4.00009 +EDGE_SE3:QUAT 114 1477 5.71968 0.772597 0.0254069 0.0014303 -0.00365608 -0.00420483 0.999983 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 4.0002 -2.21952e-05 -0.0291769 3.99995 6.17566e-05 4.00014 +EDGE_SE3:QUAT 115 1477 1.61596 0.8619 0.00664708 0.000634681 -0.00299471 -0.00473411 0.999984 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 4.00014 -8.60467e-06 -0.0239215 3.99996 5.67362e-05 4.00005 +EDGE_SE3:QUAT 116 1477 -2.66116 0.970357 0.014377 -0.00480596 0.00295175 -0.00299032 0.99998 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 4.00004 -5.68129e-05 0.0234411 3.99997 -3.59585e-05 4.0001 +EDGE_SE3:QUAT 117 1477 -6.76974 1.03693 0.0264915 -0.00576659 0.00424056 -0.000607624 0.999974 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 4.00015 -9.79324e-05 0.0338829 3.99993 -1.27755e-05 4.00029 +EDGE_SE3:QUAT 1478 1479 4.03734 -0.0796993 0.0145332 -0.000545831 0.00030761 0.0011231 0.999999 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 4 -6.71726e-07 0.00246823 4 1.38617e-06 4 +EDGE_SE3:QUAT 115 1478 5.65259 0.709876 0.0497949 0.00628113 -0.00542483 -0.00468639 0.999955 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 4.00031 -0.000138124 -0.0430457 3.99988 0.000104997 4.00038 +EDGE_SE3:QUAT 116 1478 1.378 0.84151 0.0142231 0.000604399 0.000410593 -0.00289004 0.999996 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 4 9.89269e-07 0.00330566 4 -4.78437e-06 3.99997 +EDGE_SE3:QUAT 117 1478 -2.72152 0.923538 0.0122044 -0.000261814 0.00171486 -0.000256032 0.999998 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 4.00005 -1.8139e-06 0.0137182 3.99999 -1.77465e-06 4.00005 +EDGE_SE3:QUAT 118 1478 -6.94701 0.954676 -0.223028 0.00099851 -0.0138284 0.00441437 0.999894 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 4.00306 -3.512e-05 -0.110751 3.99923 -0.000240386 4.00299 +EDGE_SE3:QUAT 1479 1480 4.06568 -0.0903932 -0.0125366 0.00131546 0.0105797 0.000214579 0.999943 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 4.00178 5.63296e-05 0.0846671 3.99955 1.26299e-05 4.00179 +EDGE_SE3:QUAT 116 1479 5.41217 0.732905 0.0196223 0.000132241 0.000893931 -0.00204403 0.999998 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 4.00001 4.33917e-07 0.00715467 4 -7.31079e-06 4 +EDGE_SE3:QUAT 117 1479 1.30967 0.839927 0.0144666 -0.000908623 0.00217524 0.000755711 0.999997 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 4.00007 -7.82551e-06 0.0174104 3.99998 6.47673e-06 4.00007 +EDGE_SE3:QUAT 118 1479 -2.90738 0.911923 -0.093032 0.000315928 -0.0133341 0.00587811 0.999894 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 4.00285 8.21506e-06 -0.106756 3.99929 -0.000313015 4.00271 +EDGE_SE3:QUAT 119 1479 -6.92752 0.983903 -0.114179 -0.00137869 -0.0128601 0.00969437 0.999869 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 4.00263 0.000109332 -0.102765 3.99934 -0.000504162 4.00226 +EDGE_SE3:QUAT 1480 1481 4.4027 -0.0964018 0.00956873 0.00131782 0.00172848 0.0013604 0.999997 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 4.00004 9.19002e-06 0.0138064 3.99999 9.48073e-06 4.00004 +EDGE_SE3:QUAT 117 1480 5.39488 0.753522 -0.018133 0.000429637 0.0126717 0.00144506 0.999919 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 4.00257 2.73962e-05 0.101423 3.99936 7.50592e-05 4.00256 +EDGE_SE3:QUAT 118 1480 1.15717 0.868126 0.00434 0.00155768 -0.00291079 0.00606353 0.999976 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 4.00013 -1.70125e-05 -0.023399 3.99997 -7.07405e-05 3.99999 +EDGE_SE3:QUAT 119 1480 -2.86857 0.964335 -0.0178245 -0.000104424 -0.00241834 0.0101641 0.999945 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 4.00009 2.43407e-06 -0.0193314 3.99998 -9.82373e-05 3.99968 +EDGE_SE3:QUAT 120 1480 -7.41797 1.01564 -0.0194015 0.0019006 -0.00130274 0.0144954 0.999892 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 4.00001 -9.69913e-06 -0.0107492 3.99999 -7.86175e-05 3.99919 +EDGE_SE3:QUAT 1481 1482 4.31334 -0.0932705 0.0232582 -0.00411496 0.00105554 -0.00483401 0.999979 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 3.99995 -1.68417e-05 0.00820517 4 -1.97447e-05 3.99992 +EDGE_SE3:QUAT 118 1481 5.55834 0.823233 0.0392933 0.00305923 -0.00107209 0.00791477 0.999963 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 3.99998 -1.348e-05 -0.00886638 3.99999 -3.53813e-05 3.99977 +EDGE_SE3:QUAT 119 1481 1.52979 0.975911 0.00889807 0.00127793 -0.000606259 0.0117956 0.999929 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 4 -3.14213e-06 -0.00502992 4 -3.00071e-05 3.99945 +EDGE_SE3:QUAT 120 1481 -3.01235 1.05472 0.0041473 0.00311254 0.000569897 0.0160675 0.999866 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 3.99997 5.94725e-06 0.00395733 4 3.01997e-05 3.99897 +EDGE_SE3:QUAT 121 1481 -7.42442 1.20448 -0.0248087 0.0052876 0.000268605 0.0109442 0.999926 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 3.99989 3.24232e-06 0.00145401 4 6.69411e-06 3.99952 +EDGE_SE3:QUAT 1482 1483 4.09741 -0.103433 0.0338465 -0.00141821 -0.00256226 -0.00441016 0.999986 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 4.0001 1.39082e-05 -0.020573 3.99997 4.51981e-05 4.00003 +EDGE_SE3:QUAT 119 1482 5.83517 0.975146 0.0336244 -0.00267956 0.000433572 0.00675298 0.999974 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 3.99997 -5.00104e-06 0.00368544 4 1.26747e-05 3.99982 +EDGE_SE3:QUAT 120 1482 1.27703 1.10628 0.0148315 -0.000658852 0.0016412 0.0112221 0.999935 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 4.00004 -3.63034e-06 0.013216 3.99999 7.4276e-05 3.99954 +EDGE_SE3:QUAT 121 1482 -3.14059 1.20302 -0.00572865 0.00130595 0.00158157 0.00642687 0.999977 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 4.00003 8.55475e-06 0.0125511 3.99999 4.0302e-05 3.99987 +EDGE_SE3:QUAT 1483 1484 4.13095 -0.104536 0.0237417 -0.000329009 -0.0043357 -0.00840089 0.999955 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 4.0003 1.91828e-06 -0.0347174 3.99992 0.00014575 4.00002 +EDGE_SE3:QUAT 120 1483 5.38226 1.08818 0.0376782 -0.00209554 -0.000769049 0.006676 0.999975 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 3.99999 6.30195e-06 -0.00598408 4 -1.98162e-05 3.99983 +EDGE_SE3:QUAT 121 1483 0.975118 1.16333 0.0128653 -0.000100675 -0.000878087 0.00174642 0.999998 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 4.00001 3.85766e-07 -0.00702257 4 -6.13348e-06 4 +EDGE_SE3:QUAT 122 1483 -3.39574 1.25276 -0.0214668 0.00163732 -0.00020467 -0.00434306 0.999989 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 3.99999 -1.25126e-06 -0.00155198 4 3.30987e-06 3.99993 +EDGE_SE3:QUAT 123 1483 -7.41178 1.31477 0.0479328 -0.00425658 0.0087108 -0.000499579 0.999953 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 4.00114 -0.000149302 0.0696774 3.9997 -2.5166e-05 4.00121 +EDGE_SE3:QUAT 1484 1485 4.03598 -0.150293 0.0355477 0.00350853 -0.00560621 -0.0186616 0.999804 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 4.00044 -9.05056e-05 -0.0440445 3.99988 0.000411159 3.99909 +EDGE_SE3:QUAT 121 1484 5.09387 1.06967 0.042476 -0.000263889 -0.00519724 -0.00663275 0.999964 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 4.00043 1.18785e-06 -0.0416001 3.99989 0.00013785 4.00026 +EDGE_SE3:QUAT 122 1484 0.734815 1.11938 0.00137678 0.000962476 -0.00477088 -0.0127873 0.999906 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 4.00036 -2.52144e-05 -0.0380129 3.99991 0.000243287 3.99971 +EDGE_SE3:QUAT 123 1484 -3.2834 1.21114 0.000418874 -0.00453607 0.00437786 -0.00871492 0.999942 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 4.00022 -8.19281e-05 0.0345457 3.99993 -0.000151907 3.99999 +EDGE_SE3:QUAT 1485 1486 4.21347 -0.203525 0.0288791 -0.00146231 0.0146922 -0.0357368 0.999252 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 4.0034 -0.000268726 0.116772 3.99916 -0.00209365 3.9983 +EDGE_SE3:QUAT 122 1485 4.75416 0.858864 0.078001 0.00463317 -0.0101859 -0.0311761 0.999451 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 4.0015 -0.000258283 -0.0796604 3.99961 0.00124457 3.9977 +EDGE_SE3:QUAT 123 1485 0.741821 0.98501 0.00639703 -0.00122457 -0.00123516 -0.0274524 0.999622 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 4.00002 5.30184e-06 -0.0102734 3.99999 0.000142764 3.99701 +EDGE_SE3:QUAT 124 1485 -3.61011 0.996507 -0.0987152 0.00122935 -0.00967736 -0.016318 0.999819 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 4.00148 -8.39245e-05 -0.0771721 3.99963 0.000632275 4.00042 +EDGE_SE3:QUAT 1486 1487 4.02384 -0.331137 -0.00751945 -0.000367138 0.00407262 -0.087318 0.996172 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 4.00025 -3.94437e-05 0.0318281 3.99994 -0.00137891 3.96976 +EDGE_SE3:QUAT 123 1486 4.91505 0.547914 0.0409439 -0.00244236 0.0134428 -0.0634767 0.99789 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 4.00274 -0.000393723 0.105099 3.99933 -0.00332551 3.98664 +EDGE_SE3:QUAT 124 1486 0.596606 0.667523 0.0156978 0.000467923 0.00480178 -0.0518831 0.998642 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 4.00037 -1.98781e-05 0.0385531 3.99991 -0.00100129 3.9896 +EDGE_SE3:QUAT 125 1486 -3.61581 0.378953 -0.0472641 -0.00250639 -0.00499973 0.0240361 0.999695 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 4.00036 6.28795e-05 -0.0392434 3.99991 -0.000470175 3.99807 +EDGE_SE3:QUAT 1487 1488 3.98277 -0.648366 0.0191666 -0.00221956 -0.00519966 -0.175096 0.984535 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 4.00047 -7.7112e-05 -0.0442721 3.99989 0.00395447 3.87785 +EDGE_SE3:QUAT 124 1487 4.57267 -0.0691251 -0.0302798 -0.000195596 0.00893177 -0.139014 0.99025 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 4.00119 -0.000261716 0.0690885 3.99973 -0.0047502 3.92389 +EDGE_SE3:QUAT 125 1487 0.417025 0.247002 -0.00623181 -0.00230674 -0.00131451 -0.0639349 0.997951 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 4.00002 1.13793e-05 -0.0122166 3.99999 0.000408589 3.98369 +EDGE_SE3:QUAT 126 1487 -3.6943 -0.531294 0.00777728 0.00346814 0.0047579 0.13474 0.990863 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 4.0002 0.000106061 0.0314924 3.99995 0.00197396 3.92763 +EDGE_SE3:QUAT 1417 1487 0.234055 -7.46189 0.0489547 -0.00968527 0.00309274 0.613119 0.789925 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 4.0007 0.000568516 0.0656158 4.00001 0.0248966 2.49741 +EDGE_SE3:QUAT 1488 1489 4.06592 -1.01414 -0.00537708 0.00487005 0.00146868 -0.242897 0.970039 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 4.00005 2.61176e-05 0.0243622 3.99995 -0.00348771 3.76415 +EDGE_SE3:QUAT 80 1488 4.99954 4.98078 0.0548845 0.00130617 0.0110864 -0.883969 0.467413 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 3.99975 -6.09969e-05 0.0156917 4.0004 0.0182577 0.874152 +EDGE_SE3:QUAT 81 1488 1.02003 5.05662 0.0507628 0.000292663 0.0121416 -0.884659 0.46608 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 3.99971 3.8766e-05 0.0113186 4.00026 0.023448 0.869221 +EDGE_SE3:QUAT 82 1488 -3.05076 5.17217 0.0395648 0.00211264 0.0119994 -0.888662 0.4584 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 3.9997 -0.000124336 0.0199098 4.00058 0.0186126 0.840834 +EDGE_SE3:QUAT 125 1488 4.28189 -0.908184 0.0278668 -0.00471935 -0.0067687 -0.237699 0.971304 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 4.00089 -0.000184092 -0.0625934 3.99979 0.00777982 3.77498 +EDGE_SE3:QUAT 126 1488 0.316957 -0.113296 -0.00530781 0.0012748 -0.000153006 -0.0410247 0.999157 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 3.99999 -2.5289e-07 -0.000594084 4 7.87415e-06 3.99327 +EDGE_SE3:QUAT 127 1488 -3.65622 -1.03047 -0.0188502 -0.00260494 -0.00128689 0.233882 0.972261 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 3.99997 1.05061e-06 -0.0024176 4 3.61075e-05 3.7812 +EDGE_SE3:QUAT 1416 1488 6.06782 -3.99467 0.036853 -0.00882167 -0.00608222 0.451705 0.892103 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 3.99962 -0.000128782 0.00676364 3.99996 0.00634368 3.18378 +EDGE_SE3:QUAT 1417 1488 1.84665 -3.7717 0.0145315 -0.00873906 -0.00378328 0.465173 0.885169 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 3.99975 -0.000159733 0.020751 3.9999 0.00939886 3.13451 +EDGE_SE3:QUAT 1418 1488 -2.21202 -3.67723 -0.0210045 -0.00773327 -0.00366814 0.457723 0.889054 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 3.99978 -0.000124035 0.01592 3.99993 0.00762261 3.16198 +EDGE_SE3:QUAT 1419 1488 -6.3991 -3.45582 -0.109244 -0.0100526 -0.00868964 0.446658 0.894606 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 3.99946 -7.72534e-05 -0.00306316 4 0.00502743 3.20185 +EDGE_SE3:QUAT 1489 1490 3.93908 -0.773746 0.00120265 0.00203929 0.00961181 -0.158404 0.987326 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 4.0015 -0.000282853 0.0778561 3.99966 -0.00619238 3.90115 +EDGE_SE3:QUAT 79 1489 6.25438 1.69499 -0.0228371 -0.00425275 0.00872025 -0.980351 0.197021 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 4 -4.0004e-05 -0.0174401 3.99972 0.0379841 0.155721 +EDGE_SE3:QUAT 80 1489 1.8887 2.20166 0.0229929 0.00227506 0.00739623 -0.971117 0.23848 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 3.9999 6.12731e-05 0.0106454 4.00012 0.0213711 0.227647 +EDGE_SE3:QUAT 81 1489 -2.09351 2.29914 0.0237385 0.00121738 0.00810176 -0.971584 0.236553 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 3.99992 9.22273e-05 0.00611917 3.99997 0.0257893 0.22402 +EDGE_SE3:QUAT 82 1489 -6.22729 2.46258 -0.0054506 0.00316516 0.0084548 -0.973655 0.227846 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 3.99985 7.36669e-05 0.0144074 4.00023 0.0240435 0.207868 +EDGE_SE3:QUAT 126 1489 4.27826 -1.44229 -0.0107664 0.00600775 0.00131734 -0.282766 0.959169 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 4.00005 3.75785e-05 0.0285997 3.99993 -0.00493673 3.68037 +EDGE_SE3:QUAT 127 1489 0.420603 -0.0960996 -0.00726595 0.00228937 0.00049578 -0.00923947 0.999955 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 3.99998 4.86663e-06 0.00421952 4 -1.98683e-05 3.99966 +EDGE_SE3:QUAT 128 1489 -3.53593 -0.526356 -0.0624636 -0.00199696 -0.00766445 0.184773 0.982749 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 4.00071 0.000268363 -0.0538827 3.99986 -0.00474763 3.86416 +EDGE_SE3:QUAT 129 1489 -7.39602 -0.90862 -0.108151 -0.00320038 -0.011195 0.232055 0.972633 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 4.00131 0.000642521 -0.0738484 3.9998 -0.0079499 3.78595 +EDGE_SE3:QUAT 1417 1489 4.99033 -1.0021 0.0337388 -0.00353745 -0.00228266 0.235798 0.971793 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 3.99996 1.38555e-05 -0.0071208 4 -0.000384541 3.77761 +EDGE_SE3:QUAT 1418 1489 0.97466 -0.948536 0.00197829 -0.00273564 -0.00202248 0.227924 0.973673 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 3.99998 1.44429e-05 -0.00771227 4 -0.000545397 3.79221 +EDGE_SE3:QUAT 1419 1489 -3.18941 -0.834577 -0.0506106 -0.00327076 -0.00698342 0.215725 0.976424 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 4.00043 0.00024313 -0.0438114 3.99993 -0.00428095 3.81432 +EDGE_SE3:QUAT 1420 1489 -7.44894 -0.705599 -0.122738 -0.00265882 -0.0120327 0.211198 0.977366 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 4.0017 0.000706279 -0.083382 3.9997 -0.00835313 3.82331 +EDGE_SE3:QUAT 1490 1491 4.07239 -0.307765 -0.0079528 0.000712247 0.00213967 -0.0422176 0.999106 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 4.00007 1.46906e-06 0.0174323 3.99998 -0.000370128 3.99295 +EDGE_SE3:QUAT 78 1490 6.53294 -1.38136 -0.0304694 0.00164335 -0.0111133 0.982077 0.188145 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 3.99988 -0.000178471 -0.00750673 3.99983 0.0381835 0.141991 +EDGE_SE3:QUAT 79 1490 2.35035 0.890269 0.0115657 0.00434196 0.00755774 -0.999191 0.039249 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 3.9999 0.000128162 0.0174126 4.00014 0.028756 0.00644491 +EDGE_SE3:QUAT 80 1490 -1.94564 1.08787 0.00396792 0.0110442 0.00779215 -0.996592 0.0813787 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 3.99942 0.000111527 0.0446442 4.00202 0.023527 0.0271315 +EDGE_SE3:QUAT 81 1490 -5.94151 1.19977 0.008822 0.0100778 0.00860461 -0.996731 0.0796981 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 3.9995 0.000166156 0.040727 4.00164 0.0275043 0.0260154 +EDGE_SE3:QUAT 127 1490 4.33619 -0.927052 -0.0129671 0.00445882 0.0104565 -0.167574 0.985794 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 4.0019 -0.000288856 0.0889897 3.99954 -0.00760244 3.88965 +EDGE_SE3:QUAT 128 1490 0.411831 0.172929 0.00491498 -0.000364525 0.00171466 0.0266465 0.999643 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 4.00005 -6.22306e-07 0.0138193 3.99999 0.000184551 3.99721 +EDGE_SE3:QUAT 129 1490 -3.55878 0.178769 -0.0103691 -0.00127661 -0.00166779 0.074861 0.997192 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 4.00003 1.17521e-05 -0.0120878 3.99999 -0.000436825 3.97762 +EDGE_SE3:QUAT 1418 1490 4.82655 0.101998 0.01902 -0.00235546 0.00760738 0.0707846 0.99746 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 4.00095 2.83518e-05 0.0624094 3.99976 0.00222497 3.98093 +EDGE_SE3:QUAT 1419 1490 0.695318 0.126605 0.0125753 -0.00189815 0.00233387 0.0584272 0.998287 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 4.00008 -1.08248e-05 0.0199036 3.99997 0.000593244 3.98644 +EDGE_SE3:QUAT 1420 1490 -3.56541 0.213478 -0.0185383 -0.000563225 -0.00237946 0.0538487 0.998546 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 4.00009 1.22567e-05 -0.01859 3.99998 -0.000496616 3.98849 +EDGE_SE3:QUAT 1491 1492 4.02859 -0.1208 0.00218551 -0.00178257 0.00101924 -0.0105922 0.999942 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 4 -7.24943e-06 0.00792602 4 -4.16174e-05 3.99957 +EDGE_SE3:QUAT 77 1491 6.56049 -2.85055 -0.000208783 -0.00288612 -0.01119 0.843169 0.537524 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 3.99974 -0.000169065 0.0014558 3.99993 0.0247569 1.15604 +EDGE_SE3:QUAT 78 1491 2.88545 0.408196 -0.0032323 4.31068e-05 -0.00998158 0.973236 0.229591 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 3.99992 -0.000140894 -0.00115302 3.99976 0.0346876 0.21117 +EDGE_SE3:QUAT 79 1491 -1.7121 0.885059 -0.0299064 -0.00640067 -0.00736551 0.999948 0.00285908 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 3.99984 0.000190209 0.0256046 4.00043 0.0296137 0.000415806 +EDGE_SE3:QUAT 80 1491 -5.99229 0.723332 -0.0928046 0.0135291 0.00768395 -0.9991 0.0394601 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 3.99921 0.000252098 0.0542431 4.00288 0.0263781 0.0071394 +EDGE_SE3:QUAT 128 1491 4.5006 0.086664 -0.0130321 -8.34068e-05 0.00406653 -0.0152605 0.999875 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 4.00026 -7.4056e-06 0.0325075 3.99993 -0.000248048 3.99933 +EDGE_SE3:QUAT 129 1491 0.503075 0.482777 8.14354e-05 -0.000836082 0.000420553 0.0330965 0.999452 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 4 -1.42581e-06 0.00369071 4 6.28719e-05 3.99562 +EDGE_SE3:QUAT 130 1491 -3.80548 0.600509 0.00140561 0.000872126 -2.67578e-05 0.0224583 0.999747 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 4 -2.2855e-07 -0.000448859 4 -5.91941e-06 3.99798 +EDGE_SE3:QUAT 192 1491 1.98818 -7.22795 0.0709099 5.71047e-05 0.00763798 0.893892 0.448217 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 3.99989 -3.94517e-05 0.00521577 4.00006 -0.0165016 0.803716 +EDGE_SE3:QUAT 833 1491 2.55427 7.02366 0.0503742 0.00359175 0.00113939 -0.703598 0.710588 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 4.00009 -0.00010498 0.0235888 4.00004 -0.0101403 2.01993 +EDGE_SE3:QUAT 834 1491 -1.49048 7.09511 0.0809045 0.00248442 0.00729741 -0.706568 0.707603 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 4.00017 -0.000455839 0.0347399 4.00036 -0.00705648 2.00324 +EDGE_SE3:QUAT 1419 1491 4.76308 0.282038 -0.0103065 -0.00142638 0.00456744 0.0160938 0.999859 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 4.00033 -1.81661e-05 0.0368034 3.99992 0.000296197 3.9993 +EDGE_SE3:QUAT 1420 1491 0.515373 0.343885 0.00689747 0.000269949 -0.00023752 0.011593 0.999933 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 4 -2.46984e-07 -0.00193733 4 -1.13012e-05 3.99946 +EDGE_SE3:QUAT 1421 1491 -3.81937 0.403079 -0.0112902 0.00177392 -0.0010868 0.0170443 0.999853 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 4.00001 -7.62144e-06 -0.00905336 3.99999 -7.81215e-05 3.99886 +EDGE_SE3:QUAT 1492 1493 4.12519 -0.123897 0.0238913 0.00208821 -0.000926097 -0.00574189 0.999981 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 4 -7.64938e-06 -0.00726451 4 2.07598e-05 3.99988 +EDGE_SE3:QUAT 77 1492 4.97128 0.841791 0.0376854 -0.00462283 -0.0118938 0.837506 0.54628 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 3.99971 -0.000275209 0.00921745 3.99975 0.0302362 1.19413 +EDGE_SE3:QUAT 78 1492 -0.666767 2.31313 0.0269573 -0.00119321 -0.0114886 0.970742 0.239847 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 3.99993 -0.000174678 0.00389687 3.99958 0.041636 0.230574 +EDGE_SE3:QUAT 79 1492 -5.7319 1.03421 -0.0744527 -0.00728666 -0.00888294 0.999845 0.0133157 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 3.9998 0.000266879 0.0291572 4.00049 0.0363009 0.00125123 +EDGE_SE3:QUAT 129 1492 4.50772 0.623721 -0.0020048 -0.00250948 0.00145846 0.0226142 0.99974 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 4.00001 -1.45038e-05 0.0123395 3.99999 0.000141919 3.99799 +EDGE_SE3:QUAT 130 1492 0.221781 0.667168 0.00163342 -0.000978301 0.00119689 0.012203 0.999924 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 4.00002 -4.34652e-06 0.00971623 3.99999 5.95371e-05 3.99943 +EDGE_SE3:QUAT 131 1492 -3.95216 0.822079 -0.0188517 -0.00102175 0.000367264 -0.00181324 0.999998 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 4 -1.49166e-06 0.00291587 4 -2.64014e-06 3.99999 +EDGE_SE3:QUAT 191 1492 5.37047 -3.0382 0.00414038 -0.00322849 -0.00305498 0.967059 0.254514 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 4 4.38492e-05 0.0137041 4.00001 0.0164345 0.259229 +EDGE_SE3:QUAT 192 1492 -0.323931 -3.92731 0.0475663 -0.00162175 0.00667832 0.889162 0.457541 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 3.99991 6.63005e-05 0.0132998 4.00023 -0.00911483 0.837479 +EDGE_SE3:QUAT 193 1492 -5.73697 -2.72328 0.224162 0.00761426 0.0171654 0.790001 0.612818 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 3.99925 -0.000529135 -0.0105292 3.99966 -0.0368049 1.50308 +EDGE_SE3:QUAT 832 1492 6.66581 2.95615 0.137012 0.0135943 -0.0066984 -0.706772 0.707279 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 4.00001 0.00017501 0.057938 3.99945 -0.0384125 2.00264 +EDGE_SE3:QUAT 833 1492 2.46972 3.01366 0.0224166 0.00319605 0.00304493 -0.710751 0.70343 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 4.00012 -0.000194793 0.026559 4.00012 -0.00899765 1.97949 +EDGE_SE3:QUAT 834 1492 -1.61348 3.06646 0.0241228 0.00204315 0.00927489 -0.714044 0.700036 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 4.00015 -0.000575059 0.0370122 4.0005 -0.00531586 1.96073 +EDGE_SE3:QUAT 835 1492 -5.70374 3.18007 0.190518 -0.00747278 0.0217067 -0.715718 0.698012 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 3.9989 -7.79173e-05 0.0168047 4.00053 0.0229632 1.95011 +EDGE_SE3:QUAT 1420 1492 4.55327 0.315411 0.0111973 -0.00150486 0.000696542 0.000902828 0.999998 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 4 -4.1986e-06 0.00558863 4 2.50764e-06 4 +EDGE_SE3:QUAT 1421 1492 0.197176 0.431931 0.00214044 1.92908e-07 -9.15837e-05 0.0065859 0.999978 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 4 1.25509e-09 -0.000732637 4 -2.4125e-06 3.99983 +EDGE_SE3:QUAT 1422 1492 -3.94737 0.542006 -0.00629532 -0.0013261 0.000902456 0.00665475 0.999977 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 4.00001 -4.74718e-06 0.00732506 4 2.44638e-05 3.99984 +EDGE_SE3:QUAT 1493 1494 4.241 -0.0954762 0.0116421 -0.00264687 0.000477283 -0.00364632 0.99999 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 3.99998 -4.86767e-06 0.00370234 4 -6.6933e-06 3.99995 +EDGE_SE3:QUAT 77 1493 3.43519 4.6448 0.0837812 -0.00281175 -0.0106043 0.834592 0.550759 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 3.99976 -0.000143829 0.000908671 3.99995 0.0225554 1.21361 +EDGE_SE3:QUAT 78 1493 -4.2418 4.33851 0.0636027 0.000349473 -0.00969828 0.969484 0.244961 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 3.99991 -0.0001365 -0.00265937 3.99983 0.0324538 0.240312 +EDGE_SE3:QUAT 130 1493 4.35242 0.645345 0.0156322 0.00113349 0.000467299 0.00651593 0.999978 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 4 2.08446e-06 0.00364952 4 1.17992e-05 3.99983 +EDGE_SE3:QUAT 131 1493 0.185235 0.679328 0.00364995 0.000869993 -0.000446335 -0.00763344 0.99997 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 4 -1.54207e-06 -0.00349067 4 1.32252e-05 3.99977 +EDGE_SE3:QUAT 132 1493 -4.10368 0.721353 0.00755554 0.0063947 0.00110141 -0.00532717 0.999965 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 3.99986 2.97455e-05 0.00921916 3.99999 -2.47186e-05 3.99991 +EDGE_SE3:QUAT 190 1493 6.0279 0.432449 0.0268929 -0.0036169 -0.00717671 0.997838 0.0652346 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 3.99997 9.07459e-05 0.0145448 3.99993 0.0302821 0.0173055 +EDGE_SE3:QUAT 191 1493 1.82494 -0.893964 0.00588922 -0.00192432 -0.00122088 0.965759 0.259431 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 4 1.80441e-05 0.0082639 4.00002 0.00780656 0.269252 +EDGE_SE3:QUAT 192 1493 -2.60867 -0.501103 0.0312046 -3.40044e-05 0.00800088 0.886688 0.462299 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 3.99987 -2.86329e-05 0.00649591 4.00009 -0.0161498 0.855012 +EDGE_SE3:QUAT 193 1493 -6.62918 1.30054 0.204953 0.00952332 0.018356 0.786564 0.617163 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 3.99912 -0.000733374 -0.0182664 3.9994 -0.0428548 1.52475 +EDGE_SE3:QUAT 832 1493 6.53372 -1.17292 0.112245 0.0142287 -0.00860441 -0.710748 0.70325 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 3.99984 0.000352301 0.0565353 3.99931 -0.040702 1.98 +EDGE_SE3:QUAT 833 1493 2.29107 -1.13591 0.00242161 0.00423815 0.00100515 -0.714776 0.69934 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 4.0001 -0.00012992 0.0267221 4.00004 -0.0120524 1.95656 +EDGE_SE3:QUAT 834 1493 -1.8277 -1.05415 -0.0172785 0.00286976 0.00698526 -0.717899 0.696106 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 4.00017 -0.000458298 0.0350798 4.00037 -0.00762341 1.93869 +EDGE_SE3:QUAT 835 1493 -5.94555 -0.940668 0.137786 -0.00718227 0.0197796 -0.719916 0.693742 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 3.99904 3.30476e-05 0.0122335 4.00036 0.0227933 1.92613 +EDGE_SE3:QUAT 1421 1493 4.33626 0.348763 0.0276686 0.00218396 -0.000956003 0.00101156 0.999997 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 4 -8.36779e-06 -0.0076745 4 -3.83795e-06 4.00001 +EDGE_SE3:QUAT 1422 1493 0.173208 0.469508 0.0105557 0.000754463 -7.01007e-06 0.00103807 0.999999 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 4 -2.58807e-08 -6.54786e-05 4 -3.56102e-08 4 +EDGE_SE3:QUAT 1423 1493 -4.21514 0.551954 0.0093859 0.00528617 0.000874141 -0.00068318 0.999985 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 3.9999 1.86226e-05 0.00703618 4 -2.31053e-06 4.00001 +EDGE_SE3:QUAT 1494 1495 4.00729 -0.0959893 0.0213248 -0.000898943 -0.00979188 -0.00153628 0.99995 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 4.00153 3.17284e-05 -0.0783775 3.99962 5.81996e-05 4.00153 +EDGE_SE3:QUAT 131 1494 4.39923 0.512071 0.0149197 -0.00195254 7.26568e-05 -0.0113496 0.999934 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 3.99998 -2.21772e-07 0.000315236 4 -1.28576e-06 3.99948 +EDGE_SE3:QUAT 132 1494 0.130405 0.576996 0.00297891 0.00345342 0.00153135 -0.00928818 0.99995 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 3.99999 2.14878e-05 0.012634 3.99999 -5.90639e-05 3.99969 +EDGE_SE3:QUAT 133 1494 -4.18905 0.641357 0.0525788 0.00544473 0.00886422 -0.00303703 0.999941 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 4.00115 0.000188218 0.0711277 3.99968 -9.78807e-05 4.00123 +EDGE_SE3:QUAT 189 1494 5.69801 1.3262 0.0755627 -0.0114525 -0.0170839 0.999768 0.00646027 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 3.9995 0.000788274 0.0458306 4.00087 0.0689588 0.00188045 +EDGE_SE3:QUAT 190 1494 1.83832 1.08783 0.0135953 -0.00446117 -0.00991587 0.997567 0.0688643 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 3.99996 0.000143164 0.0179478 3.99979 0.0416408 0.0194854 +EDGE_SE3:QUAT 191 1494 -1.7893 1.31497 -0.00228016 -0.00329443 -0.0036078 0.964702 0.263297 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 4 3.9395e-05 0.0139489 3.99998 0.0184501 0.277442 +EDGE_SE3:QUAT 192 1494 -4.94756 3.01734 0.00415253 -0.00202794 0.00553533 0.884886 0.46577 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 3.99994 9.26907e-05 0.0147666 4.00023 -0.00517468 0.867858 +EDGE_SE3:QUAT 833 1494 2.09991 -5.34985 -0.0138419 0.00253157 0.00337005 -0.717306 0.696746 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 4.00009 -0.000172154 0.0234362 4.00012 -0.00698058 1.942 +EDGE_SE3:QUAT 834 1494 -2.05918 -5.29172 -0.0674517 0.00126175 0.00948646 -0.720503 0.693386 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 4.00007 -0.000482317 0.0324341 4.00046 -0.00258964 1.92357 +EDGE_SE3:QUAT 1422 1494 4.44013 0.371847 0.0177588 -0.002112 0.000431726 -0.00222686 0.999995 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 3.99999 -3.5774e-06 0.00339733 4 -3.77094e-06 3.99998 +EDGE_SE3:QUAT 1423 1494 0.0275314 0.436678 0.00925289 0.00224706 0.00153061 -0.00419414 0.999988 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 4.00002 1.36875e-05 0.0123576 3.99999 -2.58661e-05 3.99997 +EDGE_SE3:QUAT 1424 1494 -4.11036 0.535999 0.0647838 0.00443892 0.00946254 -0.00534917 0.999931 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 4.00136 0.000157487 0.0760038 3.99964 -0.000194121 4.00133 +EDGE_SE3:QUAT 1495 1496 4.0831 -0.0581263 0.0016807 -0.000281089 0.00259027 0.00732679 0.99997 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 4.00011 -1.73505e-06 0.0207457 3.99997 7.59877e-05 3.99989 +EDGE_SE3:QUAT 132 1495 4.13308 0.39909 0.0117851 0.00234351 -0.00832401 -0.0101127 0.999911 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 4.00108 -9.43508e-05 -0.0663128 3.99973 0.000338919 4.00069 +EDGE_SE3:QUAT 133 1495 -0.189941 0.512646 0.0011715 0.00437373 -0.00101278 -0.00421411 0.999981 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 3.99994 -1.7172e-05 -0.00788069 4 1.65527e-05 3.99994 +EDGE_SE3:QUAT 134 1495 -4.3808 0.643677 -0.0190173 0.00305958 -0.00306646 -0.00797721 0.999959 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 4.00011 -3.86971e-05 -0.0242369 3.99996 9.69655e-05 3.99989 +EDGE_SE3:QUAT 188 1495 5.71688 1.40712 0.0311547 -0.00256785 -0.0141341 0.999881 0.00558051 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 3.99998 0.000137025 0.0102748 3.9993 0.056643 0.000953226 +EDGE_SE3:QUAT 189 1495 1.69537 1.46372 0.010055 -0.00153107 -0.0181552 0.999804 0.0076947 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 3.99999 9.11626e-05 0.00612743 3.99871 0.0726928 0.00156778 +EDGE_SE3:QUAT 190 1495 -2.09934 1.73208 0.00594025 0.00546758 -0.0117181 0.99746 0.070049 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 3.9998 -0.00026181 -0.022066 4.00016 0.0432564 0.0202202 +EDGE_SE3:QUAT 191 1495 -5.14466 3.40419 0.0116558 0.00610037 -0.00714866 0.964373 0.264379 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 3.99975 0.000138337 -0.0278776 4.00086 0.0117237 0.279839 +EDGE_SE3:QUAT 1423 1495 4.04964 0.31632 0.0172102 0.00137619 -0.00848274 -0.00538547 0.999949 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 4.00114 -5.5942e-05 -0.0677869 3.99971 0.00018496 4.00103 +EDGE_SE3:QUAT 1424 1495 -0.100754 0.399739 0.00519836 0.00332883 -0.00046976 -0.00686377 0.999971 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 3.99996 -5.67818e-06 -0.00348358 4 1.16569e-05 3.99981 +EDGE_SE3:QUAT 1425 1495 -4.10412 0.493105 -0.0206866 0.00230955 -0.00322105 -0.00919291 0.99995 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 4.00014 -3.1617e-05 -0.0255111 3.99996 0.000117444 3.99982 +EDGE_SE3:QUAT 1496 1497 4.40103 -0.0555714 0.022109 0.00231375 -0.000332683 0.00891022 0.999958 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 3.99998 -3.43284e-06 -0.00290851 4 -1.33175e-05 3.99968 +EDGE_SE3:QUAT 133 1496 3.90391 0.423963 0.00111186 0.0038863 0.00157062 0.003255 0.999986 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 3.99998 2.42111e-05 0.0124128 3.99999 2.03455e-05 4 +EDGE_SE3:QUAT 134 1496 -0.300315 0.513846 0.000556229 0.0026283 -0.000412585 -0.000343334 0.999996 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 3.99998 -4.31996e-06 -0.00328982 4 5.74816e-07 4 +EDGE_SE3:QUAT 135 1496 -4.31796 0.654329 -0.0243364 -4.42661e-05 0.000214072 -0.0103341 0.999947 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 4 -4.90417e-08 0.00170682 4 -8.80929e-06 3.99957 +EDGE_SE3:QUAT 187 1496 5.68595 1.42132 0.0323199 0.0060803 0.0119319 -0.99991 0.0012739 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 3.99985 0.00029058 0.024326 4.00003 0.0476718 0.000722542 +EDGE_SE3:QUAT 188 1496 1.65874 1.49545 0.0189373 0.00554981 0.0143029 -0.99988 0.00200582 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 3.99987 0.000319303 0.0222058 3.99968 0.057126 0.000955234 +EDGE_SE3:QUAT 189 1496 -2.38845 1.58616 0.00470413 -0.00439163 -0.018427 0.999821 0.000165422 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 3.99992 0.000323193 0.0175753 3.99895 0.0737093 0.0014359 +EDGE_SE3:QUAT 190 1496 -6.10375 2.35669 0.0594105 0.00263385 -0.0118558 0.997964 0.06262 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 3.99993 -0.000175916 -0.010623 3.99966 0.0456447 0.0162365 +EDGE_SE3:QUAT 1424 1496 3.98337 0.284185 0.0053487 0.00322828 0.00227714 0.00107132 0.999992 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 4.00004 2.945e-05 0.0181756 3.99998 1.01293e-05 4.00008 +EDGE_SE3:QUAT 1425 1496 -0.0138146 0.361661 0.000573704 0.0020922 -0.000535936 -0.00145506 0.999997 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 3.99999 -4.44406e-06 -0.00425092 4 3.09805e-06 4 +EDGE_SE3:QUAT 1426 1496 -4.2274 0.461322 -0.0183708 -0.00018641 -0.000205093 -0.00484383 0.999988 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 4 1.49325e-07 -0.00165153 4 4.00837e-06 3.99991 +EDGE_SE3:QUAT 1497 1498 4.02738 -0.064159 0.025054 -0.00230579 -0.00046095 6.48628e-05 0.999997 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 3.99998 4.24895e-06 -0.00368578 4 -1.31265e-07 4 +EDGE_SE3:QUAT 134 1497 4.09067 0.454694 0.0243336 0.0049558 -0.000845101 0.00878712 0.999949 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 3.99992 -1.83066e-05 -0.00728233 4 -3.2664e-05 3.9997 +EDGE_SE3:QUAT 135 1497 0.0743722 0.512221 -9.46378e-05 0.00223543 -0.000141209 -0.00124203 0.999997 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 3.99998 -1.21355e-06 -0.00109634 4 6.74968e-07 3.99999 +EDGE_SE3:QUAT 136 1497 -4.04166 0.586288 -0.042081 0.00323786 -0.00124672 -0.0057238 0.999978 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 3.99998 -1.58719e-05 -0.00975077 3.99999 2.781e-05 3.99989 +EDGE_SE3:QUAT 186 1497 5.35664 1.3848 0.0277728 0.00518873 0.00903344 -0.999882 0.011323 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 3.99988 0.000187222 0.0207612 4.00013 0.0356563 0.000938468 +EDGE_SE3:QUAT 187 1497 1.26336 1.45943 0.00288792 0.006057 0.00961655 -0.99988 0.0104843 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 3.99984 0.000231187 0.0242348 4.00025 0.0379539 0.00094665 +EDGE_SE3:QUAT 188 1497 -2.73715 1.55182 -0.0146542 0.0052733 0.0124442 -0.99985 0.0108271 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 3.99988 0.000268208 0.0211016 3.99986 0.0493096 0.00118816 +EDGE_SE3:QUAT 189 1497 -6.74427 1.64935 -0.0102497 0.00411178 0.0163792 -0.999815 0.00921954 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 3.99992 0.000284991 0.0164559 3.99923 0.0651975 0.00147064 +EDGE_SE3:QUAT 1425 1497 4.37662 0.286534 0.0309856 0.00423939 -0.000941599 0.00762653 0.999961 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 3.99994 -1.6886e-05 -0.00791992 4 -3.05955e-05 3.99978 +EDGE_SE3:QUAT 1426 1497 0.184977 0.370131 0.0035725 0.00187638 -0.000601533 0.00407313 0.99999 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 3.99999 -4.59296e-06 -0.00490384 4 -1.00324e-05 3.99994 +EDGE_SE3:QUAT 1427 1497 -3.87629 0.472742 -0.0246229 0.00266981 -2.40699e-05 0.000901512 0.999996 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 3.99997 -3.08436e-07 -0.000221439 4 -1.04108e-07 4 +EDGE_SE3:QUAT 1498 1499 4.1288 -0.248248 0.0199238 -0.00146533 0.00924392 -0.0665768 0.997737 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 4.0013 -0.000184776 0.0723131 3.99968 -0.00239374 3.98358 +EDGE_SE3:QUAT 135 1498 4.10468 0.445928 0.0242961 4.7719e-05 -0.000536083 -0.000888364 0.999999 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 4 -1.08435e-07 -0.00428815 4 1.90498e-06 4 +EDGE_SE3:QUAT 136 1498 -0.00941537 0.484539 -0.00320875 0.00100469 -0.00163094 -0.00535022 0.999984 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 4.00004 -6.84994e-06 -0.0129826 3.99999 3.47364e-05 3.99993 +EDGE_SE3:QUAT 137 1498 -4.1637 0.252044 -0.114964 0.000968598 -0.00976143 0.047047 0.998845 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 4.00153 7.03199e-05 -0.0784047 3.99962 -0.00184623 3.99268 +EDGE_SE3:QUAT 185 1498 5.78577 1.23609 -0.0236863 -0.000980711 0.0100255 -0.999904 0.00954182 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 4 -3.18149e-05 -0.00392383 3.99961 0.0401659 0.000771436 +EDGE_SE3:QUAT 186 1498 1.34173 1.33713 0.0126717 0.0050149 0.0113765 -0.999861 0.0111334 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 3.99989 0.000232586 0.020067 3.99992 0.0450488 0.0011039 +EDGE_SE3:QUAT 187 1498 -2.7501 1.44037 -0.0173459 0.00569649 0.0121894 -0.999856 0.0103158 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 3.99986 0.000281553 0.0227943 3.99996 0.0482801 0.00113835 +EDGE_SE3:QUAT 188 1498 -6.73489 1.5085 -0.0337783 0.00501277 0.014846 -0.999813 0.0113113 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 3.99989 0.00031017 0.0200615 3.99956 0.0589139 0.00148029 +EDGE_SE3:QUAT 1426 1498 4.20698 0.354294 0.0354973 -0.000198942 -0.00110094 0.00405386 0.999991 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 4.00002 9.92509e-07 -0.00879762 4 -1.78315e-05 3.99995 +EDGE_SE3:QUAT 1427 1498 0.15632 0.419988 0.00447366 0.000310088 -0.000482458 0.00133131 0.999999 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 4 -5.9199e-07 -0.00386461 4 -2.57186e-06 4 +EDGE_SE3:QUAT 1428 1498 -4.13262 0.52866 -0.0922625 -0.000921668 -0.0084342 -0.0011512 0.999963 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 4.00114 2.91662e-05 -0.0675029 3.99972 3.73115e-05 4.00113 +EDGE_SE3:QUAT 1499 1500 4.00639 -0.637249 0.00246013 -0.00179289 0.00284035 -0.165771 0.986159 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 4.00007 -3.84126e-05 0.0182916 3.99999 -0.00139155 3.89016 +EDGE_SE3:QUAT 136 1499 4.10677 0.203169 0.0242606 -0.000439895 0.00779886 -0.0716706 0.997398 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 4.00095 -0.000116169 0.0615464 3.99977 -0.00219727 3.9804 +EDGE_SE3:QUAT 137 1499 -0.0314903 0.380328 -0.00595024 -0.000128495 -0.000394283 -0.0194495 0.999811 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 4 1.31477e-07 -0.00318246 4 3.10396e-05 3.99849 +EDGE_SE3:QUAT 138 1499 -4.30161 -0.463578 -0.0461214 0.00296714 -0.00397541 0.157837 0.987453 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 4.00029 1.84175e-05 -0.0361512 3.99992 -0.0029681 3.90068 +EDGE_SE3:QUAT 184 1499 6.01014 1.28081 -0.00542452 -5.38314e-06 -0.0128226 0.998135 0.0596807 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 3.99999 -7.69789e-05 -1.13148e-06 3.99936 0.050833 0.0148956 +EDGE_SE3:QUAT 185 1499 1.67136 1.40085 0.0152248 -0.00784047 -0.011502 0.998262 0.0572589 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 3.99984 0.000366245 0.0315053 4.00021 0.0492209 0.0139706 +EDGE_SE3:QUAT 186 1499 -2.78416 1.49919 4.88811e-05 -0.0136408 -0.0135483 0.998272 0.0555236 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 3.99943 0.000870369 0.0548136 4.00174 0.0598643 0.0139825 +EDGE_SE3:QUAT 187 1499 -6.83827 1.5894 -0.0366885 -0.0145076 -0.0143498 0.998246 0.0555689 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 3.99935 0.000982254 0.0582996 4.00198 0.0634434 0.0142119 +EDGE_SE3:QUAT 1427 1499 4.28709 0.191749 0.0262157 -0.000860153 0.00876146 -0.0651179 0.997839 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 4.00119 -0.00014684 0.0689938 3.99971 -0.00223755 3.98423 +EDGE_SE3:QUAT 1428 1499 -0.000272614 0.271957 -0.000603081 -0.0020405 0.00066508 -0.0675039 0.997717 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 3.99999 -3.54255e-06 0.00363641 4 -0.000103742 3.98178 +EDGE_SE3:QUAT 1429 1499 -4.04715 0.371012 -0.0247757 -0.00239921 -0.000761787 -0.0691023 0.997606 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 3.99999 8.91478e-06 -0.00803383 4 0.000299936 3.98092 +EDGE_SE3:QUAT 1500 1501 4.09104 -0.806633 -0.00943177 0.00141559 0.00199853 -0.183735 0.982973 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 4.00008 -8.61852e-06 0.0182367 3.99998 -0.00174537 3.86505 +EDGE_SE3:QUAT 137 1500 3.93593 -0.393363 -0.000872656 -0.00183874 0.00255105 -0.184683 0.982793 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 4.00004 -3.16939e-05 0.0153909 3.99999 -0.00126315 3.86363 +EDGE_SE3:QUAT 138 1500 -0.29297 0.178736 -0.00851143 0.00132126 -0.000814915 -0.00814913 0.999966 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 4 -4.3184e-06 -0.00638947 4 2.58785e-05 3.99974 +EDGE_SE3:QUAT 139 1500 -4.28343 -0.780174 -0.00693531 0.000743913 -0.00155702 0.203441 0.979086 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 4.00004 8.5219e-06 -0.013457 3.99999 -0.00140333 3.83449 +EDGE_SE3:QUAT 183 1500 6.193 2.3242 0.0315692 0.000342827 -0.0168659 0.975028 0.22144 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 3.99978 -0.00040035 -0.00293891 3.99934 0.0587576 0.197064 +EDGE_SE3:QUAT 184 1500 2.11337 2.38614 0.0195871 -0.000899124 -0.0143037 0.974401 0.224359 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 3.99989 -0.000269753 0.00256215 3.99938 0.0516721 0.202059 +EDGE_SE3:QUAT 185 1500 -2.23741 2.47751 -0.0241423 -0.00927214 -0.0143369 0.974978 0.221643 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 4.00001 0.000265265 0.0384821 3.99938 0.0660585 0.198021 +EDGE_SE3:QUAT 186 1500 -6.67657 2.55999 -0.0782634 -0.0148254 -0.0172616 0.975287 0.219765 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 3.99995 0.000916362 0.0620157 3.9998 0.0856805 0.196083 +EDGE_SE3:QUAT 1428 1500 3.8705 -0.897843 -0.00380418 -0.00366675 0.00348174 -0.232133 0.972671 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 4 -5.13314e-05 0.0157854 4 -0.0013475 3.78451 +EDGE_SE3:QUAT 1429 1500 -0.163772 -0.813688 -0.00739433 -0.00396111 0.0019846 -0.233369 0.972378 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 3.99994 -3.14952e-06 0.00390728 4 2.73535e-05 3.78215 +EDGE_SE3:QUAT 1430 1500 -4.20377 -0.709716 -0.012178 -0.00345911 0.00216169 -0.235105 0.971961 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 3.99996 -1.16204e-05 0.00647995 4 -0.000321501 3.77891 +EDGE_SE3:QUAT 1501 1502 4.05631 -0.799304 0.0060267 0.00298764 -0.00445072 -0.172678 0.984964 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 4.00016 -9.55278e-05 -0.0279579 3.99997 0.00219027 3.88092 +EDGE_SE3:QUAT 138 1501 3.7824 -0.701915 -0.0110752 0.00265046 0.00132297 -0.191645 0.98146 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 4.00003 7.59069e-06 0.0159523 3.99998 -0.00170383 3.85315 +EDGE_SE3:QUAT 139 1501 -0.205342 0.103826 0.00299594 0.00209107 0.000945995 0.0195983 0.999805 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 4 7.60024e-06 0.00707192 4 6.77192e-05 3.99848 +EDGE_SE3:QUAT 140 1501 -4.16754 -0.554154 0.0236546 -0.00364256 0.00460809 0.196711 0.980444 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 4.00041 4.87224e-05 0.0431265 3.99989 0.00444996 3.84568 +EDGE_SE3:QUAT 183 1501 2.84522 4.81598 0.093848 0.001895 -0.0147724 0.917799 0.396766 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 3.99956 -8.52178e-05 -0.016527 4.00047 0.0321002 0.630158 +EDGE_SE3:QUAT 184 1501 -1.20274 4.89486 0.0604334 -0.00025852 -0.012281 0.916541 0.399752 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 3.99974 -0.000173686 -0.00502587 4 0.0313332 0.639556 +EDGE_SE3:QUAT 1429 1501 3.12437 -3.39074 -0.0125077 -0.00251679 0.0029882 -0.407837 0.913046 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 3.99998 -1.91274e-05 0.00724476 4.00001 -0.000195398 3.33468 +EDGE_SE3:QUAT 1430 1501 -0.903729 -3.30112 -0.0234239 -0.00192957 0.003115 -0.409602 0.912257 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 4 -3.42226e-05 0.0104958 4.00001 -0.00102867 3.32892 +EDGE_SE3:QUAT 1431 1501 -5.06175 -3.23044 -0.0195681 -0.00404464 0.00310685 -0.407233 0.91331 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 3.99992 1.02687e-05 0.00135521 4 0.00151882 3.33663 +EDGE_SE3:QUAT 1502 1503 4.34052 -0.686003 -0.0201308 0.00737703 0.0193385 -0.121719 0.992349 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 4.00635 -0.000575019 0.162181 3.99841 -0.00998801 3.9473 +EDGE_SE3:QUAT 139 1502 3.89252 -0.524481 -0.00630059 0.00483943 -0.00325553 -0.15327 0.988167 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 3.99997 -5.14961e-05 -0.0163697 3.99999 0.00100401 3.9061 +EDGE_SE3:QUAT 140 1502 -0.129847 0.275511 -0.00127209 -0.000465005 0.000126588 0.0247271 0.999694 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 4 -2.66312e-07 0.0011497 4 1.4779e-05 3.99755 +EDGE_SE3:QUAT 141 1502 -4.51189 -0.0589338 -0.15666 -0.00644983 -0.0193819 0.131783 0.991068 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 4.00479 0.00147704 -0.141083 3.99894 -0.00906619 3.93549 +EDGE_SE3:QUAT 1430 1502 1.18954 -6.85427 -0.0209159 -0.00151472 -0.00277144 -0.561134 0.827719 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 4.00009 -9.30565e-05 -0.0206324 4.00003 0.00546189 2.74061 +EDGE_SE3:QUAT 1431 1502 -2.91597 -6.78037 -0.0173908 -0.0036876 -0.00314978 -0.558908 0.829216 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 4.00023 -0.000190194 -0.0339521 4.00002 0.0102852 2.75077 +EDGE_SE3:QUAT 1503 1504 4.30824 -0.409858 0.0066847 -0.00348839 -0.00617745 -0.0648545 0.99787 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 4.00062 2.77134e-05 -0.0518223 3.99983 0.00170368 3.98385 +EDGE_SE3:QUAT 140 1503 4.25632 -0.188919 -0.023682 0.00615752 0.0195168 -0.0974538 0.99503 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 4.00634 -0.00043782 0.161298 3.99841 -0.00791351 3.9685 +EDGE_SE3:QUAT 141 1503 -0.143635 0.415529 -0.00334237 0.000679536 8.4853e-05 0.00993228 0.99995 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 4 1.95319e-07 0.000597737 4 2.8343e-06 3.99961 +EDGE_SE3:QUAT 142 1503 -4.53328 0.334669 0.0553387 0.00594109 0.00667969 0.0519401 0.99861 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 4.00047 0.000192837 0.0495286 3.99986 0.00125852 3.98982 +EDGE_SE3:QUAT 1504 1505 4.18934 -0.154053 0.00609846 -0.000776347 -0.00467313 -0.0097982 0.999941 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 4.00035 9.40624e-06 -0.0374738 3.99991 0.000183362 3.99997 +EDGE_SE3:QUAT 141 1504 4.16038 0.108201 -0.000805495 -0.00275852 -0.00596232 -0.0546953 0.998481 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 4.00058 1.95509e-05 -0.0492978 3.99985 0.00136077 3.98864 +EDGE_SE3:QUAT 142 1504 -0.219254 0.36207 0.00199743 0.00212165 0.000719113 -0.0128145 0.999915 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 3.99999 6.38892e-06 0.00607768 4 -3.96064e-05 3.99935 +EDGE_SE3:QUAT 143 1504 -4.29587 0.40863 0.0260223 0.000871296 0.00471696 0.00141085 0.999988 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 4.00035 1.7189e-05 0.0377237 3.99991 2.70791e-05 4.00035 +EDGE_SE3:QUAT 1505 1506 4.45609 -0.106564 0.00580887 0.0018821 0.00133598 -0.00143177 0.999996 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 4.00001 1.00369e-05 0.0107201 3.99999 -7.60124e-06 4.00002 +EDGE_SE3:QUAT 142 1505 3.95809 0.115669 0.000830126 0.00131552 -0.00414314 -0.0230189 0.999726 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 4.00026 -3.07786e-05 -0.0327574 3.99993 0.000376124 3.99815 +EDGE_SE3:QUAT 143 1505 -0.0953111 0.271571 -0.00560625 -3.65967e-05 -7.90477e-05 -0.00899043 0.99996 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 4 1.03047e-08 -0.000636253 4 2.86589e-06 3.99968 +EDGE_SE3:QUAT 144 1505 -4.33913 0.357858 -0.0271086 -0.00113457 -0.00159522 -0.00494047 0.999986 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 4.00004 6.98609e-06 -0.0128286 3.99999 3.16758e-05 3.99994 +EDGE_SE3:QUAT 1506 1507 4.45376 -0.109322 0.0148595 0.000123855 -0.00108009 -0.0012964 0.999999 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 4.00002 -5.71226e-07 -0.00863878 4 5.60276e-06 4.00001 +EDGE_SE3:QUAT 143 1506 4.34936 0.0832896 0.00164469 0.00175217 0.00130206 -0.0104121 0.999943 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 4.00002 8.94213e-06 0.0106337 3.99999 -5.56642e-05 3.99959 +EDGE_SE3:QUAT 144 1506 0.137192 0.200402 -0.00285042 0.000512092 -0.000412968 -0.0061324 0.999981 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 4 -8.57638e-07 -0.00326587 4 9.97718e-06 3.99985 +EDGE_SE3:QUAT 145 1506 -4.19679 0.288007 -0.0117944 -0.000755381 0.000424879 -0.00196634 0.999998 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 4 -1.28325e-06 0.00338119 4 -3.32169e-06 3.99999 +EDGE_SE3:QUAT 1507 1508 4.38169 -0.0989012 0.0172347 0.000506375 -0.000342582 -0.000948651 0.999999 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 4 -6.94616e-07 -0.00273488 4 1.29774e-06 4 +EDGE_SE3:QUAT 144 1507 4.56985 0.0416655 0.0146055 0.000353343 -0.00141856 -0.00745191 0.999971 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 4.00003 -2.35565e-06 -0.011316 3.99999 4.21405e-05 3.99981 +EDGE_SE3:QUAT 145 1507 0.252883 0.154707 -0.00366453 -0.000615589 -0.000627428 -0.00337956 0.999994 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 4 1.52299e-06 -0.00504431 4 8.53197e-06 3.99996 +EDGE_SE3:QUAT 146 1507 -4.13597 0.238579 -0.0108738 -0.00069506 0.00113574 0.000757993 0.999999 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 4.00002 -3.13713e-06 0.0090923 3.99999 3.42525e-06 4.00002 +EDGE_SE3:QUAT 1508 1509 4.45249 -0.101723 0.0165883 -0.00179171 0.0106672 -0.00224293 0.999939 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 4.00181 -8.26361e-05 0.0853223 3.99955 -0.000100673 4.0018 +EDGE_SE3:QUAT 145 1508 4.64113 0.0243708 0.0199218 -2.92239e-07 -0.000926882 -0.00437188 0.99999 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 4.00001 -8.90565e-08 -0.00741488 4 1.62085e-05 3.99994 +EDGE_SE3:QUAT 146 1508 0.276637 0.135633 -0.000329432 -0.000369178 0.000750237 -0.000384967 1 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 4.00001 -1.11267e-06 0.0060002 4 -1.15982e-06 4.00001 +EDGE_SE3:QUAT 147 1508 -4.19271 0.214149 -0.0942467 0.00207224 -0.00852471 0.00335655 0.999956 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 4.00115 -6.49791e-05 -0.068297 3.99971 -0.000111132 4.00112 +EDGE_SE3:QUAT 1509 1510 4.33262 -0.0967435 0.000428933 -4.85864e-05 0.00317954 0.000247452 0.999995 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 4.00016 -5.57978e-07 0.0254373 3.99996 3.13581e-06 4.00016 +EDGE_SE3:QUAT 146 1509 4.707 0.0443766 0.00714708 -0.00219987 0.0115375 -0.00278032 0.999927 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 4.00211 -0.000110479 0.0922676 3.99947 -0.000135434 4.0021 +EDGE_SE3:QUAT 147 1509 0.256673 0.147524 0.0056942 1.18938e-05 0.0023225 0.00134073 0.999996 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 4.00009 2.84067e-07 0.0185801 3.99998 1.24576e-05 4.00008 +EDGE_SE3:QUAT 148 1509 -3.73614 0.220575 -0.00926211 0.000185497 -0.00127986 0.00400984 0.999991 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 4.00003 -7.92885e-07 -0.0102476 3.99999 -2.05445e-05 3.99996 +EDGE_SE3:QUAT 1510 1511 3.9896 -0.0743807 0.0125094 -0.00218518 -0.00562777 0.00113664 0.999981 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 4.00049 5.00317e-05 -0.0449969 3.99987 -2.72349e-05 4.0005 +EDGE_SE3:QUAT 147 1510 4.58791 0.0570159 -0.0174516 0.000116937 0.00515267 0.00157792 0.999985 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 4.00042 3.41635e-06 0.0412228 3.99989 3.26062e-05 4.00041 +EDGE_SE3:QUAT 148 1510 0.596384 0.159274 -0.00213464 0.000347815 0.00171165 0.00458639 0.999988 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 4.00005 2.69869e-06 0.0136738 3.99999 3.1367e-05 3.99996 +EDGE_SE3:QUAT 149 1510 -3.42006 0.242081 0.0146668 0.00223397 0.00454488 0.00706559 0.999962 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 4.00031 4.3812e-05 0.0361692 3.99992 0.000128678 4.00013 +EDGE_SE3:QUAT 1511 1512 4.02757 -0.066913 0.0168848 -0.0019982 -0.000841725 0.00214002 0.999995 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 4 6.69529e-06 -0.00668241 4 -7.16556e-06 3.99999 +EDGE_SE3:QUAT 148 1511 4.56292 0.121431 -0.00189921 -0.00200153 -0.00381405 0.00577662 0.999974 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 4.00021 3.23569e-05 -0.0303735 3.99994 -8.83e-05 4.0001 +EDGE_SE3:QUAT 149 1511 0.543899 0.229734 -0.0141404 5.60229e-05 -0.0011702 0.00857274 0.999963 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 4.00002 1.95627e-08 -0.0093664 3.99999 -4.01533e-05 3.99973 +EDGE_SE3:QUAT 150 1511 -4.00354 0.308503 -0.0129146 0.00247493 0.000504635 0.0111553 0.999935 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 3.99998 4.50759e-06 0.00370502 4 2.00612e-05 3.99951 +EDGE_SE3:QUAT 1512 1513 4.47121 -0.0577464 0.0227179 -0.00178393 -0.000429213 0.00363068 0.999992 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 3.99999 2.98571e-06 -0.0033559 4 -6.05265e-06 3.99995 +EDGE_SE3:QUAT 149 1512 4.56541 0.229435 0.0118888 -0.00205718 -0.00196142 0.0108448 0.999937 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 4.00004 1.67445e-05 -0.015421 3.99999 -8.33178e-05 3.99959 +EDGE_SE3:QUAT 150 1512 0.0252368 0.338876 -0.00158428 0.000532399 -0.000329693 0.0135001 0.999909 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 4 -6.95447e-07 -0.00272306 4 -1.85717e-05 3.99927 +EDGE_SE3:QUAT 151 1512 -4.3774 0.421542 -0.0229968 0.000436332 0.000503807 0.0152211 0.999884 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 4 9.45577e-07 0.00394937 4 2.98538e-05 3.99908 +EDGE_SE3:QUAT 1513 1514 4.29015 -0.0766868 0.0303695 -0.000545479 -0.00154917 0.00365211 0.999992 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 4.00004 3.58121e-06 -0.0123693 3.99999 -2.26042e-05 3.99998 +EDGE_SE3:QUAT 150 1513 4.49695 0.38725 0.0187249 -0.0012617 -0.000752498 0.0167917 0.999858 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 4 3.79511e-06 -0.00576325 4 -4.7685e-05 3.99888 +EDGE_SE3:QUAT 151 1513 0.0951346 0.490386 -0.00897426 -0.00156852 9.72741e-05 0.0187655 0.999823 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 3.99999 -9.71366e-07 0.00113091 4 1.17138e-05 3.99859 +EDGE_SE3:QUAT 152 1513 -4.09167 0.575253 -0.0438073 -0.00249076 -0.000646452 0.0206673 0.999783 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 3.99998 5.57994e-06 -0.00455071 4 -4.49068e-05 3.9983 +EDGE_SE3:QUAT 1514 1515 4.05476 -0.107405 0.0260539 0.00886357 -0.00315648 0.00372525 0.999949 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 3.99985 -0.000113335 -0.0256455 3.99996 -4.58456e-05 4.00011 +EDGE_SE3:QUAT 151 1514 4.37879 0.56594 0.0219202 -0.00199337 -0.0014891 0.0225403 0.999743 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 4.00002 1.22607e-05 -0.0113648 3.99999 -0.000126124 3.998 +EDGE_SE3:QUAT 152 1514 0.190976 0.677966 -0.00831736 -0.00287471 -0.00215458 0.0243145 0.999698 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 4.00003 2.56449e-05 -0.016383 3.99998 -0.000196015 3.9977 +EDGE_SE3:QUAT 153 1514 -4.22616 0.787351 0.000130416 -0.0065887 0.00277964 0.0260282 0.999636 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 3.99997 -7.66582e-05 0.0242709 3.99996 0.000323312 3.99744 +EDGE_SE3:QUAT 1515 1516 4.35829 -0.0820853 0.0217836 -0.00128456 0.00125777 -0.00985026 0.99995 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 4.00002 -6.69673e-06 0.00990885 3.99999 -4.85991e-05 3.99964 +EDGE_SE3:QUAT 152 1515 4.25054 0.786035 0.030142 0.00609715 -0.0050019 0.0284792 0.999563 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 4.00029 -0.00011181 -0.042051 3.99989 -0.000604648 3.9972 +EDGE_SE3:QUAT 153 1515 -0.157253 0.886618 0.00226599 0.00249337 -0.000103597 0.0301459 0.999542 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 3.99998 -2.50363e-06 -0.00172907 4 -3.05862e-05 3.99637 +EDGE_SE3:QUAT 154 1515 -4.15284 0.996879 -0.0343096 0.00115589 -0.00113589 0.0267659 0.99964 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 4.00002 -4.64923e-06 -0.00944846 3.99999 -0.000128025 3.99716 +EDGE_SE3:QUAT 1516 1517 4.25253 -0.343321 0.0369883 -0.000333014 0.0136746 -0.0881114 0.996017 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 4.0029 -0.0004061 0.107843 3.9993 -0.00473782 3.97185 +EDGE_SE3:QUAT 153 1516 4.19044 1.06911 0.0187834 0.00126064 0.00121741 0.0201733 0.999795 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 4.00002 6.56006e-06 0.0094283 3.99999 9.40978e-05 3.99839 +EDGE_SE3:QUAT 154 1516 0.209678 1.16526 -0.000647219 7.07285e-05 0.000158313 0.0170696 0.999854 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 4 5.41603e-08 0.00125147 4 1.06383e-05 3.99883 +EDGE_SE3:QUAT 155 1516 -3.74272 1.48916 -0.109424 -0.00180999 -0.00871404 -0.0250227 0.999647 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 4.00122 1.76127e-05 -0.0702088 3.99969 0.00087777 3.99873 +EDGE_SE3:QUAT 1517 1518 3.99713 -0.690226 0.0117817 -0.00391043 -0.00496477 -0.183922 0.982921 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 4.00047 -4.5934e-05 -0.0461609 3.99987 0.00444441 3.86522 +EDGE_SE3:QUAT 154 1517 4.45558 0.967751 0.0392051 -0.000310391 0.0139344 -0.0708462 0.99739 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 4.00305 -0.000343322 0.110447 3.99926 -0.00390867 3.98297 +EDGE_SE3:QUAT 155 1517 0.462655 0.918073 0.00833792 -0.000866533 0.00478603 -0.113035 0.993579 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 4.00033 -7.33016e-05 0.0363939 3.99992 -0.00202171 3.94922 +EDGE_SE3:QUAT 156 1517 -3.59542 1.62754 0.00493816 -0.000679715 0.00569487 -0.26045 0.96547 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 4.00037 -0.00017719 0.0389773 3.99995 -0.00477422 3.72904 +EDGE_SE3:QUAT 1518 1519 4.01232 -0.907051 0.00282933 0.00356374 3.62754e-05 -0.214565 0.976703 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 3.99997 1.75189e-05 0.00916458 3.99999 -0.00131017 3.81587 +EDGE_SE3:QUAT 155 1518 4.20277 -0.619905 -0.00595639 -0.00568954 -0.000194242 -0.293889 0.955823 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 3.99997 4.62296e-05 -0.0202668 3.99996 0.00394607 3.65461 +EDGE_SE3:QUAT 156 1518 -0.503815 -0.967875 -0.0165065 -0.00626529 0.00155942 -0.433287 0.901233 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 3.99992 6.97271e-05 -0.0193663 3.99994 0.00679249 3.24912 +EDGE_SE3:QUAT 157 1518 -5.09836 0.415198 -0.0549653 -0.00144548 0.00321165 -0.613457 0.789721 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 3.99998 -1.26789e-05 0.00468315 4.00001 0.00148756 2.49467 +EDGE_SE3:QUAT 1456 1518 3.68745 -5.85518 -0.0202111 -0.00535755 -0.00349487 0.495231 0.868738 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 3.99987 -6.39219e-05 0.00830105 3.99997 0.00560524 3.01897 +EDGE_SE3:QUAT 1457 1518 -0.552134 -5.74317 -0.0364085 -0.00554632 -0.00374419 0.49493 0.868907 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 3.99986 -6.74484e-05 0.00790992 3.99997 0.0056637 3.02016 +EDGE_SE3:QUAT 1458 1518 -4.68727 -5.62598 -0.0596475 -0.00645595 -0.00342197 0.490598 0.871355 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 3.99984 -9.37551e-05 0.013796 3.99994 0.00734969 3.03726 +EDGE_SE3:QUAT 1519 1520 4.12661 -0.963441 0.000992738 0.00390429 0.00739849 -0.197132 0.980341 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 4.00099 -0.000174321 0.0647829 3.99976 -0.00657017 3.8456 +EDGE_SE3:QUAT 156 1519 1.29462 -4.64178 0.0119077 -0.00336948 -0.00142971 -0.616607 0.787263 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 4.0001 -8.80908e-05 -0.0241942 4.00001 0.00891371 2.47933 +EDGE_SE3:QUAT 157 1519 -4.98108 -3.69874 -0.0581935 0.000721787 0.000379083 -0.768728 0.639575 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 4 -6.29276e-06 0.0048286 4 -0.0019704 1.63624 +EDGE_SE3:QUAT 1456 1519 6.53349 -2.85081 0.00190297 -0.00110037 -0.00264745 0.296933 0.954894 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 4.00005 3.69755e-05 -0.0147509 4 -0.00184906 3.64738 +EDGE_SE3:QUAT 1457 1519 2.2966 -2.75833 -0.0127687 -0.00148524 -0.00303262 0.296515 0.955022 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 4.00005 4.68385e-05 -0.0161578 4 -0.00196704 3.64838 +EDGE_SE3:QUAT 1458 1519 -1.85431 -2.67598 -0.0278823 -0.00170864 -0.00273628 0.291828 0.956465 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 4.00003 3.55525e-05 -0.0135104 4 -0.00153685 3.65939 +EDGE_SE3:QUAT 1459 1519 -5.99815 -2.54245 -0.12091 -0.00635798 -0.0108869 0.289045 0.957232 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 4.00057 0.000577686 -0.0555839 3.99998 -0.00643114 3.66654 +EDGE_SE3:QUAT 1520 1521 4.08468 -0.323312 0.00692657 0.00253819 0.00502025 -0.0162952 0.999851 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 4.00039 4.17569e-05 0.0406456 3.9999 -0.000330991 3.99935 +EDGE_SE3:QUAT 1457 1520 6.23975 -1.21208 0.0158557 0.000726423 0.00501519 0.102546 0.994715 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 4.00037 7.24572e-05 0.0386057 3.99991 0.00195416 3.95831 +EDGE_SE3:QUAT 1458 1520 2.13083 -1.1684 0.00191624 0.0005989 0.00508086 0.0981923 0.995154 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 4.00039 6.98175e-05 0.0393626 3.99991 0.00191217 3.96182 +EDGE_SE3:QUAT 1459 1520 -2.03229 -1.07124 -0.023422 -0.00229799 -0.00365104 0.0944237 0.995523 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 4.00015 5.47072e-05 -0.0262309 3.99996 -0.00119202 3.96451 +EDGE_SE3:QUAT 1460 1520 -6.36025 -0.936772 -0.00204338 -0.00156998 -0.00218417 0.0918076 0.995773 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 4.00005 2.04906e-05 -0.0155331 3.99999 -0.000683345 3.96635 +EDGE_SE3:QUAT 1521 1522 4.34257 0.431855 0.015262 0.00197163 -0.00175422 0.178786 0.983884 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 4.00006 6.80787e-07 -0.0175064 3.99998 -0.00167024 3.87222 +EDGE_SE3:QUAT 918 1521 3.93489 -6.2654 -0.0069358 -0.00218956 -0.00188827 0.768041 0.640394 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 3.99999 -1.28433e-05 0.0082767 3.99998 0.00766 1.64046 +EDGE_SE3:QUAT 919 1521 -0.111704 -6.16735 -0.0171377 -0.00201743 -0.00132819 0.767161 0.64145 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 4 -4.62739e-06 0.0084809 3.99998 0.00681463 1.64587 +EDGE_SE3:QUAT 920 1521 -4.16876 -6.05283 0.196991 0.0182407 0.0164899 0.766158 0.642181 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 3.99939 -0.000997833 -0.0670881 3.99837 -0.0638563 1.65273 +EDGE_SE3:QUAT 1458 1521 6.19692 -0.690893 -0.0389219 0.00255264 0.0103561 0.0818289 0.996589 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 4.00155 0.000298628 0.0795482 3.99963 0.00321878 3.9748 +EDGE_SE3:QUAT 1459 1521 2.04091 -0.603571 0.00660964 8.12293e-05 0.00142585 0.0784325 0.996918 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 4.00003 4.19789e-06 0.0112257 3.99999 0.00043786 3.97542 +EDGE_SE3:QUAT 1460 1521 -2.27262 -0.500375 0.017581 0.000667195 0.00290573 0.0758223 0.997117 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 4.00012 2.19867e-05 0.0224415 3.99997 0.00084077 3.97713 +EDGE_SE3:QUAT 1461 1521 -6.62364 -0.400781 0.0362476 4.35096e-05 0.00371214 0.074207 0.997236 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 4.00022 2.48844e-05 0.0294149 3.99995 0.00108804 3.97819 +EDGE_SE3:QUAT 1522 1523 4.15279 1.09405 0.0161152 -0.000614039 -0.00407958 0.286251 0.958146 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 4.00017 9.49938e-05 -0.0267154 3.99998 -0.00352084 3.67242 +EDGE_SE3:QUAT 917 1522 6.74119 -2.14965 -0.0441817 0.00447171 0.00262205 0.870746 0.491705 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 4.00003 4.77949e-05 -0.0206135 3.99997 -0.0180538 0.96731 +EDGE_SE3:QUAT 918 1522 2.72787 -2.07591 0.00235613 0.000139395 -0.0010495 0.870146 0.492793 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 4 1.16346e-06 -0.00172559 4 0.00146262 0.971382 +EDGE_SE3:QUAT 919 1522 -1.29708 -1.98744 -0.00547147 0.000585441 -0.000255579 0.869651 0.493667 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 4 3.54481e-06 -0.00327514 4 -0.00129291 0.974831 +EDGE_SE3:QUAT 920 1522 -5.3503 -1.8777 0.258029 0.0233359 0.0130578 0.868884 0.494293 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 4.00075 0.00138793 -0.108281 3.99945 -0.0929469 0.98309 +EDGE_SE3:QUAT 1459 1522 6.26379 0.485039 0.00633642 0.00200402 -0.000159466 0.255467 0.966816 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 4 -5.75692e-06 -0.00702913 4 -0.00115325 3.73896 +EDGE_SE3:QUAT 1460 1522 1.94119 0.57233 0.00803189 0.00332833 0.0011257 0.252769 0.96752 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 3.99995 -8.68562e-06 -0.00150925 4 -0.000653289 3.74443 +EDGE_SE3:QUAT 1461 1522 -2.40827 0.658117 0.0232245 0.00288615 0.00214755 0.251087 0.967958 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 3.99998 1.38887e-05 0.00725076 4 0.000475984 3.74783 +EDGE_SE3:QUAT 1462 1522 -6.72509 0.71389 -0.0208207 0.00379416 -0.00128759 0.254395 0.967092 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 4.00004 -1.26725e-05 -0.0204003 3.99997 -0.00304004 3.74124 +EDGE_SE3:QUAT 1523 1524 4.07657 0.757486 -0.0672218 -0.00434231 0.0194726 0.17891 0.983663 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 4.00613 0.00134114 0.1577 3.99864 0.0141747 3.87817 +EDGE_SE3:QUAT 917 1523 3.66457 0.850965 0.00290709 0.00853297 -0.00110632 0.974916 0.222405 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 3.99979 0.00034296 -0.0366669 4.00109 -0.0105494 0.198235 +EDGE_SE3:QUAT 918 1523 -0.327376 0.924977 0.0238837 0.00290258 -0.00377122 0.974798 0.223038 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 3.99994 1.05564e-05 -0.0127784 4.00019 0.00832091 0.199046 +EDGE_SE3:QUAT 919 1523 -4.3619 1.00056 0.0248558 0.00362148 -0.00315032 0.97451 0.224294 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 3.99993 3.9568e-05 -0.0158213 4.00027 0.00487362 0.201304 +EDGE_SE3:QUAT 1460 1523 5.02097 3.55042 0.03148 0.00398072 -0.00379583 0.518998 0.854758 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 4.00032 0.000232559 -0.0393085 4.00001 -0.0109687 2.92295 +EDGE_SE3:QUAT 1461 1523 0.686483 3.63054 0.0392738 0.00414076 -0.0030102 0.517816 0.855477 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 4.00026 0.000172995 -0.0362109 3.99999 -0.0104908 2.92779 +EDGE_SE3:QUAT 1462 1523 -3.67068 3.71405 0.0312661 0.00382504 -0.0066514 0.52041 0.853882 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 4.00062 0.000525664 -0.0527143 4.00009 -0.0134291 2.91737 +EDGE_SE3:QUAT 1524 1525 4.04904 0.114472 0.0346484 0.0035329 -0.0013342 0.0403048 0.99918 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 3.99999 -2.06437e-05 -0.0123544 3.99999 -0.000260088 3.99354 +EDGE_SE3:QUAT 916 1524 3.67856 1.85143 0.053777 -0.00617058 -0.00507833 0.999027 0.0433646 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 3.99987 0.000152256 0.0247495 4.00044 0.0223586 0.00780052 +EDGE_SE3:QUAT 917 1524 -0.32783 1.95525 0.0127156 -0.0116286 -0.0025061 0.998943 0.0443938 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 3.99949 0.000254543 0.0466486 4.00206 0.0141077 0.00847817 +EDGE_SE3:QUAT 918 1524 -4.29992 2.02121 -0.0205991 -0.0177562 -0.00410759 0.998824 0.0449177 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 3.99881 0.000616654 0.0712317 4.00479 0.0227561 0.00947111 +EDGE_SE3:QUAT 1525 1526 4.03555 -0.0757694 0.0294033 -0.00278998 0.000221257 0.0100507 0.999946 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 3.99997 -3.07897e-06 0.00210624 4 1.11435e-05 3.9996 +EDGE_SE3:QUAT 915 1525 3.78632 2.0229 0.0330965 0.0051141 0.00151439 -0.999964 0.00666877 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 3.99989 2.69043e-05 0.0204575 4.00041 0.00578486 0.00029089 +EDGE_SE3:QUAT 916 1525 -0.317125 2.10087 0.0368475 -0.00504131 -0.00158213 0.999981 0.00319323 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 3.9999 3.37939e-05 0.0201654 4.0004 0.00645803 0.000152876 +EDGE_SE3:QUAT 917 1525 -4.31315 2.19414 -0.0457955 -0.0105992 0.00125896 0.999934 0.00423895 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 3.99955 -4.20633e-05 0.0423955 4.00179 -0.00467903 0.000526748 +EDGE_SE3:QUAT 1526 1527 4.11077 -0.00876317 -1.61099e-05 0.00169575 -0.00288499 0.0483048 0.998827 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 4.00013 -1.03337e-05 -0.0239813 3.99996 -0.00058616 3.99081 +EDGE_SE3:QUAT 914 1526 4.18225 1.8355 0.0258116 0.00376031 0.00825367 -0.999959 0.000847375 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 3.99994 0.000124326 0.0150427 3.99995 0.0329906 0.000331534 +EDGE_SE3:QUAT 915 1526 -0.25338 2.04941 0.0180934 0.00534743 0.004355 -0.999833 0.0169132 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 3.99988 8.37221e-05 0.0213992 4.0004 0.0166867 0.00132837 +EDGE_SE3:QUAT 916 1526 -4.32267 2.18104 0.0249852 0.00527483 0.00417331 -0.999951 0.00732803 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 3.99989 8.41377e-05 0.0211012 4.00038 0.0163842 0.000393229 +EDGE_SE3:QUAT 1527 1528 4.15163 0.530384 -0.0499012 0.00389267 -0.00105386 0.17584 0.984411 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 4 -2.25079e-05 -0.0160874 3.99998 -0.00164301 3.87638 +EDGE_SE3:QUAT 913 1527 4.62371 0.792887 -0.0228535 0.00752958 -0.0091302 0.991961 0.125992 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 3.99965 -0.000118092 -0.030972 4.00098 0.0276207 0.0639349 +EDGE_SE3:QUAT 914 1527 0.0842526 1.80954 0.00122486 0.00149005 0.00636591 -0.998779 0.048957 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 3.99998 4.95933e-05 0.00598797 3.9999 0.024729 0.00974941 +EDGE_SE3:QUAT 915 1527 -4.34826 1.92946 -0.0197953 0.00299844 0.00233926 -0.997845 0.0655006 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 3.99996 1.49318e-05 0.0120759 4.00014 0.00769274 0.0172128 +EDGE_SE3:QUAT 1528 1529 4.30188 0.656382 0.00899054 -0.00444656 -0.0159912 0.181667 0.98322 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 4.00305 0.00116436 -0.112233 3.99941 -0.00975148 3.87112 +EDGE_SE3:QUAT 912 1528 5.10345 -0.77737 0.136999 -0.0169703 0.0129243 0.944948 0.326523 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 3.99888 0.00205354 0.0814229 4.00588 0.00119753 0.428322 +EDGE_SE3:QUAT 913 1528 0.475308 1.34172 0.00423968 -0.00687447 0.0071927 -0.998674 0.0505084 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 3.99985 -0.000226175 -0.0275979 4.00043 0.0313644 0.0106417 +EDGE_SE3:QUAT 914 1528 -4.00159 0.914269 -0.0616521 0.00195475 0.00220323 -0.974547 0.224163 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 3.99998 -7.83947e-06 0.00858428 4.00008 0.0043963 0.201022 +EDGE_SE3:QUAT 1529 1530 4.55167 0.645048 -0.0788162 0.00897029 0.00762954 0.159942 0.987056 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 4.0001 0.000286415 0.0417813 3.99994 0.0028272 3.8981 +EDGE_SE3:QUAT 911 1529 5.8705 0.139291 -0.00489521 0.00364574 0.000550503 0.942745 0.333495 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 3.99999 8.03315e-05 -0.0166432 4.00012 -0.0102597 0.444977 +EDGE_SE3:QUAT 912 1529 1.3342 1.35679 -0.00523478 -0.000922292 0.00669834 0.988715 0.149656 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 3.99997 -6.14789e-05 0.003991 3.99991 -0.0242255 0.0897424 +EDGE_SE3:QUAT 913 1529 -3.72022 0.257824 0.0682506 -0.0214724 0.0113412 -0.972519 0.231553 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 3.9995 -0.00231967 -0.0914662 4.00348 0.0771679 0.218171 +EDGE_SE3:QUAT 1530 1531 4.31137 0.400326 -0.0548951 0.00588634 0.00657937 0.107991 0.994113 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 4.00035 0.000207832 0.0441494 3.9999 0.00223542 3.95384 +EDGE_SE3:QUAT 910 1530 6.27977 2.11382 -0.055381 0.00193775 0.0143324 0.974474 0.224034 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 3.99992 -0.000242064 -0.00702024 3.99927 -0.0535573 0.201536 +EDGE_SE3:QUAT 911 1530 1.93622 2.52224 -0.049654 -0.00082664 0.0113214 0.983915 0.178278 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 3.99991 -0.000173258 0.00397531 3.9997 -0.0405857 0.127564 +EDGE_SE3:QUAT 912 1530 -3.22926 2.09495 -0.0812017 0.00656629 -0.0168791 -0.999776 0.0109861 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 3.99985 -0.000428802 0.0262804 3.99949 -0.0680784 0.00181433 +EDGE_SE3:QUAT 1531 1532 4.19325 0.224794 -0.0369421 -0.00147593 -0.000749803 0.0663417 0.997796 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 4 3.87093e-06 -0.00478732 4 -0.000145383 3.9824 +EDGE_SE3:QUAT 909 1531 6.56472 3.41281 -0.0758963 0.00030003 0.0196164 0.991027 0.132217 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 3.99991 -0.000357851 -0.000862 3.99864 -0.0753575 0.0713727 +EDGE_SE3:QUAT 910 1531 2.23306 3.63084 -0.107788 -0.00173577 0.0211471 0.992844 0.117515 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 3.99983 -0.000500914 0.00737069 3.99865 -0.0800648 0.0568807 +EDGE_SE3:QUAT 911 1531 -2.21693 3.65998 -0.114819 -0.00490474 0.0181677 0.997315 0.0707694 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 3.99978 -0.000470229 0.0198271 3.99941 -0.0690045 0.0213291 +EDGE_SE3:QUAT 1532 1533 4.56712 0.0579362 -0.0420548 -0.00255161 0.000990367 0.0297021 0.999555 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 3.99999 -1.08085e-05 0.00882133 3.99999 0.000135386 3.99649 +EDGE_SE3:QUAT 909 1532 2.4628 4.2935 -0.122185 0.00236867 0.01772 0.997642 0.0662559 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 4 1.76771e-06 -0.00949721 3.99874 -0.0713419 0.0188604 +EDGE_SE3:QUAT 910 1532 -1.85622 4.38714 -0.167279 0.000172348 0.01962 0.998459 0.0519046 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 3.99999 -0.000144907 -0.00066753 3.99849 -0.0780086 0.0123025 +EDGE_SE3:QUAT 1533 1534 4.99901 0.000223587 -0.024812 -0.0046832 0.00167325 0.0102988 0.999935 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 3.99996 -3.24058e-05 0.0139623 3.99999 7.2553e-05 3.99962 +EDGE_SE3:QUAT 908 1533 2.23074 4.73677 -0.103798 0.00230971 0.0127379 0.999142 0.0393497 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 3.99999 6.90424e-05 -0.00925572 3.99939 -0.051477 0.00687862 +EDGE_SE3:QUAT 909 1533 -2.05423 4.83082 -0.145353 0.00134079 0.0148949 0.999221 0.0365272 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 4 1.52821e-05 -0.00536889 3.99912 -0.0597658 0.00623854 +EDGE_SE3:QUAT 1534 1535 4.11134 -0.0856194 -0.0248343 -0.00122748 -0.00060169 0.00111919 0.999998 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 4 2.95042e-06 -0.00479702 4 -2.69193e-06 4 +EDGE_SE3:QUAT 906 1534 5.59836 5.03831 -0.0656016 0.00128637 0.00741899 0.999887 0.0129867 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 4 3.28693e-05 -0.00514705 3.9998 -0.0297965 0.000903251 +EDGE_SE3:QUAT 907 1534 1.69029 5.059 -0.0986172 -0.000496623 0.00851721 0.999672 0.0241341 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 4 -3.05857e-05 0.00198951 3.99972 -0.0339223 0.00261867 +EDGE_SE3:QUAT 908 1534 -2.73417 5.13898 -0.1089 0.000625632 0.00807522 0.99954 0.0292331 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 4 5.01293e-06 -0.00250424 3.99974 -0.032377 0.00368216 +EDGE_SE3:QUAT 1535 1536 4.30738 -0.0975779 -0.0238632 0.00133465 0.00122223 0.00145622 0.999997 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 4.00002 6.55637e-06 0.00975452 3.99999 7.14448e-06 4.00002 +EDGE_SE3:QUAT 905 1535 5.44764 5.29525 -0.0978771 -9.42967e-05 -0.0114472 -0.999915 0.00621777 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 4 1.08291e-05 -0.000377379 3.99948 -0.0457765 0.00067864 +EDGE_SE3:QUAT 906 1535 1.51867 5.23342 -0.0875367 0.00187279 0.00638049 0.9999 0.0124592 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 3.99999 4.46701e-05 -0.00749324 3.99989 -0.0256986 0.000800104 +EDGE_SE3:QUAT 907 1535 -2.4106 5.32882 -0.130413 -0.000234104 0.00754075 0.999705 0.0230967 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 4 -1.74512e-05 0.000938065 3.99978 -0.0300787 0.00236036 +EDGE_SE3:QUAT 1536 1537 4.52093 -0.0970433 -0.0320331 1.50139e-05 0.000534929 0.00218267 0.999997 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 4 4.71086e-08 0.00427901 4 4.6698e-06 3.99999 +EDGE_SE3:QUAT 904 1536 5.47222 5.25986 -0.0891501 -0.00111454 -0.0102448 -0.999854 0.013603 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 3.99999 5.65356e-05 -0.00446039 3.99961 -0.0408372 0.00116218 +EDGE_SE3:QUAT 905 1536 1.15907 5.34925 -0.130846 0.00113621 -0.0125028 -0.999895 0.00719761 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 4 -4.79839e-05 0.00454611 3.99939 -0.0500667 0.000839185 +EDGE_SE3:QUAT 906 1536 -2.78808 5.4453 -0.089586 0.000977312 0.0075931 0.999914 0.010689 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 4 2.49433e-05 -0.00391015 3.99978 -0.0304466 0.000692628 +EDGE_SE3:QUAT 1537 1538 4.65093 -0.0963214 -0.0267361 -0.00127676 0.00131593 0.00167357 0.999997 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 4.00002 -6.6726e-06 0.0105531 3.99999 8.7847e-06 4.00002 +EDGE_SE3:QUAT 903 1537 5.17952 5.13528 -0.0823002 5.43843e-05 -0.00951145 -0.999843 0.0149259 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 4 8.72879e-06 0.000217284 3.99964 -0.0380294 0.00125282 +EDGE_SE3:QUAT 904 1537 0.946196 5.24009 -0.107565 -0.000179404 -0.0101396 -0.999823 0.0158433 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 4 2.02492e-05 -0.00071845 3.99959 -0.0405083 0.00141455 +EDGE_SE3:QUAT 905 1537 -3.35834 5.37461 -0.165326 0.00188178 -0.0133773 -0.999864 0.00940681 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 3.99999 -8.78566e-05 0.00752988 3.99933 -0.0536351 0.00108749 +EDGE_SE3:QUAT 1538 1539 5.10187 -0.116135 -0.0342023 0.00109024 -0.00112491 0.00136057 0.999998 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 4.00002 -4.87724e-06 -0.00901706 3.99999 -6.10507e-06 4.00001 +EDGE_SE3:QUAT 902 1538 4.84256 4.98687 -0.0947401 -0.000702754 -0.00899231 -0.999834 0.0158126 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 4 3.52025e-05 -0.00281278 3.99969 -0.0358566 0.00132366 +EDGE_SE3:QUAT 903 1538 0.509499 5.09476 -0.10759 0.00135992 -0.0088468 -0.999828 0.0162342 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 4 -3.8482e-05 0.00544208 3.99971 -0.0355393 0.00137747 +EDGE_SE3:QUAT 904 1538 -3.73308 5.19979 -0.134047 0.00126314 -0.00937483 -0.999808 0.0171344 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 4 -3.57616e-05 0.00505496 3.99967 -0.0376435 0.00153513 +EDGE_SE3:QUAT 1539 1540 5.03287 -0.114194 -0.0218347 0.00134164 0.00195339 0.0008842 0.999997 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 4.00005 1.05516e-05 0.0156131 3.99998 7.02339e-06 4.00006 +EDGE_SE3:QUAT 901 1539 4.03408 4.84768 -0.0923742 -0.00219994 -0.00898927 -0.99982 0.0165359 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 3.99998 8.7508e-05 -0.00880477 3.99977 -0.0356412 0.00143081 +EDGE_SE3:QUAT 902 1539 -0.287041 4.94094 -0.121441 -0.00187519 -0.0109197 -0.999799 0.0166869 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 3.99998 9.60178e-05 -0.00750577 3.9996 -0.0433967 0.0015989 +EDGE_SE3:QUAT 903 1539 -4.59997 5.0399 -0.156454 0.000369124 -0.00996656 -0.999798 0.0174676 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 4 -8.36894e-07 0.00147683 3.9996 -0.0398854 0.00161889 +EDGE_SE3:QUAT 1540 1541 5.16678 -0.106495 -0.0220419 -0.00251509 0.000193494 0.000513833 0.999997 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 3.99998 -1.97213e-06 0.00156345 4 4.00708e-07 4 +EDGE_SE3:QUAT 900 1540 3.28949 4.68969 -0.110499 -0.0010297 -0.0116847 -0.999798 0.0163137 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 3.99999 6.52913e-05 -0.00412187 3.99948 -0.0465705 0.00161121 +EDGE_SE3:QUAT 901 1540 -1.01637 4.78688 -0.0926197 -0.000291562 -0.0100883 -0.999801 0.0172343 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 4 2.56848e-05 -0.0011675 3.9996 -0.0402813 0.00159423 +EDGE_SE3:QUAT 902 1540 -5.29608 4.89116 -0.12429 0.000462835 -0.012101 -0.99978 0.0171511 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 4 -2.31518e-06 0.00185183 3.99941 -0.0484283 0.00176409 +EDGE_SE3:QUAT 1541 1542 5.28074 -0.125239 -0.00931881 0.000383904 0.00536133 0.00131232 0.999985 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 4.00046 9.13992e-06 0.0428888 3.99989 2.8414e-05 4.00045 +EDGE_SE3:QUAT 899 1541 2.30541 4.52424 -0.0874147 0.000921169 -0.00850707 -0.999833 0.0161484 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 4 -2.22014e-05 0.00368615 3.99972 -0.0341239 0.00133768 +EDGE_SE3:QUAT 900 1541 -1.88277 4.62074 -0.108683 -0.00085351 -0.00966126 -0.999812 0.0167695 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 3.99999 4.50428e-05 -0.00341643 3.99965 -0.0385018 0.00149852 +EDGE_SE3:QUAT 1542 1543 5.05638 -0.104728 0.0277519 0.000952778 0.000590994 0.00113675 0.999999 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 4 2.25358e-06 0.00471494 4 2.68536e-06 4 +EDGE_SE3:QUAT 897 1542 6.05781 4.27205 -0.0485905 0.00419259 -0.00775345 -0.999835 0.0158732 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 3.99994 -0.000128585 0.0167779 4.00002 -0.0315284 0.00132679 +EDGE_SE3:QUAT 898 1542 1.90279 4.35443 -0.0538429 0.00416522 -0.00628157 -0.999833 0.0166493 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 3.99994 -0.000105887 0.0166685 4.0001 -0.0256653 0.00134299 +EDGE_SE3:QUAT 899 1542 -2.97938 4.47525 -0.107514 0.00653058 -0.00910431 -0.999789 0.0172257 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 3.99985 -0.000243002 0.0261366 4.0003 -0.0372966 0.00170553 +EDGE_SE3:QUAT 1543 1544 5.01592 -0.0945756 0.0308869 -0.00260189 -0.000258331 0.00107818 0.999996 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 3.99997 2.63185e-06 -0.00203296 4 -1.09396e-06 4 +EDGE_SE3:QUAT 896 1543 5.55108 4.12185 -0.0525688 0.00360785 -0.00685574 -0.999773 0.0198254 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 3.99996 -9.70696e-05 0.0144404 4 -0.0279692 0.00181997 +EDGE_SE3:QUAT 897 1543 0.991792 4.20766 -0.0671918 0.00482405 -0.00828569 -0.999808 0.0171105 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 3.99992 -0.000159324 0.0193062 4.00007 -0.0337815 0.00154965 +EDGE_SE3:QUAT 898 1543 -3.14653 4.30341 -0.0685391 0.00499323 -0.00688507 -0.999816 0.0172009 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 3.99991 -0.000140668 0.0199828 4.00018 -0.0282098 0.00148233 +EDGE_SE3:QUAT 1544 1545 5.09536 -0.0919255 0.0172786 -0.00185849 -0.000959864 0.00164993 0.999996 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 4 7.1262e-06 -0.00764207 4 -6.33514e-06 4 +EDGE_SE3:QUAT 895 1544 4.84561 3.93392 -0.0449048 0.00277524 -0.00434123 -0.999674 0.0250116 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 3.99997 -4.85701e-05 0.0111111 4.00003 -0.0178932 0.0026133 +EDGE_SE3:QUAT 896 1544 0.545339 4.02303 -0.0608152 0.00336684 -0.00470524 -0.999766 0.0208439 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 3.99996 -6.49147e-05 0.0134762 4.00008 -0.0193626 0.00187705 +EDGE_SE3:QUAT 897 1544 -3.99976 4.13584 -0.0853134 0.00493288 -0.0061378 -0.999811 0.0177798 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 3.99991 -0.000125551 0.0197416 4.00021 -0.025236 0.0015212 +EDGE_SE3:QUAT 1545 1546 4.76343 -0.0945624 0.0331356 -9.34302e-05 -0.00215957 0.00324629 0.999992 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 4.00007 1.17013e-06 -0.017273 3.99998 -2.80462e-05 4.00003 +EDGE_SE3:QUAT 894 1545 4.30738 3.669 -0.073391 0.00230427 -0.00512133 -0.999707 0.0235325 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 3.99998 -4.48563e-05 0.00922453 3.99997 -0.0208908 0.00234556 +EDGE_SE3:QUAT 895 1545 -0.246718 3.7786 -0.0521993 0.00170191 -0.00264437 -0.999634 0.0268736 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 3.99999 -1.81617e-05 0.00681469 4.00001 -0.0109242 0.00293023 +EDGE_SE3:QUAT 896 1545 -4.53394 3.89309 -0.0692929 0.00221975 -0.00325701 -0.999731 0.0228471 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 3.99998 -2.94436e-05 0.00888579 4.00003 -0.0134168 0.00215273 +EDGE_SE3:QUAT 1546 1547 4.69002 -0.105729 0.000394382 0.00157416 0.0019609 0.00415192 0.999988 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 4.00005 1.26452e-05 0.0156085 3.99998 3.24936e-05 3.99999 +EDGE_SE3:QUAT 893 1546 4.42255 3.01474 -0.073546 0.00291289 0.0046198 0.9988 0.0486636 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 3.99998 5.34419e-05 -0.011689 4.00002 -0.0195017 0.0096021 +EDGE_SE3:QUAT 894 1546 -0.4731 3.53973 -0.0558991 4.17398e-05 -0.0050304 -0.999634 0.0265783 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 4 4.53187e-06 0.00016636 3.9999 -0.0200947 0.00292666 +EDGE_SE3:QUAT 895 1546 -5.00439 3.62769 -0.040029 -0.000104917 -0.00285791 -0.999555 0.0296774 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 4 3.10612e-06 -0.000420831 3.99997 -0.0113816 0.00355545 +EDGE_SE3:QUAT 1547 1548 4.66462 -0.0861032 0.0208268 0.00424821 0.00244765 0.00615756 0.999969 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 4.00002 4.15655e-05 0.019266 3.99998 5.95913e-05 3.99994 +EDGE_SE3:QUAT 892 1547 5.87564 1.80288 -0.0883637 0.0084154 0.00491647 0.95057 0.310357 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 4 0.00033703 -0.0369939 4.00029 -0.0339806 0.385953 +EDGE_SE3:QUAT 893 1547 -0.241565 3.56826 -0.0454263 0.00103318 0.0063575 0.999002 0.0441912 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 4 1.24173e-05 -0.00414059 3.99984 -0.02567 0.00798081 +EDGE_SE3:QUAT 894 1547 -5.13598 3.38433 -0.0597641 0.00220837 -0.00673475 -0.999492 0.031067 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 3.99999 -5.09769e-05 0.00884522 3.99988 -0.0274223 0.00406838 +EDGE_SE3:QUAT 1548 1549 4.57877 -0.0737712 0.0266616 -0.000960285 -0.00157138 0.00636108 0.999978 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 4.00004 6.36218e-06 -0.012497 3.99999 -3.97262e-05 3.99988 +EDGE_SE3:QUAT 892 1548 2.14642 4.61938 -0.0111193 0.00733563 0.00955974 0.952599 0.303989 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 4.00002 9.84733e-05 -0.030976 3.99966 -0.0458859 0.370457 +EDGE_SE3:QUAT 893 1548 -4.85367 4.06235 -0.0181922 -0.00117015 0.0107907 0.999215 0.0380918 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 3.99998 -8.33289e-05 0.00469669 3.99958 -0.0426485 0.00626492 +EDGE_SE3:QUAT 1549 1550 4.56878 -0.0646662 0.0244201 0.00342051 0.00202431 0.010448 0.999938 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 4.00002 2.76991e-05 0.015763 3.99998 8.19202e-05 3.99963 +EDGE_SE3:QUAT 892 1549 -1.51651 7.31152 0.0561388 0.0085866 0.0081914 0.954531 0.297874 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 4.00002 0.0002625 -0.0368805 3.99994 -0.0443765 0.355798 +EDGE_SE3:QUAT 1550 1551 4.41578 -0.0240363 -0.00169701 -0.00494354 -0.00293141 0.0121908 0.999909 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 4.00003 5.79636e-05 -0.0227227 3.99997 -0.000138005 3.99953 +EDGE_SE3:QUAT 1551 1552 4.64317 -0.0434379 0.0163675 0.00252398 -0.00219123 0.0138773 0.999898 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 4.00006 -2.11636e-05 -0.0179452 3.99998 -0.000125181 3.99931 +EDGE_SE3:QUAT 1552 1553 4.24389 -0.0308618 -0.000399642 0.000888822 0.0107143 0.01482 0.999832 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 4.00183 7.87626e-05 0.0855622 3.99954 0.00063676 4.00095 +EDGE_SE3:QUAT 1553 1554 4.46554 -0.033708 0.00845222 0.00176977 -0.00352614 0.0146634 0.999885 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 4.00019 -2.08732e-05 -0.0285125 3.99995 -0.000209274 3.99934 +EDGE_SE3:QUAT 1554 1555 4.37216 -0.0258654 0.0140848 0.00156866 -0.00075432 0.0147952 0.999889 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 4 -4.80553e-06 -0.00631103 4 -4.73456e-05 3.99913 +EDGE_SE3:QUAT 1555 1556 4.50663 -0.0365507 0.0151342 0.00086506 0.000428416 0.0146532 0.999892 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 4 1.45421e-06 0.00327413 4 2.36177e-05 3.99914 +EDGE_SE3:QUAT 1556 1557 4.44013 -0.0282924 0.0121622 0.000528064 -0.00191541 0.0146782 0.99989 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 4.00006 -2.77288e-06 -0.0154116 3.99999 -0.00011328 3.9992 +EDGE_SE3:QUAT 1557 1558 4.38386 -0.024101 0.0143407 -6.59036e-05 0.00398159 0.0138302 0.999896 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 4.00025 4.21348e-06 0.0318563 3.99994 0.000220305 3.99949 +EDGE_SE3:QUAT 1558 1559 4.29072 -0.0401218 0.0143239 0.000292497 -0.00253879 0.0136089 0.999904 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 4.0001 -8.66598e-07 -0.0203529 3.99997 -0.00013855 3.99936 +EDGE_SE3:QUAT 1559 1560 4.28518 -0.0513077 0.00932354 0.00193587 0.00281734 0.0129706 0.99991 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 4.00011 2.38411e-05 0.0222322 3.99997 0.000143892 3.99945 +EDGE_SE3:QUAT 1560 1561 4.18272 -0.032442 0.00875181 -0.00129177 0.00147131 0.0130508 0.999913 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 4.00003 -7.07815e-06 0.0119698 3.99999 7.84746e-05 3.99935 +EDGE_SE3:QUAT 1561 1562 4.21955 -0.0440722 0.0165726 -0.00137433 0.000154837 0.0128686 0.999916 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 3.99999 -1.03583e-06 0.00145059 4 9.78698e-06 3.99934 +EDGE_SE3:QUAT 1562 1563 4.26047 -0.0453943 0.0160343 0.000577694 -0.000724117 0.0134741 0.999909 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 4.00001 -1.53486e-06 -0.00588476 4 -3.98448e-05 3.99928 +EDGE_SE3:QUAT 1563 1564 4.13057 -0.0526471 0.0147843 0.00214587 0.00107787 0.0132342 0.99991 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 4 9.10778e-06 0.00827992 4 5.40889e-05 3.99932 +EDGE_SE3:QUAT 1564 1565 4.09789 -0.0495363 0.0158039 0.00279549 0.00206674 0.0134554 0.999903 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 4.00003 2.35826e-05 0.0160782 3.99998 0.000107426 3.99934 +EDGE_SE3:QUAT 1565 1566 4.0041 -0.0464073 0.0101666 0.00135679 0.00111674 0.0139698 0.999901 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 4.00001 6.25431e-06 0.00870389 4 6.02999e-05 3.99924 +EDGE_SE3:QUAT 1566 1567 4.03631 -0.0435585 0.0141006 9.29652e-05 -0.00130488 0.0152681 0.999883 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 4.00003 1.3918e-07 -0.0104525 3.99999 -7.98265e-05 3.99909 +EDGE_SE3:QUAT 1567 1568 4.96747 -0.0128106 0.0130341 -0.00371345 0.000286066 0.0202764 0.999787 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 3.99995 -6.41404e-06 0.00319036 4 3.53807e-05 3.99836 +EDGE_SE3:QUAT 1568 1569 5.04548 -0.0214435 0.0121703 0.00136121 -0.000594008 0.017587 0.999844 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 4 -3.32977e-06 -0.00503707 4 -4.51164e-05 3.99877 +EDGE_SE3:QUAT 1569 1570 4.70074 -0.0339154 0.0221262 -0.00136739 0.00223151 0.0140213 0.999898 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 4.00007 -1.07023e-05 0.0180771 3.99998 0.000127098 3.9993 +EDGE_SE3:QUAT 1570 1571 4.68005 -0.0570408 0.0265055 0.000671142 0.00258529 0.0115213 0.99993 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 4.0001 8.73251e-06 0.0205859 3.99997 0.000118517 3.99957 +EDGE_SE3:QUAT 1571 1572 4.48726 -0.0524591 0.0288692 0.000230707 0.000246068 0.0139565 0.999903 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 4 2.40708e-07 0.00192934 4 1.33726e-05 3.99922 +EDGE_SE3:QUAT 1572 1573 4.35998 -0.0381347 0.0374068 0.00109664 0.00917881 0.0163271 0.999824 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 4.00133 7.29927e-05 0.0732075 3.99967 0.000599703 4.00027 +EDGE_SE3:QUAT 1573 1574 4.72003 0.00914643 0.0333544 -0.00887613 -0.011448 0.0180232 0.999733 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 4.00169 0.000450324 -0.0896482 3.99951 -0.000830034 4.00071 +EDGE_SE3:QUAT 1574 1575 4.47025 -0.0233192 0.0420408 0.00329202 0.00742764 0.0181758 0.999802 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 4.00082 0.000119846 0.0586838 3.99979 0.000535624 3.99954 +EDGE_SE3:QUAT 1575 1576 4.13867 -0.0453317 0.0371163 0.00294225 -0.000902456 0.0158642 0.999869 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 3.99998 -1.13657e-05 -0.00777688 4 -6.30966e-05 3.99901 +EDGE_SE3:QUAT 1576 1577 4.41695 -0.0422906 0.035542 -0.00276451 0.00335565 0.0105306 0.999935 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 4.00015 -3.48446e-05 0.0271909 3.99995 0.000143028 3.99974 +EDGE_SE3:QUAT 1577 1578 4.08216 -0.060044 0.0361653 -0.00285943 0.000923982 0.00975026 0.999948 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 3.99998 -1.09899e-05 0.00772528 4 3.81412e-05 3.99963 +EDGE_SE3:QUAT 1578 1579 4.09339 -0.0364571 0.0235707 -0.00319292 -0.0127595 0.0116762 0.999845 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 4.00254 0.000207663 -0.101663 3.99936 -0.000606012 4.00204 +EDGE_SE3:QUAT 1579 1580 4.35207 -0.000482339 -0.029058 0.0017158 0.00414306 0.0402872 0.999178 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 4.00025 4.33101e-05 0.0322369 3.99994 0.000644044 3.99377 +EDGE_SE3:QUAT 1580 1581 4.22607 0.321979 -0.00125198 -0.00248052 -0.00136112 0.110114 0.993915 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 3.99999 1.05785e-05 -0.00744026 4 -0.00034589 3.95151 +EDGE_SE3:QUAT 1581 1582 4.29332 0.452132 -0.0191827 -0.00345563 0.00103885 0.127476 0.991835 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 4 -1.87766e-05 0.0133379 3.99999 0.00095789 3.93504 +EDGE_SE3:QUAT 1582 1583 4.12548 0.426787 -0.0321306 0.00354605 -0.00300403 0.124186 0.992248 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 4.00016 -1.77556e-05 -0.0287095 3.99995 -0.00187956 3.93852 +EDGE_SE3:QUAT 1583 1584 4.40897 0.501188 -0.0124451 0.00533112 0.0116407 0.132863 0.991052 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 4.00157 0.0005702 0.0822939 3.99965 0.00524462 3.93108 +EDGE_SE3:QUAT 1584 1585 4.12925 0.393631 -0.00911248 0.00166248 0.00398279 0.115318 0.993319 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 4.0002 6.13692e-05 0.0289498 3.99995 0.00161346 3.94702 +EDGE_SE3:QUAT 1585 1586 4.40671 0.347387 0.0133571 0.00257511 0.0139608 0.0970795 0.995175 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 4.00284 0.000564389 0.107194 3.99933 0.00515048 3.96517 +EDGE_SE3:QUAT 1586 1587 4.65762 0.234911 0.0491921 -0.000920582 -0.0130923 0.0551104 0.998394 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 4.00268 0.000271252 -0.103714 3.99934 -0.00285672 3.99054 +EDGE_SE3:QUAT 1587 1588 4.23679 -0.0730747 -0.0109784 0.00411342 -0.000301456 0.00583101 0.999974 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 3.99993 -5.73365e-06 -0.00269928 4 -8.1386e-06 3.99987 +EDGE_SE3:QUAT 1588 1589 4.21832 -0.0889675 0.0170931 -0.00175259 0.00132717 1.40141e-05 0.999998 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 4.00002 -9.30386e-06 0.0106176 3.99999 3.09559e-10 4.00003 +EDGE_SE3:QUAT 1589 1590 4.27833 -0.0988 0.0107317 3.23431e-06 -0.00286132 0.000642361 0.999996 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 4.00013 8.9202e-08 -0.0228912 3.99997 -7.35222e-06 4.00013 +EDGE_SE3:QUAT 1590 1591 4.40998 -0.0949855 0.00549966 -0.000153308 -4.58852e-05 0.00183494 0.999998 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 4 2.78844e-08 -0.000363704 4 -3.32662e-07 3.99999 +EDGE_SE3:QUAT 1591 1592 4.54334 -0.0996723 0.0105817 0.00247188 0.00169895 0.00282296 0.999992 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 4.00002 1.68543e-05 0.0135077 3.99999 1.91966e-05 4.00001 +EDGE_SE3:QUAT 1592 1593 4.03854 -0.0750455 0.0151473 0.00130705 0.000469692 0.00397286 0.999991 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 4 2.42176e-06 0.00369513 4 7.30555e-06 3.99994 +EDGE_SE3:QUAT 1593 1594 4.44764 -0.0759775 -0.00121651 -0.0029518 -0.000275668 0.00395956 0.999988 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 3.99997 2.98524e-06 -0.00206501 4 -4.00053e-06 3.99994 +EDGE_SE3:QUAT 1594 1595 4.89109 -0.085759 0.002902 -0.000179394 -0.000511224 0.00185881 0.999998 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 4 3.78005e-07 -0.00408578 4 -3.79723e-06 3.99999 +EDGE_SE3:QUAT 1595 1596 4.95675 -0.0894486 0.0145748 -0.00238454 0.00260826 0.000700614 0.999994 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 4.00009 -2.47974e-05 0.0208865 3.99997 6.9296e-06 4.00011 +EDGE_SE3:QUAT 1596 1597 4.03754 -0.103702 0.0171322 0.000359865 -0.000604949 -6.70798e-05 1 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 4.00001 -8.71324e-07 -0.00483931 4 1.65467e-07 4.00001 +EDGE_SE3:QUAT 1597 1598 5.00217 -0.113827 0.0167112 0.000959698 0.0014692 0.00045836 0.999998 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 4.00003 5.66047e-06 0.0117484 3.99999 2.74184e-06 4.00003 +EDGE_SE3:QUAT 1598 1599 4.97894 -0.120363 0.0209915 -0.000316389 -0.000651806 -0.000312717 1 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 4.00001 8.21963e-07 -0.00521564 4 8.12348e-07 4.00001 +EDGE_SE3:QUAT 1599 1600 5.12511 -0.128454 0.0261588 0.00350091 0.000240649 -0.00113808 0.999993 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 3.99995 3.47982e-06 0.00197296 4 -1.1267e-06 4 +EDGE_SE3:QUAT 1600 1601 4.91992 -0.128263 0.0243036 -0.00150868 -0.00157271 -0.00104487 0.999997 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 4.00003 9.44798e-06 -0.0126006 3.99999 6.49672e-06 4.00004 +EDGE_SE3:QUAT 1601 1602 4.95072 -0.127683 0.0211913 -0.000279126 0.000602345 -0.000752746 0.999999 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 4.00001 -6.78604e-07 0.00481624 4 -1.81482e-06 4 +EDGE_SE3:QUAT 1602 1603 4.90559 -0.110356 0.0158775 0.000974569 -0.000181719 -0.000997198 0.999999 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 4 -7.0159e-07 -0.00144208 4 7.17845e-07 4 +EDGE_SE3:QUAT 1603 1604 4.92211 -0.146581 0.0342474 0.00386419 -0.00572578 -0.00513414 0.999963 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 4.00046 -9.19288e-05 -0.0455705 3.99987 0.000119833 4.00041 +EDGE_SE3:QUAT 1604 1605 4.84917 -0.127158 0.00471935 -0.00599569 -0.000287833 -0.00643405 0.999961 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 3.99986 8.73515e-06 -0.00276529 4 9.3762e-06 3.99984 +EDGE_SE3:QUAT 1605 1606 4.66468 -0.13583 0.0327671 -0.00199417 0.0011833 -0.00533841 0.999983 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 4.00001 -9.44418e-06 0.00933823 3.99999 -2.48776e-05 3.99991 +EDGE_SE3:QUAT 1606 1607 4.85398 -0.144049 0.0273182 0.00162506 -0.00107992 -0.004628 0.999987 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 4.00001 -7.0492e-06 -0.00854886 4 1.97572e-05 3.99993 +EDGE_SE3:QUAT 1607 1608 4.49636 -0.117259 0.0207594 -0.00426188 -0.000604383 -0.0050494 0.999978 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 3.99993 1.09881e-05 -0.00509299 4 1.30348e-05 3.9999 +EDGE_SE3:QUAT 1608 1609 4.6889 -0.173549 0.00208799 0.00725482 -0.000179307 -0.00898126 0.999933 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 3.99979 -1.42286e-06 -0.000652353 4 1.76049e-06 3.99968 +EDGE_SE3:QUAT 1609 1610 4.43355 -0.163263 0.025863 -0.000740686 -2.30565e-06 -0.0128757 0.999917 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 4 6.32796e-08 -0.000132871 4 1.10098e-06 3.99934 +EDGE_SE3:QUAT 1610 1611 4.327 -0.156474 0.026917 -0.00218966 0.00104309 -0.0125996 0.999918 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 4 -8.95891e-06 0.0080117 4 -4.98268e-05 3.99938 +EDGE_SE3:QUAT 1611 1612 4.37833 -0.145636 0.0201934 -0.000721739 0.000332608 -0.0116195 0.999932 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 4 -9.406e-07 0.0025597 4 -1.46771e-05 3.99946 +EDGE_SE3:QUAT 1612 1613 4.32384 -0.171139 0.00388387 -0.000254011 -0.00162312 -0.0155488 0.999878 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 4.00004 6.6816e-07 -0.0130277 3.99999 0.00010138 3.99908 +EDGE_SE3:QUAT 1613 1614 4.30798 -0.168415 0.00572135 -0.000858778 0.00107139 -0.0152984 0.999882 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 4.00001 -3.99774e-06 0.00841053 4 -6.39479e-05 3.99908 +EDGE_SE3:QUAT 1614 1615 4.29487 -0.162255 0.0136193 -0.00167982 0.00096719 -0.0151582 0.999883 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 4 -6.47333e-06 0.00742934 4 -5.55648e-05 3.99909 +EDGE_SE3:QUAT 42 1614 4.87428 4.49879 -0.0768914 0.00398712 -0.0167261 -0.998233 0.0568859 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 3.99998 -0.000148978 0.016006 3.99898 -0.0681652 0.0141738 +EDGE_SE3:QUAT 43 1614 -0.893906 5.11172 -0.072377 0.00911984 -0.0153948 -0.97501 0.221441 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 4.00001 -0.000216035 0.0377363 3.99919 -0.0695206 0.197771 +EDGE_SE3:QUAT 1615 1616 4.35773 -0.157655 0.0171106 -0.00055747 -0.000835903 -0.0128005 0.999918 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 4.00001 1.6763e-06 -0.00677121 4 4.35073e-05 3.99936 +EDGE_SE3:QUAT 41 1615 4.89907 4.00687 -0.0217422 0.00867054 -0.0138869 -0.999755 0.0148752 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 3.99973 -0.0004841 0.0347027 4.00035 -0.0565649 0.00198612 +EDGE_SE3:QUAT 42 1615 0.618341 4.16465 -0.097643 0.00521194 -0.0150533 -0.999005 0.0416491 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 3.99994 -0.000257215 0.0208997 3.99938 -0.0616854 0.00800093 +EDGE_SE3:QUAT 43 1615 -4.81208 3.427 -0.115932 0.00967444 -0.0135045 -0.978377 0.206162 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 3.99998 -0.000365351 0.0401517 3.99963 -0.0636455 0.171473 +EDGE_SE3:QUAT 1616 1617 4.37141 -0.181371 0.00556954 0.0011889 0.000154122 -0.0177595 0.999842 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 3.99999 9.19659e-07 0.00148571 4 -1.394e-05 3.99874 +EDGE_SE3:QUAT 40 1616 4.64878 4.01411 -0.0965022 0.0114208 -0.02093 -0.999663 0.0102623 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 3.99952 -0.000951489 0.0457181 4.00022 -0.0846749 0.002736 +EDGE_SE3:QUAT 41 1616 0.545643 4.0332 -0.0900535 0.00805075 -0.0131569 -0.999879 0.00212537 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 3.99974 -0.000424257 0.0322106 4.00033 -0.052778 0.000973702 +EDGE_SE3:QUAT 42 1616 -3.72873 3.95758 -0.121512 0.00485553 -0.0142291 -0.99947 0.0288802 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 3.99994 -0.000242339 0.0194492 3.99948 -0.0579185 0.00427031 +EDGE_SE3:QUAT 1617 1618 4.32815 -0.182213 -0.000356666 0.000280566 0.000980957 -0.0183688 0.999831 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 4.00002 6.82557e-07 0.00790554 4 -7.27791e-05 3.99867 +EDGE_SE3:QUAT 39 1617 4.57812 4.07906 -0.0591696 0.00518899 -0.014004 -0.999825 0.0112941 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 3.99991 -0.000279644 0.0207656 3.99961 -0.0564692 0.00141537 +EDGE_SE3:QUAT 40 1617 0.309183 4.09873 -0.187013 -0.0120349 0.0218739 0.99966 0.00754972 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 3.99939 -0.00105593 0.048174 4.0005 -0.0868072 0.00269149 +EDGE_SE3:QUAT 41 1617 -3.76578 4.18617 -0.145561 -0.00901473 0.013636 0.999741 0.0158131 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 3.99964 -0.000482826 0.0360806 4.00065 -0.0533901 0.00203836 +EDGE_SE3:QUAT 1618 1619 4.39043 -0.193119 0.0129997 0.00229804 -0.000963477 -0.0161868 0.999866 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 3.99999 -8.4967e-06 -0.00725845 4 5.75801e-05 3.99897 +EDGE_SE3:QUAT 38 1618 4.33161 4.12781 -0.110821 0.0069288 -0.0188869 -0.999735 0.0112014 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 3.99983 -0.000503297 0.0277344 3.99927 -0.0761498 0.00214423 +EDGE_SE3:QUAT 39 1618 0.26143 4.14553 -0.105766 -0.00666454 0.0142301 0.999853 0.00680135 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 3.99981 -0.00038293 0.0266674 3.99993 -0.0565599 0.00116257 +EDGE_SE3:QUAT 40 1618 -4.006 4.34775 -0.3119 -0.0138028 0.021973 0.999341 0.0253855 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 3.99912 -0.00118503 0.0552973 4.00149 -0.0850265 0.00515005 +EDGE_SE3:QUAT 1619 1620 4.33949 -0.180779 0.0103998 0.000744134 -0.00108841 -0.015782 0.999875 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 4.00002 -3.60551e-06 -0.00856319 4 6.72141e-05 3.99902 +EDGE_SE3:QUAT 37 1619 4.50169 4.2037 -0.1374 0.00633474 -0.0228549 -0.999625 0.0136539 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 3.99987 -0.000533194 0.0253643 3.99846 -0.0920624 0.00302651 +EDGE_SE3:QUAT 38 1619 -0.0246381 4.2207 -0.157553 -0.00619671 0.021714 0.999731 0.00534181 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 3.99984 -0.000553001 0.0248051 3.99876 -0.0865837 0.00214264 +EDGE_SE3:QUAT 39 1619 -4.09231 4.39269 -0.149315 -0.0058858 0.0168775 0.999583 0.0226657 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 3.99982 -0.000426808 0.0235725 3.99953 -0.066362 0.00329554 +EDGE_SE3:QUAT 1620 1621 4.40341 -0.161375 -0.00106608 -0.000686433 0.00243367 -0.0135757 0.999905 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 4.00009 -8.54103e-06 0.0193525 3.99998 -0.000131202 3.99936 +EDGE_SE3:QUAT 36 1620 4.26499 4.22992 -0.162218 0.00112251 -0.0254722 -0.999575 0.0141218 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 4 -4.10723e-05 0.0044933 3.99741 -0.101932 0.00340247 +EDGE_SE3:QUAT 37 1620 0.159588 4.26133 -0.17609 -0.00611091 0.0230124 0.999714 0.00200238 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 3.99985 -0.000568866 0.0244628 3.99849 -0.0919459 0.00227981 +EDGE_SE3:QUAT 38 1620 -4.36221 4.45267 -0.21078 -0.00596512 0.0223029 0.999517 0.0207968 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 3.99981 -0.000593145 0.0238956 3.99872 -0.0881223 0.00381556 +EDGE_SE3:QUAT 1621 1622 4.47461 -0.135161 0.0130137 -0.00520227 0.000554146 -0.0126662 0.999906 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 3.9999 -8.85408e-06 0.00364131 4 -2.14174e-05 3.99936 +EDGE_SE3:QUAT 35 1621 4.02869 4.21071 -0.0994682 0.00473176 -0.0207495 -0.999643 0.0161654 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 3.99993 -0.000343914 0.018945 3.99856 -0.0835461 0.00288104 +EDGE_SE3:QUAT 36 1621 -0.140154 4.2638 -0.157934 0.00398114 -0.0244672 -0.999692 0.000759126 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 3.99994 -0.000385898 0.0159387 3.99786 -0.097872 0.00246176 +EDGE_SE3:QUAT 37 1621 -4.20099 4.43899 -0.230711 -0.00924551 0.0224025 0.999592 0.0151247 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 3.99961 -0.000855413 0.037021 3.99951 -0.0884639 0.00321459 +EDGE_SE3:QUAT 1622 1623 4.42625 -0.153182 0.00238998 -0.00395688 0.0039779 -0.0115424 0.999918 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 4.00018 -6.57752e-05 0.0312698 3.99994 -0.000180887 3.99971 +EDGE_SE3:QUAT 34 1622 3.97008 4.14631 -0.0830815 0.00231109 -0.012625 -0.999745 0.0185624 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 3.99999 -9.47814e-05 0.00925043 3.99942 -0.0507964 0.00204503 +EDGE_SE3:QUAT 35 1622 -0.42403 4.21211 -0.136992 0.00559565 -0.0152329 -0.999861 0.00373134 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 3.99988 -0.000336739 0.0223905 3.99956 -0.0610996 0.00111438 +EDGE_SE3:QUAT 36 1622 -4.57278 4.40737 -0.197074 -0.00493041 0.0191277 0.999737 0.0116821 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 3.99988 -0.000403638 0.0197368 3.99898 -0.0760215 0.00208859 +EDGE_SE3:QUAT 1623 1624 4.41978 -0.12604 -9.52053e-05 0.00043646 0.00266504 -0.00642925 0.999976 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 4.00011 3.56403e-06 0.0213532 3.99997 -6.86076e-05 3.99995 +EDGE_SE3:QUAT 33 1623 4.01691 4.07918 -0.0832389 0.00389056 -0.0102129 -0.999706 0.0216456 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 3.99995 -0.000147571 0.0155747 3.99978 -0.0414779 0.00236511 +EDGE_SE3:QUAT 34 1623 -0.442365 4.13618 -0.0968128 0.00660838 -0.00910391 -0.999911 0.00718093 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 3.99983 -0.000243317 0.0264384 4.00035 -0.0367977 0.000719502 +EDGE_SE3:QUAT 35 1623 -4.81692 4.3294 -0.185449 -0.00992179 0.011962 0.999851 0.00755937 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 3.99959 -0.000465633 0.0396967 4.00105 -0.0472639 0.00118084 +EDGE_SE3:QUAT 1624 1625 4.52037 -0.160043 6.41136e-05 0.00460013 -0.00399406 -0.00856891 0.999945 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 4.00016 -7.52495e-05 -0.0314767 3.99994 0.000135921 3.99995 +EDGE_SE3:QUAT 32 1624 4.15355 3.95547 -0.0827699 0.00406057 -0.00963641 -0.999486 0.0303033 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 3.99995 -0.00014377 0.0162647 3.99984 -0.0394417 0.00412861 +EDGE_SE3:QUAT 33 1624 -0.417085 4.01607 -0.118272 0.00685919 -0.0111198 -0.999797 0.0153193 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 3.99983 -0.000306205 0.0274509 4.0002 -0.0453016 0.00164027 +EDGE_SE3:QUAT 34 1624 -4.84592 4.20068 -0.165744 0.00986567 -0.00972255 -0.999903 0.00125027 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 3.99961 -0.000386092 0.0394665 4.00117 -0.0390077 0.000775908 +EDGE_SE3:QUAT 1625 1626 4.3784 -0.167214 -0.00683481 0.00037961 0.00570054 -0.0152656 0.999867 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 4.00052 -3.25738e-06 0.0456631 3.99987 -0.000348497 3.99959 +EDGE_SE3:QUAT 31 1625 4.4699 3.78458 -0.0929384 -0.000457551 -0.0156683 -0.999324 0.0332514 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 3.99999 9.29616e-05 -0.00183951 3.99904 -0.0623711 0.00539733 +EDGE_SE3:QUAT 32 1625 -0.372033 3.83084 -0.114816 0.000592819 -0.0146413 -0.999655 0.0218182 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 4 2.70961e-06 0.00237197 3.99914 -0.0585925 0.00276442 +EDGE_SE3:QUAT 33 1625 -4.91932 4.03013 -0.17726 0.00364203 -0.0157048 -0.99984 0.00771486 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 3.99995 -0.000215734 0.0145745 3.9992 -0.0630309 0.00128464 +EDGE_SE3:QUAT 1626 1627 4.50868 -0.196405 0.0143591 0.0012235 0.00251997 -0.0171471 0.999849 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 4.0001 9.86897e-06 0.020403 3.99997 -0.000175442 3.99893 +EDGE_SE3:QUAT 30 1626 4.70904 3.61017 -0.0735356 0.00262878 -0.0169474 -0.999363 0.0313059 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 3.99999 -0.000108893 0.0105298 3.9989 -0.0682727 0.00511471 +EDGE_SE3:QUAT 31 1626 0.0604157 3.63892 -0.0984239 0.00577017 -0.0159032 -0.999688 0.018385 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 3.99989 -0.000342566 0.0230999 3.99944 -0.0644095 0.00252305 +EDGE_SE3:QUAT 32 1626 -4.7376 3.81113 -0.133284 0.00716511 -0.0146797 -0.999844 0.0067863 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 3.99981 -0.000417184 0.0286711 3.99992 -0.0591106 0.00126323 +EDGE_SE3:QUAT 1627 1628 4.45958 -0.151169 0.0284431 0.000454493 -0.00290508 -0.012576 0.999917 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 4.00013 -7.79444e-06 -0.0231672 3.99997 0.000145625 3.9995 +EDGE_SE3:QUAT 29 1627 5.02069 3.48312 -0.0702481 0.00487028 -0.0179908 -0.99932 0.0318275 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 3.99995 -0.000280702 0.0195145 3.99896 -0.0730148 0.00548166 +EDGE_SE3:QUAT 30 1627 0.235959 3.50847 -0.0917453 0.0055329 -0.0186236 -0.99971 0.0142447 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 3.9999 -0.000381667 0.0221488 3.99903 -0.0750852 0.0023443 +EDGE_SE3:QUAT 31 1627 -4.42386 3.65647 -0.129863 0.00885966 -0.0170705 -0.999814 0.0014601 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 3.99969 -0.000604588 0.0354529 4.00008 -0.0684047 0.00149238 +EDGE_SE3:QUAT 1628 1629 4.45962 -0.174245 0.0101186 0.000265351 0.00261902 -0.0176246 0.999841 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 4.00011 -1.23632e-07 0.020999 3.99997 -0.000185155 3.99887 +EDGE_SE3:QUAT 28 1628 5.4824 3.38149 -0.10629 -0.000835532 -0.0219736 -0.999054 0.0375298 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 3.99998 0.000215111 -0.00336393 3.99813 -0.0873152 0.00754637 +EDGE_SE3:QUAT 29 1628 0.653529 3.35382 -0.0814387 0.00260426 -0.0182239 -0.999653 0.0188657 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 3.99999 -0.000141674 0.010426 3.99874 -0.0732135 0.00279178 +EDGE_SE3:QUAT 30 1628 -4.19504 3.52176 -0.120706 0.0033596 -0.0190941 -0.99981 0.00212253 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 3.99996 -0.000250813 0.0134457 3.99872 -0.0764234 0.00152379 +EDGE_SE3:QUAT 1629 1630 4.5905 -0.201537 0.0181564 0.000185858 0.00118931 -0.0217508 0.999763 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 4.00002 1.4576e-07 0.00955626 3.99999 -0.000104075 3.99813 +EDGE_SE3:QUAT 27 1629 5.05843 3.20195 -0.0818437 0.00211504 -0.0223989 -0.999093 0.036165 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 4 -4.49556e-05 0.00847143 3.998 -0.0898915 0.00727334 +EDGE_SE3:QUAT 28 1629 1.04756 3.21267 -0.0753229 0.00253279 -0.0218671 -0.999549 0.0204393 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 3.99999 -0.000144977 0.0101417 3.99814 -0.0877717 0.00362442 +EDGE_SE3:QUAT 29 1629 -3.84079 3.35759 -0.093143 0.00585379 -0.0183145 -0.999814 0.00148428 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 3.99987 -0.000425973 0.0234266 3.9992 -0.0733283 0.00149046 +EDGE_SE3:QUAT 1630 1631 4.22449 -0.221751 0.0253988 9.36988e-05 -0.000355006 -0.0283852 0.999597 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 4 -2.15085e-07 -0.00280472 4 3.96394e-05 3.99678 +EDGE_SE3:QUAT 26 1630 5.22014 3.04022 -0.0965048 0.00187456 -0.0225273 -0.999341 0.0283974 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 4 -5.4116e-05 0.00750633 3.99798 -0.0903307 0.00528232 +EDGE_SE3:QUAT 27 1630 0.472891 3.06939 -0.0883051 0.0038669 -0.0220953 -0.999648 0.0141986 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 3.99996 -0.000290076 0.015482 3.99823 -0.0887598 0.00283713 +EDGE_SE3:QUAT 28 1630 -3.51972 3.21772 -0.0906732 -0.00439837 0.0218303 0.999751 0.00115259 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 3.99992 -0.000387661 0.017606 3.99841 -0.0872688 0.00198746 +EDGE_SE3:QUAT 1631 1632 4.35221 -0.213366 0.0227815 -0.00254701 -0.00145924 -0.0233938 0.999722 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 4.00001 1.47538e-05 -0.0123791 3.99999 0.000147408 3.99785 +EDGE_SE3:QUAT 25 1631 5.66212 3.00296 -0.0941246 0.00142744 -0.0231075 -0.999631 0.0141866 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 4 -7.15379e-05 0.00571416 3.99788 -0.0925213 0.00295481 +EDGE_SE3:QUAT 26 1631 0.989998 3.00551 -0.094247 0.00198482 -0.0226552 -0.999741 0.000501486 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 3.99998 -0.000177679 0.00794533 3.99801 -0.0906073 0.00207022 +EDGE_SE3:QUAT 27 1631 -3.77402 3.17326 -0.0870579 -0.00456909 0.021759 0.999658 0.0137581 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 3.99989 -0.000441412 0.0182955 3.99851 -0.0864833 0.00271165 +EDGE_SE3:QUAT 1632 1633 4.29661 -0.151941 0.00800613 0.00053275 0.000751799 -0.0108589 0.999941 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 4.00001 1.47645e-06 0.00608276 4 -3.31427e-05 3.99954 +EDGE_SE3:QUAT 24 1632 5.65616 3.07285 -0.0591334 0.000778299 -0.0163638 -0.999841 0.00699447 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 4 -3.60003e-05 0.00311439 3.99893 -0.0654822 0.00127043 +EDGE_SE3:QUAT 25 1632 1.30964 3.07219 -0.0908219 -0.000377126 0.0205289 0.999749 0.00896583 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 4 -6.10824e-05 0.00151038 3.99832 -0.0820548 0.0020062 +EDGE_SE3:QUAT 26 1632 -3.31654 3.20796 -0.0987268 -0.00145368 0.0200154 0.999539 0.0227779 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 3.99998 -0.000186998 0.00582596 3.99847 -0.0796788 0.00367243 +EDGE_SE3:QUAT 1633 1634 4.35631 -0.129577 0.0161601 0.00166563 0.00275973 -0.00631414 0.999975 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 4.00011 1.7363e-05 0.0222032 3.99997 -6.99269e-05 3.99996 +EDGE_SE3:QUAT 23 1633 5.83881 3.18765 -0.0666695 5.20104e-05 -0.0157196 -0.999778 0.0140118 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 4 2.4412e-05 0.000207399 3.99901 -0.0628457 0.00177316 +EDGE_SE3:QUAT 24 1633 1.37975 3.17194 -0.0645848 -0.00170092 0.0169627 0.999847 0.0038057 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 3.99999 -0.000123815 0.0068069 3.9989 -0.0677878 0.00121864 +EDGE_SE3:QUAT 25 1633 -2.9449 3.30236 -0.0930233 -0.00123766 0.0211418 0.999581 0.0197406 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 3.99998 -0.00017365 0.00495957 3.99827 -0.0842719 0.00334181 +EDGE_SE3:QUAT 1634 1635 4.20828 -0.106098 0.0169031 0.00163221 -0.00160926 -0.00557198 0.999982 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 4.00003 -1.07292e-05 -0.0127644 3.99999 3.55605e-05 3.99992 +EDGE_SE3:QUAT 22 1634 5.65993 3.23238 -0.0673591 0.00307226 -0.0208696 -0.999468 0.0248698 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 3.99998 -0.000172953 0.0123042 3.99834 -0.0839444 0.00427535 +EDGE_SE3:QUAT 23 1634 1.51098 3.19486 -0.0478791 0.00321024 -0.0176165 -0.999808 0.0078958 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 3.99997 -0.000208232 0.0128477 3.9989 -0.0706505 0.00153891 +EDGE_SE3:QUAT 24 1634 -2.96107 3.33633 -0.0688464 -0.00512099 0.0190654 0.999758 0.00973518 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 3.99988 -0.000411993 0.0204981 3.99901 -0.075843 0.00192261 +EDGE_SE3:QUAT 1635 1636 4.18615 -0.0845266 0.0254468 -0.00464139 0.00333776 -0.0055518 0.999968 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 4.00009 -6.24713e-05 0.0263918 3.99996 -7.42e-05 4.00005 +EDGE_SE3:QUAT 21 1635 5.45777 3.13298 -0.119215 -0.00466546 -0.0250908 -0.999255 0.0289373 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 3.99985 0.000591697 -0.0187098 3.99801 -0.09906 0.00589348 +EDGE_SE3:QUAT 22 1635 1.47332 3.14236 -0.0683572 0.00186867 -0.0224983 -0.999564 0.0190429 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 4 -9.16522e-05 0.0074815 3.998 -0.090174 0.00349911 +EDGE_SE3:QUAT 23 1635 -2.71437 3.24405 -0.0523741 0.00203534 -0.0190119 -0.999814 0.00246306 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 3.99998 -0.000147788 0.00814571 3.99862 -0.0760746 0.00148819 +EDGE_SE3:QUAT 1636 1637 4.71497 -0.139613 0.0348208 0.00204922 -0.000116927 -0.0053658 0.999983 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 3.99998 -7.79512e-07 -0.000803425 4 2.038e-06 3.99988 +EDGE_SE3:QUAT 20 1636 5.87112 2.97636 -0.0223156 0.00604351 -0.0178198 -0.999239 0.0341708 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 3.99991 -0.000366148 0.0242213 3.99915 -0.0727208 0.00614117 +EDGE_SE3:QUAT 21 1636 1.30247 2.97948 -0.0434244 -0.000957881 -0.0200135 -0.999517 0.023738 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 3.99999 0.000151268 -0.00384066 3.99844 -0.0797445 0.00384897 +EDGE_SE3:QUAT 22 1636 -2.68922 3.06975 -0.0511209 0.00583159 -0.0177654 -0.999731 0.0136888 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 3.99989 -0.000389701 0.0233431 3.99921 -0.0716676 0.00217025 +EDGE_SE3:QUAT 1637 1638 4.19205 -0.122098 0.0268189 0.00301926 0.00184332 -0.00540729 0.999979 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 4.00002 2.22054e-05 0.0149418 3.99999 -4.03232e-05 3.99994 +EDGE_SE3:QUAT 19 1637 5.32486 2.77309 -0.0627117 0.00217966 -0.0195954 -0.998907 0.0423839 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 4 -4.15081e-05 0.00873269 3.99848 -0.0787529 0.00875853 +EDGE_SE3:QUAT 20 1637 1.1494 2.79004 -0.0391009 0.00633578 -0.0200075 -0.999377 0.0283749 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 3.99989 -0.000437075 0.0253841 3.99888 -0.0813034 0.00503597 +EDGE_SE3:QUAT 21 1637 -3.40104 2.90652 -0.00195276 -0.000789879 -0.0228116 -0.99958 0.017873 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 3.99999 0.000145644 -0.00316619 3.99795 -0.0910378 0.00335398 +EDGE_SE3:QUAT 1638 1639 4.03208 -0.140343 0.0352138 -0.00174759 0.000223705 -0.0242364 0.999705 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 3.99999 -9.8757e-07 0.00127999 4 -1.3453e-05 3.99765 +EDGE_SE3:QUAT 18 1638 5.27338 2.73593 -0.0364283 0.0068588 -0.0192965 -0.996922 0.0756817 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 3.99994 -0.0003458 0.027616 3.99884 -0.0802067 0.0247198 +EDGE_SE3:QUAT 19 1638 1.13481 2.53469 -0.0416504 0.00445244 -0.0226127 -0.999065 0.036566 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 3.99997 -0.000262459 0.0178474 3.99812 -0.0914314 0.00752162 +EDGE_SE3:QUAT 20 1638 -3.032 2.65721 -0.0606195 0.00835259 -0.0230861 -0.999432 0.0230754 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 3.99979 -0.00070495 0.0334602 3.99878 -0.0937677 0.00460957 +EDGE_SE3:QUAT 1639 1640 4.26433 -0.485648 0.0221284 -7.93151e-05 0.00127944 -0.120986 0.992653 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 4.00002 -4.93281e-06 0.00989763 3.99999 -0.000591849 3.94147 +EDGE_SE3:QUAT 17 1639 4.95508 2.83287 -0.0288672 0.00474301 -0.00451255 -0.986962 0.160821 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 3.99997 -0.00011067 0.0195446 4.00011 -0.0228396 0.103684 +EDGE_SE3:QUAT 18 1639 1.28178 2.25424 -0.0505188 0.00750178 -0.0169003 -0.998508 0.0513855 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 3.99987 -0.000438753 0.0301199 3.99946 -0.0702365 0.0120257 +EDGE_SE3:QUAT 19 1639 -2.88914 2.37381 -0.0396139 0.00534216 -0.0204832 -0.999704 0.0119986 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 3.99991 -0.00040444 0.0213857 3.99872 -0.0824102 0.00238878 +EDGE_SE3:QUAT 1640 1641 4.20907 -0.9773 -0.0121778 -0.0196755 -0.0114269 -0.236021 0.971482 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 4.00315 3.18928e-05 -0.137647 3.99875 0.0180342 3.78187 +EDGE_SE3:QUAT 16 1640 4.04242 2.69346 -0.0371051 -0.000777905 0.00585171 -0.977078 0.212801 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 3.99999 3.81918e-05 -0.00286441 3.99988 0.0220633 0.181267 +EDGE_SE3:QUAT 17 1640 0.78026 1.91822 -0.0404276 0.00639995 -0.00394543 -0.999161 0.0402481 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 3.99985 -0.000132915 0.0256604 4.00054 -0.0177789 0.00672364 +EDGE_SE3:QUAT 18 1640 -2.97561 2.27496 -0.0888216 -0.0110127 0.0161792 0.997379 0.0696627 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 3.99932 -0.000600627 0.0444214 4.0015 -0.0578655 0.020749 +EDGE_SE3:QUAT 1641 1642 4.30548 -1.13435 -0.0153259 0.00730837 0.00797018 -0.2148 0.976598 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 4.00129 -0.000157981 0.0776823 3.99964 -0.008845 3.81695 +EDGE_SE3:QUAT 14 1641 6.58383 3.22906 -0.0238646 -0.00466606 0.0158649 -0.94156 0.336439 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 3.99984 0.000388046 -0.0167169 3.99908 0.057359 0.453782 +EDGE_SE3:QUAT 15 1641 3.21091 2.39907 0.0165386 0.00388882 0.0197618 -0.975198 0.220416 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 3.99948 0.000548673 0.0183459 3.99996 0.0631018 0.195491 +EDGE_SE3:QUAT 16 1641 -0.210909 1.80966 -0.0359248 0.0172741 -0.0220003 0.999306 0.0246036 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 3.99866 -0.00142995 -0.0691931 4.00329 0.0845987 0.00540729 +EDGE_SE3:QUAT 17 1641 -3.50413 2.54994 -0.101757 0.00503262 -0.0164003 0.98023 0.197116 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 3.99956 -0.000373067 -0.0222766 4.00033 0.0517029 0.156256 +EDGE_SE3:QUAT 1642 1643 4.00108 -0.513873 -0.0106495 0.00110821 0.00260582 -0.0952538 0.995449 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 4.00011 -4.47773e-06 0.0218231 3.99997 -0.00105483 3.96383 +EDGE_SE3:QUAT 13 1642 6.48533 1.52982 0.00715442 0.00184407 0.00441128 -0.988444 0.151514 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 3.99996 3.01894e-05 0.00774869 4.00004 0.0144571 0.0918953 +EDGE_SE3:QUAT 14 1642 2.50938 1.37638 -0.01378 0.00186949 0.0102583 -0.991921 0.126431 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 3.99993 0.000145946 0.00782242 3.9998 0.0375424 0.0643143 +EDGE_SE3:QUAT 15 1642 -1.16701 1.5766 -0.027898 0.00895726 0.0145389 -0.999837 0.00582645 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 3.99967 0.000519648 0.0358405 4.00047 0.057753 0.00129061 +EDGE_SE3:QUAT 16 1642 -4.42984 3.15486 0.148311 0.0138062 -0.0103182 0.970929 0.238748 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 3.99907 0.000747232 -0.060851 4.00377 0.0106463 0.229025 +EDGE_SE3:QUAT 1643 1644 4.11446 -0.320664 -8.21395e-05 -0.00511068 0.000559438 -0.0669708 0.997742 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 3.9999 2.59392e-06 0.000350404 4 3.44464e-05 3.98206 +EDGE_SE3:QUAT 12 1643 6.74219 1.32807 0.0177318 0.00417301 -0.000456552 -0.993291 0.115563 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 3.99994 -5.29582e-05 0.0170174 4.00026 -0.00557255 0.0535 +EDGE_SE3:QUAT 13 1643 2.52001 0.827486 -0.0126175 0.00427407 0.00392687 -0.998359 0.056971 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 3.99991 4.57728e-05 0.0171851 4.00027 0.0136399 0.0131036 +EDGE_SE3:QUAT 14 1643 -1.46656 0.863543 -0.0258173 0.00380259 0.00991344 -0.999452 0.0313497 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 3.99992 0.000162108 0.0152373 3.9999 0.0386055 0.00436229 +EDGE_SE3:QUAT 15 1643 -5.14691 2.04531 -0.0854837 -0.0103297 -0.0143849 0.995742 0.0904661 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 3.99978 0.000601362 0.0417535 4.00026 0.0637995 0.0341999 +EDGE_SE3:QUAT 1644 1645 3.98079 -0.480287 -0.00196443 0.00295626 0.00539958 -0.106253 0.99432 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 4.0005 -1.32974e-05 0.0462133 3.99987 -0.00250735 3.95537 +EDGE_SE3:QUAT 11 1644 6.47588 1.77966 0.00277929 0.00023739 0.00431194 -0.985209 0.171305 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 3.99999 2.41661e-05 0.00116393 3.99995 0.0156797 0.117445 +EDGE_SE3:QUAT 12 1644 2.64467 0.720028 -0.0128682 0.00405762 0.0052798 -0.998782 0.0488826 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 3.99992 7.39973e-05 0.0162938 4.0002 0.0194119 0.00971904 +EDGE_SE3:QUAT 13 1644 -1.59029 0.640093 -0.0411105 -0.00461882 -0.00921885 0.99989 0.0106187 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 3.99992 0.000168251 0.0184805 3.99998 0.0372599 0.000883519 +EDGE_SE3:QUAT 14 1644 -5.57944 0.910414 -0.0511808 -0.00389358 -0.0151331 0.999226 0.036108 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 3.99997 0.000178041 0.0156037 3.99923 0.0614548 0.00622163 +EDGE_SE3:QUAT 1645 1646 4.09062 -0.701715 0.000976882 3.60877e-05 0.000264421 -0.158177 0.987411 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 4 -2.28608e-07 0.00210383 4 -0.000166062 3.89992 +EDGE_SE3:QUAT 10 1645 6.52799 2.03487 0.0166483 0.00305798 0.00556502 -0.978782 0.204807 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 3.99991 2.3177e-05 0.0133593 4.0002 0.0151613 0.167893 +EDGE_SE3:QUAT 11 1645 2.57345 0.86924 0.00454204 0.00585219 0.00249895 -0.997819 0.0657003 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 3.99985 4.13797e-06 0.023565 4.00056 0.00682664 0.0174173 +EDGE_SE3:QUAT 12 1645 -1.33729 0.795487 -0.0376276 -0.00946563 -0.00311902 0.998302 0.057388 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 3.99968 0.00023033 0.0380445 4.0013 0.0167131 0.0136065 +EDGE_SE3:QUAT 13 1645 -5.51538 1.2153 -0.0620265 -0.00920274 -0.00717267 0.993084 0.116823 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 3.9998 0.000393761 0.0374706 4.00076 0.0362121 0.0552765 +EDGE_SE3:QUAT 1646 1647 4.30177 -0.736715 0.0123525 0.00454295 -0.000623928 -0.139559 0.990203 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 3.99992 1.19082e-05 0.00266304 4 -0.000366199 3.92209 +EDGE_SE3:QUAT 9 1646 6.29759 2.14226 0.00706908 0.0043935 0.00463255 -0.983302 0.181869 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 3.99988 -1.27805e-05 0.0186465 4.00038 0.0108361 0.132427 +EDGE_SE3:QUAT 10 1646 2.50965 1.0401 -0.00614604 0.00235437 0.00600132 -0.998858 0.0473332 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 3.99997 6.17281e-05 0.00945462 3.99998 0.0229819 0.00911647 +EDGE_SE3:QUAT 11 1646 -1.56252 1.02355 -0.0350646 -0.00561118 -0.00325137 0.995653 0.0929103 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 3.99991 0.000124559 0.0227132 4.00037 0.0168629 0.0347308 +EDGE_SE3:QUAT 12 1646 -5.27903 1.93672 -0.103722 -0.00906267 -0.00438426 0.976587 0.214887 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 3.99988 0.00040898 0.0383306 4.00071 0.0304155 0.185323 +EDGE_SE3:QUAT 1647 1648 4.3708 -0.561232 0.00753037 0.00390513 0.00439183 -0.0896923 0.995952 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 4.00032 2.94998e-05 0.0388947 3.9999 -0.00179899 3.9682 +EDGE_SE3:QUAT 8 1647 6.08425 1.78125 0.0199025 0.00208025 0.00830931 -0.991584 0.12918 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 3.99993 0.000104021 0.00867074 3.99993 0.0297457 0.0669943 +EDGE_SE3:QUAT 9 1647 2.01279 1.27681 -0.0207622 0.00417169 0.000353982 -0.999074 0.0428286 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 3.99993 -1.20519e-05 0.0167327 4.00028 -1.73195e-05 0.00740727 +EDGE_SE3:QUAT 10 1647 -1.82708 1.35269 -0.00352222 -0.00117633 -0.00132619 0.995761 0.0919646 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 4 7.16493e-06 0.00475639 4.00001 0.00605107 0.0338448 +EDGE_SE3:QUAT 11 1647 -5.62359 2.52428 -0.0679914 -0.00436507 0.00105027 0.973096 0.230356 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 3.99994 9.0107e-05 0.0188966 4.0003 0.00396378 0.212354 +EDGE_SE3:QUAT 1648 1649 4.37412 -0.178264 0.0165824 0.00113546 -0.00400328 -0.0161481 0.999861 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 4.00025 -2.41526e-05 -0.0317954 3.99994 0.000256567 3.99921 +EDGE_SE3:QUAT 7 1648 6.18265 1.23585 0.04879 0.00834706 0.00627002 -0.997986 0.062577 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 3.99968 0.000111913 0.0335953 4.00111 0.0206805 0.0160543 +EDGE_SE3:QUAT 8 1648 1.74706 1.21064 0.00524288 0.0062173 0.00509156 -0.999189 0.0394609 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 3.99983 9.51599e-05 0.0249298 4.00057 0.0183312 0.00646841 +EDGE_SE3:QUAT 9 1648 -2.34762 1.46064 -0.0535503 -0.00892494 0.00322366 0.998861 0.0467576 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 3.99967 -2.59852e-05 0.0358178 4.00129 -0.00949691 0.00908917 +EDGE_SE3:QUAT 10 1648 -5.95403 2.69279 -0.00508378 -0.00550117 0.00318545 0.983509 0.180747 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 3.99986 7.62823e-05 0.0232062 4.00055 -0.00401876 0.130821 +EDGE_SE3:QUAT 1649 1650 4.25211 -0.0853315 0.00509129 -0.00220196 0.00410603 -0.00387816 0.999982 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 4.00025 -3.75836e-05 0.0327467 3.99993 -6.43295e-05 4.00021 +EDGE_SE3:QUAT 6 1649 5.91158 0.752835 -0.0102756 -0.000667923 0.00371734 -0.999008 0.0443746 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 4 -5.23034e-06 -0.00267701 3.99995 0.0150328 0.0079348 +EDGE_SE3:QUAT 7 1649 1.83169 0.878425 -0.00373686 0.00457592 0.00554793 -0.998881 0.0467488 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 3.9999 8.6032e-05 0.0183685 4.00027 0.0203653 0.00893028 +EDGE_SE3:QUAT 8 1649 -2.59846 1.0354 -0.0332926 0.00275685 0.00352043 -0.999701 0.0240286 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 3.99997 3.64642e-05 0.0110375 4.00008 0.0135323 0.00238577 +EDGE_SE3:QUAT 9 1649 -6.63096 2.03369 -0.123838 -0.00552368 0.00457362 0.998022 0.0624485 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 3.99986 -5.96776e-05 0.0222323 4.00048 -0.0153702 0.0157827 +EDGE_SE3:QUAT 1650 1651 4.08575 -0.0925979 0.0155685 0.00527495 0.00647773 0.00636033 0.999945 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 4.00055 0.000141652 0.0514213 3.99984 0.000168416 4.0005 +EDGE_SE3:QUAT 5 1650 6.21574 0.321562 -0.0366492 -0.00416862 0.0105567 -0.999315 0.0352112 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 3.99995 -0.000155964 -0.0167044 3.99976 0.0432694 0.00549779 +EDGE_SE3:QUAT 6 1650 1.66239 0.480254 0.00021061 0.00330497 0.00613624 -0.999161 0.0403607 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 3.99994 8.05394e-05 0.0132559 4.00006 0.0233809 0.00669684 +EDGE_SE3:QUAT 7 1650 -2.38631 0.580169 -0.0447687 0.00864521 0.00753401 -0.99901 0.0429944 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 3.99966 0.0001956 0.0346816 4.0011 0.0270399 0.00787848 +EDGE_SE3:QUAT 8 1650 -6.82493 0.948098 -0.0528068 0.00662836 0.00573836 -0.999748 0.0206518 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 3.99981 0.000134863 0.0265312 4.00061 0.0218394 0.00200132 +EDGE_SE3:QUAT 1651 1652 4.1204 -0.0152244 0.0151391 -0.00753493 0.00135794 0.00300757 0.999966 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 3.9998 -4.21514e-05 0.0111345 3.99999 1.65335e-05 3.99999 +EDGE_SE3:QUAT 4 1651 6.27522 0.0188935 0.00773556 0.00247589 -0.000594239 -0.999368 0.0354571 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 3.99998 -1.08723e-05 0.00992197 4.00009 -0.00307102 0.00505583 +EDGE_SE3:QUAT 5 1651 2.12195 0.108139 0.00978795 0.00259779 0.00553805 -0.999142 0.0409544 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 3.99996 5.93688e-05 0.0104207 4.00001 0.0212103 0.00684892 +EDGE_SE3:QUAT 6 1651 -2.40022 0.216895 -0.00683457 0.0101848 0.000811627 -0.998873 0.0463557 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 3.99959 -8.27868e-05 0.0408688 4.00167 -0.000540699 0.009014 +EDGE_SE3:QUAT 7 1651 -6.44917 0.326625 -0.0791651 0.0156608 0.00366028 -0.998661 0.0491758 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 3.99899 -6.2069e-05 0.0628652 4.00398 0.00841573 0.0106815 +EDGE_SE3:QUAT 1652 1653 4.15696 -0.240089 0.0484517 0.00579958 0.0068985 -0.0778036 0.996928 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 4.00077 7.72162e-05 0.0600903 3.99977 -0.00239498 3.97669 +EDGE_SE3:QUAT 3 1652 6.38393 -0.293055 -0.08547 -0.00617668 0.015476 -0.998723 0.047696 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 3.99991 -0.000321448 -0.0247858 3.99945 0.0639054 0.0102768 +EDGE_SE3:QUAT 4 1652 2.18256 -0.269426 0.00327167 0.0034979 0.0070275 -0.999227 0.0385315 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 3.99994 9.98439e-05 0.0140268 4.00005 0.0269306 0.00616958 +EDGE_SE3:QUAT 5 1652 -1.96145 -0.17553 2.08753e-05 0.00404134 0.0135461 -0.998932 0.0439796 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 3.99989 0.000259037 0.0162258 3.99965 0.0525052 0.00849343 +EDGE_SE3:QUAT 6 1652 -6.4326 -0.112862 -0.0837512 0.0123166 0.00977851 -0.998623 0.0500463 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 3.99931 0.000319934 0.0494601 4.00232 0.0339789 0.0109211 +EDGE_SE3:QUAT 1653 1654 3.92796 -0.955001 0.0183337 -0.00199735 -0.011907 -0.252282 0.967578 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 4.0021 -0.000750329 -0.0921413 3.99963 0.0114869 3.74753 +EDGE_SE3:QUAT 2 1653 6.54774 -0.419841 0.0728622 -0.015764 -0.00801408 0.999736 0.0146745 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 3.99904 0.000585279 0.0630761 4.00363 0.0339343 0.00214398 +EDGE_SE3:QUAT 3 1653 2.22521 -0.473007 0.0193753 0.000248367 -0.00955622 0.999498 0.0302105 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 4 -3.12883e-05 -0.000997276 3.99964 0.038076 0.00401375 +EDGE_SE3:QUAT 4 1653 -1.9398 -0.368043 0.0222743 -0.0100867 -0.00149985 0.999187 0.0390054 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 3.99961 0.000153452 0.0404366 4.00158 0.00912477 0.00651595 +EDGE_SE3:QUAT 5 1653 -6.09442 -0.317928 0.0120939 -0.0100738 -0.00834225 0.999353 0.0334923 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 3.99964 0.000393381 0.0403642 4.00121 0.0359893 0.00521869 +EDGE_SE3:QUAT 1654 1655 4.10279 -1.20909 -0.0179888 0.0034339 0.00747838 -0.259653 0.965667 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 4.00098 -0.000289674 0.0641131 3.9998 -0.00851073 3.73135 +EDGE_SE3:QUAT 1 1654 6.80609 0.55539 0.0531633 -0.0015676 -0.0165327 0.964748 0.262652 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 3.99981 -0.000390547 0.00448336 3.99921 0.0580667 0.276869 +EDGE_SE3:QUAT 2 1654 2.65452 0.638271 -0.00205286 -0.00160224 -0.0135109 0.963817 0.266219 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 3.99988 -0.000258839 0.00501121 3.99945 0.0478768 0.284122 +EDGE_SE3:QUAT 3 1654 -1.6109 0.704777 0.0640753 0.0140825 -0.011224 0.959526 0.281045 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 3.99907 0.00106588 -0.0645776 4.00408 0.00711225 0.317102 +EDGE_SE3:QUAT 4 1654 -5.77663 0.87977 -0.0293589 0.00229129 -0.00664123 0.957117 0.289618 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 3.9999 -2.0022e-05 -0.0115343 4.00018 0.0162986 0.33563 +EDGE_SE3:QUAT 1655 1656 3.92864 -0.702978 0.000953771 -0.00371143 0.00142667 -0.14937 0.988773 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 3.99995 -5.96439e-06 0.0044798 4 -0.000159379 3.91076 +EDGE_SE3:QUAT 1 1655 3.89772 3.67134 0.0944305 -0.00320542 -0.0112546 0.86339 0.504402 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 3.99976 -0.000214898 0.00514812 3.99982 0.0287344 1.01804 +EDGE_SE3:QUAT 2 1655 -0.23959 3.78344 0.0247867 -0.00440455 -0.00811962 0.861494 0.507684 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 3.9999 -0.000154026 0.0145021 3.99976 0.0268335 1.03129 +EDGE_SE3:QUAT 3 1655 -4.38741 3.93031 0.192891 0.0102101 -0.0020792 0.853815 0.520472 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 4.00025 0.00089524 -0.0561254 4.00086 -0.0277578 1.08466 +EDGE_SE3:QUAT 1656 1657 4.07595 -0.477979 -0.00176339 0.0038547 -0.00102997 -0.0909059 0.995851 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 3.99994 -5.672e-06 -0.00395585 4 0.000114573 3.96695 +EDGE_SE3:QUAT 1657 1658 4.19805 -0.240542 0.0378044 0.00229015 0.0030218 -0.0257697 0.999661 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 4.00013 2.28284e-05 0.0248589 3.99996 -0.000322747 3.9975 +EDGE_SE3:QUAT 1658 1659 4.24184 -0.061526 0.0197744 0.00578879 -0.00019708 -0.00536722 0.999969 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 3.99987 -3.12739e-06 -0.00120367 4 2.90013e-06 3.99989 +EDGE_SE3:QUAT 1659 1660 4.21884 -0.184745 0.00856371 0.00395105 0.00187026 0.0429952 0.999066 1 0 0 0 0 0 1 0 0 0 0 1 0 0 0 3.99998 2.69577e-05 0.0128844 3.99999 0.000262348 3.99265 diff --git a/symforce/examples/pose_graph_optimization/pgo.py b/symforce/examples/pose_graph_optimization/pgo.py new file mode 100644 index 00000000..1ae9dcee --- /dev/null +++ b/symforce/examples/pose_graph_optimization/pgo.py @@ -0,0 +1,89 @@ +# ---------------------------------------------------------------------------- +# SymForce - Copyright 2022, Skydio, Inc. +# This source code is under the Apache 2.0 license found in the LICENSE file. +# ---------------------------------------------------------------------------- + +import symforce + +symforce.set_epsilon_to_symbol() +symforce.set_log_level("info") + +# In general, you want to make sure symengine is installed and being used correctly, the sympy +# symbolic API is very slow +assert symforce.get_symbolic_api() == "symengine" + +import plotly.graph_objects as go +from tqdm import tqdm + +import symforce.symbolic as sf +from symforce.opt.factor import Factor +from symforce.opt.optimizer import Optimizer +from symforce.opt.optimizer import OptimizerParams +from symforce.values import Values + +from . import pgo_dataset + + +def main() -> None: + ids, edges, values = pgo_dataset.load("parking-garage.g2o") + + values["epsilon"] = sf.numeric_epsilon + + print(f"Num poses: {len(ids)}") + print(f"Num edges: {len(edges)}") + + def residual( + world_T_p0: sf.Pose3, + world_T_p1: sf.Pose3, + p0_T_p1: sf.Pose3, + sqrt_info: sf.M66, + epsilon: sf.Scalar, + ) -> sf.M: + unwhitened_residual = sf.V6( + (world_T_p0.inverse() * world_T_p1 * p0_T_p1.inverse()).to_tangent(epsilon) + ) + return sqrt_info * unwhitened_residual + + factors = [] + for i, j in tqdm(edges): + factors.append( + Factor([f"p_{i}", f"p_{j}", f"e_{i}_{j}", f"i_{i}_{j}", "epsilon"], residual) + ) + + params = OptimizerParams(debug_stats=True, verbose=True) + + optimizer = Optimizer(factors, [f"p_{i}" for i in ids], params=params) + + result = optimizer.optimize(values) + + def draw_graph(values: Values, name: str) -> tuple[go.Scatter3d, go.Scatter3d]: + poses = {i: values[f"p_{i}"] for i in ids} + trace1 = go.Scatter3d( + x=[poses[i].t[0, 0] for i in ids], + y=[poses[i].t[1, 0] for i in ids], + z=[poses[i].t[2, 0] for i in ids], + mode="markers", + name=f"{name} Points", + ) + x_lines, y_lines, z_lines = [], [], [] + for e in edges: + for i in range(2): + x_lines.append(poses[e[i]].t[0, 0]) + y_lines.append(poses[e[i]].t[1, 0]) + z_lines.append(poses[e[i]].t[2, 0]) + x_lines.append(None) + y_lines.append(None) + z_lines.append(None) + + trace2 = go.Scatter3d(x=x_lines, y=y_lines, z=z_lines, mode="lines", name=f"{name} Edges") + + return trace1, trace2 + + fig = go.Figure( + data=draw_graph(values, "Original") + draw_graph(result.optimized_values, "Optimized") + ) + fig.show() + + +if __name__ == "__main__": + main() diff --git a/symforce/examples/pose_graph_optimization/pgo_dataset.py b/symforce/examples/pose_graph_optimization/pgo_dataset.py new file mode 100644 index 00000000..cd14a40d --- /dev/null +++ b/symforce/examples/pose_graph_optimization/pgo_dataset.py @@ -0,0 +1,62 @@ +# ---------------------------------------------------------------------------- +# SymForce - Copyright 2022, Skydio, Inc. +# This source code is under the Apache 2.0 license found in the LICENSE file. +# ---------------------------------------------------------------------------- + +import numpy as np + +import symforce.symbolic as sf +from symforce import typing as T +from symforce.values import Values + + +def load(filename: T.Openable) -> tuple[list[int], list[tuple[int, int]], Values]: + """ + Load a g2o file and return the pose IDs, edges (pairs of pose IDs) and values (initial poses, + relative pose measurements and their sqrt information matrices) + """ + + def to_float(l: T.Sequence[str]) -> list[float]: + return [float(x) for x in l] + + def pose_from_g2o(l: T.Sequence[str]) -> sf.Pose3: + storage_g2o = to_float(l) + return sf.Pose3(R=sf.Rot3.from_storage(storage_g2o[3:]), t=sf.V3(storage_g2o[:3])) + + ids = [] + edges = [] + values = Values() + + with open(filename) as f: + for line_str in f: + line = line_str.split() + if line[0] == "VERTEX_SE3:QUAT": + i = int(line[1]) + ids.append(i) + values[f"p_{i}"] = pose_from_g2o(line[2:]) + elif line[0] == "EDGE_SE3:QUAT": + i, j = int(line[1]), int(line[2]) + edges.append((i, j)) + values[f"e_{i}_{j}"] = pose_from_g2o(line[3:10]) + + # Check frame + values[f"i_{i}_{j}"] = info_storage_to_sqrt_info(to_float(line[10:])) + + return ids, edges, values.to_numerical() + + +def info_storage_to_sqrt_info(info_storage: T.Sequence[float]) -> np.ndarray: + info = np.zeros((6, 6)) + ix = 0 + for i in range(info.shape[0]): + info[i, i:] = info_storage[ix : ix + (6 - i)] + info[i:, i] = info_storage[ix : ix + (6 - i)] + ix += 6 - i + + info = info[(3, 4, 5, 0, 1, 2), :] + info = info[:, (3, 4, 5, 0, 1, 2)] + + # Convert the information matrix to a square root information matrix + sqrt_info = np.linalg.cholesky(info).T + + return sqrt_info From 7b01ab6fab76d0791bc125a2f264a9b8464440d1 Mon Sep 17 00:00:00 2001 From: Skydio Buildkite Worker Date: Thu, 10 Sep 2026 03:16:33 +0000 Subject: [PATCH 23/68] [SymForce] Upgrade pinned depenencies GitOrigin-RevId: c7f5580bec849f41719b786a0d4ced1bef951d54 --- requirements/dev_py310.txt | 6 +++--- requirements/dev_py311.txt | 6 +++--- requirements/dev_py312.txt | 6 +++--- requirements/dev_py313.txt | 6 +++--- requirements/dev_py314.txt | 6 +++--- 5 files changed, 15 insertions(+), 15 deletions(-) diff --git a/requirements/dev_py310.txt b/requirements/dev_py310.txt index a17f1900..0e948d82 100644 --- a/requirements/dev_py310.txt +++ b/requirements/dev_py310.txt @@ -126,7 +126,7 @@ mdit-py-plugins==0.5.0 # via myst-parser mdurl==0.1.2 # via markdown-it-py -mistune==3.3.0 +mistune==3.3.3 # via nbconvert mpmath==1.3.0 # via sympy @@ -187,7 +187,7 @@ pexpect==4.9.0 # via ipython pillow==12.3.0 # via matplotlib -pip==26.1.2 +pip==26.2 # via symforce (pyproject.toml) platformdirs==4.5.1 # via jupyter-core @@ -302,7 +302,7 @@ tomli==2.4.0 # mypy # setuptools-scm # sphinx -tornado==6.5.7 +tornado==6.5.8 # via # ipykernel # jupyter-client diff --git a/requirements/dev_py311.txt b/requirements/dev_py311.txt index 88d8666e..88bae80b 100644 --- a/requirements/dev_py311.txt +++ b/requirements/dev_py311.txt @@ -126,7 +126,7 @@ mdit-py-plugins==0.5.0 # via myst-parser mdurl==0.1.2 # via markdown-it-py -mistune==3.3.0 +mistune==3.3.3 # via nbconvert mpmath==1.3.0 # via sympy @@ -187,7 +187,7 @@ pexpect==4.9.0 # via ipython pillow==12.3.0 # via matplotlib -pip==26.1.2 +pip==26.2 # via symforce (pyproject.toml) platformdirs==4.5.1 # via jupyter-core @@ -298,7 +298,7 @@ sympy==1.13.3 # via symforce (pyproject.toml) tinycss2==1.4.0 # via bleach -tornado==6.5.7 +tornado==6.5.8 # via # ipykernel # jupyter-client diff --git a/requirements/dev_py312.txt b/requirements/dev_py312.txt index 496763f0..9f1a401c 100644 --- a/requirements/dev_py312.txt +++ b/requirements/dev_py312.txt @@ -126,7 +126,7 @@ mdit-py-plugins==0.5.0 # via myst-parser mdurl==0.1.2 # via markdown-it-py -mistune==3.3.0 +mistune==3.3.3 # via nbconvert mpmath==1.3.0 # via sympy @@ -187,7 +187,7 @@ pexpect==4.9.0 # via ipython pillow==12.3.0 # via matplotlib -pip==26.1.2 +pip==26.2 # via symforce (pyproject.toml) platformdirs==4.5.1 # via jupyter-core @@ -298,7 +298,7 @@ sympy==1.13.3 # via symforce (pyproject.toml) tinycss2==1.4.0 # via bleach -tornado==6.5.7 +tornado==6.5.8 # via # ipykernel # jupyter-client diff --git a/requirements/dev_py313.txt b/requirements/dev_py313.txt index e4160208..94fb4ab8 100644 --- a/requirements/dev_py313.txt +++ b/requirements/dev_py313.txt @@ -126,7 +126,7 @@ mdit-py-plugins==0.5.0 # via myst-parser mdurl==0.1.2 # via markdown-it-py -mistune==3.3.0 +mistune==3.3.3 # via nbconvert mpmath==1.3.0 # via sympy @@ -187,7 +187,7 @@ pexpect==4.9.0 # via ipython pillow==12.3.0 # via matplotlib -pip==26.1.2 +pip==26.2 # via symforce (pyproject.toml) platformdirs==4.5.1 # via jupyter-core @@ -298,7 +298,7 @@ sympy==1.13.3 # via symforce (pyproject.toml) tinycss2==1.4.0 # via bleach -tornado==6.5.7 +tornado==6.5.8 # via # ipykernel # jupyter-client diff --git a/requirements/dev_py314.txt b/requirements/dev_py314.txt index 0039d361..7ab1fc5e 100644 --- a/requirements/dev_py314.txt +++ b/requirements/dev_py314.txt @@ -126,7 +126,7 @@ mdit-py-plugins==0.5.0 # via myst-parser mdurl==0.1.2 # via markdown-it-py -mistune==3.3.0 +mistune==3.3.3 # via nbconvert mpmath==1.3.0 # via sympy @@ -187,7 +187,7 @@ pexpect==4.9.0 # via ipython pillow==12.3.0 # via matplotlib -pip==26.1.2 +pip==26.2 # via symforce (pyproject.toml) platformdirs==4.5.1 # via jupyter-core @@ -300,7 +300,7 @@ sympy==1.13.3 # via symforce (pyproject.toml) tinycss2==1.4.0 # via bleach -tornado==6.5.7 +tornado==6.5.8 # via # ipykernel # jupyter-client From 4ee8e6fea94689bbfb9159859a1d43f4c5e6fd69 Mon Sep 17 00:00:00 2001 From: Brian Kubisiak Date: Thu, 17 Sep 2026 19:14:43 +0000 Subject: [PATCH 24/68] [SymForce] Support new fmtlib Upgrade fmt to 12.2.0 (the latest tagged release) Signed-off-by: Brian Kubisiak GitOrigin-RevId: dede9296e9d4619352aa54d940d52aa7bb7c58e5 --- CMakeLists.txt | 30 ++++++++ cmake/patch_spdlog.sh | 22 ++++++ cmake/spdlog-fmt-fstring-get.patch | 36 ++++++++++ cmake/spdlog-fmt-runtime.patch | 40 +++++++++++ gen/cpp/sym/atan_camera_cal.h | 12 ++++ gen/cpp/sym/double_sphere_camera_cal.h | 12 ++++ gen/cpp/sym/equirectangular_camera_cal.h | 12 ++++ gen/cpp/sym/linear_camera_cal.h | 12 ++++ gen/cpp/sym/orthographic_camera_cal.h | 12 ++++ gen/cpp/sym/polynomial_camera_cal.h | 12 ++++ gen/cpp/sym/pose2.h | 12 ++++ gen/cpp/sym/pose3.h | 12 ++++ gen/cpp/sym/rot2.h | 12 ++++ gen/cpp/sym/rot3.h | 12 ++++ gen/cpp/sym/spherical_camera_cal.h | 12 ++++ gen/cpp/sym/unit3.h | 12 ++++ gen/cpp/sym/util/type_ops.h | 6 ++ .../cpp/templates/cam_package/CLASS.h.jinja | 11 +++ .../cpp/templates/geo_package/CLASS.h.jinja | 11 +++ .../backends/cpp/templates/type_ops.h.jinja | 5 ++ symforce/opt/CMakeLists.txt | 25 +------ symforce/opt/dense_linearizer.cc | 2 + symforce/opt/factor.cc | 1 + symforce/opt/factor.h | 16 +++++ symforce/opt/fmt_eigen.h | 72 +++++++++++++++++++ symforce/opt/internal/derivative_checker.h | 1 + symforce/opt/internal/linearizer_utils.h | 1 + symforce/opt/internal/tic_toc.cc | 6 +- symforce/opt/key.h | 8 +++ symforce/opt/levenberg_marquardt_solver.tcc | 1 + symforce/opt/values.cc | 1 + symforce/opt/values.h | 6 ++ symforce/pybind/cc_factor.cc | 14 ++++ .../lcmtypes/codegen_cpp_test/constants_t.hpp | 8 +++ .../lcmtypes/codegen_cpp_test/states_t.hpp | 8 +++ .../codegen_cpp_test/values_vec_t.hpp | 8 +++ .../lcmtypes/codegen_test/my_dataclass_t.hpp | 8 +++ .../constants_t.hpp | 8 +++ .../states_t.hpp | 8 +++ .../values_vec_t.hpp | 8 +++ .../inputs_constants_t.hpp | 8 +++ .../inputs_states_t.hpp | 8 +++ .../codegen_multi_function_test/inputs_t.hpp | 8 +++ .../outputs_1_t.hpp | 8 +++ .../outputs_2_t.hpp | 8 +++ .../values_vec_t.hpp | 8 +++ .../codegen_python_test/constants_t.hpp | 8 +++ .../lcmtypes/codegen_python_test/states_t.hpp | 8 +++ .../codegen_python_test/values_vec_t.hpp | 8 +++ .../cpp/lcmtypes/sym/d_out_t.hpp | 8 +++ .../cpp/lcmtypes/sym/d_t.hpp | 8 +++ .../lcmtypes/codegen_test/my_dataclass_t.hpp | 8 +++ .../cpp/lcmtypes/sym/d_out_t.hpp | 8 +++ .../cpp/lcmtypes/sym/d_t.hpp | 8 +++ .../cpp/lcmtypes/eigen_lcm/Matrix24d.hpp | 16 ++++- .../cpp/lcmtypes/eigen_lcm/Matrix2d.hpp | 16 ++++- .../cpp/lcmtypes/eigen_lcm/Matrix2f.hpp | 16 ++++- .../cpp/lcmtypes/eigen_lcm/Matrix2i.hpp | 16 ++++- .../cpp/lcmtypes/eigen_lcm/Matrix34d.hpp | 16 ++++- .../cpp/lcmtypes/eigen_lcm/Matrix3d.hpp | 16 ++++- .../cpp/lcmtypes/eigen_lcm/Matrix3f.hpp | 16 ++++- .../cpp/lcmtypes/eigen_lcm/Matrix3i.hpp | 16 ++++- .../cpp/lcmtypes/eigen_lcm/Matrix43f.hpp | 16 ++++- .../cpp/lcmtypes/eigen_lcm/Matrix4d.hpp | 16 ++++- .../cpp/lcmtypes/eigen_lcm/Matrix4f.hpp | 16 ++++- .../cpp/lcmtypes/eigen_lcm/Matrix4i.hpp | 16 ++++- .../cpp/lcmtypes/eigen_lcm/Matrix54d.hpp | 16 ++++- .../cpp/lcmtypes/eigen_lcm/Matrix68f.hpp | 16 ++++- .../cpp/lcmtypes/eigen_lcm/MatrixXd.hpp | 16 ++++- .../cpp/lcmtypes/eigen_lcm/MatrixXf.hpp | 16 ++++- .../cpp/lcmtypes/eigen_lcm/MatrixXi.hpp | 16 ++++- .../cpp/lcmtypes/eigen_lcm/Quaterniond.hpp | 16 ++++- .../cpp/lcmtypes/eigen_lcm/Quaternionf.hpp | 16 ++++- .../lcmtypes/eigen_lcm/SymmetricMatrix2d.hpp | 16 ++++- .../lcmtypes/eigen_lcm/SymmetricMatrix2f.hpp | 16 ++++- .../lcmtypes/eigen_lcm/SymmetricMatrix3d.hpp | 16 ++++- .../lcmtypes/eigen_lcm/SymmetricMatrix3f.hpp | 16 ++++- .../lcmtypes/eigen_lcm/SymmetricMatrix4d.hpp | 16 ++++- .../lcmtypes/eigen_lcm/SymmetricMatrix4f.hpp | 16 ++++- .../lcmtypes/eigen_lcm/SymmetricMatrixXd.hpp | 16 ++++- .../lcmtypes/eigen_lcm/SymmetricMatrixXf.hpp | 16 ++++- .../cpp/lcmtypes/eigen_lcm/Vector1d.hpp | 16 ++++- .../cpp/lcmtypes/eigen_lcm/Vector1f.hpp | 16 ++++- .../cpp/lcmtypes/eigen_lcm/Vector1i.hpp | 16 ++++- .../cpp/lcmtypes/eigen_lcm/Vector2d.hpp | 16 ++++- .../cpp/lcmtypes/eigen_lcm/Vector2f.hpp | 16 ++++- .../cpp/lcmtypes/eigen_lcm/Vector2i.hpp | 16 ++++- .../cpp/lcmtypes/eigen_lcm/Vector3d.hpp | 16 ++++- .../cpp/lcmtypes/eigen_lcm/Vector3f.hpp | 16 ++++- .../cpp/lcmtypes/eigen_lcm/Vector3i.hpp | 16 ++++- .../cpp/lcmtypes/eigen_lcm/Vector4d.hpp | 16 ++++- .../cpp/lcmtypes/eigen_lcm/Vector4f.hpp | 16 ++++- .../cpp/lcmtypes/eigen_lcm/Vector4i.hpp | 16 ++++- .../cpp/lcmtypes/eigen_lcm/Vector5d.hpp | 16 ++++- .../cpp/lcmtypes/eigen_lcm/Vector5f.hpp | 16 ++++- .../cpp/lcmtypes/eigen_lcm/Vector5i.hpp | 16 ++++- .../cpp/lcmtypes/eigen_lcm/Vector6d.hpp | 16 ++++- .../cpp/lcmtypes/eigen_lcm/Vector6f.hpp | 16 ++++- .../cpp/lcmtypes/eigen_lcm/Vector6i.hpp | 16 ++++- .../cpp/lcmtypes/eigen_lcm/Vector7d.hpp | 16 ++++- .../cpp/lcmtypes/eigen_lcm/Vector7f.hpp | 16 ++++- .../cpp/lcmtypes/eigen_lcm/Vector7i.hpp | 16 ++++- .../cpp/lcmtypes/eigen_lcm/Vector8d.hpp | 16 ++++- .../cpp/lcmtypes/eigen_lcm/Vector8f.hpp | 16 ++++- .../cpp/lcmtypes/eigen_lcm/Vector8i.hpp | 16 ++++- .../cpp/lcmtypes/eigen_lcm/VectorXd.hpp | 16 ++++- .../cpp/lcmtypes/eigen_lcm/VectorXf.hpp | 16 ++++- .../cpp/lcmtypes/eigen_lcm/VectorXi.hpp | 16 ++++- .../templates/djinni_converter.h.template | 15 ++++ .../templates/enumtype.hpp.template | 18 +++++ .../skymarshal/templates/lcmtype.hpp.template | 12 ++++ 111 files changed, 1457 insertions(+), 79 deletions(-) create mode 100755 cmake/patch_spdlog.sh create mode 100644 cmake/spdlog-fmt-fstring-get.patch create mode 100644 cmake/spdlog-fmt-runtime.patch create mode 100644 symforce/opt/fmt_eigen.h diff --git a/CMakeLists.txt b/CMakeLists.txt index f85cf488..bea2d8e5 100644 --- a/CMakeLists.txt +++ b/CMakeLists.txt @@ -27,6 +27,10 @@ option(SYMFORCE_ADD_PYTHON_TESTS "Include the Python tests" ON) option(SYMFORCE_BUILD_SYMENGINE "Build symengine[py]" ON) option(SYMFORCE_GENERATE_MANIFEST "Generate build manifest" ON) option(SYMFORCE_BUILD_BENCHMARKS "Generate examples for alternative libraries" OFF) +option(SYMFORCE_GEN_USE_FMTLIB + "Declare fmt::formatter specializations in symforce_gen (requires fmtlib)" + ON +) # ------------------------------------------------------------------------------ # TicTocs @@ -197,6 +201,28 @@ if(SYMFORCE_BUILD_BENCHMARKS OR SYMFORCE_BUILD_TESTS) endif() endif() +# ------------------------------------------------------------------------------ +# fmtlib + +find_package(fmt 12...<13 QUIET) +if (NOT fmt_FOUND) + message(STATUS "fmt not found, adding with FetchContent") + function(add_fmt) + set(FMT_INSTALL ON CACHE INTERNAL "fmt should create an install target") + FetchContent_Declare( + fmtlib + URL https://github.com/fmtlib/fmt/archive/12.2.0.zip + URL_HASH SHA256=8bc0dfbeccc1ba96dc9c0f9bf0bbc95f3c7a35308122618638c5755f389e5e72 + ) + set(CMAKE_POSITION_INDEPENDENT_CODE True) + FetchContent_MakeAvailable(fmtlib) + endfunction() + + add_fmt() +else() + message(STATUS "fmt found: ${fmt_VERSION}") +endif() + # ============================================================================== # SymForce Targets # ============================================================================== @@ -271,6 +297,10 @@ target_compile_options(symforce_gen PRIVATE ${SYMFORCE_COMPILE_OPTIONS}) if(NOT SYMFORCE_NO_FAST_MATH) target_compile_options(symforce_gen PRIVATE -ffast-math) endif() +if(SYMFORCE_GEN_USE_FMTLIB) + target_compile_definitions(symforce_gen PUBLIC SYMFORCE_GEN_USE_FMTLIB) + target_link_libraries(symforce_gen fmt::fmt) +endif() target_link_libraries(symforce_gen ${SYMFORCE_EIGEN_TARGET} symforce_lcmtypes_cpp) target_include_directories( symforce_gen diff --git a/cmake/patch_spdlog.sh b/cmake/patch_spdlog.sh new file mode 100755 index 00000000..16b38d11 --- /dev/null +++ b/cmake/patch_spdlog.sh @@ -0,0 +1,22 @@ +#!/bin/bash + +# ---------------------------------------------------------------------------- +# SymForce - Copyright 2022, Skydio, Inc. +# This source code is under the Apache 2.0 license found in the LICENSE file. +# ---------------------------------------------------------------------------- + +set -eu + +spdlog_src="$1" +shift + +# Apply the patches that make spdlog 1.9.2 compile against fmt 12. FetchContent re-runs the patch +# step on trees that may already be patched, so skip any patch whose changes are already present -- a +# successful reverse dry-run means the tree contains that patch. +for patch_file in "$@"; do + if patch -p1 -R -s --dry-run -d "${spdlog_src}" -i "${patch_file}" >/dev/null 2>&1; then + continue + fi + + patch -p1 -d "${spdlog_src}" -i "${patch_file}" +done diff --git a/cmake/spdlog-fmt-fstring-get.patch b/cmake/spdlog-fmt-fstring-get.patch new file mode 100644 index 00000000..c2cc1433 --- /dev/null +++ b/cmake/spdlog-fmt-fstring-get.patch @@ -0,0 +1,36 @@ +From: Skydio +Date: Mon, 20 Jul 2026 00:00:00 +0000 +Subject: [PATCH] logger: Use fstring::get() instead of the deprecated conversion + +fmt 12 marked fmt::fstring's implicit conversion to string_view as deprecated in +favor of fstring::get(). logger::log() relies on that conversion to pass a +format_string into log_(), which takes a string_view, so every caller trips +-Werror=deprecated-declarations. + +Call get() explicitly at the two sites that convert. All other format_string +overloads forward the type along and are unaffected. +--- + include/spdlog/logger.h | 4 ++-- + 1 file changed, 2 insertions(+), 2 deletions(-) + +diff --git a/include/spdlog/logger.h b/include/spdlog/logger.h +--- a/include/spdlog/logger.h ++++ b/include/spdlog/logger.h +@@ -80,7 +80,7 @@ + template + void log(source_loc loc, level::level_enum lvl, fmt::format_string fmt, Args &&...args) + { +- log_(loc, lvl, fmt, std::forward(args)...); ++ log_(loc, lvl, fmt.get(), std::forward(args)...); + } + + template +@@ -186,7 +186,7 @@ + template + void log(source_loc loc, level::level_enum lvl, fmt::wformat_string fmt, Args &&...args) + { +- log_(loc, lvl, fmt, std::forward(args)...); ++ log_(loc, lvl, fmt.get(), std::forward(args)...); + } + + template diff --git a/cmake/spdlog-fmt-runtime.patch b/cmake/spdlog-fmt-runtime.patch new file mode 100644 index 00000000..75b39e9e --- /dev/null +++ b/cmake/spdlog-fmt-runtime.patch @@ -0,0 +1,40 @@ +From: Skydio +Date: Mon, 20 Jul 2026 00:00:00 +0000 +Subject: [PATCH] common: Support fmt >= 9.1 runtime_format_string + +fmt 10 removed fmt::basic_runtime (it was renamed to +fmt::runtime_format_string in fmt 9.1). The pinned spdlog (1.9.2) still +references fmt::basic_runtime directly in is_convertible_to_basic_format_string, +which fails to compile against fmt 12. + +Introduce a version-guarded fmt_runtime_string alias, mirroring the fix that +upstream spdlog shipped in 1.15.x, so the trait keeps compiling across fmt +versions. +--- + include/spdlog/common.h | 9 ++++++++- + 1 file changed, 8 insertions(+), 1 deletion(-) + +diff --git a/include/spdlog/common.h b/include/spdlog/common.h +--- a/include/spdlog/common.h ++++ b/include/spdlog/common.h +@@ -119,12 +119,19 @@ using level_t = std::atomic; + template + using remove_cvref_t = typename std::remove_cv::type>::type; + ++template ++#if FMT_VERSION >= 90101 ++using fmt_runtime_string = fmt::runtime_format_string; ++#else ++using fmt_runtime_string = fmt::basic_runtime; ++#endif ++ + // clang doesn't like SFINAE disabled constructor in std::is_convertible<> so have to repeat the condition from basic_format_string here, + // in addition, fmt::basic_runtime is only convertible to basic_format_string but not basic_string_view + template + struct is_convertible_to_basic_format_string + : std::integral_constant>::value || std::is_same, fmt::basic_runtime>::value> ++ std::is_convertible>::value || std::is_same, fmt_runtime_string>::value> + {}; + + #ifdef SPDLOG_WCHAR_TO_UTF8_SUPPORT diff --git a/gen/cpp/sym/atan_camera_cal.h b/gen/cpp/sym/atan_camera_cal.h index 6488d2c6..c38e4917 100644 --- a/gen/cpp/sym/atan_camera_cal.h +++ b/gen/cpp/sym/atan_camera_cal.h @@ -14,6 +14,10 @@ #include +#if SYMFORCE_GEN_USE_FMTLIB +#include +#endif + namespace sym { /** @@ -198,3 +202,11 @@ static_assert(alignof(sym::ATANCameraCal) == sizeof(float)); #include "./ops/atan_camera_cal/group_ops.h" #include "./ops/atan_camera_cal/lie_group_ops.h" #include "./ops/atan_camera_cal/storage_ops.h" + +// fmt::formatter specialization for this type +#if SYMFORCE_GEN_USE_FMTLIB +template <> +struct fmt::formatter> : ostream_formatter {}; +template <> +struct fmt::formatter> : ostream_formatter {}; +#endif diff --git a/gen/cpp/sym/double_sphere_camera_cal.h b/gen/cpp/sym/double_sphere_camera_cal.h index f6f303af..5a7db3b6 100644 --- a/gen/cpp/sym/double_sphere_camera_cal.h +++ b/gen/cpp/sym/double_sphere_camera_cal.h @@ -14,6 +14,10 @@ #include +#if SYMFORCE_GEN_USE_FMTLIB +#include +#endif + namespace sym { /** @@ -212,3 +216,11 @@ static_assert(alignof(sym::DoubleSphereCameraCal) == sizeof(float)); #include "./ops/double_sphere_camera_cal/group_ops.h" #include "./ops/double_sphere_camera_cal/lie_group_ops.h" #include "./ops/double_sphere_camera_cal/storage_ops.h" + +// fmt::formatter specialization for this type +#if SYMFORCE_GEN_USE_FMTLIB +template <> +struct fmt::formatter> : ostream_formatter {}; +template <> +struct fmt::formatter> : ostream_formatter {}; +#endif diff --git a/gen/cpp/sym/equirectangular_camera_cal.h b/gen/cpp/sym/equirectangular_camera_cal.h index ed5a595f..b36ef945 100644 --- a/gen/cpp/sym/equirectangular_camera_cal.h +++ b/gen/cpp/sym/equirectangular_camera_cal.h @@ -14,6 +14,10 @@ #include +#if SYMFORCE_GEN_USE_FMTLIB +#include +#endif + namespace sym { /** @@ -195,3 +199,11 @@ static_assert(alignof(sym::EquirectangularCameraCal) == sizeof(float)); #include "./ops/equirectangular_camera_cal/group_ops.h" #include "./ops/equirectangular_camera_cal/lie_group_ops.h" #include "./ops/equirectangular_camera_cal/storage_ops.h" + +// fmt::formatter specialization for this type +#if SYMFORCE_GEN_USE_FMTLIB +template <> +struct fmt::formatter> : ostream_formatter {}; +template <> +struct fmt::formatter> : ostream_formatter {}; +#endif diff --git a/gen/cpp/sym/linear_camera_cal.h b/gen/cpp/sym/linear_camera_cal.h index ba5bec4c..1598c5b8 100644 --- a/gen/cpp/sym/linear_camera_cal.h +++ b/gen/cpp/sym/linear_camera_cal.h @@ -14,6 +14,10 @@ #include +#if SYMFORCE_GEN_USE_FMTLIB +#include +#endif + namespace sym { /** @@ -194,3 +198,11 @@ static_assert(alignof(sym::LinearCameraCal) == sizeof(float)); #include "./ops/linear_camera_cal/group_ops.h" #include "./ops/linear_camera_cal/lie_group_ops.h" #include "./ops/linear_camera_cal/storage_ops.h" + +// fmt::formatter specialization for this type +#if SYMFORCE_GEN_USE_FMTLIB +template <> +struct fmt::formatter> : ostream_formatter {}; +template <> +struct fmt::formatter> : ostream_formatter {}; +#endif diff --git a/gen/cpp/sym/orthographic_camera_cal.h b/gen/cpp/sym/orthographic_camera_cal.h index 246cb4b5..5c6d727f 100644 --- a/gen/cpp/sym/orthographic_camera_cal.h +++ b/gen/cpp/sym/orthographic_camera_cal.h @@ -14,6 +14,10 @@ #include +#if SYMFORCE_GEN_USE_FMTLIB +#include +#endif + namespace sym { /** @@ -177,3 +181,11 @@ static_assert(alignof(sym::OrthographicCameraCal) == sizeof(float)); #include "./ops/orthographic_camera_cal/group_ops.h" #include "./ops/orthographic_camera_cal/lie_group_ops.h" #include "./ops/orthographic_camera_cal/storage_ops.h" + +// fmt::formatter specialization for this type +#if SYMFORCE_GEN_USE_FMTLIB +template <> +struct fmt::formatter> : ostream_formatter {}; +template <> +struct fmt::formatter> : ostream_formatter {}; +#endif diff --git a/gen/cpp/sym/polynomial_camera_cal.h b/gen/cpp/sym/polynomial_camera_cal.h index 3667b1f2..92bdc9a0 100644 --- a/gen/cpp/sym/polynomial_camera_cal.h +++ b/gen/cpp/sym/polynomial_camera_cal.h @@ -14,6 +14,10 @@ #include +#if SYMFORCE_GEN_USE_FMTLIB +#include +#endif + namespace sym { /** @@ -181,3 +185,11 @@ static_assert(alignof(sym::PolynomialCameraCal) == sizeof(float)); #include "./ops/polynomial_camera_cal/group_ops.h" #include "./ops/polynomial_camera_cal/lie_group_ops.h" #include "./ops/polynomial_camera_cal/storage_ops.h" + +// fmt::formatter specialization for this type +#if SYMFORCE_GEN_USE_FMTLIB +template <> +struct fmt::formatter> : ostream_formatter {}; +template <> +struct fmt::formatter> : ostream_formatter {}; +#endif diff --git a/gen/cpp/sym/pose2.h b/gen/cpp/sym/pose2.h index 581b4676..10f834a0 100644 --- a/gen/cpp/sym/pose2.h +++ b/gen/cpp/sym/pose2.h @@ -18,6 +18,10 @@ #include #include +#if SYMFORCE_GEN_USE_FMTLIB +#include +#endif + namespace sym { /** @@ -289,3 +293,11 @@ static_assert(alignof(sym::Pose2) == sizeof(float)); #include "./ops/pose2/group_ops.h" #include "./ops/pose2/lie_group_ops.h" #include "./ops/pose2/storage_ops.h" + +// fmt::formatter specialization for this type +#if SYMFORCE_GEN_USE_FMTLIB +template <> +struct fmt::formatter> : ostream_formatter {}; +template <> +struct fmt::formatter> : ostream_formatter {}; +#endif diff --git a/gen/cpp/sym/pose3.h b/gen/cpp/sym/pose3.h index 8d6dcb75..e23d0d3f 100644 --- a/gen/cpp/sym/pose3.h +++ b/gen/cpp/sym/pose3.h @@ -18,6 +18,10 @@ #include #include +#if SYMFORCE_GEN_USE_FMTLIB +#include +#endif + namespace sym { /** @@ -291,3 +295,11 @@ static_assert(alignof(sym::Pose3) == sizeof(float)); #include "./ops/pose3/group_ops.h" #include "./ops/pose3/lie_group_ops.h" #include "./ops/pose3/storage_ops.h" + +// fmt::formatter specialization for this type +#if SYMFORCE_GEN_USE_FMTLIB +template <> +struct fmt::formatter> : ostream_formatter {}; +template <> +struct fmt::formatter> : ostream_formatter {}; +#endif diff --git a/gen/cpp/sym/rot2.h b/gen/cpp/sym/rot2.h index 25d27c3d..f42c13e6 100644 --- a/gen/cpp/sym/rot2.h +++ b/gen/cpp/sym/rot2.h @@ -18,6 +18,10 @@ #include #include +#if SYMFORCE_GEN_USE_FMTLIB +#include +#endif + namespace sym { /** @@ -268,3 +272,11 @@ static_assert(alignof(sym::Rot2) == sizeof(float)); #include "./ops/rot2/group_ops.h" #include "./ops/rot2/lie_group_ops.h" #include "./ops/rot2/storage_ops.h" + +// fmt::formatter specialization for this type +#if SYMFORCE_GEN_USE_FMTLIB +template <> +struct fmt::formatter> : ostream_formatter {}; +template <> +struct fmt::formatter> : ostream_formatter {}; +#endif diff --git a/gen/cpp/sym/rot3.h b/gen/cpp/sym/rot3.h index 314934e4..228ce877 100644 --- a/gen/cpp/sym/rot3.h +++ b/gen/cpp/sym/rot3.h @@ -18,6 +18,10 @@ #include #include +#if SYMFORCE_GEN_USE_FMTLIB +#include +#endif + namespace sym { /** @@ -357,3 +361,11 @@ static_assert(alignof(sym::Rot3) == sizeof(float)); #include "./ops/rot3/group_ops.h" #include "./ops/rot3/lie_group_ops.h" #include "./ops/rot3/storage_ops.h" + +// fmt::formatter specialization for this type +#if SYMFORCE_GEN_USE_FMTLIB +template <> +struct fmt::formatter> : ostream_formatter {}; +template <> +struct fmt::formatter> : ostream_formatter {}; +#endif diff --git a/gen/cpp/sym/spherical_camera_cal.h b/gen/cpp/sym/spherical_camera_cal.h index cb9eb33b..7958fa85 100644 --- a/gen/cpp/sym/spherical_camera_cal.h +++ b/gen/cpp/sym/spherical_camera_cal.h @@ -14,6 +14,10 @@ #include +#if SYMFORCE_GEN_USE_FMTLIB +#include +#endif + namespace sym { /** @@ -201,3 +205,11 @@ static_assert(alignof(sym::SphericalCameraCal) == sizeof(float)); #include "./ops/spherical_camera_cal/group_ops.h" #include "./ops/spherical_camera_cal/lie_group_ops.h" #include "./ops/spherical_camera_cal/storage_ops.h" + +// fmt::formatter specialization for this type +#if SYMFORCE_GEN_USE_FMTLIB +template <> +struct fmt::formatter> : ostream_formatter {}; +template <> +struct fmt::formatter> : ostream_formatter {}; +#endif diff --git a/gen/cpp/sym/unit3.h b/gen/cpp/sym/unit3.h index 312b2510..f0ee235b 100644 --- a/gen/cpp/sym/unit3.h +++ b/gen/cpp/sym/unit3.h @@ -18,6 +18,10 @@ #include #include +#if SYMFORCE_GEN_USE_FMTLIB +#include +#endif + namespace sym { /** @@ -220,3 +224,11 @@ static_assert(alignof(sym::Unit3) == sizeof(float)); #include "./ops/unit3/group_ops.h" #include "./ops/unit3/lie_group_ops.h" #include "./ops/unit3/storage_ops.h" + +// fmt::formatter specialization for this type +#if SYMFORCE_GEN_USE_FMTLIB +template <> +struct fmt::formatter> : ostream_formatter {}; +template <> +struct fmt::formatter> : ostream_formatter {}; +#endif diff --git a/gen/cpp/sym/util/type_ops.h b/gen/cpp/sym/util/type_ops.h index b681ab85..8cd26da4 100644 --- a/gen/cpp/sym/util/type_ops.h +++ b/gen/cpp/sym/util/type_ops.h @@ -365,3 +365,9 @@ inline std::pair EigenTypeShape(const type_t type) { } } // namespace sym + +// fmt::formatter specialization for type_t, which is formatted by the SYM_ASSERT calls above +#if SYMFORCE_GEN_USE_FMTLIB +template <> +struct fmt::formatter : ostream_formatter {}; +#endif diff --git a/symforce/codegen/backends/cpp/templates/cam_package/CLASS.h.jinja b/symforce/codegen/backends/cpp/templates/cam_package/CLASS.h.jinja index eb90625e..40e72ece 100644 --- a/symforce/codegen/backends/cpp/templates/cam_package/CLASS.h.jinja +++ b/symforce/codegen/backends/cpp/templates/cam_package/CLASS.h.jinja @@ -14,6 +14,10 @@ #include +#if SYMFORCE_GEN_USE_FMTLIB +#include +#endif + namespace sym { {% if doc %} @@ -148,3 +152,10 @@ static_assert( #include "./ops/{{ camelcase_to_snakecase(cls.__name__) }}/storage_ops.h" #include "./ops/{{ camelcase_to_snakecase(cls.__name__) }}/lie_group_ops.h" #include "./ops/{{ camelcase_to_snakecase(cls.__name__) }}/group_ops.h" + +// fmt::formatter specialization for this type +#if SYMFORCE_GEN_USE_FMTLIB +{% for scalar in scalar_types %} +template <> struct fmt::formatter> : ostream_formatter {}; +{% endfor %} +#endif diff --git a/symforce/codegen/backends/cpp/templates/geo_package/CLASS.h.jinja b/symforce/codegen/backends/cpp/templates/geo_package/CLASS.h.jinja index 2297062d..12b96456 100644 --- a/symforce/codegen/backends/cpp/templates/geo_package/CLASS.h.jinja +++ b/symforce/codegen/backends/cpp/templates/geo_package/CLASS.h.jinja @@ -28,6 +28,10 @@ #include #include +#if SYMFORCE_GEN_USE_FMTLIB +#include +#endif + namespace sym { {% if doc %} @@ -273,3 +277,10 @@ static_assert( #include "./ops/{{ camelcase_to_snakecase(cls.__name__) }}/storage_ops.h" #include "./ops/{{ camelcase_to_snakecase(cls.__name__) }}/lie_group_ops.h" #include "./ops/{{ camelcase_to_snakecase(cls.__name__) }}/group_ops.h" + +// fmt::formatter specialization for this type +#if SYMFORCE_GEN_USE_FMTLIB +{% for scalar in scalar_types %} +template <> struct fmt::formatter> : ostream_formatter {}; +{% endfor %} +#endif diff --git a/symforce/codegen/backends/cpp/templates/type_ops.h.jinja b/symforce/codegen/backends/cpp/templates/type_ops.h.jinja index b42c3c4f..e4c233b9 100644 --- a/symforce/codegen/backends/cpp/templates/type_ops.h.jinja +++ b/symforce/codegen/backends/cpp/templates/type_ops.h.jinja @@ -108,3 +108,8 @@ inline std::pair EigenTypeShape(const type_t type) { } } // namespace sym + +// fmt::formatter specialization for type_t, which is formatted by the SYM_ASSERT calls above +#if SYMFORCE_GEN_USE_FMTLIB +template <> struct fmt::formatter : ostream_formatter {}; +#endif diff --git a/symforce/opt/CMakeLists.txt b/symforce/opt/CMakeLists.txt index 1c155578..08fc65f7 100644 --- a/symforce/opt/CMakeLists.txt +++ b/symforce/opt/CMakeLists.txt @@ -9,28 +9,6 @@ include(FetchContent) -# ------------------------------------------------------------------------------ -# fmtlib - -find_package(fmt 8...<9 QUIET) -if (NOT fmt_FOUND) - message(STATUS "fmt not found, adding with FetchContent") - function(add_fmt) - set(FMT_INSTALL ON CACHE INTERNAL "fmt should create an install target") - FetchContent_Declare( - fmtlib - URL https://github.com/fmtlib/fmt/archive/8.0.1.zip - URL_HASH SHA256=6747442c189064b857336007dd7fa3aaf58512aa1a0b2ba76bf1182eefb01025 - ) - set(CMAKE_POSITION_INDEPENDENT_CODE True) - FetchContent_MakeAvailable(fmtlib) - endfunction() - - add_fmt() -else() - message(STATUS "fmt found: ${fmt_VERSION}") -endif() - # ------------------------------------------------------------------------------ # spdlog @@ -45,6 +23,9 @@ if (NOT spdlog_FOUND) spdlog URL https://github.com/gabime/spdlog/archive/v1.9.2.zip URL_HASH SHA256=130bd593c33e2e2abba095b551db6a05f5e4a5a19c03ab31256c38fa218aa0a6 + # spdlog 1.9.2 references fmt::basic_runtime, which fmt 10 removed, and relies on an + # fmt::fstring conversion that fmt 12 deprecated. Patch both so it compiles against fmt 12. + PATCH_COMMAND "${CMAKE_CURRENT_SOURCE_DIR}/../../cmake/patch_spdlog.sh" "${FETCHCONTENT_BASE_DIR}/spdlog-src" "${CMAKE_CURRENT_SOURCE_DIR}/../../cmake/spdlog-fmt-runtime.patch" "${CMAKE_CURRENT_SOURCE_DIR}/../../cmake/spdlog-fmt-fstring-get.patch" ) FetchContent_MakeAvailable(spdlog) endfunction() diff --git a/symforce/opt/dense_linearizer.cc b/symforce/opt/dense_linearizer.cc index 013c91c0..fcf0d82f 100644 --- a/symforce/opt/dense_linearizer.cc +++ b/symforce/opt/dense_linearizer.cc @@ -7,6 +7,8 @@ #include +#include + #include "./internal/linearizer_utils.h" namespace sym { diff --git a/symforce/opt/factor.cc b/symforce/opt/factor.cc index c8b34b6d..932ba1b2 100644 --- a/symforce/opt/factor.cc +++ b/symforce/opt/factor.cc @@ -10,6 +10,7 @@ #include #include "./assert.h" +#include "./fmt_eigen.h" #include "./internal/factor_utils.h" namespace sym { diff --git a/symforce/opt/factor.h b/symforce/opt/factor.h index 3dba6ba8..55fc5d2a 100644 --- a/symforce/opt/factor.h +++ b/symforce/opt/factor.h @@ -9,11 +9,13 @@ #include #include +#include #include #include #include +#include "./fmt_eigen.h" #include "./templates.h" #include "./values.h" @@ -454,5 +456,19 @@ std::vector ComputeKeysToOptimize(const std::vector>& factor extern template class sym::Factor; extern template class sym::Factor; +// fmt::formatter specializations +template <> +struct fmt::formatter : ostream_formatter {}; +template <> +struct fmt::formatter : ostream_formatter {}; +template <> +struct fmt::formatter : ostream_formatter {}; +template <> +struct fmt::formatter : ostream_formatter {}; +template <> +struct fmt::formatter> : ostream_formatter {}; +template <> +struct fmt::formatter> : ostream_formatter {}; + // Template method implementations #include "./factor.tcc" diff --git a/symforce/opt/fmt_eigen.h b/symforce/opt/fmt_eigen.h new file mode 100644 index 00000000..8acd429c --- /dev/null +++ b/symforce/opt/fmt_eigen.h @@ -0,0 +1,72 @@ +/* ---------------------------------------------------------------------------- + * SymForce - Copyright 2022, Skydio, Inc. + * This source code is under the Apache 2.0 license found in the LICENSE file. + * ---------------------------------------------------------------------------- */ + +#pragma once + +// Always keep this header. The specializations it defines are not recognized by IWYU +// IWYU pragma: always_keep + +/// Formatter definitions for Eigen types + +#include +#include + +namespace Eigen { +template +class DenseBase; +template +class MatrixBase; +template +class SparseMatrixBase; +template +class WithFormat; +template +class VectorBlock; +} // namespace Eigen + +template +struct fmt::formatter> : ostream_formatter {}; + +template +struct fmt::formatter, Derived>, char>> + : ostream_formatter {}; + +template +struct fmt::formatter> : ostream_formatter {}; + +template +struct fmt::formatter> : ostream_formatter {}; + +template +struct fmt::formatter< + Derived, std::enable_if_t, Derived>, char>> + : ostream_formatter {}; + +template +struct fmt::formatter> : ostream_formatter {}; +template +struct fmt::formatter> : ostream_formatter {}; + +// Eigen 3.4 gave vector expressions STL iterators, so fmt's range formatter is an equally +// specialized candidate against the ostream formatters above. Opt out of range formatting to leave +// the ostream formatters as the only match. These mirror the formatters above, minus the ones fmt +// never treats as ranges (2D expressions, sparse, and WithFormat). +template +struct fmt::range_format_kind, Char> + : std::integral_constant {}; + +template +struct fmt::range_format_kind, Char> + : std::integral_constant {}; + +template +struct fmt::range_format_kind< + Derived, Char, std::enable_if_t, Derived>>> + : std::integral_constant {}; + +template +struct fmt::range_format_kind, Char> + : std::integral_constant {}; diff --git a/symforce/opt/internal/derivative_checker.h b/symforce/opt/internal/derivative_checker.h index e071ed08..540607c8 100644 --- a/symforce/opt/internal/derivative_checker.h +++ b/symforce/opt/internal/derivative_checker.h @@ -7,6 +7,7 @@ #include +#include "../fmt_eigen.h" #include "../util.h" #include "../values.h" diff --git a/symforce/opt/internal/linearizer_utils.h b/symforce/opt/internal/linearizer_utils.h index 4d4a9198..3156b9c5 100644 --- a/symforce/opt/internal/linearizer_utils.h +++ b/symforce/opt/internal/linearizer_utils.h @@ -17,6 +17,7 @@ #include #include "../factor.h" +#include "../fmt_eigen.h" #include "./hash_combine.h" namespace sym { diff --git a/symforce/opt/internal/tic_toc.cc b/symforce/opt/internal/tic_toc.cc index 3866a0c7..a0fdf491 100644 --- a/symforce/opt/internal/tic_toc.cc +++ b/symforce/opt/internal/tic_toc.cc @@ -148,11 +148,11 @@ void TicTocManager::PrintTimingResults(std::ostream& out) const { "Max Time (s)", "Min Time (s)"); fmt::print(out, "\nSymForce TicToc Results:\n"); - fmt::print(out, legend); - fmt::print(out, separator + "\n"); + fmt::print(out, "{}", legend); + fmt::print(out, "{}", separator + "\n"); for (const auto& [name, block] : blocks) { - fmt::print(out, output_fmt, name, block.Count(), float(block.TotalTime()), + fmt::print(out, fmt::runtime(output_fmt), name, block.Count(), float(block.TotalTime()), float(block.AverageTime()), float(block.MaxTime()), float(block.MinTime())); } } diff --git a/symforce/opt/key.h b/symforce/opt/key.h index baff5d41..142957fe 100644 --- a/symforce/opt/key.h +++ b/symforce/opt/key.h @@ -9,6 +9,8 @@ #include #include +#include + #include #include "./assert.h" @@ -117,6 +119,12 @@ std::ostream& operator<<(std::ostream& os, const sym::Key& key); } // namespace sym +/** + * Specialize fmt::formatter for Key + */ +template <> +struct fmt::formatter : ostream_formatter {}; + /** * Hash function for Key. */ diff --git a/symforce/opt/levenberg_marquardt_solver.tcc b/symforce/opt/levenberg_marquardt_solver.tcc index 172df042..8627d6df 100644 --- a/symforce/opt/levenberg_marquardt_solver.tcc +++ b/symforce/opt/levenberg_marquardt_solver.tcc @@ -9,6 +9,7 @@ #include #include "./assert.h" +#include "./fmt_eigen.h" #include "./levenberg_marquardt_solver.h" #include "./tic_toc.h" #include "./util.h" diff --git a/symforce/opt/values.cc b/symforce/opt/values.cc index 70885c84..27691c0b 100644 --- a/symforce/opt/values.cc +++ b/symforce/opt/values.cc @@ -9,6 +9,7 @@ #include #include "./assert.h" +#include "./fmt_eigen.h" namespace sym { diff --git a/symforce/opt/values.h b/symforce/opt/values.h index fc8ed883..0942eaf7 100644 --- a/symforce/opt/values.h +++ b/symforce/opt/values.h @@ -361,5 +361,11 @@ extern template sym::Values sym::Values::Cast() const; extern template sym::Values sym::Values::Cast() const; extern template sym::Values sym::Values::Cast() const; +// Specialize fmt::formatter for Values +template <> +struct fmt::formatter> : ostream_formatter {}; +template <> +struct fmt::formatter> : ostream_formatter {}; + // Template method implementations #include "./values.tcc" diff --git a/symforce/pybind/cc_factor.cc b/symforce/pybind/cc_factor.cc index 910649c3..768ddc85 100644 --- a/symforce/pybind/cc_factor.cc +++ b/symforce/pybind/cc_factor.cc @@ -11,6 +11,7 @@ #include #include #include +#include #include #include #include @@ -25,6 +26,19 @@ namespace py = pybind11; +// NOTE(aaron): pybind defines operator<< in stl.h, but doesn't define this +template +struct fmt::formatter, char>> + : ostream_formatter {}; + +// pybind objects expose begin()/end(), which makes fmt's range formatter an equally specialized +// candidate against the ostream formatter above. Opt out of range formatting to leave the ostream +// formatter as the only match. +template +struct fmt::range_format_kind>> + : std::integral_constant {}; + namespace sym { //================================================================================================// diff --git a/test/symforce_function_codegen_test_data/symengine/codegen_cpp_test_data/cpp/lcmtypes/codegen_cpp_test/constants_t.hpp b/test/symforce_function_codegen_test_data/symengine/codegen_cpp_test_data/cpp/lcmtypes/codegen_cpp_test/constants_t.hpp index efa6cadc..9ca6e6f1 100644 --- a/test/symforce_function_codegen_test_data/symengine/codegen_cpp_test_data/cpp/lcmtypes/codegen_cpp_test/constants_t.hpp +++ b/test/symforce_function_codegen_test_data/symengine/codegen_cpp_test_data/cpp/lcmtypes/codegen_cpp_test/constants_t.hpp @@ -15,6 +15,7 @@ #include #endif #include +#include namespace codegen_cpp_test @@ -164,6 +165,13 @@ class constants_t } #endif + // The fmt library does not use operator<< implicitly, so it is given format_as instead. + friend std::string format_as(const constants_t& obj) { + std::ostringstream _stream; + _stream << obj; + return _stream.str(); + } + #if defined(SKYMARSHAL_STORING_ENABLED) // Return value is 0 if the operation succeeded. // If the operation failed, return value is equal to 1 + the index of the first invalid field, diff --git a/test/symforce_function_codegen_test_data/symengine/codegen_cpp_test_data/cpp/lcmtypes/codegen_cpp_test/states_t.hpp b/test/symforce_function_codegen_test_data/symengine/codegen_cpp_test_data/cpp/lcmtypes/codegen_cpp_test/states_t.hpp index e7d3591a..58d4378d 100644 --- a/test/symforce_function_codegen_test_data/symengine/codegen_cpp_test_data/cpp/lcmtypes/codegen_cpp_test/states_t.hpp +++ b/test/symforce_function_codegen_test_data/symengine/codegen_cpp_test_data/cpp/lcmtypes/codegen_cpp_test/states_t.hpp @@ -15,6 +15,7 @@ #include #endif #include +#include #include "lcmtypes/eigen_lcm/Vector2d.hpp" @@ -172,6 +173,13 @@ class states_t } #endif + // The fmt library does not use operator<< implicitly, so it is given format_as instead. + friend std::string format_as(const states_t& obj) { + std::ostringstream _stream; + _stream << obj; + return _stream.str(); + } + #if defined(SKYMARSHAL_STORING_ENABLED) // Return value is 0 if the operation succeeded. // If the operation failed, return value is equal to 1 + the index of the first invalid field, diff --git a/test/symforce_function_codegen_test_data/symengine/codegen_cpp_test_data/cpp/lcmtypes/codegen_cpp_test/values_vec_t.hpp b/test/symforce_function_codegen_test_data/symengine/codegen_cpp_test_data/cpp/lcmtypes/codegen_cpp_test/values_vec_t.hpp index e5138902..22fcadc4 100644 --- a/test/symforce_function_codegen_test_data/symengine/codegen_cpp_test_data/cpp/lcmtypes/codegen_cpp_test/values_vec_t.hpp +++ b/test/symforce_function_codegen_test_data/symengine/codegen_cpp_test_data/cpp/lcmtypes/codegen_cpp_test/values_vec_t.hpp @@ -15,6 +15,7 @@ #include #endif #include +#include #include #include "lcmtypes/eigen_lcm/Vector4d.hpp" @@ -238,6 +239,13 @@ class values_vec_t } #endif + // The fmt library does not use operator<< implicitly, so it is given format_as instead. + friend std::string format_as(const values_vec_t& obj) { + std::ostringstream _stream; + _stream << obj; + return _stream.str(); + } + #if defined(SKYMARSHAL_STORING_ENABLED) // Return value is 0 if the operation succeeded. // If the operation failed, return value is equal to 1 + the index of the first invalid field, diff --git a/test/symforce_function_codegen_test_data/symengine/codegen_dataclass_in_values_test_data/cpp/lcmtypes/codegen_test/my_dataclass_t.hpp b/test/symforce_function_codegen_test_data/symengine/codegen_dataclass_in_values_test_data/cpp/lcmtypes/codegen_test/my_dataclass_t.hpp index bf0647fc..ceb69670 100644 --- a/test/symforce_function_codegen_test_data/symengine/codegen_dataclass_in_values_test_data/cpp/lcmtypes/codegen_test/my_dataclass_t.hpp +++ b/test/symforce_function_codegen_test_data/symengine/codegen_dataclass_in_values_test_data/cpp/lcmtypes/codegen_test/my_dataclass_t.hpp @@ -15,6 +15,7 @@ #include #endif #include +#include #include "lcmtypes/eigen_lcm/Vector4d.hpp" @@ -172,6 +173,13 @@ class my_dataclass_t } #endif + // The fmt library does not use operator<< implicitly, so it is given format_as instead. + friend std::string format_as(const my_dataclass_t& obj) { + std::ostringstream _stream; + _stream << obj; + return _stream.str(); + } + #if defined(SKYMARSHAL_STORING_ENABLED) // Return value is 0 if the operation succeeded. // If the operation failed, return value is equal to 1 + the index of the first invalid field, diff --git a/test/symforce_function_codegen_test_data/symengine/codegen_explicit_template_instantiation_test_data/cpp/lcmtypes/codegen_explicit_template_instantiation_test/constants_t.hpp b/test/symforce_function_codegen_test_data/symengine/codegen_explicit_template_instantiation_test_data/cpp/lcmtypes/codegen_explicit_template_instantiation_test/constants_t.hpp index cb197b3a..ee09bc39 100644 --- a/test/symforce_function_codegen_test_data/symengine/codegen_explicit_template_instantiation_test_data/cpp/lcmtypes/codegen_explicit_template_instantiation_test/constants_t.hpp +++ b/test/symforce_function_codegen_test_data/symengine/codegen_explicit_template_instantiation_test_data/cpp/lcmtypes/codegen_explicit_template_instantiation_test/constants_t.hpp @@ -15,6 +15,7 @@ #include #endif #include +#include namespace codegen_explicit_template_instantiation_test @@ -164,6 +165,13 @@ class constants_t } #endif + // The fmt library does not use operator<< implicitly, so it is given format_as instead. + friend std::string format_as(const constants_t& obj) { + std::ostringstream _stream; + _stream << obj; + return _stream.str(); + } + #if defined(SKYMARSHAL_STORING_ENABLED) // Return value is 0 if the operation succeeded. // If the operation failed, return value is equal to 1 + the index of the first invalid field, diff --git a/test/symforce_function_codegen_test_data/symengine/codegen_explicit_template_instantiation_test_data/cpp/lcmtypes/codegen_explicit_template_instantiation_test/states_t.hpp b/test/symforce_function_codegen_test_data/symengine/codegen_explicit_template_instantiation_test_data/cpp/lcmtypes/codegen_explicit_template_instantiation_test/states_t.hpp index 9e69c9f1..d606df5b 100644 --- a/test/symforce_function_codegen_test_data/symengine/codegen_explicit_template_instantiation_test_data/cpp/lcmtypes/codegen_explicit_template_instantiation_test/states_t.hpp +++ b/test/symforce_function_codegen_test_data/symengine/codegen_explicit_template_instantiation_test_data/cpp/lcmtypes/codegen_explicit_template_instantiation_test/states_t.hpp @@ -15,6 +15,7 @@ #include #endif #include +#include #include "lcmtypes/eigen_lcm/Vector2d.hpp" @@ -172,6 +173,13 @@ class states_t } #endif + // The fmt library does not use operator<< implicitly, so it is given format_as instead. + friend std::string format_as(const states_t& obj) { + std::ostringstream _stream; + _stream << obj; + return _stream.str(); + } + #if defined(SKYMARSHAL_STORING_ENABLED) // Return value is 0 if the operation succeeded. // If the operation failed, return value is equal to 1 + the index of the first invalid field, diff --git a/test/symforce_function_codegen_test_data/symengine/codegen_explicit_template_instantiation_test_data/cpp/lcmtypes/codegen_explicit_template_instantiation_test/values_vec_t.hpp b/test/symforce_function_codegen_test_data/symengine/codegen_explicit_template_instantiation_test_data/cpp/lcmtypes/codegen_explicit_template_instantiation_test/values_vec_t.hpp index 08b2adc5..86bcdc3c 100644 --- a/test/symforce_function_codegen_test_data/symengine/codegen_explicit_template_instantiation_test_data/cpp/lcmtypes/codegen_explicit_template_instantiation_test/values_vec_t.hpp +++ b/test/symforce_function_codegen_test_data/symengine/codegen_explicit_template_instantiation_test_data/cpp/lcmtypes/codegen_explicit_template_instantiation_test/values_vec_t.hpp @@ -15,6 +15,7 @@ #include #endif #include +#include #include #include "lcmtypes/eigen_lcm/Vector4d.hpp" @@ -238,6 +239,13 @@ class values_vec_t } #endif + // The fmt library does not use operator<< implicitly, so it is given format_as instead. + friend std::string format_as(const values_vec_t& obj) { + std::ostringstream _stream; + _stream << obj; + return _stream.str(); + } + #if defined(SKYMARSHAL_STORING_ENABLED) // Return value is 0 if the operation succeeded. // If the operation failed, return value is equal to 1 + the index of the first invalid field, diff --git a/test/symforce_function_codegen_test_data/symengine/codegen_multi_function_test_data/cpp/lcmtypes/codegen_multi_function_test/inputs_constants_t.hpp b/test/symforce_function_codegen_test_data/symengine/codegen_multi_function_test_data/cpp/lcmtypes/codegen_multi_function_test/inputs_constants_t.hpp index e1d14fc4..21ff367d 100644 --- a/test/symforce_function_codegen_test_data/symengine/codegen_multi_function_test_data/cpp/lcmtypes/codegen_multi_function_test/inputs_constants_t.hpp +++ b/test/symforce_function_codegen_test_data/symengine/codegen_multi_function_test_data/cpp/lcmtypes/codegen_multi_function_test/inputs_constants_t.hpp @@ -15,6 +15,7 @@ #include #endif #include +#include namespace codegen_multi_function_test @@ -164,6 +165,13 @@ class inputs_constants_t } #endif + // The fmt library does not use operator<< implicitly, so it is given format_as instead. + friend std::string format_as(const inputs_constants_t& obj) { + std::ostringstream _stream; + _stream << obj; + return _stream.str(); + } + #if defined(SKYMARSHAL_STORING_ENABLED) // Return value is 0 if the operation succeeded. // If the operation failed, return value is equal to 1 + the index of the first invalid field, diff --git a/test/symforce_function_codegen_test_data/symengine/codegen_multi_function_test_data/cpp/lcmtypes/codegen_multi_function_test/inputs_states_t.hpp b/test/symforce_function_codegen_test_data/symengine/codegen_multi_function_test_data/cpp/lcmtypes/codegen_multi_function_test/inputs_states_t.hpp index 05a67cfa..47e42cfb 100644 --- a/test/symforce_function_codegen_test_data/symengine/codegen_multi_function_test_data/cpp/lcmtypes/codegen_multi_function_test/inputs_states_t.hpp +++ b/test/symforce_function_codegen_test_data/symengine/codegen_multi_function_test_data/cpp/lcmtypes/codegen_multi_function_test/inputs_states_t.hpp @@ -15,6 +15,7 @@ #include #endif #include +#include #include "lcmtypes/eigen_lcm/Vector2d.hpp" @@ -172,6 +173,13 @@ class inputs_states_t } #endif + // The fmt library does not use operator<< implicitly, so it is given format_as instead. + friend std::string format_as(const inputs_states_t& obj) { + std::ostringstream _stream; + _stream << obj; + return _stream.str(); + } + #if defined(SKYMARSHAL_STORING_ENABLED) // Return value is 0 if the operation succeeded. // If the operation failed, return value is equal to 1 + the index of the first invalid field, diff --git a/test/symforce_function_codegen_test_data/symengine/codegen_multi_function_test_data/cpp/lcmtypes/codegen_multi_function_test/inputs_t.hpp b/test/symforce_function_codegen_test_data/symengine/codegen_multi_function_test_data/cpp/lcmtypes/codegen_multi_function_test/inputs_t.hpp index ca87de04..524e234c 100644 --- a/test/symforce_function_codegen_test_data/symengine/codegen_multi_function_test_data/cpp/lcmtypes/codegen_multi_function_test/inputs_t.hpp +++ b/test/symforce_function_codegen_test_data/symengine/codegen_multi_function_test_data/cpp/lcmtypes/codegen_multi_function_test/inputs_t.hpp @@ -15,6 +15,7 @@ #include #endif #include +#include #include #include "lcmtypes/codegen_multi_function_test/inputs_constants_t.hpp" @@ -321,6 +322,13 @@ class inputs_t } #endif + // The fmt library does not use operator<< implicitly, so it is given format_as instead. + friend std::string format_as(const inputs_t& obj) { + std::ostringstream _stream; + _stream << obj; + return _stream.str(); + } + #if defined(SKYMARSHAL_STORING_ENABLED) // Return value is 0 if the operation succeeded. // If the operation failed, return value is equal to 1 + the index of the first invalid field, diff --git a/test/symforce_function_codegen_test_data/symengine/codegen_multi_function_test_data/cpp/lcmtypes/codegen_multi_function_test/outputs_1_t.hpp b/test/symforce_function_codegen_test_data/symengine/codegen_multi_function_test_data/cpp/lcmtypes/codegen_multi_function_test/outputs_1_t.hpp index 271120d1..f2dcad5b 100644 --- a/test/symforce_function_codegen_test_data/symengine/codegen_multi_function_test_data/cpp/lcmtypes/codegen_multi_function_test/outputs_1_t.hpp +++ b/test/symforce_function_codegen_test_data/symengine/codegen_multi_function_test_data/cpp/lcmtypes/codegen_multi_function_test/outputs_1_t.hpp @@ -15,6 +15,7 @@ #include #endif #include +#include #include #include "lcmtypes/codegen_multi_function_test/values_vec_t.hpp" @@ -253,6 +254,13 @@ class outputs_1_t } #endif + // The fmt library does not use operator<< implicitly, so it is given format_as instead. + friend std::string format_as(const outputs_1_t& obj) { + std::ostringstream _stream; + _stream << obj; + return _stream.str(); + } + #if defined(SKYMARSHAL_STORING_ENABLED) // Return value is 0 if the operation succeeded. // If the operation failed, return value is equal to 1 + the index of the first invalid field, diff --git a/test/symforce_function_codegen_test_data/symengine/codegen_multi_function_test_data/cpp/lcmtypes/codegen_multi_function_test/outputs_2_t.hpp b/test/symforce_function_codegen_test_data/symengine/codegen_multi_function_test_data/cpp/lcmtypes/codegen_multi_function_test/outputs_2_t.hpp index 7394d425..78db8e9d 100644 --- a/test/symforce_function_codegen_test_data/symengine/codegen_multi_function_test_data/cpp/lcmtypes/codegen_multi_function_test/outputs_2_t.hpp +++ b/test/symforce_function_codegen_test_data/symengine/codegen_multi_function_test_data/cpp/lcmtypes/codegen_multi_function_test/outputs_2_t.hpp @@ -15,6 +15,7 @@ #include #endif #include +#include namespace codegen_multi_function_test @@ -164,6 +165,13 @@ class outputs_2_t } #endif + // The fmt library does not use operator<< implicitly, so it is given format_as instead. + friend std::string format_as(const outputs_2_t& obj) { + std::ostringstream _stream; + _stream << obj; + return _stream.str(); + } + #if defined(SKYMARSHAL_STORING_ENABLED) // Return value is 0 if the operation succeeded. // If the operation failed, return value is equal to 1 + the index of the first invalid field, diff --git a/test/symforce_function_codegen_test_data/symengine/codegen_multi_function_test_data/cpp/lcmtypes/codegen_multi_function_test/values_vec_t.hpp b/test/symforce_function_codegen_test_data/symengine/codegen_multi_function_test_data/cpp/lcmtypes/codegen_multi_function_test/values_vec_t.hpp index ed8573ae..8dfb6e73 100644 --- a/test/symforce_function_codegen_test_data/symengine/codegen_multi_function_test_data/cpp/lcmtypes/codegen_multi_function_test/values_vec_t.hpp +++ b/test/symforce_function_codegen_test_data/symengine/codegen_multi_function_test_data/cpp/lcmtypes/codegen_multi_function_test/values_vec_t.hpp @@ -15,6 +15,7 @@ #include #endif #include +#include #include #include "lcmtypes/eigen_lcm/Vector4d.hpp" @@ -238,6 +239,13 @@ class values_vec_t } #endif + // The fmt library does not use operator<< implicitly, so it is given format_as instead. + friend std::string format_as(const values_vec_t& obj) { + std::ostringstream _stream; + _stream << obj; + return _stream.str(); + } + #if defined(SKYMARSHAL_STORING_ENABLED) // Return value is 0 if the operation succeeded. // If the operation failed, return value is equal to 1 + the index of the first invalid field, diff --git a/test/symforce_function_codegen_test_data/symengine/codegen_python_test_data/cpp/lcmtypes/codegen_python_test/constants_t.hpp b/test/symforce_function_codegen_test_data/symengine/codegen_python_test_data/cpp/lcmtypes/codegen_python_test/constants_t.hpp index dce06d5c..3e64ab12 100644 --- a/test/symforce_function_codegen_test_data/symengine/codegen_python_test_data/cpp/lcmtypes/codegen_python_test/constants_t.hpp +++ b/test/symforce_function_codegen_test_data/symengine/codegen_python_test_data/cpp/lcmtypes/codegen_python_test/constants_t.hpp @@ -15,6 +15,7 @@ #include #endif #include +#include namespace codegen_python_test @@ -164,6 +165,13 @@ class constants_t } #endif + // The fmt library does not use operator<< implicitly, so it is given format_as instead. + friend std::string format_as(const constants_t& obj) { + std::ostringstream _stream; + _stream << obj; + return _stream.str(); + } + #if defined(SKYMARSHAL_STORING_ENABLED) // Return value is 0 if the operation succeeded. // If the operation failed, return value is equal to 1 + the index of the first invalid field, diff --git a/test/symforce_function_codegen_test_data/symengine/codegen_python_test_data/cpp/lcmtypes/codegen_python_test/states_t.hpp b/test/symforce_function_codegen_test_data/symengine/codegen_python_test_data/cpp/lcmtypes/codegen_python_test/states_t.hpp index e5812f45..4a73f6ff 100644 --- a/test/symforce_function_codegen_test_data/symengine/codegen_python_test_data/cpp/lcmtypes/codegen_python_test/states_t.hpp +++ b/test/symforce_function_codegen_test_data/symengine/codegen_python_test_data/cpp/lcmtypes/codegen_python_test/states_t.hpp @@ -15,6 +15,7 @@ #include #endif #include +#include #include "lcmtypes/eigen_lcm/Vector2d.hpp" @@ -172,6 +173,13 @@ class states_t } #endif + // The fmt library does not use operator<< implicitly, so it is given format_as instead. + friend std::string format_as(const states_t& obj) { + std::ostringstream _stream; + _stream << obj; + return _stream.str(); + } + #if defined(SKYMARSHAL_STORING_ENABLED) // Return value is 0 if the operation succeeded. // If the operation failed, return value is equal to 1 + the index of the first invalid field, diff --git a/test/symforce_function_codegen_test_data/symengine/codegen_python_test_data/cpp/lcmtypes/codegen_python_test/values_vec_t.hpp b/test/symforce_function_codegen_test_data/symengine/codegen_python_test_data/cpp/lcmtypes/codegen_python_test/values_vec_t.hpp index a208f5f8..0ff25e09 100644 --- a/test/symforce_function_codegen_test_data/symengine/codegen_python_test_data/cpp/lcmtypes/codegen_python_test/values_vec_t.hpp +++ b/test/symforce_function_codegen_test_data/symengine/codegen_python_test_data/cpp/lcmtypes/codegen_python_test/values_vec_t.hpp @@ -15,6 +15,7 @@ #include #endif #include +#include #include #include "lcmtypes/eigen_lcm/Vector4d.hpp" @@ -238,6 +239,13 @@ class values_vec_t } #endif + // The fmt library does not use operator<< implicitly, so it is given format_as instead. + friend std::string format_as(const values_vec_t& obj) { + std::ostringstream _stream; + _stream << obj; + return _stream.str(); + } + #if defined(SKYMARSHAL_STORING_ENABLED) // Return value is 0 if the operation succeeded. // If the operation failed, return value is equal to 1 + the index of the first invalid field, diff --git a/test/symforce_function_codegen_test_data/symengine/with_jacobians_values/cpp/lcmtypes/sym/d_out_t.hpp b/test/symforce_function_codegen_test_data/symengine/with_jacobians_values/cpp/lcmtypes/sym/d_out_t.hpp index 21f06313..b2208bbf 100644 --- a/test/symforce_function_codegen_test_data/symengine/with_jacobians_values/cpp/lcmtypes/sym/d_out_t.hpp +++ b/test/symforce_function_codegen_test_data/symengine/with_jacobians_values/cpp/lcmtypes/sym/d_out_t.hpp @@ -15,6 +15,7 @@ #include #endif #include +#include namespace sym @@ -177,6 +178,13 @@ class d_out_t } #endif + // The fmt library does not use operator<< implicitly, so it is given format_as instead. + friend std::string format_as(const d_out_t& obj) { + std::ostringstream _stream; + _stream << obj; + return _stream.str(); + } + #if defined(SKYMARSHAL_STORING_ENABLED) // Return value is 0 if the operation succeeded. // If the operation failed, return value is equal to 1 + the index of the first invalid field, diff --git a/test/symforce_function_codegen_test_data/symengine/with_jacobians_values/cpp/lcmtypes/sym/d_t.hpp b/test/symforce_function_codegen_test_data/symengine/with_jacobians_values/cpp/lcmtypes/sym/d_t.hpp index b43db198..23bc1155 100644 --- a/test/symforce_function_codegen_test_data/symengine/with_jacobians_values/cpp/lcmtypes/sym/d_t.hpp +++ b/test/symforce_function_codegen_test_data/symengine/with_jacobians_values/cpp/lcmtypes/sym/d_t.hpp @@ -15,6 +15,7 @@ #include #endif #include +#include #include "lcmtypes/eigen_lcm/Vector2d.hpp" @@ -185,6 +186,13 @@ class d_t } #endif + // The fmt library does not use operator<< implicitly, so it is given format_as instead. + friend std::string format_as(const d_t& obj) { + std::ostringstream _stream; + _stream << obj; + return _stream.str(); + } + #if defined(SKYMARSHAL_STORING_ENABLED) // Return value is 0 if the operation succeeded. // If the operation failed, return value is equal to 1 + the index of the first invalid field, diff --git a/test/symforce_function_codegen_test_data/sympy/codegen_dataclass_in_values_test_data/cpp/lcmtypes/codegen_test/my_dataclass_t.hpp b/test/symforce_function_codegen_test_data/sympy/codegen_dataclass_in_values_test_data/cpp/lcmtypes/codegen_test/my_dataclass_t.hpp index bf0647fc..ceb69670 100644 --- a/test/symforce_function_codegen_test_data/sympy/codegen_dataclass_in_values_test_data/cpp/lcmtypes/codegen_test/my_dataclass_t.hpp +++ b/test/symforce_function_codegen_test_data/sympy/codegen_dataclass_in_values_test_data/cpp/lcmtypes/codegen_test/my_dataclass_t.hpp @@ -15,6 +15,7 @@ #include #endif #include +#include #include "lcmtypes/eigen_lcm/Vector4d.hpp" @@ -172,6 +173,13 @@ class my_dataclass_t } #endif + // The fmt library does not use operator<< implicitly, so it is given format_as instead. + friend std::string format_as(const my_dataclass_t& obj) { + std::ostringstream _stream; + _stream << obj; + return _stream.str(); + } + #if defined(SKYMARSHAL_STORING_ENABLED) // Return value is 0 if the operation succeeded. // If the operation failed, return value is equal to 1 + the index of the first invalid field, diff --git a/test/symforce_function_codegen_test_data/sympy/with_jacobians_values/cpp/lcmtypes/sym/d_out_t.hpp b/test/symforce_function_codegen_test_data/sympy/with_jacobians_values/cpp/lcmtypes/sym/d_out_t.hpp index 21f06313..b2208bbf 100644 --- a/test/symforce_function_codegen_test_data/sympy/with_jacobians_values/cpp/lcmtypes/sym/d_out_t.hpp +++ b/test/symforce_function_codegen_test_data/sympy/with_jacobians_values/cpp/lcmtypes/sym/d_out_t.hpp @@ -15,6 +15,7 @@ #include #endif #include +#include namespace sym @@ -177,6 +178,13 @@ class d_out_t } #endif + // The fmt library does not use operator<< implicitly, so it is given format_as instead. + friend std::string format_as(const d_out_t& obj) { + std::ostringstream _stream; + _stream << obj; + return _stream.str(); + } + #if defined(SKYMARSHAL_STORING_ENABLED) // Return value is 0 if the operation succeeded. // If the operation failed, return value is equal to 1 + the index of the first invalid field, diff --git a/test/symforce_function_codegen_test_data/sympy/with_jacobians_values/cpp/lcmtypes/sym/d_t.hpp b/test/symforce_function_codegen_test_data/sympy/with_jacobians_values/cpp/lcmtypes/sym/d_t.hpp index b43db198..23bc1155 100644 --- a/test/symforce_function_codegen_test_data/sympy/with_jacobians_values/cpp/lcmtypes/sym/d_t.hpp +++ b/test/symforce_function_codegen_test_data/sympy/with_jacobians_values/cpp/lcmtypes/sym/d_t.hpp @@ -15,6 +15,7 @@ #include #endif #include +#include #include "lcmtypes/eigen_lcm/Vector2d.hpp" @@ -185,6 +186,13 @@ class d_t } #endif + // The fmt library does not use operator<< implicitly, so it is given format_as instead. + friend std::string format_as(const d_t& obj) { + std::ostringstream _stream; + _stream << obj; + return _stream.str(); + } + #if defined(SKYMARSHAL_STORING_ENABLED) // Return value is 0 if the operation succeeded. // If the operation failed, return value is equal to 1 + the index of the first invalid field, diff --git a/third_party/eigen_lcm/lcmtypes/eigen_lcm_lcm/cpp/lcmtypes/eigen_lcm/Matrix24d.hpp b/third_party/eigen_lcm/lcmtypes/eigen_lcm_lcm/cpp/lcmtypes/eigen_lcm/Matrix24d.hpp index cda6f45e..eab9c7ef 100644 --- a/third_party/eigen_lcm/lcmtypes/eigen_lcm_lcm/cpp/lcmtypes/eigen_lcm/Matrix24d.hpp +++ b/third_party/eigen_lcm/lcmtypes/eigen_lcm_lcm/cpp/lcmtypes/eigen_lcm/Matrix24d.hpp @@ -1,6 +1,9 @@ // This file was hand-written, modified from the Matrix24d type, with the hash // generated by skymarshal. #pragma once +#include +#include +#include #include #include @@ -34,7 +37,7 @@ class Matrix24d : public Eigen::Matrix { // Stream formatting operator friend std::ostream& operator<<(std::ostream& os, const eigen_lcm::Matrix24d& obj) { os << "Matrix24d("; - for (size_t i = 0; i < obj.size(); ++i) { + for (Eigen::Index i = 0; i < obj.size(); ++i) { os << obj.data()[i]; if (i + 1 != obj.size()) { os << ", "; @@ -44,6 +47,17 @@ class Matrix24d : public Eigen::Matrix { return os; } + // The fmt library does not use operator<< implicitly, so it is given format_as instead. + // Constrained to the exact type so the pass through constructor above cannot make it viable + // for containers of this type. + template + friend std::enable_if_t::value, std::string> format_as( + const T& obj) { + std::ostringstream os; + os << obj; + return os.str(); + } + private: // Disable comma initialization magic for eigen_lcm types template diff --git a/third_party/eigen_lcm/lcmtypes/eigen_lcm_lcm/cpp/lcmtypes/eigen_lcm/Matrix2d.hpp b/third_party/eigen_lcm/lcmtypes/eigen_lcm_lcm/cpp/lcmtypes/eigen_lcm/Matrix2d.hpp index 467df438..653fb708 100644 --- a/third_party/eigen_lcm/lcmtypes/eigen_lcm_lcm/cpp/lcmtypes/eigen_lcm/Matrix2d.hpp +++ b/third_party/eigen_lcm/lcmtypes/eigen_lcm_lcm/cpp/lcmtypes/eigen_lcm/Matrix2d.hpp @@ -1,6 +1,9 @@ // This file was autogenerated by eigen_lcm // DO NOT MODIFY BY HAND! #pragma once +#include +#include +#include #include #include @@ -34,7 +37,7 @@ class Matrix2d : public Eigen::Matrix { // Stream formatting operator friend std::ostream& operator<<(std::ostream& os, const eigen_lcm::Matrix2d& obj) { os << "Matrix2d("; - for (size_t i = 0; i < obj.size(); ++i) { + for (Eigen::Index i = 0; i < obj.size(); ++i) { os << obj.data()[i]; if (i + 1 != obj.size()) { os << ", "; @@ -44,6 +47,17 @@ class Matrix2d : public Eigen::Matrix { return os; } + // The fmt library does not use operator<< implicitly, so it is given format_as instead. + // Constrained to the exact type so the pass through constructor above cannot make it viable + // for containers of this type. + template + friend std::enable_if_t::value, std::string> format_as( + const T& obj) { + std::ostringstream os; + os << obj; + return os.str(); + } + private: // Disable comma initialization magic for eigen_lcm types template diff --git a/third_party/eigen_lcm/lcmtypes/eigen_lcm_lcm/cpp/lcmtypes/eigen_lcm/Matrix2f.hpp b/third_party/eigen_lcm/lcmtypes/eigen_lcm_lcm/cpp/lcmtypes/eigen_lcm/Matrix2f.hpp index f49e410f..228b9072 100644 --- a/third_party/eigen_lcm/lcmtypes/eigen_lcm_lcm/cpp/lcmtypes/eigen_lcm/Matrix2f.hpp +++ b/third_party/eigen_lcm/lcmtypes/eigen_lcm_lcm/cpp/lcmtypes/eigen_lcm/Matrix2f.hpp @@ -1,6 +1,9 @@ // This file was autogenerated by eigen_lcm // DO NOT MODIFY BY HAND! #pragma once +#include +#include +#include #include #include @@ -34,7 +37,7 @@ class Matrix2f : public Eigen::Matrix { // Stream formatting operator friend std::ostream& operator<<(std::ostream& os, const eigen_lcm::Matrix2f& obj) { os << "Matrix2f("; - for (size_t i = 0; i < obj.size(); ++i) { + for (Eigen::Index i = 0; i < obj.size(); ++i) { os << obj.data()[i]; if (i + 1 != obj.size()) { os << ", "; @@ -44,6 +47,17 @@ class Matrix2f : public Eigen::Matrix { return os; } + // The fmt library does not use operator<< implicitly, so it is given format_as instead. + // Constrained to the exact type so the pass through constructor above cannot make it viable + // for containers of this type. + template + friend std::enable_if_t::value, std::string> format_as( + const T& obj) { + std::ostringstream os; + os << obj; + return os.str(); + } + private: // Disable comma initialization magic for eigen_lcm types template diff --git a/third_party/eigen_lcm/lcmtypes/eigen_lcm_lcm/cpp/lcmtypes/eigen_lcm/Matrix2i.hpp b/third_party/eigen_lcm/lcmtypes/eigen_lcm_lcm/cpp/lcmtypes/eigen_lcm/Matrix2i.hpp index 73d2bcf3..6d8f224f 100644 --- a/third_party/eigen_lcm/lcmtypes/eigen_lcm_lcm/cpp/lcmtypes/eigen_lcm/Matrix2i.hpp +++ b/third_party/eigen_lcm/lcmtypes/eigen_lcm_lcm/cpp/lcmtypes/eigen_lcm/Matrix2i.hpp @@ -1,6 +1,9 @@ // This file was autogenerated by eigen_lcm // DO NOT MODIFY BY HAND! #pragma once +#include +#include +#include #include #include @@ -34,7 +37,7 @@ class Matrix2i : public Eigen::Matrix { // Stream formatting operator friend std::ostream& operator<<(std::ostream& os, const eigen_lcm::Matrix2i& obj) { os << "Matrix2i("; - for (size_t i = 0; i < obj.size(); ++i) { + for (Eigen::Index i = 0; i < obj.size(); ++i) { os << obj.data()[i]; if (i + 1 != obj.size()) { os << ", "; @@ -44,6 +47,17 @@ class Matrix2i : public Eigen::Matrix { return os; } + // The fmt library does not use operator<< implicitly, so it is given format_as instead. + // Constrained to the exact type so the pass through constructor above cannot make it viable + // for containers of this type. + template + friend std::enable_if_t::value, std::string> format_as( + const T& obj) { + std::ostringstream os; + os << obj; + return os.str(); + } + private: // Disable comma initialization magic for eigen_lcm types template diff --git a/third_party/eigen_lcm/lcmtypes/eigen_lcm_lcm/cpp/lcmtypes/eigen_lcm/Matrix34d.hpp b/third_party/eigen_lcm/lcmtypes/eigen_lcm_lcm/cpp/lcmtypes/eigen_lcm/Matrix34d.hpp index 39a58829..ce7d6e8e 100644 --- a/third_party/eigen_lcm/lcmtypes/eigen_lcm_lcm/cpp/lcmtypes/eigen_lcm/Matrix34d.hpp +++ b/third_party/eigen_lcm/lcmtypes/eigen_lcm_lcm/cpp/lcmtypes/eigen_lcm/Matrix34d.hpp @@ -1,6 +1,9 @@ // This file was hand-written, modified from the Matrix34d type, with the hash // generated by skymarshal. #pragma once +#include +#include +#include #include #include @@ -34,7 +37,7 @@ class Matrix34d : public Eigen::Matrix { // Stream formatting operator friend std::ostream& operator<<(std::ostream& os, const eigen_lcm::Matrix34d& obj) { os << "Matrix34d("; - for (size_t i = 0; i < obj.size(); ++i) { + for (Eigen::Index i = 0; i < obj.size(); ++i) { os << obj.data()[i]; if (i + 1 != obj.size()) { os << ", "; @@ -44,6 +47,17 @@ class Matrix34d : public Eigen::Matrix { return os; } + // The fmt library does not use operator<< implicitly, so it is given format_as instead. + // Constrained to the exact type so the pass through constructor above cannot make it viable + // for containers of this type. + template + friend std::enable_if_t::value, std::string> format_as( + const T& obj) { + std::ostringstream os; + os << obj; + return os.str(); + } + private: // Disable comma initialization magic for eigen_lcm types template diff --git a/third_party/eigen_lcm/lcmtypes/eigen_lcm_lcm/cpp/lcmtypes/eigen_lcm/Matrix3d.hpp b/third_party/eigen_lcm/lcmtypes/eigen_lcm_lcm/cpp/lcmtypes/eigen_lcm/Matrix3d.hpp index f575c7b1..75562293 100644 --- a/third_party/eigen_lcm/lcmtypes/eigen_lcm_lcm/cpp/lcmtypes/eigen_lcm/Matrix3d.hpp +++ b/third_party/eigen_lcm/lcmtypes/eigen_lcm_lcm/cpp/lcmtypes/eigen_lcm/Matrix3d.hpp @@ -1,6 +1,9 @@ // This file was autogenerated by eigen_lcm // DO NOT MODIFY BY HAND! #pragma once +#include +#include +#include #include #include @@ -34,7 +37,7 @@ class Matrix3d : public Eigen::Matrix { // Stream formatting operator friend std::ostream& operator<<(std::ostream& os, const eigen_lcm::Matrix3d& obj) { os << "Matrix3d("; - for (size_t i = 0; i < obj.size(); ++i) { + for (Eigen::Index i = 0; i < obj.size(); ++i) { os << obj.data()[i]; if (i + 1 != obj.size()) { os << ", "; @@ -44,6 +47,17 @@ class Matrix3d : public Eigen::Matrix { return os; } + // The fmt library does not use operator<< implicitly, so it is given format_as instead. + // Constrained to the exact type so the pass through constructor above cannot make it viable + // for containers of this type. + template + friend std::enable_if_t::value, std::string> format_as( + const T& obj) { + std::ostringstream os; + os << obj; + return os.str(); + } + private: // Disable comma initialization magic for eigen_lcm types template diff --git a/third_party/eigen_lcm/lcmtypes/eigen_lcm_lcm/cpp/lcmtypes/eigen_lcm/Matrix3f.hpp b/third_party/eigen_lcm/lcmtypes/eigen_lcm_lcm/cpp/lcmtypes/eigen_lcm/Matrix3f.hpp index ed336ec7..dc1aff69 100644 --- a/third_party/eigen_lcm/lcmtypes/eigen_lcm_lcm/cpp/lcmtypes/eigen_lcm/Matrix3f.hpp +++ b/third_party/eigen_lcm/lcmtypes/eigen_lcm_lcm/cpp/lcmtypes/eigen_lcm/Matrix3f.hpp @@ -1,6 +1,9 @@ // This file was autogenerated by eigen_lcm // DO NOT MODIFY BY HAND! #pragma once +#include +#include +#include #include #include @@ -34,7 +37,7 @@ class Matrix3f : public Eigen::Matrix { // Stream formatting operator friend std::ostream& operator<<(std::ostream& os, const eigen_lcm::Matrix3f& obj) { os << "Matrix3f("; - for (size_t i = 0; i < obj.size(); ++i) { + for (Eigen::Index i = 0; i < obj.size(); ++i) { os << obj.data()[i]; if (i + 1 != obj.size()) { os << ", "; @@ -44,6 +47,17 @@ class Matrix3f : public Eigen::Matrix { return os; } + // The fmt library does not use operator<< implicitly, so it is given format_as instead. + // Constrained to the exact type so the pass through constructor above cannot make it viable + // for containers of this type. + template + friend std::enable_if_t::value, std::string> format_as( + const T& obj) { + std::ostringstream os; + os << obj; + return os.str(); + } + private: // Disable comma initialization magic for eigen_lcm types template diff --git a/third_party/eigen_lcm/lcmtypes/eigen_lcm_lcm/cpp/lcmtypes/eigen_lcm/Matrix3i.hpp b/third_party/eigen_lcm/lcmtypes/eigen_lcm_lcm/cpp/lcmtypes/eigen_lcm/Matrix3i.hpp index 123c85a4..3f8c1d05 100644 --- a/third_party/eigen_lcm/lcmtypes/eigen_lcm_lcm/cpp/lcmtypes/eigen_lcm/Matrix3i.hpp +++ b/third_party/eigen_lcm/lcmtypes/eigen_lcm_lcm/cpp/lcmtypes/eigen_lcm/Matrix3i.hpp @@ -1,6 +1,9 @@ // This file was autogenerated by eigen_lcm // DO NOT MODIFY BY HAND! #pragma once +#include +#include +#include #include #include @@ -34,7 +37,7 @@ class Matrix3i : public Eigen::Matrix { // Stream formatting operator friend std::ostream& operator<<(std::ostream& os, const eigen_lcm::Matrix3i& obj) { os << "Matrix3i("; - for (size_t i = 0; i < obj.size(); ++i) { + for (Eigen::Index i = 0; i < obj.size(); ++i) { os << obj.data()[i]; if (i + 1 != obj.size()) { os << ", "; @@ -44,6 +47,17 @@ class Matrix3i : public Eigen::Matrix { return os; } + // The fmt library does not use operator<< implicitly, so it is given format_as instead. + // Constrained to the exact type so the pass through constructor above cannot make it viable + // for containers of this type. + template + friend std::enable_if_t::value, std::string> format_as( + const T& obj) { + std::ostringstream os; + os << obj; + return os.str(); + } + private: // Disable comma initialization magic for eigen_lcm types template diff --git a/third_party/eigen_lcm/lcmtypes/eigen_lcm_lcm/cpp/lcmtypes/eigen_lcm/Matrix43f.hpp b/third_party/eigen_lcm/lcmtypes/eigen_lcm_lcm/cpp/lcmtypes/eigen_lcm/Matrix43f.hpp index dc9618a8..f3c474a3 100644 --- a/third_party/eigen_lcm/lcmtypes/eigen_lcm_lcm/cpp/lcmtypes/eigen_lcm/Matrix43f.hpp +++ b/third_party/eigen_lcm/lcmtypes/eigen_lcm_lcm/cpp/lcmtypes/eigen_lcm/Matrix43f.hpp @@ -1,6 +1,9 @@ // This file was hand-written, modified from the Matrix43f type, with the hash // generated by skymarshal. #pragma once +#include +#include +#include #include #include @@ -34,7 +37,7 @@ class Matrix43f : public Eigen::Matrix { // Stream formatting operator friend std::ostream& operator<<(std::ostream& os, const eigen_lcm::Matrix43f& obj) { os << "Matrix43f("; - for (size_t i = 0; i < obj.size(); ++i) { + for (Eigen::Index i = 0; i < obj.size(); ++i) { os << obj.data()[i]; if (i + 1 != obj.size()) { os << ", "; @@ -44,6 +47,17 @@ class Matrix43f : public Eigen::Matrix { return os; } + // The fmt library does not use operator<< implicitly, so it is given format_as instead. + // Constrained to the exact type so the pass through constructor above cannot make it viable + // for containers of this type. + template + friend std::enable_if_t::value, std::string> format_as( + const T& obj) { + std::ostringstream os; + os << obj; + return os.str(); + } + private: // Disable comma initialization magic for eigen_lcm types template diff --git a/third_party/eigen_lcm/lcmtypes/eigen_lcm_lcm/cpp/lcmtypes/eigen_lcm/Matrix4d.hpp b/third_party/eigen_lcm/lcmtypes/eigen_lcm_lcm/cpp/lcmtypes/eigen_lcm/Matrix4d.hpp index 693015e9..f49c4f0b 100644 --- a/third_party/eigen_lcm/lcmtypes/eigen_lcm_lcm/cpp/lcmtypes/eigen_lcm/Matrix4d.hpp +++ b/third_party/eigen_lcm/lcmtypes/eigen_lcm_lcm/cpp/lcmtypes/eigen_lcm/Matrix4d.hpp @@ -1,6 +1,9 @@ // This file was autogenerated by eigen_lcm // DO NOT MODIFY BY HAND! #pragma once +#include +#include +#include #include #include @@ -34,7 +37,7 @@ class Matrix4d : public Eigen::Matrix { // Stream formatting operator friend std::ostream& operator<<(std::ostream& os, const eigen_lcm::Matrix4d& obj) { os << "Matrix4d("; - for (size_t i = 0; i < obj.size(); ++i) { + for (Eigen::Index i = 0; i < obj.size(); ++i) { os << obj.data()[i]; if (i + 1 != obj.size()) { os << ", "; @@ -44,6 +47,17 @@ class Matrix4d : public Eigen::Matrix { return os; } + // The fmt library does not use operator<< implicitly, so it is given format_as instead. + // Constrained to the exact type so the pass through constructor above cannot make it viable + // for containers of this type. + template + friend std::enable_if_t::value, std::string> format_as( + const T& obj) { + std::ostringstream os; + os << obj; + return os.str(); + } + private: // Disable comma initialization magic for eigen_lcm types template diff --git a/third_party/eigen_lcm/lcmtypes/eigen_lcm_lcm/cpp/lcmtypes/eigen_lcm/Matrix4f.hpp b/third_party/eigen_lcm/lcmtypes/eigen_lcm_lcm/cpp/lcmtypes/eigen_lcm/Matrix4f.hpp index d7c2679a..2f6dec96 100644 --- a/third_party/eigen_lcm/lcmtypes/eigen_lcm_lcm/cpp/lcmtypes/eigen_lcm/Matrix4f.hpp +++ b/third_party/eigen_lcm/lcmtypes/eigen_lcm_lcm/cpp/lcmtypes/eigen_lcm/Matrix4f.hpp @@ -1,6 +1,9 @@ // This file was autogenerated by eigen_lcm // DO NOT MODIFY BY HAND! #pragma once +#include +#include +#include #include #include @@ -34,7 +37,7 @@ class Matrix4f : public Eigen::Matrix { // Stream formatting operator friend std::ostream& operator<<(std::ostream& os, const eigen_lcm::Matrix4f& obj) { os << "Matrix4f("; - for (size_t i = 0; i < obj.size(); ++i) { + for (Eigen::Index i = 0; i < obj.size(); ++i) { os << obj.data()[i]; if (i + 1 != obj.size()) { os << ", "; @@ -44,6 +47,17 @@ class Matrix4f : public Eigen::Matrix { return os; } + // The fmt library does not use operator<< implicitly, so it is given format_as instead. + // Constrained to the exact type so the pass through constructor above cannot make it viable + // for containers of this type. + template + friend std::enable_if_t::value, std::string> format_as( + const T& obj) { + std::ostringstream os; + os << obj; + return os.str(); + } + private: // Disable comma initialization magic for eigen_lcm types template diff --git a/third_party/eigen_lcm/lcmtypes/eigen_lcm_lcm/cpp/lcmtypes/eigen_lcm/Matrix4i.hpp b/third_party/eigen_lcm/lcmtypes/eigen_lcm_lcm/cpp/lcmtypes/eigen_lcm/Matrix4i.hpp index 4c3fa0aa..5871bfa0 100644 --- a/third_party/eigen_lcm/lcmtypes/eigen_lcm_lcm/cpp/lcmtypes/eigen_lcm/Matrix4i.hpp +++ b/third_party/eigen_lcm/lcmtypes/eigen_lcm_lcm/cpp/lcmtypes/eigen_lcm/Matrix4i.hpp @@ -1,6 +1,9 @@ // This file was autogenerated by eigen_lcm // DO NOT MODIFY BY HAND! #pragma once +#include +#include +#include #include #include @@ -34,7 +37,7 @@ class Matrix4i : public Eigen::Matrix { // Stream formatting operator friend std::ostream& operator<<(std::ostream& os, const eigen_lcm::Matrix4i& obj) { os << "Matrix4i("; - for (size_t i = 0; i < obj.size(); ++i) { + for (Eigen::Index i = 0; i < obj.size(); ++i) { os << obj.data()[i]; if (i + 1 != obj.size()) { os << ", "; @@ -44,6 +47,17 @@ class Matrix4i : public Eigen::Matrix { return os; } + // The fmt library does not use operator<< implicitly, so it is given format_as instead. + // Constrained to the exact type so the pass through constructor above cannot make it viable + // for containers of this type. + template + friend std::enable_if_t::value, std::string> format_as( + const T& obj) { + std::ostringstream os; + os << obj; + return os.str(); + } + private: // Disable comma initialization magic for eigen_lcm types template diff --git a/third_party/eigen_lcm/lcmtypes/eigen_lcm_lcm/cpp/lcmtypes/eigen_lcm/Matrix54d.hpp b/third_party/eigen_lcm/lcmtypes/eigen_lcm_lcm/cpp/lcmtypes/eigen_lcm/Matrix54d.hpp index c922a9bb..a207abf6 100644 --- a/third_party/eigen_lcm/lcmtypes/eigen_lcm_lcm/cpp/lcmtypes/eigen_lcm/Matrix54d.hpp +++ b/third_party/eigen_lcm/lcmtypes/eigen_lcm_lcm/cpp/lcmtypes/eigen_lcm/Matrix54d.hpp @@ -1,6 +1,9 @@ // This file was hand-written, modified from the Matrix54d type, with the hash // generated by skymarshal. #pragma once +#include +#include +#include #include #include @@ -34,7 +37,7 @@ class Matrix54d : public Eigen::Matrix { // Stream formatting operator friend std::ostream& operator<<(std::ostream& os, const eigen_lcm::Matrix54d& obj) { os << "Matrix54d("; - for (size_t i = 0; i < obj.size(); ++i) { + for (Eigen::Index i = 0; i < obj.size(); ++i) { os << obj.data()[i]; if (i + 1 != obj.size()) { os << ", "; @@ -44,6 +47,17 @@ class Matrix54d : public Eigen::Matrix { return os; } + // The fmt library does not use operator<< implicitly, so it is given format_as instead. + // Constrained to the exact type so the pass through constructor above cannot make it viable + // for containers of this type. + template + friend std::enable_if_t::value, std::string> format_as( + const T& obj) { + std::ostringstream os; + os << obj; + return os.str(); + } + private: // Disable comma initialization magic for eigen_lcm types template diff --git a/third_party/eigen_lcm/lcmtypes/eigen_lcm_lcm/cpp/lcmtypes/eigen_lcm/Matrix68f.hpp b/third_party/eigen_lcm/lcmtypes/eigen_lcm_lcm/cpp/lcmtypes/eigen_lcm/Matrix68f.hpp index ba4e0e39..d7e6c1bc 100644 --- a/third_party/eigen_lcm/lcmtypes/eigen_lcm_lcm/cpp/lcmtypes/eigen_lcm/Matrix68f.hpp +++ b/third_party/eigen_lcm/lcmtypes/eigen_lcm_lcm/cpp/lcmtypes/eigen_lcm/Matrix68f.hpp @@ -1,6 +1,9 @@ // This file was hand-written, modified from the Matrix68f type, with the hash // generated by skymarshal. #pragma once +#include +#include +#include #include #include @@ -34,7 +37,7 @@ class Matrix68f : public Eigen::Matrix { // Stream formatting operator friend std::ostream& operator<<(std::ostream& os, const eigen_lcm::Matrix68f& obj) { os << "Matrix68f("; - for (size_t i = 0; i < obj.size(); ++i) { + for (Eigen::Index i = 0; i < obj.size(); ++i) { os << obj.data()[i]; if (i + 1 != obj.size()) { os << ", "; @@ -44,6 +47,17 @@ class Matrix68f : public Eigen::Matrix { return os; } + // The fmt library does not use operator<< implicitly, so it is given format_as instead. + // Constrained to the exact type so the pass through constructor above cannot make it viable + // for containers of this type. + template + friend std::enable_if_t::value, std::string> format_as( + const T& obj) { + std::ostringstream os; + os << obj; + return os.str(); + } + private: // Disable comma initialization magic for eigen_lcm types template diff --git a/third_party/eigen_lcm/lcmtypes/eigen_lcm_lcm/cpp/lcmtypes/eigen_lcm/MatrixXd.hpp b/third_party/eigen_lcm/lcmtypes/eigen_lcm_lcm/cpp/lcmtypes/eigen_lcm/MatrixXd.hpp index e5ee2a8c..2c301f0c 100644 --- a/third_party/eigen_lcm/lcmtypes/eigen_lcm_lcm/cpp/lcmtypes/eigen_lcm/MatrixXd.hpp +++ b/third_party/eigen_lcm/lcmtypes/eigen_lcm_lcm/cpp/lcmtypes/eigen_lcm/MatrixXd.hpp @@ -1,6 +1,9 @@ // This file was autogenerated by eigen_lcm // DO NOT MODIFY BY HAND! #pragma once +#include +#include +#include #include #include @@ -33,7 +36,7 @@ class MatrixXd : public Eigen::Matrix + friend std::enable_if_t::value, std::string> format_as( + const T& obj) { + std::ostringstream os; + os << obj; + return os.str(); + } + private: // Disable comma initialization magic for eigen_lcm types template diff --git a/third_party/eigen_lcm/lcmtypes/eigen_lcm_lcm/cpp/lcmtypes/eigen_lcm/MatrixXf.hpp b/third_party/eigen_lcm/lcmtypes/eigen_lcm_lcm/cpp/lcmtypes/eigen_lcm/MatrixXf.hpp index dea98884..af5c3a52 100644 --- a/third_party/eigen_lcm/lcmtypes/eigen_lcm_lcm/cpp/lcmtypes/eigen_lcm/MatrixXf.hpp +++ b/third_party/eigen_lcm/lcmtypes/eigen_lcm_lcm/cpp/lcmtypes/eigen_lcm/MatrixXf.hpp @@ -1,6 +1,9 @@ // This file was autogenerated by eigen_lcm // DO NOT MODIFY BY HAND! #pragma once +#include +#include +#include #include #include @@ -33,7 +36,7 @@ class MatrixXf : public Eigen::Matrix + friend std::enable_if_t::value, std::string> format_as( + const T& obj) { + std::ostringstream os; + os << obj; + return os.str(); + } + private: // Disable comma initialization magic for eigen_lcm types template diff --git a/third_party/eigen_lcm/lcmtypes/eigen_lcm_lcm/cpp/lcmtypes/eigen_lcm/MatrixXi.hpp b/third_party/eigen_lcm/lcmtypes/eigen_lcm_lcm/cpp/lcmtypes/eigen_lcm/MatrixXi.hpp index 70f33330..5dc97a3e 100644 --- a/third_party/eigen_lcm/lcmtypes/eigen_lcm_lcm/cpp/lcmtypes/eigen_lcm/MatrixXi.hpp +++ b/third_party/eigen_lcm/lcmtypes/eigen_lcm_lcm/cpp/lcmtypes/eigen_lcm/MatrixXi.hpp @@ -1,6 +1,9 @@ // This file was autogenerated by eigen_lcm // DO NOT MODIFY BY HAND! #pragma once +#include +#include +#include #include #include @@ -33,7 +36,7 @@ class MatrixXi : public Eigen::Matrix + friend std::enable_if_t::value, std::string> format_as( + const T& obj) { + std::ostringstream os; + os << obj; + return os.str(); + } + private: // Disable comma initialization magic for eigen_lcm types template diff --git a/third_party/eigen_lcm/lcmtypes/eigen_lcm_lcm/cpp/lcmtypes/eigen_lcm/Quaterniond.hpp b/third_party/eigen_lcm/lcmtypes/eigen_lcm_lcm/cpp/lcmtypes/eigen_lcm/Quaterniond.hpp index 7babf03e..5b5917f2 100644 --- a/third_party/eigen_lcm/lcmtypes/eigen_lcm_lcm/cpp/lcmtypes/eigen_lcm/Quaterniond.hpp +++ b/third_party/eigen_lcm/lcmtypes/eigen_lcm_lcm/cpp/lcmtypes/eigen_lcm/Quaterniond.hpp @@ -1,6 +1,9 @@ // This file was autogenerated by eigen_lcm // DO NOT MODIFY BY HAND! #pragma once +#include +#include +#include #include #include @@ -34,7 +37,7 @@ class Quaterniond : public Eigen::Quaternion { // Stream formatting operator friend std::ostream& operator<<(std::ostream& os, const eigen_lcm::Quaterniond& obj) { os << "Quaterniond("; - for (size_t i = 0; i < obj.coeffs().size(); ++i) { + for (Eigen::Index i = 0; i < obj.coeffs().size(); ++i) { os << obj.coeffs().data()[i]; if (i + 1 != obj.coeffs().size()) { os << ", "; @@ -44,6 +47,17 @@ class Quaterniond : public Eigen::Quaternion { return os; } + // The fmt library does not use operator<< implicitly, so it is given format_as instead. + // Constrained to the exact type so the pass through constructor above cannot make it viable + // for containers of this type. + template + friend std::enable_if_t::value, std::string> format_as( + const T& obj) { + std::ostringstream os; + os << obj; + return os.str(); + } + // Mimic the data() accessor of standard eigen lcm types inline const Coefficients& data() const { return coeffs(); diff --git a/third_party/eigen_lcm/lcmtypes/eigen_lcm_lcm/cpp/lcmtypes/eigen_lcm/Quaternionf.hpp b/third_party/eigen_lcm/lcmtypes/eigen_lcm_lcm/cpp/lcmtypes/eigen_lcm/Quaternionf.hpp index acd91b76..22e009ab 100644 --- a/third_party/eigen_lcm/lcmtypes/eigen_lcm_lcm/cpp/lcmtypes/eigen_lcm/Quaternionf.hpp +++ b/third_party/eigen_lcm/lcmtypes/eigen_lcm_lcm/cpp/lcmtypes/eigen_lcm/Quaternionf.hpp @@ -1,6 +1,9 @@ // This file was autogenerated by eigen_lcm // DO NOT MODIFY BY HAND! #pragma once +#include +#include +#include #include #include @@ -34,7 +37,7 @@ class Quaternionf : public Eigen::Quaternion { // Stream formatting operator friend std::ostream& operator<<(std::ostream& os, const eigen_lcm::Quaternionf& obj) { os << "Quaternionf("; - for (size_t i = 0; i < obj.coeffs().size(); ++i) { + for (Eigen::Index i = 0; i < obj.coeffs().size(); ++i) { os << obj.coeffs().data()[i]; if (i + 1 != obj.coeffs().size()) { os << ", "; @@ -44,6 +47,17 @@ class Quaternionf : public Eigen::Quaternion { return os; } + // The fmt library does not use operator<< implicitly, so it is given format_as instead. + // Constrained to the exact type so the pass through constructor above cannot make it viable + // for containers of this type. + template + friend std::enable_if_t::value, std::string> format_as( + const T& obj) { + std::ostringstream os; + os << obj; + return os.str(); + } + // Mimic the data() accessor of standard eigen lcm types inline const Coefficients& data() const { return coeffs(); diff --git a/third_party/eigen_lcm/lcmtypes/eigen_lcm_lcm/cpp/lcmtypes/eigen_lcm/SymmetricMatrix2d.hpp b/third_party/eigen_lcm/lcmtypes/eigen_lcm_lcm/cpp/lcmtypes/eigen_lcm/SymmetricMatrix2d.hpp index 2bf93192..2b15be68 100644 --- a/third_party/eigen_lcm/lcmtypes/eigen_lcm_lcm/cpp/lcmtypes/eigen_lcm/SymmetricMatrix2d.hpp +++ b/third_party/eigen_lcm/lcmtypes/eigen_lcm_lcm/cpp/lcmtypes/eigen_lcm/SymmetricMatrix2d.hpp @@ -1,6 +1,9 @@ // This file was autogenerated by eigen_lcm // DO NOT MODIFY BY HAND! #pragma once +#include +#include +#include #include #include @@ -34,7 +37,7 @@ class SymmetricMatrix2d : public Eigen::Matrix { // Stream formatting operator friend std::ostream& operator<<(std::ostream& os, const eigen_lcm::SymmetricMatrix2d& obj) { os << "SymmetricMatrix2d("; - for (size_t i = 0; i < obj.size(); ++i) { + for (Eigen::Index i = 0; i < obj.size(); ++i) { os << obj.data()[i]; if (i + 1 != obj.size()) { os << ", "; @@ -44,6 +47,17 @@ class SymmetricMatrix2d : public Eigen::Matrix { return os; } + // The fmt library does not use operator<< implicitly, so it is given format_as instead. + // Constrained to the exact type so the pass through constructor above cannot make it viable + // for containers of this type. + template + friend std::enable_if_t::value, std::string> + format_as(const T& obj) { + std::ostringstream os; + os << obj; + return os.str(); + } + private: // Disable comma initialization magic for eigen_lcm types template diff --git a/third_party/eigen_lcm/lcmtypes/eigen_lcm_lcm/cpp/lcmtypes/eigen_lcm/SymmetricMatrix2f.hpp b/third_party/eigen_lcm/lcmtypes/eigen_lcm_lcm/cpp/lcmtypes/eigen_lcm/SymmetricMatrix2f.hpp index a28f59da..ea550762 100644 --- a/third_party/eigen_lcm/lcmtypes/eigen_lcm_lcm/cpp/lcmtypes/eigen_lcm/SymmetricMatrix2f.hpp +++ b/third_party/eigen_lcm/lcmtypes/eigen_lcm_lcm/cpp/lcmtypes/eigen_lcm/SymmetricMatrix2f.hpp @@ -1,6 +1,9 @@ // This file was autogenerated by eigen_lcm // DO NOT MODIFY BY HAND! #pragma once +#include +#include +#include #include #include @@ -34,7 +37,7 @@ class SymmetricMatrix2f : public Eigen::Matrix { // Stream formatting operator friend std::ostream& operator<<(std::ostream& os, const eigen_lcm::SymmetricMatrix2f& obj) { os << "SymmetricMatrix2f("; - for (size_t i = 0; i < obj.size(); ++i) { + for (Eigen::Index i = 0; i < obj.size(); ++i) { os << obj.data()[i]; if (i + 1 != obj.size()) { os << ", "; @@ -44,6 +47,17 @@ class SymmetricMatrix2f : public Eigen::Matrix { return os; } + // The fmt library does not use operator<< implicitly, so it is given format_as instead. + // Constrained to the exact type so the pass through constructor above cannot make it viable + // for containers of this type. + template + friend std::enable_if_t::value, std::string> + format_as(const T& obj) { + std::ostringstream os; + os << obj; + return os.str(); + } + private: // Disable comma initialization magic for eigen_lcm types template diff --git a/third_party/eigen_lcm/lcmtypes/eigen_lcm_lcm/cpp/lcmtypes/eigen_lcm/SymmetricMatrix3d.hpp b/third_party/eigen_lcm/lcmtypes/eigen_lcm_lcm/cpp/lcmtypes/eigen_lcm/SymmetricMatrix3d.hpp index 3e42af77..dc89a567 100644 --- a/third_party/eigen_lcm/lcmtypes/eigen_lcm_lcm/cpp/lcmtypes/eigen_lcm/SymmetricMatrix3d.hpp +++ b/third_party/eigen_lcm/lcmtypes/eigen_lcm_lcm/cpp/lcmtypes/eigen_lcm/SymmetricMatrix3d.hpp @@ -1,6 +1,9 @@ // This file was autogenerated by eigen_lcm // DO NOT MODIFY BY HAND! #pragma once +#include +#include +#include #include #include @@ -34,7 +37,7 @@ class SymmetricMatrix3d : public Eigen::Matrix { // Stream formatting operator friend std::ostream& operator<<(std::ostream& os, const eigen_lcm::SymmetricMatrix3d& obj) { os << "SymmetricMatrix3d("; - for (size_t i = 0; i < obj.size(); ++i) { + for (Eigen::Index i = 0; i < obj.size(); ++i) { os << obj.data()[i]; if (i + 1 != obj.size()) { os << ", "; @@ -44,6 +47,17 @@ class SymmetricMatrix3d : public Eigen::Matrix { return os; } + // The fmt library does not use operator<< implicitly, so it is given format_as instead. + // Constrained to the exact type so the pass through constructor above cannot make it viable + // for containers of this type. + template + friend std::enable_if_t::value, std::string> + format_as(const T& obj) { + std::ostringstream os; + os << obj; + return os.str(); + } + private: // Disable comma initialization magic for eigen_lcm types template diff --git a/third_party/eigen_lcm/lcmtypes/eigen_lcm_lcm/cpp/lcmtypes/eigen_lcm/SymmetricMatrix3f.hpp b/third_party/eigen_lcm/lcmtypes/eigen_lcm_lcm/cpp/lcmtypes/eigen_lcm/SymmetricMatrix3f.hpp index df6b0057..d716bbe8 100644 --- a/third_party/eigen_lcm/lcmtypes/eigen_lcm_lcm/cpp/lcmtypes/eigen_lcm/SymmetricMatrix3f.hpp +++ b/third_party/eigen_lcm/lcmtypes/eigen_lcm_lcm/cpp/lcmtypes/eigen_lcm/SymmetricMatrix3f.hpp @@ -1,6 +1,9 @@ // This file was autogenerated by eigen_lcm // DO NOT MODIFY BY HAND! #pragma once +#include +#include +#include #include #include @@ -34,7 +37,7 @@ class SymmetricMatrix3f : public Eigen::Matrix { // Stream formatting operator friend std::ostream& operator<<(std::ostream& os, const eigen_lcm::SymmetricMatrix3f& obj) { os << "SymmetricMatrix3f("; - for (size_t i = 0; i < obj.size(); ++i) { + for (Eigen::Index i = 0; i < obj.size(); ++i) { os << obj.data()[i]; if (i + 1 != obj.size()) { os << ", "; @@ -44,6 +47,17 @@ class SymmetricMatrix3f : public Eigen::Matrix { return os; } + // The fmt library does not use operator<< implicitly, so it is given format_as instead. + // Constrained to the exact type so the pass through constructor above cannot make it viable + // for containers of this type. + template + friend std::enable_if_t::value, std::string> + format_as(const T& obj) { + std::ostringstream os; + os << obj; + return os.str(); + } + private: // Disable comma initialization magic for eigen_lcm types template diff --git a/third_party/eigen_lcm/lcmtypes/eigen_lcm_lcm/cpp/lcmtypes/eigen_lcm/SymmetricMatrix4d.hpp b/third_party/eigen_lcm/lcmtypes/eigen_lcm_lcm/cpp/lcmtypes/eigen_lcm/SymmetricMatrix4d.hpp index 9e085347..3a6167b6 100644 --- a/third_party/eigen_lcm/lcmtypes/eigen_lcm_lcm/cpp/lcmtypes/eigen_lcm/SymmetricMatrix4d.hpp +++ b/third_party/eigen_lcm/lcmtypes/eigen_lcm_lcm/cpp/lcmtypes/eigen_lcm/SymmetricMatrix4d.hpp @@ -1,6 +1,9 @@ // This file was autogenerated by eigen_lcm // DO NOT MODIFY BY HAND! #pragma once +#include +#include +#include #include #include @@ -34,7 +37,7 @@ class SymmetricMatrix4d : public Eigen::Matrix { // Stream formatting operator friend std::ostream& operator<<(std::ostream& os, const eigen_lcm::SymmetricMatrix4d& obj) { os << "SymmetricMatrix4d("; - for (size_t i = 0; i < obj.size(); ++i) { + for (Eigen::Index i = 0; i < obj.size(); ++i) { os << obj.data()[i]; if (i + 1 != obj.size()) { os << ", "; @@ -44,6 +47,17 @@ class SymmetricMatrix4d : public Eigen::Matrix { return os; } + // The fmt library does not use operator<< implicitly, so it is given format_as instead. + // Constrained to the exact type so the pass through constructor above cannot make it viable + // for containers of this type. + template + friend std::enable_if_t::value, std::string> + format_as(const T& obj) { + std::ostringstream os; + os << obj; + return os.str(); + } + private: // Disable comma initialization magic for eigen_lcm types template diff --git a/third_party/eigen_lcm/lcmtypes/eigen_lcm_lcm/cpp/lcmtypes/eigen_lcm/SymmetricMatrix4f.hpp b/third_party/eigen_lcm/lcmtypes/eigen_lcm_lcm/cpp/lcmtypes/eigen_lcm/SymmetricMatrix4f.hpp index 92701ece..de4b7d5d 100644 --- a/third_party/eigen_lcm/lcmtypes/eigen_lcm_lcm/cpp/lcmtypes/eigen_lcm/SymmetricMatrix4f.hpp +++ b/third_party/eigen_lcm/lcmtypes/eigen_lcm_lcm/cpp/lcmtypes/eigen_lcm/SymmetricMatrix4f.hpp @@ -1,6 +1,9 @@ // This file was autogenerated by eigen_lcm // DO NOT MODIFY BY HAND! #pragma once +#include +#include +#include #include #include @@ -34,7 +37,7 @@ class SymmetricMatrix4f : public Eigen::Matrix { // Stream formatting operator friend std::ostream& operator<<(std::ostream& os, const eigen_lcm::SymmetricMatrix4f& obj) { os << "SymmetricMatrix4f("; - for (size_t i = 0; i < obj.size(); ++i) { + for (Eigen::Index i = 0; i < obj.size(); ++i) { os << obj.data()[i]; if (i + 1 != obj.size()) { os << ", "; @@ -44,6 +47,17 @@ class SymmetricMatrix4f : public Eigen::Matrix { return os; } + // The fmt library does not use operator<< implicitly, so it is given format_as instead. + // Constrained to the exact type so the pass through constructor above cannot make it viable + // for containers of this type. + template + friend std::enable_if_t::value, std::string> + format_as(const T& obj) { + std::ostringstream os; + os << obj; + return os.str(); + } + private: // Disable comma initialization magic for eigen_lcm types template diff --git a/third_party/eigen_lcm/lcmtypes/eigen_lcm_lcm/cpp/lcmtypes/eigen_lcm/SymmetricMatrixXd.hpp b/third_party/eigen_lcm/lcmtypes/eigen_lcm_lcm/cpp/lcmtypes/eigen_lcm/SymmetricMatrixXd.hpp index decb7660..95ecdab5 100644 --- a/third_party/eigen_lcm/lcmtypes/eigen_lcm_lcm/cpp/lcmtypes/eigen_lcm/SymmetricMatrixXd.hpp +++ b/third_party/eigen_lcm/lcmtypes/eigen_lcm_lcm/cpp/lcmtypes/eigen_lcm/SymmetricMatrixXd.hpp @@ -1,6 +1,9 @@ // This file was autogenerated by eigen_lcm // DO NOT MODIFY BY HAND! #pragma once +#include +#include +#include #include #include @@ -34,7 +37,7 @@ class SymmetricMatrixXd // Stream formatting operator friend std::ostream& operator<<(std::ostream& os, const eigen_lcm::SymmetricMatrixXd& obj) { os << "SymmetricMatrixXd("; - for (size_t i = 0; i < obj.size(); ++i) { + for (Eigen::Index i = 0; i < obj.size(); ++i) { os << obj.data()[i]; if (i + 1 != obj.size()) { os << ", "; @@ -44,6 +47,17 @@ class SymmetricMatrixXd return os; } + // The fmt library does not use operator<< implicitly, so it is given format_as instead. + // Constrained to the exact type so the pass through constructor above cannot make it viable + // for containers of this type. + template + friend std::enable_if_t::value, std::string> + format_as(const T& obj) { + std::ostringstream os; + os << obj; + return os.str(); + } + private: // Disable comma initialization magic for eigen_lcm types template diff --git a/third_party/eigen_lcm/lcmtypes/eigen_lcm_lcm/cpp/lcmtypes/eigen_lcm/SymmetricMatrixXf.hpp b/third_party/eigen_lcm/lcmtypes/eigen_lcm_lcm/cpp/lcmtypes/eigen_lcm/SymmetricMatrixXf.hpp index 014a21d5..2c93c83f 100644 --- a/third_party/eigen_lcm/lcmtypes/eigen_lcm_lcm/cpp/lcmtypes/eigen_lcm/SymmetricMatrixXf.hpp +++ b/third_party/eigen_lcm/lcmtypes/eigen_lcm_lcm/cpp/lcmtypes/eigen_lcm/SymmetricMatrixXf.hpp @@ -1,6 +1,9 @@ // This file was autogenerated by eigen_lcm // DO NOT MODIFY BY HAND! #pragma once +#include +#include +#include #include #include @@ -34,7 +37,7 @@ class SymmetricMatrixXf // Stream formatting operator friend std::ostream& operator<<(std::ostream& os, const eigen_lcm::SymmetricMatrixXf& obj) { os << "SymmetricMatrixXf("; - for (size_t i = 0; i < obj.size(); ++i) { + for (Eigen::Index i = 0; i < obj.size(); ++i) { os << obj.data()[i]; if (i + 1 != obj.size()) { os << ", "; @@ -44,6 +47,17 @@ class SymmetricMatrixXf return os; } + // The fmt library does not use operator<< implicitly, so it is given format_as instead. + // Constrained to the exact type so the pass through constructor above cannot make it viable + // for containers of this type. + template + friend std::enable_if_t::value, std::string> + format_as(const T& obj) { + std::ostringstream os; + os << obj; + return os.str(); + } + private: // Disable comma initialization magic for eigen_lcm types template diff --git a/third_party/eigen_lcm/lcmtypes/eigen_lcm_lcm/cpp/lcmtypes/eigen_lcm/Vector1d.hpp b/third_party/eigen_lcm/lcmtypes/eigen_lcm_lcm/cpp/lcmtypes/eigen_lcm/Vector1d.hpp index 23ef6acd..136c742c 100644 --- a/third_party/eigen_lcm/lcmtypes/eigen_lcm_lcm/cpp/lcmtypes/eigen_lcm/Vector1d.hpp +++ b/third_party/eigen_lcm/lcmtypes/eigen_lcm_lcm/cpp/lcmtypes/eigen_lcm/Vector1d.hpp @@ -1,6 +1,9 @@ // This file was autogenerated by eigen_lcm // DO NOT MODIFY BY HAND! #pragma once +#include +#include +#include #include #include @@ -34,7 +37,7 @@ class Vector1d : public Eigen::Matrix { // Stream formatting operator friend std::ostream& operator<<(std::ostream& os, const eigen_lcm::Vector1d& obj) { os << "Vector1d("; - for (size_t i = 0; i < obj.size(); ++i) { + for (Eigen::Index i = 0; i < obj.size(); ++i) { os << obj.data()[i]; if (i + 1 != obj.size()) { os << ", "; @@ -44,6 +47,17 @@ class Vector1d : public Eigen::Matrix { return os; } + // The fmt library does not use operator<< implicitly, so it is given format_as instead. + // Constrained to the exact type so the pass through constructor above cannot make it viable + // for containers of this type. + template + friend std::enable_if_t::value, std::string> format_as( + const T& obj) { + std::ostringstream os; + os << obj; + return os.str(); + } + private: // Disable comma initialization magic for eigen_lcm types template diff --git a/third_party/eigen_lcm/lcmtypes/eigen_lcm_lcm/cpp/lcmtypes/eigen_lcm/Vector1f.hpp b/third_party/eigen_lcm/lcmtypes/eigen_lcm_lcm/cpp/lcmtypes/eigen_lcm/Vector1f.hpp index a98a6d2c..86c0aed6 100644 --- a/third_party/eigen_lcm/lcmtypes/eigen_lcm_lcm/cpp/lcmtypes/eigen_lcm/Vector1f.hpp +++ b/third_party/eigen_lcm/lcmtypes/eigen_lcm_lcm/cpp/lcmtypes/eigen_lcm/Vector1f.hpp @@ -1,6 +1,9 @@ // This file was autogenerated by eigen_lcm // DO NOT MODIFY BY HAND! #pragma once +#include +#include +#include #include #include @@ -34,7 +37,7 @@ class Vector1f : public Eigen::Matrix { // Stream formatting operator friend std::ostream& operator<<(std::ostream& os, const eigen_lcm::Vector1f& obj) { os << "Vector1f("; - for (size_t i = 0; i < obj.size(); ++i) { + for (Eigen::Index i = 0; i < obj.size(); ++i) { os << obj.data()[i]; if (i + 1 != obj.size()) { os << ", "; @@ -44,6 +47,17 @@ class Vector1f : public Eigen::Matrix { return os; } + // The fmt library does not use operator<< implicitly, so it is given format_as instead. + // Constrained to the exact type so the pass through constructor above cannot make it viable + // for containers of this type. + template + friend std::enable_if_t::value, std::string> format_as( + const T& obj) { + std::ostringstream os; + os << obj; + return os.str(); + } + private: // Disable comma initialization magic for eigen_lcm types template diff --git a/third_party/eigen_lcm/lcmtypes/eigen_lcm_lcm/cpp/lcmtypes/eigen_lcm/Vector1i.hpp b/third_party/eigen_lcm/lcmtypes/eigen_lcm_lcm/cpp/lcmtypes/eigen_lcm/Vector1i.hpp index 75d5df84..1757c620 100644 --- a/third_party/eigen_lcm/lcmtypes/eigen_lcm_lcm/cpp/lcmtypes/eigen_lcm/Vector1i.hpp +++ b/third_party/eigen_lcm/lcmtypes/eigen_lcm_lcm/cpp/lcmtypes/eigen_lcm/Vector1i.hpp @@ -1,6 +1,9 @@ // This file was autogenerated by eigen_lcm // DO NOT MODIFY BY HAND! #pragma once +#include +#include +#include #include #include @@ -34,7 +37,7 @@ class Vector1i : public Eigen::Matrix { // Stream formatting operator friend std::ostream& operator<<(std::ostream& os, const eigen_lcm::Vector1i& obj) { os << "Vector1i("; - for (size_t i = 0; i < obj.size(); ++i) { + for (Eigen::Index i = 0; i < obj.size(); ++i) { os << obj.data()[i]; if (i + 1 != obj.size()) { os << ", "; @@ -44,6 +47,17 @@ class Vector1i : public Eigen::Matrix { return os; } + // The fmt library does not use operator<< implicitly, so it is given format_as instead. + // Constrained to the exact type so the pass through constructor above cannot make it viable + // for containers of this type. + template + friend std::enable_if_t::value, std::string> format_as( + const T& obj) { + std::ostringstream os; + os << obj; + return os.str(); + } + private: // Disable comma initialization magic for eigen_lcm types template diff --git a/third_party/eigen_lcm/lcmtypes/eigen_lcm_lcm/cpp/lcmtypes/eigen_lcm/Vector2d.hpp b/third_party/eigen_lcm/lcmtypes/eigen_lcm_lcm/cpp/lcmtypes/eigen_lcm/Vector2d.hpp index 3d3a3b05..6f219c1a 100644 --- a/third_party/eigen_lcm/lcmtypes/eigen_lcm_lcm/cpp/lcmtypes/eigen_lcm/Vector2d.hpp +++ b/third_party/eigen_lcm/lcmtypes/eigen_lcm_lcm/cpp/lcmtypes/eigen_lcm/Vector2d.hpp @@ -1,6 +1,9 @@ // This file was autogenerated by eigen_lcm // DO NOT MODIFY BY HAND! #pragma once +#include +#include +#include #include #include @@ -34,7 +37,7 @@ class Vector2d : public Eigen::Matrix { // Stream formatting operator friend std::ostream& operator<<(std::ostream& os, const eigen_lcm::Vector2d& obj) { os << "Vector2d("; - for (size_t i = 0; i < obj.size(); ++i) { + for (Eigen::Index i = 0; i < obj.size(); ++i) { os << obj.data()[i]; if (i + 1 != obj.size()) { os << ", "; @@ -44,6 +47,17 @@ class Vector2d : public Eigen::Matrix { return os; } + // The fmt library does not use operator<< implicitly, so it is given format_as instead. + // Constrained to the exact type so the pass through constructor above cannot make it viable + // for containers of this type. + template + friend std::enable_if_t::value, std::string> format_as( + const T& obj) { + std::ostringstream os; + os << obj; + return os.str(); + } + private: // Disable comma initialization magic for eigen_lcm types template diff --git a/third_party/eigen_lcm/lcmtypes/eigen_lcm_lcm/cpp/lcmtypes/eigen_lcm/Vector2f.hpp b/third_party/eigen_lcm/lcmtypes/eigen_lcm_lcm/cpp/lcmtypes/eigen_lcm/Vector2f.hpp index 52e6363e..6a4915b4 100644 --- a/third_party/eigen_lcm/lcmtypes/eigen_lcm_lcm/cpp/lcmtypes/eigen_lcm/Vector2f.hpp +++ b/third_party/eigen_lcm/lcmtypes/eigen_lcm_lcm/cpp/lcmtypes/eigen_lcm/Vector2f.hpp @@ -1,6 +1,9 @@ // This file was autogenerated by eigen_lcm // DO NOT MODIFY BY HAND! #pragma once +#include +#include +#include #include #include @@ -34,7 +37,7 @@ class Vector2f : public Eigen::Matrix { // Stream formatting operator friend std::ostream& operator<<(std::ostream& os, const eigen_lcm::Vector2f& obj) { os << "Vector2f("; - for (size_t i = 0; i < obj.size(); ++i) { + for (Eigen::Index i = 0; i < obj.size(); ++i) { os << obj.data()[i]; if (i + 1 != obj.size()) { os << ", "; @@ -44,6 +47,17 @@ class Vector2f : public Eigen::Matrix { return os; } + // The fmt library does not use operator<< implicitly, so it is given format_as instead. + // Constrained to the exact type so the pass through constructor above cannot make it viable + // for containers of this type. + template + friend std::enable_if_t::value, std::string> format_as( + const T& obj) { + std::ostringstream os; + os << obj; + return os.str(); + } + private: // Disable comma initialization magic for eigen_lcm types template diff --git a/third_party/eigen_lcm/lcmtypes/eigen_lcm_lcm/cpp/lcmtypes/eigen_lcm/Vector2i.hpp b/third_party/eigen_lcm/lcmtypes/eigen_lcm_lcm/cpp/lcmtypes/eigen_lcm/Vector2i.hpp index 2f52fd52..4dac6ef5 100644 --- a/third_party/eigen_lcm/lcmtypes/eigen_lcm_lcm/cpp/lcmtypes/eigen_lcm/Vector2i.hpp +++ b/third_party/eigen_lcm/lcmtypes/eigen_lcm_lcm/cpp/lcmtypes/eigen_lcm/Vector2i.hpp @@ -1,6 +1,9 @@ // This file was autogenerated by eigen_lcm // DO NOT MODIFY BY HAND! #pragma once +#include +#include +#include #include #include @@ -34,7 +37,7 @@ class Vector2i : public Eigen::Matrix { // Stream formatting operator friend std::ostream& operator<<(std::ostream& os, const eigen_lcm::Vector2i& obj) { os << "Vector2i("; - for (size_t i = 0; i < obj.size(); ++i) { + for (Eigen::Index i = 0; i < obj.size(); ++i) { os << obj.data()[i]; if (i + 1 != obj.size()) { os << ", "; @@ -44,6 +47,17 @@ class Vector2i : public Eigen::Matrix { return os; } + // The fmt library does not use operator<< implicitly, so it is given format_as instead. + // Constrained to the exact type so the pass through constructor above cannot make it viable + // for containers of this type. + template + friend std::enable_if_t::value, std::string> format_as( + const T& obj) { + std::ostringstream os; + os << obj; + return os.str(); + } + private: // Disable comma initialization magic for eigen_lcm types template diff --git a/third_party/eigen_lcm/lcmtypes/eigen_lcm_lcm/cpp/lcmtypes/eigen_lcm/Vector3d.hpp b/third_party/eigen_lcm/lcmtypes/eigen_lcm_lcm/cpp/lcmtypes/eigen_lcm/Vector3d.hpp index cfa41394..d04c4b53 100644 --- a/third_party/eigen_lcm/lcmtypes/eigen_lcm_lcm/cpp/lcmtypes/eigen_lcm/Vector3d.hpp +++ b/third_party/eigen_lcm/lcmtypes/eigen_lcm_lcm/cpp/lcmtypes/eigen_lcm/Vector3d.hpp @@ -1,6 +1,9 @@ // This file was autogenerated by eigen_lcm // DO NOT MODIFY BY HAND! #pragma once +#include +#include +#include #include #include @@ -34,7 +37,7 @@ class Vector3d : public Eigen::Matrix { // Stream formatting operator friend std::ostream& operator<<(std::ostream& os, const eigen_lcm::Vector3d& obj) { os << "Vector3d("; - for (size_t i = 0; i < obj.size(); ++i) { + for (Eigen::Index i = 0; i < obj.size(); ++i) { os << obj.data()[i]; if (i + 1 != obj.size()) { os << ", "; @@ -44,6 +47,17 @@ class Vector3d : public Eigen::Matrix { return os; } + // The fmt library does not use operator<< implicitly, so it is given format_as instead. + // Constrained to the exact type so the pass through constructor above cannot make it viable + // for containers of this type. + template + friend std::enable_if_t::value, std::string> format_as( + const T& obj) { + std::ostringstream os; + os << obj; + return os.str(); + } + private: // Disable comma initialization magic for eigen_lcm types template diff --git a/third_party/eigen_lcm/lcmtypes/eigen_lcm_lcm/cpp/lcmtypes/eigen_lcm/Vector3f.hpp b/third_party/eigen_lcm/lcmtypes/eigen_lcm_lcm/cpp/lcmtypes/eigen_lcm/Vector3f.hpp index 9d2513ad..c2f0b6a9 100644 --- a/third_party/eigen_lcm/lcmtypes/eigen_lcm_lcm/cpp/lcmtypes/eigen_lcm/Vector3f.hpp +++ b/third_party/eigen_lcm/lcmtypes/eigen_lcm_lcm/cpp/lcmtypes/eigen_lcm/Vector3f.hpp @@ -1,6 +1,9 @@ // This file was autogenerated by eigen_lcm // DO NOT MODIFY BY HAND! #pragma once +#include +#include +#include #include #include @@ -34,7 +37,7 @@ class Vector3f : public Eigen::Matrix { // Stream formatting operator friend std::ostream& operator<<(std::ostream& os, const eigen_lcm::Vector3f& obj) { os << "Vector3f("; - for (size_t i = 0; i < obj.size(); ++i) { + for (Eigen::Index i = 0; i < obj.size(); ++i) { os << obj.data()[i]; if (i + 1 != obj.size()) { os << ", "; @@ -44,6 +47,17 @@ class Vector3f : public Eigen::Matrix { return os; } + // The fmt library does not use operator<< implicitly, so it is given format_as instead. + // Constrained to the exact type so the pass through constructor above cannot make it viable + // for containers of this type. + template + friend std::enable_if_t::value, std::string> format_as( + const T& obj) { + std::ostringstream os; + os << obj; + return os.str(); + } + private: // Disable comma initialization magic for eigen_lcm types template diff --git a/third_party/eigen_lcm/lcmtypes/eigen_lcm_lcm/cpp/lcmtypes/eigen_lcm/Vector3i.hpp b/third_party/eigen_lcm/lcmtypes/eigen_lcm_lcm/cpp/lcmtypes/eigen_lcm/Vector3i.hpp index bfb2eb09..ae24c610 100644 --- a/third_party/eigen_lcm/lcmtypes/eigen_lcm_lcm/cpp/lcmtypes/eigen_lcm/Vector3i.hpp +++ b/third_party/eigen_lcm/lcmtypes/eigen_lcm_lcm/cpp/lcmtypes/eigen_lcm/Vector3i.hpp @@ -1,6 +1,9 @@ // This file was autogenerated by eigen_lcm // DO NOT MODIFY BY HAND! #pragma once +#include +#include +#include #include #include @@ -34,7 +37,7 @@ class Vector3i : public Eigen::Matrix { // Stream formatting operator friend std::ostream& operator<<(std::ostream& os, const eigen_lcm::Vector3i& obj) { os << "Vector3i("; - for (size_t i = 0; i < obj.size(); ++i) { + for (Eigen::Index i = 0; i < obj.size(); ++i) { os << obj.data()[i]; if (i + 1 != obj.size()) { os << ", "; @@ -44,6 +47,17 @@ class Vector3i : public Eigen::Matrix { return os; } + // The fmt library does not use operator<< implicitly, so it is given format_as instead. + // Constrained to the exact type so the pass through constructor above cannot make it viable + // for containers of this type. + template + friend std::enable_if_t::value, std::string> format_as( + const T& obj) { + std::ostringstream os; + os << obj; + return os.str(); + } + private: // Disable comma initialization magic for eigen_lcm types template diff --git a/third_party/eigen_lcm/lcmtypes/eigen_lcm_lcm/cpp/lcmtypes/eigen_lcm/Vector4d.hpp b/third_party/eigen_lcm/lcmtypes/eigen_lcm_lcm/cpp/lcmtypes/eigen_lcm/Vector4d.hpp index 9b3811e6..db7de78b 100644 --- a/third_party/eigen_lcm/lcmtypes/eigen_lcm_lcm/cpp/lcmtypes/eigen_lcm/Vector4d.hpp +++ b/third_party/eigen_lcm/lcmtypes/eigen_lcm_lcm/cpp/lcmtypes/eigen_lcm/Vector4d.hpp @@ -1,6 +1,9 @@ // This file was autogenerated by eigen_lcm // DO NOT MODIFY BY HAND! #pragma once +#include +#include +#include #include #include @@ -34,7 +37,7 @@ class Vector4d : public Eigen::Matrix { // Stream formatting operator friend std::ostream& operator<<(std::ostream& os, const eigen_lcm::Vector4d& obj) { os << "Vector4d("; - for (size_t i = 0; i < obj.size(); ++i) { + for (Eigen::Index i = 0; i < obj.size(); ++i) { os << obj.data()[i]; if (i + 1 != obj.size()) { os << ", "; @@ -44,6 +47,17 @@ class Vector4d : public Eigen::Matrix { return os; } + // The fmt library does not use operator<< implicitly, so it is given format_as instead. + // Constrained to the exact type so the pass through constructor above cannot make it viable + // for containers of this type. + template + friend std::enable_if_t::value, std::string> format_as( + const T& obj) { + std::ostringstream os; + os << obj; + return os.str(); + } + private: // Disable comma initialization magic for eigen_lcm types template diff --git a/third_party/eigen_lcm/lcmtypes/eigen_lcm_lcm/cpp/lcmtypes/eigen_lcm/Vector4f.hpp b/third_party/eigen_lcm/lcmtypes/eigen_lcm_lcm/cpp/lcmtypes/eigen_lcm/Vector4f.hpp index 40b4048e..ee3599d7 100644 --- a/third_party/eigen_lcm/lcmtypes/eigen_lcm_lcm/cpp/lcmtypes/eigen_lcm/Vector4f.hpp +++ b/third_party/eigen_lcm/lcmtypes/eigen_lcm_lcm/cpp/lcmtypes/eigen_lcm/Vector4f.hpp @@ -1,6 +1,9 @@ // This file was autogenerated by eigen_lcm // DO NOT MODIFY BY HAND! #pragma once +#include +#include +#include #include #include @@ -34,7 +37,7 @@ class Vector4f : public Eigen::Matrix { // Stream formatting operator friend std::ostream& operator<<(std::ostream& os, const eigen_lcm::Vector4f& obj) { os << "Vector4f("; - for (size_t i = 0; i < obj.size(); ++i) { + for (Eigen::Index i = 0; i < obj.size(); ++i) { os << obj.data()[i]; if (i + 1 != obj.size()) { os << ", "; @@ -44,6 +47,17 @@ class Vector4f : public Eigen::Matrix { return os; } + // The fmt library does not use operator<< implicitly, so it is given format_as instead. + // Constrained to the exact type so the pass through constructor above cannot make it viable + // for containers of this type. + template + friend std::enable_if_t::value, std::string> format_as( + const T& obj) { + std::ostringstream os; + os << obj; + return os.str(); + } + private: // Disable comma initialization magic for eigen_lcm types template diff --git a/third_party/eigen_lcm/lcmtypes/eigen_lcm_lcm/cpp/lcmtypes/eigen_lcm/Vector4i.hpp b/third_party/eigen_lcm/lcmtypes/eigen_lcm_lcm/cpp/lcmtypes/eigen_lcm/Vector4i.hpp index 97da0bee..29f442d5 100644 --- a/third_party/eigen_lcm/lcmtypes/eigen_lcm_lcm/cpp/lcmtypes/eigen_lcm/Vector4i.hpp +++ b/third_party/eigen_lcm/lcmtypes/eigen_lcm_lcm/cpp/lcmtypes/eigen_lcm/Vector4i.hpp @@ -1,6 +1,9 @@ // This file was autogenerated by eigen_lcm // DO NOT MODIFY BY HAND! #pragma once +#include +#include +#include #include #include @@ -34,7 +37,7 @@ class Vector4i : public Eigen::Matrix { // Stream formatting operator friend std::ostream& operator<<(std::ostream& os, const eigen_lcm::Vector4i& obj) { os << "Vector4i("; - for (size_t i = 0; i < obj.size(); ++i) { + for (Eigen::Index i = 0; i < obj.size(); ++i) { os << obj.data()[i]; if (i + 1 != obj.size()) { os << ", "; @@ -44,6 +47,17 @@ class Vector4i : public Eigen::Matrix { return os; } + // The fmt library does not use operator<< implicitly, so it is given format_as instead. + // Constrained to the exact type so the pass through constructor above cannot make it viable + // for containers of this type. + template + friend std::enable_if_t::value, std::string> format_as( + const T& obj) { + std::ostringstream os; + os << obj; + return os.str(); + } + private: // Disable comma initialization magic for eigen_lcm types template diff --git a/third_party/eigen_lcm/lcmtypes/eigen_lcm_lcm/cpp/lcmtypes/eigen_lcm/Vector5d.hpp b/third_party/eigen_lcm/lcmtypes/eigen_lcm_lcm/cpp/lcmtypes/eigen_lcm/Vector5d.hpp index 63591bc1..f4579aae 100644 --- a/third_party/eigen_lcm/lcmtypes/eigen_lcm_lcm/cpp/lcmtypes/eigen_lcm/Vector5d.hpp +++ b/third_party/eigen_lcm/lcmtypes/eigen_lcm_lcm/cpp/lcmtypes/eigen_lcm/Vector5d.hpp @@ -1,6 +1,9 @@ // This file was autogenerated by eigen_lcm // DO NOT MODIFY BY HAND! #pragma once +#include +#include +#include #include #include @@ -34,7 +37,7 @@ class Vector5d : public Eigen::Matrix { // Stream formatting operator friend std::ostream& operator<<(std::ostream& os, const eigen_lcm::Vector5d& obj) { os << "Vector5d("; - for (size_t i = 0; i < obj.size(); ++i) { + for (Eigen::Index i = 0; i < obj.size(); ++i) { os << obj.data()[i]; if (i + 1 != obj.size()) { os << ", "; @@ -44,6 +47,17 @@ class Vector5d : public Eigen::Matrix { return os; } + // The fmt library does not use operator<< implicitly, so it is given format_as instead. + // Constrained to the exact type so the pass through constructor above cannot make it viable + // for containers of this type. + template + friend std::enable_if_t::value, std::string> format_as( + const T& obj) { + std::ostringstream os; + os << obj; + return os.str(); + } + private: // Disable comma initialization magic for eigen_lcm types template diff --git a/third_party/eigen_lcm/lcmtypes/eigen_lcm_lcm/cpp/lcmtypes/eigen_lcm/Vector5f.hpp b/third_party/eigen_lcm/lcmtypes/eigen_lcm_lcm/cpp/lcmtypes/eigen_lcm/Vector5f.hpp index 875e345c..3c3bf19f 100644 --- a/third_party/eigen_lcm/lcmtypes/eigen_lcm_lcm/cpp/lcmtypes/eigen_lcm/Vector5f.hpp +++ b/third_party/eigen_lcm/lcmtypes/eigen_lcm_lcm/cpp/lcmtypes/eigen_lcm/Vector5f.hpp @@ -1,6 +1,9 @@ // This file was autogenerated by eigen_lcm // DO NOT MODIFY BY HAND! #pragma once +#include +#include +#include #include #include @@ -34,7 +37,7 @@ class Vector5f : public Eigen::Matrix { // Stream formatting operator friend std::ostream& operator<<(std::ostream& os, const eigen_lcm::Vector5f& obj) { os << "Vector5f("; - for (size_t i = 0; i < obj.size(); ++i) { + for (Eigen::Index i = 0; i < obj.size(); ++i) { os << obj.data()[i]; if (i + 1 != obj.size()) { os << ", "; @@ -44,6 +47,17 @@ class Vector5f : public Eigen::Matrix { return os; } + // The fmt library does not use operator<< implicitly, so it is given format_as instead. + // Constrained to the exact type so the pass through constructor above cannot make it viable + // for containers of this type. + template + friend std::enable_if_t::value, std::string> format_as( + const T& obj) { + std::ostringstream os; + os << obj; + return os.str(); + } + private: // Disable comma initialization magic for eigen_lcm types template diff --git a/third_party/eigen_lcm/lcmtypes/eigen_lcm_lcm/cpp/lcmtypes/eigen_lcm/Vector5i.hpp b/third_party/eigen_lcm/lcmtypes/eigen_lcm_lcm/cpp/lcmtypes/eigen_lcm/Vector5i.hpp index 9fd900a4..4fec2eb9 100644 --- a/third_party/eigen_lcm/lcmtypes/eigen_lcm_lcm/cpp/lcmtypes/eigen_lcm/Vector5i.hpp +++ b/third_party/eigen_lcm/lcmtypes/eigen_lcm_lcm/cpp/lcmtypes/eigen_lcm/Vector5i.hpp @@ -1,6 +1,9 @@ // This file was autogenerated by eigen_lcm // DO NOT MODIFY BY HAND! #pragma once +#include +#include +#include #include #include @@ -34,7 +37,7 @@ class Vector5i : public Eigen::Matrix { // Stream formatting operator friend std::ostream& operator<<(std::ostream& os, const eigen_lcm::Vector5i& obj) { os << "Vector5i("; - for (size_t i = 0; i < obj.size(); ++i) { + for (Eigen::Index i = 0; i < obj.size(); ++i) { os << obj.data()[i]; if (i + 1 != obj.size()) { os << ", "; @@ -44,6 +47,17 @@ class Vector5i : public Eigen::Matrix { return os; } + // The fmt library does not use operator<< implicitly, so it is given format_as instead. + // Constrained to the exact type so the pass through constructor above cannot make it viable + // for containers of this type. + template + friend std::enable_if_t::value, std::string> format_as( + const T& obj) { + std::ostringstream os; + os << obj; + return os.str(); + } + private: // Disable comma initialization magic for eigen_lcm types template diff --git a/third_party/eigen_lcm/lcmtypes/eigen_lcm_lcm/cpp/lcmtypes/eigen_lcm/Vector6d.hpp b/third_party/eigen_lcm/lcmtypes/eigen_lcm_lcm/cpp/lcmtypes/eigen_lcm/Vector6d.hpp index c09af7ae..433fdd6f 100644 --- a/third_party/eigen_lcm/lcmtypes/eigen_lcm_lcm/cpp/lcmtypes/eigen_lcm/Vector6d.hpp +++ b/third_party/eigen_lcm/lcmtypes/eigen_lcm_lcm/cpp/lcmtypes/eigen_lcm/Vector6d.hpp @@ -1,6 +1,9 @@ // This file was autogenerated by eigen_lcm // DO NOT MODIFY BY HAND! #pragma once +#include +#include +#include #include #include @@ -34,7 +37,7 @@ class Vector6d : public Eigen::Matrix { // Stream formatting operator friend std::ostream& operator<<(std::ostream& os, const eigen_lcm::Vector6d& obj) { os << "Vector6d("; - for (size_t i = 0; i < obj.size(); ++i) { + for (Eigen::Index i = 0; i < obj.size(); ++i) { os << obj.data()[i]; if (i + 1 != obj.size()) { os << ", "; @@ -44,6 +47,17 @@ class Vector6d : public Eigen::Matrix { return os; } + // The fmt library does not use operator<< implicitly, so it is given format_as instead. + // Constrained to the exact type so the pass through constructor above cannot make it viable + // for containers of this type. + template + friend std::enable_if_t::value, std::string> format_as( + const T& obj) { + std::ostringstream os; + os << obj; + return os.str(); + } + private: // Disable comma initialization magic for eigen_lcm types template diff --git a/third_party/eigen_lcm/lcmtypes/eigen_lcm_lcm/cpp/lcmtypes/eigen_lcm/Vector6f.hpp b/third_party/eigen_lcm/lcmtypes/eigen_lcm_lcm/cpp/lcmtypes/eigen_lcm/Vector6f.hpp index 328ef215..d9d7dd6f 100644 --- a/third_party/eigen_lcm/lcmtypes/eigen_lcm_lcm/cpp/lcmtypes/eigen_lcm/Vector6f.hpp +++ b/third_party/eigen_lcm/lcmtypes/eigen_lcm_lcm/cpp/lcmtypes/eigen_lcm/Vector6f.hpp @@ -1,6 +1,9 @@ // This file was autogenerated by eigen_lcm // DO NOT MODIFY BY HAND! #pragma once +#include +#include +#include #include #include @@ -34,7 +37,7 @@ class Vector6f : public Eigen::Matrix { // Stream formatting operator friend std::ostream& operator<<(std::ostream& os, const eigen_lcm::Vector6f& obj) { os << "Vector6f("; - for (size_t i = 0; i < obj.size(); ++i) { + for (Eigen::Index i = 0; i < obj.size(); ++i) { os << obj.data()[i]; if (i + 1 != obj.size()) { os << ", "; @@ -44,6 +47,17 @@ class Vector6f : public Eigen::Matrix { return os; } + // The fmt library does not use operator<< implicitly, so it is given format_as instead. + // Constrained to the exact type so the pass through constructor above cannot make it viable + // for containers of this type. + template + friend std::enable_if_t::value, std::string> format_as( + const T& obj) { + std::ostringstream os; + os << obj; + return os.str(); + } + private: // Disable comma initialization magic for eigen_lcm types template diff --git a/third_party/eigen_lcm/lcmtypes/eigen_lcm_lcm/cpp/lcmtypes/eigen_lcm/Vector6i.hpp b/third_party/eigen_lcm/lcmtypes/eigen_lcm_lcm/cpp/lcmtypes/eigen_lcm/Vector6i.hpp index dbc67a89..7793cf70 100644 --- a/third_party/eigen_lcm/lcmtypes/eigen_lcm_lcm/cpp/lcmtypes/eigen_lcm/Vector6i.hpp +++ b/third_party/eigen_lcm/lcmtypes/eigen_lcm_lcm/cpp/lcmtypes/eigen_lcm/Vector6i.hpp @@ -1,6 +1,9 @@ // This file was autogenerated by eigen_lcm // DO NOT MODIFY BY HAND! #pragma once +#include +#include +#include #include #include @@ -34,7 +37,7 @@ class Vector6i : public Eigen::Matrix { // Stream formatting operator friend std::ostream& operator<<(std::ostream& os, const eigen_lcm::Vector6i& obj) { os << "Vector6i("; - for (size_t i = 0; i < obj.size(); ++i) { + for (Eigen::Index i = 0; i < obj.size(); ++i) { os << obj.data()[i]; if (i + 1 != obj.size()) { os << ", "; @@ -44,6 +47,17 @@ class Vector6i : public Eigen::Matrix { return os; } + // The fmt library does not use operator<< implicitly, so it is given format_as instead. + // Constrained to the exact type so the pass through constructor above cannot make it viable + // for containers of this type. + template + friend std::enable_if_t::value, std::string> format_as( + const T& obj) { + std::ostringstream os; + os << obj; + return os.str(); + } + private: // Disable comma initialization magic for eigen_lcm types template diff --git a/third_party/eigen_lcm/lcmtypes/eigen_lcm_lcm/cpp/lcmtypes/eigen_lcm/Vector7d.hpp b/third_party/eigen_lcm/lcmtypes/eigen_lcm_lcm/cpp/lcmtypes/eigen_lcm/Vector7d.hpp index fc747dc9..4b20289f 100644 --- a/third_party/eigen_lcm/lcmtypes/eigen_lcm_lcm/cpp/lcmtypes/eigen_lcm/Vector7d.hpp +++ b/third_party/eigen_lcm/lcmtypes/eigen_lcm_lcm/cpp/lcmtypes/eigen_lcm/Vector7d.hpp @@ -1,6 +1,9 @@ // This file was autogenerated by eigen_lcm // DO NOT MODIFY BY HAND! #pragma once +#include +#include +#include #include #include @@ -34,7 +37,7 @@ class Vector7d : public Eigen::Matrix { // Stream formatting operator friend std::ostream& operator<<(std::ostream& os, const eigen_lcm::Vector7d& obj) { os << "Vector7d("; - for (size_t i = 0; i < obj.size(); ++i) { + for (Eigen::Index i = 0; i < obj.size(); ++i) { os << obj.data()[i]; if (i + 1 != obj.size()) { os << ", "; @@ -44,6 +47,17 @@ class Vector7d : public Eigen::Matrix { return os; } + // The fmt library does not use operator<< implicitly, so it is given format_as instead. + // Constrained to the exact type so the pass through constructor above cannot make it viable + // for containers of this type. + template + friend std::enable_if_t::value, std::string> format_as( + const T& obj) { + std::ostringstream os; + os << obj; + return os.str(); + } + private: // Disable comma initialization magic for eigen_lcm types template diff --git a/third_party/eigen_lcm/lcmtypes/eigen_lcm_lcm/cpp/lcmtypes/eigen_lcm/Vector7f.hpp b/third_party/eigen_lcm/lcmtypes/eigen_lcm_lcm/cpp/lcmtypes/eigen_lcm/Vector7f.hpp index 11933a2a..8525e341 100644 --- a/third_party/eigen_lcm/lcmtypes/eigen_lcm_lcm/cpp/lcmtypes/eigen_lcm/Vector7f.hpp +++ b/third_party/eigen_lcm/lcmtypes/eigen_lcm_lcm/cpp/lcmtypes/eigen_lcm/Vector7f.hpp @@ -1,6 +1,9 @@ // This file was autogenerated by eigen_lcm // DO NOT MODIFY BY HAND! #pragma once +#include +#include +#include #include #include @@ -34,7 +37,7 @@ class Vector7f : public Eigen::Matrix { // Stream formatting operator friend std::ostream& operator<<(std::ostream& os, const eigen_lcm::Vector7f& obj) { os << "Vector7f("; - for (size_t i = 0; i < obj.size(); ++i) { + for (Eigen::Index i = 0; i < obj.size(); ++i) { os << obj.data()[i]; if (i + 1 != obj.size()) { os << ", "; @@ -44,6 +47,17 @@ class Vector7f : public Eigen::Matrix { return os; } + // The fmt library does not use operator<< implicitly, so it is given format_as instead. + // Constrained to the exact type so the pass through constructor above cannot make it viable + // for containers of this type. + template + friend std::enable_if_t::value, std::string> format_as( + const T& obj) { + std::ostringstream os; + os << obj; + return os.str(); + } + private: // Disable comma initialization magic for eigen_lcm types template diff --git a/third_party/eigen_lcm/lcmtypes/eigen_lcm_lcm/cpp/lcmtypes/eigen_lcm/Vector7i.hpp b/third_party/eigen_lcm/lcmtypes/eigen_lcm_lcm/cpp/lcmtypes/eigen_lcm/Vector7i.hpp index f85e97db..3b600a46 100644 --- a/third_party/eigen_lcm/lcmtypes/eigen_lcm_lcm/cpp/lcmtypes/eigen_lcm/Vector7i.hpp +++ b/third_party/eigen_lcm/lcmtypes/eigen_lcm_lcm/cpp/lcmtypes/eigen_lcm/Vector7i.hpp @@ -1,6 +1,9 @@ // This file was autogenerated by eigen_lcm // DO NOT MODIFY BY HAND! #pragma once +#include +#include +#include #include #include @@ -34,7 +37,7 @@ class Vector7i : public Eigen::Matrix { // Stream formatting operator friend std::ostream& operator<<(std::ostream& os, const eigen_lcm::Vector7i& obj) { os << "Vector7i("; - for (size_t i = 0; i < obj.size(); ++i) { + for (Eigen::Index i = 0; i < obj.size(); ++i) { os << obj.data()[i]; if (i + 1 != obj.size()) { os << ", "; @@ -44,6 +47,17 @@ class Vector7i : public Eigen::Matrix { return os; } + // The fmt library does not use operator<< implicitly, so it is given format_as instead. + // Constrained to the exact type so the pass through constructor above cannot make it viable + // for containers of this type. + template + friend std::enable_if_t::value, std::string> format_as( + const T& obj) { + std::ostringstream os; + os << obj; + return os.str(); + } + private: // Disable comma initialization magic for eigen_lcm types template diff --git a/third_party/eigen_lcm/lcmtypes/eigen_lcm_lcm/cpp/lcmtypes/eigen_lcm/Vector8d.hpp b/third_party/eigen_lcm/lcmtypes/eigen_lcm_lcm/cpp/lcmtypes/eigen_lcm/Vector8d.hpp index 79c39815..2b975cdb 100644 --- a/third_party/eigen_lcm/lcmtypes/eigen_lcm_lcm/cpp/lcmtypes/eigen_lcm/Vector8d.hpp +++ b/third_party/eigen_lcm/lcmtypes/eigen_lcm_lcm/cpp/lcmtypes/eigen_lcm/Vector8d.hpp @@ -1,6 +1,9 @@ // This file was autogenerated by eigen_lcm // DO NOT MODIFY BY HAND! #pragma once +#include +#include +#include #include #include @@ -34,7 +37,7 @@ class Vector8d : public Eigen::Matrix { // Stream formatting operator friend std::ostream& operator<<(std::ostream& os, const eigen_lcm::Vector8d& obj) { os << "Vector8d("; - for (size_t i = 0; i < obj.size(); ++i) { + for (Eigen::Index i = 0; i < obj.size(); ++i) { os << obj.data()[i]; if (i + 1 != obj.size()) { os << ", "; @@ -44,6 +47,17 @@ class Vector8d : public Eigen::Matrix { return os; } + // The fmt library does not use operator<< implicitly, so it is given format_as instead. + // Constrained to the exact type so the pass through constructor above cannot make it viable + // for containers of this type. + template + friend std::enable_if_t::value, std::string> format_as( + const T& obj) { + std::ostringstream os; + os << obj; + return os.str(); + } + private: // Disable comma initialization magic for eigen_lcm types template diff --git a/third_party/eigen_lcm/lcmtypes/eigen_lcm_lcm/cpp/lcmtypes/eigen_lcm/Vector8f.hpp b/third_party/eigen_lcm/lcmtypes/eigen_lcm_lcm/cpp/lcmtypes/eigen_lcm/Vector8f.hpp index c9806619..22f46953 100644 --- a/third_party/eigen_lcm/lcmtypes/eigen_lcm_lcm/cpp/lcmtypes/eigen_lcm/Vector8f.hpp +++ b/third_party/eigen_lcm/lcmtypes/eigen_lcm_lcm/cpp/lcmtypes/eigen_lcm/Vector8f.hpp @@ -1,6 +1,9 @@ // This file was autogenerated by eigen_lcm // DO NOT MODIFY BY HAND! #pragma once +#include +#include +#include #include #include @@ -34,7 +37,7 @@ class Vector8f : public Eigen::Matrix { // Stream formatting operator friend std::ostream& operator<<(std::ostream& os, const eigen_lcm::Vector8f& obj) { os << "Vector8f("; - for (size_t i = 0; i < obj.size(); ++i) { + for (Eigen::Index i = 0; i < obj.size(); ++i) { os << obj.data()[i]; if (i + 1 != obj.size()) { os << ", "; @@ -44,6 +47,17 @@ class Vector8f : public Eigen::Matrix { return os; } + // The fmt library does not use operator<< implicitly, so it is given format_as instead. + // Constrained to the exact type so the pass through constructor above cannot make it viable + // for containers of this type. + template + friend std::enable_if_t::value, std::string> format_as( + const T& obj) { + std::ostringstream os; + os << obj; + return os.str(); + } + private: // Disable comma initialization magic for eigen_lcm types template diff --git a/third_party/eigen_lcm/lcmtypes/eigen_lcm_lcm/cpp/lcmtypes/eigen_lcm/Vector8i.hpp b/third_party/eigen_lcm/lcmtypes/eigen_lcm_lcm/cpp/lcmtypes/eigen_lcm/Vector8i.hpp index 14e87d3d..532eef8d 100644 --- a/third_party/eigen_lcm/lcmtypes/eigen_lcm_lcm/cpp/lcmtypes/eigen_lcm/Vector8i.hpp +++ b/third_party/eigen_lcm/lcmtypes/eigen_lcm_lcm/cpp/lcmtypes/eigen_lcm/Vector8i.hpp @@ -1,6 +1,9 @@ // This file was autogenerated by eigen_lcm // DO NOT MODIFY BY HAND! #pragma once +#include +#include +#include #include #include @@ -34,7 +37,7 @@ class Vector8i : public Eigen::Matrix { // Stream formatting operator friend std::ostream& operator<<(std::ostream& os, const eigen_lcm::Vector8i& obj) { os << "Vector8i("; - for (size_t i = 0; i < obj.size(); ++i) { + for (Eigen::Index i = 0; i < obj.size(); ++i) { os << obj.data()[i]; if (i + 1 != obj.size()) { os << ", "; @@ -44,6 +47,17 @@ class Vector8i : public Eigen::Matrix { return os; } + // The fmt library does not use operator<< implicitly, so it is given format_as instead. + // Constrained to the exact type so the pass through constructor above cannot make it viable + // for containers of this type. + template + friend std::enable_if_t::value, std::string> format_as( + const T& obj) { + std::ostringstream os; + os << obj; + return os.str(); + } + private: // Disable comma initialization magic for eigen_lcm types template diff --git a/third_party/eigen_lcm/lcmtypes/eigen_lcm_lcm/cpp/lcmtypes/eigen_lcm/VectorXd.hpp b/third_party/eigen_lcm/lcmtypes/eigen_lcm_lcm/cpp/lcmtypes/eigen_lcm/VectorXd.hpp index b51e1ca4..7e6b8d01 100644 --- a/third_party/eigen_lcm/lcmtypes/eigen_lcm_lcm/cpp/lcmtypes/eigen_lcm/VectorXd.hpp +++ b/third_party/eigen_lcm/lcmtypes/eigen_lcm_lcm/cpp/lcmtypes/eigen_lcm/VectorXd.hpp @@ -1,6 +1,9 @@ // This file was autogenerated by eigen_lcm // DO NOT MODIFY BY HAND! #pragma once +#include +#include +#include #include #include @@ -32,7 +35,7 @@ class VectorXd : public Eigen::Matrix + friend std::enable_if_t::value, std::string> format_as( + const T& obj) { + std::ostringstream os; + os << obj; + return os.str(); + } + private: // Disable comma initialization magic for eigen_lcm types template diff --git a/third_party/eigen_lcm/lcmtypes/eigen_lcm_lcm/cpp/lcmtypes/eigen_lcm/VectorXf.hpp b/third_party/eigen_lcm/lcmtypes/eigen_lcm_lcm/cpp/lcmtypes/eigen_lcm/VectorXf.hpp index 22f5d433..d691cc0b 100644 --- a/third_party/eigen_lcm/lcmtypes/eigen_lcm_lcm/cpp/lcmtypes/eigen_lcm/VectorXf.hpp +++ b/third_party/eigen_lcm/lcmtypes/eigen_lcm_lcm/cpp/lcmtypes/eigen_lcm/VectorXf.hpp @@ -1,6 +1,9 @@ // This file was autogenerated by eigen_lcm // DO NOT MODIFY BY HAND! #pragma once +#include +#include +#include #include #include @@ -32,7 +35,7 @@ class VectorXf : public Eigen::Matrix + friend std::enable_if_t::value, std::string> format_as( + const T& obj) { + std::ostringstream os; + os << obj; + return os.str(); + } + private: // Disable comma initialization magic for eigen_lcm types template diff --git a/third_party/eigen_lcm/lcmtypes/eigen_lcm_lcm/cpp/lcmtypes/eigen_lcm/VectorXi.hpp b/third_party/eigen_lcm/lcmtypes/eigen_lcm_lcm/cpp/lcmtypes/eigen_lcm/VectorXi.hpp index 54ac8a23..1f97e519 100644 --- a/third_party/eigen_lcm/lcmtypes/eigen_lcm_lcm/cpp/lcmtypes/eigen_lcm/VectorXi.hpp +++ b/third_party/eigen_lcm/lcmtypes/eigen_lcm_lcm/cpp/lcmtypes/eigen_lcm/VectorXi.hpp @@ -1,6 +1,9 @@ // This file was autogenerated by eigen_lcm // DO NOT MODIFY BY HAND! #pragma once +#include +#include +#include #include #include @@ -32,7 +35,7 @@ class VectorXi : public Eigen::Matrix + friend std::enable_if_t::value, std::string> format_as( + const T& obj) { + std::ostringstream os; + os << obj; + return os.str(); + } + private: // Disable comma initialization magic for eigen_lcm types template diff --git a/third_party/skymarshal/skymarshal/templates/djinni_converter.h.template b/third_party/skymarshal/skymarshal/templates/djinni_converter.h.template index 5ca9da1e..c7940c31 100644 --- a/third_party/skymarshal/skymarshal/templates/djinni_converter.h.template +++ b/third_party/skymarshal/skymarshal/templates/djinni_converter.h.template @@ -5,7 +5,15 @@ {% endif %} #pragma once +// The payload of this header for a formatting caller is the `format_as` overload below, reached by +// ADL from an expression that names only the enum, which is declared by the djinni header instead. +// include-cleaner therefore sees no use of this header in such a file, and asks for the include to +// be removed. +// IWYU pragma: always_keep + #include +#include +#include #include <{{enum_type.djinni_header}}> #include <{{enum_type.lcm_header}}> @@ -32,4 +40,11 @@ namespace {{enum_type.djinni_namespace}} { // Support stringification of {{enum_type.djinni_name}} std::ostream& operator <<(std::ostream& s, {{enum_type.djinni_name}} djinni_enum); +// The fmt library does not use operator<< implicitly, so it is given format_as instead. +inline std::string format_as({{enum_type.djinni_name}} djinni_enum) { + std::ostringstream stream; + stream << djinni_enum; + return stream.str(); +} + } // namespace {{enum_type.djinni_namespace}} diff --git a/third_party/skymarshal/skymarshal/templates/enumtype.hpp.template b/third_party/skymarshal/skymarshal/templates/enumtype.hpp.template index caa88657..3c6e782e 100644 --- a/third_party/skymarshal/skymarshal/templates/enumtype.hpp.template +++ b/third_party/skymarshal/skymarshal/templates/enumtype.hpp.template @@ -15,6 +15,7 @@ #include #include +#include namespace {{enumtype.namespace}} { @@ -270,6 +271,23 @@ inline std::ostream& operator <<(std::ostream& s, const {{enumtype.name}}& objec return s << object.value; } +// The fmt library does not use operator<< implicitly, so it is given format_as instead. +inline std::string format_as(const {{enumtype.name}}::option_t& option) +{ + switch (option) { +{% for case in enumtype.cases %} + case {{enumtype.name}}::{{case.name}}: + return "{{case.name}}"; +{% endfor %} + } + return "{{enumtype.name}}::" + std::to_string(static_cast<{{enumtype.string_cast_type}}>(option)); +} + +inline std::string format_as(const {{enumtype.name}}& object) +{ + return format_as(object.value); +} + } // namespace {{enumtype.namespace}} // Allow enum as an unordered_map key diff --git a/third_party/skymarshal/skymarshal/templates/lcmtype.hpp.template b/third_party/skymarshal/skymarshal/templates/lcmtype.hpp.template index 88bd0994..e182dff8 100644 --- a/third_party/skymarshal/skymarshal/templates/lcmtype.hpp.template +++ b/third_party/skymarshal/skymarshal/templates/lcmtype.hpp.template @@ -25,6 +25,9 @@ {% endif %} #include {% endif %} +{% if not lcmtype.cpp_no_display %} +#include +{% endif %} {{lcmtype.includes()}} namespace {{lcmtype.namespace}} @@ -222,6 +225,15 @@ class {{lcmtype.name}} #endif {% endif %} +{% if not lcmtype.cpp_no_display %} + // The fmt library does not use operator<< implicitly, so it is given format_as instead. + friend std::string format_as(const {{lcmtype.name}}& obj) { + std::ostringstream _stream; + _stream << obj; + return _stream.str(); + } + +{% endif %} #if defined(SKYMARSHAL_STORING_ENABLED) // Return value is 0 if the operation succeeded. // If the operation failed, return value is equal to 1 + the index of the first invalid field, From 074af9852914e282f45b18230d639c13abeb0f2a Mon Sep 17 00:00:00 2001 From: Brian Kubisiak Date: Sat, 19 Sep 2026 00:49:06 +0000 Subject: [PATCH 25/68] [SymForce] Update spdlog to 1.17.0 The CMake build still needs the fstring fix because its include directories are not SYSTEM. Take it from upstream 1685e694 and d5af52d9, which landed after the 1.17.0 tag and are in no release. patch_spdlog.sh stamps a hash of the whole series instead of reverse-dry-running each patch, since 0002 rewrites lines 0001 adds and the per-patch check would read an already-patched tree as unpatched. Co-Authored-By: Claude Opus 5 Signed-off-by: Brian Kubisiak GitOrigin-RevId: 86edce82319bd11f39f2af26856568862aaf97b8 --- cmake/patch_spdlog.sh | 19 +- ...opy-constructor-usage-of-fmt-format_.patch | 410 ++++++++++++++++++ ...2-Fix-format_string-propagation-3543.patch | 326 ++++++++++++++ cmake/spdlog-fmt-fstring-get.patch | 36 -- cmake/spdlog-fmt-runtime.patch | 40 -- symforce/opt/CMakeLists.txt | 15 +- 6 files changed, 757 insertions(+), 89 deletions(-) create mode 100644 cmake/spdlog-0001-Fix-deprecated-copy-constructor-usage-of-fmt-format_.patch create mode 100644 cmake/spdlog-0002-Fix-format_string-propagation-3543.patch delete mode 100644 cmake/spdlog-fmt-fstring-get.patch delete mode 100644 cmake/spdlog-fmt-runtime.patch diff --git a/cmake/patch_spdlog.sh b/cmake/patch_spdlog.sh index 16b38d11..474d7557 100755 --- a/cmake/patch_spdlog.sh +++ b/cmake/patch_spdlog.sh @@ -10,13 +10,18 @@ set -eu spdlog_src="$1" shift -# Apply the patches that make spdlog 1.9.2 compile against fmt 12. FetchContent re-runs the patch -# step on trees that may already be patched, so skip any patch whose changes are already present -- a -# successful reverse dry-run means the tree contains that patch. -for patch_file in "$@"; do - if patch -p1 -R -s --dry-run -d "${spdlog_src}" -i "${patch_file}" >/dev/null 2>&1; then - continue - fi +# FetchContent re-runs the patch step on trees that may already be patched. The series overlaps +# itself, so a per-patch check can't tell "already applied" from "does not apply"; stamp the whole +# series instead. +stamp="${spdlog_src}/.symforce_patches_applied" +series="$(cat "$@" | sha256sum | cut -d' ' -f1)" + +if [ -f "${stamp}" ] && [ "$(cat "${stamp}")" = "${series}" ]; then + exit 0 +fi +for patch_file in "$@"; do patch -p1 -d "${spdlog_src}" -i "${patch_file}" done + +echo "${series}" > "${stamp}" diff --git a/cmake/spdlog-0001-Fix-deprecated-copy-constructor-usage-of-fmt-format_.patch b/cmake/spdlog-0001-Fix-deprecated-copy-constructor-usage-of-fmt-format_.patch new file mode 100644 index 00000000..cc8b4bec --- /dev/null +++ b/cmake/spdlog-0001-Fix-deprecated-copy-constructor-usage-of-fmt-format_.patch @@ -0,0 +1,410 @@ +From c8b5a153d93645a2d2dcc3894cb9544a5c387aba Mon Sep 17 00:00:00 2001 +From: Yancey <135342560+Yancey2023@users.noreply.github.com> +Date: Mon, 23 Feb 2026 08:10:25 +0800 +Subject: [PATCH 1/2] Fix deprecated copy constructor usage of + fmt::format_string (#3541) + +* Fix deprecated copy constructor usage of fmt::format_string + +* Fix copy constructor usage of fmt::wformat_string_t + +* Fix usage of std::basic_format_string + +* remove spdlog::to_string_view() + +(cherry picked from commit 1685e694c5cd8328280c48f8b94b1281c17c6fee) +--- + include/spdlog/common.h | 32 ---------------- + include/spdlog/logger.h | 64 +++++++++++++++++++++++++++++++- + include/spdlog/spdlog.h | 64 ++++++++++++++++++++++++++++++++ + tests/test_fmt_helper.cpp | 6 ++- + tests/test_pattern_formatter.cpp | 6 ++- + 5 files changed, 136 insertions(+), 36 deletions(-) + +diff --git a/include/spdlog/common.h b/include/spdlog/common.h +index 20dbca45..8ff31663 100644 +--- a/include/spdlog/common.h ++++ b/include/spdlog/common.h +@@ -340,38 +340,6 @@ struct file_event_handlers { + + namespace details { + +-// to_string_view +- +-SPDLOG_CONSTEXPR_FUNC spdlog::string_view_t to_string_view(const memory_buf_t &buf) +- SPDLOG_NOEXCEPT { +- return spdlog::string_view_t{buf.data(), buf.size()}; +-} +- +-SPDLOG_CONSTEXPR_FUNC spdlog::string_view_t to_string_view(spdlog::string_view_t str) +- SPDLOG_NOEXCEPT { +- return str; +-} +- +-#if defined(SPDLOG_WCHAR_FILENAMES) || defined(SPDLOG_WCHAR_TO_UTF8_SUPPORT) +-SPDLOG_CONSTEXPR_FUNC spdlog::wstring_view_t to_string_view(const wmemory_buf_t &buf) +- SPDLOG_NOEXCEPT { +- return spdlog::wstring_view_t{buf.data(), buf.size()}; +-} +- +-SPDLOG_CONSTEXPR_FUNC spdlog::wstring_view_t to_string_view(spdlog::wstring_view_t str) +- SPDLOG_NOEXCEPT { +- return str; +-} +-#endif +- +-#if defined(SPDLOG_USE_STD_FORMAT) && __cpp_lib_format >= 202207L +-template +-SPDLOG_CONSTEXPR_FUNC std::basic_string_view to_string_view( +- std::basic_format_string fmt) SPDLOG_NOEXCEPT { +- return fmt.get(); +-} +-#endif +- + // make_unique support for pre c++14 + #if __cplusplus >= 201402L // C++14 and beyond + using std::enable_if_t; +diff --git a/include/spdlog/logger.h b/include/spdlog/logger.h +index 9db3c6b3..07d96e5d 100644 +--- a/include/spdlog/logger.h ++++ b/include/spdlog/logger.h +@@ -77,12 +77,20 @@ public: + + template + void log(source_loc loc, level::level_enum lvl, format_string_t fmt, Args &&...args) { +- log_(loc, lvl, details::to_string_view(fmt), std::forward(args)...); ++#ifdef SPDLOG_USE_STD_FORMAT ++ log_(loc, lvl, fmt.get(), std::forward(args)...); ++#else ++ log_(loc, lvl, fmt.str, std::forward(args)...); ++#endif + } + + template + void log(level::level_enum lvl, format_string_t fmt, Args &&...args) { ++#ifdef SPDLOG_USE_STD_FORMAT + log(source_loc{}, lvl, fmt, std::forward(args)...); ++#else ++ log(source_loc{}, lvl, fmt.str, std::forward(args)...); ++#endif + } + + template +@@ -127,43 +135,71 @@ public: + + template + void trace(format_string_t fmt, Args &&...args) { ++#ifdef SPDLOG_USE_STD_FORMAT + log(level::trace, fmt, std::forward(args)...); ++#else ++ log(level::trace, fmt.str, std::forward(args)...); ++#endif + } + + template + void debug(format_string_t fmt, Args &&...args) { ++#ifdef SPDLOG_USE_STD_FORMAT + log(level::debug, fmt, std::forward(args)...); ++#else ++ log(level::debug, fmt.str, std::forward(args)...); ++#endif + } + + template + void info(format_string_t fmt, Args &&...args) { ++#ifdef SPDLOG_USE_STD_FORMAT + log(level::info, fmt, std::forward(args)...); ++#else ++ log(level::info, fmt.str, std::forward(args)...); ++#endif + } + + template + void warn(format_string_t fmt, Args &&...args) { ++#ifdef SPDLOG_USE_STD_FORMAT + log(level::warn, fmt, std::forward(args)...); ++#else ++ log(level::warn, fmt.str, std::forward(args)...); ++#endif + } + + template + void error(format_string_t fmt, Args &&...args) { ++#ifdef SPDLOG_USE_STD_FORMAT + log(level::err, fmt, std::forward(args)...); ++#else ++ log(level::err, fmt.str, std::forward(args)...); ++#endif + } + + template + void critical(format_string_t fmt, Args &&...args) { ++#ifdef SPDLOG_USE_STD_FORMAT + log(level::critical, fmt, std::forward(args)...); ++#else ++ log(level::critical, fmt.str, std::forward(args)...); ++#endif + } + + #ifdef SPDLOG_WCHAR_TO_UTF8_SUPPORT + template + void log(source_loc loc, level::level_enum lvl, wformat_string_t fmt, Args &&...args) { +- log_(loc, lvl, details::to_string_view(fmt), std::forward(args)...); ++ log_(loc, lvl, fmt.get(), std::forward(args)...); + } + + template + void log(level::level_enum lvl, wformat_string_t fmt, Args &&...args) { ++#ifdef SPDLOG_USE_STD_FORMAT + log(source_loc{}, lvl, fmt, std::forward(args)...); ++#else ++ log(source_loc{}, lvl, fmt.get(), std::forward(args)...); ++#endif + } + + void log(log_clock::time_point log_time, +@@ -199,32 +235,56 @@ public: + + template + void trace(wformat_string_t fmt, Args &&...args) { ++#ifdef SPDLOG_USE_STD_FORMAT + log(level::trace, fmt, std::forward(args)...); ++#else ++ log(level::trace, fmt.get(), std::forward(args)...); ++#endif + } + + template + void debug(wformat_string_t fmt, Args &&...args) { ++#ifdef SPDLOG_USE_STD_FORMAT + log(level::debug, fmt, std::forward(args)...); ++#else ++ log(level::debug, fmt.get(), std::forward(args)...); ++#endif + } + + template + void info(wformat_string_t fmt, Args &&...args) { ++#ifdef SPDLOG_USE_STD_FORMAT + log(level::info, fmt, std::forward(args)...); ++#else ++ log(level::info, fmt.get(), std::forward(args)...); ++#endif + } + + template + void warn(wformat_string_t fmt, Args &&...args) { ++#ifdef SPDLOG_USE_STD_FORMAT + log(level::warn, fmt, std::forward(args)...); ++#else ++ log(level::warn, fmt.get(), std::forward(args)...); ++#endif + } + + template + void error(wformat_string_t fmt, Args &&...args) { ++#ifdef SPDLOG_USE_STD_FORMAT + log(level::err, fmt, std::forward(args)...); ++#else ++ log(level::err, fmt.get(), std::forward(args)...); ++#endif + } + + template + void critical(wformat_string_t fmt, Args &&...args) { ++#ifdef SPDLOG_USE_STD_FORMAT + log(level::critical, fmt, std::forward(args)...); ++#else ++ log(level::critical, fmt.get(), std::forward(args)...); ++#endif + } + #endif + +diff --git a/include/spdlog/spdlog.h b/include/spdlog/spdlog.h +index 681045e1..bfecaf92 100644 +--- a/include/spdlog/spdlog.h ++++ b/include/spdlog/spdlog.h +@@ -150,42 +150,74 @@ inline void log(source_loc source, + level::level_enum lvl, + format_string_t fmt, + Args &&...args) { ++#ifdef SPDLOG_USE_STD_FORMAT + default_logger_raw()->log(source, lvl, fmt, std::forward(args)...); ++#else ++ default_logger_raw()->log(source, lvl, fmt.str, std::forward(args)...); ++#endif + } + + template + inline void log(level::level_enum lvl, format_string_t fmt, Args &&...args) { ++#ifdef SPDLOG_USE_STD_FORMAT + default_logger_raw()->log(source_loc{}, lvl, fmt, std::forward(args)...); ++#else ++ default_logger_raw()->log(source_loc{}, lvl, fmt.str, std::forward(args)...); ++#endif + } + + template + inline void trace(format_string_t fmt, Args &&...args) { ++#ifdef SPDLOG_USE_STD_FORMAT + default_logger_raw()->trace(fmt, std::forward(args)...); ++#else ++ default_logger_raw()->trace(fmt.str, std::forward(args)...); ++#endif + } + + template + inline void debug(format_string_t fmt, Args &&...args) { ++#ifdef SPDLOG_USE_STD_FORMAT + default_logger_raw()->debug(fmt, std::forward(args)...); ++#else ++ default_logger_raw()->debug(fmt.str, std::forward(args)...); ++#endif + } + + template + inline void info(format_string_t fmt, Args &&...args) { ++#ifdef SPDLOG_USE_STD_FORMAT + default_logger_raw()->info(fmt, std::forward(args)...); ++#else ++ default_logger_raw()->info(fmt.str, std::forward(args)...); ++#endif + } + + template + inline void warn(format_string_t fmt, Args &&...args) { ++#ifdef SPDLOG_USE_STD_FORMAT + default_logger_raw()->warn(fmt, std::forward(args)...); ++#else ++ default_logger_raw()->warn(fmt.str, std::forward(args)...); ++#endif + } + + template + inline void error(format_string_t fmt, Args &&...args) { ++#ifdef SPDLOG_USE_STD_FORMAT + default_logger_raw()->error(fmt, std::forward(args)...); ++#else ++ default_logger_raw()->error(fmt.str, std::forward(args)...); ++#endif + } + + template + inline void critical(format_string_t fmt, Args &&...args) { ++#ifdef SPDLOG_USE_STD_FORMAT + default_logger_raw()->critical(fmt, std::forward(args)...); ++#else ++ default_logger_raw()->critical(fmt.str, std::forward(args)...); ++#endif + } + + template +@@ -204,42 +236,74 @@ inline void log(source_loc source, + level::level_enum lvl, + wformat_string_t fmt, + Args &&...args) { ++#ifdef SPDLOG_USE_STD_FORMAT + default_logger_raw()->log(source, lvl, fmt, std::forward(args)...); ++#else ++ default_logger_raw()->log(source, lvl, fmt.get(), std::forward(args)...); ++#endif + } + + template + inline void log(level::level_enum lvl, wformat_string_t fmt, Args &&...args) { ++#ifdef SPDLOG_USE_STD_FORMAT + default_logger_raw()->log(source_loc{}, lvl, fmt, std::forward(args)...); ++#else ++ default_logger_raw()->log(source_loc{}, lvl, fmt.get(), std::forward(args)...); ++#endif + } + + template + inline void trace(wformat_string_t fmt, Args &&...args) { ++#ifdef SPDLOG_USE_STD_FORMAT + default_logger_raw()->trace(fmt, std::forward(args)...); ++#else ++ default_logger_raw()->trace(fmt.get(), std::forward(args)...); ++#endif + } + + template + inline void debug(wformat_string_t fmt, Args &&...args) { ++#ifdef SPDLOG_USE_STD_FORMAT + default_logger_raw()->debug(fmt, std::forward(args)...); ++#else ++ default_logger_raw()->debug(fmt.get(), std::forward(args)...); ++#endif + } + + template + inline void info(wformat_string_t fmt, Args &&...args) { ++#ifdef SPDLOG_USE_STD_FORMAT + default_logger_raw()->info(fmt, std::forward(args)...); ++#else ++ default_logger_raw()->info(fmt.get(), std::forward(args)...); ++#endif + } + + template + inline void warn(wformat_string_t fmt, Args &&...args) { ++#ifdef SPDLOG_USE_STD_FORMAT + default_logger_raw()->warn(fmt, std::forward(args)...); ++#else ++ default_logger_raw()->warn(fmt.get(), std::forward(args)...); ++#endif + } + + template + inline void error(wformat_string_t fmt, Args &&...args) { ++#ifdef SPDLOG_USE_STD_FORMAT + default_logger_raw()->error(fmt, std::forward(args)...); ++#else ++ default_logger_raw()->error(fmt.get(), std::forward(args)...); ++#endif + } + + template + inline void critical(wformat_string_t fmt, Args &&...args) { ++#ifdef SPDLOG_USE_STD_FORMAT + default_logger_raw()->critical(fmt, std::forward(args)...); ++#else ++ default_logger_raw()->critical(fmt.get(), std::forward(args)...); ++#endif + } + #endif + +diff --git a/tests/test_fmt_helper.cpp b/tests/test_fmt_helper.cpp +index 31b93067..1f317750 100644 +--- a/tests/test_fmt_helper.cpp ++++ b/tests/test_fmt_helper.cpp +@@ -2,7 +2,11 @@ + #include "includes.h" + + using spdlog::memory_buf_t; +-using spdlog::details::to_string_view; ++ ++SPDLOG_CONSTEXPR_FUNC spdlog::string_view_t to_string_view(const memory_buf_t &buf) ++ SPDLOG_NOEXCEPT { ++ return spdlog::string_view_t{buf.data(), buf.size()}; ++} + + void test_pad2(int n, const char *expected) { + memory_buf_t buf; +diff --git a/tests/test_pattern_formatter.cpp b/tests/test_pattern_formatter.cpp +index cd0df811..905b2be9 100644 +--- a/tests/test_pattern_formatter.cpp ++++ b/tests/test_pattern_formatter.cpp +@@ -4,7 +4,11 @@ + #include + + using spdlog::memory_buf_t; +-using spdlog::details::to_string_view; ++ ++SPDLOG_CONSTEXPR_FUNC spdlog::string_view_t to_string_view(const memory_buf_t &buf) ++ SPDLOG_NOEXCEPT { ++ return spdlog::string_view_t{buf.data(), buf.size()}; ++} + + // log to str and return it + template diff --git a/cmake/spdlog-0002-Fix-format_string-propagation-3543.patch b/cmake/spdlog-0002-Fix-format_string-propagation-3543.patch new file mode 100644 index 00000000..20b18be2 --- /dev/null +++ b/cmake/spdlog-0002-Fix-format_string-propagation-3543.patch @@ -0,0 +1,326 @@ +From 0177c64e92c3a5bc33902e064372a2551a15dba4 Mon Sep 17 00:00:00 2001 +From: Yancey <135342560+Yancey2023@users.noreply.github.com> +Date: Mon, 23 Feb 2026 23:16:21 +0800 +Subject: [PATCH 2/2] Fix format_string propagation (#3543) + +(cherry picked from commit d5af52d903ed69f96c7350155e94aeff248b31eb) +--- + include/spdlog/logger.h | 66 +++++------------------------------------ + include/spdlog/spdlog.h | 64 --------------------------------------- + 2 files changed, 7 insertions(+), 123 deletions(-) + +diff --git a/include/spdlog/logger.h b/include/spdlog/logger.h +index 07d96e5d..af1c594d 100644 +--- a/include/spdlog/logger.h ++++ b/include/spdlog/logger.h +@@ -77,20 +77,16 @@ public: + + template + void log(source_loc loc, level::level_enum lvl, format_string_t fmt, Args &&...args) { +-#ifdef SPDLOG_USE_STD_FORMAT +- log_(loc, lvl, fmt.get(), std::forward(args)...); ++#if defined(SPDLOG_USE_STD_FORMAT) && __cpp_lib_format < 202207L ++ log_(loc, lvl, fmt, std::forward(args)...); + #else +- log_(loc, lvl, fmt.str, std::forward(args)...); ++ log_(loc, lvl, fmt.get(), std::forward(args)...); + #endif + } + + template + void log(level::level_enum lvl, format_string_t fmt, Args &&...args) { +-#ifdef SPDLOG_USE_STD_FORMAT + log(source_loc{}, lvl, fmt, std::forward(args)...); +-#else +- log(source_loc{}, lvl, fmt.str, std::forward(args)...); +-#endif + } + + template +@@ -135,71 +131,47 @@ public: + + template + void trace(format_string_t fmt, Args &&...args) { +-#ifdef SPDLOG_USE_STD_FORMAT + log(level::trace, fmt, std::forward(args)...); +-#else +- log(level::trace, fmt.str, std::forward(args)...); +-#endif + } + + template + void debug(format_string_t fmt, Args &&...args) { +-#ifdef SPDLOG_USE_STD_FORMAT + log(level::debug, fmt, std::forward(args)...); +-#else +- log(level::debug, fmt.str, std::forward(args)...); +-#endif + } + + template + void info(format_string_t fmt, Args &&...args) { +-#ifdef SPDLOG_USE_STD_FORMAT + log(level::info, fmt, std::forward(args)...); +-#else +- log(level::info, fmt.str, std::forward(args)...); +-#endif + } + + template + void warn(format_string_t fmt, Args &&...args) { +-#ifdef SPDLOG_USE_STD_FORMAT + log(level::warn, fmt, std::forward(args)...); +-#else +- log(level::warn, fmt.str, std::forward(args)...); +-#endif + } + + template + void error(format_string_t fmt, Args &&...args) { +-#ifdef SPDLOG_USE_STD_FORMAT + log(level::err, fmt, std::forward(args)...); +-#else +- log(level::err, fmt.str, std::forward(args)...); +-#endif + } + + template + void critical(format_string_t fmt, Args &&...args) { +-#ifdef SPDLOG_USE_STD_FORMAT + log(level::critical, fmt, std::forward(args)...); +-#else +- log(level::critical, fmt.str, std::forward(args)...); +-#endif + } + + #ifdef SPDLOG_WCHAR_TO_UTF8_SUPPORT + template + void log(source_loc loc, level::level_enum lvl, wformat_string_t fmt, Args &&...args) { ++#if defined(SPDLOG_USE_STD_FORMAT) && __cpp_lib_format < 202207L ++ log_(loc, lvl, fmt, std::forward(args)...); ++#else + log_(loc, lvl, fmt.get(), std::forward(args)...); ++#endif + } + + template + void log(level::level_enum lvl, wformat_string_t fmt, Args &&...args) { +-#ifdef SPDLOG_USE_STD_FORMAT + log(source_loc{}, lvl, fmt, std::forward(args)...); +-#else +- log(source_loc{}, lvl, fmt.get(), std::forward(args)...); +-#endif + } + + void log(log_clock::time_point log_time, +@@ -235,56 +207,32 @@ public: + + template + void trace(wformat_string_t fmt, Args &&...args) { +-#ifdef SPDLOG_USE_STD_FORMAT + log(level::trace, fmt, std::forward(args)...); +-#else +- log(level::trace, fmt.get(), std::forward(args)...); +-#endif + } + + template + void debug(wformat_string_t fmt, Args &&...args) { +-#ifdef SPDLOG_USE_STD_FORMAT + log(level::debug, fmt, std::forward(args)...); +-#else +- log(level::debug, fmt.get(), std::forward(args)...); +-#endif + } + + template + void info(wformat_string_t fmt, Args &&...args) { +-#ifdef SPDLOG_USE_STD_FORMAT + log(level::info, fmt, std::forward(args)...); +-#else +- log(level::info, fmt.get(), std::forward(args)...); +-#endif + } + + template + void warn(wformat_string_t fmt, Args &&...args) { +-#ifdef SPDLOG_USE_STD_FORMAT + log(level::warn, fmt, std::forward(args)...); +-#else +- log(level::warn, fmt.get(), std::forward(args)...); +-#endif + } + + template + void error(wformat_string_t fmt, Args &&...args) { +-#ifdef SPDLOG_USE_STD_FORMAT + log(level::err, fmt, std::forward(args)...); +-#else +- log(level::err, fmt.get(), std::forward(args)...); +-#endif + } + + template + void critical(wformat_string_t fmt, Args &&...args) { +-#ifdef SPDLOG_USE_STD_FORMAT + log(level::critical, fmt, std::forward(args)...); +-#else +- log(level::critical, fmt.get(), std::forward(args)...); +-#endif + } + #endif + +diff --git a/include/spdlog/spdlog.h b/include/spdlog/spdlog.h +index bfecaf92..681045e1 100644 +--- a/include/spdlog/spdlog.h ++++ b/include/spdlog/spdlog.h +@@ -150,74 +150,42 @@ inline void log(source_loc source, + level::level_enum lvl, + format_string_t fmt, + Args &&...args) { +-#ifdef SPDLOG_USE_STD_FORMAT + default_logger_raw()->log(source, lvl, fmt, std::forward(args)...); +-#else +- default_logger_raw()->log(source, lvl, fmt.str, std::forward(args)...); +-#endif + } + + template + inline void log(level::level_enum lvl, format_string_t fmt, Args &&...args) { +-#ifdef SPDLOG_USE_STD_FORMAT + default_logger_raw()->log(source_loc{}, lvl, fmt, std::forward(args)...); +-#else +- default_logger_raw()->log(source_loc{}, lvl, fmt.str, std::forward(args)...); +-#endif + } + + template + inline void trace(format_string_t fmt, Args &&...args) { +-#ifdef SPDLOG_USE_STD_FORMAT + default_logger_raw()->trace(fmt, std::forward(args)...); +-#else +- default_logger_raw()->trace(fmt.str, std::forward(args)...); +-#endif + } + + template + inline void debug(format_string_t fmt, Args &&...args) { +-#ifdef SPDLOG_USE_STD_FORMAT + default_logger_raw()->debug(fmt, std::forward(args)...); +-#else +- default_logger_raw()->debug(fmt.str, std::forward(args)...); +-#endif + } + + template + inline void info(format_string_t fmt, Args &&...args) { +-#ifdef SPDLOG_USE_STD_FORMAT + default_logger_raw()->info(fmt, std::forward(args)...); +-#else +- default_logger_raw()->info(fmt.str, std::forward(args)...); +-#endif + } + + template + inline void warn(format_string_t fmt, Args &&...args) { +-#ifdef SPDLOG_USE_STD_FORMAT + default_logger_raw()->warn(fmt, std::forward(args)...); +-#else +- default_logger_raw()->warn(fmt.str, std::forward(args)...); +-#endif + } + + template + inline void error(format_string_t fmt, Args &&...args) { +-#ifdef SPDLOG_USE_STD_FORMAT + default_logger_raw()->error(fmt, std::forward(args)...); +-#else +- default_logger_raw()->error(fmt.str, std::forward(args)...); +-#endif + } + + template + inline void critical(format_string_t fmt, Args &&...args) { +-#ifdef SPDLOG_USE_STD_FORMAT + default_logger_raw()->critical(fmt, std::forward(args)...); +-#else +- default_logger_raw()->critical(fmt.str, std::forward(args)...); +-#endif + } + + template +@@ -236,74 +204,42 @@ inline void log(source_loc source, + level::level_enum lvl, + wformat_string_t fmt, + Args &&...args) { +-#ifdef SPDLOG_USE_STD_FORMAT + default_logger_raw()->log(source, lvl, fmt, std::forward(args)...); +-#else +- default_logger_raw()->log(source, lvl, fmt.get(), std::forward(args)...); +-#endif + } + + template + inline void log(level::level_enum lvl, wformat_string_t fmt, Args &&...args) { +-#ifdef SPDLOG_USE_STD_FORMAT + default_logger_raw()->log(source_loc{}, lvl, fmt, std::forward(args)...); +-#else +- default_logger_raw()->log(source_loc{}, lvl, fmt.get(), std::forward(args)...); +-#endif + } + + template + inline void trace(wformat_string_t fmt, Args &&...args) { +-#ifdef SPDLOG_USE_STD_FORMAT + default_logger_raw()->trace(fmt, std::forward(args)...); +-#else +- default_logger_raw()->trace(fmt.get(), std::forward(args)...); +-#endif + } + + template + inline void debug(wformat_string_t fmt, Args &&...args) { +-#ifdef SPDLOG_USE_STD_FORMAT + default_logger_raw()->debug(fmt, std::forward(args)...); +-#else +- default_logger_raw()->debug(fmt.get(), std::forward(args)...); +-#endif + } + + template + inline void info(wformat_string_t fmt, Args &&...args) { +-#ifdef SPDLOG_USE_STD_FORMAT + default_logger_raw()->info(fmt, std::forward(args)...); +-#else +- default_logger_raw()->info(fmt.get(), std::forward(args)...); +-#endif + } + + template + inline void warn(wformat_string_t fmt, Args &&...args) { +-#ifdef SPDLOG_USE_STD_FORMAT + default_logger_raw()->warn(fmt, std::forward(args)...); +-#else +- default_logger_raw()->warn(fmt.get(), std::forward(args)...); +-#endif + } + + template + inline void error(wformat_string_t fmt, Args &&...args) { +-#ifdef SPDLOG_USE_STD_FORMAT + default_logger_raw()->error(fmt, std::forward(args)...); +-#else +- default_logger_raw()->error(fmt.get(), std::forward(args)...); +-#endif + } + + template + inline void critical(wformat_string_t fmt, Args &&...args) { +-#ifdef SPDLOG_USE_STD_FORMAT + default_logger_raw()->critical(fmt, std::forward(args)...); +-#else +- default_logger_raw()->critical(fmt.get(), std::forward(args)...); +-#endif + } + #endif + diff --git a/cmake/spdlog-fmt-fstring-get.patch b/cmake/spdlog-fmt-fstring-get.patch deleted file mode 100644 index c2cc1433..00000000 --- a/cmake/spdlog-fmt-fstring-get.patch +++ /dev/null @@ -1,36 +0,0 @@ -From: Skydio -Date: Mon, 20 Jul 2026 00:00:00 +0000 -Subject: [PATCH] logger: Use fstring::get() instead of the deprecated conversion - -fmt 12 marked fmt::fstring's implicit conversion to string_view as deprecated in -favor of fstring::get(). logger::log() relies on that conversion to pass a -format_string into log_(), which takes a string_view, so every caller trips --Werror=deprecated-declarations. - -Call get() explicitly at the two sites that convert. All other format_string -overloads forward the type along and are unaffected. ---- - include/spdlog/logger.h | 4 ++-- - 1 file changed, 2 insertions(+), 2 deletions(-) - -diff --git a/include/spdlog/logger.h b/include/spdlog/logger.h ---- a/include/spdlog/logger.h -+++ b/include/spdlog/logger.h -@@ -80,7 +80,7 @@ - template - void log(source_loc loc, level::level_enum lvl, fmt::format_string fmt, Args &&...args) - { -- log_(loc, lvl, fmt, std::forward(args)...); -+ log_(loc, lvl, fmt.get(), std::forward(args)...); - } - - template -@@ -186,7 +186,7 @@ - template - void log(source_loc loc, level::level_enum lvl, fmt::wformat_string fmt, Args &&...args) - { -- log_(loc, lvl, fmt, std::forward(args)...); -+ log_(loc, lvl, fmt.get(), std::forward(args)...); - } - - template diff --git a/cmake/spdlog-fmt-runtime.patch b/cmake/spdlog-fmt-runtime.patch deleted file mode 100644 index 75b39e9e..00000000 --- a/cmake/spdlog-fmt-runtime.patch +++ /dev/null @@ -1,40 +0,0 @@ -From: Skydio -Date: Mon, 20 Jul 2026 00:00:00 +0000 -Subject: [PATCH] common: Support fmt >= 9.1 runtime_format_string - -fmt 10 removed fmt::basic_runtime (it was renamed to -fmt::runtime_format_string in fmt 9.1). The pinned spdlog (1.9.2) still -references fmt::basic_runtime directly in is_convertible_to_basic_format_string, -which fails to compile against fmt 12. - -Introduce a version-guarded fmt_runtime_string alias, mirroring the fix that -upstream spdlog shipped in 1.15.x, so the trait keeps compiling across fmt -versions. ---- - include/spdlog/common.h | 9 ++++++++- - 1 file changed, 8 insertions(+), 1 deletion(-) - -diff --git a/include/spdlog/common.h b/include/spdlog/common.h ---- a/include/spdlog/common.h -+++ b/include/spdlog/common.h -@@ -119,12 +119,19 @@ using level_t = std::atomic; - template - using remove_cvref_t = typename std::remove_cv::type>::type; - -+template -+#if FMT_VERSION >= 90101 -+using fmt_runtime_string = fmt::runtime_format_string; -+#else -+using fmt_runtime_string = fmt::basic_runtime; -+#endif -+ - // clang doesn't like SFINAE disabled constructor in std::is_convertible<> so have to repeat the condition from basic_format_string here, - // in addition, fmt::basic_runtime is only convertible to basic_format_string but not basic_string_view - template - struct is_convertible_to_basic_format_string - : std::integral_constant>::value || std::is_same, fmt::basic_runtime>::value> -+ std::is_convertible>::value || std::is_same, fmt_runtime_string>::value> - {}; - - #ifdef SPDLOG_WCHAR_TO_UTF8_SUPPORT diff --git a/symforce/opt/CMakeLists.txt b/symforce/opt/CMakeLists.txt index 08fc65f7..7b124bb0 100644 --- a/symforce/opt/CMakeLists.txt +++ b/symforce/opt/CMakeLists.txt @@ -12,7 +12,7 @@ include(FetchContent) # ------------------------------------------------------------------------------ # spdlog -find_package(spdlog 1.9...<1.11 QUIET) +find_package(spdlog 1.17...<1.18 QUIET) if (NOT spdlog_FOUND) message(STATUS "spdlog not found, adding with FetchContent") function(add_spdlog) @@ -21,11 +21,14 @@ if (NOT spdlog_FOUND) set(CMAKE_POSITION_INDEPENDENT_CODE True) FetchContent_Declare( spdlog - URL https://github.com/gabime/spdlog/archive/v1.9.2.zip - URL_HASH SHA256=130bd593c33e2e2abba095b551db6a05f5e4a5a19c03ab31256c38fa218aa0a6 - # spdlog 1.9.2 references fmt::basic_runtime, which fmt 10 removed, and relies on an - # fmt::fstring conversion that fmt 12 deprecated. Patch both so it compiles against fmt 12. - PATCH_COMMAND "${CMAKE_CURRENT_SOURCE_DIR}/../../cmake/patch_spdlog.sh" "${FETCHCONTENT_BASE_DIR}/spdlog-src" "${CMAKE_CURRENT_SOURCE_DIR}/../../cmake/spdlog-fmt-runtime.patch" "${CMAKE_CURRENT_SOURCE_DIR}/../../cmake/spdlog-fmt-fstring-get.patch" + URL https://github.com/gabime/spdlog/archive/v1.17.0.zip + URL_HASH SHA256=b11912a82d149792fef33fabd0503b13d54aeac25c1464755461d4108ea71fc2 + # spdlog 1.17.0 relies on an fmt::fstring conversion that fmt 12 deprecated. These are + # upstream spdlog 1685e694 and d5af52d9, which landed after the 1.17.0 release. + PATCH_COMMAND "${CMAKE_CURRENT_SOURCE_DIR}/../../cmake/patch_spdlog.sh" + "${FETCHCONTENT_BASE_DIR}/spdlog-src" + "${CMAKE_CURRENT_SOURCE_DIR}/../../cmake/spdlog-0001-Fix-deprecated-copy-constructor-usage-of-fmt-format_.patch" + "${CMAKE_CURRENT_SOURCE_DIR}/../../cmake/spdlog-0002-Fix-format_string-propagation-3543.patch" ) FetchContent_MakeAvailable(spdlog) endfunction() From 2246f8a5b49a455c46e9e9db09e0ba25ace421e2 Mon Sep 17 00:00:00 2001 From: Skydio Buildkite Worker Date: Sun, 20 Sep 2026 19:59:44 +0000 Subject: [PATCH 26/68] [SymForce] Update pinned dependencies GitOrigin-RevId: 6884434b3265638d98fadbec3d61eafdec06ea28 --- requirements/dev_py310.txt | 2 +- requirements/dev_py311.txt | 2 +- requirements/dev_py312.txt | 2 +- requirements/dev_py313.txt | 2 +- requirements/dev_py314.txt | 2 +- 5 files changed, 5 insertions(+), 5 deletions(-) diff --git a/requirements/dev_py310.txt b/requirements/dev_py310.txt index 0e948d82..2dfca3d6 100644 --- a/requirements/dev_py310.txt +++ b/requirements/dev_py310.txt @@ -259,7 +259,7 @@ sortedcontainers==2.4.0 # sortedcontainers-stubs sortedcontainers-stubs==2.4.3 # via symforce (pyproject.toml) -soupsieve==2.8.4 +soupsieve==2.9 # via beautifulsoup4 sphinx==8.1.3 # via diff --git a/requirements/dev_py311.txt b/requirements/dev_py311.txt index 88bae80b..d5d27f5e 100644 --- a/requirements/dev_py311.txt +++ b/requirements/dev_py311.txt @@ -260,7 +260,7 @@ sortedcontainers==2.4.0 # sortedcontainers-stubs sortedcontainers-stubs==2.4.3 # via symforce (pyproject.toml) -soupsieve==2.8.4 +soupsieve==2.9 # via beautifulsoup4 sphinx==9.0.4 # via diff --git a/requirements/dev_py312.txt b/requirements/dev_py312.txt index 9f1a401c..dfb01700 100644 --- a/requirements/dev_py312.txt +++ b/requirements/dev_py312.txt @@ -260,7 +260,7 @@ sortedcontainers==2.4.0 # sortedcontainers-stubs sortedcontainers-stubs==2.4.3 # via symforce (pyproject.toml) -soupsieve==2.8.4 +soupsieve==2.9 # via beautifulsoup4 sphinx==9.1.0 # via diff --git a/requirements/dev_py313.txt b/requirements/dev_py313.txt index 94fb4ab8..9e39304f 100644 --- a/requirements/dev_py313.txt +++ b/requirements/dev_py313.txt @@ -260,7 +260,7 @@ sortedcontainers==2.4.0 # sortedcontainers-stubs sortedcontainers-stubs==2.4.3 # via symforce (pyproject.toml) -soupsieve==2.8.4 +soupsieve==2.9 # via beautifulsoup4 sphinx==9.1.0 # via diff --git a/requirements/dev_py314.txt b/requirements/dev_py314.txt index 7ab1fc5e..29612bf4 100644 --- a/requirements/dev_py314.txt +++ b/requirements/dev_py314.txt @@ -262,7 +262,7 @@ sortedcontainers==2.4.0 # sortedcontainers-stubs sortedcontainers-stubs==2.4.3 # via symforce (pyproject.toml) -soupsieve==2.8.4 +soupsieve==2.9 # via beautifulsoup4 sphinx==9.1.0 # via From a768308e36e3a6935a54df095152acde41a0e734 Mon Sep 17 00:00:00 2001 From: Aaron Date: Fri, 25 Sep 2026 23:12:46 +0000 Subject: [PATCH 27/68] [Caspar] Zero initialize caspar kernel registers Fixes symforce-org/symforce#469 Threads past `problem_size` still reach the accessor calls emitted outside the valid-lane guard, and pass them registers nothing assigned in those threads. For `AddSum` that register is the summand `SumStore` reduces. `SumStore` masks invalid lanes with `valid ? data : 0`, but on a large enough kernel LLVM speculates the guarded body and drops the mask, so the padding lanes' garbage lands in the sum. It was reported from a COLMAP OpenCV bundle adjustment on HIP (AMD) scoring NaN; the same kernel built with clang for sm_75 (Nvidia) scores NaN on any problem size that isn't a multiple of the block size. nvcc keeps the mask and emits identical code with or without this change. Zeroing the registers where they are declared makes the read defined for every accessor, including the pair accessors, which hit the same path. `caspar_padding_lane_cuda_test` runs a checked-in generated score kernel over problem sizes that leave padding lanes. It is the first test here that needs a GPU: `*_cuda_test.cc` tests are built in CMake only when a CUDA compiler is available. Its codegen test also imports caspar under the sympy API, where the symengine in SymForce's build directory isn't on `sys.path` until `symforce.find_symengine()` puts it there. caspar now calls it, and it loses its leading underscore since caspar isn't the only caller. Running this test built with clang on a Quadro RTX 4000 fails 4 of 5 assertions without the fix and passes with it. Assisted-by: Claude:claude-opus-5 Signed-off-by: Aaron Miller GitOrigin-RevId: 4c2a6d0744b03cd0ac0659b819ef20349bceb45a --- symforce/__init__.py | 6 +- symforce/caspar/code_formulation/ftypes.py | 6 + .../caspar/source/templates/kernel.cu.jinja | 4 +- symforce/geo/matrix.py | 2 +- symforce/internal/symbolic.py | 2 +- test/CMakeLists.txt | 43 +++++ test/caspar_padding_lane_cuda_test.cc | 95 ++++++++++ test/symforce_caspar_codegen_test.py | 87 ++++++++++ .../kernel_caspar_padding_lane_score.cu | 164 ++++++++++++++++++ .../kernel_caspar_padding_lane_score.h | 17 ++ 10 files changed, 420 insertions(+), 6 deletions(-) create mode 100644 test/caspar_padding_lane_cuda_test.cc create mode 100644 test/symforce_caspar_codegen_test.py create mode 100644 test/symforce_function_codegen_test_data/symengine/symforce_caspar_codegen_test/kernel_caspar_padding_lane_score.cu create mode 100644 test/symforce_function_codegen_test_data/symengine/symforce_caspar_codegen_test/kernel_caspar_padding_lane_score.h diff --git a/symforce/__init__.py b/symforce/__init__.py index 3853d6f4..90e7e514 100644 --- a/symforce/__init__.py +++ b/symforce/__init__.py @@ -97,7 +97,7 @@ def __init__(self, api: str): super().__init__(f'Symbolic API is "{api}", must be one of ("sympy", "symengine")') -def _find_symengine() -> ModuleType: +def find_symengine() -> ModuleType: """ Attempts to import symengine from its location in the symforce build directory @@ -159,7 +159,7 @@ def _set_symbolic_api(sympy_module: T.Literal["sympy", "symengine"]) -> None: def _use_symengine() -> None: try: - _find_symengine() + find_symengine() except ImportError: logger.critical("Commanded to use symengine, but failed to import.") @@ -221,7 +221,7 @@ def set_symbolic_api(name: str) -> None: set_symbolic_api(os.environ["SYMFORCE_SYMBOLIC_API"]) else: try: - _find_symengine() + find_symengine() logger.debug("No SYMFORCE_SYMBOLIC_API set, found and using symengine.") set_symbolic_api("symengine") diff --git a/symforce/caspar/code_formulation/ftypes.py b/symforce/caspar/code_formulation/ftypes.py index 68e33b54..1ad9c25f 100644 --- a/symforce/caspar/code_formulation/ftypes.py +++ b/symforce/caspar/code_formulation/ftypes.py @@ -9,6 +9,12 @@ from abc import abstractmethod +import symforce + +# symengine may only be importable once symforce has found it. +symforce.find_symengine() + +# isort: split from symengine.lib import symengine_wrapper import symforce.symbolic as sf diff --git a/symforce/caspar/source/templates/kernel.cu.jinja b/symforce/caspar/source/templates/kernel.cu.jinja index fa30d92d..8da744a3 100644 --- a/symforce/caspar/source/templates/kernel.cu.jinja +++ b/symforce/caspar/source/templates/kernel.cu.jinja @@ -39,7 +39,9 @@ __launch_bounds__({{kernel.block_size}}, 1) {% endfor %} {% if kernel.registers.__len__() > 0 %} - {{kernel.kernel_t}} {{','.join(kernel.registers)}}; + {# Threads past problem_size pass these by value to accessor calls outside the guard without + ever assigning them, so they need a defined value; zero is the identity of the sums. #} + {{kernel.kernel_t}} {{' = 0, '.join(kernel.registers)}} = 0; {% endif %} if (global_thread_idx < problem_size){ diff --git a/symforce/geo/matrix.py b/symforce/geo/matrix.py index 880db835..85eb2074 100644 --- a/symforce/geo/matrix.py +++ b/symforce/geo/matrix.py @@ -806,7 +806,7 @@ def __truediv__( return self.__class__(self.mat * _T.cast(sf.sympy.MutableDenseMatrix, right).inv()) def _symengine_(self) -> symengine.Matrix: # noqa: PLW3201 - symengine = symforce._find_symengine() # noqa: SLF001 + symengine = symforce.find_symengine() return symengine.S(self.mat) def compute_AtA(self, lower_only: bool = False) -> Matrix: diff --git a/symforce/internal/symbolic.py b/symforce/internal/symbolic.py index 9e7ba1a2..44aa2661 100644 --- a/symforce/internal/symbolic.py +++ b/symforce/internal/symbolic.py @@ -61,7 +61,7 @@ import sympy as _sympy_py if not T.TYPE_CHECKING and symforce.get_symbolic_api() == "symengine": - sympy = symforce._find_symengine() + sympy = symforce.find_symengine() # isort: split diff --git a/test/CMakeLists.txt b/test/CMakeLists.txt index 107a3d07..702be381 100644 --- a/test/CMakeLists.txt +++ b/test/CMakeLists.txt @@ -9,6 +9,8 @@ file(MAKE_DIRECTORY ${CMAKE_BINARY_DIR}/bin/tests) # symforce_test library file(GLOB_RECURSE SYMFORCE_TEST_SOURCES CONFIGURE_DEPENDS symforce_function_codegen_test_data/**/*.cc) +# The caspar test data is CUDA, built by its own targets below. +list(FILTER SYMFORCE_TEST_SOURCES EXCLUDE REGEX "/symforce_caspar_[^/]*/") file(GLOB_RECURSE SYMFORCE_TEST_HEADERS CONFIGURE_DEPENDS symforce_function_codegen_test_data/**/*.hpp include/*.h @@ -44,6 +46,11 @@ target_compile_definitions( # Tests file(GLOB SYMFORCE_TEST_CC_SOURCES CONFIGURE_DEPENDS *_test.cc) + +# *_cuda_test.cc tests are built below, only when a CUDA compiler is available. +file(GLOB SYMFORCE_CUDA_TEST_CC_SOURCES CONFIGURE_DEPENDS *_cuda_test.cc) +list(REMOVE_ITEM SYMFORCE_TEST_CC_SOURCES ${SYMFORCE_CUDA_TEST_CC_SOURCES}) + set(SYMFORCE_CC_TEST_TARGETS "") foreach(SOURCE_FILE ${SYMFORCE_TEST_CC_SOURCES}) get_filename_component(TEST_NAME ${SOURCE_FILE} NAME_WE) @@ -68,6 +75,42 @@ foreach(SOURCE_FILE ${SYMFORCE_TEST_CC_SOURCES}) add_test(${TEST_NAME} ${CMAKE_BINARY_DIR}/bin/${BINARY_NAME}) endforeach() +# ------------------------------------------------------------------------------ +# Caspar CUDA tests, on code checked in by symforce_caspar_codegen_test.py + +include(CheckLanguage) +check_language(CUDA) +if(CMAKE_CUDA_COMPILER) + enable_language(CUDA) + find_package(CUDAToolkit REQUIRED) + + set(CASPAR_KERNEL_DIR + ${CMAKE_CURRENT_SOURCE_DIR}/symforce_function_codegen_test_data/symengine/symforce_caspar_codegen_test + ) + set(CASPAR_RUNTIME_DIR ${CMAKE_CURRENT_SOURCE_DIR}/../symforce/caspar/source/runtime) + + add_executable( + bin.tests.caspar_padding_lane_cuda_test + caspar_padding_lane_cuda_test.cc + ${CASPAR_KERNEL_DIR}/kernel_caspar_padding_lane_score.cu + ${CASPAR_RUNTIME_DIR}/shared_indices.cu + ) + set_target_properties(bin.tests.caspar_padding_lane_cuda_test PROPERTIES + CUDA_ARCHITECTURES 75 # Minimum for cooperative_groups::reduce + OUTPUT_NAME tests/caspar_padding_lane_cuda_test + TEST_NAME caspar_padding_lane_cuda_test + RUNTIME_OUTPUT_DIRECTORY ${CMAKE_BINARY_DIR}/bin + ) + target_include_directories(bin.tests.caspar_padding_lane_cuda_test PRIVATE + ${CASPAR_KERNEL_DIR} + ${CASPAR_RUNTIME_DIR} + ) + target_link_libraries(bin.tests.caspar_padding_lane_cuda_test Catch2::Catch2WithMain CUDA::cudart) + + list(APPEND SYMFORCE_CC_TEST_TARGETS bin.tests.caspar_padding_lane_cuda_test) + add_test(caspar_padding_lane_cuda_test ${CMAKE_BINARY_DIR}/bin/tests/caspar_padding_lane_cuda_test) +endif() + if(SYMFORCE_ADD_PYTHON_TESTS) file(GLOB SYMFORCE_TEST_PY_SOURCES CONFIGURE_DEPENDS *_test.py) foreach(SOURCE_FILE ${SYMFORCE_TEST_PY_SOURCES}) diff --git a/test/caspar_padding_lane_cuda_test.cc b/test/caspar_padding_lane_cuda_test.cc new file mode 100644 index 00000000..a7e2ea9a --- /dev/null +++ b/test/caspar_padding_lane_cuda_test.cc @@ -0,0 +1,95 @@ +/* ---------------------------------------------------------------------------- + * SymForce - Copyright 2025, Skydio, Inc. + * This source code is under the Apache 2.0 license found in the LICENSE file. + * ---------------------------------------------------------------------------- */ + +#include +#include +#include + +#include +#include + +#include "kernel_caspar_padding_lane_score.h" +#include "shared_indices.h" + +namespace { + +// Enough for any argument's caspar layout. +constexpr size_t kSlotsPerFactor = 16; + +constexpr size_t kNumNodes = 64; + +float* AllocateFilled(const size_t num_factors) { + std::vector host(num_factors * kSlotsPerFactor); + for (size_t i = 0; i < host.size(); i++) { + host[i] = 0.3f + 0.013f * static_cast(i % 19); + } + float* device = nullptr; + cudaMalloc(&device, host.size() * sizeof(float)); + cudaMemcpy(device, host.data(), host.size() * sizeof(float), cudaMemcpyHostToDevice); + return device; +} + +caspar::SharedIndex* AllocateIndices(const size_t problem_size) { + std::vector host(problem_size); + for (size_t i = 0; i < problem_size; i++) { + host[i] = static_cast(i % kNumNodes); + } + unsigned int* device_plain = nullptr; + cudaMalloc(&device_plain, problem_size * sizeof(unsigned int)); + cudaMemcpy(device_plain, host.data(), problem_size * sizeof(unsigned int), + cudaMemcpyHostToDevice); + + caspar::SharedIndex* device_shared = nullptr; + cudaMalloc(&device_shared, problem_size * sizeof(caspar::SharedIndex)); + caspar::SharedIndices(device_plain, device_shared, static_cast(problem_size)); + cudaDeviceSynchronize(); + cudaFree(device_plain); + return device_shared; +} + +bool HaveDevice() { + int count = 0; + return cudaGetDeviceCount(&count) == cudaSuccess && count > 0; +} + +float Score(const size_t problem_size) { + const size_t num_alloc = problem_size + 1024; + + // The inputs are read-only and filled identically, so one buffer serves for all of them. + float* data = AllocateFilled(num_alloc); + caspar::SharedIndex* indices = AllocateIndices(problem_size); + + float* out = nullptr; + cudaMalloc(&out, sizeof(float)); + cudaMemset(out, 0, sizeof(float)); + + const unsigned int num_alloc_arg = static_cast(num_alloc); + caspar::CasparPaddingLaneScore(data, num_alloc_arg, indices, data, num_alloc_arg, indices, data, + num_alloc_arg, indices, data, num_alloc_arg, out, problem_size); + + float score = nanf(""); + if (cudaDeviceSynchronize() == cudaSuccess) { + cudaMemcpy(&score, out, sizeof(float), cudaMemcpyDeviceToHost); + } + + cudaFree(data); + cudaFree(indices); + cudaFree(out); + return score; +} + +} // namespace + +// Sizes that aren't multiples of the 1024-thread block leave padding lanes. Without +// zero-initialized registers, clang drops SumStore's mask on them and the score is NaN; nvcc keeps +// it either way. +TEST_CASE("Score ignores the padding lanes of a partial block", "[caspar_padding_lane_cuda_test]") { + REQUIRE(HaveDevice()); + + for (const size_t problem_size : {1000, 1024, 1500, 2049, 5000}) { + CAPTURE(problem_size); + CHECK(std::isfinite(Score(problem_size))); + } +} diff --git a/test/symforce_caspar_codegen_test.py b/test/symforce_caspar_codegen_test.py new file mode 100644 index 00000000..d30c262f --- /dev/null +++ b/test/symforce_caspar_codegen_test.py @@ -0,0 +1,87 @@ +# ---------------------------------------------------------------------------- +# SymForce - Copyright 2025, Skydio, Inc. +# This source code is under the Apache 2.0 license found in the LICENSE file. +# ---------------------------------------------------------------------------- + +import symforce + +symforce.set_epsilon_to_number() + +import symforce.symbolic as sf +from symforce import path_util +from symforce import typing as T +from symforce.caspar import CasparLibrary +from symforce.caspar import memory as mem +from symforce.codegen.format_util import format_cpp +from symforce.test_util import TestCase +from symforce.test_util import symengine_only + +TEST_DATA_DIR = ( + path_util.symforce_data_root(__file__) + / "test" + / "symforce_function_codegen_test_data" + / symforce.get_symbolic_api() + / "symforce_caspar_codegen_test" +) + +KERNEL_FILENAMES = ( + "kernel_caspar_padding_lane_score.cu", + "kernel_caspar_padding_lane_score.h", +) + + +def _make_padding_lane_library() -> CasparLibrary: + """ + Shaped like the OpenCV reprojection factor from symforce-org/symforce#469, whose score kernel + LLVM miscompiles without zero-initialized registers. Simpler kernels don't reproduce it. + """ + caslib = CasparLibrary() + + @caslib.add_factor + def caspar_padding_lane( + cam_T_world: T.Annotated[sf.Pose3, mem.TunableShared], + point: T.Annotated[sf.V3, mem.TunableShared], + calibration: T.Annotated[sf.V8, mem.TunableShared], + pixel: T.Annotated[sf.V2, mem.ConstantSequential], + ) -> sf.V2: + fx, fy, cx, cy, k1, k2, p1, p2 = calibration + + point_cam = cam_T_world * point + xn = point_cam[0] / point_cam[2] + yn = point_cam[1] / point_cam[2] + + r2 = xn * xn + yn * yn + radial = 1 + k1 * r2 + k2 * r2 * r2 + x_d = xn * radial + 2 * p1 * xn * yn + p2 * (r2 + 2 * xn * xn) + y_d = yn * radial + p1 * (r2 + 2 * yn * yn) + 2 * p2 * xn * yn + + return sf.V2(fx * x_d + cx, fy * y_d + cy) - pixel + + return caslib + + +class SymforceCasparCodegenTest(TestCase): + """ + Tests the CUDA kernels generated by caspar. + """ + + @symengine_only + def test_generate_padding_lane_kernel(self) -> None: + """ + Keep the kernel caspar_padding_lane_cuda_test.cc runs up to date. + """ + output_dir = self.make_output_dir("sf_caspar_padding_lane_") + _make_padding_lane_library().generate(output_dir, python_bindings=False) + + kernel_dir = output_dir / "kernel" + kernel_dir.mkdir() + for name in KERNEL_FILENAMES: + # Format against the checked-in path, to pick up SymForce's clang-format config. + content = (output_dir / name).read_text() + (kernel_dir / name).write_text(format_cpp(content, str(TEST_DATA_DIR / name))) + + self.compare_or_update_directory(kernel_dir, TEST_DATA_DIR) + + +if __name__ == "__main__": + SymforceCasparCodegenTest.main() diff --git a/test/symforce_function_codegen_test_data/symengine/symforce_caspar_codegen_test/kernel_caspar_padding_lane_score.cu b/test/symforce_function_codegen_test_data/symengine/symforce_caspar_codegen_test/kernel_caspar_padding_lane_score.cu new file mode 100644 index 00000000..0869546f --- /dev/null +++ b/test/symforce_function_codegen_test_data/symengine/symforce_caspar_codegen_test/kernel_caspar_padding_lane_score.cu @@ -0,0 +1,164 @@ +#include +#include +#include +#include +#include + +#include "kernel_caspar_padding_lane_score.h" +#include "memops.cuh" + +namespace cg = cooperative_groups; + +namespace caspar { + +__global__ void __launch_bounds__(1024, 1) CasparPaddingLaneScoreKernel( + float* cam_T_world, unsigned int cam_T_world_num_alloc, SharedIndex* cam_T_world_indices, + float* point, unsigned int point_num_alloc, SharedIndex* point_indices, float* calibration, + unsigned int calibration_num_alloc, SharedIndex* calibration_indices, float* pixel, + unsigned int pixel_num_alloc, float* const out_rTr, size_t problem_size) { + const int global_thread_idx = blockIdx.x * blockDim.x + threadIdx.x; + __shared__ uint8_t inout_shared[16384]; + + __shared__ SharedIndex cam_T_world_indices_loc[1024]; + cam_T_world_indices_loc[threadIdx.x] = + (global_thread_idx < problem_size ? cam_T_world_indices[global_thread_idx] + : SharedIndex{0xffffffff, 0xffff, 0xffff}); + __shared__ SharedIndex point_indices_loc[1024]; + point_indices_loc[threadIdx.x] = + (global_thread_idx < problem_size ? point_indices[global_thread_idx] + : SharedIndex{0xffffffff, 0xffff, 0xffff}); + __shared__ SharedIndex calibration_indices_loc[1024]; + calibration_indices_loc[threadIdx.x] = + (global_thread_idx < problem_size ? calibration_indices[global_thread_idx] + : SharedIndex{0xffffffff, 0xffff, 0xffff}); + + __shared__ float out_rTr_local[1]; + + float r0 = 0, r1 = 0, r2 = 0, r3 = 0, r4 = 0, r5 = 0, r6 = 0, r7 = 0, r8 = 0, r9 = 0, r10 = 0, + r11 = 0, r12 = 0, r13 = 0, r14 = 0, r15 = 0, r16 = 0, r17 = 0, r18 = 0, r19 = 0, r20 = 0, + r21 = 0, r22 = 0, r23 = 0, r24 = 0, r25 = 0, r26 = 0, r27 = 0, r28 = 0; + LoadShared<4, float, float>(calibration, 0 * calibration_num_alloc, calibration_indices_loc, + (float*)inout_shared); + if (global_thread_idx < problem_size) { + ReadShared4((float*)inout_shared, calibration_indices_loc[threadIdx.x].target, r0, r1, + r2, r3); + }; + __syncthreads(); + LoadShared<4, float, float>(calibration, 4 * calibration_num_alloc, calibration_indices_loc, + (float*)inout_shared); + if (global_thread_idx < problem_size) { + ReadShared4((float*)inout_shared, calibration_indices_loc[threadIdx.x].target, r4, r5, + r6, r7); + }; + __syncthreads(); + LoadShared<3, float, float>(cam_T_world, 4 * cam_T_world_num_alloc, cam_T_world_indices_loc, + (float*)inout_shared); + if (global_thread_idx < problem_size) { + ReadShared3((float*)inout_shared, cam_T_world_indices_loc[threadIdx.x].target, r8, r9, + r10); + }; + __syncthreads(); + LoadShared<3, float, float>(point, 0 * point_num_alloc, point_indices_loc, (float*)inout_shared); + if (global_thread_idx < problem_size) { + ReadShared3((float*)inout_shared, point_indices_loc[threadIdx.x].target, r11, r12, r13); + }; + __syncthreads(); + LoadShared<4, float, float>(cam_T_world, 0 * cam_T_world_num_alloc, cam_T_world_indices_loc, + (float*)inout_shared); + if (global_thread_idx < problem_size) { + ReadShared4((float*)inout_shared, cam_T_world_indices_loc[threadIdx.x].target, r14, r15, + r16, r17); + }; + __syncthreads(); + if (global_thread_idx < problem_size) { + r18 = r14 * r14; + r19 = -2.00000000000000000e+00; + r18 = r18 * r19; + r20 = 1.00000000000000000e+00; + r21 = r15 * r15; + r21 = fmaf(r19, r21, r20); + r22 = r18 + r21; + r22 = fmaf(r13, r22, r10); + r10 = 2.00000000000000000e+00; + r23 = r14 * r10; + r24 = r16 * r23; + r25 = r17 * r19; + r26 = fmaf(r15, r25, r24); + r27 = r15 * r16; + r27 = r27 * r10; + r28 = fmaf(r17, r23, r27); + r22 = fmaf(r11, r26, r22); + r22 = fmaf(r12, r28, r22); + r28 = r22 * r22; + r28 = 1.0 / r28; + r18 = r20 + r18; + r26 = r16 * r16; + r26 = r19 * r26; + r18 = r18 + r26; + r18 = fmaf(r12, r18, r9); + r9 = r16 * r17; + r23 = r15 * r23; + r9 = fmaf(r10, r9, r23); + r14 = fmaf(r14, r25, r27); + r18 = fmaf(r11, r9, r18); + r18 = fmaf(r13, r14, r18); + r14 = r18 * r18; + r14 = r28 * r14; + r9 = 3.00000000000000000e+00; + r21 = r26 + r21; + r21 = fmaf(r11, r21, r8); + r25 = fmaf(r16, r25, r23); + r23 = r15 * r17; + r23 = fmaf(r10, r23, r24); + r21 = fmaf(r12, r25, r21); + r21 = fmaf(r13, r23, r21); + r23 = r21 * r21; + r23 = r28 * r23; + r13 = fmaf(r9, r23, r14); + r25 = r14 + r23; + r4 = fmaf(r4, r25, r20); + r25 = r25 * r25; + r4 = fmaf(r5, r25, r4); + r22 = 1.0 / r22; + r22 = r4 * r22; + r13 = fmaf(r21, r22, r7 * r13); + r4 = r6 * r10; + r28 = r18 * r28; + r4 = r4 * r21; + r13 = fmaf(r28, r4, r13); + r13 = fmaf(r0, r13, r2); + ReadIdx2<1024, float, float, float2>(pixel, 0 * pixel_num_alloc, global_thread_idx, r0, r2); + r4 = -1.00000000000000000e+00; + r13 = fmaf(r0, r4, r13); + r14 = fmaf(r9, r14, r23); + r22 = fmaf(r18, r22, r6 * r14); + r18 = r7 * r10; + r18 = r18 * r21; + r22 = fmaf(r28, r18, r22); + r22 = fmaf(r1, r22, r3); + r22 = fmaf(r2, r4, r22); + r22 = fmaf(r22, r22, r13 * r13); + }; + SumStore(out_rTr_local, (float*)inout_shared, 0, global_thread_idx < problem_size, r22); + SumFlushFinal(out_rTr_local, out_rTr, 1); +} + +void CasparPaddingLaneScore(float* cam_T_world, unsigned int cam_T_world_num_alloc, + SharedIndex* cam_T_world_indices, float* point, + unsigned int point_num_alloc, SharedIndex* point_indices, + float* calibration, unsigned int calibration_num_alloc, + SharedIndex* calibration_indices, float* pixel, + unsigned int pixel_num_alloc, float* const out_rTr, + size_t problem_size) { + if (problem_size == 0) { + return; + } + + const int n_blocks = (problem_size + 1024 - 1) / 1024; + CasparPaddingLaneScoreKernel<<>>( + cam_T_world, cam_T_world_num_alloc, cam_T_world_indices, point, point_num_alloc, + point_indices, calibration, calibration_num_alloc, calibration_indices, pixel, + pixel_num_alloc, out_rTr, problem_size); +} + +} // namespace caspar \ No newline at end of file diff --git a/test/symforce_function_codegen_test_data/symengine/symforce_caspar_codegen_test/kernel_caspar_padding_lane_score.h b/test/symforce_function_codegen_test_data/symengine/symforce_caspar_codegen_test/kernel_caspar_padding_lane_score.h new file mode 100644 index 00000000..a78f744a --- /dev/null +++ b/test/symforce_function_codegen_test_data/symengine/symforce_caspar_codegen_test/kernel_caspar_padding_lane_score.h @@ -0,0 +1,17 @@ +#pragma once + +#include + +#include "shared_indices.h" + +namespace caspar { + +void CasparPaddingLaneScore(float* cam_T_world, unsigned int cam_T_world_num_alloc, + SharedIndex* cam_T_world_indices, float* point, + unsigned int point_num_alloc, SharedIndex* point_indices, + float* calibration, unsigned int calibration_num_alloc, + SharedIndex* calibration_indices, float* pixel, + unsigned int pixel_num_alloc, float* const out_rTr, + size_t problem_size); + +} // namespace caspar \ No newline at end of file From 475065dacf13c3ebe5ff2f8b0dc251d177a51ac3 Mon Sep 17 00:00:00 2001 From: Aaron Date: Fri, 25 Sep 2026 23:13:05 +0000 Subject: [PATCH 28/68] [Caspar] Stop generating unreferenced variables Generated solvers and kernels were declaring unused variables, which trips nvcc's "declared but never referenced" and "set but never used" diagnostics under warnings-as-errors. `DoNormalize` and `DoAlphaFirst` declared dead pointer locals, now dropped. A kernel whose body comes out empty still emitted its thread index, shared scratch, and accessor index setup; those are now emitted only when there is a body. No kernel computes anything different. Assisted-by: Claude:claude-opus-5 Signed-off-by: Aaron Miller GitOrigin-RevId: 91611ee3c284b3545711afe226fe638ce5b6f72f --- symforce/caspar/source/templates/kernel.cu.jinja | 4 ++++ symforce/caspar/source/templates/solver.cc.jinja | 3 --- 2 files changed, 4 insertions(+), 3 deletions(-) diff --git a/symforce/caspar/source/templates/kernel.cu.jinja b/symforce/caspar/source/templates/kernel.cu.jinja index 8da744a3..6bcd9b90 100644 --- a/symforce/caspar/source/templates/kernel.cu.jinja +++ b/symforce/caspar/source/templates/kernel.cu.jinja @@ -24,15 +24,19 @@ __launch_bounds__({{kernel.block_size}}, 1) {% endfor %} {% endfor %} size_t problem_size) { + {% if kernel.code_lines %} const int global_thread_idx = blockIdx.x * blockDim.x + threadIdx.x; {% if kernel.shared_size_req > 0 %} __shared__ uint8_t inout_shared[{{kernel.shared_size_req}}]; {% endif %} + {% endif %} {% for accessor in kernel.accessors %} + {% if kernel.code_lines %} {% filter indent(width=4) %} {{accessor.prep_lines}} {% endfilter %} + {% endif %} {% if accessor.pre_calc_code() %} {{accessor.pre_calc_code()}} {% endif %} diff --git a/symforce/caspar/source/templates/solver.cc.jinja b/symforce/caspar/source/templates/solver.cc.jinja index 4379d6e8..baa935ba 100644 --- a/symforce/caspar/source/templates/solver.cc.jinja +++ b/symforce/caspar/source/templates/solver.cc.jinja @@ -343,7 +343,6 @@ SolveResult {{ solver.struct_name }}::solve(bool print_progress, bool verbose_lo {%endfor%} void {{ solver.struct_name }}::DoNormalize() { - {{solver.linear_t}}* r_k; {{solver.linear_t}}* z; {% for nodetype in solver.node_types%} z = pcg_iter_ == 0 ? {{node_key(nodetype, "p")}} : {{node_key(nodetype, "z")}}; @@ -459,8 +458,6 @@ void {{ solver.struct_name }}::DoJtjpDirect() { void {{ solver.struct_name }}::DoAlphaFirst() { Zero({{solver_key("alpha_numerator")}}, {{solver_key("alpha_denominator")}}+1); - {{solver.linear_t}}* p_kp1; - {{solver.linear_t}}* r_k; {% for nodetype in solver.node_types %} {{nodetype.__name__}}AlphaNumeratorDenominator( {{node_key(nodetype, "p")}}, {{num_key(nodetype)}}, From eb3d04a7877758b5d43977ecfe8e6bf870fad91f Mon Sep 17 00:00:00 2001 From: Aaron Date: Fri, 25 Sep 2026 23:13:20 +0000 Subject: [PATCH 29/68] [Caspar] Fix three defects in the solver loop Fixes symforce-org/symforce#468 Three defects in the solve loop: - The last iteration skipped `DoResJac` but still took a step, so it stepped from the previous iterate's linearization. It now re-linearizes like every other iteration. - `IterationData::step_accepted` was never set true. - With `pcg_rel_decrease_min` or `pcg_rel_score_exit` set, the inner loop can break before storing a proposal, and with `solver_rel_decrease_min > 1` the stale `score_best_pcg` passed the accept test, so the solver returned a buffer nothing had written while reporting the previous score. Iterations with no proposal are now rejected. `pcg_iter_max < 1`, which never writes `step_`, is rejected in the constructor. `caspar_solver_cuda_test` runs a checked-in generated solver on a bank of Rosenbrock problems, with a case for basic convergence and one for each defect. Ran the new test, and confirmed each defect's case fails with the fix reverted. Assisted-by: Claude:claude-opus-5 Signed-off-by: Aaron Miller GitOrigin-RevId: 5ba7c8faa888b127ea0e49d155b782d7e697993f --- .../caspar/source/templates/solver.cc.jinja | 12 +- test/CMakeLists.txt | 31 + test/caspar_solver_cuda_test.cc | 133 +++++ test/symforce_caspar_codegen_test.py | 51 ++ .../caspar_mappings.cu | 87 +++ .../caspar_mappings.h | 15 + ...x21_alpha_denominator_or_beta_numerator.cu | 50 ++ ...ix21_alpha_denominator_or_beta_numerator.h | 14 + ...el_Matrix21_alpha_numerator_denominator.cu | 63 ++ ...nel_Matrix21_alpha_numerator_denominator.h | 16 + .../kernel_Matrix21_normalize.cu | 73 +++ .../kernel_Matrix21_normalize.h | 15 + ...kernel_Matrix21_pred_decrease_times_two.cu | 70 +++ .../kernel_Matrix21_pred_decrease_times_two.h | 16 + .../kernel_Matrix21_retract.cu | 46 ++ .../kernel_Matrix21_retract.h | 13 + .../kernel_Matrix21_start_w.cu | 60 ++ .../kernel_Matrix21_start_w.h | 14 + .../kernel_Matrix21_start_w_contribute.cu | 61 ++ .../kernel_Matrix21_start_w_contribute.h | 15 + .../kernel_Matrix21_update_Mp.cu | 62 ++ .../kernel_Matrix21_update_Mp.h | 15 + .../kernel_Matrix21_update_p.cu | 57 ++ .../kernel_Matrix21_update_p.h | 14 + .../kernel_Matrix21_update_r.cu | 64 ++ .../kernel_Matrix21_update_r.h | 14 + .../kernel_Matrix21_update_r_first.cu | 76 +++ .../kernel_Matrix21_update_r_first.h | 16 + .../kernel_Matrix21_update_step.cu | 57 ++ .../kernel_Matrix21_update_step.h | 14 + .../kernel_Matrix21_update_step_first.cu | 54 ++ .../kernel_Matrix21_update_step_first.h | 13 + .../kernel_rosenbrock_jtjnjtr_direct.cu | 34 ++ .../kernel_rosenbrock_jtjnjtr_direct.h | 14 + .../kernel_rosenbrock_res_jac.cu | 91 +++ .../kernel_rosenbrock_res_jac.h | 15 + .../kernel_rosenbrock_res_jac_first.cu | 101 ++++ .../kernel_rosenbrock_res_jac_first.h | 17 + .../kernel_rosenbrock_score.cu | 60 ++ .../kernel_rosenbrock_score.h | 12 + .../symforce_caspar_solver_test/solver.cc | 560 ++++++++++++++++++ .../symforce_caspar_solver_test/solver.h | 223 +++++++ 42 files changed, 2436 insertions(+), 2 deletions(-) create mode 100644 test/caspar_solver_cuda_test.cc create mode 100644 test/symforce_function_codegen_test_data/symengine/symforce_caspar_solver_test/caspar_mappings.cu create mode 100644 test/symforce_function_codegen_test_data/symengine/symforce_caspar_solver_test/caspar_mappings.h create mode 100644 test/symforce_function_codegen_test_data/symengine/symforce_caspar_solver_test/kernel_Matrix21_alpha_denominator_or_beta_numerator.cu create mode 100644 test/symforce_function_codegen_test_data/symengine/symforce_caspar_solver_test/kernel_Matrix21_alpha_denominator_or_beta_numerator.h create mode 100644 test/symforce_function_codegen_test_data/symengine/symforce_caspar_solver_test/kernel_Matrix21_alpha_numerator_denominator.cu create mode 100644 test/symforce_function_codegen_test_data/symengine/symforce_caspar_solver_test/kernel_Matrix21_alpha_numerator_denominator.h create mode 100644 test/symforce_function_codegen_test_data/symengine/symforce_caspar_solver_test/kernel_Matrix21_normalize.cu create mode 100644 test/symforce_function_codegen_test_data/symengine/symforce_caspar_solver_test/kernel_Matrix21_normalize.h create mode 100644 test/symforce_function_codegen_test_data/symengine/symforce_caspar_solver_test/kernel_Matrix21_pred_decrease_times_two.cu create mode 100644 test/symforce_function_codegen_test_data/symengine/symforce_caspar_solver_test/kernel_Matrix21_pred_decrease_times_two.h create mode 100644 test/symforce_function_codegen_test_data/symengine/symforce_caspar_solver_test/kernel_Matrix21_retract.cu create mode 100644 test/symforce_function_codegen_test_data/symengine/symforce_caspar_solver_test/kernel_Matrix21_retract.h create mode 100644 test/symforce_function_codegen_test_data/symengine/symforce_caspar_solver_test/kernel_Matrix21_start_w.cu create mode 100644 test/symforce_function_codegen_test_data/symengine/symforce_caspar_solver_test/kernel_Matrix21_start_w.h create mode 100644 test/symforce_function_codegen_test_data/symengine/symforce_caspar_solver_test/kernel_Matrix21_start_w_contribute.cu create mode 100644 test/symforce_function_codegen_test_data/symengine/symforce_caspar_solver_test/kernel_Matrix21_start_w_contribute.h create mode 100644 test/symforce_function_codegen_test_data/symengine/symforce_caspar_solver_test/kernel_Matrix21_update_Mp.cu create mode 100644 test/symforce_function_codegen_test_data/symengine/symforce_caspar_solver_test/kernel_Matrix21_update_Mp.h create mode 100644 test/symforce_function_codegen_test_data/symengine/symforce_caspar_solver_test/kernel_Matrix21_update_p.cu create mode 100644 test/symforce_function_codegen_test_data/symengine/symforce_caspar_solver_test/kernel_Matrix21_update_p.h create mode 100644 test/symforce_function_codegen_test_data/symengine/symforce_caspar_solver_test/kernel_Matrix21_update_r.cu create mode 100644 test/symforce_function_codegen_test_data/symengine/symforce_caspar_solver_test/kernel_Matrix21_update_r.h create mode 100644 test/symforce_function_codegen_test_data/symengine/symforce_caspar_solver_test/kernel_Matrix21_update_r_first.cu create mode 100644 test/symforce_function_codegen_test_data/symengine/symforce_caspar_solver_test/kernel_Matrix21_update_r_first.h create mode 100644 test/symforce_function_codegen_test_data/symengine/symforce_caspar_solver_test/kernel_Matrix21_update_step.cu create mode 100644 test/symforce_function_codegen_test_data/symengine/symforce_caspar_solver_test/kernel_Matrix21_update_step.h create mode 100644 test/symforce_function_codegen_test_data/symengine/symforce_caspar_solver_test/kernel_Matrix21_update_step_first.cu create mode 100644 test/symforce_function_codegen_test_data/symengine/symforce_caspar_solver_test/kernel_Matrix21_update_step_first.h create mode 100644 test/symforce_function_codegen_test_data/symengine/symforce_caspar_solver_test/kernel_rosenbrock_jtjnjtr_direct.cu create mode 100644 test/symforce_function_codegen_test_data/symengine/symforce_caspar_solver_test/kernel_rosenbrock_jtjnjtr_direct.h create mode 100644 test/symforce_function_codegen_test_data/symengine/symforce_caspar_solver_test/kernel_rosenbrock_res_jac.cu create mode 100644 test/symforce_function_codegen_test_data/symengine/symforce_caspar_solver_test/kernel_rosenbrock_res_jac.h create mode 100644 test/symforce_function_codegen_test_data/symengine/symforce_caspar_solver_test/kernel_rosenbrock_res_jac_first.cu create mode 100644 test/symforce_function_codegen_test_data/symengine/symforce_caspar_solver_test/kernel_rosenbrock_res_jac_first.h create mode 100644 test/symforce_function_codegen_test_data/symengine/symforce_caspar_solver_test/kernel_rosenbrock_score.cu create mode 100644 test/symforce_function_codegen_test_data/symengine/symforce_caspar_solver_test/kernel_rosenbrock_score.h create mode 100644 test/symforce_function_codegen_test_data/symengine/symforce_caspar_solver_test/solver.cc create mode 100644 test/symforce_function_codegen_test_data/symengine/symforce_caspar_solver_test/solver.h diff --git a/symforce/caspar/source/templates/solver.cc.jinja b/symforce/caspar/source/templates/solver.cc.jinja index baa935ba..dd02e567 100644 --- a/symforce/caspar/source/templates/solver.cc.jinja +++ b/symforce/caspar/source/templates/solver.cc.jinja @@ -86,6 +86,9 @@ namespace caspar { if (params.diag_init < 0.0f){ throw std::runtime_error("params.diag_init must be positive"); } + if (params.pcg_iter_max < 1){ + throw std::runtime_error("params.pcg_iter_max must be at least 1"); + } allocation_size_ = get_nbytes(); if (device_id_ < 0) { @@ -147,10 +150,12 @@ SolveResult {{ solver.struct_name }}::solve(bool print_progress, bool verbose_lo } for (solver_iter_ = 0; solver_iter_ < params_.solver_iter_max; solver_iter_++) { - if (solver_iter_ != 0 && solver_iter_ < params_.solver_iter_max - 1){ + if (solver_iter_ != 0){ DoResJac(); } score_best_pcg = score_best; + // The inner loop can break before storing a proposal in storage_new_best_. + bool have_pcg_proposal = false; for (pcg_iter_ = 0; pcg_iter_ < params_.pcg_iter_max; pcg_iter_++){ DoNormalize(); @@ -179,6 +184,7 @@ SolveResult {{ solver.struct_name }}::solve(bool print_progress, bool verbose_lo {{node_key(node_type, "storage_new_best")}}); {% endfor %} score_best_pcg = score_new_pcg; + have_pcg_proposal = true; if (params_.pcg_rel_score_exit != -1.0f &&score_best_pcg < score_best * params_.pcg_rel_score_exit){ break; @@ -196,11 +202,12 @@ SolveResult {{ solver.struct_name }}::solve(bool print_progress, bool verbose_lo std::swap({{node_key(node_type, "storage_check")}}, {{node_key(node_type, "storage_new_best")}}); {% endfor %} + have_pcg_proposal = true; } const {{solver.linear_t}} diag_current = diag; bool step_accepted = false; - if (score_best_pcg < score_best * params_.solver_rel_decrease_min) { + if (have_pcg_proposal && score_best_pcg < score_best * params_.solver_rel_decrease_min) { quality = (score_best - score_best_pcg) / GetPredDecrease(); const {{solver.linear_t}} quality_tmp = 2 * quality - 1; {{solver.linear_t}} scale = @@ -209,6 +216,7 @@ SolveResult {{ solver.struct_name }}::solve(bool print_progress, bool verbose_lo cudaMemcpy({{solver_key("current_diag")}}, &diag, sizeof({{solver.linear_t}}), cudaMemcpyHostToDevice); up_scale = params_.diag_scaling_up; score_best = score_best_pcg; + step_accepted = true; {% for node_type in solver.node_types %} std::swap({{node_key(node_type, "storage_current")}}, {{node_key(node_type, "storage_new_best")}}); diff --git a/test/CMakeLists.txt b/test/CMakeLists.txt index 702be381..0e124651 100644 --- a/test/CMakeLists.txt +++ b/test/CMakeLists.txt @@ -109,6 +109,37 @@ if(CMAKE_CUDA_COMPILER) list(APPEND SYMFORCE_CC_TEST_TARGETS bin.tests.caspar_padding_lane_cuda_test) add_test(caspar_padding_lane_cuda_test ${CMAKE_BINARY_DIR}/bin/tests/caspar_padding_lane_cuda_test) + + set(CASPAR_SOLVER_DIR + ${CMAKE_CURRENT_SOURCE_DIR}/symforce_function_codegen_test_data/symengine/symforce_caspar_solver_test + ) + file(GLOB CASPAR_SOLVER_SOURCES CONFIGURE_DEPENDS + ${CASPAR_SOLVER_DIR}/*.cu + ${CASPAR_SOLVER_DIR}/*.cc + ) + + add_executable( + bin.tests.caspar_solver_cuda_test + caspar_solver_cuda_test.cc + ${CASPAR_SOLVER_SOURCES} + ${CASPAR_RUNTIME_DIR}/shared_indices.cu + ${CASPAR_RUNTIME_DIR}/sort_indices.cu + ${CASPAR_RUNTIME_DIR}/solver_tools.cu + ) + set_target_properties(bin.tests.caspar_solver_cuda_test PROPERTIES + CUDA_ARCHITECTURES 75 + OUTPUT_NAME tests/caspar_solver_cuda_test + TEST_NAME caspar_solver_cuda_test + RUNTIME_OUTPUT_DIRECTORY ${CMAKE_BINARY_DIR}/bin + ) + target_include_directories(bin.tests.caspar_solver_cuda_test PRIVATE + ${CASPAR_SOLVER_DIR} + ${CASPAR_RUNTIME_DIR} + ) + target_link_libraries(bin.tests.caspar_solver_cuda_test Catch2::Catch2WithMain CUDA::cudart) + + list(APPEND SYMFORCE_CC_TEST_TARGETS bin.tests.caspar_solver_cuda_test) + add_test(caspar_solver_cuda_test ${CMAKE_BINARY_DIR}/bin/tests/caspar_solver_cuda_test) endif() if(SYMFORCE_ADD_PYTHON_TESTS) diff --git a/test/caspar_solver_cuda_test.cc b/test/caspar_solver_cuda_test.cc new file mode 100644 index 00000000..bce016fe --- /dev/null +++ b/test/caspar_solver_cuda_test.cc @@ -0,0 +1,133 @@ +/* ---------------------------------------------------------------------------- + * SymForce - Copyright 2025, Skydio, Inc. + * This source code is under the Apache 2.0 license found in the LICENSE file. + * ---------------------------------------------------------------------------- */ + +#include +#include +#include + +#include +#include +#include + +#include "solver.h" + +namespace { + +constexpr size_t kNumNodes = 4096; + +bool HaveDevice() { + int count = 0; + return cudaGetDeviceCount(&count) == cudaSuccess && count > 0; +} + +struct Solve { + caspar::SolveResult result; + std::vector x; +}; + +// Independent Rosenbrock problems, all started at (-1.2, 1). +Solve Run(const caspar::SolverParams& params) { + caspar::GraphSolver solver(params, kNumNodes, kNumNodes); + + std::vector indices(kNumNodes); + std::vector x(2 * kNumNodes); + for (size_t i = 0; i < kNumNodes; i++) { + indices[i] = static_cast(i); + x[2 * i + 0] = -1.2; + x[2 * i + 1] = 1.0; + } + + solver.SetRosenbrockXIndicesFromHost(indices.data(), kNumNodes); + solver.SetMatrix21NodesFromStackedHost(x.data(), 0, kNumNodes); + solver.finish_indices(); + + Solve solve; + solve.result = solver.solve(/* print_progress */ false, /* verbose_logging */ true); + solve.x.resize(2 * kNumNodes); + solver.GetMatrix21NodesToStackedHost(solve.x.data(), 0, kNumNodes); + return solve; +} + +// Half the sum of squared residuals, which is what the solver reports. +double ScoreOf(const std::vector& x) { + double score = 0.0; + for (size_t i = 0; i < kNumNodes; i++) { + const double r0 = 10.0 * (x[2 * i + 1] - x[2 * i + 0] * x[2 * i + 0]); + const double r1 = 1.0 - x[2 * i + 0]; + score += r0 * r0 + r1 * r1; + } + return 0.5 * score; +} + +caspar::SolverParams ParamsWithIterations(const int solver_iter_max) { + caspar::SolverParams params; + params.solver_iter_max = solver_iter_max; + return params; +} + +} // namespace + +TEST_CASE("Solver drives a bank of Rosenbrock problems toward the optimum", + "[caspar_solver_cuda_test]") { + REQUIRE(HaveDevice()); + + const Solve solve = Run(ParamsWithIterations(50)); + + CHECK(std::isfinite(solve.result.final_score)); + CHECK(solve.result.final_score < solve.result.initial_score); + CHECK(solve.x[0] > -1.2); + CHECK(ScoreOf(solve.x) == Catch::Approx(solve.result.final_score).epsilon(1e-9)); +} + +TEST_CASE("The last iteration makes progress", "[caspar_solver_cuda_test]") { + REQUIRE(HaveDevice()); + + const Solve one = Run(ParamsWithIterations(1)); + const Solve two = Run(ParamsWithIterations(2)); + + CHECK(std::isfinite(two.result.final_score)); + CHECK(two.result.final_score < one.result.final_score); +} + +TEST_CASE("step_accepted marks exactly the iterations that moved the score", + "[caspar_solver_cuda_test]") { + REQUIRE(HaveDevice()); + + const Solve solve = Run(ParamsWithIterations(8)); + REQUIRE(solve.result.iterations.size() > 1); + + int accepted = 0; + double previous_best = solve.result.initial_score; + for (const caspar::IterationData& iteration : solve.result.iterations) { + CAPTURE(iteration.solver_iter, iteration.score_best, previous_best); + CHECK(iteration.step_accepted == (iteration.score_best < previous_best)); + accepted += iteration.step_accepted; + previous_best = iteration.score_best; + } + CHECK(accepted > 0); +} + +TEST_CASE("A solve that accepts non-monotonically still returns what it reports", + "[caspar_solver_cuda_test]") { + REQUIRE(HaveDevice()); + + caspar::SolverParams params = ParamsWithIterations(8); + params.pcg_rel_decrease_min = 0.5; + params.solver_rel_decrease_min = 1.5; + + const Solve solve = Run(params); + + CHECK(std::isfinite(solve.result.final_score)); + CHECK(ScoreOf(solve.x) == Catch::Approx(solve.result.final_score).epsilon(1e-9)); +} + +TEST_CASE("A solver with no inner iterations is rejected", "[caspar_solver_cuda_test]") { + REQUIRE(HaveDevice()); + + caspar::SolverParams params = ParamsWithIterations(8); + params.pcg_iter_max = 0; + + CHECK_THROWS(caspar::GraphSolver(params, kNumNodes, kNumNodes)); +} diff --git a/test/symforce_caspar_codegen_test.py b/test/symforce_caspar_codegen_test.py index d30c262f..123bb3aa 100644 --- a/test/symforce_caspar_codegen_test.py +++ b/test/symforce_caspar_codegen_test.py @@ -7,11 +7,15 @@ symforce.set_epsilon_to_number() +from pathlib import Path + import symforce.symbolic as sf +from symforce import caspar from symforce import path_util from symforce import typing as T from symforce.caspar import CasparLibrary from symforce.caspar import memory as mem +from symforce.caspar.memory import DType from symforce.codegen.format_util import format_cpp from symforce.test_util import TestCase from symforce.test_util import symengine_only @@ -24,6 +28,14 @@ / "symforce_caspar_codegen_test" ) +SOLVER_TEST_DATA_DIR = ( + path_util.symforce_data_root(__file__) + / "test" + / "symforce_function_codegen_test_data" + / symforce.get_symbolic_api() + / "symforce_caspar_solver_test" +) + KERNEL_FILENAMES = ( "kernel_caspar_padding_lane_score.cu", "kernel_caspar_padding_lane_score.h", @@ -60,6 +72,21 @@ def caspar_padding_lane( return caslib +def _make_solver_library() -> CasparLibrary: + """ + Rosenbrock converges slowly, so a solve is still progressing after a few iterations. + """ + caslib = CasparLibrary(dtype=DType.DOUBLE) + + @caslib.add_factor + def rosenbrock( + x: T.Annotated[sf.V2, mem.TunableShared], + ) -> sf.V2: + return sf.V2(10 * (x[1] - x[0] * x[0]), 1 - x[0]) + + return caslib + + class SymforceCasparCodegenTest(TestCase): """ Tests the CUDA kernels generated by caspar. @@ -82,6 +109,30 @@ def test_generate_padding_lane_kernel(self) -> None: self.compare_or_update_directory(kernel_dir, TEST_DATA_DIR) + @symengine_only + def test_generate_solver(self) -> None: + """ + Keep the solver caspar_solver_cuda_test.cc runs up to date. + """ + output_dir = self.make_output_dir("sf_caspar_solver_") + _make_solver_library().generate(output_dir, python_bindings=False) + + # The runtime is compiled from its own directory; check in only what was generated. + runtime_dir = Path(caspar.__file__).parent / "source" / "runtime" + generated_dir = output_dir / "generated" + generated_dir.mkdir() + for path in sorted(output_dir.glob("*")): + if ( + path.suffix not in {".cu", ".cc", ".h", ".cuh"} + or (runtime_dir / path.name).exists() + ): + continue + (generated_dir / path.name).write_text( + format_cpp(path.read_text(), str(SOLVER_TEST_DATA_DIR / path.name)) + ) + + self.compare_or_update_directory(generated_dir, SOLVER_TEST_DATA_DIR) + if __name__ == "__main__": SymforceCasparCodegenTest.main() diff --git a/test/symforce_function_codegen_test_data/symengine/symforce_caspar_solver_test/caspar_mappings.cu b/test/symforce_function_codegen_test_data/symengine/symforce_caspar_solver_test/caspar_mappings.cu new file mode 100644 index 00000000..7edd0f2b --- /dev/null +++ b/test/symforce_function_codegen_test_data/symengine/symforce_caspar_solver_test/caspar_mappings.cu @@ -0,0 +1,87 @@ +#include + +#include +#include + +#include "caspar_mappings.h" + +namespace cg = cooperative_groups; + +// We use shared memory to improve the memory access. +// A smaller block size of 32 allows for larger nodetypes. +constexpr int block_size = 32; + +namespace caspar { + +__global__ __launch_bounds__(block_size, 1) void Matrix21StackedToCaspar_kernel( + const double* const __restrict__ stacked_data, double* const __restrict__ cas_data, + const unsigned int cas_stride, const unsigned int cas_offset, const unsigned int num_objects) { + const unsigned int global_thread_idx = blockIdx.x * blockDim.x + threadIdx.x; + __shared__ double stacked_data_local[block_size * 2]; + + for (unsigned int target = (blockIdx.x * blockDim.x) * 2 + threadIdx.x; + target < min(num_objects, (blockIdx.x + 1) * blockDim.x) * 2; target += blockDim.x) { + stacked_data_local[target - (blockIdx.x * blockDim.x) * 2] = stacked_data[target]; + } + + __syncthreads(); + + if (global_thread_idx < num_objects) { + double data[4] = {0, 0, 0, 0}; + double* stacked_local_ptr = stacked_data_local + threadIdx.x * 2; + double* out_ptr; + data[0] = stacked_local_ptr[0]; + data[1] = stacked_local_ptr[1]; + + out_ptr = cas_data + 2 * (global_thread_idx + cas_offset) + 0 * cas_stride; + reinterpret_cast(out_ptr)[0] = reinterpret_cast(data)[0]; + } +} + +__global__ __launch_bounds__(block_size, 1) void Matrix21CasparToStacked_kernel( + const double* const __restrict__ cas_data, double* const __restrict__ stacked_data, + const unsigned int cas_stride, const unsigned int cas_offset, const unsigned int num_objects) { + const unsigned int global_thread_idx = blockIdx.x * blockDim.x + threadIdx.x; + __shared__ double stacked_data_local[block_size * 2]; + + if (global_thread_idx < num_objects) { + double data[4] = {0, 0, 0, 0}; + double* stacked_local_ptr = stacked_data_local + threadIdx.x * 2; + const double* in_ptr; + in_ptr = cas_data + 2 * (global_thread_idx + cas_offset) + 0 * cas_stride; + reinterpret_cast(data)[0] = reinterpret_cast(in_ptr)[0]; + stacked_local_ptr[0] = data[0]; + stacked_local_ptr[1] = data[1]; + } + + __syncthreads(); + + for (unsigned int target = (blockIdx.x * blockDim.x) * 2 + threadIdx.x; + target < min(num_objects, (blockIdx.x + 1) * blockDim.x) * 2; target += blockDim.x) { + stacked_data[target] = stacked_data_local[target - (blockIdx.x * blockDim.x) * 2]; + } +} + +cudaError_t Matrix21StackedToCaspar(const double* stacked_data, double* cas_data, + const unsigned int cas_stride, const unsigned int cas_offset, + const unsigned int num_objects) { + const int num_blocks = (num_objects + block_size - 1) / block_size; + + Matrix21StackedToCaspar_kernel<<>>(stacked_data, cas_data, cas_stride, + cas_offset, num_objects); + + return cudaGetLastError(); +} + +cudaError_t Matrix21CasparToStacked(const double* cas_data, double* stacked_data, + const unsigned int cas_stride, const unsigned int cas_offset, + const unsigned int num_objects) { + const int num_blocks = (num_objects + block_size - 1) / block_size; + + Matrix21CasparToStacked_kernel<<>>(cas_data, stacked_data, cas_stride, + cas_offset, num_objects); + + return cudaGetLastError(); +} + +} // namespace caspar \ No newline at end of file diff --git a/test/symforce_function_codegen_test_data/symengine/symforce_caspar_solver_test/caspar_mappings.h b/test/symforce_function_codegen_test_data/symengine/symforce_caspar_solver_test/caspar_mappings.h new file mode 100644 index 00000000..4b4c2719 --- /dev/null +++ b/test/symforce_function_codegen_test_data/symengine/symforce_caspar_solver_test/caspar_mappings.h @@ -0,0 +1,15 @@ +#pragma once + +#include + +namespace caspar { + +cudaError_t Matrix21StackedToCaspar(const double* stacked_data, double* cas_data, + const unsigned int cas_stride, const unsigned int cas_offset, + const unsigned int num_objects); + +cudaError_t Matrix21CasparToStacked(const double* cas_data, double* stacked_data, + const unsigned int cas_stride, const unsigned int cas_offset, + const unsigned int num_objects); + +} // namespace caspar \ No newline at end of file diff --git a/test/symforce_function_codegen_test_data/symengine/symforce_caspar_solver_test/kernel_Matrix21_alpha_denominator_or_beta_numerator.cu b/test/symforce_function_codegen_test_data/symengine/symforce_caspar_solver_test/kernel_Matrix21_alpha_denominator_or_beta_numerator.cu new file mode 100644 index 00000000..a5c9f980 --- /dev/null +++ b/test/symforce_function_codegen_test_data/symengine/symforce_caspar_solver_test/kernel_Matrix21_alpha_denominator_or_beta_numerator.cu @@ -0,0 +1,50 @@ +#include +#include +#include +#include +#include + +#include "kernel_Matrix21_alpha_denominator_or_beta_numerator.h" +#include "memops.cuh" + +namespace cg = cooperative_groups; + +namespace caspar { + +__global__ void __launch_bounds__(1024, 1) Matrix21AlphaDenominatorOrBetaNumeratorKernel( + double* Matrix21_p_kp1, unsigned int Matrix21_p_kp1_num_alloc, double* Matrix21_w, + unsigned int Matrix21_w_num_alloc, double* const Matrix21_out, size_t problem_size) { + const int global_thread_idx = blockIdx.x * blockDim.x + threadIdx.x; + __shared__ uint8_t inout_shared[256]; + + __shared__ double Matrix21_out_local[1]; + + double r0 = 0, r1 = 0, r2 = 0, r3 = 0; + + if (global_thread_idx < problem_size) { + ReadIdx2<1024, double, double, double2>(Matrix21_p_kp1, 0 * Matrix21_p_kp1_num_alloc, + global_thread_idx, r0, r1); + ReadIdx2<1024, double, double, double2>(Matrix21_w, 0 * Matrix21_w_num_alloc, global_thread_idx, + r2, r3); + r3 = fma(r1, r3, r0 * r2); + }; + SumStore(Matrix21_out_local, (double*)inout_shared, 0, global_thread_idx < problem_size, + r3); + SumFlushFinal(Matrix21_out_local, Matrix21_out, 1); +} + +void Matrix21AlphaDenominatorOrBetaNumerator(double* Matrix21_p_kp1, + unsigned int Matrix21_p_kp1_num_alloc, + double* Matrix21_w, unsigned int Matrix21_w_num_alloc, + double* const Matrix21_out, size_t problem_size) { + if (problem_size == 0) { + return; + } + + const int n_blocks = (problem_size + 1024 - 1) / 1024; + Matrix21AlphaDenominatorOrBetaNumeratorKernel<<>>( + Matrix21_p_kp1, Matrix21_p_kp1_num_alloc, Matrix21_w, Matrix21_w_num_alloc, Matrix21_out, + problem_size); +} + +} // namespace caspar \ No newline at end of file diff --git a/test/symforce_function_codegen_test_data/symengine/symforce_caspar_solver_test/kernel_Matrix21_alpha_denominator_or_beta_numerator.h b/test/symforce_function_codegen_test_data/symengine/symforce_caspar_solver_test/kernel_Matrix21_alpha_denominator_or_beta_numerator.h new file mode 100644 index 00000000..fe955dba --- /dev/null +++ b/test/symforce_function_codegen_test_data/symengine/symforce_caspar_solver_test/kernel_Matrix21_alpha_denominator_or_beta_numerator.h @@ -0,0 +1,14 @@ +#pragma once + +#include + +#include "shared_indices.h" + +namespace caspar { + +void Matrix21AlphaDenominatorOrBetaNumerator(double* Matrix21_p_kp1, + unsigned int Matrix21_p_kp1_num_alloc, + double* Matrix21_w, unsigned int Matrix21_w_num_alloc, + double* const Matrix21_out, size_t problem_size); + +} // namespace caspar \ No newline at end of file diff --git a/test/symforce_function_codegen_test_data/symengine/symforce_caspar_solver_test/kernel_Matrix21_alpha_numerator_denominator.cu b/test/symforce_function_codegen_test_data/symengine/symforce_caspar_solver_test/kernel_Matrix21_alpha_numerator_denominator.cu new file mode 100644 index 00000000..1f5be115 --- /dev/null +++ b/test/symforce_function_codegen_test_data/symengine/symforce_caspar_solver_test/kernel_Matrix21_alpha_numerator_denominator.cu @@ -0,0 +1,63 @@ +#include +#include +#include +#include +#include + +#include "kernel_Matrix21_alpha_numerator_denominator.h" +#include "memops.cuh" + +namespace cg = cooperative_groups; + +namespace caspar { + +__global__ void __launch_bounds__(1024, 1) Matrix21AlphaNumeratorDenominatorKernel( + double* Matrix21_p_kp1, unsigned int Matrix21_p_kp1_num_alloc, double* Matrix21_r_k, + unsigned int Matrix21_r_k_num_alloc, double* Matrix21_w, unsigned int Matrix21_w_num_alloc, + double* const Matrix21_total_ag, double* const Matrix21_total_ac, size_t problem_size) { + const int global_thread_idx = blockIdx.x * blockDim.x + threadIdx.x; + __shared__ uint8_t inout_shared[256]; + + __shared__ double Matrix21_total_ag_local[1]; + + __shared__ double Matrix21_total_ac_local[1]; + + double r0 = 0, r1 = 0, r2 = 0, r3 = 0; + + if (global_thread_idx < problem_size) { + ReadIdx2<1024, double, double, double2>(Matrix21_p_kp1, 0 * Matrix21_p_kp1_num_alloc, + global_thread_idx, r0, r1); + ReadIdx2<1024, double, double, double2>(Matrix21_r_k, 0 * Matrix21_r_k_num_alloc, + global_thread_idx, r2, r3); + r3 = fma(r1, r3, r0 * r2); + }; + SumStore(Matrix21_total_ag_local, (double*)inout_shared, 0, + global_thread_idx < problem_size, r3); + if (global_thread_idx < problem_size) { + ReadIdx2<1024, double, double, double2>(Matrix21_w, 0 * Matrix21_w_num_alloc, global_thread_idx, + r3, r2); + r2 = fma(r1, r2, r0 * r3); + }; + SumStore(Matrix21_total_ac_local, (double*)inout_shared, 0, + global_thread_idx < problem_size, r2); + SumFlushFinal(Matrix21_total_ag_local, Matrix21_total_ag, 1); + SumFlushFinal(Matrix21_total_ac_local, Matrix21_total_ac, 1); +} + +void Matrix21AlphaNumeratorDenominator(double* Matrix21_p_kp1, + unsigned int Matrix21_p_kp1_num_alloc, double* Matrix21_r_k, + unsigned int Matrix21_r_k_num_alloc, double* Matrix21_w, + unsigned int Matrix21_w_num_alloc, + double* const Matrix21_total_ag, + double* const Matrix21_total_ac, size_t problem_size) { + if (problem_size == 0) { + return; + } + + const int n_blocks = (problem_size + 1024 - 1) / 1024; + Matrix21AlphaNumeratorDenominatorKernel<<>>( + Matrix21_p_kp1, Matrix21_p_kp1_num_alloc, Matrix21_r_k, Matrix21_r_k_num_alloc, Matrix21_w, + Matrix21_w_num_alloc, Matrix21_total_ag, Matrix21_total_ac, problem_size); +} + +} // namespace caspar \ No newline at end of file diff --git a/test/symforce_function_codegen_test_data/symengine/symforce_caspar_solver_test/kernel_Matrix21_alpha_numerator_denominator.h b/test/symforce_function_codegen_test_data/symengine/symforce_caspar_solver_test/kernel_Matrix21_alpha_numerator_denominator.h new file mode 100644 index 00000000..863a162c --- /dev/null +++ b/test/symforce_function_codegen_test_data/symengine/symforce_caspar_solver_test/kernel_Matrix21_alpha_numerator_denominator.h @@ -0,0 +1,16 @@ +#pragma once + +#include + +#include "shared_indices.h" + +namespace caspar { + +void Matrix21AlphaNumeratorDenominator(double* Matrix21_p_kp1, + unsigned int Matrix21_p_kp1_num_alloc, double* Matrix21_r_k, + unsigned int Matrix21_r_k_num_alloc, double* Matrix21_w, + unsigned int Matrix21_w_num_alloc, + double* const Matrix21_total_ag, + double* const Matrix21_total_ac, size_t problem_size); + +} // namespace caspar \ No newline at end of file diff --git a/test/symforce_function_codegen_test_data/symengine/symforce_caspar_solver_test/kernel_Matrix21_normalize.cu b/test/symforce_function_codegen_test_data/symengine/symforce_caspar_solver_test/kernel_Matrix21_normalize.cu new file mode 100644 index 00000000..a6bc4b76 --- /dev/null +++ b/test/symforce_function_codegen_test_data/symengine/symforce_caspar_solver_test/kernel_Matrix21_normalize.cu @@ -0,0 +1,73 @@ +#include +#include +#include +#include +#include + +#include "kernel_Matrix21_normalize.h" +#include "memops.cuh" + +namespace cg = cooperative_groups; + +namespace caspar { + +__global__ void __launch_bounds__(1024, 1) + Matrix21NormalizeKernel(double* precond_diag, unsigned int precond_diag_num_alloc, + double* precond_tril, unsigned int precond_tril_num_alloc, double* njtr, + unsigned int njtr_num_alloc, const double* const diag, + double* out_normalized, unsigned int out_normalized_num_alloc, + size_t problem_size) { + const int global_thread_idx = blockIdx.x * blockDim.x + threadIdx.x; + __shared__ uint8_t inout_shared[8192]; + + double r0 = 0, r1 = 0, r2 = 0, r3 = 0, r4 = 0, r5 = 0, r6 = 0, r7 = 0, r8 = 0; + + if (global_thread_idx < problem_size) { + ReadIdx2<1024, double, double, double2>(njtr, 0 * njtr_num_alloc, global_thread_idx, r0, r1); + ReadIdx1<1024, double, double, double>(precond_tril, 0 * precond_tril_num_alloc, + global_thread_idx, r2); + r3 = -1.00000000000000000e+00; + r3 = r2 * r3; + ReadIdx2<1024, double, double, double2>(precond_diag, 0 * precond_diag_num_alloc, + global_thread_idx, r4, r5); + }; + LoadUnique<1, double, double>(diag, 0, (double*)inout_shared); + if (global_thread_idx < problem_size) { + ReadShared1((double*)inout_shared, 0, r6); + }; + __syncthreads(); + if (global_thread_idx < problem_size) { + r7 = 1.00000000000000000e+00; + r7 = r6 + r7; + r8 = 2.22044604925031308e-15; + r8 = r6 * r8; + r4 = fma(r4, r7, r8); + r4 = 1.0 / r4; + r3 = r3 * r4; + r1 = fma(r0, r3, r1); + r7 = fma(r5, r7, r8); + r7 = fma(r2, r3, r7); + r7 = 1.0 / r7; + r7 = r1 * r7; + r4 = fma(r0, r4, r3 * r7); + WriteIdx2<1024, double, double, double2>(out_normalized, 0 * out_normalized_num_alloc, + global_thread_idx, r4, r7); + }; +} + +void Matrix21Normalize(double* precond_diag, unsigned int precond_diag_num_alloc, + double* precond_tril, unsigned int precond_tril_num_alloc, double* njtr, + unsigned int njtr_num_alloc, const double* const diag, + double* out_normalized, unsigned int out_normalized_num_alloc, + size_t problem_size) { + if (problem_size == 0) { + return; + } + + const int n_blocks = (problem_size + 1024 - 1) / 1024; + Matrix21NormalizeKernel<<>>( + precond_diag, precond_diag_num_alloc, precond_tril, precond_tril_num_alloc, njtr, + njtr_num_alloc, diag, out_normalized, out_normalized_num_alloc, problem_size); +} + +} // namespace caspar \ No newline at end of file diff --git a/test/symforce_function_codegen_test_data/symengine/symforce_caspar_solver_test/kernel_Matrix21_normalize.h b/test/symforce_function_codegen_test_data/symengine/symforce_caspar_solver_test/kernel_Matrix21_normalize.h new file mode 100644 index 00000000..c6db2e2f --- /dev/null +++ b/test/symforce_function_codegen_test_data/symengine/symforce_caspar_solver_test/kernel_Matrix21_normalize.h @@ -0,0 +1,15 @@ +#pragma once + +#include + +#include "shared_indices.h" + +namespace caspar { + +void Matrix21Normalize(double* precond_diag, unsigned int precond_diag_num_alloc, + double* precond_tril, unsigned int precond_tril_num_alloc, double* njtr, + unsigned int njtr_num_alloc, const double* const diag, + double* out_normalized, unsigned int out_normalized_num_alloc, + size_t problem_size); + +} // namespace caspar \ No newline at end of file diff --git a/test/symforce_function_codegen_test_data/symengine/symforce_caspar_solver_test/kernel_Matrix21_pred_decrease_times_two.cu b/test/symforce_function_codegen_test_data/symengine/symforce_caspar_solver_test/kernel_Matrix21_pred_decrease_times_two.cu new file mode 100644 index 00000000..c8b25b86 --- /dev/null +++ b/test/symforce_function_codegen_test_data/symengine/symforce_caspar_solver_test/kernel_Matrix21_pred_decrease_times_two.cu @@ -0,0 +1,70 @@ +#include +#include +#include +#include +#include + +#include "kernel_Matrix21_pred_decrease_times_two.h" +#include "memops.cuh" + +namespace cg = cooperative_groups; + +namespace caspar { + +__global__ void __launch_bounds__(1024, 1) + Matrix21PredDecreaseTimesTwoKernel(double* Matrix21_step, unsigned int Matrix21_step_num_alloc, + double* Matrix21_precond_diag, + unsigned int Matrix21_precond_diag_num_alloc, + const double* const diag, double* Matrix21_njtr, + unsigned int Matrix21_njtr_num_alloc, + double* const out_Matrix21_pred_dec, size_t problem_size) { + const int global_thread_idx = blockIdx.x * blockDim.x + threadIdx.x; + __shared__ uint8_t inout_shared[8192]; + + __shared__ double out_Matrix21_pred_dec_local[1]; + + double r0 = 0, r1 = 0, r2 = 0, r3 = 0, r4 = 0, r5 = 0, r6 = 0, r7 = 0; + + if (global_thread_idx < problem_size) { + ReadIdx2<1024, double, double, double2>(Matrix21_step, 0 * Matrix21_step_num_alloc, + global_thread_idx, r0, r1); + ReadIdx2<1024, double, double, double2>(Matrix21_njtr, 0 * Matrix21_njtr_num_alloc, + global_thread_idx, r2, r3); + ReadIdx2<1024, double, double, double2>( + Matrix21_precond_diag, 0 * Matrix21_precond_diag_num_alloc, global_thread_idx, r4, r5); + r6 = r1 * r5; + }; + LoadUnique<1, double, double>(diag, 0, (double*)inout_shared); + if (global_thread_idx < problem_size) { + ReadShared1((double*)inout_shared, 0, r7); + }; + __syncthreads(); + if (global_thread_idx < problem_size) { + r6 = fma(r7, r6, r3); + r3 = r0 * r4; + r3 = fma(r7, r3, r2); + r3 = fma(r0, r3, r1 * r6); + }; + SumStore(out_Matrix21_pred_dec_local, (double*)inout_shared, 0, + global_thread_idx < problem_size, r3); + SumFlushFinal(out_Matrix21_pred_dec_local, out_Matrix21_pred_dec, 1); +} + +void Matrix21PredDecreaseTimesTwo(double* Matrix21_step, unsigned int Matrix21_step_num_alloc, + double* Matrix21_precond_diag, + unsigned int Matrix21_precond_diag_num_alloc, + const double* const diag, double* Matrix21_njtr, + unsigned int Matrix21_njtr_num_alloc, + double* const out_Matrix21_pred_dec, size_t problem_size) { + if (problem_size == 0) { + return; + } + + const int n_blocks = (problem_size + 1024 - 1) / 1024; + Matrix21PredDecreaseTimesTwoKernel<<>>( + Matrix21_step, Matrix21_step_num_alloc, Matrix21_precond_diag, + Matrix21_precond_diag_num_alloc, diag, Matrix21_njtr, Matrix21_njtr_num_alloc, + out_Matrix21_pred_dec, problem_size); +} + +} // namespace caspar \ No newline at end of file diff --git a/test/symforce_function_codegen_test_data/symengine/symforce_caspar_solver_test/kernel_Matrix21_pred_decrease_times_two.h b/test/symforce_function_codegen_test_data/symengine/symforce_caspar_solver_test/kernel_Matrix21_pred_decrease_times_two.h new file mode 100644 index 00000000..4e8ad4e1 --- /dev/null +++ b/test/symforce_function_codegen_test_data/symengine/symforce_caspar_solver_test/kernel_Matrix21_pred_decrease_times_two.h @@ -0,0 +1,16 @@ +#pragma once + +#include + +#include "shared_indices.h" + +namespace caspar { + +void Matrix21PredDecreaseTimesTwo(double* Matrix21_step, unsigned int Matrix21_step_num_alloc, + double* Matrix21_precond_diag, + unsigned int Matrix21_precond_diag_num_alloc, + const double* const diag, double* Matrix21_njtr, + unsigned int Matrix21_njtr_num_alloc, + double* const out_Matrix21_pred_dec, size_t problem_size); + +} // namespace caspar \ No newline at end of file diff --git a/test/symforce_function_codegen_test_data/symengine/symforce_caspar_solver_test/kernel_Matrix21_retract.cu b/test/symforce_function_codegen_test_data/symengine/symforce_caspar_solver_test/kernel_Matrix21_retract.cu new file mode 100644 index 00000000..ca07887a --- /dev/null +++ b/test/symforce_function_codegen_test_data/symengine/symforce_caspar_solver_test/kernel_Matrix21_retract.cu @@ -0,0 +1,46 @@ +#include +#include +#include +#include +#include + +#include "kernel_Matrix21_retract.h" +#include "memops.cuh" + +namespace cg = cooperative_groups; + +namespace caspar { + +__global__ void __launch_bounds__(1024, 1) + Matrix21RetractKernel(double* Matrix21, unsigned int Matrix21_num_alloc, double* delta, + unsigned int delta_num_alloc, double* out_Matrix21_retracted, + unsigned int out_Matrix21_retracted_num_alloc, size_t problem_size) { + const int global_thread_idx = blockIdx.x * blockDim.x + threadIdx.x; + + double r0 = 0, r1 = 0, r2 = 0, r3 = 0; + + if (global_thread_idx < problem_size) { + ReadIdx2<1024, double, double, double2>(Matrix21, 0 * Matrix21_num_alloc, global_thread_idx, r0, + r1); + ReadIdx2<1024, double, double, double2>(delta, 0 * delta_num_alloc, global_thread_idx, r2, r3); + r2 = r0 + r2; + r3 = r1 + r3; + WriteIdx2<1024, double, double, double2>( + out_Matrix21_retracted, 0 * out_Matrix21_retracted_num_alloc, global_thread_idx, r2, r3); + }; +} + +void Matrix21Retract(double* Matrix21, unsigned int Matrix21_num_alloc, double* delta, + unsigned int delta_num_alloc, double* out_Matrix21_retracted, + unsigned int out_Matrix21_retracted_num_alloc, size_t problem_size) { + if (problem_size == 0) { + return; + } + + const int n_blocks = (problem_size + 1024 - 1) / 1024; + Matrix21RetractKernel<<>>(Matrix21, Matrix21_num_alloc, delta, delta_num_alloc, + out_Matrix21_retracted, + out_Matrix21_retracted_num_alloc, problem_size); +} + +} // namespace caspar \ No newline at end of file diff --git a/test/symforce_function_codegen_test_data/symengine/symforce_caspar_solver_test/kernel_Matrix21_retract.h b/test/symforce_function_codegen_test_data/symengine/symforce_caspar_solver_test/kernel_Matrix21_retract.h new file mode 100644 index 00000000..1219c59d --- /dev/null +++ b/test/symforce_function_codegen_test_data/symengine/symforce_caspar_solver_test/kernel_Matrix21_retract.h @@ -0,0 +1,13 @@ +#pragma once + +#include + +#include "shared_indices.h" + +namespace caspar { + +void Matrix21Retract(double* Matrix21, unsigned int Matrix21_num_alloc, double* delta, + unsigned int delta_num_alloc, double* out_Matrix21_retracted, + unsigned int out_Matrix21_retracted_num_alloc, size_t problem_size); + +} // namespace caspar \ No newline at end of file diff --git a/test/symforce_function_codegen_test_data/symengine/symforce_caspar_solver_test/kernel_Matrix21_start_w.cu b/test/symforce_function_codegen_test_data/symengine/symforce_caspar_solver_test/kernel_Matrix21_start_w.cu new file mode 100644 index 00000000..fae4bdd9 --- /dev/null +++ b/test/symforce_function_codegen_test_data/symengine/symforce_caspar_solver_test/kernel_Matrix21_start_w.cu @@ -0,0 +1,60 @@ +#include +#include +#include +#include +#include + +#include "kernel_Matrix21_start_w.h" +#include "memops.cuh" + +namespace cg = cooperative_groups; + +namespace caspar { + +__global__ void __launch_bounds__(1024, 1) + Matrix21StartWKernel(double* Matrix21_precond_diag, + unsigned int Matrix21_precond_diag_num_alloc, const double* const diag, + double* Matrix21_p, unsigned int Matrix21_p_num_alloc, + double* out_Matrix21_w, unsigned int out_Matrix21_w_num_alloc, + size_t problem_size) { + const int global_thread_idx = blockIdx.x * blockDim.x + threadIdx.x; + __shared__ uint8_t inout_shared[8192]; + + double r0 = 0, r1 = 0, r2 = 0, r3 = 0, r4 = 0; + + if (global_thread_idx < problem_size) { + ReadIdx2<1024, double, double, double2>( + Matrix21_precond_diag, 0 * Matrix21_precond_diag_num_alloc, global_thread_idx, r0, r1); + }; + LoadUnique<1, double, double>(diag, 0, (double*)inout_shared); + if (global_thread_idx < problem_size) { + ReadShared1((double*)inout_shared, 0, r2); + }; + __syncthreads(); + if (global_thread_idx < problem_size) { + r0 = r0 * r2; + ReadIdx2<1024, double, double, double2>(Matrix21_p, 0 * Matrix21_p_num_alloc, global_thread_idx, + r3, r4); + r0 = r0 * r3; + r2 = r1 * r2; + r2 = r2 * r4; + WriteIdx2<1024, double, double, double2>(out_Matrix21_w, 0 * out_Matrix21_w_num_alloc, + global_thread_idx, r0, r2); + }; +} + +void Matrix21StartW(double* Matrix21_precond_diag, unsigned int Matrix21_precond_diag_num_alloc, + const double* const diag, double* Matrix21_p, unsigned int Matrix21_p_num_alloc, + double* out_Matrix21_w, unsigned int out_Matrix21_w_num_alloc, + size_t problem_size) { + if (problem_size == 0) { + return; + } + + const int n_blocks = (problem_size + 1024 - 1) / 1024; + Matrix21StartWKernel<<>>(Matrix21_precond_diag, Matrix21_precond_diag_num_alloc, + diag, Matrix21_p, Matrix21_p_num_alloc, out_Matrix21_w, + out_Matrix21_w_num_alloc, problem_size); +} + +} // namespace caspar \ No newline at end of file diff --git a/test/symforce_function_codegen_test_data/symengine/symforce_caspar_solver_test/kernel_Matrix21_start_w.h b/test/symforce_function_codegen_test_data/symengine/symforce_caspar_solver_test/kernel_Matrix21_start_w.h new file mode 100644 index 00000000..fa1e7963 --- /dev/null +++ b/test/symforce_function_codegen_test_data/symengine/symforce_caspar_solver_test/kernel_Matrix21_start_w.h @@ -0,0 +1,14 @@ +#pragma once + +#include + +#include "shared_indices.h" + +namespace caspar { + +void Matrix21StartW(double* Matrix21_precond_diag, unsigned int Matrix21_precond_diag_num_alloc, + const double* const diag, double* Matrix21_p, unsigned int Matrix21_p_num_alloc, + double* out_Matrix21_w, unsigned int out_Matrix21_w_num_alloc, + size_t problem_size); + +} // namespace caspar \ No newline at end of file diff --git a/test/symforce_function_codegen_test_data/symengine/symforce_caspar_solver_test/kernel_Matrix21_start_w_contribute.cu b/test/symforce_function_codegen_test_data/symengine/symforce_caspar_solver_test/kernel_Matrix21_start_w_contribute.cu new file mode 100644 index 00000000..c77cfa38 --- /dev/null +++ b/test/symforce_function_codegen_test_data/symengine/symforce_caspar_solver_test/kernel_Matrix21_start_w_contribute.cu @@ -0,0 +1,61 @@ +#include +#include +#include +#include +#include + +#include "kernel_Matrix21_start_w_contribute.h" +#include "memops.cuh" + +namespace cg = cooperative_groups; + +namespace caspar { + +__global__ void __launch_bounds__(1024, 1) + Matrix21StartWContributeKernel(double* Matrix21_precond_diag, + unsigned int Matrix21_precond_diag_num_alloc, + const double* const diag, double* Matrix21_p, + unsigned int Matrix21_p_num_alloc, double* out_Matrix21_w, + unsigned int out_Matrix21_w_num_alloc, size_t problem_size) { + const int global_thread_idx = blockIdx.x * blockDim.x + threadIdx.x; + __shared__ uint8_t inout_shared[8192]; + + double r0 = 0, r1 = 0, r2 = 0, r3 = 0, r4 = 0; + + if (global_thread_idx < problem_size) { + ReadIdx2<1024, double, double, double2>( + Matrix21_precond_diag, 0 * Matrix21_precond_diag_num_alloc, global_thread_idx, r0, r1); + }; + LoadUnique<1, double, double>(diag, 0, (double*)inout_shared); + if (global_thread_idx < problem_size) { + ReadShared1((double*)inout_shared, 0, r2); + }; + __syncthreads(); + if (global_thread_idx < problem_size) { + r0 = r0 * r2; + ReadIdx2<1024, double, double, double2>(Matrix21_p, 0 * Matrix21_p_num_alloc, global_thread_idx, + r3, r4); + r0 = r0 * r3; + r2 = r1 * r2; + r2 = r2 * r4; + AddIdx2<1024, double, double, double2>(out_Matrix21_w, 0 * out_Matrix21_w_num_alloc, + global_thread_idx, r0, r2); + }; +} + +void Matrix21StartWContribute(double* Matrix21_precond_diag, + unsigned int Matrix21_precond_diag_num_alloc, + const double* const diag, double* Matrix21_p, + unsigned int Matrix21_p_num_alloc, double* out_Matrix21_w, + unsigned int out_Matrix21_w_num_alloc, size_t problem_size) { + if (problem_size == 0) { + return; + } + + const int n_blocks = (problem_size + 1024 - 1) / 1024; + Matrix21StartWContributeKernel<<>>( + Matrix21_precond_diag, Matrix21_precond_diag_num_alloc, diag, Matrix21_p, + Matrix21_p_num_alloc, out_Matrix21_w, out_Matrix21_w_num_alloc, problem_size); +} + +} // namespace caspar \ No newline at end of file diff --git a/test/symforce_function_codegen_test_data/symengine/symforce_caspar_solver_test/kernel_Matrix21_start_w_contribute.h b/test/symforce_function_codegen_test_data/symengine/symforce_caspar_solver_test/kernel_Matrix21_start_w_contribute.h new file mode 100644 index 00000000..67a41b95 --- /dev/null +++ b/test/symforce_function_codegen_test_data/symengine/symforce_caspar_solver_test/kernel_Matrix21_start_w_contribute.h @@ -0,0 +1,15 @@ +#pragma once + +#include + +#include "shared_indices.h" + +namespace caspar { + +void Matrix21StartWContribute(double* Matrix21_precond_diag, + unsigned int Matrix21_precond_diag_num_alloc, + const double* const diag, double* Matrix21_p, + unsigned int Matrix21_p_num_alloc, double* out_Matrix21_w, + unsigned int out_Matrix21_w_num_alloc, size_t problem_size); + +} // namespace caspar \ No newline at end of file diff --git a/test/symforce_function_codegen_test_data/symengine/symforce_caspar_solver_test/kernel_Matrix21_update_Mp.cu b/test/symforce_function_codegen_test_data/symengine/symforce_caspar_solver_test/kernel_Matrix21_update_Mp.cu new file mode 100644 index 00000000..c76ec730 --- /dev/null +++ b/test/symforce_function_codegen_test_data/symengine/symforce_caspar_solver_test/kernel_Matrix21_update_Mp.cu @@ -0,0 +1,62 @@ +#include +#include +#include +#include +#include + +#include "kernel_Matrix21_update_Mp.h" +#include "memops.cuh" + +namespace cg = cooperative_groups; + +namespace caspar { + +__global__ void __launch_bounds__(1024, 1) + Matrix21UpdateMpKernel(double* Matrix21_r_k, unsigned int Matrix21_r_k_num_alloc, + double* Matrix21_Mp, unsigned int Matrix21_Mp_num_alloc, + const double* const beta, double* out_Matrix21_Mp_kp1, + unsigned int out_Matrix21_Mp_kp1_num_alloc, double* out_Matrix21_w, + unsigned int out_Matrix21_w_num_alloc, size_t problem_size) { + const int global_thread_idx = blockIdx.x * blockDim.x + threadIdx.x; + __shared__ uint8_t inout_shared[8192]; + + double r0 = 0, r1 = 0, r2 = 0, r3 = 0, r4 = 0; + + if (global_thread_idx < problem_size) { + ReadIdx2<1024, double, double, double2>(Matrix21_Mp, 0 * Matrix21_Mp_num_alloc, + global_thread_idx, r0, r1); + ReadIdx2<1024, double, double, double2>(Matrix21_r_k, 0 * Matrix21_r_k_num_alloc, + global_thread_idx, r2, r3); + }; + LoadUnique<1, double, double>(beta, 0, (double*)inout_shared); + if (global_thread_idx < problem_size) { + ReadShared1((double*)inout_shared, 0, r4); + }; + __syncthreads(); + if (global_thread_idx < problem_size) { + r0 = fma(r0, r4, r2); + r4 = fma(r1, r4, r3); + WriteIdx2<1024, double, double, double2>(out_Matrix21_Mp_kp1, 0 * out_Matrix21_Mp_kp1_num_alloc, + global_thread_idx, r0, r4); + WriteIdx2<1024, double, double, double2>(out_Matrix21_w, 0 * out_Matrix21_w_num_alloc, + global_thread_idx, r0, r4); + }; +} + +void Matrix21UpdateMp(double* Matrix21_r_k, unsigned int Matrix21_r_k_num_alloc, + double* Matrix21_Mp, unsigned int Matrix21_Mp_num_alloc, + const double* const beta, double* out_Matrix21_Mp_kp1, + unsigned int out_Matrix21_Mp_kp1_num_alloc, double* out_Matrix21_w, + unsigned int out_Matrix21_w_num_alloc, size_t problem_size) { + if (problem_size == 0) { + return; + } + + const int n_blocks = (problem_size + 1024 - 1) / 1024; + Matrix21UpdateMpKernel<<>>(Matrix21_r_k, Matrix21_r_k_num_alloc, Matrix21_Mp, + Matrix21_Mp_num_alloc, beta, out_Matrix21_Mp_kp1, + out_Matrix21_Mp_kp1_num_alloc, out_Matrix21_w, + out_Matrix21_w_num_alloc, problem_size); +} + +} // namespace caspar \ No newline at end of file diff --git a/test/symforce_function_codegen_test_data/symengine/symforce_caspar_solver_test/kernel_Matrix21_update_Mp.h b/test/symforce_function_codegen_test_data/symengine/symforce_caspar_solver_test/kernel_Matrix21_update_Mp.h new file mode 100644 index 00000000..4e3352d5 --- /dev/null +++ b/test/symforce_function_codegen_test_data/symengine/symforce_caspar_solver_test/kernel_Matrix21_update_Mp.h @@ -0,0 +1,15 @@ +#pragma once + +#include + +#include "shared_indices.h" + +namespace caspar { + +void Matrix21UpdateMp(double* Matrix21_r_k, unsigned int Matrix21_r_k_num_alloc, + double* Matrix21_Mp, unsigned int Matrix21_Mp_num_alloc, + const double* const beta, double* out_Matrix21_Mp_kp1, + unsigned int out_Matrix21_Mp_kp1_num_alloc, double* out_Matrix21_w, + unsigned int out_Matrix21_w_num_alloc, size_t problem_size); + +} // namespace caspar \ No newline at end of file diff --git a/test/symforce_function_codegen_test_data/symengine/symforce_caspar_solver_test/kernel_Matrix21_update_p.cu b/test/symforce_function_codegen_test_data/symengine/symforce_caspar_solver_test/kernel_Matrix21_update_p.cu new file mode 100644 index 00000000..d814eaef --- /dev/null +++ b/test/symforce_function_codegen_test_data/symengine/symforce_caspar_solver_test/kernel_Matrix21_update_p.cu @@ -0,0 +1,57 @@ +#include +#include +#include +#include +#include + +#include "kernel_Matrix21_update_p.h" +#include "memops.cuh" + +namespace cg = cooperative_groups; + +namespace caspar { + +__global__ void __launch_bounds__(1024, 1) + Matrix21UpdatePKernel(double* Matrix21_z, unsigned int Matrix21_z_num_alloc, + double* Matrix21_p_k, unsigned int Matrix21_p_k_num_alloc, + const double* const beta, double* out_Matrix21_p_kp1, + unsigned int out_Matrix21_p_kp1_num_alloc, size_t problem_size) { + const int global_thread_idx = blockIdx.x * blockDim.x + threadIdx.x; + __shared__ uint8_t inout_shared[8192]; + + double r0 = 0, r1 = 0, r2 = 0, r3 = 0, r4 = 0; + + if (global_thread_idx < problem_size) { + ReadIdx2<1024, double, double, double2>(Matrix21_p_k, 0 * Matrix21_p_k_num_alloc, + global_thread_idx, r0, r1); + ReadIdx2<1024, double, double, double2>(Matrix21_z, 0 * Matrix21_z_num_alloc, global_thread_idx, + r2, r3); + }; + LoadUnique<1, double, double>(beta, 0, (double*)inout_shared); + if (global_thread_idx < problem_size) { + ReadShared1((double*)inout_shared, 0, r4); + }; + __syncthreads(); + if (global_thread_idx < problem_size) { + r0 = fma(r0, r4, r2); + r4 = fma(r1, r4, r3); + WriteIdx2<1024, double, double, double2>(out_Matrix21_p_kp1, 0 * out_Matrix21_p_kp1_num_alloc, + global_thread_idx, r0, r4); + }; +} + +void Matrix21UpdateP(double* Matrix21_z, unsigned int Matrix21_z_num_alloc, double* Matrix21_p_k, + unsigned int Matrix21_p_k_num_alloc, const double* const beta, + double* out_Matrix21_p_kp1, unsigned int out_Matrix21_p_kp1_num_alloc, + size_t problem_size) { + if (problem_size == 0) { + return; + } + + const int n_blocks = (problem_size + 1024 - 1) / 1024; + Matrix21UpdatePKernel<<>>(Matrix21_z, Matrix21_z_num_alloc, Matrix21_p_k, + Matrix21_p_k_num_alloc, beta, out_Matrix21_p_kp1, + out_Matrix21_p_kp1_num_alloc, problem_size); +} + +} // namespace caspar \ No newline at end of file diff --git a/test/symforce_function_codegen_test_data/symengine/symforce_caspar_solver_test/kernel_Matrix21_update_p.h b/test/symforce_function_codegen_test_data/symengine/symforce_caspar_solver_test/kernel_Matrix21_update_p.h new file mode 100644 index 00000000..a6ea4824 --- /dev/null +++ b/test/symforce_function_codegen_test_data/symengine/symforce_caspar_solver_test/kernel_Matrix21_update_p.h @@ -0,0 +1,14 @@ +#pragma once + +#include + +#include "shared_indices.h" + +namespace caspar { + +void Matrix21UpdateP(double* Matrix21_z, unsigned int Matrix21_z_num_alloc, double* Matrix21_p_k, + unsigned int Matrix21_p_k_num_alloc, const double* const beta, + double* out_Matrix21_p_kp1, unsigned int out_Matrix21_p_kp1_num_alloc, + size_t problem_size); + +} // namespace caspar \ No newline at end of file diff --git a/test/symforce_function_codegen_test_data/symengine/symforce_caspar_solver_test/kernel_Matrix21_update_r.cu b/test/symforce_function_codegen_test_data/symengine/symforce_caspar_solver_test/kernel_Matrix21_update_r.cu new file mode 100644 index 00000000..b7d47685 --- /dev/null +++ b/test/symforce_function_codegen_test_data/symengine/symforce_caspar_solver_test/kernel_Matrix21_update_r.cu @@ -0,0 +1,64 @@ +#include +#include +#include +#include +#include + +#include "kernel_Matrix21_update_r.h" +#include "memops.cuh" + +namespace cg = cooperative_groups; + +namespace caspar { + +__global__ void __launch_bounds__(1024, 1) + Matrix21UpdateRKernel(double* Matrix21_r_k, unsigned int Matrix21_r_k_num_alloc, + double* Matrix21_w, unsigned int Matrix21_w_num_alloc, + const double* const negalpha, double* out_Matrix21_r_kp1, + unsigned int out_Matrix21_r_kp1_num_alloc, + double* const out_Matrix21_r_kp1_norm2_tot, size_t problem_size) { + const int global_thread_idx = blockIdx.x * blockDim.x + threadIdx.x; + __shared__ uint8_t inout_shared[8192]; + + __shared__ double out_Matrix21_r_kp1_norm2_tot_local[1]; + + double r0 = 0, r1 = 0, r2 = 0, r3 = 0, r4 = 0; + + if (global_thread_idx < problem_size) { + ReadIdx2<1024, double, double, double2>(Matrix21_r_k, 0 * Matrix21_r_k_num_alloc, + global_thread_idx, r0, r1); + ReadIdx2<1024, double, double, double2>(Matrix21_w, 0 * Matrix21_w_num_alloc, global_thread_idx, + r2, r3); + }; + LoadUnique<1, double, double>(negalpha, 0, (double*)inout_shared); + if (global_thread_idx < problem_size) { + ReadShared1((double*)inout_shared, 0, r4); + }; + __syncthreads(); + if (global_thread_idx < problem_size) { + r2 = fma(r2, r4, r0); + r4 = fma(r3, r4, r1); + WriteIdx2<1024, double, double, double2>(out_Matrix21_r_kp1, 0 * out_Matrix21_r_kp1_num_alloc, + global_thread_idx, r2, r4); + r2 = fma(r2, r2, r4 * r4); + }; + SumStore(out_Matrix21_r_kp1_norm2_tot_local, (double*)inout_shared, 0, + global_thread_idx < problem_size, r2); + SumFlushFinal(out_Matrix21_r_kp1_norm2_tot_local, out_Matrix21_r_kp1_norm2_tot, 1); +} + +void Matrix21UpdateR(double* Matrix21_r_k, unsigned int Matrix21_r_k_num_alloc, double* Matrix21_w, + unsigned int Matrix21_w_num_alloc, const double* const negalpha, + double* out_Matrix21_r_kp1, unsigned int out_Matrix21_r_kp1_num_alloc, + double* const out_Matrix21_r_kp1_norm2_tot, size_t problem_size) { + if (problem_size == 0) { + return; + } + + const int n_blocks = (problem_size + 1024 - 1) / 1024; + Matrix21UpdateRKernel<<>>( + Matrix21_r_k, Matrix21_r_k_num_alloc, Matrix21_w, Matrix21_w_num_alloc, negalpha, + out_Matrix21_r_kp1, out_Matrix21_r_kp1_num_alloc, out_Matrix21_r_kp1_norm2_tot, problem_size); +} + +} // namespace caspar \ No newline at end of file diff --git a/test/symforce_function_codegen_test_data/symengine/symforce_caspar_solver_test/kernel_Matrix21_update_r.h b/test/symforce_function_codegen_test_data/symengine/symforce_caspar_solver_test/kernel_Matrix21_update_r.h new file mode 100644 index 00000000..33ce7fea --- /dev/null +++ b/test/symforce_function_codegen_test_data/symengine/symforce_caspar_solver_test/kernel_Matrix21_update_r.h @@ -0,0 +1,14 @@ +#pragma once + +#include + +#include "shared_indices.h" + +namespace caspar { + +void Matrix21UpdateR(double* Matrix21_r_k, unsigned int Matrix21_r_k_num_alloc, double* Matrix21_w, + unsigned int Matrix21_w_num_alloc, const double* const negalpha, + double* out_Matrix21_r_kp1, unsigned int out_Matrix21_r_kp1_num_alloc, + double* const out_Matrix21_r_kp1_norm2_tot, size_t problem_size); + +} // namespace caspar \ No newline at end of file diff --git a/test/symforce_function_codegen_test_data/symengine/symforce_caspar_solver_test/kernel_Matrix21_update_r_first.cu b/test/symforce_function_codegen_test_data/symengine/symforce_caspar_solver_test/kernel_Matrix21_update_r_first.cu new file mode 100644 index 00000000..8ef1fc2d --- /dev/null +++ b/test/symforce_function_codegen_test_data/symengine/symforce_caspar_solver_test/kernel_Matrix21_update_r_first.cu @@ -0,0 +1,76 @@ +#include +#include +#include +#include +#include + +#include "kernel_Matrix21_update_r_first.h" +#include "memops.cuh" + +namespace cg = cooperative_groups; + +namespace caspar { + +__global__ void __launch_bounds__(1024, 1) + Matrix21UpdateRFirstKernel(double* Matrix21_r_k, unsigned int Matrix21_r_k_num_alloc, + double* Matrix21_w, unsigned int Matrix21_w_num_alloc, + const double* const negalpha, double* out_Matrix21_r_kp1, + unsigned int out_Matrix21_r_kp1_num_alloc, + double* const out_Matrix21_r_0_norm2_tot, + double* const out_Matrix21_r_kp1_norm2_tot, size_t problem_size) { + const int global_thread_idx = blockIdx.x * blockDim.x + threadIdx.x; + __shared__ uint8_t inout_shared[8192]; + + __shared__ double out_Matrix21_r_0_norm2_tot_local[1]; + + __shared__ double out_Matrix21_r_kp1_norm2_tot_local[1]; + + double r0 = 0, r1 = 0, r2 = 0, r3 = 0, r4 = 0; + + if (global_thread_idx < problem_size) { + ReadIdx2<1024, double, double, double2>(Matrix21_r_k, 0 * Matrix21_r_k_num_alloc, + global_thread_idx, r0, r1); + ReadIdx2<1024, double, double, double2>(Matrix21_w, 0 * Matrix21_w_num_alloc, global_thread_idx, + r2, r3); + }; + LoadUnique<1, double, double>(negalpha, 0, (double*)inout_shared); + if (global_thread_idx < problem_size) { + ReadShared1((double*)inout_shared, 0, r4); + }; + __syncthreads(); + if (global_thread_idx < problem_size) { + r2 = fma(r2, r4, r0); + r4 = fma(r3, r4, r1); + WriteIdx2<1024, double, double, double2>(out_Matrix21_r_kp1, 0 * out_Matrix21_r_kp1_num_alloc, + global_thread_idx, r2, r4); + r0 = fma(r0, r0, r1 * r1); + }; + SumStore(out_Matrix21_r_0_norm2_tot_local, (double*)inout_shared, 0, + global_thread_idx < problem_size, r0); + if (global_thread_idx < problem_size) { + r2 = fma(r2, r2, r4 * r4); + }; + SumStore(out_Matrix21_r_kp1_norm2_tot_local, (double*)inout_shared, 0, + global_thread_idx < problem_size, r2); + SumFlushFinal(out_Matrix21_r_0_norm2_tot_local, out_Matrix21_r_0_norm2_tot, 1); + SumFlushFinal(out_Matrix21_r_kp1_norm2_tot_local, out_Matrix21_r_kp1_norm2_tot, 1); +} + +void Matrix21UpdateRFirst(double* Matrix21_r_k, unsigned int Matrix21_r_k_num_alloc, + double* Matrix21_w, unsigned int Matrix21_w_num_alloc, + const double* const negalpha, double* out_Matrix21_r_kp1, + unsigned int out_Matrix21_r_kp1_num_alloc, + double* const out_Matrix21_r_0_norm2_tot, + double* const out_Matrix21_r_kp1_norm2_tot, size_t problem_size) { + if (problem_size == 0) { + return; + } + + const int n_blocks = (problem_size + 1024 - 1) / 1024; + Matrix21UpdateRFirstKernel<<>>( + Matrix21_r_k, Matrix21_r_k_num_alloc, Matrix21_w, Matrix21_w_num_alloc, negalpha, + out_Matrix21_r_kp1, out_Matrix21_r_kp1_num_alloc, out_Matrix21_r_0_norm2_tot, + out_Matrix21_r_kp1_norm2_tot, problem_size); +} + +} // namespace caspar \ No newline at end of file diff --git a/test/symforce_function_codegen_test_data/symengine/symforce_caspar_solver_test/kernel_Matrix21_update_r_first.h b/test/symforce_function_codegen_test_data/symengine/symforce_caspar_solver_test/kernel_Matrix21_update_r_first.h new file mode 100644 index 00000000..24f801d0 --- /dev/null +++ b/test/symforce_function_codegen_test_data/symengine/symforce_caspar_solver_test/kernel_Matrix21_update_r_first.h @@ -0,0 +1,16 @@ +#pragma once + +#include + +#include "shared_indices.h" + +namespace caspar { + +void Matrix21UpdateRFirst(double* Matrix21_r_k, unsigned int Matrix21_r_k_num_alloc, + double* Matrix21_w, unsigned int Matrix21_w_num_alloc, + const double* const negalpha, double* out_Matrix21_r_kp1, + unsigned int out_Matrix21_r_kp1_num_alloc, + double* const out_Matrix21_r_0_norm2_tot, + double* const out_Matrix21_r_kp1_norm2_tot, size_t problem_size); + +} // namespace caspar \ No newline at end of file diff --git a/test/symforce_function_codegen_test_data/symengine/symforce_caspar_solver_test/kernel_Matrix21_update_step.cu b/test/symforce_function_codegen_test_data/symengine/symforce_caspar_solver_test/kernel_Matrix21_update_step.cu new file mode 100644 index 00000000..ea0a9a04 --- /dev/null +++ b/test/symforce_function_codegen_test_data/symengine/symforce_caspar_solver_test/kernel_Matrix21_update_step.cu @@ -0,0 +1,57 @@ +#include +#include +#include +#include +#include + +#include "kernel_Matrix21_update_step.h" +#include "memops.cuh" + +namespace cg = cooperative_groups; + +namespace caspar { + +__global__ void __launch_bounds__(1024, 1) + Matrix21UpdateStepKernel(double* Matrix21_step_k, unsigned int Matrix21_step_k_num_alloc, + double* Matrix21_p_kp1, unsigned int Matrix21_p_kp1_num_alloc, + const double* const alpha, double* out_Matrix21_step_kp1, + unsigned int out_Matrix21_step_kp1_num_alloc, size_t problem_size) { + const int global_thread_idx = blockIdx.x * blockDim.x + threadIdx.x; + __shared__ uint8_t inout_shared[8192]; + + double r0 = 0, r1 = 0, r2 = 0, r3 = 0, r4 = 0; + + if (global_thread_idx < problem_size) { + ReadIdx2<1024, double, double, double2>(Matrix21_step_k, 0 * Matrix21_step_k_num_alloc, + global_thread_idx, r0, r1); + ReadIdx2<1024, double, double, double2>(Matrix21_p_kp1, 0 * Matrix21_p_kp1_num_alloc, + global_thread_idx, r2, r3); + }; + LoadUnique<1, double, double>(alpha, 0, (double*)inout_shared); + if (global_thread_idx < problem_size) { + ReadShared1((double*)inout_shared, 0, r4); + }; + __syncthreads(); + if (global_thread_idx < problem_size) { + r2 = fma(r2, r4, r0); + r4 = fma(r3, r4, r1); + WriteIdx2<1024, double, double, double2>( + out_Matrix21_step_kp1, 0 * out_Matrix21_step_kp1_num_alloc, global_thread_idx, r2, r4); + }; +} + +void Matrix21UpdateStep(double* Matrix21_step_k, unsigned int Matrix21_step_k_num_alloc, + double* Matrix21_p_kp1, unsigned int Matrix21_p_kp1_num_alloc, + const double* const alpha, double* out_Matrix21_step_kp1, + unsigned int out_Matrix21_step_kp1_num_alloc, size_t problem_size) { + if (problem_size == 0) { + return; + } + + const int n_blocks = (problem_size + 1024 - 1) / 1024; + Matrix21UpdateStepKernel<<>>( + Matrix21_step_k, Matrix21_step_k_num_alloc, Matrix21_p_kp1, Matrix21_p_kp1_num_alloc, alpha, + out_Matrix21_step_kp1, out_Matrix21_step_kp1_num_alloc, problem_size); +} + +} // namespace caspar \ No newline at end of file diff --git a/test/symforce_function_codegen_test_data/symengine/symforce_caspar_solver_test/kernel_Matrix21_update_step.h b/test/symforce_function_codegen_test_data/symengine/symforce_caspar_solver_test/kernel_Matrix21_update_step.h new file mode 100644 index 00000000..e1709af9 --- /dev/null +++ b/test/symforce_function_codegen_test_data/symengine/symforce_caspar_solver_test/kernel_Matrix21_update_step.h @@ -0,0 +1,14 @@ +#pragma once + +#include + +#include "shared_indices.h" + +namespace caspar { + +void Matrix21UpdateStep(double* Matrix21_step_k, unsigned int Matrix21_step_k_num_alloc, + double* Matrix21_p_kp1, unsigned int Matrix21_p_kp1_num_alloc, + const double* const alpha, double* out_Matrix21_step_kp1, + unsigned int out_Matrix21_step_kp1_num_alloc, size_t problem_size); + +} // namespace caspar \ No newline at end of file diff --git a/test/symforce_function_codegen_test_data/symengine/symforce_caspar_solver_test/kernel_Matrix21_update_step_first.cu b/test/symforce_function_codegen_test_data/symengine/symforce_caspar_solver_test/kernel_Matrix21_update_step_first.cu new file mode 100644 index 00000000..db63ec50 --- /dev/null +++ b/test/symforce_function_codegen_test_data/symengine/symforce_caspar_solver_test/kernel_Matrix21_update_step_first.cu @@ -0,0 +1,54 @@ +#include +#include +#include +#include +#include + +#include "kernel_Matrix21_update_step_first.h" +#include "memops.cuh" + +namespace cg = cooperative_groups; + +namespace caspar { + +__global__ void __launch_bounds__(1024, 1) + Matrix21UpdateStepFirstKernel(double* Matrix21_p_kp1, unsigned int Matrix21_p_kp1_num_alloc, + const double* const alpha, double* out_Matrix21_step_kp1, + unsigned int out_Matrix21_step_kp1_num_alloc, + size_t problem_size) { + const int global_thread_idx = blockIdx.x * blockDim.x + threadIdx.x; + __shared__ uint8_t inout_shared[8192]; + + double r0 = 0, r1 = 0, r2 = 0; + + if (global_thread_idx < problem_size) { + ReadIdx2<1024, double, double, double2>(Matrix21_p_kp1, 0 * Matrix21_p_kp1_num_alloc, + global_thread_idx, r0, r1); + }; + LoadUnique<1, double, double>(alpha, 0, (double*)inout_shared); + if (global_thread_idx < problem_size) { + ReadShared1((double*)inout_shared, 0, r2); + }; + __syncthreads(); + if (global_thread_idx < problem_size) { + r0 = r0 * r2; + r2 = r1 * r2; + WriteIdx2<1024, double, double, double2>( + out_Matrix21_step_kp1, 0 * out_Matrix21_step_kp1_num_alloc, global_thread_idx, r0, r2); + }; +} + +void Matrix21UpdateStepFirst(double* Matrix21_p_kp1, unsigned int Matrix21_p_kp1_num_alloc, + const double* const alpha, double* out_Matrix21_step_kp1, + unsigned int out_Matrix21_step_kp1_num_alloc, size_t problem_size) { + if (problem_size == 0) { + return; + } + + const int n_blocks = (problem_size + 1024 - 1) / 1024; + Matrix21UpdateStepFirstKernel<<>>(Matrix21_p_kp1, Matrix21_p_kp1_num_alloc, alpha, + out_Matrix21_step_kp1, + out_Matrix21_step_kp1_num_alloc, problem_size); +} + +} // namespace caspar \ No newline at end of file diff --git a/test/symforce_function_codegen_test_data/symengine/symforce_caspar_solver_test/kernel_Matrix21_update_step_first.h b/test/symforce_function_codegen_test_data/symengine/symforce_caspar_solver_test/kernel_Matrix21_update_step_first.h new file mode 100644 index 00000000..bbf51fa9 --- /dev/null +++ b/test/symforce_function_codegen_test_data/symengine/symforce_caspar_solver_test/kernel_Matrix21_update_step_first.h @@ -0,0 +1,13 @@ +#pragma once + +#include + +#include "shared_indices.h" + +namespace caspar { + +void Matrix21UpdateStepFirst(double* Matrix21_p_kp1, unsigned int Matrix21_p_kp1_num_alloc, + const double* const alpha, double* out_Matrix21_step_kp1, + unsigned int out_Matrix21_step_kp1_num_alloc, size_t problem_size); + +} // namespace caspar \ No newline at end of file diff --git a/test/symforce_function_codegen_test_data/symengine/symforce_caspar_solver_test/kernel_rosenbrock_jtjnjtr_direct.cu b/test/symforce_function_codegen_test_data/symengine/symforce_caspar_solver_test/kernel_rosenbrock_jtjnjtr_direct.cu new file mode 100644 index 00000000..2c85a23f --- /dev/null +++ b/test/symforce_function_codegen_test_data/symengine/symforce_caspar_solver_test/kernel_rosenbrock_jtjnjtr_direct.cu @@ -0,0 +1,34 @@ +#include +#include +#include +#include +#include + +#include "kernel_rosenbrock_jtjnjtr_direct.h" +#include "memops.cuh" + +namespace cg = cooperative_groups; + +namespace caspar { + +__global__ void __launch_bounds__(1024, 1) + RosenbrockJtjnjtrDirectKernel(double* x_njtr, unsigned int x_njtr_num_alloc, + SharedIndex* x_njtr_indices, double* x_jac, + unsigned int x_jac_num_alloc, double* const out_x_njtr, + unsigned int out_x_njtr_num_alloc, size_t problem_size) {} + +void RosenbrockJtjnjtrDirect(double* x_njtr, unsigned int x_njtr_num_alloc, + SharedIndex* x_njtr_indices, double* x_jac, + unsigned int x_jac_num_alloc, double* const out_x_njtr, + unsigned int out_x_njtr_num_alloc, size_t problem_size) { + if (problem_size == 0) { + return; + } + + const int n_blocks = (problem_size + 1024 - 1) / 1024; + RosenbrockJtjnjtrDirectKernel<<>>(x_njtr, x_njtr_num_alloc, x_njtr_indices, x_jac, + x_jac_num_alloc, out_x_njtr, + out_x_njtr_num_alloc, problem_size); +} + +} // namespace caspar \ No newline at end of file diff --git a/test/symforce_function_codegen_test_data/symengine/symforce_caspar_solver_test/kernel_rosenbrock_jtjnjtr_direct.h b/test/symforce_function_codegen_test_data/symengine/symforce_caspar_solver_test/kernel_rosenbrock_jtjnjtr_direct.h new file mode 100644 index 00000000..f0556d5f --- /dev/null +++ b/test/symforce_function_codegen_test_data/symengine/symforce_caspar_solver_test/kernel_rosenbrock_jtjnjtr_direct.h @@ -0,0 +1,14 @@ +#pragma once + +#include + +#include "shared_indices.h" + +namespace caspar { + +void RosenbrockJtjnjtrDirect(double* x_njtr, unsigned int x_njtr_num_alloc, + SharedIndex* x_njtr_indices, double* x_jac, + unsigned int x_jac_num_alloc, double* const out_x_njtr, + unsigned int out_x_njtr_num_alloc, size_t problem_size); + +} // namespace caspar \ No newline at end of file diff --git a/test/symforce_function_codegen_test_data/symengine/symforce_caspar_solver_test/kernel_rosenbrock_res_jac.cu b/test/symforce_function_codegen_test_data/symengine/symforce_caspar_solver_test/kernel_rosenbrock_res_jac.cu new file mode 100644 index 00000000..cae75c48 --- /dev/null +++ b/test/symforce_function_codegen_test_data/symengine/symforce_caspar_solver_test/kernel_rosenbrock_res_jac.cu @@ -0,0 +1,91 @@ +#include +#include +#include +#include +#include + +#include "kernel_rosenbrock_res_jac.h" +#include "memops.cuh" + +namespace cg = cooperative_groups; + +namespace caspar { + +__global__ void __launch_bounds__(1024, 1) + RosenbrockResJacKernel(double* x, unsigned int x_num_alloc, SharedIndex* x_indices, + double* out_res, unsigned int out_res_num_alloc, + double* const out_x_njtr, unsigned int out_x_njtr_num_alloc, + double* const out_x_precond_diag, + unsigned int out_x_precond_diag_num_alloc, + double* const out_x_precond_tril, + unsigned int out_x_precond_tril_num_alloc, size_t problem_size) { + const int global_thread_idx = blockIdx.x * blockDim.x + threadIdx.x; + __shared__ uint8_t inout_shared[16384]; + + __shared__ SharedIndex x_indices_loc[1024]; + x_indices_loc[threadIdx.x] = + (global_thread_idx < problem_size ? x_indices[global_thread_idx] + : SharedIndex{0xffffffff, 0xffff, 0xffff}); + + double r0 = 0, r1 = 0, r2 = 0, r3 = 0, r4 = 0, r5 = 0, r6 = 0, r7 = 0; + + if (global_thread_idx < problem_size) { + r0 = 1.00000000000000000e+01; + }; + LoadShared<2, double, double>(x, 0 * x_num_alloc, x_indices_loc, (double*)inout_shared); + if (global_thread_idx < problem_size) { + ReadShared2((double*)inout_shared, x_indices_loc[threadIdx.x].target, r1, r2); + }; + __syncthreads(); + if (global_thread_idx < problem_size) { + r3 = -1.00000000000000000e+00; + r4 = r1 * r1; + r2 = fma(r3, r4, r2); + r0 = r0 * r2; + r5 = 1.00000000000000000e+00; + r3 = fma(r1, r3, r5); + WriteIdx2<1024, double, double, double2>(out_res, 0 * out_res_num_alloc, global_thread_idx, r0, + r3); + r0 = -1.00000000000000000e+02; + r0 = r2 * r0; + r6 = r1 * r2; + r7 = 2.00000000000000000e+02; + r6 = fma(r7, r6, r3); + WriteSum2((double*)inout_shared, r6, r0); + }; + FlushSumShared<2, double>(out_x_njtr, 0 * out_x_njtr_num_alloc, x_indices_loc, + (double*)inout_shared); + if (global_thread_idx < problem_size) { + r0 = 1.00000000000000000e+02; + r6 = 4.00000000000000000e+02; + r4 = fma(r6, r4, r5); + WriteSum2((double*)inout_shared, r4, r0); + }; + FlushSumShared<2, double>(out_x_precond_diag, 0 * out_x_precond_diag_num_alloc, x_indices_loc, + (double*)inout_shared); + if (global_thread_idx < problem_size) { + r0 = -2.00000000000000000e+02; + r0 = r1 * r0; + WriteSum1((double*)inout_shared, r0); + }; + FlushSumShared<1, double>(out_x_precond_tril, 0 * out_x_precond_tril_num_alloc, x_indices_loc, + (double*)inout_shared); +} + +void RosenbrockResJac(double* x, unsigned int x_num_alloc, SharedIndex* x_indices, double* out_res, + unsigned int out_res_num_alloc, double* const out_x_njtr, + unsigned int out_x_njtr_num_alloc, double* const out_x_precond_diag, + unsigned int out_x_precond_diag_num_alloc, double* const out_x_precond_tril, + unsigned int out_x_precond_tril_num_alloc, size_t problem_size) { + if (problem_size == 0) { + return; + } + + const int n_blocks = (problem_size + 1024 - 1) / 1024; + RosenbrockResJacKernel<<>>(x, x_num_alloc, x_indices, out_res, out_res_num_alloc, + out_x_njtr, out_x_njtr_num_alloc, out_x_precond_diag, + out_x_precond_diag_num_alloc, out_x_precond_tril, + out_x_precond_tril_num_alloc, problem_size); +} + +} // namespace caspar \ No newline at end of file diff --git a/test/symforce_function_codegen_test_data/symengine/symforce_caspar_solver_test/kernel_rosenbrock_res_jac.h b/test/symforce_function_codegen_test_data/symengine/symforce_caspar_solver_test/kernel_rosenbrock_res_jac.h new file mode 100644 index 00000000..84617734 --- /dev/null +++ b/test/symforce_function_codegen_test_data/symengine/symforce_caspar_solver_test/kernel_rosenbrock_res_jac.h @@ -0,0 +1,15 @@ +#pragma once + +#include + +#include "shared_indices.h" + +namespace caspar { + +void RosenbrockResJac(double* x, unsigned int x_num_alloc, SharedIndex* x_indices, double* out_res, + unsigned int out_res_num_alloc, double* const out_x_njtr, + unsigned int out_x_njtr_num_alloc, double* const out_x_precond_diag, + unsigned int out_x_precond_diag_num_alloc, double* const out_x_precond_tril, + unsigned int out_x_precond_tril_num_alloc, size_t problem_size); + +} // namespace caspar \ No newline at end of file diff --git a/test/symforce_function_codegen_test_data/symengine/symforce_caspar_solver_test/kernel_rosenbrock_res_jac_first.cu b/test/symforce_function_codegen_test_data/symengine/symforce_caspar_solver_test/kernel_rosenbrock_res_jac_first.cu new file mode 100644 index 00000000..d1b9617c --- /dev/null +++ b/test/symforce_function_codegen_test_data/symengine/symforce_caspar_solver_test/kernel_rosenbrock_res_jac_first.cu @@ -0,0 +1,101 @@ +#include +#include +#include +#include +#include + +#include "kernel_rosenbrock_res_jac_first.h" +#include "memops.cuh" + +namespace cg = cooperative_groups; + +namespace caspar { + +__global__ void __launch_bounds__(1024, 1) + RosenbrockResJacFirstKernel(double* x, unsigned int x_num_alloc, SharedIndex* x_indices, + double* out_res, unsigned int out_res_num_alloc, + double* const out_rTr, double* const out_x_njtr, + unsigned int out_x_njtr_num_alloc, double* const out_x_precond_diag, + unsigned int out_x_precond_diag_num_alloc, + double* const out_x_precond_tril, + unsigned int out_x_precond_tril_num_alloc, size_t problem_size) { + const int global_thread_idx = blockIdx.x * blockDim.x + threadIdx.x; + __shared__ uint8_t inout_shared[16384]; + + __shared__ SharedIndex x_indices_loc[1024]; + x_indices_loc[threadIdx.x] = + (global_thread_idx < problem_size ? x_indices[global_thread_idx] + : SharedIndex{0xffffffff, 0xffff, 0xffff}); + + __shared__ double out_rTr_local[1]; + + double r0 = 0, r1 = 0, r2 = 0, r3 = 0, r4 = 0, r5 = 0, r6 = 0, r7 = 0, r8 = 0; + + if (global_thread_idx < problem_size) { + r0 = 1.00000000000000000e+01; + }; + LoadShared<2, double, double>(x, 0 * x_num_alloc, x_indices_loc, (double*)inout_shared); + if (global_thread_idx < problem_size) { + ReadShared2((double*)inout_shared, x_indices_loc[threadIdx.x].target, r1, r2); + }; + __syncthreads(); + if (global_thread_idx < problem_size) { + r3 = -1.00000000000000000e+00; + r4 = r1 * r1; + r2 = fma(r3, r4, r2); + r0 = r0 * r2; + r5 = 1.00000000000000000e+00; + r3 = fma(r1, r3, r5); + WriteIdx2<1024, double, double, double2>(out_res, 0 * out_res_num_alloc, global_thread_idx, r0, + r3); + r0 = 1.00000000000000000e+02; + r6 = r2 * r2; + r6 = fma(r0, r6, r3 * r3); + }; + SumStore(out_rTr_local, (double*)inout_shared, 0, global_thread_idx < problem_size, r6); + if (global_thread_idx < problem_size) { + r6 = -1.00000000000000000e+02; + r6 = r2 * r6; + r7 = r1 * r2; + r8 = 2.00000000000000000e+02; + r7 = fma(r8, r7, r3); + WriteSum2((double*)inout_shared, r7, r6); + }; + FlushSumShared<2, double>(out_x_njtr, 0 * out_x_njtr_num_alloc, x_indices_loc, + (double*)inout_shared); + if (global_thread_idx < problem_size) { + r6 = 4.00000000000000000e+02; + r4 = fma(r6, r4, r5); + WriteSum2((double*)inout_shared, r4, r0); + }; + FlushSumShared<2, double>(out_x_precond_diag, 0 * out_x_precond_diag_num_alloc, x_indices_loc, + (double*)inout_shared); + if (global_thread_idx < problem_size) { + r0 = -2.00000000000000000e+02; + r0 = r1 * r0; + WriteSum1((double*)inout_shared, r0); + }; + FlushSumShared<1, double>(out_x_precond_tril, 0 * out_x_precond_tril_num_alloc, x_indices_loc, + (double*)inout_shared); + SumFlushFinal(out_rTr_local, out_rTr, 1); +} + +void RosenbrockResJacFirst(double* x, unsigned int x_num_alloc, SharedIndex* x_indices, + double* out_res, unsigned int out_res_num_alloc, double* const out_rTr, + double* const out_x_njtr, unsigned int out_x_njtr_num_alloc, + double* const out_x_precond_diag, + unsigned int out_x_precond_diag_num_alloc, + double* const out_x_precond_tril, + unsigned int out_x_precond_tril_num_alloc, size_t problem_size) { + if (problem_size == 0) { + return; + } + + const int n_blocks = (problem_size + 1024 - 1) / 1024; + RosenbrockResJacFirstKernel<<>>( + x, x_num_alloc, x_indices, out_res, out_res_num_alloc, out_rTr, out_x_njtr, + out_x_njtr_num_alloc, out_x_precond_diag, out_x_precond_diag_num_alloc, out_x_precond_tril, + out_x_precond_tril_num_alloc, problem_size); +} + +} // namespace caspar \ No newline at end of file diff --git a/test/symforce_function_codegen_test_data/symengine/symforce_caspar_solver_test/kernel_rosenbrock_res_jac_first.h b/test/symforce_function_codegen_test_data/symengine/symforce_caspar_solver_test/kernel_rosenbrock_res_jac_first.h new file mode 100644 index 00000000..c2186b6e --- /dev/null +++ b/test/symforce_function_codegen_test_data/symengine/symforce_caspar_solver_test/kernel_rosenbrock_res_jac_first.h @@ -0,0 +1,17 @@ +#pragma once + +#include + +#include "shared_indices.h" + +namespace caspar { + +void RosenbrockResJacFirst(double* x, unsigned int x_num_alloc, SharedIndex* x_indices, + double* out_res, unsigned int out_res_num_alloc, double* const out_rTr, + double* const out_x_njtr, unsigned int out_x_njtr_num_alloc, + double* const out_x_precond_diag, + unsigned int out_x_precond_diag_num_alloc, + double* const out_x_precond_tril, + unsigned int out_x_precond_tril_num_alloc, size_t problem_size); + +} // namespace caspar \ No newline at end of file diff --git a/test/symforce_function_codegen_test_data/symengine/symforce_caspar_solver_test/kernel_rosenbrock_score.cu b/test/symforce_function_codegen_test_data/symengine/symforce_caspar_solver_test/kernel_rosenbrock_score.cu new file mode 100644 index 00000000..047b7ec0 --- /dev/null +++ b/test/symforce_function_codegen_test_data/symengine/symforce_caspar_solver_test/kernel_rosenbrock_score.cu @@ -0,0 +1,60 @@ +#include +#include +#include +#include +#include + +#include "kernel_rosenbrock_score.h" +#include "memops.cuh" + +namespace cg = cooperative_groups; + +namespace caspar { + +__global__ void __launch_bounds__(1024, 1) + RosenbrockScoreKernel(double* x, unsigned int x_num_alloc, SharedIndex* x_indices, + double* const out_rTr, size_t problem_size) { + const int global_thread_idx = blockIdx.x * blockDim.x + threadIdx.x; + __shared__ uint8_t inout_shared[16384]; + + __shared__ SharedIndex x_indices_loc[1024]; + x_indices_loc[threadIdx.x] = + (global_thread_idx < problem_size ? x_indices[global_thread_idx] + : SharedIndex{0xffffffff, 0xffff, 0xffff}); + + __shared__ double out_rTr_local[1]; + + double r0 = 0, r1 = 0, r2 = 0, r3 = 0, r4 = 0; + + if (global_thread_idx < problem_size) { + r0 = 1.00000000000000000e+00; + }; + LoadShared<2, double, double>(x, 0 * x_num_alloc, x_indices_loc, (double*)inout_shared); + if (global_thread_idx < problem_size) { + ReadShared2((double*)inout_shared, x_indices_loc[threadIdx.x].target, r1, r2); + }; + __syncthreads(); + if (global_thread_idx < problem_size) { + r3 = -1.00000000000000000e+00; + r0 = fma(r1, r3, r0); + r4 = 1.00000000000000000e+02; + r1 = r1 * r1; + r1 = fma(r3, r1, r2); + r1 = r1 * r1; + r1 = fma(r4, r1, r0 * r0); + }; + SumStore(out_rTr_local, (double*)inout_shared, 0, global_thread_idx < problem_size, r1); + SumFlushFinal(out_rTr_local, out_rTr, 1); +} + +void RosenbrockScore(double* x, unsigned int x_num_alloc, SharedIndex* x_indices, + double* const out_rTr, size_t problem_size) { + if (problem_size == 0) { + return; + } + + const int n_blocks = (problem_size + 1024 - 1) / 1024; + RosenbrockScoreKernel<<>>(x, x_num_alloc, x_indices, out_rTr, problem_size); +} + +} // namespace caspar \ No newline at end of file diff --git a/test/symforce_function_codegen_test_data/symengine/symforce_caspar_solver_test/kernel_rosenbrock_score.h b/test/symforce_function_codegen_test_data/symengine/symforce_caspar_solver_test/kernel_rosenbrock_score.h new file mode 100644 index 00000000..aee00b4e --- /dev/null +++ b/test/symforce_function_codegen_test_data/symengine/symforce_caspar_solver_test/kernel_rosenbrock_score.h @@ -0,0 +1,12 @@ +#pragma once + +#include + +#include "shared_indices.h" + +namespace caspar { + +void RosenbrockScore(double* x, unsigned int x_num_alloc, SharedIndex* x_indices, + double* const out_rTr, size_t problem_size); + +} // namespace caspar \ No newline at end of file diff --git a/test/symforce_function_codegen_test_data/symengine/symforce_caspar_solver_test/solver.cc b/test/symforce_function_codegen_test_data/symengine/symforce_caspar_solver_test/solver.cc new file mode 100644 index 00000000..1bfb4c03 --- /dev/null +++ b/test/symforce_function_codegen_test_data/symengine/symforce_caspar_solver_test/solver.cc @@ -0,0 +1,560 @@ +#include "solver.h" + +#include +#include +#include + +#include "caspar_mappings.h" +#include "kernel_Matrix21_alpha_denominator_or_beta_numerator.h" +#include "kernel_Matrix21_alpha_numerator_denominator.h" +#include "kernel_Matrix21_normalize.h" +#include "kernel_Matrix21_pred_decrease_times_two.h" +#include "kernel_Matrix21_retract.h" +#include "kernel_Matrix21_start_w.h" +#include "kernel_Matrix21_start_w_contribute.h" +#include "kernel_Matrix21_update_Mp.h" +#include "kernel_Matrix21_update_p.h" +#include "kernel_Matrix21_update_r.h" +#include "kernel_Matrix21_update_r_first.h" +#include "kernel_Matrix21_update_step.h" +#include "kernel_Matrix21_update_step_first.h" +#include "kernel_rosenbrock_jtjnjtr_direct.h" +#include "kernel_rosenbrock_res_jac.h" +#include "kernel_rosenbrock_res_jac_first.h" +#include "kernel_rosenbrock_score.h" +#include "shared_indices.h" +#include "solver_tools.h" +#include "sort_indices.h" + +namespace { + +void make_aligned(size_t& offset, size_t alignment_bytes) { + offset = ((offset + alignment_bytes - 1) / alignment_bytes) * alignment_bytes; +} + +template +void increment_offset(size_t& offset, size_t num_elements, size_t alignment_elements) { + make_aligned(offset, alignment_elements * sizeof(T)); + offset += num_elements * sizeof(T); +} + +template +T* assign_and_increment(uint8_t* origin_ptr, size_t& offset, size_t num_elements, + size_t alignment_elements) { + make_aligned(offset, alignment_elements * sizeof(T)); + size_t old_offset = offset; + offset += num_elements * sizeof(T); + return reinterpret_cast(origin_ptr + old_offset); +} + +} // namespace + +namespace caspar { + +GraphSolver::GraphSolver(const SolverParams& params, size_t Matrix21_num_max, + size_t rosenbrock_num_max, int device_id) + : params_(params), + device_id_(device_id), + Matrix21_num_(Matrix21_num_max), + Matrix21_num_max_(Matrix21_num_max), + rosenbrock_num_(rosenbrock_num_max), + rosenbrock_num_max_(rosenbrock_num_max) { + indices_valid_ = false; + if (params.pcg_rel_error_exit <= 0.0f) { + throw std::runtime_error("params.pcg_rel_error_exit must be positive"); + } + if (params.diag_init < 0.0f) { + throw std::runtime_error("params.diag_init must be positive"); + } + if (params.pcg_iter_max < 1) { + throw std::runtime_error("params.pcg_iter_max must be at least 1"); + } + allocation_size_ = get_nbytes(); + + if (device_id_ < 0) { + throw std::runtime_error("Invalid CUDA device id: " + std::to_string(device_id_)); + } + if (device_id_ != 0) { + int deviceCount; + cudaGetDeviceCount(&deviceCount); + if (deviceCount <= device_id_) { + throw std::runtime_error("CUDA detected " + std::to_string(deviceCount) + + " devices, but device " + std::to_string(device_id_) + + " was requested (0-indexed)"); + } + } + cudaSetDevice(device_id_); + cudaMalloc(&origin_ptr_, allocation_size_); + + size_t offset = 0; + marker__start_ = assign_and_increment(origin_ptr_, offset, 0 * 0, 4); + nodes__Matrix21__storage_current_ = + assign_and_increment(origin_ptr_, offset, 2 * Matrix21_num_, 4); + nodes__Matrix21__storage_check_ = + assign_and_increment(origin_ptr_, offset, 2 * Matrix21_num_, 4); + nodes__Matrix21__storage_new_best_ = + assign_and_increment(origin_ptr_, offset, 2 * Matrix21_num_, 4); + facs__rosenbrock__args__x__idx_shared_ = + assign_and_increment(origin_ptr_, offset, 1 * rosenbrock_num_, 4); + marker__scratch_inout_ = assign_and_increment(origin_ptr_, offset, 0 * 0, 4); + facs__rosenbrock__res_ = + assign_and_increment(origin_ptr_, offset, 2 * rosenbrock_num_, 4); + facs__rosenbrock__args__x__jac_ = + assign_and_increment(origin_ptr_, offset, 1 * rosenbrock_num_, 4); + nodes__Matrix21__z_ = assign_and_increment(origin_ptr_, offset, 2 * Matrix21_num_, 4); + nodes__Matrix21__z_end__ = assign_and_increment(origin_ptr_, offset, 0 * 0, 4); + nodes__Matrix21__p_ = assign_and_increment(origin_ptr_, offset, 2 * Matrix21_num_, 4); + nodes__Matrix21__p_end__ = assign_and_increment(origin_ptr_, offset, 0 * 0, 4); + nodes__Matrix21__step_ = assign_and_increment(origin_ptr_, offset, 2 * Matrix21_num_, 4); + nodes__Matrix21__step_end__ = assign_and_increment(origin_ptr_, offset, 0 * 0, 4); + marker__w_start_ = assign_and_increment(origin_ptr_, offset, 0 * 0, 4); + nodes__Matrix21__w_ = assign_and_increment(origin_ptr_, offset, 2 * Matrix21_num_, 4); + marker__w_end_ = assign_and_increment(origin_ptr_, offset, 0 * 0, 1); + marker__r_0_start_ = assign_and_increment(origin_ptr_, offset, 0 * 0, 4); + nodes__Matrix21__r_0_ = assign_and_increment(origin_ptr_, offset, 2 * Matrix21_num_, 4); + marker__r_0_end_ = assign_and_increment(origin_ptr_, offset, 0 * 0, 4); + marker__r_k_start_ = assign_and_increment(origin_ptr_, offset, 0 * 0, 4); + nodes__Matrix21__r_k_ = assign_and_increment(origin_ptr_, offset, 2 * Matrix21_num_, 4); + marker__r_k_end_ = assign_and_increment(origin_ptr_, offset, 0 * 0, 4); + marker__Mp_start_ = assign_and_increment(origin_ptr_, offset, 0 * 0, 4); + nodes__Matrix21__Mp_ = assign_and_increment(origin_ptr_, offset, 2 * Matrix21_num_, 4); + marker__Mp_end_ = assign_and_increment(origin_ptr_, offset, 0 * 0, 4); + marker__precond_start_ = assign_and_increment(origin_ptr_, offset, 0 * 0, 4); + nodes__Matrix21__precond_diag_ = + assign_and_increment(origin_ptr_, offset, 2 * Matrix21_num_, 4); + nodes__Matrix21__precond_tril_ = + assign_and_increment(origin_ptr_, offset, 1 * Matrix21_num_, 4); + marker__precond_end_ = assign_and_increment(origin_ptr_, offset, 0 * 0, 1); + marker__jp_start_ = assign_and_increment(origin_ptr_, offset, 0 * 0, 4); + facs__rosenbrock__jp_ = assign_and_increment(origin_ptr_, offset, 2 * rosenbrock_num_, 4); + marker__jp_end_ = assign_and_increment(origin_ptr_, offset, 0 * 0, 1); + solver__current_diag_ = assign_and_increment(origin_ptr_, offset, 1 * 1, 1); + solver__alpha_numerator_ = assign_and_increment(origin_ptr_, offset, 1 * 1, 1); + solver__alpha_denominator_ = assign_and_increment(origin_ptr_, offset, 1 * 1, 1); + solver__alpha_ = assign_and_increment(origin_ptr_, offset, 1 * 1, 1); + solver__neg_alpha_ = assign_and_increment(origin_ptr_, offset, 1 * 1, 1); + solver__beta_numerator_ = assign_and_increment(origin_ptr_, offset, 1 * 1, 1); + solver__beta_ = assign_and_increment(origin_ptr_, offset, 1 * 1, 1); + solver__r_0_norm2_tot_ = assign_and_increment(origin_ptr_, offset, 1 * 1, 1); + solver__r_kp1_norm2_tot_ = assign_and_increment(origin_ptr_, offset, 1 * 1, 1); + solver__pred_decrease_tot_ = assign_and_increment(origin_ptr_, offset, 1 * 1, 1); + solver__res_tot_ = assign_and_increment(origin_ptr_, offset, 1 * 1, 1); + + scratch_inout_size_ = offset; // sorting, sum, +} + +GraphSolver::~GraphSolver() { + cudaSetDevice(device_id_); + cudaFree(origin_ptr_); +} + +void GraphSolver::set_params(const SolverParams& params) { + this->params_ = params; +} + +size_t GraphSolver::get_allocation_size() { + return allocation_size_; +} + +SolveResult GraphSolver::solve(bool print_progress, bool verbose_logging) { + cudaSetDevice(device_id_); + SolveResult result; + result.exit_reason = ExitReason::MAX_ITERATIONS; + double score_best; + double score_best_pcg; + double diag = params_.diag_init; + cudaMemcpy(solver__current_diag_, &diag, sizeof(double), cudaMemcpyHostToDevice); + + double up_scale = params_.diag_scaling_up; + double quality; + + std::chrono::time_point t0 = std::chrono::steady_clock::now(); + std::chrono::time_point t_prev = t0; + score_best = DoResJacFirst(); + result.initial_score = score_best; + if (print_progress) { + printf(" score_init: % .6e\n", score_best); + } + + for (solver_iter_ = 0; solver_iter_ < params_.solver_iter_max; solver_iter_++) { + if (solver_iter_ != 0) { + DoResJac(); + } + score_best_pcg = score_best; + // The inner loop can break before storing a proposal in storage_new_best_. + bool have_pcg_proposal = false; + for (pcg_iter_ = 0; pcg_iter_ < params_.pcg_iter_max; pcg_iter_++) { + DoNormalize(); + + if (pcg_iter_ == 0) { + Copy(marker__r_k_start_, marker__r_k_end_, marker__w_start_); + DoJtjpDirect(); + DoAlphaFirst(); + DoUpdateStepFirst(); + DoUpdateRFirst(); + } else { + DoBeta(); + DoUpdateP(); + DoUpdateMp(); + DoJtjpDirect(); + DoAlpha(); + DoUpdateStep(); + DoUpdateR(); + } + if (params_.pcg_rel_decrease_min != -1.0f || params_.pcg_rel_score_exit != -1.0f) { + double score_new_pcg = DoRetractScore(); + if (!(score_new_pcg <= score_best_pcg * params_.pcg_rel_decrease_min)) { + break; + } + std::swap(nodes__Matrix21__storage_check_, nodes__Matrix21__storage_new_best_); + score_best_pcg = score_new_pcg; + have_pcg_proposal = true; + if (params_.pcg_rel_score_exit != -1.0f && + score_best_pcg < score_best * params_.pcg_rel_score_exit) { + break; + } + } + if (pcg_r_kp1_norm2_ < pcg_r_0_norm2_ * params_.pcg_rel_error_exit) { + break; + } + } + pcg_iter_ = std::min(pcg_iter_, params_.pcg_iter_max - 1); + + if (params_.pcg_rel_decrease_min == -1.0f && params_.pcg_rel_score_exit == -1.0f) { + score_best_pcg = DoRetractScore(); + std::swap(nodes__Matrix21__storage_check_, nodes__Matrix21__storage_new_best_); + have_pcg_proposal = true; + } + + const double diag_current = diag; + bool step_accepted = false; + if (have_pcg_proposal && score_best_pcg < score_best * params_.solver_rel_decrease_min) { + quality = (score_best - score_best_pcg) / GetPredDecrease(); + const double quality_tmp = 2 * quality - 1; + double scale = + std::max(params_.diag_scaling_down, 1.0f - quality_tmp * quality_tmp * quality_tmp); + diag = std::max(params_.diag_min, diag * scale); + cudaMemcpy(solver__current_diag_, &diag, sizeof(double), cudaMemcpyHostToDevice); + up_scale = params_.diag_scaling_up; + score_best = score_best_pcg; + step_accepted = true; + std::swap(nodes__Matrix21__storage_current_, nodes__Matrix21__storage_new_best_); + + } else { + quality = 0.0f; + diag = diag * up_scale; + if (diag > params_.diag_exit_value) { + result.exit_reason = ExitReason::CONVERGED_DIAG_EXIT; + break; + } + cudaMemcpy(solver__current_diag_, &diag, sizeof(double), cudaMemcpyHostToDevice); + up_scale *= 2; + } + const auto t_now = std::chrono::steady_clock::now(); + const double dt_inc = std::chrono::duration(t_now - t_prev).count(); + const double dt_tot = std::chrono::duration(t_now - t0).count(); + + if (verbose_logging) { + IterationData iter_data; + iter_data.solver_iter = solver_iter_; + iter_data.pcg_iter = pcg_iter_; + iter_data.score_current = score_best_pcg; + iter_data.score_best = score_best; + iter_data.step_quality = quality; + iter_data.diag = diag_current; + iter_data.dt_inc = dt_inc; + iter_data.dt_tot = dt_tot; + iter_data.step_accepted = step_accepted; + result.iterations.push_back(iter_data); + } + + if (print_progress) { + printf("solver_iter: % 3d ", solver_iter_); + printf("pcg_iter: % 3d ", pcg_iter_); + printf("score_current: % 13.6e ", score_best_pcg); + printf("score_best: % 13.6e ", score_best); + printf("step_quality: % 7.3f ", quality); + printf("diag: % 6.3e ", diag_current); + printf("dt_inc: % 10.6f ", dt_inc); + printf("dt_tot: % 10.6f ", dt_tot); + t_prev = t_now; + printf("\n"); + } + if (score_best <= params_.score_exit_value) { + result.exit_reason = ExitReason::CONVERGED_SCORE_THRESHOLD; + break; + } + } + + const auto t_final = std::chrono::steady_clock::now(); + result.final_score = score_best; + result.iteration_count = solver_iter_; + result.runtime = std::chrono::duration(t_final - t0).count(); + return result; +} + +double GraphSolver::DoResJacFirst() { + Zero(solver__res_tot_, solver__res_tot_ + 1); + Zero(marker__r_0_start_, marker__precond_end_); + + RosenbrockResJacFirst( + nodes__Matrix21__storage_current_, Matrix21_num_max_, facs__rosenbrock__args__x__idx_shared_, + + facs__rosenbrock__res_, rosenbrock_num_, solver__res_tot_, nodes__Matrix21__r_k_, + Matrix21_num_, nodes__Matrix21__precond_diag_, Matrix21_num_, nodes__Matrix21__precond_tril_, + Matrix21_num_, rosenbrock_num_); + Copy(marker__r_k_start_, marker__r_k_end_, marker__r_0_start_); + Copy(marker__r_k_start_, marker__r_k_end_, marker__Mp_start_); + return 0.5 * ReadCuMem(solver__res_tot_); +} +void GraphSolver::DoResJac() { + Zero(solver__res_tot_, solver__res_tot_ + 1); + Zero(marker__r_0_start_, marker__precond_end_); + + RosenbrockResJac(nodes__Matrix21__storage_current_, Matrix21_num_max_, + facs__rosenbrock__args__x__idx_shared_, + + facs__rosenbrock__res_, rosenbrock_num_, + + nodes__Matrix21__r_k_, Matrix21_num_, nodes__Matrix21__precond_diag_, + Matrix21_num_, nodes__Matrix21__precond_tril_, Matrix21_num_, rosenbrock_num_); + Copy(marker__r_k_start_, marker__r_k_end_, marker__r_0_start_); + Copy(marker__r_k_start_, marker__r_k_end_, marker__Mp_start_); +} + +void GraphSolver::DoNormalize() { + double* z; + z = pcg_iter_ == 0 ? nodes__Matrix21__p_ : nodes__Matrix21__z_; + Matrix21Normalize(nodes__Matrix21__precond_diag_, Matrix21_num_, nodes__Matrix21__precond_tril_, + Matrix21_num_, nodes__Matrix21__r_k_, Matrix21_num_, solver__current_diag_, z, + Matrix21_num_, Matrix21_num_); +} + +void GraphSolver::DoUpdateMp() { + Matrix21UpdateMp(nodes__Matrix21__r_k_, Matrix21_num_, nodes__Matrix21__Mp_, Matrix21_num_, + solver__beta_, nodes__Matrix21__Mp_, Matrix21_num_, nodes__Matrix21__w_, + Matrix21_num_, Matrix21_num_); +} + +void GraphSolver::DoJtjpDirect() {} + +void GraphSolver::DoAlphaFirst() { + Zero(solver__alpha_numerator_, solver__alpha_denominator_ + 1); + Matrix21AlphaNumeratorDenominator( + nodes__Matrix21__p_, Matrix21_num_, nodes__Matrix21__r_k_, Matrix21_num_, nodes__Matrix21__w_, + Matrix21_num_, solver__alpha_numerator_, solver__alpha_denominator_, Matrix21_num_); + + AlphaFromNumDenom(solver__alpha_numerator_, solver__alpha_denominator_, solver__alpha_, + solver__neg_alpha_); +} + +void GraphSolver::DoAlpha() { + Zero(solver__alpha_denominator_, solver__alpha_denominator_ + 1); + Matrix21AlphaDenominatorOrBetaNumerator(nodes__Matrix21__p_, Matrix21_num_, nodes__Matrix21__w_, + Matrix21_num_, solver__alpha_denominator_, Matrix21_num_); + + AlphaFromNumDenom(solver__beta_numerator_, solver__alpha_denominator_, solver__alpha_, + solver__neg_alpha_); +} + +void GraphSolver::DoUpdateStepFirst() { + Matrix21UpdateStepFirst(nodes__Matrix21__p_, Matrix21_num_, solver__alpha_, + nodes__Matrix21__step_, Matrix21_num_, Matrix21_num_); +} + +void GraphSolver::DoUpdateStep() { + Matrix21UpdateStep(nodes__Matrix21__step_, Matrix21_num_, nodes__Matrix21__p_, Matrix21_num_, + solver__alpha_, nodes__Matrix21__step_, Matrix21_num_, Matrix21_num_); +} + +void GraphSolver::DoUpdateRFirst() { + Zero(solver__r_0_norm2_tot_, solver__r_0_norm2_tot_ + 1); + + Matrix21UpdateRFirst(nodes__Matrix21__r_k_, Matrix21_num_, nodes__Matrix21__w_, Matrix21_num_, + solver__neg_alpha_, nodes__Matrix21__r_k_, Matrix21_num_, + solver__r_0_norm2_tot_, solver__r_kp1_norm2_tot_, Matrix21_num_); + + pcg_r_0_norm2_ = ReadCuMem(solver__r_0_norm2_tot_); + pcg_r_kp1_norm2_ = ReadCuMem(solver__r_kp1_norm2_tot_); +} + +void GraphSolver::DoUpdateR() { + Zero(solver__r_kp1_norm2_tot_, solver__r_kp1_norm2_tot_ + 1); + + Matrix21UpdateR(nodes__Matrix21__r_k_, Matrix21_num_, nodes__Matrix21__w_, Matrix21_num_, + solver__neg_alpha_, nodes__Matrix21__r_k_, Matrix21_num_, + solver__r_kp1_norm2_tot_, Matrix21_num_); + pcg_r_kp1_norm2_ = ReadCuMem(solver__r_kp1_norm2_tot_); +} + +double GraphSolver::DoRetractScore() { + Matrix21Retract(nodes__Matrix21__storage_current_, Matrix21_num_max_, nodes__Matrix21__step_, + Matrix21_num_, nodes__Matrix21__storage_check_, Matrix21_num_max_, Matrix21_num_); + Zero(solver__res_tot_, solver__res_tot_ + 1); + RosenbrockScore(nodes__Matrix21__storage_check_, Matrix21_num_max_, + facs__rosenbrock__args__x__idx_shared_, solver__res_tot_, rosenbrock_num_); + return 0.5 * ReadCuMem(solver__res_tot_); +} + +void GraphSolver::DoBeta() { + Zero(solver__beta_numerator_, solver__beta_numerator_ + 1); + + Matrix21AlphaDenominatorOrBetaNumerator(nodes__Matrix21__r_k_, Matrix21_num_, nodes__Matrix21__z_, + Matrix21_num_, solver__beta_numerator_, Matrix21_num_); + BetaFromNumDenom(solver__beta_numerator_, solver__alpha_numerator_, solver__beta_); +} + +void GraphSolver::DoUpdateP() { + Matrix21UpdateP(nodes__Matrix21__z_, Matrix21_num_, nodes__Matrix21__p_, Matrix21_num_, + solver__beta_, nodes__Matrix21__p_, Matrix21_num_, Matrix21_num_); +} + +double GraphSolver::GetPredDecrease() { + Zero(solver__pred_decrease_tot_, solver__pred_decrease_tot_ + 1); + Matrix21PredDecreaseTimesTwo(nodes__Matrix21__step_, Matrix21_num_, + nodes__Matrix21__precond_diag_, Matrix21_num_, solver__current_diag_, + nodes__Matrix21__r_0_, Matrix21_num_, solver__pred_decrease_tot_, + Matrix21_num_); + return 0.5 * ReadCuMem(solver__pred_decrease_tot_); +} + +void GraphSolver::finish_indices() { + indices_valid_ = true; +} + +void GraphSolver::SetMatrix21Num(const size_t num) { + cudaSetDevice(device_id_); + if (num > Matrix21_num_max_) { + throw std::runtime_error(std::to_string(num) + " > Matrix21_num_max_"); + } + Matrix21_num_ = num; +} + +void GraphSolver::SetMatrix21NodesFromStackedHost(const double* const data, const size_t offset, + const size_t num) { + cudaSetDevice(device_id_); + if (offset + num > Matrix21_num_) { + throw std::runtime_error(std::to_string(offset + num) + " > Matrix21_num_"); + } + cudaMemcpy(marker__scratch_inout_, data, 2 * num * sizeof(double), cudaMemcpyHostToDevice); + Matrix21StackedToCaspar(marker__scratch_inout_, nodes__Matrix21__storage_current_, + Matrix21_num_max_, offset, num); +} + +void GraphSolver::SetMatrix21NodesFromStackedDevice(const double* const data, const size_t offset, + const size_t num) { + cudaSetDevice(device_id_); + if (offset + num > Matrix21_num_) { + throw std::runtime_error(std::to_string(offset + num) + " > Matrix21_num_"); + } + Matrix21StackedToCaspar(data, nodes__Matrix21__storage_current_, Matrix21_num_max_, offset, num); +} + +void GraphSolver::GetMatrix21NodesToStackedHost(double* const data, const size_t offset, + const size_t num) { + cudaSetDevice(device_id_); + if (offset + num > Matrix21_num_) { + throw std::runtime_error(std::to_string(offset + num) + " > Matrix21_num_"); + } + Matrix21CasparToStacked(nodes__Matrix21__storage_current_, marker__scratch_inout_, + Matrix21_num_max_, offset, num); + cudaMemcpy(data, marker__scratch_inout_, 2 * num * sizeof(double), cudaMemcpyDeviceToHost); +} + +void GraphSolver::GetMatrix21NodesToStackedDevice(double* const data, const size_t offset, + const size_t num) { + cudaSetDevice(device_id_); + if (offset + num > Matrix21_num_) { + throw std::runtime_error(std::to_string(offset + num) + " > Matrix21_num_"); + } + Matrix21CasparToStacked(nodes__Matrix21__storage_current_, data, Matrix21_num_max_, offset, num); +} + +void GraphSolver::SetRosenbrockNum(const size_t num) { + if (num > rosenbrock_num_max_) { + throw std::runtime_error(std::to_string(num) + " > rosenbrock_num_max_"); + } + rosenbrock_num_ = num; +} +void GraphSolver::SetRosenbrockXIndicesFromHost(const unsigned int* const indices, size_t num) { + cudaSetDevice(device_id_); + if (num != rosenbrock_num_) { + throw std::runtime_error(std::to_string(num) + + " != rosenbrock_num_. Use SetrosenbrockNum before setting indices."); + } + cudaMemcpy((unsigned int*)marker__scratch_inout_, indices, num * sizeof(unsigned int), + cudaMemcpyHostToDevice); + SetRosenbrockXIndicesFromDevice((unsigned int*)marker__scratch_inout_, num); +} + +void GraphSolver::SetRosenbrockXIndicesFromDevice(const unsigned int* const indices, size_t num) { + indices_valid_ = false; + cudaSetDevice(device_id_); + + if (num != rosenbrock_num_) { + throw std::runtime_error(std::to_string(num) + + " != rosenbrock_num_. Use SetrosenbrockNum before setting indices."); + } + + size_t tmp_size = SortIndicesGetTmpNbytes(num); + if (tmp_size + num > scratch_inout_size_) { + throw std::runtime_error("Scratch_inout_size too small. tmp_size: " + std::to_string(tmp_size) + + ", num: " + std::to_string(num) + + ", scratch_inout_size_: " + std::to_string(scratch_inout_size_)); + } + SharedIndices(indices, facs__rosenbrock__args__x__idx_shared_, num); +} + +size_t GraphSolver::get_nbytes() { + size_t offset = 0; + size_t at_least = 0; + increment_offset(offset, 0 * 0, 4); + increment_offset(offset, 2 * Matrix21_num_, 4); + increment_offset(offset, 2 * Matrix21_num_, 4); + increment_offset(offset, 2 * Matrix21_num_, 4); + increment_offset(offset, 1 * rosenbrock_num_, 4); + at_least = std::max(at_least, offset + std::max({2 * Matrix21_num_max_}) * sizeof(double)); + increment_offset(offset, 0 * 0, 4); + increment_offset(offset, 2 * rosenbrock_num_, 4); + increment_offset(offset, 1 * rosenbrock_num_, 4); + increment_offset(offset, 2 * Matrix21_num_, 4); + increment_offset(offset, 0 * 0, 4); + increment_offset(offset, 2 * Matrix21_num_, 4); + increment_offset(offset, 0 * 0, 4); + increment_offset(offset, 2 * Matrix21_num_, 4); + increment_offset(offset, 0 * 0, 4); + increment_offset(offset, 0 * 0, 4); + increment_offset(offset, 2 * Matrix21_num_, 4); + increment_offset(offset, 0 * 0, 1); + increment_offset(offset, 0 * 0, 4); + increment_offset(offset, 2 * Matrix21_num_, 4); + increment_offset(offset, 0 * 0, 4); + increment_offset(offset, 0 * 0, 4); + increment_offset(offset, 2 * Matrix21_num_, 4); + increment_offset(offset, 0 * 0, 4); + increment_offset(offset, 0 * 0, 4); + increment_offset(offset, 2 * Matrix21_num_, 4); + increment_offset(offset, 0 * 0, 4); + increment_offset(offset, 0 * 0, 4); + increment_offset(offset, 2 * Matrix21_num_, 4); + increment_offset(offset, 1 * Matrix21_num_, 4); + increment_offset(offset, 0 * 0, 1); + increment_offset(offset, 0 * 0, 4); + increment_offset(offset, 2 * rosenbrock_num_, 4); + increment_offset(offset, 0 * 0, 1); + increment_offset(offset, 1 * 1, 1); + increment_offset(offset, 1 * 1, 1); + increment_offset(offset, 1 * 1, 1); + increment_offset(offset, 1 * 1, 1); + increment_offset(offset, 1 * 1, 1); + increment_offset(offset, 1 * 1, 1); + increment_offset(offset, 1 * 1, 1); + increment_offset(offset, 1 * 1, 1); + increment_offset(offset, 1 * 1, 1); + increment_offset(offset, 1 * 1, 1); + increment_offset(offset, 1 * 1, 1); + + return std::max(offset, at_least); +} + +} // namespace caspar \ No newline at end of file diff --git a/test/symforce_function_codegen_test_data/symengine/symforce_caspar_solver_test/solver.h b/test/symforce_function_codegen_test_data/symengine/symforce_caspar_solver_test/solver.h new file mode 100644 index 00000000..247055a1 --- /dev/null +++ b/test/symforce_function_codegen_test_data/symengine/symforce_caspar_solver_test/solver.h @@ -0,0 +1,223 @@ +#pragma once + +#include +#include + +#include + +#include "shared_indices.h" +#include "solver_params.h" + +namespace caspar { + +enum class ExitReason { MAX_ITERATIONS, CONVERGED_SCORE_THRESHOLD, CONVERGED_DIAG_EXIT }; + +struct IterationData { + int solver_iter; + int pcg_iter; + double score_current; + double score_best; + double step_quality; + double diag; + double dt_inc; + double dt_tot; + bool step_accepted; +}; + +struct SolveResult { + double initial_score; + double final_score; + int iteration_count; + double runtime; + ExitReason exit_reason; + std::vector iterations; +}; + +class GraphSolver { + public: + /** + * Base constructor. + * + * @param params: The params to use for the solver + * @param Matrix21_num_max the maximum number of Matrix21s + * @param rosenbrock_num_max the maximum number of rosenbrocks + */ + GraphSolver(const SolverParams& params, size_t Matrix21_num_max, + size_t rosenbrock_num_max, int device_id = 0); + + // This class is managing cuda memory and cannot be copied. + GraphSolver(const GraphSolver&) = delete; + GraphSolver& operator=(const GraphSolver&) = delete; + + GraphSolver(GraphSolver&&) = default; + GraphSolver& operator=(GraphSolver&&) = default; + + ~GraphSolver(); + + /** + * Set the solver parameters. + */ + void set_params(const SolverParams& params); + + /** + * Run the solver. + */ + SolveResult solve(bool print_progress = false, bool verbose_logging = false); + + /** + * Finish the indices. + * + * This function has to be called after all indices are set and before the + * solve function is called. + */ + void finish_indices(); + + /** + * Get the number of allocated bytes. + */ + size_t get_allocation_size(); + + /** + * Set the current value for the Matrix21 nodes from the stacked host data. + * + * The offset can be used to start writing at a specific index. + */ + void SetMatrix21NodesFromStackedHost(const double* const data, size_t offset, size_t num); + + /** + * Set the current value for the Matrix21 nodes from the stacked device data. + * + * The offset can be used to start writing at a specific index. + */ + void SetMatrix21NodesFromStackedDevice(const double* const data, size_t offset, size_t num); + + /** + * Read the current value for the Matrix21 nodes into the stacked output host + * data. + * + * The offset can be used to start reading from a specific index. + */ + void GetMatrix21NodesToStackedHost(double* const data, size_t offset, size_t num); + + /** + * Read the current value for the Matrix21 nodes into the stacked output + * device data. + * + * The offset can be used to start reading from a specific index. + */ + void GetMatrix21NodesToStackedDevice(double* const data, size_t offset, size_t num); + + /** + * Set the current number of active nodes of type Matrix21. + * + * The value is set during initialization and this function is only needed if + * you want to change the problem between optimization runs. This is work in + * progress and can have performance impacts. + */ + void SetMatrix21Num(size_t num); + + /** + * Set the indices for the x argument for the Rosenbrock factor from host. + */ + void SetRosenbrockXIndicesFromHost(const unsigned int* const indices, size_t num); + + /** + * Set the indices for the x argument for the Rosenbrock factor from device. + */ + void SetRosenbrockXIndicesFromDevice(const unsigned int* const indices, size_t num); + + /** + * Set the current number of Rosenbrock factors. + * + * The value is set during initialization and this function is only needed if + * you want to change the problem between optimization runs. This is work in + * progress and can have performance impacts. + */ + void SetRosenbrockNum(size_t num); + + private: + SolverParams params_; + int device_id_; + uint8_t* origin_ptr_; + size_t scratch_inout_size_; + size_t allocation_size_; + + int solver_iter_; + int pcg_iter_; + + bool indices_valid_; + + double pcg_r_0_norm2_; + double pcg_r_kp1_norm2_; + + size_t Matrix21_num_; + size_t Matrix21_num_max_; + size_t rosenbrock_num_; + size_t rosenbrock_num_max_; + + size_t get_nbytes(); + double LinearizeFirst(); + void Linearize(); + double DoResJacFirst(); + void DoResJac(); + void DoNormalize(); + void DoJtjpDirect(); + void DoAlphaFirst(); + void DoAlpha(); + void DoUpdateStepFirst(); + void DoUpdateStep(); + void DoUpdateRFirst(); + void DoUpdateR(); + double DoRetractScore(); + void DoBeta(); + void DoUpdateP(); + void DoUpdateMp(); + double GetPredDecrease(); + + double* marker__start_; + double* nodes__Matrix21__storage_current_; + double* nodes__Matrix21__storage_check_; + double* nodes__Matrix21__storage_new_best_; + SharedIndex* facs__rosenbrock__args__x__idx_shared_; + double* marker__scratch_inout_; + double* facs__rosenbrock__res_; + double* facs__rosenbrock__args__x__jac_; + double* nodes__Matrix21__z_; + double* nodes__Matrix21__z_end__; + double* nodes__Matrix21__p_; + double* nodes__Matrix21__p_end__; + double* nodes__Matrix21__step_; + double* nodes__Matrix21__step_end__; + double* marker__w_start_; + double* nodes__Matrix21__w_; + double* marker__w_end_; + double* marker__r_0_start_; + double* nodes__Matrix21__r_0_; + double* marker__r_0_end_; + double* marker__r_k_start_; + double* nodes__Matrix21__r_k_; + double* marker__r_k_end_; + double* marker__Mp_start_; + double* nodes__Matrix21__Mp_; + double* marker__Mp_end_; + double* marker__precond_start_; + double* nodes__Matrix21__precond_diag_; + double* nodes__Matrix21__precond_tril_; + double* marker__precond_end_; + double* marker__jp_start_; + double* facs__rosenbrock__jp_; + double* marker__jp_end_; + double* solver__current_diag_; + double* solver__alpha_numerator_; + double* solver__alpha_denominator_; + double* solver__alpha_; + double* solver__neg_alpha_; + double* solver__beta_numerator_; + double* solver__beta_; + double* solver__r_0_norm2_tot_; + double* solver__r_kp1_norm2_tot_; + double* solver__pred_decrease_tot_; + double* solver__res_tot_; +}; + +} // namespace caspar \ No newline at end of file From ac55ed37b217a23daf3fde061d9c51e7ad45233b Mon Sep 17 00:00:00 2001 From: Aaron Date: Sat, 26 Sep 2026 03:06:50 +0000 Subject: [PATCH 30/68] [SymForce] Fix some IWYU issues Co-Authored-By: Claude Opus 5 GitOrigin-RevId: b278f63de9815d6d0a122d65d904791c727461cb --- gen/cpp/sym/util/epsilon.h | 3 ++- .../backends/cpp/templates/epsilon.h.jinja | 3 ++- symforce/opt/internal/factor_utils.h | 15 ++++++++++++++- .../pixel_to_ray_and_back.h | 5 +++-- 4 files changed, 21 insertions(+), 5 deletions(-) diff --git a/gen/cpp/sym/util/epsilon.h b/gen/cpp/sym/util/epsilon.h index a4ddb319..d3a28593 100644 --- a/gen/cpp/sym/util/epsilon.h +++ b/gen/cpp/sym/util/epsilon.h @@ -28,7 +28,8 @@ namespace sym { * symforce/notebooks/epsilon_sandbox.ipynb */ template -constexpr Scalar kDefaultEpsilon = Scalar(10.0) * std::numeric_limits::epsilon(); +constexpr Scalar kDefaultEpsilon = + static_cast(10.0) * std::numeric_limits::epsilon(); // Explicit instantiation to reduce duplicate instantiation extern template const double kDefaultEpsilon; diff --git a/symforce/codegen/backends/cpp/templates/epsilon.h.jinja b/symforce/codegen/backends/cpp/templates/epsilon.h.jinja index 69614951..2f7b951f 100644 --- a/symforce/codegen/backends/cpp/templates/epsilon.h.jinja +++ b/symforce/codegen/backends/cpp/templates/epsilon.h.jinja @@ -27,7 +27,8 @@ namespace sym { * symforce/notebooks/epsilon_sandbox.ipynb */ template -constexpr Scalar kDefaultEpsilon = Scalar(10.0) * std::numeric_limits::epsilon(); +constexpr Scalar kDefaultEpsilon = + static_cast(10.0) * std::numeric_limits::epsilon(); // Explicit instantiation to reduce duplicate instantiation extern template const double kDefaultEpsilon; diff --git a/symforce/opt/internal/factor_utils.h b/symforce/opt/internal/factor_utils.h index a0b8f1ff..07a64632 100644 --- a/symforce/opt/internal/factor_utils.h +++ b/symforce/opt/internal/factor_utils.h @@ -12,9 +12,22 @@ * Primarily intended to be included by factor.tcc and used internally there */ +#include +#include +#include #include +#include -#include "../factor.h" +#include +#include + +#include + +#include + +#include "../assert.h" +#include "../templates.h" +#include "../values.h" namespace sym { namespace internal { diff --git a/test/symforce_function_codegen_test_data/sympy/symforce_gen_codegen_test_data/cam_function_codegen_test/pixel_to_ray_and_back.h b/test/symforce_function_codegen_test_data/sympy/symforce_gen_codegen_test_data/cam_function_codegen_test/pixel_to_ray_and_back.h index e4566363..8d57a8a6 100644 --- a/test/symforce_function_codegen_test_data/sympy/symforce_gen_codegen_test_data/cam_function_codegen_test/pixel_to_ray_and_back.h +++ b/test/symforce_function_codegen_test_data/sympy/symforce_gen_codegen_test_data/cam_function_codegen_test/pixel_to_ray_and_back.h @@ -1,6 +1,6 @@ // ----------------------------------------------------------------------------- // This file was autogenerated by symforce from template: -// cpp_templates/function/FUNCTION.h.jinja +// function/FUNCTION.h.jinja // Do NOT modify by hand. // ----------------------------------------------------------------------------- @@ -8,12 +8,13 @@ #include +#include + namespace cam_function_codegen_test { /** * Transform a given pixel into a ray and project the ray back to * pixel coordinates. Input and output should match. - * */ template Eigen::Matrix PixelToRayAndBack(const Eigen::Matrix& pixel, From 80842122d2fd2a780890eff3039b885461d6aae3 Mon Sep 17 00:00:00 2001 From: Brian Kubisiak Date: Mon, 28 Sep 2026 20:52:17 +0000 Subject: [PATCH 31/68] fmt_eigen: Disable fmt range formatting for all Eigen dense types Since Eigen 3.4, dense Eigen types have STL iterators, so fmt treats them as ranges. That makes fmt's range formatter an equally good match as the ostream formatters `fmt_eigen.h` defines, and formatting the type is ambiguous. The header opts out by specializing `fmt::range_format_kind` as disabled. The existing specializations only covered `DenseBase`, `MatrixBase`, `VectorBlock`, and types whose CRTP parameter is the type itself. A subclass of an Eigen type, such as the eigen_lcm types, matches none of them, so formatting one failed to compile. Replace them with one specialization that matches any type deriving from `Eigen::DenseBase` for some `X`. On Eigen versions without STL iterators, dense types are not ranges, so the opt-out has no effect. Assisted-by: Claude:claude-opus-5-5 Signed-off-by: Brian Kubisiak GitOrigin-RevId: 28c6b0078836daac8cb44cf097a53760d5d7a16f --- gen/cpp/sym/util/type_ops.h | 8 +-- .../backends/cpp/templates/type_ops.h.jinja | 8 +-- symforce/opt/eigen_type_ops.h | 59 +++++++++++++++++++ symforce/opt/fmt_eigen.h | 26 +++----- 4 files changed, 70 insertions(+), 31 deletions(-) create mode 100644 symforce/opt/eigen_type_ops.h diff --git a/gen/cpp/sym/util/type_ops.h b/gen/cpp/sym/util/type_ops.h index 8cd26da4..0bfc88ac 100644 --- a/gen/cpp/sym/util/type_ops.h +++ b/gen/cpp/sym/util/type_ops.h @@ -29,16 +29,10 @@ #include #include #include +#include namespace sym { -template -static constexpr const bool kIsEigenType = std::is_base_of, T>::value; - -template -static constexpr const bool kIsSparseEigenType = - std::is_base_of, T>::value; - inline bool IsEigenType(const type_t type) { switch (type.value) { case type_t::VECTOR1: diff --git a/symforce/codegen/backends/cpp/templates/type_ops.h.jinja b/symforce/codegen/backends/cpp/templates/type_ops.h.jinja index e4c233b9..32fa95ee 100644 --- a/symforce/codegen/backends/cpp/templates/type_ops.h.jinja +++ b/symforce/codegen/backends/cpp/templates/type_ops.h.jinja @@ -17,18 +17,12 @@ {% endfor %} #include #include +#include #include namespace sym { -template -static constexpr const bool kIsEigenType = std::is_base_of, T>::value; - -template -static constexpr const bool kIsSparseEigenType = - std::is_base_of, T>::value; - inline bool IsEigenType(const type_t type) { switch (type.value) { {% for i in range(1, 10) %} diff --git a/symforce/opt/eigen_type_ops.h b/symforce/opt/eigen_type_ops.h new file mode 100644 index 00000000..bb019092 --- /dev/null +++ b/symforce/opt/eigen_type_ops.h @@ -0,0 +1,59 @@ +/* ---------------------------------------------------------------------------- + * SymForce - Copyright 2022, Skydio, Inc. + * This source code is under the Apache 2.0 license found in the LICENSE file. + * ---------------------------------------------------------------------------- */ + +#pragma once + +/// Compile-time traits for Eigen types. This only forward declares Eigen, so it can be used +/// without pulling in Eigen or any of the generated sym types. + +#include +#include + +namespace Eigen { +template +class DenseBase; +template +class MatrixBase; +template +class SparseMatrix; +} // namespace Eigen + +namespace sym { +namespace internal { + +// Each trait overloads on a pointer to the Eigen base, so a type matches if it derives from that +// base for any template arguments. This also covers subclasses of Eigen types, which derive from +// e.g. MatrixBase> rather than MatrixBase. +template +std::true_type IsEigenTypeImpl(const Eigen::MatrixBase*); +std::false_type IsEigenTypeImpl(...); + +template +std::true_type IsDenseEigenTypeImpl(const Eigen::DenseBase*); +std::false_type IsDenseEigenTypeImpl(...); + +// Only the default options (column-major, int indices). +template +std::true_type IsSparseEigenTypeImpl(const Eigen::SparseMatrix*); +std::false_type IsSparseEigenTypeImpl(...); + +} // namespace internal + +/// True for Eigen matrix and vector types and expressions, not arrays +template +static constexpr const bool kIsEigenType = + decltype(internal::IsEigenTypeImpl(std::declval()))::value; + +/// True for all dense Eigen types and expressions, including arrays +template +static constexpr const bool kIsDenseEigenType = + decltype(internal::IsDenseEigenTypeImpl(std::declval()))::value; + +/// True for Eigen::SparseMatrix and types derived from it +template +static constexpr const bool kIsSparseEigenType = + decltype(internal::IsSparseEigenTypeImpl(std::declval()))::value; + +} // namespace sym diff --git a/symforce/opt/fmt_eigen.h b/symforce/opt/fmt_eigen.h index 8acd429c..55e06822 100644 --- a/symforce/opt/fmt_eigen.h +++ b/symforce/opt/fmt_eigen.h @@ -10,9 +10,14 @@ /// Formatter definitions for Eigen types +#include +#include + #include #include +#include "./eigen_type_ops.h" + namespace Eigen { template class DenseBase; @@ -52,21 +57,8 @@ struct fmt::formatter> : ostream_formatter // Eigen 3.4 gave vector expressions STL iterators, so fmt's range formatter is an equally // specialized candidate against the ostream formatters above. Opt out of range formatting to leave -// the ostream formatters as the only match. These mirror the formatters above, minus the ones fmt -// never treats as ranges (2D expressions, sparse, and WithFormat). -template -struct fmt::range_format_kind, Char> - : std::integral_constant {}; - -template -struct fmt::range_format_kind, Char> - : std::integral_constant {}; - -template -struct fmt::range_format_kind< - Derived, Char, std::enable_if_t, Derived>>> - : std::integral_constant {}; - -template -struct fmt::range_format_kind, Char> +// the ostream formatters as the only match. This also covers subclasses of Eigen types (e.g. +// eigen_lcm types) whose own format_as would otherwise be ambiguous with the range formatter. +template +struct fmt::range_format_kind>> : std::integral_constant {}; From b99ebe603def329dd97d243d7984095700c9557a Mon Sep 17 00:00:00 2001 From: Brian Kubisiak Date: Mon, 28 Sep 2026 23:02:07 +0000 Subject: [PATCH 32/68] eigen_lcm: Suppress false-positive -Wmaybe-uninitialized The `SymmetricMatrixXd` and `SymmetricMatrixXf` encoders pack the lower triangle into an uninitialized `VectorX` scratch buffer before serializing it. With Eigen 5, GCC 13 cannot prove that the packing loop writes every element, and reports `'aligned' may be used uninitialized [-Werror=maybe-uninitialized]` in `SymmetricMatrixXd.hpp`, which fails the build. Assisted-by: Claude:claude-opus-5-5 Signed-off-by: Brian Kubisiak GitOrigin-RevId: 57c25bf4c89bdbdc471006a872b7d09e5fbfa691 --- .../cpp/lcmtypes/eigen_lcm/SymmetricMatrixXd.hpp | 9 +++++++++ .../cpp/lcmtypes/eigen_lcm/SymmetricMatrixXf.hpp | 9 +++++++++ 2 files changed, 18 insertions(+) diff --git a/third_party/eigen_lcm/lcmtypes/eigen_lcm_lcm/cpp/lcmtypes/eigen_lcm/SymmetricMatrixXd.hpp b/third_party/eigen_lcm/lcmtypes/eigen_lcm_lcm/cpp/lcmtypes/eigen_lcm/SymmetricMatrixXd.hpp index 95ecdab5..68ba4a24 100644 --- a/third_party/eigen_lcm/lcmtypes/eigen_lcm_lcm/cpp/lcmtypes/eigen_lcm/SymmetricMatrixXd.hpp +++ b/third_party/eigen_lcm/lcmtypes/eigen_lcm_lcm/cpp/lcmtypes/eigen_lcm/SymmetricMatrixXd.hpp @@ -227,8 +227,17 @@ __lcm_buffer_size SymmetricMatrixXd::_encodeNoHash(void* buf, __lcm_buffer_size flattened_offset += segment_size; segment_size -= 1; } + // GCC false positive: -Wmaybe-uninitialized fires on Eigen's aligned allocation through the + // data pointer, though the loop above writes every element of the lower triangle. +#if defined(__GNUC__) && !defined(__clang__) +#pragma GCC diagnostic push +#pragma GCC diagnostic ignored "-Wmaybe-uninitialized" +#endif tlen = __double_encode_array(buf, offset + pos, maxlen - pos, flattened_lower_triangle.data(), flattened_lower_triangle.size()); +#if defined(__GNUC__) && !defined(__clang__) +#pragma GCC diagnostic pop +#endif if (tlen < 0) { return tlen; } else { diff --git a/third_party/eigen_lcm/lcmtypes/eigen_lcm_lcm/cpp/lcmtypes/eigen_lcm/SymmetricMatrixXf.hpp b/third_party/eigen_lcm/lcmtypes/eigen_lcm_lcm/cpp/lcmtypes/eigen_lcm/SymmetricMatrixXf.hpp index 2c93c83f..a89a8311 100644 --- a/third_party/eigen_lcm/lcmtypes/eigen_lcm_lcm/cpp/lcmtypes/eigen_lcm/SymmetricMatrixXf.hpp +++ b/third_party/eigen_lcm/lcmtypes/eigen_lcm_lcm/cpp/lcmtypes/eigen_lcm/SymmetricMatrixXf.hpp @@ -227,8 +227,17 @@ __lcm_buffer_size SymmetricMatrixXf::_encodeNoHash(void* buf, __lcm_buffer_size flattened_offset += segment_size; segment_size -= 1; } + // GCC false positive: -Wmaybe-uninitialized fires on Eigen's aligned allocation through the + // data pointer, though the loop above writes every element of the lower triangle. +#if defined(__GNUC__) && !defined(__clang__) +#pragma GCC diagnostic push +#pragma GCC diagnostic ignored "-Wmaybe-uninitialized" +#endif tlen = __float_encode_array(buf, offset + pos, maxlen - pos, flattened_lower_triangle.data(), flattened_lower_triangle.size()); +#if defined(__GNUC__) && !defined(__clang__) +#pragma GCC diagnostic pop +#endif if (tlen < 0) { return tlen; } else { From 820b62feb41ebc312a758e43b514c36e08e9ed26 Mon Sep 17 00:00:00 2001 From: Nikhil Marathe Date: Tue, 29 Sep 2026 01:21:57 +0000 Subject: [PATCH 33/68] [SymForce] Assign additional factor outputs through fixed-size Maps Same as 1ca0ec3, for additional call sites. Reviewers: kubisiak,aaron Topic: sym-eigen-map GitOrigin-RevId: 271476a010648327dbc9576d887e462c6aeea2aa --- symforce/opt/internal/factor_utils.h | 15 ++++++++++----- 1 file changed, 10 insertions(+), 5 deletions(-) diff --git a/symforce/opt/internal/factor_utils.h b/symforce/opt/internal/factor_utils.h index 07a64632..531920e7 100644 --- a/symforce/opt/internal/factor_utils.h +++ b/symforce/opt/internal/factor_utils.h @@ -229,7 +229,8 @@ auto JacobianFixed(Functor&& func) { Eigen::Matrix jacobian_fixed; JacobianFuncValuesExtractor::Invoke(func, values, keys_to_func, &residual_fixed, &jacobian_fixed); - (*jacobian) = jacobian_fixed; + jacobian->resize(M, N); + Eigen::Map>{jacobian->data()} = jacobian_fixed; CalculateHessianRhs(residual_fixed, jacobian_fixed, hessian, rhs); } else { // jacobian not requested @@ -456,19 +457,23 @@ auto HessianFixedDense(Functor&& func) { hessian == nullptr ? nullptr : &hessian_fixed, rhs == nullptr ? nullptr : &rhs_fixed); if (residual != nullptr) { - (*residual) = residual_fixed; + residual->resize(M); + Eigen::Map>{residual->data()} = residual_fixed; } if (jacobian != nullptr) { - (*jacobian) = jacobian_fixed; + jacobian->resize(M, N); + Eigen::Map>{jacobian->data()} = jacobian_fixed; } if (hessian != nullptr) { - (*hessian) = hessian_fixed; + hessian->resize(N, N); + Eigen::Map>{hessian->data()} = hessian_fixed; } if (rhs != nullptr) { - (*rhs) = rhs_fixed; + rhs->resize(N); + Eigen::Map>{rhs->data()} = rhs_fixed; } }; } From 17c248a0491ad6540c39c7e7fc2850897083fbed Mon Sep 17 00:00:00 2001 From: Aaron Date: Tue, 29 Sep 2026 03:21:15 +0000 Subject: [PATCH 34/68] [SymForce] Run the docs test in its own CI job The docs test takes ~20 minutes and ran in every test-on-ubuntu matrix configuration, where the runner is sometimes shut down before it finishes. Exclude it from the matrix and build the docs once in a separate job on ubuntu-24.04 / Python 3.12, which also uploads the docs artifact. Co-Authored-By: Claude Opus 5.5 Signed-off-by: Aaron Miller GitOrigin-RevId: f53c60db89be3d0b8be6f08ab89df6ace3586024 --- .github/workflows/ci.yml | 53 ++++++++++++++++++++++++++++++++++++---- 1 file changed, 48 insertions(+), 5 deletions(-) diff --git a/.github/workflows/ci.yml b/.github/workflows/ci.yml index 97713cb9..310459ed 100644 --- a/.github/workflows/ci.yml +++ b/.github/workflows/ci.yml @@ -138,22 +138,65 @@ jobs: cmake --build build -j $(nproc) # lcmtypes and symforce need to be available for tests + # The docs test is slow, so it only runs in the docs job below - name: Run tests run: | pip install build/lcmtypes/python2.7 export PYTHONPATH=$PYTHONPATH:$(pwd) EXIT_CODE=0 - ctest --test-dir build -j $(nproc) || EXIT_CODE=$? + EXCLUDE='^symengine_symforce_docs_test$' + ctest --test-dir build -j $(nproc) -E "$EXCLUDE" || EXIT_CODE=$? if [ $EXIT_CODE -ne 0 ]; then - ctest --test-dir build -j $(nproc) --rerun-failed --output-on-failure + ctest --test-dir build -j $(nproc) -E "$EXCLUDE" --rerun-failed --output-on-failure fi + docs: + if: contains(fromJSON('["push", "workflow_dispatch"]'), github.event_name) || (github.event_name == 'pull_request' && github.event.pull_request.draft == false) + runs-on: ubuntu-24.04 + steps: + - name: Checkout + uses: actions/checkout@v6 + + - name: Install build dependencies + run: | + sudo apt-get update + sudo apt-get install -y \ + build-essential \ + doxygen \ + libgmp-dev \ + pandoc + + - uses: actions/setup-python@v6 + with: + python-version: "3.12" + + - name: Install python dependencies + run: | + PY_MINOR_VERSION=$(python -c "import sys; print(sys.version_info.minor)") + python -m pip install pip==25.0.1 setuptools==75.3.2 + python -m pip install -r requirements/dev_py3${PY_MINOR_VERSION}.txt + + - name: Run cmake build + run: | + cmake -B build \ + -D SYMFORCE_PYTHON_OVERRIDE=python3.12 \ + -D SYMFORCE_BUILD_EXAMPLES=OFF \ + -D SYMFORCE_BUILD_TESTS=OFF \ + -D SYMFORCE_BUILD_BENCHMARKS=OFF + cmake --build build -j $(nproc) + + # Runs `make docs`, with retries for flakiness + - name: Build docs + run: | + pip install build/lcmtypes/python2.7 + export PYTHONPATH=$PYTHONPATH:$(pwd) + SYMFORCE_SYMBOLIC_API=symengine python test/symforce_docs_test.py + # Upload the docs as an artifact - # To view, download the `docs` artifact from the build and matrix entry you're interested in - # (probably any is good, assuming they all pass) + # To view, download the `docs` artifact from the build # Unzip to a directory and run `npx http-server` in that directory - name: Upload Generated Docs uses: actions/upload-artifact@v7 with: - name: docs ${{ matrix.os }}-python${{ matrix.python }}-${{ matrix.compiler.C }} + name: docs path: build/docs From 626c3afb3f18e4fb8374a1ec6fff6d98c8a07b84 Mon Sep 17 00:00:00 2001 From: Aaron Date: Tue, 29 Sep 2026 05:31:00 +0000 Subject: [PATCH 35/68] [Caspar] IWYU GitOrigin-RevId: 2ce0f10939364af7000b7595d3f7c32295703b35 --- symforce/caspar/source/runtime/sort_indices.h | 2 ++ 1 file changed, 2 insertions(+) diff --git a/symforce/caspar/source/runtime/sort_indices.h b/symforce/caspar/source/runtime/sort_indices.h index 37800303..2fbeeb1a 100644 --- a/symforce/caspar/source/runtime/sort_indices.h +++ b/symforce/caspar/source/runtime/sort_indices.h @@ -5,6 +5,8 @@ #pragma once +#include + #include namespace caspar { From c93eb63bda43f4cc26dbd00154632eeef8a383d8 Mon Sep 17 00:00:00 2001 From: Brian Kubisiak Date: Tue, 29 Sep 2026 22:26:56 +0000 Subject: [PATCH 36/68] [SymForce] Initialize covariance_sums in imu_preintegration_test Signed-off-by: Brian Kubisiak GitOrigin-RevId: 42a48b14779d7d152a23ba6cb3d5112b4e51296a --- test/slam_imu_preintegration_test.cc | 2 +- 1 file changed, 1 insertion(+), 1 deletion(-) diff --git a/test/slam_imu_preintegration_test.cc b/test/slam_imu_preintegration_test.cc index ef9be06e..2dd1c784 100644 --- a/test/slam_imu_preintegration_test.cc +++ b/test/slam_imu_preintegration_test.cc @@ -179,7 +179,7 @@ TEST_CASE("Test ImuPreintegrator.covariance", "[slam]") { // NOTE(brad): I assume I can equally distribute samples among the threads CHECK(kSampleCount % kThreadCount == 0); std::vector threads; - std::array, kThreadCount> covariance_sums; + std::array, kThreadCount> covariance_sums{}; covariance_sums.fill(M99::Zero()); Eigen::MatrixXd samples(9, kSampleCount); From 8848a3f217d4674d1dadfa1862fa8d58b2484aed Mon Sep 17 00:00:00 2001 From: Aaron Date: Tue, 29 Sep 2026 23:14:07 +0000 Subject: [PATCH 37/68] [SymForce] Mark FetchContent fmt headers as system headers fmt 12 with clang-19 -Werror was broken: fmt/format.h uses infinity, which trips -Wnan-infinity-disabled under the -ffast-math that symforce_gen is compiled with. Set FMT_SYSTEM_HEADERS so warnings in fmt's headers don't fail the build. Co-Authored-By: Claude Opus 5.5 Signed-off-by: Aaron Miller GitOrigin-RevId: 7410b578674ed3029eac9eba5d3c40af32a5b676 --- CMakeLists.txt | 3 +++ 1 file changed, 3 insertions(+) diff --git a/CMakeLists.txt b/CMakeLists.txt index bea2d8e5..b1944fa0 100644 --- a/CMakeLists.txt +++ b/CMakeLists.txt @@ -209,6 +209,9 @@ if (NOT fmt_FOUND) message(STATUS "fmt not found, adding with FetchContent") function(add_fmt) set(FMT_INSTALL ON CACHE INTERNAL "fmt should create an install target") + # Mark fmt headers as system headers so warnings in them don't break -Werror builds, e.g. + # clang's -Wnan-infinity-disabled under -ffast-math + set(FMT_SYSTEM_HEADERS ON CACHE INTERNAL "fmt headers should be marked as system headers") FetchContent_Declare( fmtlib URL https://github.com/fmtlib/fmt/archive/12.2.0.zip From 2bcd467c575b451e7a61ba4abbd52489c19a037e Mon Sep 17 00:00:00 2001 From: Aaron Miller <78561124+aaron-skydio@users.noreply.github.com> Date: Tue, 29 Sep 2026 16:32:28 -0700 Subject: [PATCH 38/68] [SymForce] Upgrade to pybind11-stubgen 3.0.0 3.0.0 replaced CLIArgs.module_name with module_names, and run() now takes the module names and output dir directly. The symforce wheel tests install the unpinned dev extras, so they picked up 3.0.0 and the cc_sym stubs codegen test failed. Update both stubgen callers to the new API and require >=3.0.0. Value comments are now opt-in, so pass --print-value-comments to keep them. Remove monkeypatches that are now redundant. Current-module prefix stripping and nested-parameter imports are handled upstream in 3.0.0. The typing.Buffer -> typing_extensions.Buffer rewrite is unneeded since pybind11 3.0.0 (pybind/pybind11#5662) never emits typing.Buffer. Regenerating with each of these disabled produces no change. Topic: pybind11-stubgen-3 Co-Authored-By: Claude Opus 5.5 Signed-off-by: Aaron Miller GitOrigin-RevId: a5f55ed3319031e4f580e650bc2022e9a05af47b --- requirements/dev_py310.txt | 2 +- requirements/dev_py311.txt | 2 +- requirements/dev_py312.txt | 2 +- requirements/dev_py313.txt | 2 +- requirements/dev_py314.txt | 2 +- setup.py | 4 +- symforce/pybind/cc_sym.pyi | 1186 ++++++++++---------- symforce/test_util/stubs_util.py | 79 -- test/symforce_cc_sym_stubs_codegen_test.py | 19 +- 9 files changed, 606 insertions(+), 692 deletions(-) diff --git a/requirements/dev_py310.txt b/requirements/dev_py310.txt index 2dfca3d6..de50a45e 100644 --- a/requirements/dev_py310.txt +++ b/requirements/dev_py310.txt @@ -203,7 +203,7 @@ ptyprocess==0.7.0 # via pexpect pure-eval==0.2.3 # via stack-data -pybind11-stubgen==2.5.5 +pybind11-stubgen==3.0.0 # via symforce (pyproject.toml) pygments==2.20.0 # via diff --git a/requirements/dev_py311.txt b/requirements/dev_py311.txt index d5d27f5e..dc539abc 100644 --- a/requirements/dev_py311.txt +++ b/requirements/dev_py311.txt @@ -203,7 +203,7 @@ ptyprocess==0.7.0 # via pexpect pure-eval==0.2.3 # via stack-data -pybind11-stubgen==2.5.5 +pybind11-stubgen==3.0.0 # via symforce (pyproject.toml) pygments==2.20.0 # via diff --git a/requirements/dev_py312.txt b/requirements/dev_py312.txt index dfb01700..e4973cc6 100644 --- a/requirements/dev_py312.txt +++ b/requirements/dev_py312.txt @@ -203,7 +203,7 @@ ptyprocess==0.7.0 # via pexpect pure-eval==0.2.3 # via stack-data -pybind11-stubgen==2.5.5 +pybind11-stubgen==3.0.0 # via symforce (pyproject.toml) pygments==2.20.0 # via diff --git a/requirements/dev_py313.txt b/requirements/dev_py313.txt index 9e39304f..466147a0 100644 --- a/requirements/dev_py313.txt +++ b/requirements/dev_py313.txt @@ -203,7 +203,7 @@ ptyprocess==0.7.0 # via pexpect pure-eval==0.2.3 # via stack-data -pybind11-stubgen==2.5.5 +pybind11-stubgen==3.0.0 # via symforce (pyproject.toml) pygments==2.20.0 # via diff --git a/requirements/dev_py314.txt b/requirements/dev_py314.txt index 29612bf4..7e897e94 100644 --- a/requirements/dev_py314.txt +++ b/requirements/dev_py314.txt @@ -203,7 +203,7 @@ ptyprocess==0.7.0 # via pexpect pure-eval==0.2.3 # via stack-data -pybind11-stubgen==2.5.5 +pybind11-stubgen==3.0.0 # via symforce (pyproject.toml) pygments==2.20.0 # via diff --git a/setup.py b/setup.py index 6d293237..aa166ae8 100644 --- a/setup.py +++ b/setup.py @@ -429,8 +429,8 @@ def fixed_readme() -> str: "jinja2~=3.0", "mypy~=1.19.1", "numba", - # Base for https://github.com/sizmailov/pybind11-stubgen/pull/263 - "pybind11-stubgen>=2.5.5", + # First version with the multi-module run() API + "pybind11-stubgen>=3.0.0", "ruff~=0.9.7", "types-jinja2", "types-requests", diff --git a/symforce/pybind/cc_sym.pyi b/symforce/pybind/cc_sym.pyi index d6d579d8..0b7fe0c7 100644 --- a/symforce/pybind/cc_sym.pyi +++ b/symforce/pybind/cc_sym.pyi @@ -46,147 +46,6 @@ __all__: list[str] = [ "set_log_level", ] -class Factor: - """ - A residual term for optimization. - - Created from a function and a set of Keys that act as inputs. Given a Values as an evaluation - point, generates a linear approximation to the residual function. - """ - @staticmethod - @typing.overload - def jacobian( - jacobian_func: collections.abc.Callable[ - [Values, collections.abc.Sequence[lcmtypes.sym._index_entry_t.index_entry_t]], tuple - ], - keys: collections.abc.Sequence[Key], - sparse: bool = False, - ) -> Factor: - """ - Create from a function that computes the jacobian. The hessian will be computed using the - Gauss Newton approximation:: - - H = J.T * J - rhs = J.T * b - - Args: - keys: The set of input arguments, in order, accepted by func. - sparse: Create a sparse factor if True, dense factor if false. Defaults to dense. - - Precondition: - The jacobian returned by jacobian_func has type scipy.sparse.csc_matrix if and only if sparse = True. - """ - @staticmethod - @typing.overload - def jacobian( - jacobian_func: collections.abc.Callable[ - [Values, collections.abc.Sequence[lcmtypes.sym._index_entry_t.index_entry_t]], tuple - ], - keys_to_func: collections.abc.Sequence[Key], - keys_to_optimize: collections.abc.Sequence[Key], - sparse: bool = False, - ) -> Factor: - """ - Create from a function that computes the jacobian. The hessian will be computed using the - Gauss Newton approximation:: - - H = J.T * J - rhs = J.T * b - - Args: - keys_to_func: The set of input arguments, in order, accepted by func. - keys_to_optimize: The set of input arguments that correspond to the derivative in func. Must be a subset of keys_to_func. - sparse: Create a sparse factor if True, dense factor if false. Defaults to dense. - - Precondition: - The jacobian returned by jacobian_func has type scipy.sparse.csc_matrix if and only if sparse = True. - """ - @typing.overload - def __init__( - self, - hessian_func: collections.abc.Callable[ - [Values, collections.abc.Sequence[lcmtypes.sym._index_entry_t.index_entry_t]], tuple - ], - keys: collections.abc.Sequence[Key], - sparse: bool = False, - ) -> None: - """ - Create directly from a hessian functor. This is the lowest-level constructor. - - Args: - keys: The set of input arguments, in order, accepted by func. - sparse: Create a sparse factor if True, dense factor if false. Defaults to dense. - - Precondition: - The jacobian and hessian returned by hessian_func have type scipy.sparse.csc_matrix if and only if sparse = True. - """ - @typing.overload - def __init__( - self, - hessian_func: collections.abc.Callable[ - [Values, collections.abc.Sequence[lcmtypes.sym._index_entry_t.index_entry_t]], tuple - ], - keys_to_func: collections.abc.Sequence[Key], - keys_to_optimize: collections.abc.Sequence[Key], - sparse: bool = False, - ) -> None: - """ - Create directly from a hessian functor. This is the lowest-level constructor. - - Args: - keys_to_func: The set of input arguments, in order, accepted by func. - keys_to_optimize: The set of input arguments that correspond to the derivative in func. Must be a subset of keys_to_func. - sparse: Create a sparse factor if True, dense factor if false. Defaults to dense. - - Precondition: - The jacobian and hessian returned by hessian_func have type scipy.sparse.csc_matrix if and only if sparse = True. - """ - def __repr__(self) -> str: ... - def all_keys(self) -> list[Key]: - """ - Get all keys required to evaluate this factor. - """ - def is_sparse(self) -> bool: - """ - Does this factor use a sparse jacobian/hessian matrix? - """ - def linearize(self, arg0: Values) -> tuple: - """ - Evaluate the factor at the given linearization point and output just the numerical values of the residual and jacobian. - """ - def linearized_factor( - self, values: Values - ) -> lcmtypes.sym._linearized_dense_factor_t.linearized_dense_factor_t: - """ - Evaluate the factor at the given linearization point and output a LinearizedDenseFactor that - contains the numerical values of the residual, jacobian, hessian, and right-hand-side. - - This can only be called if is_sparse is false; otherwise, it will throw. - """ - def optimized_keys(self) -> list[Key]: - """ - Get the optimized keys for this factor. - """ - -class ImuPreintegrator: - """ - Class to on-manifold preintegrate IMU measurements for usage in a SymForce optimization problem. - """ - def __init__( - self, accel_bias: numpy.typing.ArrayLike, gyro_bias: numpy.typing.ArrayLike - ) -> None: ... - def covariance(self) -> typing.Annotated[numpy.typing.NDArray[numpy.float64], "[9, 9]"]: ... - def integrate_measurement( - self, - measured_accel: numpy.typing.ArrayLike, - measured_gyro: numpy.typing.ArrayLike, - accel_cov: numpy.typing.ArrayLike, - gyro_cov: numpy.typing.ArrayLike, - dt: typing.SupportsFloat, - epsilon: typing.SupportsFloat = 2.220446049250313e-15, - ) -> None: ... - def preintegrated_measurements(self) -> PreintegratedImuMeasurements: ... - class Key: """ Key type for Values. Contains a letter plus an integral subscript and superscript. Can construct with a letter, a letter + sub, or a letter + sub + super, but not a letter + super. @@ -239,510 +98,180 @@ class Key: The superscript value of the key (INVALID_SUPER if not set). """ -class Linearization: - """ - Class for storing a problem linearization evaluated at a Values (i.e. a residual, jacobian, hessian, and rhs). +class Values: """ + Efficient polymorphic data structure to store named types with a dict-like interface and + support efficient repeated operations using a key index. Supports on-manifold optimization. - hessian_lower: scipy.sparse.csc_matrix - jacobian: scipy.sparse.csc_matrix - def __getstate__(self) -> tuple: ... - def __init__(self) -> None: ... - def __setstate__(self, arg0: tuple) -> None: ... - def error(self) -> float: ... - def is_initialized(self) -> bool: + Compatible types are given by the type_t enum. All types implement the StorageOps and + LieGroupOps concepts, which are the core operating mechanisms in this class. + """ + def __getstate__(self) -> bytes: ... + @typing.overload + def __init__(self) -> None: """ - Returns whether the linearization is currently valid for the corresponding values. Accessing any of the members when this is false could result in unexpected behavior. + Default construct as empty. """ - def linear_delta_error( - self, x_update: numpy.typing.ArrayLike, damping_vector: numpy.typing.ArrayLike - ) -> float: ... - def reset(self) -> None: + @typing.overload + def __init__(self, msg: lcmtypes.sym._values_t.values_t) -> None: """ - Set to invalid. + Construct from serialized form. """ - def set_initialized(self, initialized: bool = True) -> None: ... - @property - def residual(self) -> typing.Annotated[numpy.typing.NDArray[numpy.float64], "[m, 1]"]: ... - @residual.setter - def residual(self, arg0: numpy.typing.ArrayLike) -> None: ... - @property - def rhs(self) -> typing.Annotated[numpy.typing.NDArray[numpy.float64], "[m, 1]"]: ... - @rhs.setter - def rhs(self, arg0: numpy.typing.ArrayLike) -> None: ... - -class OptimizationStats: - """ - Debug stats for a full optimization run. - """ - def __getstate__(self) -> tuple: ... - def __init__(self) -> None: ... - def __setstate__(self, arg0: tuple) -> None: ... - def get_lcm_type(self) -> lcmtypes.sym._optimization_stats_t.optimization_stats_t: ... - @property - def best_index(self) -> int: + def __repr__(self) -> str: ... + def __setstate__(self, arg0: bytes) -> None: ... + @typing.overload + def at(self, key: Key) -> typing.Any: """ - Index into iterations of the best iteration (containing the optimal Values). + Retrieve a value by key. """ - @best_index.setter - def best_index(self, arg0: typing.SupportsInt) -> None: ... - @property - def best_linearization(self) -> typing.Optional[Linearization]: + @typing.overload + def at(self, entry: lcmtypes.sym._index_entry_t.index_entry_t) -> typing.Any: """ - The linearization at best_index (at optimized_values), filled out if populate_best_linearization=True + Retrieve a value by index entry. This avoids a map lookup compared to at(key). """ - @best_linearization.setter - def best_linearization(self, arg1: typing.Optional[Linearization]) -> None: ... - @property - def cholesky_factor_sparsity( - self, - ) -> lcmtypes.sym._sparse_matrix_structure_t.sparse_matrix_structure_t: + def cleanup(self) -> int: """ - Sparsity pattern of the cholesky factor L (filled out if debug_stats=True) + Repack the data array to get rid of empty space from removed keys. If regularly removing + keys, it's up to the user to call this appropriately to avoid storage growth. Returns the + number of Scalar elements cleaned up from the data array. + + It will INVALIDATE all indices, offset increments, and pointers. + Re-create an index with create_index(). """ - @cholesky_factor_sparsity.setter - def cholesky_factor_sparsity( - self, arg0: lcmtypes.sym._sparse_matrix_structure_t.sparse_matrix_structure_t - ) -> None: ... - @property - def failure_reason(self) -> int: + @typing.overload + def create_index(self, sort_by_offset: bool) -> lcmtypes.sym._index_t.index_t: """ - If status == FAILED, why? This should be cast to the NonlinearSolver::FailureReason enum for the nonlinear solver you used. + Create an index for all keys in this Values. This object can then be used + for repeated efficient operations. + + If sort_by_offset is true, the index will be sorted by offset. Otherwise, the ordering is + not specified. + + An index will be INVALIDATED if the following happens: + 1) Remove() is called with a contained key, or RemoveAll() is called + 2) Cleanup() is called to re-pack the data array """ - @failure_reason.setter - def failure_reason(self, arg0: typing.SupportsInt) -> None: ... - @property - def iterations( - self, - ) -> list[lcmtypes.sym._optimization_iteration_t.optimization_iteration_t]: ... - @iterations.setter - def iterations( - self, - arg0: collections.abc.Sequence[ - lcmtypes.sym._optimization_iteration_t.optimization_iteration_t - ], - ) -> None: ... - @property - def jacobian_sparsity( - self, - ) -> lcmtypes.sym._sparse_matrix_structure_t.sparse_matrix_structure_t: + @typing.overload + def create_index(self, keys: collections.abc.Sequence[Key]) -> lcmtypes.sym._index_t.index_t: """ - Sparsity pattern of the problem jacobian (filled out if debug_stats=True and include_jacobians=True) + Create an index from the given ordered subset of keys. This object can then be used + for repeated efficient operations on that subset of keys. + + If you want an index of all the keys, call `values.create_index(values.keys())`. + + An index will be INVALIDATED if the following happens: + 1) remove() is called with a contained key, or remove_all() is called + 2) cleanup() is called to re-pack the data array """ - @jacobian_sparsity.setter - def jacobian_sparsity( - self, arg0: lcmtypes.sym._sparse_matrix_structure_t.sparse_matrix_structure_t - ) -> None: ... - @property - def linear_solver_ordering( - self, - ) -> typing.Annotated[numpy.typing.NDArray[numpy.int32], "[m, 1]"]: + def data(self) -> list[float]: """ - Ordering used by the linear solver (filled out if debug_stats=True) + Raw data buffer. """ - @linear_solver_ordering.setter - def linear_solver_ordering(self, arg0: numpy.typing.ArrayLike) -> None: ... - @property - def status(self) -> lcmtypes.sym._optimization_status_t.optimization_status_t: + def empty(self) -> bool: """ - What was the result of the optimization? (did it converge, fail, etc.) + Has zero keys. """ - @status.setter - def status(self, arg0: lcmtypes.sym._optimization_status_t.optimization_status_t) -> None: ... - -class Optimizer: - """ - Class for optimizing a nonlinear least-squares problem specified as a list of Factors. For efficient use, create once and call Optimize() multiple times with different initial guesses, as long as the factors remain constant and the structure of the Values is identical. - """ - def __init__( - self, - params: lcmtypes.sym._optimizer_params_t.optimizer_params_t, - factors: collections.abc.Sequence[Factor], - name: str = "sym::Optimize", - keys: collections.abc.Sequence[Key] = [], - epsilon: typing.SupportsFloat = 2.220446049250313e-15, - ) -> None: ... - def compute_all_covariances( - self, linearization: Linearization - ) -> dict[Key, typing.Annotated[numpy.typing.NDArray[numpy.float64], "[m, n]"]]: + def get_lcm_type(self, sort_keys: bool = False) -> lcmtypes.sym._values_t.values_t: """ - Get covariances for each optimized key at the given linearization - - May not be called before either optimize or linearize has been called. + Serialize to LCM. """ - def compute_covariances( - self, linearization: Linearization, keys: collections.abc.Sequence[Key] - ) -> dict[Key, typing.Annotated[numpy.typing.NDArray[numpy.float64], "[m, n]"]]: + def has(self, key: Key) -> bool: """ - Get covariances for the given subset of keys at the given linearization - - This version is potentially much more efficient than computing the covariances for all - keys in the problem. - - Currently requires that `keys` corresponds to a set of keys at the start of the list of keys - for the full problem, and in the same order. It uses the Schur complement trick, so will be - most efficient if the hessian is of the following form, with C block diagonal:: - - A = ( B E ) - ( E^T C ) + Return whether the key exists. """ - def compute_full_covariance( - self, linearization: Linearization - ) -> typing.Annotated[numpy.typing.NDArray[numpy.float64], "[m, n]"]: + def items(self) -> dict[Key, lcmtypes.sym._index_entry_t.index_entry_t]: """ - Get the full problem covariance at the given linearization - - Unlike compute_covariance and compute_all_covariances, this includes the off-diagonal - blocks, i.e. the cross-covariances between different keys. - - The ordering of entries here is the same as the ordering of the keys in the linearization, - which can be accessed via linearization_index(). + Expose map type to allow iteration. + """ + def keys(self, sort_by_offset: bool = True) -> list[Key]: + """ + Get all keys. - May not be called before either optimize or linearize has been called. + Args: + sort_by_offset: Sorts by storage order to make iteration safer and more memory efficient """ - def factors(self) -> list[Factor]: + @typing.overload + def local_coordinates( + self, + others: Values, + keys: collections.abc.Sequence[Key], + epsilon: typing.SupportsFloat, + tangent_dimension: typing.SupportsInt | None = None, + ) -> typing.Annotated[numpy.typing.NDArray[numpy.float64], "[m, 1]"]: """ - Get the factors. + Compute the tangent space delta needed to transform this into others. + Args: + others: The other Values that the local coordinate is relative to + keys: Keys (in order) for the resulting tangent space delta + epsilon: Small constant to avoid singularities (do not use zero) + tangent_dimension: Total tangent dimension; None to infer """ - def keys(self) -> list[Key]: + @typing.overload + def local_coordinates( + self, arg0: Values, arg1: lcmtypes.sym._index_t.index_t, arg2: typing.SupportsFloat + ) -> typing.Annotated[numpy.typing.NDArray[numpy.float64], "[m, 1]"]: """ - Get the optimized keys. + Compute the tangent space delta needed to transform this into others. + Args: + others: The other Values that the local coordinate is relative to + index: Ordered list of keys to include (valid for both Values) + epsilon: Small constant to avoid singularities (do not use zero) """ - def linearization_index(self) -> dict: ... - def linearization_index_entry(self, key: Key) -> lcmtypes.sym._index_entry_t.index_entry_t: ... - def linearize(self, values: Values) -> Linearization: + def num_entries(self) -> int: """ - Linearize the problem around the given values. + Number of keys. """ - @typing.overload - def optimize( - self, - values: Values, - num_iterations: typing.SupportsInt = -1, - populate_best_linearization: bool = False, - ) -> OptimizationStats: + def remove(self, key: Key) -> bool: """ - Optimize the given values in-place - - Args: - num_iterations: If < 0 (the default), uses the number of iterations specified by the params at construction. - - populate_best_linearization: If true, the linearization at the best values will be filled out in the stats. + Remove the given key. Only removes the index entry, does not change the data array. + Returns true if removed, false if already not present. - Returns: - The optimization stats + Call cleanup() to re-pack the data array. """ - @typing.overload - def optimize( + def remove_all(self) -> None: + """ + Remove all keys and empty out the storage. + """ + def retract( self, - values: Values, - num_iterations: typing.SupportsInt, - populate_best_linearization: bool, - stats: OptimizationStats, + index: lcmtypes.sym._index_t.index_t, + delta: collections.abc.Sequence[typing.SupportsFloat], + epsilon: typing.SupportsFloat, ) -> None: """ - Optimize the given values in-place - - This overload takes the stats as an argument, and stores into there. This allows users to - avoid reallocating memory for any of the entries in the stats, for use cases where that's - important. If passed, stats must not be None. + Perform a retraction from an update vector. Args: - num_iterations: If < 0 (the default), uses the number of iterations specified by the params at construction - - populate_best_linearization: If true, the linearization at the best values will be filled out in the stats - - stats: An OptimizationStats to fill out with the result - if filling out dynamically allocated fields here, will not reallocate if memory is already allocated in the required shape (e.g. for repeated calls to Optimize) + index: Ordered list of keys in the delta vector + delta: Update vector - MUST be the size of index.tangent_dim! + epsilon: Small constant to avoid singularities (do not use zero) """ @typing.overload - def optimize( - self, values: Values, num_iterations: typing.SupportsInt, stats: OptimizationStats + def set(self, key: Key, value: typing.SupportsFloat) -> bool: + """ + Add or update a value by key. Returns true if added, false if updated. + """ + @typing.overload + def set( + self, key: lcmtypes.sym._index_entry_t.index_entry_t, value: typing.SupportsFloat ) -> None: """ - Optimize the given values in-place - - This overload takes the stats as an argument, and stores into there. This allows users to - avoid reallocating memory for any of the entries in the stats, for use cases where that's - important. If passed, stats must not be None. - - Args: - num_iterations: If < 0 (the default), uses the number of iterations specified by the params at construction - - stats: An OptimizationStats to fill out with the result - if filling out dynamically allocated fields here, will not reallocate if memory is already allocated in the required shape (e.g. for repeated calls to Optimize) + Update a value by index entry with no map lookup (compared to Set(key)). This does NOT add new values and assumes the key exists already. """ @typing.overload - def optimize(self, values: Values, stats: OptimizationStats) -> None: + def set(self, key: Key, value: sym.Rot2) -> bool: """ - Optimize the given values in-place - - This overload takes the stats as an argument, and stores into there. This allows users to - avoid reallocating memory for any of the entries in the stats, for use cases where that's - important. If passed, stats must not be None. - - Args: - stats: An OptimizationStats to fill out with the result - if filling out dynamically allocated fields here, will not reallocate if memory is already allocated in the required shape (e.g. for repeated calls to Optimize) + Add or update a value by key. Returns true if added, false if updated. """ - def update_params(self, params: lcmtypes.sym._optimizer_params_t.optimizer_params_t) -> None: + @typing.overload + def set(self, key: lcmtypes.sym._index_entry_t.index_entry_t, value: sym.Rot2) -> None: """ - Update the optimizer params. + Update a value by index entry with no map lookup (compared to Set(key)). This does NOT add new values and assumes the key exists already. """ - -class PreintegratedImuMeasurements: - """ - Struct of Preintegrated IMU Measurements (not including the covariance of change in orientation, velocity, and position). - """ - class Delta: + @typing.overload + def set(self, key: Key, value: sym.Rot3) -> bool: """ - A convenient struct that holds the Preintegrated delta. - """ - - DR: sym.Rot3 - @staticmethod - def from_lcm( - arg0: lcmtypes.sym._imu_integrated_measurement_delta_t.imu_integrated_measurement_delta_t, - ) -> PreintegratedImuMeasurements.Delta: ... - def get_lcm_type( - self, - ) -> ( - lcmtypes.sym._imu_integrated_measurement_delta_t.imu_integrated_measurement_delta_t - ): ... - def roll_forward_state( - self, pose_i: sym.Pose3, vel_i: numpy.typing.ArrayLike, gravity: numpy.typing.ArrayLike - ) -> tuple[sym.Pose3, typing.Annotated[numpy.typing.NDArray[numpy.float64], "[3, 1]"]]: ... - @property - def Dp(self) -> typing.Annotated[numpy.typing.NDArray[numpy.float64], "[3, 1]"]: ... - @Dp.setter - def Dp(self, arg0: numpy.typing.ArrayLike) -> None: ... - @property - def Dt(self) -> float: ... - @Dt.setter - def Dt(self, arg0: typing.SupportsFloat) -> None: ... - @property - def Dv(self) -> typing.Annotated[numpy.typing.NDArray[numpy.float64], "[3, 1]"]: ... - @Dv.setter - def Dv(self, arg0: numpy.typing.ArrayLike) -> None: ... - - delta: PreintegratedImuMeasurements.Delta - @staticmethod - def from_lcm( - arg0: lcmtypes.sym._imu_integrated_measurement_t.imu_integrated_measurement_t, - ) -> PreintegratedImuMeasurements: ... - def __init__( - self, accel_bias: numpy.typing.ArrayLike, gyro_bias: numpy.typing.ArrayLike - ) -> None: ... - def get_bias_corrected_delta( - self, new_accel_bias: numpy.typing.ArrayLike, new_gyro_bias: numpy.typing.ArrayLike - ) -> PreintegratedImuMeasurements.Delta: ... - def get_lcm_type( - self, - ) -> lcmtypes.sym._imu_integrated_measurement_t.imu_integrated_measurement_t: ... - @property - def DR_D_gyro_bias(self) -> typing.Annotated[numpy.typing.NDArray[numpy.float64], "[3, 3]"]: ... - @DR_D_gyro_bias.setter - def DR_D_gyro_bias(self, arg0: numpy.typing.ArrayLike) -> None: ... - @property - def Dp_D_accel_bias( - self, - ) -> typing.Annotated[numpy.typing.NDArray[numpy.float64], "[3, 3]"]: ... - @Dp_D_accel_bias.setter - def Dp_D_accel_bias(self, arg0: numpy.typing.ArrayLike) -> None: ... - @property - def Dp_D_gyro_bias(self) -> typing.Annotated[numpy.typing.NDArray[numpy.float64], "[3, 3]"]: ... - @Dp_D_gyro_bias.setter - def Dp_D_gyro_bias(self, arg0: numpy.typing.ArrayLike) -> None: ... - @property - def Dv_D_accel_bias( - self, - ) -> typing.Annotated[numpy.typing.NDArray[numpy.float64], "[3, 3]"]: ... - @Dv_D_accel_bias.setter - def Dv_D_accel_bias(self, arg0: numpy.typing.ArrayLike) -> None: ... - @property - def Dv_D_gyro_bias(self) -> typing.Annotated[numpy.typing.NDArray[numpy.float64], "[3, 3]"]: ... - @Dv_D_gyro_bias.setter - def Dv_D_gyro_bias(self, arg0: numpy.typing.ArrayLike) -> None: ... - @property - def accel_bias(self) -> typing.Annotated[numpy.typing.NDArray[numpy.float64], "[3, 1]"]: ... - @accel_bias.setter - def accel_bias(self, arg0: numpy.typing.ArrayLike) -> None: ... - @property - def gyro_bias(self) -> typing.Annotated[numpy.typing.NDArray[numpy.float64], "[3, 1]"]: ... - @gyro_bias.setter - def gyro_bias(self, arg0: numpy.typing.ArrayLike) -> None: ... - -class Values: - """ - Efficient polymorphic data structure to store named types with a dict-like interface and - support efficient repeated operations using a key index. Supports on-manifold optimization. - - Compatible types are given by the type_t enum. All types implement the StorageOps and - LieGroupOps concepts, which are the core operating mechanisms in this class. - """ - def __getstate__(self) -> bytes: ... - @typing.overload - def __init__(self) -> None: - """ - Default construct as empty. - """ - @typing.overload - def __init__(self, msg: lcmtypes.sym._values_t.values_t) -> None: - """ - Construct from serialized form. - """ - def __repr__(self) -> str: ... - def __setstate__(self, arg0: bytes) -> None: ... - @typing.overload - def at(self, key: Key) -> typing.Any: - """ - Retrieve a value by key. - """ - @typing.overload - def at(self, entry: lcmtypes.sym._index_entry_t.index_entry_t) -> typing.Any: - """ - Retrieve a value by index entry. This avoids a map lookup compared to at(key). - """ - def cleanup(self) -> int: - """ - Repack the data array to get rid of empty space from removed keys. If regularly removing - keys, it's up to the user to call this appropriately to avoid storage growth. Returns the - number of Scalar elements cleaned up from the data array. - - It will INVALIDATE all indices, offset increments, and pointers. - Re-create an index with create_index(). - """ - @typing.overload - def create_index(self, sort_by_offset: bool) -> lcmtypes.sym._index_t.index_t: - """ - Create an index for all keys in this Values. This object can then be used - for repeated efficient operations. - - If sort_by_offset is true, the index will be sorted by offset. Otherwise, the ordering is - not specified. - - An index will be INVALIDATED if the following happens: - 1) Remove() is called with a contained key, or RemoveAll() is called - 2) Cleanup() is called to re-pack the data array - """ - @typing.overload - def create_index(self, keys: collections.abc.Sequence[Key]) -> lcmtypes.sym._index_t.index_t: - """ - Create an index from the given ordered subset of keys. This object can then be used - for repeated efficient operations on that subset of keys. - - If you want an index of all the keys, call `values.create_index(values.keys())`. - - An index will be INVALIDATED if the following happens: - 1) remove() is called with a contained key, or remove_all() is called - 2) cleanup() is called to re-pack the data array - """ - def data(self) -> list[float]: - """ - Raw data buffer. - """ - def empty(self) -> bool: - """ - Has zero keys. - """ - def get_lcm_type(self, sort_keys: bool = False) -> lcmtypes.sym._values_t.values_t: - """ - Serialize to LCM. - """ - def has(self, key: Key) -> bool: - """ - Return whether the key exists. - """ - def items(self) -> dict[Key, lcmtypes.sym._index_entry_t.index_entry_t]: - """ - Expose map type to allow iteration. - """ - def keys(self, sort_by_offset: bool = True) -> list[Key]: - """ - Get all keys. - - Args: - sort_by_offset: Sorts by storage order to make iteration safer and more memory efficient - """ - @typing.overload - def local_coordinates( - self, - others: Values, - keys: collections.abc.Sequence[Key], - epsilon: typing.SupportsFloat, - tangent_dimension: typing.SupportsInt | None = None, - ) -> typing.Annotated[numpy.typing.NDArray[numpy.float64], "[m, 1]"]: - """ - Compute the tangent space delta needed to transform this into others. - Args: - others: The other Values that the local coordinate is relative to - keys: Keys (in order) for the resulting tangent space delta - epsilon: Small constant to avoid singularities (do not use zero) - tangent_dimension: Total tangent dimension; None to infer - """ - @typing.overload - def local_coordinates( - self, arg0: Values, arg1: lcmtypes.sym._index_t.index_t, arg2: typing.SupportsFloat - ) -> typing.Annotated[numpy.typing.NDArray[numpy.float64], "[m, 1]"]: - """ - Compute the tangent space delta needed to transform this into others. - Args: - others: The other Values that the local coordinate is relative to - index: Ordered list of keys to include (valid for both Values) - epsilon: Small constant to avoid singularities (do not use zero) - """ - def num_entries(self) -> int: - """ - Number of keys. - """ - def remove(self, key: Key) -> bool: - """ - Remove the given key. Only removes the index entry, does not change the data array. - Returns true if removed, false if already not present. - - Call cleanup() to re-pack the data array. - """ - def remove_all(self) -> None: - """ - Remove all keys and empty out the storage. - """ - def retract( - self, - index: lcmtypes.sym._index_t.index_t, - delta: collections.abc.Sequence[typing.SupportsFloat], - epsilon: typing.SupportsFloat, - ) -> None: - """ - Perform a retraction from an update vector. - - Args: - index: Ordered list of keys in the delta vector - delta: Update vector - MUST be the size of index.tangent_dim! - epsilon: Small constant to avoid singularities (do not use zero) - """ - @typing.overload - def set(self, key: Key, value: typing.SupportsFloat) -> bool: - """ - Add or update a value by key. Returns true if added, false if updated. - """ - @typing.overload - def set( - self, key: lcmtypes.sym._index_entry_t.index_entry_t, value: typing.SupportsFloat - ) -> None: - """ - Update a value by index entry with no map lookup (compared to Set(key)). This does NOT add new values and assumes the key exists already. - """ - @typing.overload - def set(self, key: Key, value: sym.Rot2) -> bool: - """ - Add or update a value by key. Returns true if added, false if updated. - """ - @typing.overload - def set(self, key: lcmtypes.sym._index_entry_t.index_entry_t, value: sym.Rot2) -> None: - """ - Update a value by index entry with no map lookup (compared to Set(key)). This does NOT add new values and assumes the key exists already. - """ - @typing.overload - def set(self, key: Key, value: sym.Rot3) -> bool: - """ - Add or update a value by key. Returns true if added, false if updated. + Add or update a value by key. Returns true if added, false if updated. """ @typing.overload def set(self, key: lcmtypes.sym._index_entry_t.index_entry_t, value: sym.Rot3) -> None: @@ -896,6 +425,477 @@ class Values: NOTE(alvin): it is less efficient than the Update methods below if index objects are created and cached. This method performs map lookup for each key of the index """ +class Factor: + """ + A residual term for optimization. + + Created from a function and a set of Keys that act as inputs. Given a Values as an evaluation + point, generates a linear approximation to the residual function. + """ + @staticmethod + @typing.overload + def jacobian( + jacobian_func: collections.abc.Callable[ + [Values, collections.abc.Sequence[lcmtypes.sym._index_entry_t.index_entry_t]], tuple + ], + keys: collections.abc.Sequence[Key], + sparse: bool = False, + ) -> Factor: + """ + Create from a function that computes the jacobian. The hessian will be computed using the + Gauss Newton approximation:: + + H = J.T * J + rhs = J.T * b + + Args: + keys: The set of input arguments, in order, accepted by func. + sparse: Create a sparse factor if True, dense factor if false. Defaults to dense. + + Precondition: + The jacobian returned by jacobian_func has type scipy.sparse.csc_matrix if and only if sparse = True. + """ + @staticmethod + @typing.overload + def jacobian( + jacobian_func: collections.abc.Callable[ + [Values, collections.abc.Sequence[lcmtypes.sym._index_entry_t.index_entry_t]], tuple + ], + keys_to_func: collections.abc.Sequence[Key], + keys_to_optimize: collections.abc.Sequence[Key], + sparse: bool = False, + ) -> Factor: + """ + Create from a function that computes the jacobian. The hessian will be computed using the + Gauss Newton approximation:: + + H = J.T * J + rhs = J.T * b + + Args: + keys_to_func: The set of input arguments, in order, accepted by func. + keys_to_optimize: The set of input arguments that correspond to the derivative in func. Must be a subset of keys_to_func. + sparse: Create a sparse factor if True, dense factor if false. Defaults to dense. + + Precondition: + The jacobian returned by jacobian_func has type scipy.sparse.csc_matrix if and only if sparse = True. + """ + @typing.overload + def __init__( + self, + hessian_func: collections.abc.Callable[ + [Values, collections.abc.Sequence[lcmtypes.sym._index_entry_t.index_entry_t]], tuple + ], + keys: collections.abc.Sequence[Key], + sparse: bool = False, + ) -> None: + """ + Create directly from a hessian functor. This is the lowest-level constructor. + + Args: + keys: The set of input arguments, in order, accepted by func. + sparse: Create a sparse factor if True, dense factor if false. Defaults to dense. + + Precondition: + The jacobian and hessian returned by hessian_func have type scipy.sparse.csc_matrix if and only if sparse = True. + """ + @typing.overload + def __init__( + self, + hessian_func: collections.abc.Callable[ + [Values, collections.abc.Sequence[lcmtypes.sym._index_entry_t.index_entry_t]], tuple + ], + keys_to_func: collections.abc.Sequence[Key], + keys_to_optimize: collections.abc.Sequence[Key], + sparse: bool = False, + ) -> None: + """ + Create directly from a hessian functor. This is the lowest-level constructor. + + Args: + keys_to_func: The set of input arguments, in order, accepted by func. + keys_to_optimize: The set of input arguments that correspond to the derivative in func. Must be a subset of keys_to_func. + sparse: Create a sparse factor if True, dense factor if false. Defaults to dense. + + Precondition: + The jacobian and hessian returned by hessian_func have type scipy.sparse.csc_matrix if and only if sparse = True. + """ + def __repr__(self) -> str: ... + def all_keys(self) -> list[Key]: + """ + Get all keys required to evaluate this factor. + """ + def is_sparse(self) -> bool: + """ + Does this factor use a sparse jacobian/hessian matrix? + """ + def linearize(self, arg0: Values) -> tuple: + """ + Evaluate the factor at the given linearization point and output just the numerical values of the residual and jacobian. + """ + def linearized_factor( + self, values: Values + ) -> lcmtypes.sym._linearized_dense_factor_t.linearized_dense_factor_t: + """ + Evaluate the factor at the given linearization point and output a LinearizedDenseFactor that + contains the numerical values of the residual, jacobian, hessian, and right-hand-side. + + This can only be called if is_sparse is false; otherwise, it will throw. + """ + def optimized_keys(self) -> list[Key]: + """ + Get the optimized keys for this factor. + """ + +class Linearization: + """ + Class for storing a problem linearization evaluated at a Values (i.e. a residual, jacobian, hessian, and rhs). + """ + + hessian_lower: scipy.sparse.csc_matrix + jacobian: scipy.sparse.csc_matrix + def __getstate__(self) -> tuple: ... + def __init__(self) -> None: ... + def __setstate__(self, arg0: tuple) -> None: ... + def error(self) -> float: ... + def is_initialized(self) -> bool: + """ + Returns whether the linearization is currently valid for the corresponding values. Accessing any of the members when this is false could result in unexpected behavior. + """ + def linear_delta_error( + self, x_update: numpy.typing.ArrayLike, damping_vector: numpy.typing.ArrayLike + ) -> float: ... + def reset(self) -> None: + """ + Set to invalid. + """ + def set_initialized(self, initialized: bool = True) -> None: ... + @property + def residual(self) -> typing.Annotated[numpy.typing.NDArray[numpy.float64], "[m, 1]"]: ... + @residual.setter + def residual(self, arg0: numpy.typing.ArrayLike) -> None: ... + @property + def rhs(self) -> typing.Annotated[numpy.typing.NDArray[numpy.float64], "[m, 1]"]: ... + @rhs.setter + def rhs(self, arg0: numpy.typing.ArrayLike) -> None: ... + +class OptimizationStats: + """ + Debug stats for a full optimization run. + """ + def __getstate__(self) -> tuple: ... + def __init__(self) -> None: ... + def __setstate__(self, arg0: tuple) -> None: ... + def get_lcm_type(self) -> lcmtypes.sym._optimization_stats_t.optimization_stats_t: ... + @property + def best_index(self) -> int: + """ + Index into iterations of the best iteration (containing the optimal Values). + """ + @best_index.setter + def best_index(self, arg0: typing.SupportsInt) -> None: ... + @property + def best_linearization(self) -> typing.Optional[Linearization]: + """ + The linearization at best_index (at optimized_values), filled out if populate_best_linearization=True + """ + @best_linearization.setter + def best_linearization(self, arg1: typing.Optional[Linearization]) -> None: ... + @property + def cholesky_factor_sparsity( + self, + ) -> lcmtypes.sym._sparse_matrix_structure_t.sparse_matrix_structure_t: + """ + Sparsity pattern of the cholesky factor L (filled out if debug_stats=True) + """ + @cholesky_factor_sparsity.setter + def cholesky_factor_sparsity( + self, arg0: lcmtypes.sym._sparse_matrix_structure_t.sparse_matrix_structure_t + ) -> None: ... + @property + def failure_reason(self) -> int: + """ + If status == FAILED, why? This should be cast to the NonlinearSolver::FailureReason enum for the nonlinear solver you used. + """ + @failure_reason.setter + def failure_reason(self, arg0: typing.SupportsInt) -> None: ... + @property + def iterations( + self, + ) -> list[lcmtypes.sym._optimization_iteration_t.optimization_iteration_t]: ... + @iterations.setter + def iterations( + self, + arg0: collections.abc.Sequence[ + lcmtypes.sym._optimization_iteration_t.optimization_iteration_t + ], + ) -> None: ... + @property + def jacobian_sparsity( + self, + ) -> lcmtypes.sym._sparse_matrix_structure_t.sparse_matrix_structure_t: + """ + Sparsity pattern of the problem jacobian (filled out if debug_stats=True and include_jacobians=True) + """ + @jacobian_sparsity.setter + def jacobian_sparsity( + self, arg0: lcmtypes.sym._sparse_matrix_structure_t.sparse_matrix_structure_t + ) -> None: ... + @property + def linear_solver_ordering( + self, + ) -> typing.Annotated[numpy.typing.NDArray[numpy.int32], "[m, 1]"]: + """ + Ordering used by the linear solver (filled out if debug_stats=True) + """ + @linear_solver_ordering.setter + def linear_solver_ordering(self, arg0: numpy.typing.ArrayLike) -> None: ... + @property + def status(self) -> lcmtypes.sym._optimization_status_t.optimization_status_t: + """ + What was the result of the optimization? (did it converge, fail, etc.) + """ + @status.setter + def status(self, arg0: lcmtypes.sym._optimization_status_t.optimization_status_t) -> None: ... + +class Optimizer: + """ + Class for optimizing a nonlinear least-squares problem specified as a list of Factors. For efficient use, create once and call Optimize() multiple times with different initial guesses, as long as the factors remain constant and the structure of the Values is identical. + """ + def __init__( + self, + params: lcmtypes.sym._optimizer_params_t.optimizer_params_t, + factors: collections.abc.Sequence[Factor], + name: str = "sym::Optimize", + keys: collections.abc.Sequence[Key] = [], + epsilon: typing.SupportsFloat = 2.220446049250313e-15, + ) -> None: ... + def compute_all_covariances( + self, linearization: Linearization + ) -> dict[Key, typing.Annotated[numpy.typing.NDArray[numpy.float64], "[m, n]"]]: + """ + Get covariances for each optimized key at the given linearization + + May not be called before either optimize or linearize has been called. + """ + def compute_covariances( + self, linearization: Linearization, keys: collections.abc.Sequence[Key] + ) -> dict[Key, typing.Annotated[numpy.typing.NDArray[numpy.float64], "[m, n]"]]: + """ + Get covariances for the given subset of keys at the given linearization + + This version is potentially much more efficient than computing the covariances for all + keys in the problem. + + Currently requires that `keys` corresponds to a set of keys at the start of the list of keys + for the full problem, and in the same order. It uses the Schur complement trick, so will be + most efficient if the hessian is of the following form, with C block diagonal:: + + A = ( B E ) + ( E^T C ) + """ + def compute_full_covariance( + self, linearization: Linearization + ) -> typing.Annotated[numpy.typing.NDArray[numpy.float64], "[m, n]"]: + """ + Get the full problem covariance at the given linearization + + Unlike compute_covariance and compute_all_covariances, this includes the off-diagonal + blocks, i.e. the cross-covariances between different keys. + + The ordering of entries here is the same as the ordering of the keys in the linearization, + which can be accessed via linearization_index(). + + May not be called before either optimize or linearize has been called. + """ + def factors(self) -> list[Factor]: + """ + Get the factors. + """ + def keys(self) -> list[Key]: + """ + Get the optimized keys. + """ + def linearization_index(self) -> dict: ... + def linearization_index_entry(self, key: Key) -> lcmtypes.sym._index_entry_t.index_entry_t: ... + def linearize(self, values: Values) -> Linearization: + """ + Linearize the problem around the given values. + """ + @typing.overload + def optimize( + self, + values: Values, + num_iterations: typing.SupportsInt = -1, + populate_best_linearization: bool = False, + ) -> OptimizationStats: + """ + Optimize the given values in-place + + Args: + num_iterations: If < 0 (the default), uses the number of iterations specified by the params at construction. + + populate_best_linearization: If true, the linearization at the best values will be filled out in the stats. + + Returns: + The optimization stats + """ + @typing.overload + def optimize( + self, + values: Values, + num_iterations: typing.SupportsInt, + populate_best_linearization: bool, + stats: OptimizationStats, + ) -> None: + """ + Optimize the given values in-place + + This overload takes the stats as an argument, and stores into there. This allows users to + avoid reallocating memory for any of the entries in the stats, for use cases where that's + important. If passed, stats must not be None. + + Args: + num_iterations: If < 0 (the default), uses the number of iterations specified by the params at construction + + populate_best_linearization: If true, the linearization at the best values will be filled out in the stats + + stats: An OptimizationStats to fill out with the result - if filling out dynamically allocated fields here, will not reallocate if memory is already allocated in the required shape (e.g. for repeated calls to Optimize) + """ + @typing.overload + def optimize( + self, values: Values, num_iterations: typing.SupportsInt, stats: OptimizationStats + ) -> None: + """ + Optimize the given values in-place + + This overload takes the stats as an argument, and stores into there. This allows users to + avoid reallocating memory for any of the entries in the stats, for use cases where that's + important. If passed, stats must not be None. + + Args: + num_iterations: If < 0 (the default), uses the number of iterations specified by the params at construction + + stats: An OptimizationStats to fill out with the result - if filling out dynamically allocated fields here, will not reallocate if memory is already allocated in the required shape (e.g. for repeated calls to Optimize) + """ + @typing.overload + def optimize(self, values: Values, stats: OptimizationStats) -> None: + """ + Optimize the given values in-place + + This overload takes the stats as an argument, and stores into there. This allows users to + avoid reallocating memory for any of the entries in the stats, for use cases where that's + important. If passed, stats must not be None. + + Args: + stats: An OptimizationStats to fill out with the result - if filling out dynamically allocated fields here, will not reallocate if memory is already allocated in the required shape (e.g. for repeated calls to Optimize) + """ + def update_params(self, params: lcmtypes.sym._optimizer_params_t.optimizer_params_t) -> None: + """ + Update the optimizer params. + """ + +class PreintegratedImuMeasurements: + """ + Struct of Preintegrated IMU Measurements (not including the covariance of change in orientation, velocity, and position). + """ + class Delta: + """ + A convenient struct that holds the Preintegrated delta. + """ + + DR: sym.Rot3 + @staticmethod + def from_lcm( + arg0: lcmtypes.sym._imu_integrated_measurement_delta_t.imu_integrated_measurement_delta_t, + ) -> PreintegratedImuMeasurements.Delta: ... + def get_lcm_type( + self, + ) -> ( + lcmtypes.sym._imu_integrated_measurement_delta_t.imu_integrated_measurement_delta_t + ): ... + def roll_forward_state( + self, pose_i: sym.Pose3, vel_i: numpy.typing.ArrayLike, gravity: numpy.typing.ArrayLike + ) -> tuple[sym.Pose3, typing.Annotated[numpy.typing.NDArray[numpy.float64], "[3, 1]"]]: ... + @property + def Dp(self) -> typing.Annotated[numpy.typing.NDArray[numpy.float64], "[3, 1]"]: ... + @Dp.setter + def Dp(self, arg0: numpy.typing.ArrayLike) -> None: ... + @property + def Dt(self) -> float: ... + @Dt.setter + def Dt(self, arg0: typing.SupportsFloat) -> None: ... + @property + def Dv(self) -> typing.Annotated[numpy.typing.NDArray[numpy.float64], "[3, 1]"]: ... + @Dv.setter + def Dv(self, arg0: numpy.typing.ArrayLike) -> None: ... + + delta: PreintegratedImuMeasurements.Delta + @staticmethod + def from_lcm( + arg0: lcmtypes.sym._imu_integrated_measurement_t.imu_integrated_measurement_t, + ) -> PreintegratedImuMeasurements: ... + def __init__( + self, accel_bias: numpy.typing.ArrayLike, gyro_bias: numpy.typing.ArrayLike + ) -> None: ... + def get_bias_corrected_delta( + self, new_accel_bias: numpy.typing.ArrayLike, new_gyro_bias: numpy.typing.ArrayLike + ) -> PreintegratedImuMeasurements.Delta: ... + def get_lcm_type( + self, + ) -> lcmtypes.sym._imu_integrated_measurement_t.imu_integrated_measurement_t: ... + @property + def DR_D_gyro_bias(self) -> typing.Annotated[numpy.typing.NDArray[numpy.float64], "[3, 3]"]: ... + @DR_D_gyro_bias.setter + def DR_D_gyro_bias(self, arg0: numpy.typing.ArrayLike) -> None: ... + @property + def Dp_D_accel_bias( + self, + ) -> typing.Annotated[numpy.typing.NDArray[numpy.float64], "[3, 3]"]: ... + @Dp_D_accel_bias.setter + def Dp_D_accel_bias(self, arg0: numpy.typing.ArrayLike) -> None: ... + @property + def Dp_D_gyro_bias(self) -> typing.Annotated[numpy.typing.NDArray[numpy.float64], "[3, 3]"]: ... + @Dp_D_gyro_bias.setter + def Dp_D_gyro_bias(self, arg0: numpy.typing.ArrayLike) -> None: ... + @property + def Dv_D_accel_bias( + self, + ) -> typing.Annotated[numpy.typing.NDArray[numpy.float64], "[3, 3]"]: ... + @Dv_D_accel_bias.setter + def Dv_D_accel_bias(self, arg0: numpy.typing.ArrayLike) -> None: ... + @property + def Dv_D_gyro_bias(self) -> typing.Annotated[numpy.typing.NDArray[numpy.float64], "[3, 3]"]: ... + @Dv_D_gyro_bias.setter + def Dv_D_gyro_bias(self, arg0: numpy.typing.ArrayLike) -> None: ... + @property + def accel_bias(self) -> typing.Annotated[numpy.typing.NDArray[numpy.float64], "[3, 1]"]: ... + @accel_bias.setter + def accel_bias(self, arg0: numpy.typing.ArrayLike) -> None: ... + @property + def gyro_bias(self) -> typing.Annotated[numpy.typing.NDArray[numpy.float64], "[3, 1]"]: ... + @gyro_bias.setter + def gyro_bias(self, arg0: numpy.typing.ArrayLike) -> None: ... + +class ImuPreintegrator: + """ + Class to on-manifold preintegrate IMU measurements for usage in a SymForce optimization problem. + """ + def __init__( + self, accel_bias: numpy.typing.ArrayLike, gyro_bias: numpy.typing.ArrayLike + ) -> None: ... + def covariance(self) -> typing.Annotated[numpy.typing.NDArray[numpy.float64], "[9, 9]"]: ... + def integrate_measurement( + self, + measured_accel: numpy.typing.ArrayLike, + measured_gyro: numpy.typing.ArrayLike, + accel_cov: numpy.typing.ArrayLike, + gyro_cov: numpy.typing.ArrayLike, + dt: typing.SupportsFloat, + epsilon: typing.SupportsFloat = 2.220446049250313e-15, + ) -> None: ... + def preintegrated_measurements(self) -> PreintegratedImuMeasurements: ... + def default_optimizer_params() -> lcmtypes.sym._optimizer_params_t.optimizer_params_t: """ Sensible default parameters for Optimizer. diff --git a/symforce/test_util/stubs_util.py b/symforce/test_util/stubs_util.py index 057f7ba9..8d6dd22c 100644 --- a/symforce/test_util/stubs_util.py +++ b/symforce/test_util/stubs_util.py @@ -11,12 +11,10 @@ import pybind11_stubgen.parser.mixins.fix as fix_mixins import pybind11_stubgen.parser.mixins.parse as parse_mixins from pybind11_stubgen import ExtractSignaturesFromPybind11Docstrings -from pybind11_stubgen import FixCurrentModulePrefixInTypeNames from pybind11_stubgen import FixMissingImports as PybindFixMissingImports from pybind11_stubgen import ( FixMissingNoneHashFieldAnnotation as PybindFixMissingNoneHashFieldAnnotation, ) -from pybind11_stubgen import FixTypingTypeNames as PybindFixTypingTypeNames from pybind11_stubgen import IParser from pybind11_stubgen.structs import Class from pybind11_stubgen.structs import Docstring @@ -38,52 +36,12 @@ def _add_import(self, name: QualifiedName) -> None: return super()._add_import(name) - # NOTE(aaron): Fixed in https://github.com/sizmailov/pybind11-stubgen/pull/263 - def parse_annotation_str(self, annotation_str: str) -> ResolvedType | InvalidExpression | Value: - result = super().parse_annotation_str(annotation_str) - - def handle_annotation(annotation: ResolvedType | InvalidExpression | Value) -> None: - if isinstance(annotation, ResolvedType): - self._add_import(annotation.name) - if annotation.parameters is not None: - for p in annotation.parameters: - handle_annotation(p) - - handle_annotation(result) - return result - def patch_lcmtype_imports() -> None: fix_mixins.FixMissingImports = FixMissingImports # type: ignore[misc] pybind11_stubgen.FixMissingImports = FixMissingImports # type: ignore[misc] -def patch_current_module_prefix() -> None: - """ - Fix use of the current module in nested types - - Could upstream - """ - - def parse_annotation_str( - self: FixCurrentModulePrefixInTypeNames, - annotation_str: str, - ) -> ResolvedType | InvalidExpression | Value: - result = super(FixCurrentModulePrefixInTypeNames, self).parse_annotation_str(annotation_str) # type: ignore[safe-super] - - def handle_annotation(annotation: ResolvedType | InvalidExpression | Value) -> None: - if isinstance(annotation, ResolvedType): - annotation.name = self._strip_current_module(annotation.name) - if annotation.parameters is not None: - for p in annotation.parameters: - handle_annotation(p) - - handle_annotation(result) - return result - - fix_mixins.FixCurrentModulePrefixInTypeNames.parse_annotation_str = parse_annotation_str # type: ignore[method-assign] - - def patch_handle_docstring() -> None: """ Patch BaseParser.handle_docstring to always strip empty lines from the start or end of @@ -119,43 +77,6 @@ def handle_field( fix_mixins.FixMissingNoneHashFieldAnnotation.handle_field = handle_field # type: ignore[method-assign] -def patch_numpy_annotations() -> None: - class FixTypingTypeNames(PybindFixTypingTypeNames): - def _parse_annotation_str( - self, - result: ResolvedType | InvalidExpression | Value, - ) -> ResolvedType | InvalidExpression | Value: - if not isinstance(result, ResolvedType): - return result - - result.parameters = ( - [self._parse_annotation_str(p) for p in result.parameters] - if result.parameters is not None - else None - ) - - if len(result.name) != 1: - if result.name[0] == "typing" and result.name[1] in self.__typing_extensions_names: - result.name = QualifiedName.from_str(f"typing_extensions.{result.name[1]}") - return result - - word = result.name[0] - if word in self.__typing_names: - package = "typing" - if word in self.__typing_extensions_names: - package = "typing_extensions" - result.name = QualifiedName.from_str(f"{package}.{word[0].upper()}{word[1:]}") - if word == "function" and result.parameters is None: - result.name = QualifiedName.from_str("typing.Callable") - if word in {"object", "handle"} and result.parameters is None: - result.name = QualifiedName.from_str("typing.Any") - - return result - - fix_mixins.FixTypingTypeNames = FixTypingTypeNames # type: ignore[misc] - pybind11_stubgen.FixTypingTypeNames = FixTypingTypeNames # type: ignore[misc] - - class FixNumpyArrayRemoveParameters(IParser): __ndarray_name = QualifiedName.from_str("numpy.typing.ArrayLike") diff --git a/test/symforce_cc_sym_stubs_codegen_test.py b/test/symforce_cc_sym_stubs_codegen_test.py index 94099352..ed93a6c6 100644 --- a/test/symforce_cc_sym_stubs_codegen_test.py +++ b/test/symforce_cc_sym_stubs_codegen_test.py @@ -15,17 +15,13 @@ from symforce import path_util from symforce.codegen import format_util from symforce.test_util import TestCase -from symforce.test_util.stubs_util import patch_current_module_prefix from symforce.test_util.stubs_util import patch_handle_docstring from symforce.test_util.stubs_util import patch_lcmtype_imports -from symforce.test_util.stubs_util import patch_numpy_annotations from symforce.test_util.stubs_util import patch_remove_parameters patch_lcmtype_imports() patch_handle_docstring() patch_remove_parameters() -patch_numpy_annotations() -patch_current_module_prefix() class SymforceCCSymStubsCodegenTest(TestCase): @@ -52,6 +48,7 @@ def cc_sym_stubgen_output(self) -> str: # Ignore undefined n and m typevars for numpy arrays # This shouldn't be needed with --numpy-array-remove-parameters, but it seems like it is "--ignore-unresolved-names=n|m", + "--print-value-comments", f"--output-dir={output_dir}", "--exit-code", ] @@ -61,20 +58,16 @@ def cc_sym_stubgen_output(self) -> str: ) parser = pybind11_stubgen.stub_parser_from_args(args) - printer = pybind11_stubgen.Printer(invalid_expr_as_ellipses=False) - - out_dir, sub_dir = pybind11_stubgen.to_output_and_subdir( - output_dir=args.output_dir, - module_name=args.module_name, - root_suffix=args.root_suffix, + printer = pybind11_stubgen.Printer( + invalid_expr_as_ellipses=False, print_value_comments=args.print_value_comments ) pybind11_stubgen.run( parser, printer, - args.module_name, - out_dir, - sub_dir=sub_dir, + args.module_names, + args.output_dir, + root_suffix=args.root_suffix, dry_run=args.dry_run, writer=pybind11_stubgen.Writer(stub_ext=args.stub_extension), ) From 6c14fc6470ca1f366c1630922b64b4326562ad79 Mon Sep 17 00:00:00 2001 From: Aaron Date: Sat, 3 Oct 2026 10:44:36 +0000 Subject: [PATCH 39/68] [SymForce] Some fixes for clang-tidy google-explicit-constructor GitOrigin-RevId: 10107f4bb1fde17049f614f9a0e31ee1dc609304 --- gen/cpp/sym/camera.h | 4 ++-- symforce/caspar/source/runtime/solver_params.h | 4 ++-- .../backends/cpp/templates/cam_package/camera.h.jinja | 2 +- symforce/opt/fixed_size_optimizer.h | 6 +++--- symforce/opt/key.h | 10 +++++++--- symforce/opt/sparse_cholesky/sparse_cholesky_solver.h | 9 +++++++-- symforce/opt/sparse_schur_solver.h | 6 ++++-- symforce/opt/values.h | 2 +- 8 files changed, 27 insertions(+), 16 deletions(-) diff --git a/gen/cpp/sym/camera.h b/gen/cpp/sym/camera.h index c2688bde..63e28ee2 100644 --- a/gen/cpp/sym/camera.h +++ b/gen/cpp/sym/camera.h @@ -21,8 +21,8 @@ class Camera { public: using Scalar = typename CameraCalType::Scalar; - Camera(const CameraCalType& calibration, - const Eigen::Vector2i& image_size = Eigen::Vector2i(-1, -1)) + explicit Camera(const CameraCalType& calibration, + const Eigen::Vector2i& image_size = Eigen::Vector2i(-1, -1)) : calibration_(calibration), image_size_(image_size) {} Eigen::Matrix FocalLength() const { diff --git a/symforce/caspar/source/runtime/solver_params.h b/symforce/caspar/source/runtime/solver_params.h index c7dfdf68..1efd239b 100644 --- a/symforce/caspar/source/runtime/solver_params.h +++ b/symforce/caspar/source/runtime/solver_params.h @@ -22,11 +22,11 @@ struct SolverParams { T pcg_rel_decrease_min = -1.0f; // disabled if == -1.0f T solver_rel_decrease_min = 1.0f; - // Templated conversion constructor to enable automatic type conversion SolverParams() = default; + // Implicit so set_params can assign a SolverParams to the SolverParams member. template - SolverParams(const SolverParams& other) + SolverParams(const SolverParams& other) // NOLINT(google-explicit-constructor) : diag_init(static_cast(other.diag_init)), diag_scaling_up(static_cast(other.diag_scaling_up)), diag_scaling_down(static_cast(other.diag_scaling_down)), diff --git a/symforce/codegen/backends/cpp/templates/cam_package/camera.h.jinja b/symforce/codegen/backends/cpp/templates/cam_package/camera.h.jinja index e9f2f8db..b92ef689 100644 --- a/symforce/codegen/backends/cpp/templates/cam_package/camera.h.jinja +++ b/symforce/codegen/backends/cpp/templates/cam_package/camera.h.jinja @@ -21,7 +21,7 @@ class Camera { public: using Scalar = typename CameraCalType::Scalar; - Camera(const CameraCalType& calibration, const Eigen::Vector2i& image_size=Eigen::Vector2i(-1, -1)) + explicit Camera(const CameraCalType& calibration, const Eigen::Vector2i& image_size=Eigen::Vector2i(-1, -1)) : calibration_(calibration), image_size_(image_size) { } diff --git a/symforce/opt/fixed_size_optimizer.h b/symforce/opt/fixed_size_optimizer.h index 76b71de0..ac168f7b 100644 --- a/symforce/opt/fixed_size_optimizer.h +++ b/symforce/opt/fixed_size_optimizer.h @@ -72,9 +72,9 @@ class FixedSizeOptimizer { using LinearizeFunc = typename NonlinearSolverType::LinearizeFunc; using ValuesType = typename NonlinearSolverType::ValuesType; - FixedSizeOptimizer(const optimizer_params_t& params, - const std::string& name = "sym::FixedSizeOptimizer", - const Scalar epsilon = sym::kDefaultEpsilon); + explicit FixedSizeOptimizer(const optimizer_params_t& params, + const std::string& name = "sym::FixedSizeOptimizer", + const Scalar epsilon = sym::kDefaultEpsilon); template FixedSizeOptimizer(const optimizer_params_t& params, const std::string& name, diff --git a/symforce/opt/key.h b/symforce/opt/key.h index 142957fe..1e0fce7d 100644 --- a/symforce/opt/key.h +++ b/symforce/opt/key.h @@ -36,13 +36,17 @@ class Key { static constexpr superscript_t kInvalidSuper = std::numeric_limits::min(); constexpr Key() = default; - constexpr Key(const letter_t letter, const subscript_t sub = kInvalidSub, - const superscript_t super = kInvalidSuper) + // Implicit so a letter or {letter, sub, super} can be passed wherever a Key is expected. + constexpr Key(const letter_t letter, // NOLINT(google-explicit-constructor) + const subscript_t sub = kInvalidSub, const superscript_t super = kInvalidSuper) : letter_(letter), sub_(sub), super_(super) { SYM_ASSERT(letter != kInvalidLetter); } - constexpr Key(const key_t& key) : Key(key.letter, key.subscript, key.superscript) {} + // Implicit because key_t is the LCM form of the same value, and code indexing Key maps with a + // key_t relies on it. + constexpr Key(const key_t& key) // NOLINT(google-explicit-constructor) + : Key(key.letter, key.subscript, key.superscript) {} constexpr letter_t Letter() const noexcept { return letter_; diff --git a/symforce/opt/sparse_cholesky/sparse_cholesky_solver.h b/symforce/opt/sparse_cholesky/sparse_cholesky_solver.h index 6df71156..bb5cc4df 100644 --- a/symforce/opt/sparse_cholesky/sparse_cholesky_solver.h +++ b/symforce/opt/sparse_cholesky/sparse_cholesky_solver.h @@ -44,7 +44,12 @@ class SparseCholeskySolver { public: /** - * Default constructor + * Default constructor, using Eigen::MetisOrdering + */ + SparseCholeskySolver() : SparseCholeskySolver(Eigen::MetisOrdering()) {} + + /** + * Construct with the given variable ordering * * @param ordering: Functor to compute the variable ordering to use. Can be any functor with * signature void(const MatrixType&, PermutationMatrixType&) which takes in the sparsity @@ -54,7 +59,7 @@ class SparseCholeskySolver { * that are nonzero. Typically this will be an instance of one of the orderings provided * by Eigen, such as Eigen::NaturalOrdering(). */ - SparseCholeskySolver(const Ordering& ordering = Eigen::MetisOrdering()) + explicit SparseCholeskySolver(const Ordering& ordering) : is_initialized_(false), ordering_(ordering) {} /** diff --git a/symforce/opt/sparse_schur_solver.h b/symforce/opt/sparse_schur_solver.h index df729ffc..13998eae 100644 --- a/symforce/opt/sparse_schur_solver.h +++ b/symforce/opt/sparse_schur_solver.h @@ -73,8 +73,10 @@ class SparseSchurSolver { using MatrixX = Eigen::Matrix; using VectorX = Eigen::Matrix; - SparseSchurSolver(const typename SMatrixSolverType::Ordering& ordering = - Eigen::MetisOrdering()) + SparseSchurSolver() + : SparseSchurSolver(Eigen::MetisOrdering()) {} + + explicit SparseSchurSolver(const typename SMatrixSolverType::Ordering& ordering) : is_initialized_(false), S_solver_(ordering) {} bool IsInitialized() const { diff --git a/symforce/opt/values.h b/symforce/opt/values.h index 0942eaf7..947057e0 100644 --- a/symforce/opt/values.h +++ b/symforce/opt/values.h @@ -47,7 +47,7 @@ class Values { * * NOTE(alvin): others Values should not contain overlapping Keys */ - explicit Values(std::initializer_list> others); + Values(std::initializer_list> others); /** * Construct from serialized form. From b98449544a8cb1f049c3e150de9f27fe8f7bf5f5 Mon Sep 17 00:00:00 2001 From: Skydio Buildkite Worker Date: Sun, 4 Oct 2026 14:11:09 +0000 Subject: [PATCH 40/68] [SymForce] Update pinned dependencies GitOrigin-RevId: 7bb5ed09df388f7eef2ddf7c3c5476a265f1ff9c --- requirements/dev_py310.txt | 4 ++-- requirements/dev_py311.txt | 4 ++-- requirements/dev_py312.txt | 4 ++-- requirements/dev_py313.txt | 4 ++-- requirements/dev_py314.txt | 4 ++-- 5 files changed, 10 insertions(+), 10 deletions(-) diff --git a/requirements/dev_py310.txt b/requirements/dev_py310.txt index de50a45e..96728e6e 100644 --- a/requirements/dev_py310.txt +++ b/requirements/dev_py310.txt @@ -302,7 +302,7 @@ tomli==2.4.0 # mypy # setuptools-scm # sphinx -tornado==6.5.8 +tornado==6.5.9 # via # ipykernel # jupyter-client @@ -338,7 +338,7 @@ typing-extensions==4.15.0 # sortedcontainers-stubs tzdata==2025.3 # via pandas -urllib3==2.7.0 +urllib3==2.8.0 # via # requests # types-requests diff --git a/requirements/dev_py311.txt b/requirements/dev_py311.txt index dc539abc..b1a90ce7 100644 --- a/requirements/dev_py311.txt +++ b/requirements/dev_py311.txt @@ -298,7 +298,7 @@ sympy==1.13.3 # via symforce (pyproject.toml) tinycss2==1.4.0 # via bleach -tornado==6.5.8 +tornado==6.5.9 # via # ipykernel # jupyter-client @@ -330,7 +330,7 @@ typing-extensions==4.15.0 # mypy # referencing # sortedcontainers-stubs -urllib3==2.7.0 +urllib3==2.8.0 # via # requests # types-requests diff --git a/requirements/dev_py312.txt b/requirements/dev_py312.txt index e4973cc6..29b18698 100644 --- a/requirements/dev_py312.txt +++ b/requirements/dev_py312.txt @@ -298,7 +298,7 @@ sympy==1.13.3 # via symforce (pyproject.toml) tinycss2==1.4.0 # via bleach -tornado==6.5.8 +tornado==6.5.9 # via # ipykernel # jupyter-client @@ -329,7 +329,7 @@ typing-extensions==4.15.0 # mypy # referencing # sortedcontainers-stubs -urllib3==2.7.0 +urllib3==2.8.0 # via # requests # types-requests diff --git a/requirements/dev_py313.txt b/requirements/dev_py313.txt index 466147a0..875c3680 100644 --- a/requirements/dev_py313.txt +++ b/requirements/dev_py313.txt @@ -298,7 +298,7 @@ sympy==1.13.3 # via symforce (pyproject.toml) tinycss2==1.4.0 # via bleach -tornado==6.5.8 +tornado==6.5.9 # via # ipykernel # jupyter-client @@ -328,7 +328,7 @@ typing-extensions==4.15.0 # beautifulsoup4 # mypy # sortedcontainers-stubs -urllib3==2.7.0 +urllib3==2.8.0 # via # requests # types-requests diff --git a/requirements/dev_py314.txt b/requirements/dev_py314.txt index 7e897e94..e8c6c59d 100644 --- a/requirements/dev_py314.txt +++ b/requirements/dev_py314.txt @@ -300,7 +300,7 @@ sympy==1.13.3 # via symforce (pyproject.toml) tinycss2==1.4.0 # via bleach -tornado==6.5.8 +tornado==6.5.9 # via # ipykernel # jupyter-client @@ -332,7 +332,7 @@ typing-extensions==4.15.0 # sortedcontainers-stubs tzdata==2026.2 # via pandas -urllib3==2.7.0 +urllib3==2.8.0 # via # requests # types-requests From ad058f37df9a8087bb3012f5a736b1b3e26810ce Mon Sep 17 00:00:00 2001 From: Tom Date: Thu, 8 Oct 2026 02:10:11 +0000 Subject: [PATCH 41/68] skymarshal: 1 vector allocation per schema() call Change the schema() implementation to do 1 allocation, rather than 1 each time vector grows. i.e. a lcm type with 8 members, will malloc() 4 times during the 8 push back operations. ``` when size grows: 0 -> 1 when size grows: 1 -> 2 when size grows: 2 -> 4 when size grows: 4 -> 8 ``` This reduces it to 1 via reserve(). Topic: schema-improvement GitOrigin-RevId: 1832d8415393e4c404f67d98172254e724d34195 --- .../cpp/lcmtypes/codegen_cpp_test/constants_t.hpp | 1 + .../cpp/lcmtypes/codegen_cpp_test/states_t.hpp | 1 + .../cpp/lcmtypes/codegen_cpp_test/values_vec_t.hpp | 1 + .../cpp/lcmtypes/codegen_test/my_dataclass_t.hpp | 1 + .../codegen_explicit_template_instantiation_test/constants_t.hpp | 1 + .../codegen_explicit_template_instantiation_test/states_t.hpp | 1 + .../values_vec_t.hpp | 1 + .../lcmtypes/codegen_multi_function_test/inputs_constants_t.hpp | 1 + .../cpp/lcmtypes/codegen_multi_function_test/inputs_states_t.hpp | 1 + .../cpp/lcmtypes/codegen_multi_function_test/inputs_t.hpp | 1 + .../cpp/lcmtypes/codegen_multi_function_test/outputs_1_t.hpp | 1 + .../cpp/lcmtypes/codegen_multi_function_test/outputs_2_t.hpp | 1 + .../cpp/lcmtypes/codegen_multi_function_test/values_vec_t.hpp | 1 + .../cpp/lcmtypes/codegen_python_test/constants_t.hpp | 1 + .../cpp/lcmtypes/codegen_python_test/states_t.hpp | 1 + .../cpp/lcmtypes/codegen_python_test/values_vec_t.hpp | 1 + .../symengine/with_jacobians_values/cpp/lcmtypes/sym/d_out_t.hpp | 1 + .../symengine/with_jacobians_values/cpp/lcmtypes/sym/d_t.hpp | 1 + .../cpp/lcmtypes/codegen_cpp_test/constants_t.hpp | 1 + .../cpp/lcmtypes/codegen_cpp_test/states_t.hpp | 1 + .../cpp/lcmtypes/codegen_cpp_test/values_vec_t.hpp | 1 + .../cpp/lcmtypes/codegen_test/my_dataclass_t.hpp | 1 + .../codegen_explicit_template_instantiation_test/constants_t.hpp | 1 + .../codegen_explicit_template_instantiation_test/states_t.hpp | 1 + .../values_vec_t.hpp | 1 + .../lcmtypes/codegen_multi_function_test/inputs_constants_t.hpp | 1 + .../cpp/lcmtypes/codegen_multi_function_test/inputs_states_t.hpp | 1 + .../cpp/lcmtypes/codegen_multi_function_test/inputs_t.hpp | 1 + .../cpp/lcmtypes/codegen_multi_function_test/outputs_1_t.hpp | 1 + .../cpp/lcmtypes/codegen_multi_function_test/outputs_2_t.hpp | 1 + .../cpp/lcmtypes/codegen_multi_function_test/values_vec_t.hpp | 1 + .../cpp/lcmtypes/codegen_python_test/constants_t.hpp | 1 + .../cpp/lcmtypes/codegen_python_test/states_t.hpp | 1 + .../cpp/lcmtypes/codegen_python_test/values_vec_t.hpp | 1 + .../sympy/with_jacobians_values/cpp/lcmtypes/sym/d_out_t.hpp | 1 + .../sympy/with_jacobians_values/cpp/lcmtypes/sym/d_t.hpp | 1 + third_party/skymarshal/skymarshal/templates/lcmtype.hpp.template | 1 + 37 files changed, 37 insertions(+) diff --git a/test/symforce_function_codegen_test_data/symengine/codegen_cpp_test_data/cpp/lcmtypes/codegen_cpp_test/constants_t.hpp b/test/symforce_function_codegen_test_data/symengine/codegen_cpp_test_data/cpp/lcmtypes/codegen_cpp_test/constants_t.hpp index 9ca6e6f1..01297339 100644 --- a/test/symforce_function_codegen_test_data/symengine/codegen_cpp_test_data/cpp/lcmtypes/codegen_cpp_test/constants_t.hpp +++ b/test/symforce_function_codegen_test_data/symengine/codegen_cpp_test_data/cpp/lcmtypes/codegen_cpp_test/constants_t.hpp @@ -113,6 +113,7 @@ class constants_t static lcm::StructType schema() { std::vector fields; + fields.reserve(1); fields.push_back(lcm::get_schema()); diff --git a/test/symforce_function_codegen_test_data/symengine/codegen_cpp_test_data/cpp/lcmtypes/codegen_cpp_test/states_t.hpp b/test/symforce_function_codegen_test_data/symengine/codegen_cpp_test_data/cpp/lcmtypes/codegen_cpp_test/states_t.hpp index 58d4378d..20eac645 100644 --- a/test/symforce_function_codegen_test_data/symengine/codegen_cpp_test_data/cpp/lcmtypes/codegen_cpp_test/states_t.hpp +++ b/test/symforce_function_codegen_test_data/symengine/codegen_cpp_test_data/cpp/lcmtypes/codegen_cpp_test/states_t.hpp @@ -121,6 +121,7 @@ class states_t static lcm::StructType schema() { std::vector fields; + fields.reserve(1); fields.push_back(lcm::get_schema()); diff --git a/test/symforce_function_codegen_test_data/symengine/codegen_cpp_test_data/cpp/lcmtypes/codegen_cpp_test/values_vec_t.hpp b/test/symforce_function_codegen_test_data/symengine/codegen_cpp_test_data/cpp/lcmtypes/codegen_cpp_test/values_vec_t.hpp index 22fcadc4..f6135ce7 100644 --- a/test/symforce_function_codegen_test_data/symengine/codegen_cpp_test_data/cpp/lcmtypes/codegen_cpp_test/values_vec_t.hpp +++ b/test/symforce_function_codegen_test_data/symengine/codegen_cpp_test_data/cpp/lcmtypes/codegen_cpp_test/values_vec_t.hpp @@ -142,6 +142,7 @@ class values_vec_t static lcm::StructType schema() { std::vector fields; + fields.reserve(6); fields.push_back(lcm::get_schema()); fields.push_back(lcm::get_schema()); diff --git a/test/symforce_function_codegen_test_data/symengine/codegen_dataclass_in_values_test_data/cpp/lcmtypes/codegen_test/my_dataclass_t.hpp b/test/symforce_function_codegen_test_data/symengine/codegen_dataclass_in_values_test_data/cpp/lcmtypes/codegen_test/my_dataclass_t.hpp index ceb69670..f7297938 100644 --- a/test/symforce_function_codegen_test_data/symengine/codegen_dataclass_in_values_test_data/cpp/lcmtypes/codegen_test/my_dataclass_t.hpp +++ b/test/symforce_function_codegen_test_data/symengine/codegen_dataclass_in_values_test_data/cpp/lcmtypes/codegen_test/my_dataclass_t.hpp @@ -121,6 +121,7 @@ class my_dataclass_t static lcm::StructType schema() { std::vector fields; + fields.reserve(1); fields.push_back(lcm::get_schema()); diff --git a/test/symforce_function_codegen_test_data/symengine/codegen_explicit_template_instantiation_test_data/cpp/lcmtypes/codegen_explicit_template_instantiation_test/constants_t.hpp b/test/symforce_function_codegen_test_data/symengine/codegen_explicit_template_instantiation_test_data/cpp/lcmtypes/codegen_explicit_template_instantiation_test/constants_t.hpp index ee09bc39..ba724c54 100644 --- a/test/symforce_function_codegen_test_data/symengine/codegen_explicit_template_instantiation_test_data/cpp/lcmtypes/codegen_explicit_template_instantiation_test/constants_t.hpp +++ b/test/symforce_function_codegen_test_data/symengine/codegen_explicit_template_instantiation_test_data/cpp/lcmtypes/codegen_explicit_template_instantiation_test/constants_t.hpp @@ -113,6 +113,7 @@ class constants_t static lcm::StructType schema() { std::vector fields; + fields.reserve(1); fields.push_back(lcm::get_schema()); diff --git a/test/symforce_function_codegen_test_data/symengine/codegen_explicit_template_instantiation_test_data/cpp/lcmtypes/codegen_explicit_template_instantiation_test/states_t.hpp b/test/symforce_function_codegen_test_data/symengine/codegen_explicit_template_instantiation_test_data/cpp/lcmtypes/codegen_explicit_template_instantiation_test/states_t.hpp index d606df5b..59c7f9c4 100644 --- a/test/symforce_function_codegen_test_data/symengine/codegen_explicit_template_instantiation_test_data/cpp/lcmtypes/codegen_explicit_template_instantiation_test/states_t.hpp +++ b/test/symforce_function_codegen_test_data/symengine/codegen_explicit_template_instantiation_test_data/cpp/lcmtypes/codegen_explicit_template_instantiation_test/states_t.hpp @@ -121,6 +121,7 @@ class states_t static lcm::StructType schema() { std::vector fields; + fields.reserve(1); fields.push_back(lcm::get_schema()); diff --git a/test/symforce_function_codegen_test_data/symengine/codegen_explicit_template_instantiation_test_data/cpp/lcmtypes/codegen_explicit_template_instantiation_test/values_vec_t.hpp b/test/symforce_function_codegen_test_data/symengine/codegen_explicit_template_instantiation_test_data/cpp/lcmtypes/codegen_explicit_template_instantiation_test/values_vec_t.hpp index 86bcdc3c..88106679 100644 --- a/test/symforce_function_codegen_test_data/symengine/codegen_explicit_template_instantiation_test_data/cpp/lcmtypes/codegen_explicit_template_instantiation_test/values_vec_t.hpp +++ b/test/symforce_function_codegen_test_data/symengine/codegen_explicit_template_instantiation_test_data/cpp/lcmtypes/codegen_explicit_template_instantiation_test/values_vec_t.hpp @@ -142,6 +142,7 @@ class values_vec_t static lcm::StructType schema() { std::vector fields; + fields.reserve(6); fields.push_back(lcm::get_schema()); fields.push_back(lcm::get_schema()); diff --git a/test/symforce_function_codegen_test_data/symengine/codegen_multi_function_test_data/cpp/lcmtypes/codegen_multi_function_test/inputs_constants_t.hpp b/test/symforce_function_codegen_test_data/symengine/codegen_multi_function_test_data/cpp/lcmtypes/codegen_multi_function_test/inputs_constants_t.hpp index 21ff367d..7cf9cee2 100644 --- a/test/symforce_function_codegen_test_data/symengine/codegen_multi_function_test_data/cpp/lcmtypes/codegen_multi_function_test/inputs_constants_t.hpp +++ b/test/symforce_function_codegen_test_data/symengine/codegen_multi_function_test_data/cpp/lcmtypes/codegen_multi_function_test/inputs_constants_t.hpp @@ -113,6 +113,7 @@ class inputs_constants_t static lcm::StructType schema() { std::vector fields; + fields.reserve(1); fields.push_back(lcm::get_schema()); diff --git a/test/symforce_function_codegen_test_data/symengine/codegen_multi_function_test_data/cpp/lcmtypes/codegen_multi_function_test/inputs_states_t.hpp b/test/symforce_function_codegen_test_data/symengine/codegen_multi_function_test_data/cpp/lcmtypes/codegen_multi_function_test/inputs_states_t.hpp index 47e42cfb..cff05483 100644 --- a/test/symforce_function_codegen_test_data/symengine/codegen_multi_function_test_data/cpp/lcmtypes/codegen_multi_function_test/inputs_states_t.hpp +++ b/test/symforce_function_codegen_test_data/symengine/codegen_multi_function_test_data/cpp/lcmtypes/codegen_multi_function_test/inputs_states_t.hpp @@ -121,6 +121,7 @@ class inputs_states_t static lcm::StructType schema() { std::vector fields; + fields.reserve(1); fields.push_back(lcm::get_schema()); diff --git a/test/symforce_function_codegen_test_data/symengine/codegen_multi_function_test_data/cpp/lcmtypes/codegen_multi_function_test/inputs_t.hpp b/test/symforce_function_codegen_test_data/symengine/codegen_multi_function_test_data/cpp/lcmtypes/codegen_multi_function_test/inputs_t.hpp index 524e234c..e08a918c 100644 --- a/test/symforce_function_codegen_test_data/symengine/codegen_multi_function_test_data/cpp/lcmtypes/codegen_multi_function_test/inputs_t.hpp +++ b/test/symforce_function_codegen_test_data/symengine/codegen_multi_function_test_data/cpp/lcmtypes/codegen_multi_function_test/inputs_t.hpp @@ -171,6 +171,7 @@ class inputs_t static lcm::StructType schema() { std::vector fields; + fields.reserve(12); fields.push_back(lcm::get_schema()); fields.push_back(lcm::get_schema()); diff --git a/test/symforce_function_codegen_test_data/symengine/codegen_multi_function_test_data/cpp/lcmtypes/codegen_multi_function_test/outputs_1_t.hpp b/test/symforce_function_codegen_test_data/symengine/codegen_multi_function_test_data/cpp/lcmtypes/codegen_multi_function_test/outputs_1_t.hpp index f2dcad5b..87270f90 100644 --- a/test/symforce_function_codegen_test_data/symengine/codegen_multi_function_test_data/cpp/lcmtypes/codegen_multi_function_test/outputs_1_t.hpp +++ b/test/symforce_function_codegen_test_data/symengine/codegen_multi_function_test_data/cpp/lcmtypes/codegen_multi_function_test/outputs_1_t.hpp @@ -148,6 +148,7 @@ class outputs_1_t static lcm::StructType schema() { std::vector fields; + fields.reserve(7); fields.push_back(lcm::get_schema()); fields.push_back(lcm::get_schema()); diff --git a/test/symforce_function_codegen_test_data/symengine/codegen_multi_function_test_data/cpp/lcmtypes/codegen_multi_function_test/outputs_2_t.hpp b/test/symforce_function_codegen_test_data/symengine/codegen_multi_function_test_data/cpp/lcmtypes/codegen_multi_function_test/outputs_2_t.hpp index 78db8e9d..05a1ebec 100644 --- a/test/symforce_function_codegen_test_data/symengine/codegen_multi_function_test_data/cpp/lcmtypes/codegen_multi_function_test/outputs_2_t.hpp +++ b/test/symforce_function_codegen_test_data/symengine/codegen_multi_function_test_data/cpp/lcmtypes/codegen_multi_function_test/outputs_2_t.hpp @@ -113,6 +113,7 @@ class outputs_2_t static lcm::StructType schema() { std::vector fields; + fields.reserve(1); fields.push_back(lcm::get_schema()); diff --git a/test/symforce_function_codegen_test_data/symengine/codegen_multi_function_test_data/cpp/lcmtypes/codegen_multi_function_test/values_vec_t.hpp b/test/symforce_function_codegen_test_data/symengine/codegen_multi_function_test_data/cpp/lcmtypes/codegen_multi_function_test/values_vec_t.hpp index 8dfb6e73..73dc29c9 100644 --- a/test/symforce_function_codegen_test_data/symengine/codegen_multi_function_test_data/cpp/lcmtypes/codegen_multi_function_test/values_vec_t.hpp +++ b/test/symforce_function_codegen_test_data/symengine/codegen_multi_function_test_data/cpp/lcmtypes/codegen_multi_function_test/values_vec_t.hpp @@ -142,6 +142,7 @@ class values_vec_t static lcm::StructType schema() { std::vector fields; + fields.reserve(6); fields.push_back(lcm::get_schema()); fields.push_back(lcm::get_schema()); diff --git a/test/symforce_function_codegen_test_data/symengine/codegen_python_test_data/cpp/lcmtypes/codegen_python_test/constants_t.hpp b/test/symforce_function_codegen_test_data/symengine/codegen_python_test_data/cpp/lcmtypes/codegen_python_test/constants_t.hpp index 3e64ab12..36661c14 100644 --- a/test/symforce_function_codegen_test_data/symengine/codegen_python_test_data/cpp/lcmtypes/codegen_python_test/constants_t.hpp +++ b/test/symforce_function_codegen_test_data/symengine/codegen_python_test_data/cpp/lcmtypes/codegen_python_test/constants_t.hpp @@ -113,6 +113,7 @@ class constants_t static lcm::StructType schema() { std::vector fields; + fields.reserve(1); fields.push_back(lcm::get_schema()); diff --git a/test/symforce_function_codegen_test_data/symengine/codegen_python_test_data/cpp/lcmtypes/codegen_python_test/states_t.hpp b/test/symforce_function_codegen_test_data/symengine/codegen_python_test_data/cpp/lcmtypes/codegen_python_test/states_t.hpp index 4a73f6ff..0c2cb117 100644 --- a/test/symforce_function_codegen_test_data/symengine/codegen_python_test_data/cpp/lcmtypes/codegen_python_test/states_t.hpp +++ b/test/symforce_function_codegen_test_data/symengine/codegen_python_test_data/cpp/lcmtypes/codegen_python_test/states_t.hpp @@ -121,6 +121,7 @@ class states_t static lcm::StructType schema() { std::vector fields; + fields.reserve(1); fields.push_back(lcm::get_schema()); diff --git a/test/symforce_function_codegen_test_data/symengine/codegen_python_test_data/cpp/lcmtypes/codegen_python_test/values_vec_t.hpp b/test/symforce_function_codegen_test_data/symengine/codegen_python_test_data/cpp/lcmtypes/codegen_python_test/values_vec_t.hpp index 0ff25e09..16963fe0 100644 --- a/test/symforce_function_codegen_test_data/symengine/codegen_python_test_data/cpp/lcmtypes/codegen_python_test/values_vec_t.hpp +++ b/test/symforce_function_codegen_test_data/symengine/codegen_python_test_data/cpp/lcmtypes/codegen_python_test/values_vec_t.hpp @@ -142,6 +142,7 @@ class values_vec_t static lcm::StructType schema() { std::vector fields; + fields.reserve(6); fields.push_back(lcm::get_schema()); fields.push_back(lcm::get_schema()); diff --git a/test/symforce_function_codegen_test_data/symengine/with_jacobians_values/cpp/lcmtypes/sym/d_out_t.hpp b/test/symforce_function_codegen_test_data/symengine/with_jacobians_values/cpp/lcmtypes/sym/d_out_t.hpp index b2208bbf..5ded3dd2 100644 --- a/test/symforce_function_codegen_test_data/symengine/with_jacobians_values/cpp/lcmtypes/sym/d_out_t.hpp +++ b/test/symforce_function_codegen_test_data/symengine/with_jacobians_values/cpp/lcmtypes/sym/d_out_t.hpp @@ -117,6 +117,7 @@ class d_out_t static lcm::StructType schema() { std::vector fields; + fields.reserve(2); fields.push_back(lcm::get_schema()); fields.push_back(lcm::get_schema()); diff --git a/test/symforce_function_codegen_test_data/symengine/with_jacobians_values/cpp/lcmtypes/sym/d_t.hpp b/test/symforce_function_codegen_test_data/symengine/with_jacobians_values/cpp/lcmtypes/sym/d_t.hpp index 23bc1155..b3c8656e 100644 --- a/test/symforce_function_codegen_test_data/symengine/with_jacobians_values/cpp/lcmtypes/sym/d_t.hpp +++ b/test/symforce_function_codegen_test_data/symengine/with_jacobians_values/cpp/lcmtypes/sym/d_t.hpp @@ -125,6 +125,7 @@ class d_t static lcm::StructType schema() { std::vector fields; + fields.reserve(2); fields.push_back(lcm::get_schema()); fields.push_back(lcm::get_schema()); diff --git a/test/symforce_function_codegen_test_data/sympy/codegen_cpp_test_data/cpp/lcmtypes/codegen_cpp_test/constants_t.hpp b/test/symforce_function_codegen_test_data/sympy/codegen_cpp_test_data/cpp/lcmtypes/codegen_cpp_test/constants_t.hpp index efa6cadc..ef8b31cf 100644 --- a/test/symforce_function_codegen_test_data/sympy/codegen_cpp_test_data/cpp/lcmtypes/codegen_cpp_test/constants_t.hpp +++ b/test/symforce_function_codegen_test_data/sympy/codegen_cpp_test_data/cpp/lcmtypes/codegen_cpp_test/constants_t.hpp @@ -112,6 +112,7 @@ class constants_t static lcm::StructType schema() { std::vector fields; + fields.reserve(1); fields.push_back(lcm::get_schema()); diff --git a/test/symforce_function_codegen_test_data/sympy/codegen_cpp_test_data/cpp/lcmtypes/codegen_cpp_test/states_t.hpp b/test/symforce_function_codegen_test_data/sympy/codegen_cpp_test_data/cpp/lcmtypes/codegen_cpp_test/states_t.hpp index e7d3591a..e93fa2f3 100644 --- a/test/symforce_function_codegen_test_data/sympy/codegen_cpp_test_data/cpp/lcmtypes/codegen_cpp_test/states_t.hpp +++ b/test/symforce_function_codegen_test_data/sympy/codegen_cpp_test_data/cpp/lcmtypes/codegen_cpp_test/states_t.hpp @@ -120,6 +120,7 @@ class states_t static lcm::StructType schema() { std::vector fields; + fields.reserve(1); fields.push_back(lcm::get_schema()); diff --git a/test/symforce_function_codegen_test_data/sympy/codegen_cpp_test_data/cpp/lcmtypes/codegen_cpp_test/values_vec_t.hpp b/test/symforce_function_codegen_test_data/sympy/codegen_cpp_test_data/cpp/lcmtypes/codegen_cpp_test/values_vec_t.hpp index e5138902..c0efce2a 100644 --- a/test/symforce_function_codegen_test_data/sympy/codegen_cpp_test_data/cpp/lcmtypes/codegen_cpp_test/values_vec_t.hpp +++ b/test/symforce_function_codegen_test_data/sympy/codegen_cpp_test_data/cpp/lcmtypes/codegen_cpp_test/values_vec_t.hpp @@ -141,6 +141,7 @@ class values_vec_t static lcm::StructType schema() { std::vector fields; + fields.reserve(6); fields.push_back(lcm::get_schema()); fields.push_back(lcm::get_schema()); diff --git a/test/symforce_function_codegen_test_data/sympy/codegen_dataclass_in_values_test_data/cpp/lcmtypes/codegen_test/my_dataclass_t.hpp b/test/symforce_function_codegen_test_data/sympy/codegen_dataclass_in_values_test_data/cpp/lcmtypes/codegen_test/my_dataclass_t.hpp index ceb69670..f7297938 100644 --- a/test/symforce_function_codegen_test_data/sympy/codegen_dataclass_in_values_test_data/cpp/lcmtypes/codegen_test/my_dataclass_t.hpp +++ b/test/symforce_function_codegen_test_data/sympy/codegen_dataclass_in_values_test_data/cpp/lcmtypes/codegen_test/my_dataclass_t.hpp @@ -121,6 +121,7 @@ class my_dataclass_t static lcm::StructType schema() { std::vector fields; + fields.reserve(1); fields.push_back(lcm::get_schema()); diff --git a/test/symforce_function_codegen_test_data/sympy/codegen_explicit_template_instantiation_test_data/cpp/lcmtypes/codegen_explicit_template_instantiation_test/constants_t.hpp b/test/symforce_function_codegen_test_data/sympy/codegen_explicit_template_instantiation_test_data/cpp/lcmtypes/codegen_explicit_template_instantiation_test/constants_t.hpp index cb197b3a..ca80ea2d 100644 --- a/test/symforce_function_codegen_test_data/sympy/codegen_explicit_template_instantiation_test_data/cpp/lcmtypes/codegen_explicit_template_instantiation_test/constants_t.hpp +++ b/test/symforce_function_codegen_test_data/sympy/codegen_explicit_template_instantiation_test_data/cpp/lcmtypes/codegen_explicit_template_instantiation_test/constants_t.hpp @@ -112,6 +112,7 @@ class constants_t static lcm::StructType schema() { std::vector fields; + fields.reserve(1); fields.push_back(lcm::get_schema()); diff --git a/test/symforce_function_codegen_test_data/sympy/codegen_explicit_template_instantiation_test_data/cpp/lcmtypes/codegen_explicit_template_instantiation_test/states_t.hpp b/test/symforce_function_codegen_test_data/sympy/codegen_explicit_template_instantiation_test_data/cpp/lcmtypes/codegen_explicit_template_instantiation_test/states_t.hpp index 9e69c9f1..7afee35c 100644 --- a/test/symforce_function_codegen_test_data/sympy/codegen_explicit_template_instantiation_test_data/cpp/lcmtypes/codegen_explicit_template_instantiation_test/states_t.hpp +++ b/test/symforce_function_codegen_test_data/sympy/codegen_explicit_template_instantiation_test_data/cpp/lcmtypes/codegen_explicit_template_instantiation_test/states_t.hpp @@ -120,6 +120,7 @@ class states_t static lcm::StructType schema() { std::vector fields; + fields.reserve(1); fields.push_back(lcm::get_schema()); diff --git a/test/symforce_function_codegen_test_data/sympy/codegen_explicit_template_instantiation_test_data/cpp/lcmtypes/codegen_explicit_template_instantiation_test/values_vec_t.hpp b/test/symforce_function_codegen_test_data/sympy/codegen_explicit_template_instantiation_test_data/cpp/lcmtypes/codegen_explicit_template_instantiation_test/values_vec_t.hpp index 08b2adc5..110f3fd4 100644 --- a/test/symforce_function_codegen_test_data/sympy/codegen_explicit_template_instantiation_test_data/cpp/lcmtypes/codegen_explicit_template_instantiation_test/values_vec_t.hpp +++ b/test/symforce_function_codegen_test_data/sympy/codegen_explicit_template_instantiation_test_data/cpp/lcmtypes/codegen_explicit_template_instantiation_test/values_vec_t.hpp @@ -141,6 +141,7 @@ class values_vec_t static lcm::StructType schema() { std::vector fields; + fields.reserve(6); fields.push_back(lcm::get_schema()); fields.push_back(lcm::get_schema()); diff --git a/test/symforce_function_codegen_test_data/sympy/codegen_multi_function_test_data/cpp/lcmtypes/codegen_multi_function_test/inputs_constants_t.hpp b/test/symforce_function_codegen_test_data/sympy/codegen_multi_function_test_data/cpp/lcmtypes/codegen_multi_function_test/inputs_constants_t.hpp index e1d14fc4..1f66ef83 100644 --- a/test/symforce_function_codegen_test_data/sympy/codegen_multi_function_test_data/cpp/lcmtypes/codegen_multi_function_test/inputs_constants_t.hpp +++ b/test/symforce_function_codegen_test_data/sympy/codegen_multi_function_test_data/cpp/lcmtypes/codegen_multi_function_test/inputs_constants_t.hpp @@ -112,6 +112,7 @@ class inputs_constants_t static lcm::StructType schema() { std::vector fields; + fields.reserve(1); fields.push_back(lcm::get_schema()); diff --git a/test/symforce_function_codegen_test_data/sympy/codegen_multi_function_test_data/cpp/lcmtypes/codegen_multi_function_test/inputs_states_t.hpp b/test/symforce_function_codegen_test_data/sympy/codegen_multi_function_test_data/cpp/lcmtypes/codegen_multi_function_test/inputs_states_t.hpp index 05a67cfa..c7080e90 100644 --- a/test/symforce_function_codegen_test_data/sympy/codegen_multi_function_test_data/cpp/lcmtypes/codegen_multi_function_test/inputs_states_t.hpp +++ b/test/symforce_function_codegen_test_data/sympy/codegen_multi_function_test_data/cpp/lcmtypes/codegen_multi_function_test/inputs_states_t.hpp @@ -120,6 +120,7 @@ class inputs_states_t static lcm::StructType schema() { std::vector fields; + fields.reserve(1); fields.push_back(lcm::get_schema()); diff --git a/test/symforce_function_codegen_test_data/sympy/codegen_multi_function_test_data/cpp/lcmtypes/codegen_multi_function_test/inputs_t.hpp b/test/symforce_function_codegen_test_data/sympy/codegen_multi_function_test_data/cpp/lcmtypes/codegen_multi_function_test/inputs_t.hpp index ca87de04..a5c4b4c9 100644 --- a/test/symforce_function_codegen_test_data/sympy/codegen_multi_function_test_data/cpp/lcmtypes/codegen_multi_function_test/inputs_t.hpp +++ b/test/symforce_function_codegen_test_data/sympy/codegen_multi_function_test_data/cpp/lcmtypes/codegen_multi_function_test/inputs_t.hpp @@ -170,6 +170,7 @@ class inputs_t static lcm::StructType schema() { std::vector fields; + fields.reserve(12); fields.push_back(lcm::get_schema()); fields.push_back(lcm::get_schema()); diff --git a/test/symforce_function_codegen_test_data/sympy/codegen_multi_function_test_data/cpp/lcmtypes/codegen_multi_function_test/outputs_1_t.hpp b/test/symforce_function_codegen_test_data/sympy/codegen_multi_function_test_data/cpp/lcmtypes/codegen_multi_function_test/outputs_1_t.hpp index 271120d1..6db01b50 100644 --- a/test/symforce_function_codegen_test_data/sympy/codegen_multi_function_test_data/cpp/lcmtypes/codegen_multi_function_test/outputs_1_t.hpp +++ b/test/symforce_function_codegen_test_data/sympy/codegen_multi_function_test_data/cpp/lcmtypes/codegen_multi_function_test/outputs_1_t.hpp @@ -147,6 +147,7 @@ class outputs_1_t static lcm::StructType schema() { std::vector fields; + fields.reserve(7); fields.push_back(lcm::get_schema()); fields.push_back(lcm::get_schema()); diff --git a/test/symforce_function_codegen_test_data/sympy/codegen_multi_function_test_data/cpp/lcmtypes/codegen_multi_function_test/outputs_2_t.hpp b/test/symforce_function_codegen_test_data/sympy/codegen_multi_function_test_data/cpp/lcmtypes/codegen_multi_function_test/outputs_2_t.hpp index 7394d425..e79e2d24 100644 --- a/test/symforce_function_codegen_test_data/sympy/codegen_multi_function_test_data/cpp/lcmtypes/codegen_multi_function_test/outputs_2_t.hpp +++ b/test/symforce_function_codegen_test_data/sympy/codegen_multi_function_test_data/cpp/lcmtypes/codegen_multi_function_test/outputs_2_t.hpp @@ -112,6 +112,7 @@ class outputs_2_t static lcm::StructType schema() { std::vector fields; + fields.reserve(1); fields.push_back(lcm::get_schema()); diff --git a/test/symforce_function_codegen_test_data/sympy/codegen_multi_function_test_data/cpp/lcmtypes/codegen_multi_function_test/values_vec_t.hpp b/test/symforce_function_codegen_test_data/sympy/codegen_multi_function_test_data/cpp/lcmtypes/codegen_multi_function_test/values_vec_t.hpp index ed8573ae..b2d4004c 100644 --- a/test/symforce_function_codegen_test_data/sympy/codegen_multi_function_test_data/cpp/lcmtypes/codegen_multi_function_test/values_vec_t.hpp +++ b/test/symforce_function_codegen_test_data/sympy/codegen_multi_function_test_data/cpp/lcmtypes/codegen_multi_function_test/values_vec_t.hpp @@ -141,6 +141,7 @@ class values_vec_t static lcm::StructType schema() { std::vector fields; + fields.reserve(6); fields.push_back(lcm::get_schema()); fields.push_back(lcm::get_schema()); diff --git a/test/symforce_function_codegen_test_data/sympy/codegen_python_test_data/cpp/lcmtypes/codegen_python_test/constants_t.hpp b/test/symforce_function_codegen_test_data/sympy/codegen_python_test_data/cpp/lcmtypes/codegen_python_test/constants_t.hpp index dce06d5c..97bdd318 100644 --- a/test/symforce_function_codegen_test_data/sympy/codegen_python_test_data/cpp/lcmtypes/codegen_python_test/constants_t.hpp +++ b/test/symforce_function_codegen_test_data/sympy/codegen_python_test_data/cpp/lcmtypes/codegen_python_test/constants_t.hpp @@ -112,6 +112,7 @@ class constants_t static lcm::StructType schema() { std::vector fields; + fields.reserve(1); fields.push_back(lcm::get_schema()); diff --git a/test/symforce_function_codegen_test_data/sympy/codegen_python_test_data/cpp/lcmtypes/codegen_python_test/states_t.hpp b/test/symforce_function_codegen_test_data/sympy/codegen_python_test_data/cpp/lcmtypes/codegen_python_test/states_t.hpp index e5812f45..33addd39 100644 --- a/test/symforce_function_codegen_test_data/sympy/codegen_python_test_data/cpp/lcmtypes/codegen_python_test/states_t.hpp +++ b/test/symforce_function_codegen_test_data/sympy/codegen_python_test_data/cpp/lcmtypes/codegen_python_test/states_t.hpp @@ -120,6 +120,7 @@ class states_t static lcm::StructType schema() { std::vector fields; + fields.reserve(1); fields.push_back(lcm::get_schema()); diff --git a/test/symforce_function_codegen_test_data/sympy/codegen_python_test_data/cpp/lcmtypes/codegen_python_test/values_vec_t.hpp b/test/symforce_function_codegen_test_data/sympy/codegen_python_test_data/cpp/lcmtypes/codegen_python_test/values_vec_t.hpp index a208f5f8..8bb1ae8a 100644 --- a/test/symforce_function_codegen_test_data/sympy/codegen_python_test_data/cpp/lcmtypes/codegen_python_test/values_vec_t.hpp +++ b/test/symforce_function_codegen_test_data/sympy/codegen_python_test_data/cpp/lcmtypes/codegen_python_test/values_vec_t.hpp @@ -141,6 +141,7 @@ class values_vec_t static lcm::StructType schema() { std::vector fields; + fields.reserve(6); fields.push_back(lcm::get_schema()); fields.push_back(lcm::get_schema()); diff --git a/test/symforce_function_codegen_test_data/sympy/with_jacobians_values/cpp/lcmtypes/sym/d_out_t.hpp b/test/symforce_function_codegen_test_data/sympy/with_jacobians_values/cpp/lcmtypes/sym/d_out_t.hpp index b2208bbf..5ded3dd2 100644 --- a/test/symforce_function_codegen_test_data/sympy/with_jacobians_values/cpp/lcmtypes/sym/d_out_t.hpp +++ b/test/symforce_function_codegen_test_data/sympy/with_jacobians_values/cpp/lcmtypes/sym/d_out_t.hpp @@ -117,6 +117,7 @@ class d_out_t static lcm::StructType schema() { std::vector fields; + fields.reserve(2); fields.push_back(lcm::get_schema()); fields.push_back(lcm::get_schema()); diff --git a/test/symforce_function_codegen_test_data/sympy/with_jacobians_values/cpp/lcmtypes/sym/d_t.hpp b/test/symforce_function_codegen_test_data/sympy/with_jacobians_values/cpp/lcmtypes/sym/d_t.hpp index 23bc1155..b3c8656e 100644 --- a/test/symforce_function_codegen_test_data/sympy/with_jacobians_values/cpp/lcmtypes/sym/d_t.hpp +++ b/test/symforce_function_codegen_test_data/sympy/with_jacobians_values/cpp/lcmtypes/sym/d_t.hpp @@ -125,6 +125,7 @@ class d_t static lcm::StructType schema() { std::vector fields; + fields.reserve(2); fields.push_back(lcm::get_schema()); fields.push_back(lcm::get_schema()); diff --git a/third_party/skymarshal/skymarshal/templates/lcmtype.hpp.template b/third_party/skymarshal/skymarshal/templates/lcmtype.hpp.template index e182dff8..b2c2b95c 100644 --- a/third_party/skymarshal/skymarshal/templates/lcmtype.hpp.template +++ b/third_party/skymarshal/skymarshal/templates/lcmtype.hpp.template @@ -161,6 +161,7 @@ class {{lcmtype.name}} static lcm::StructType schema() { std::vector fields; + fields.reserve({{lcmtype.num_members}}); {% for member in lcmtype.members %} fields.push_back(lcm::get_schema()); From bb8ba39fa1832ecd14110e8a25339825f35931f9 Mon Sep 17 00:00:00 2001 From: Veeresh Taranalli Date: Sat, 10 Oct 2026 20:37:21 +0000 Subject: [PATCH 42/68] [SymForce] Clamp squared norm of residual to 0 to avoid numerical issues GitOrigin-RevId: a5aded28983ea8107b98f90b9609fbb78999cf42 --- symforce/opt/marginalization.cc | 6 +++++- 1 file changed, 5 insertions(+), 1 deletion(-) diff --git a/symforce/opt/marginalization.cc b/symforce/opt/marginalization.cc index 40141d57..078e3277 100644 --- a/symforce/opt/marginalization.cc +++ b/symforce/opt/marginalization.cc @@ -206,7 +206,11 @@ class MarginalizationFactorLinearizationFunctor { *rhs = H_delta_ + factor_.rhs; } - const Scalar c_updated = delta_.dot(H_delta_) + 2 * factor_.rhs.dot(delta_) + factor_.c; + // c_updated is a squared norm by construction, so it can only drop below zero through + // roundoff when the current estimate sits at the quadratic's minimum. Clamp it so the + // residual below stays finite. + const Scalar c_updated = + std::max(delta_.dot(H_delta_) + 2 * factor_.rhs.dot(delta_) + factor_.c, Scalar(0)); // We don't directly have a Jacobian or residual. The residual of the system would've been // some MxN matrix, but since we can compute and store only the quadratic form (NxN), we From 432a8d5b896f57669e369432cd4810c44c948635 Mon Sep 17 00:00:00 2001 From: Jerry Date: Tue, 13 Oct 2026 01:57:42 +0000 Subject: [PATCH 43/68] [SkyMarshal] Format LCM Autoformat .lcm files. To make clang-format work correctly on these files, also require a trailing semicolon on structs in skymarshal's parser, these were previously optional. GitOrigin-RevId: ee3a97bf27716a0265a7158ce67946630bff3ec4 --- lcmtypes/symforce.lcm | 27 +++--- .../codegen/lcm_templates/types.lcm.jinja | 2 +- symforce/codegen/template_util.py | 4 +- .../lcmtypes/codegen_cpp_test.lcm | 6 +- .../codegen_dataclass_in_values_test.lcm | 2 +- ...n_explicit_template_instantiation_test.lcm | 6 +- .../lcmtypes/codegen_multi_function_test1.lcm | 10 +-- .../lcmtypes/codegen_multi_function_test2.lcm | 2 +- .../lcmtypes/python_function.lcm | 6 +- .../lcmtypes/misc_function_with_jacobians.lcm | 4 +- .../lcmtypes/codegen_cpp_test.lcm | 6 +- .../codegen_dataclass_in_values_test.lcm | 2 +- ...n_explicit_template_instantiation_test.lcm | 6 +- .../lcmtypes/codegen_multi_function_test1.lcm | 10 +-- .../lcmtypes/codegen_multi_function_test2.lcm | 2 +- .../lcmtypes/python_function.lcm | 6 +- .../lcmtypes/misc_function_with_jacobians.lcm | 4 +- third_party/eigen_lcm/lcmtypes/eigen_lcm.lcm | 88 +++++++++---------- .../skymarshal/skymarshal/syntax_tree.py | 7 +- 19 files changed, 100 insertions(+), 100 deletions(-) diff --git a/lcmtypes/symforce.lcm b/lcmtypes/symforce.lcm index 991a4f97..c291b241 100644 --- a/lcmtypes/symforce.lcm +++ b/lcmtypes/symforce.lcm @@ -197,7 +197,7 @@ struct optimizer_params_t { double early_exit_min_absolute_error; // Allow uphill movements in the optimization? boolean enable_bold_updates; -} +}; // Additional parameters for the GNCOptimizer struct optimizer_gnc_params_t { @@ -223,7 +223,7 @@ struct optimizer_gnc_params_t { // convergence once, with the value of gnc_mu_key set to mu_initial and convergence threshold // early_exit_min_reduction. double mu_max; -} +}; // Debug stats for a single iteration of a Levenberg Marquardt optimization struct optimization_iteration_t { @@ -259,7 +259,7 @@ struct optimization_iteration_t { eigen_lcm.VectorXd residual; // The problem jacobian exactly if dense, or as CSC format sparse data column vector if sparse eigen_lcm.MatrixXd jacobian_values; -} +}; // The structure of a sparse matrix in CSC format, not including the numerical values // For a description of the format, see @@ -274,7 +274,8 @@ struct sparse_matrix_structure_t { // The shape (M, N) of the sparse matrix int64_t shape[2]; -} +}; + #protobuf enum optimization_status_t { // Uninitialized enum value @@ -285,7 +286,7 @@ enum optimization_status_t { HIT_ITERATION_LIMIT = 2, // The solver failed to converge for some reason (other than hitting the iteration limit) FAILED = 3, -} +}; #protobuf enum levenberg_marquardt_solver_failure_reason_t : int32_t { @@ -296,7 +297,7 @@ enum levenberg_marquardt_solver_failure_reason_t : int32_t { // The initial error was not finite (either NaN or Inf) INITIAL_ERROR_NOT_FINITE = 2, -} +}; // Debug stats for a full optimization run struct optimization_stats_t { @@ -333,19 +334,19 @@ struct optimization_stats_t { /// exposes L() (such as the default SparseCholeskySolver). Otherwise, will be default /// constructed. sparse_matrix_structure_t cholesky_factor_sparsity; -} +}; struct imu_biases_t { eigen_lcm.Vector3d accel_bias; eigen_lcm.Vector3d gyro_bias; -} +}; struct imu_integrated_measurement_delta_t { double Dt; eigen_lcm.Quaterniond DR; eigen_lcm.Vector3d Dv; eigen_lcm.Vector3d Dp; -} +}; struct imu_integrated_measurement_derivatives_t { eigen_lcm.Matrix3d DR_D_gyro_bias; @@ -353,13 +354,13 @@ struct imu_integrated_measurement_derivatives_t { eigen_lcm.Matrix3d Dv_D_gyro_bias; eigen_lcm.Matrix3d Dp_D_accel_bias; eigen_lcm.Matrix3d Dp_D_gyro_bias; -} +}; struct imu_integrated_measurement_t { imu_biases_t biases; imu_integrated_measurement_delta_t delta; imu_integrated_measurement_derivatives_t derivatives; -} +}; // Serialized form of MarginalizationFactor for double precision struct marginalization_factor_t { @@ -368,7 +369,7 @@ struct marginalization_factor_t { double c; values_t linearization_values; index_entry_t index[]; -} +}; // Serialized form of MarginalizationFactor for float precision struct marginalization_factorf_t { @@ -377,4 +378,4 @@ struct marginalization_factorf_t { float c; valuesf_t linearization_values; index_entry_t index[]; -} +}; diff --git a/symforce/codegen/lcm_templates/types.lcm.jinja b/symforce/codegen/lcm_templates/types.lcm.jinja index b5bc2245..89db0546 100644 --- a/symforce/codegen/lcm_templates/types.lcm.jinja +++ b/symforce/codegen/lcm_templates/types.lcm.jinja @@ -32,5 +32,5 @@ struct {{ typename }} { {% endif %} {% endif %} {% endfor %} -} +}; {% endfor %} diff --git a/symforce/codegen/template_util.py b/symforce/codegen/template_util.py index d8c9c15d..72af5653 100644 --- a/symforce/codegen/template_util.py +++ b/symforce/codegen/template_util.py @@ -113,7 +113,9 @@ def autoformat( elif self in {FileType.PYTHON, FileType.PYTHON_INTERFACE}: return format_util.format_py(file_contents, filename=str(CURRENT_DIR / format_filename)) elif self == FileType.LCM: - return file_contents + return format_util.format_cpp( + file_contents, filename=str(CURRENT_DIR / format_filename) + ) elif self == FileType.RUST: return format_util.format_rust( file_contents, filename=str(CURRENT_DIR / format_filename) diff --git a/test/symforce_function_codegen_test_data/symengine/codegen_cpp_test_data/lcmtypes/codegen_cpp_test.lcm b/test/symforce_function_codegen_test_data/symengine/codegen_cpp_test_data/lcmtypes/codegen_cpp_test.lcm index 97361beb..d0120838 100644 --- a/test/symforce_function_codegen_test_data/symengine/codegen_cpp_test_data/lcmtypes/codegen_cpp_test.lcm +++ b/test/symforce_function_codegen_test_data/symengine/codegen_cpp_test_data/lcmtypes/codegen_cpp_test.lcm @@ -13,12 +13,12 @@ struct values_vec_t { eigen_lcm.Vector4d rot_vec[3]; double scalar_vec[3]; eigen_lcm.Vector4d list_of_lists[3][3]; -} +}; struct constants_t { double epsilon; -} +}; struct states_t { eigen_lcm.Vector2d p; -} +}; diff --git a/test/symforce_function_codegen_test_data/symengine/codegen_dataclass_in_values_test_data/lcmtypes/codegen_dataclass_in_values_test.lcm b/test/symforce_function_codegen_test_data/symengine/codegen_dataclass_in_values_test_data/lcmtypes/codegen_dataclass_in_values_test.lcm index 1934821c..dfe4e072 100644 --- a/test/symforce_function_codegen_test_data/symengine/codegen_dataclass_in_values_test_data/lcmtypes/codegen_dataclass_in_values_test.lcm +++ b/test/symforce_function_codegen_test_data/symengine/codegen_dataclass_in_values_test_data/lcmtypes/codegen_dataclass_in_values_test.lcm @@ -8,4 +8,4 @@ package codegen_test; struct my_dataclass_t { eigen_lcm.Vector4d rot; -} +}; diff --git a/test/symforce_function_codegen_test_data/symengine/codegen_explicit_template_instantiation_test_data/lcmtypes/codegen_explicit_template_instantiation_test.lcm b/test/symforce_function_codegen_test_data/symengine/codegen_explicit_template_instantiation_test_data/lcmtypes/codegen_explicit_template_instantiation_test.lcm index 9f3e2a0f..1d2b4fe5 100644 --- a/test/symforce_function_codegen_test_data/symengine/codegen_explicit_template_instantiation_test_data/lcmtypes/codegen_explicit_template_instantiation_test.lcm +++ b/test/symforce_function_codegen_test_data/symengine/codegen_explicit_template_instantiation_test_data/lcmtypes/codegen_explicit_template_instantiation_test.lcm @@ -13,12 +13,12 @@ struct values_vec_t { eigen_lcm.Vector4d rot_vec[3]; double scalar_vec[3]; eigen_lcm.Vector4d list_of_lists[3][3]; -} +}; struct constants_t { double epsilon; -} +}; struct states_t { eigen_lcm.Vector2d p; -} +}; diff --git a/test/symforce_function_codegen_test_data/symengine/codegen_multi_function_test_data/lcmtypes/codegen_multi_function_test1.lcm b/test/symforce_function_codegen_test_data/symengine/codegen_multi_function_test_data/lcmtypes/codegen_multi_function_test1.lcm index e4f1546b..f553afa3 100644 --- a/test/symforce_function_codegen_test_data/symengine/codegen_multi_function_test_data/lcmtypes/codegen_multi_function_test1.lcm +++ b/test/symforce_function_codegen_test_data/symengine/codegen_multi_function_test_data/lcmtypes/codegen_multi_function_test1.lcm @@ -13,15 +13,15 @@ struct values_vec_t { eigen_lcm.Vector4d rot_vec[3]; double scalar_vec[3]; eigen_lcm.Vector4d list_of_lists[3][3]; -} +}; struct inputs_constants_t { double epsilon; -} +}; struct inputs_states_t { eigen_lcm.Vector2d p; -} +}; struct inputs_t { double x; @@ -36,7 +36,7 @@ struct inputs_t { eigen_lcm.MatrixXd big_matrix; eigen_lcm.Matrix4d small_matrix; inputs_states_t states; -} +}; struct outputs_1_t { double foo; @@ -46,4 +46,4 @@ struct outputs_1_t { values_vec_t values_vec_2D_out[2][1]; eigen_lcm.MatrixXd big_matrix_from_small_matrix; eigen_lcm.Matrix4d small_matrix_from_big_matrix; -} +}; diff --git a/test/symforce_function_codegen_test_data/symengine/codegen_multi_function_test_data/lcmtypes/codegen_multi_function_test2.lcm b/test/symforce_function_codegen_test_data/symengine/codegen_multi_function_test_data/lcmtypes/codegen_multi_function_test2.lcm index 861f01ed..deb05098 100644 --- a/test/symforce_function_codegen_test_data/symengine/codegen_multi_function_test_data/lcmtypes/codegen_multi_function_test2.lcm +++ b/test/symforce_function_codegen_test_data/symengine/codegen_multi_function_test_data/lcmtypes/codegen_multi_function_test2.lcm @@ -8,4 +8,4 @@ package codegen_multi_function_test; struct outputs_2_t { double foo; -} +}; diff --git a/test/symforce_function_codegen_test_data/symengine/codegen_python_test_data/lcmtypes/python_function.lcm b/test/symforce_function_codegen_test_data/symengine/codegen_python_test_data/lcmtypes/python_function.lcm index a727b9ba..cc991c1b 100644 --- a/test/symforce_function_codegen_test_data/symengine/codegen_python_test_data/lcmtypes/python_function.lcm +++ b/test/symforce_function_codegen_test_data/symengine/codegen_python_test_data/lcmtypes/python_function.lcm @@ -13,12 +13,12 @@ struct values_vec_t { eigen_lcm.Vector4d rot_vec[3]; double scalar_vec[3]; eigen_lcm.Vector4d list_of_lists[3][3]; -} +}; struct constants_t { double epsilon; -} +}; struct states_t { eigen_lcm.Vector2d p; -} +}; diff --git a/test/symforce_function_codegen_test_data/symengine/with_jacobians_values/lcmtypes/misc_function_with_jacobians.lcm b/test/symforce_function_codegen_test_data/symengine/with_jacobians_values/lcmtypes/misc_function_with_jacobians.lcm index 1b64a81c..43670f4c 100644 --- a/test/symforce_function_codegen_test_data/symengine/with_jacobians_values/lcmtypes/misc_function_with_jacobians.lcm +++ b/test/symforce_function_codegen_test_data/symengine/with_jacobians_values/lcmtypes/misc_function_with_jacobians.lcm @@ -9,9 +9,9 @@ package sym; struct d_t { double x; eigen_lcm.Vector2d y; -} +}; struct d_out_t { double x; double y; -} +}; diff --git a/test/symforce_function_codegen_test_data/sympy/codegen_cpp_test_data/lcmtypes/codegen_cpp_test.lcm b/test/symforce_function_codegen_test_data/sympy/codegen_cpp_test_data/lcmtypes/codegen_cpp_test.lcm index 97361beb..d0120838 100644 --- a/test/symforce_function_codegen_test_data/sympy/codegen_cpp_test_data/lcmtypes/codegen_cpp_test.lcm +++ b/test/symforce_function_codegen_test_data/sympy/codegen_cpp_test_data/lcmtypes/codegen_cpp_test.lcm @@ -13,12 +13,12 @@ struct values_vec_t { eigen_lcm.Vector4d rot_vec[3]; double scalar_vec[3]; eigen_lcm.Vector4d list_of_lists[3][3]; -} +}; struct constants_t { double epsilon; -} +}; struct states_t { eigen_lcm.Vector2d p; -} +}; diff --git a/test/symforce_function_codegen_test_data/sympy/codegen_dataclass_in_values_test_data/lcmtypes/codegen_dataclass_in_values_test.lcm b/test/symforce_function_codegen_test_data/sympy/codegen_dataclass_in_values_test_data/lcmtypes/codegen_dataclass_in_values_test.lcm index 1934821c..dfe4e072 100644 --- a/test/symforce_function_codegen_test_data/sympy/codegen_dataclass_in_values_test_data/lcmtypes/codegen_dataclass_in_values_test.lcm +++ b/test/symforce_function_codegen_test_data/sympy/codegen_dataclass_in_values_test_data/lcmtypes/codegen_dataclass_in_values_test.lcm @@ -8,4 +8,4 @@ package codegen_test; struct my_dataclass_t { eigen_lcm.Vector4d rot; -} +}; diff --git a/test/symforce_function_codegen_test_data/sympy/codegen_explicit_template_instantiation_test_data/lcmtypes/codegen_explicit_template_instantiation_test.lcm b/test/symforce_function_codegen_test_data/sympy/codegen_explicit_template_instantiation_test_data/lcmtypes/codegen_explicit_template_instantiation_test.lcm index 9f3e2a0f..1d2b4fe5 100644 --- a/test/symforce_function_codegen_test_data/sympy/codegen_explicit_template_instantiation_test_data/lcmtypes/codegen_explicit_template_instantiation_test.lcm +++ b/test/symforce_function_codegen_test_data/sympy/codegen_explicit_template_instantiation_test_data/lcmtypes/codegen_explicit_template_instantiation_test.lcm @@ -13,12 +13,12 @@ struct values_vec_t { eigen_lcm.Vector4d rot_vec[3]; double scalar_vec[3]; eigen_lcm.Vector4d list_of_lists[3][3]; -} +}; struct constants_t { double epsilon; -} +}; struct states_t { eigen_lcm.Vector2d p; -} +}; diff --git a/test/symforce_function_codegen_test_data/sympy/codegen_multi_function_test_data/lcmtypes/codegen_multi_function_test1.lcm b/test/symforce_function_codegen_test_data/sympy/codegen_multi_function_test_data/lcmtypes/codegen_multi_function_test1.lcm index e4f1546b..f553afa3 100644 --- a/test/symforce_function_codegen_test_data/sympy/codegen_multi_function_test_data/lcmtypes/codegen_multi_function_test1.lcm +++ b/test/symforce_function_codegen_test_data/sympy/codegen_multi_function_test_data/lcmtypes/codegen_multi_function_test1.lcm @@ -13,15 +13,15 @@ struct values_vec_t { eigen_lcm.Vector4d rot_vec[3]; double scalar_vec[3]; eigen_lcm.Vector4d list_of_lists[3][3]; -} +}; struct inputs_constants_t { double epsilon; -} +}; struct inputs_states_t { eigen_lcm.Vector2d p; -} +}; struct inputs_t { double x; @@ -36,7 +36,7 @@ struct inputs_t { eigen_lcm.MatrixXd big_matrix; eigen_lcm.Matrix4d small_matrix; inputs_states_t states; -} +}; struct outputs_1_t { double foo; @@ -46,4 +46,4 @@ struct outputs_1_t { values_vec_t values_vec_2D_out[2][1]; eigen_lcm.MatrixXd big_matrix_from_small_matrix; eigen_lcm.Matrix4d small_matrix_from_big_matrix; -} +}; diff --git a/test/symforce_function_codegen_test_data/sympy/codegen_multi_function_test_data/lcmtypes/codegen_multi_function_test2.lcm b/test/symforce_function_codegen_test_data/sympy/codegen_multi_function_test_data/lcmtypes/codegen_multi_function_test2.lcm index 861f01ed..deb05098 100644 --- a/test/symforce_function_codegen_test_data/sympy/codegen_multi_function_test_data/lcmtypes/codegen_multi_function_test2.lcm +++ b/test/symforce_function_codegen_test_data/sympy/codegen_multi_function_test_data/lcmtypes/codegen_multi_function_test2.lcm @@ -8,4 +8,4 @@ package codegen_multi_function_test; struct outputs_2_t { double foo; -} +}; diff --git a/test/symforce_function_codegen_test_data/sympy/codegen_python_test_data/lcmtypes/python_function.lcm b/test/symforce_function_codegen_test_data/sympy/codegen_python_test_data/lcmtypes/python_function.lcm index a727b9ba..cc991c1b 100644 --- a/test/symforce_function_codegen_test_data/sympy/codegen_python_test_data/lcmtypes/python_function.lcm +++ b/test/symforce_function_codegen_test_data/sympy/codegen_python_test_data/lcmtypes/python_function.lcm @@ -13,12 +13,12 @@ struct values_vec_t { eigen_lcm.Vector4d rot_vec[3]; double scalar_vec[3]; eigen_lcm.Vector4d list_of_lists[3][3]; -} +}; struct constants_t { double epsilon; -} +}; struct states_t { eigen_lcm.Vector2d p; -} +}; diff --git a/test/symforce_function_codegen_test_data/sympy/with_jacobians_values/lcmtypes/misc_function_with_jacobians.lcm b/test/symforce_function_codegen_test_data/sympy/with_jacobians_values/lcmtypes/misc_function_with_jacobians.lcm index 1b64a81c..43670f4c 100644 --- a/test/symforce_function_codegen_test_data/sympy/with_jacobians_values/lcmtypes/misc_function_with_jacobians.lcm +++ b/test/symforce_function_codegen_test_data/sympy/with_jacobians_values/lcmtypes/misc_function_with_jacobians.lcm @@ -9,9 +9,9 @@ package sym; struct d_t { double x; eigen_lcm.Vector2d y; -} +}; struct d_out_t { double x; double y; -} +}; diff --git a/third_party/eigen_lcm/lcmtypes/eigen_lcm.lcm b/third_party/eigen_lcm/lcmtypes/eigen_lcm.lcm index 6aaccea9..3d556f20 100644 --- a/third_party/eigen_lcm/lcmtypes/eigen_lcm.lcm +++ b/third_party/eigen_lcm/lcmtypes/eigen_lcm.lcm @@ -5,19 +5,19 @@ package eigen_lcm; -#protobuf { typename="Matrix2iPb", filename="Matrix2i" } +#protobuf{typename = "Matrix2iPb", filename = "Matrix2i" } #cpp_no_display struct Matrix2i { int32_t data[4] = 1; }; -#protobuf { typename="Matrix3iPb", filename="Matrix3i" } +#protobuf{typename = "Matrix3iPb", filename = "Matrix3i" } #cpp_no_display struct Matrix3i { int32_t data[9] = 1; }; -#protobuf { typename="Matrix4iPb", filename="Matrix4i" } +#protobuf{typename = "Matrix4iPb", filename = "Matrix4i" } #cpp_no_display struct Matrix4i { int32_t data[16] = 1; @@ -30,19 +30,19 @@ struct MatrixXi { int32_t data[data_sz] = 1; }; -#protobuf { typename="Matrix2dPb", filename="Matrix2d" } +#protobuf{typename = "Matrix2dPb", filename = "Matrix2d" } #cpp_no_display struct Matrix2d { double data[4] = 3; }; -#protobuf { typename="Matrix3dPb", filename="Matrix3d" } +#protobuf{typename = "Matrix3dPb", filename = "Matrix3d" } #cpp_no_display struct Matrix3d { double data[9] = 3; }; -#protobuf { typename="Matrix4dPb", filename="Matrix4d" } +#protobuf{typename = "Matrix4dPb", filename = "Matrix4d" } #cpp_no_display struct Matrix4d { double data[16] = 3; @@ -55,19 +55,19 @@ struct MatrixXd { double data[data_sz] = 3; }; -#protobuf { typename="Matrix2fPb", filename="Matrix2f" } +#protobuf{typename = "Matrix2fPb", filename = "Matrix2f" } #cpp_no_display struct Matrix2f { float data[4] = 2; }; -#protobuf { typename="Matrix3fPb", filename="Matrix3f" } +#protobuf{typename = "Matrix3fPb", filename = "Matrix3f" } #cpp_no_display struct Matrix3f { float data[9] = 2; }; -#protobuf { typename="Matrix4fPb", filename="Matrix4f" } +#protobuf{typename = "Matrix4fPb", filename = "Matrix4f" } #cpp_no_display struct Matrix4f { float data[16] = 2; @@ -80,184 +80,184 @@ struct MatrixXf { float data[data_sz] = 2; }; -#protobuf { typename="Vector2iPb", filename="Vector2i" } +#protobuf{typename = "Vector2iPb", filename = "Vector2i" } #cpp_no_display struct Vector2i { int32_t data[2] = 1; }; -#protobuf { typename="Vector3iPb", filename="Vector3i" } +#protobuf{typename = "Vector3iPb", filename = "Vector3i" } #cpp_no_display struct Vector3i { int32_t data[3] = 1; }; -#protobuf { typename="Vector4iPb", filename="Vector4i" } +#protobuf{typename = "Vector4iPb", filename = "Vector4i" } #cpp_no_display struct Vector4i { int32_t data[4] = 1; }; -#protobuf { typename="VectorXiPb", filename="VectorXi" } +#protobuf{typename = "VectorXiPb", filename = "VectorXi" } #cpp_no_display struct VectorXi { int32_t rows; int32_t data[rows] = 1; }; -#protobuf { typename="Vector1iPb", filename="Vector1i" } +#protobuf{typename = "Vector1iPb", filename = "Vector1i" } #cpp_no_display struct Vector1i { int32_t data[1] = 1; }; -#protobuf { typename="Vector5iPb", filename="Vector5i" } +#protobuf{typename = "Vector5iPb", filename = "Vector5i" } #cpp_no_display struct Vector5i { int32_t data[5] = 1; }; -#protobuf { typename="Vector6iPb", filename="Vector6i" } +#protobuf{typename = "Vector6iPb", filename = "Vector6i" } #cpp_no_display struct Vector6i { int32_t data[6] = 1; }; -#protobuf { typename="Vector7iPb", filename="Vector7i" } +#protobuf{typename = "Vector7iPb", filename = "Vector7i" } #cpp_no_display struct Vector7i { int32_t data[7] = 1; }; -#protobuf { typename="Vector8iPb", filename="Vector8i" } +#protobuf{typename = "Vector8iPb", filename = "Vector8i" } #cpp_no_display struct Vector8i { int32_t data[8] = 1; }; -#protobuf { typename="Vector2dPb", filename="Vector2d" } +#protobuf{typename = "Vector2dPb", filename = "Vector2d" } #cpp_no_display struct Vector2d { double data[2] = 3; }; -#protobuf { typename="Vector3dPb", filename="Vector3d" } +#protobuf{typename = "Vector3dPb", filename = "Vector3d" } #cpp_no_display struct Vector3d { double data[3] = 3; }; -#protobuf { typename="Vector4dPb", filename="Vector4d" } +#protobuf{typename = "Vector4dPb", filename = "Vector4d" } #cpp_no_display struct Vector4d { double data[4] = 3; }; -#protobuf { typename="VectorXdPb", filename="VectorXd" } +#protobuf{typename = "VectorXdPb", filename = "VectorXd" } #cpp_no_display struct VectorXd { int32_t rows; double data[rows] = 3; }; -#protobuf { typename="Vector1dPb", filename="Vector1d" } +#protobuf{typename = "Vector1dPb", filename = "Vector1d" } #cpp_no_display struct Vector1d { double data[1] = 3; }; -#protobuf { typename="Vector5dPb", filename="Vector5d" } +#protobuf{typename = "Vector5dPb", filename = "Vector5d" } #cpp_no_display struct Vector5d { double data[5] = 3; }; -#protobuf { typename="Vector6dPb", filename="Vector6d" } +#protobuf{typename = "Vector6dPb", filename = "Vector6d" } #cpp_no_display struct Vector6d { double data[6] = 3; }; -#protobuf { typename="Vector7dPb", filename="Vector7d" } +#protobuf{typename = "Vector7dPb", filename = "Vector7d" } #cpp_no_display struct Vector7d { double data[7] = 3; }; -#protobuf { typename="Vector8dPb", filename="Vector8d" } +#protobuf{typename = "Vector8dPb", filename = "Vector8d" } #cpp_no_display struct Vector8d { double data[8] = 3; }; -#protobuf { typename="Vector2fPb", filename="Vector2f" } +#protobuf{typename = "Vector2fPb", filename = "Vector2f" } #cpp_no_display struct Vector2f { float data[2] = 2; }; -#protobuf { typename="Vector3fPb", filename="Vector3f" } +#protobuf{typename = "Vector3fPb", filename = "Vector3f" } #cpp_no_display struct Vector3f { float data[3] = 2; }; -#protobuf { typename="Vector4fPb", filename="Vector4f" } +#protobuf{typename = "Vector4fPb", filename = "Vector4f" } #cpp_no_display struct Vector4f { float data[4] = 2; }; -#protobuf { typename="VectorXfPb", filename="VectorXf" } +#protobuf{typename = "VectorXfPb", filename = "VectorXf" } #cpp_no_display struct VectorXf { int32_t rows; float data[rows] = 2; }; -#protobuf { typename="Vector1fPb", filename="Vector1f" } +#protobuf{typename = "Vector1fPb", filename = "Vector1f" } #cpp_no_display struct Vector1f { float data[1] = 2; }; -#protobuf { typename="Vector5fPb", filename="Vector5f" } +#protobuf{typename = "Vector5fPb", filename = "Vector5f" } #cpp_no_display struct Vector5f { float data[5] = 2; }; -#protobuf { typename="Vector6fPb", filename="Vector6f" } +#protobuf{typename = "Vector6fPb", filename = "Vector6f" } #cpp_no_display struct Vector6f { float data[6] = 2; }; -#protobuf { typename="Vector7fPb", filename="Vector7f" } +#protobuf{typename = "Vector7fPb", filename = "Vector7f" } #cpp_no_display struct Vector7f { float data[7] = 2; }; -#protobuf { typename="Vector8fPb", filename="Vector8f" } +#protobuf{typename = "Vector8fPb", filename = "Vector8f" } #cpp_no_display struct Vector8f { float data[8] = 2; }; -#protobuf { typename="SymmetricMatrix2dPb", filename="SymmetricMatrix2d" } +#protobuf{typename = "SymmetricMatrix2dPb", filename = "SymmetricMatrix2d" } #cpp_no_display struct SymmetricMatrix2d { double data[3] = 3; }; -#protobuf { typename="SymmetricMatrix3dPb", filename="SymmetricMatrix3d" } +#protobuf{typename = "SymmetricMatrix3dPb", filename = "SymmetricMatrix3d" } #cpp_no_display struct SymmetricMatrix3d { double data[6] = 3; }; -#protobuf { typename="SymmetricMatrix4dPb", filename="SymmetricMatrix4d" } +#protobuf{typename = "SymmetricMatrix4dPb", filename = "SymmetricMatrix4d" } #cpp_no_display struct SymmetricMatrix4d { double data[10] = 3; @@ -269,19 +269,19 @@ struct SymmetricMatrixXd { double data[data_sz] = 3; }; -#protobuf { typename="SymmetricMatrix2fPb", filename="SymmetricMatrix2f" } +#protobuf{typename = "SymmetricMatrix2fPb", filename = "SymmetricMatrix2f" } #cpp_no_display struct SymmetricMatrix2f { float data[3] = 2; }; -#protobuf { typename="SymmetricMatrix3fPb", filename="SymmetricMatrix3f" } +#protobuf{typename = "SymmetricMatrix3fPb", filename = "SymmetricMatrix3f" } #cpp_no_display struct SymmetricMatrix3f { float data[6] = 2; }; -#protobuf { typename="SymmetricMatrix4fPb", filename="SymmetricMatrix4f" } +#protobuf{typename = "SymmetricMatrix4fPb", filename = "SymmetricMatrix4f" } #cpp_no_display struct SymmetricMatrix4f { float data[10] = 2; @@ -293,13 +293,13 @@ struct SymmetricMatrixXf { float data[data_sz] = 2; }; -#protobuf { typename="QuaterniondPb", filename="Quaterniond" } +#protobuf{typename = "QuaterniondPb", filename = "Quaterniond" } #cpp_no_display struct Quaterniond { double xyzw[4] = 3; }; -#protobuf { typename="QuaternionfPb", filename="Quaternionf" } +#protobuf{typename = "QuaternionfPb", filename = "Quaternionf" } #cpp_no_display struct Quaternionf { float xyzw[4] = 2; diff --git a/third_party/skymarshal/skymarshal/syntax_tree.py b/third_party/skymarshal/skymarshal/syntax_tree.py index f087bd27..d3f71af6 100644 --- a/third_party/skymarshal/skymarshal/syntax_tree.py +++ b/third_party/skymarshal/skymarshal/syntax_tree.py @@ -135,11 +135,8 @@ def extend_with_package(self, other_package: Package) -> None: self.type_definitions[name] = t def __repr__(self) -> str: - lines: T.List[str] = [] - for _, type_definition in self.type_definitions.items(): - lines.extend(repr(type_definition).splitlines()) - children = "\n".join(lines) - return f"package {self.name};\n{children}" + children = "\n\n".join(repr(t) for t in self.type_definitions.values()) + return f"package {self.name};\n\n{children}" NotationSpecProperty = T.NamedTuple("NotationSpecProperty", [("name", str), ("type", str)]) From dc269a3239f2b327b461b6f653f917953d05e790 Mon Sep 17 00:00:00 2001 From: Aaron Date: Tue, 13 Oct 2026 18:39:16 +0000 Subject: [PATCH 44/68] [Caspar] Check every generated kernel launch for errors Generated kernel wrappers launched their kernels without checking the result. A launch that failed, for example because the kernel needs more shared memory or registers than the GPU allows, was silently leaving its outputs untouched: the factor then contributed nothing to the solve and nothing reported it. This was hit with a factor whose kernel needed 49160 bytes of static shared memory, just over the 48 KB limit. Every wrapper now calls `cudaGetLastError()` after its launch and throws a `std::runtime_error` naming the kernel if the launch failed. GitOrigin-RevId: aa02f4314a16779e474cfa5f68ea49d44d38af60 --- symforce/caspar/source/templates/kernel.cu.jinja | 10 ++++++++++ .../kernel_caspar_padding_lane_score.cu | 10 ++++++++++ ...el_Matrix21_alpha_denominator_or_beta_numerator.cu | 11 +++++++++++ .../kernel_Matrix21_alpha_numerator_denominator.cu | 11 +++++++++++ .../kernel_Matrix21_normalize.cu | 10 ++++++++++ .../kernel_Matrix21_pred_decrease_times_two.cu | 10 ++++++++++ .../kernel_Matrix21_retract.cu | 10 ++++++++++ .../kernel_Matrix21_start_w.cu | 10 ++++++++++ .../kernel_Matrix21_start_w_contribute.cu | 10 ++++++++++ .../kernel_Matrix21_update_Mp.cu | 10 ++++++++++ .../kernel_Matrix21_update_p.cu | 10 ++++++++++ .../kernel_Matrix21_update_r.cu | 10 ++++++++++ .../kernel_Matrix21_update_r_first.cu | 10 ++++++++++ .../kernel_Matrix21_update_step.cu | 10 ++++++++++ .../kernel_Matrix21_update_step_first.cu | 10 ++++++++++ .../kernel_rosenbrock_jtjnjtr_direct.cu | 10 ++++++++++ .../kernel_rosenbrock_res_jac.cu | 10 ++++++++++ .../kernel_rosenbrock_res_jac_first.cu | 10 ++++++++++ .../kernel_rosenbrock_score.cu | 10 ++++++++++ 19 files changed, 192 insertions(+) diff --git a/symforce/caspar/source/templates/kernel.cu.jinja b/symforce/caspar/source/templates/kernel.cu.jinja index 6bcd9b90..53709c15 100644 --- a/symforce/caspar/source/templates/kernel.cu.jinja +++ b/symforce/caspar/source/templates/kernel.cu.jinja @@ -8,6 +8,9 @@ #include #include +#include +#include + #include "kernel_{{kernel.name}}.h" #include "memops.cuh" @@ -93,6 +96,13 @@ void {{parts_to_pascal(kernel.name)}} ( {% endfor %} problem_size ); + // A launch that fails (e.g. from exceeding shared memory or register limits) otherwise leaves its + // outputs untouched without any error. + const cudaError_t launch_error = cudaGetLastError(); + if (launch_error != cudaSuccess) { + throw std::runtime_error(std::string("{{parts_to_pascal(kernel.name)}}Kernel launch failed: ") + + cudaGetErrorString(launch_error)); + } } } // namespace caspar diff --git a/test/symforce_function_codegen_test_data/symengine/symforce_caspar_codegen_test/kernel_caspar_padding_lane_score.cu b/test/symforce_function_codegen_test_data/symengine/symforce_caspar_codegen_test/kernel_caspar_padding_lane_score.cu index 0869546f..f29c197f 100644 --- a/test/symforce_function_codegen_test_data/symengine/symforce_caspar_codegen_test/kernel_caspar_padding_lane_score.cu +++ b/test/symforce_function_codegen_test_data/symengine/symforce_caspar_codegen_test/kernel_caspar_padding_lane_score.cu @@ -1,3 +1,6 @@ +#include +#include + #include #include #include @@ -159,6 +162,13 @@ void CasparPaddingLaneScore(float* cam_T_world, unsigned int cam_T_world_num_all cam_T_world, cam_T_world_num_alloc, cam_T_world_indices, point, point_num_alloc, point_indices, calibration, calibration_num_alloc, calibration_indices, pixel, pixel_num_alloc, out_rTr, problem_size); + // A launch that fails (e.g. from exceeding shared memory or register limits) + // otherwise leaves its outputs untouched without any error. + const cudaError_t launch_error = cudaGetLastError(); + if (launch_error != cudaSuccess) { + throw std::runtime_error(std::string("CasparPaddingLaneScoreKernel launch failed: ") + + cudaGetErrorString(launch_error)); + } } } // namespace caspar \ No newline at end of file diff --git a/test/symforce_function_codegen_test_data/symengine/symforce_caspar_solver_test/kernel_Matrix21_alpha_denominator_or_beta_numerator.cu b/test/symforce_function_codegen_test_data/symengine/symforce_caspar_solver_test/kernel_Matrix21_alpha_denominator_or_beta_numerator.cu index a5c9f980..49389edc 100644 --- a/test/symforce_function_codegen_test_data/symengine/symforce_caspar_solver_test/kernel_Matrix21_alpha_denominator_or_beta_numerator.cu +++ b/test/symforce_function_codegen_test_data/symengine/symforce_caspar_solver_test/kernel_Matrix21_alpha_denominator_or_beta_numerator.cu @@ -1,3 +1,6 @@ +#include +#include + #include #include #include @@ -45,6 +48,14 @@ void Matrix21AlphaDenominatorOrBetaNumerator(double* Matrix21_p_kp1, Matrix21AlphaDenominatorOrBetaNumeratorKernel<<>>( Matrix21_p_kp1, Matrix21_p_kp1_num_alloc, Matrix21_w, Matrix21_w_num_alloc, Matrix21_out, problem_size); + // A launch that fails (e.g. from exceeding shared memory or register limits) + // otherwise leaves its outputs untouched without any error. + const cudaError_t launch_error = cudaGetLastError(); + if (launch_error != cudaSuccess) { + throw std::runtime_error( + std::string("Matrix21AlphaDenominatorOrBetaNumeratorKernel launch failed: ") + + cudaGetErrorString(launch_error)); + } } } // namespace caspar \ No newline at end of file diff --git a/test/symforce_function_codegen_test_data/symengine/symforce_caspar_solver_test/kernel_Matrix21_alpha_numerator_denominator.cu b/test/symforce_function_codegen_test_data/symengine/symforce_caspar_solver_test/kernel_Matrix21_alpha_numerator_denominator.cu index 1f5be115..efdd5216 100644 --- a/test/symforce_function_codegen_test_data/symengine/symforce_caspar_solver_test/kernel_Matrix21_alpha_numerator_denominator.cu +++ b/test/symforce_function_codegen_test_data/symengine/symforce_caspar_solver_test/kernel_Matrix21_alpha_numerator_denominator.cu @@ -1,3 +1,6 @@ +#include +#include + #include #include #include @@ -58,6 +61,14 @@ void Matrix21AlphaNumeratorDenominator(double* Matrix21_p_kp1, Matrix21AlphaNumeratorDenominatorKernel<<>>( Matrix21_p_kp1, Matrix21_p_kp1_num_alloc, Matrix21_r_k, Matrix21_r_k_num_alloc, Matrix21_w, Matrix21_w_num_alloc, Matrix21_total_ag, Matrix21_total_ac, problem_size); + // A launch that fails (e.g. from exceeding shared memory or register limits) + // otherwise leaves its outputs untouched without any error. + const cudaError_t launch_error = cudaGetLastError(); + if (launch_error != cudaSuccess) { + throw std::runtime_error( + std::string("Matrix21AlphaNumeratorDenominatorKernel launch failed: ") + + cudaGetErrorString(launch_error)); + } } } // namespace caspar \ No newline at end of file diff --git a/test/symforce_function_codegen_test_data/symengine/symforce_caspar_solver_test/kernel_Matrix21_normalize.cu b/test/symforce_function_codegen_test_data/symengine/symforce_caspar_solver_test/kernel_Matrix21_normalize.cu index a6bc4b76..45ba1d4c 100644 --- a/test/symforce_function_codegen_test_data/symengine/symforce_caspar_solver_test/kernel_Matrix21_normalize.cu +++ b/test/symforce_function_codegen_test_data/symengine/symforce_caspar_solver_test/kernel_Matrix21_normalize.cu @@ -1,3 +1,6 @@ +#include +#include + #include #include #include @@ -68,6 +71,13 @@ void Matrix21Normalize(double* precond_diag, unsigned int precond_diag_num_alloc Matrix21NormalizeKernel<<>>( precond_diag, precond_diag_num_alloc, precond_tril, precond_tril_num_alloc, njtr, njtr_num_alloc, diag, out_normalized, out_normalized_num_alloc, problem_size); + // A launch that fails (e.g. from exceeding shared memory or register limits) + // otherwise leaves its outputs untouched without any error. + const cudaError_t launch_error = cudaGetLastError(); + if (launch_error != cudaSuccess) { + throw std::runtime_error(std::string("Matrix21NormalizeKernel launch failed: ") + + cudaGetErrorString(launch_error)); + } } } // namespace caspar \ No newline at end of file diff --git a/test/symforce_function_codegen_test_data/symengine/symforce_caspar_solver_test/kernel_Matrix21_pred_decrease_times_two.cu b/test/symforce_function_codegen_test_data/symengine/symforce_caspar_solver_test/kernel_Matrix21_pred_decrease_times_two.cu index c8b25b86..d31e9f1b 100644 --- a/test/symforce_function_codegen_test_data/symengine/symforce_caspar_solver_test/kernel_Matrix21_pred_decrease_times_two.cu +++ b/test/symforce_function_codegen_test_data/symengine/symforce_caspar_solver_test/kernel_Matrix21_pred_decrease_times_two.cu @@ -1,3 +1,6 @@ +#include +#include + #include #include #include @@ -65,6 +68,13 @@ void Matrix21PredDecreaseTimesTwo(double* Matrix21_step, unsigned int Matrix21_s Matrix21_step, Matrix21_step_num_alloc, Matrix21_precond_diag, Matrix21_precond_diag_num_alloc, diag, Matrix21_njtr, Matrix21_njtr_num_alloc, out_Matrix21_pred_dec, problem_size); + // A launch that fails (e.g. from exceeding shared memory or register limits) + // otherwise leaves its outputs untouched without any error. + const cudaError_t launch_error = cudaGetLastError(); + if (launch_error != cudaSuccess) { + throw std::runtime_error(std::string("Matrix21PredDecreaseTimesTwoKernel launch failed: ") + + cudaGetErrorString(launch_error)); + } } } // namespace caspar \ No newline at end of file diff --git a/test/symforce_function_codegen_test_data/symengine/symforce_caspar_solver_test/kernel_Matrix21_retract.cu b/test/symforce_function_codegen_test_data/symengine/symforce_caspar_solver_test/kernel_Matrix21_retract.cu index ca07887a..fa999ec9 100644 --- a/test/symforce_function_codegen_test_data/symengine/symforce_caspar_solver_test/kernel_Matrix21_retract.cu +++ b/test/symforce_function_codegen_test_data/symengine/symforce_caspar_solver_test/kernel_Matrix21_retract.cu @@ -1,3 +1,6 @@ +#include +#include + #include #include #include @@ -41,6 +44,13 @@ void Matrix21Retract(double* Matrix21, unsigned int Matrix21_num_alloc, double* Matrix21RetractKernel<<>>(Matrix21, Matrix21_num_alloc, delta, delta_num_alloc, out_Matrix21_retracted, out_Matrix21_retracted_num_alloc, problem_size); + // A launch that fails (e.g. from exceeding shared memory or register limits) + // otherwise leaves its outputs untouched without any error. + const cudaError_t launch_error = cudaGetLastError(); + if (launch_error != cudaSuccess) { + throw std::runtime_error(std::string("Matrix21RetractKernel launch failed: ") + + cudaGetErrorString(launch_error)); + } } } // namespace caspar \ No newline at end of file diff --git a/test/symforce_function_codegen_test_data/symengine/symforce_caspar_solver_test/kernel_Matrix21_start_w.cu b/test/symforce_function_codegen_test_data/symengine/symforce_caspar_solver_test/kernel_Matrix21_start_w.cu index fae4bdd9..541e8d19 100644 --- a/test/symforce_function_codegen_test_data/symengine/symforce_caspar_solver_test/kernel_Matrix21_start_w.cu +++ b/test/symforce_function_codegen_test_data/symengine/symforce_caspar_solver_test/kernel_Matrix21_start_w.cu @@ -1,3 +1,6 @@ +#include +#include + #include #include #include @@ -55,6 +58,13 @@ void Matrix21StartW(double* Matrix21_precond_diag, unsigned int Matrix21_precond Matrix21StartWKernel<<>>(Matrix21_precond_diag, Matrix21_precond_diag_num_alloc, diag, Matrix21_p, Matrix21_p_num_alloc, out_Matrix21_w, out_Matrix21_w_num_alloc, problem_size); + // A launch that fails (e.g. from exceeding shared memory or register limits) + // otherwise leaves its outputs untouched without any error. + const cudaError_t launch_error = cudaGetLastError(); + if (launch_error != cudaSuccess) { + throw std::runtime_error(std::string("Matrix21StartWKernel launch failed: ") + + cudaGetErrorString(launch_error)); + } } } // namespace caspar \ No newline at end of file diff --git a/test/symforce_function_codegen_test_data/symengine/symforce_caspar_solver_test/kernel_Matrix21_start_w_contribute.cu b/test/symforce_function_codegen_test_data/symengine/symforce_caspar_solver_test/kernel_Matrix21_start_w_contribute.cu index c77cfa38..6e11cbdb 100644 --- a/test/symforce_function_codegen_test_data/symengine/symforce_caspar_solver_test/kernel_Matrix21_start_w_contribute.cu +++ b/test/symforce_function_codegen_test_data/symengine/symforce_caspar_solver_test/kernel_Matrix21_start_w_contribute.cu @@ -1,3 +1,6 @@ +#include +#include + #include #include #include @@ -56,6 +59,13 @@ void Matrix21StartWContribute(double* Matrix21_precond_diag, Matrix21StartWContributeKernel<<>>( Matrix21_precond_diag, Matrix21_precond_diag_num_alloc, diag, Matrix21_p, Matrix21_p_num_alloc, out_Matrix21_w, out_Matrix21_w_num_alloc, problem_size); + // A launch that fails (e.g. from exceeding shared memory or register limits) + // otherwise leaves its outputs untouched without any error. + const cudaError_t launch_error = cudaGetLastError(); + if (launch_error != cudaSuccess) { + throw std::runtime_error(std::string("Matrix21StartWContributeKernel launch failed: ") + + cudaGetErrorString(launch_error)); + } } } // namespace caspar \ No newline at end of file diff --git a/test/symforce_function_codegen_test_data/symengine/symforce_caspar_solver_test/kernel_Matrix21_update_Mp.cu b/test/symforce_function_codegen_test_data/symengine/symforce_caspar_solver_test/kernel_Matrix21_update_Mp.cu index c76ec730..8e744289 100644 --- a/test/symforce_function_codegen_test_data/symengine/symforce_caspar_solver_test/kernel_Matrix21_update_Mp.cu +++ b/test/symforce_function_codegen_test_data/symengine/symforce_caspar_solver_test/kernel_Matrix21_update_Mp.cu @@ -1,3 +1,6 @@ +#include +#include + #include #include #include @@ -57,6 +60,13 @@ void Matrix21UpdateMp(double* Matrix21_r_k, unsigned int Matrix21_r_k_num_alloc, Matrix21_Mp_num_alloc, beta, out_Matrix21_Mp_kp1, out_Matrix21_Mp_kp1_num_alloc, out_Matrix21_w, out_Matrix21_w_num_alloc, problem_size); + // A launch that fails (e.g. from exceeding shared memory or register limits) + // otherwise leaves its outputs untouched without any error. + const cudaError_t launch_error = cudaGetLastError(); + if (launch_error != cudaSuccess) { + throw std::runtime_error(std::string("Matrix21UpdateMpKernel launch failed: ") + + cudaGetErrorString(launch_error)); + } } } // namespace caspar \ No newline at end of file diff --git a/test/symforce_function_codegen_test_data/symengine/symforce_caspar_solver_test/kernel_Matrix21_update_p.cu b/test/symforce_function_codegen_test_data/symengine/symforce_caspar_solver_test/kernel_Matrix21_update_p.cu index d814eaef..dd9b9021 100644 --- a/test/symforce_function_codegen_test_data/symengine/symforce_caspar_solver_test/kernel_Matrix21_update_p.cu +++ b/test/symforce_function_codegen_test_data/symengine/symforce_caspar_solver_test/kernel_Matrix21_update_p.cu @@ -1,3 +1,6 @@ +#include +#include + #include #include #include @@ -52,6 +55,13 @@ void Matrix21UpdateP(double* Matrix21_z, unsigned int Matrix21_z_num_alloc, doub Matrix21UpdatePKernel<<>>(Matrix21_z, Matrix21_z_num_alloc, Matrix21_p_k, Matrix21_p_k_num_alloc, beta, out_Matrix21_p_kp1, out_Matrix21_p_kp1_num_alloc, problem_size); + // A launch that fails (e.g. from exceeding shared memory or register limits) + // otherwise leaves its outputs untouched without any error. + const cudaError_t launch_error = cudaGetLastError(); + if (launch_error != cudaSuccess) { + throw std::runtime_error(std::string("Matrix21UpdatePKernel launch failed: ") + + cudaGetErrorString(launch_error)); + } } } // namespace caspar \ No newline at end of file diff --git a/test/symforce_function_codegen_test_data/symengine/symforce_caspar_solver_test/kernel_Matrix21_update_r.cu b/test/symforce_function_codegen_test_data/symengine/symforce_caspar_solver_test/kernel_Matrix21_update_r.cu index b7d47685..ba15b1be 100644 --- a/test/symforce_function_codegen_test_data/symengine/symforce_caspar_solver_test/kernel_Matrix21_update_r.cu +++ b/test/symforce_function_codegen_test_data/symengine/symforce_caspar_solver_test/kernel_Matrix21_update_r.cu @@ -1,3 +1,6 @@ +#include +#include + #include #include #include @@ -59,6 +62,13 @@ void Matrix21UpdateR(double* Matrix21_r_k, unsigned int Matrix21_r_k_num_alloc, Matrix21UpdateRKernel<<>>( Matrix21_r_k, Matrix21_r_k_num_alloc, Matrix21_w, Matrix21_w_num_alloc, negalpha, out_Matrix21_r_kp1, out_Matrix21_r_kp1_num_alloc, out_Matrix21_r_kp1_norm2_tot, problem_size); + // A launch that fails (e.g. from exceeding shared memory or register limits) + // otherwise leaves its outputs untouched without any error. + const cudaError_t launch_error = cudaGetLastError(); + if (launch_error != cudaSuccess) { + throw std::runtime_error(std::string("Matrix21UpdateRKernel launch failed: ") + + cudaGetErrorString(launch_error)); + } } } // namespace caspar \ No newline at end of file diff --git a/test/symforce_function_codegen_test_data/symengine/symforce_caspar_solver_test/kernel_Matrix21_update_r_first.cu b/test/symforce_function_codegen_test_data/symengine/symforce_caspar_solver_test/kernel_Matrix21_update_r_first.cu index 8ef1fc2d..cb5dd733 100644 --- a/test/symforce_function_codegen_test_data/symengine/symforce_caspar_solver_test/kernel_Matrix21_update_r_first.cu +++ b/test/symforce_function_codegen_test_data/symengine/symforce_caspar_solver_test/kernel_Matrix21_update_r_first.cu @@ -1,3 +1,6 @@ +#include +#include + #include #include #include @@ -71,6 +74,13 @@ void Matrix21UpdateRFirst(double* Matrix21_r_k, unsigned int Matrix21_r_k_num_al Matrix21_r_k, Matrix21_r_k_num_alloc, Matrix21_w, Matrix21_w_num_alloc, negalpha, out_Matrix21_r_kp1, out_Matrix21_r_kp1_num_alloc, out_Matrix21_r_0_norm2_tot, out_Matrix21_r_kp1_norm2_tot, problem_size); + // A launch that fails (e.g. from exceeding shared memory or register limits) + // otherwise leaves its outputs untouched without any error. + const cudaError_t launch_error = cudaGetLastError(); + if (launch_error != cudaSuccess) { + throw std::runtime_error(std::string("Matrix21UpdateRFirstKernel launch failed: ") + + cudaGetErrorString(launch_error)); + } } } // namespace caspar \ No newline at end of file diff --git a/test/symforce_function_codegen_test_data/symengine/symforce_caspar_solver_test/kernel_Matrix21_update_step.cu b/test/symforce_function_codegen_test_data/symengine/symforce_caspar_solver_test/kernel_Matrix21_update_step.cu index ea0a9a04..5f84d923 100644 --- a/test/symforce_function_codegen_test_data/symengine/symforce_caspar_solver_test/kernel_Matrix21_update_step.cu +++ b/test/symforce_function_codegen_test_data/symengine/symforce_caspar_solver_test/kernel_Matrix21_update_step.cu @@ -1,3 +1,6 @@ +#include +#include + #include #include #include @@ -52,6 +55,13 @@ void Matrix21UpdateStep(double* Matrix21_step_k, unsigned int Matrix21_step_k_nu Matrix21UpdateStepKernel<<>>( Matrix21_step_k, Matrix21_step_k_num_alloc, Matrix21_p_kp1, Matrix21_p_kp1_num_alloc, alpha, out_Matrix21_step_kp1, out_Matrix21_step_kp1_num_alloc, problem_size); + // A launch that fails (e.g. from exceeding shared memory or register limits) + // otherwise leaves its outputs untouched without any error. + const cudaError_t launch_error = cudaGetLastError(); + if (launch_error != cudaSuccess) { + throw std::runtime_error(std::string("Matrix21UpdateStepKernel launch failed: ") + + cudaGetErrorString(launch_error)); + } } } // namespace caspar \ No newline at end of file diff --git a/test/symforce_function_codegen_test_data/symengine/symforce_caspar_solver_test/kernel_Matrix21_update_step_first.cu b/test/symforce_function_codegen_test_data/symengine/symforce_caspar_solver_test/kernel_Matrix21_update_step_first.cu index db63ec50..41129866 100644 --- a/test/symforce_function_codegen_test_data/symengine/symforce_caspar_solver_test/kernel_Matrix21_update_step_first.cu +++ b/test/symforce_function_codegen_test_data/symengine/symforce_caspar_solver_test/kernel_Matrix21_update_step_first.cu @@ -1,3 +1,6 @@ +#include +#include + #include #include #include @@ -49,6 +52,13 @@ void Matrix21UpdateStepFirst(double* Matrix21_p_kp1, unsigned int Matrix21_p_kp1 Matrix21UpdateStepFirstKernel<<>>(Matrix21_p_kp1, Matrix21_p_kp1_num_alloc, alpha, out_Matrix21_step_kp1, out_Matrix21_step_kp1_num_alloc, problem_size); + // A launch that fails (e.g. from exceeding shared memory or register limits) + // otherwise leaves its outputs untouched without any error. + const cudaError_t launch_error = cudaGetLastError(); + if (launch_error != cudaSuccess) { + throw std::runtime_error(std::string("Matrix21UpdateStepFirstKernel launch failed: ") + + cudaGetErrorString(launch_error)); + } } } // namespace caspar \ No newline at end of file diff --git a/test/symforce_function_codegen_test_data/symengine/symforce_caspar_solver_test/kernel_rosenbrock_jtjnjtr_direct.cu b/test/symforce_function_codegen_test_data/symengine/symforce_caspar_solver_test/kernel_rosenbrock_jtjnjtr_direct.cu index 2c85a23f..0c0a66c1 100644 --- a/test/symforce_function_codegen_test_data/symengine/symforce_caspar_solver_test/kernel_rosenbrock_jtjnjtr_direct.cu +++ b/test/symforce_function_codegen_test_data/symengine/symforce_caspar_solver_test/kernel_rosenbrock_jtjnjtr_direct.cu @@ -1,3 +1,6 @@ +#include +#include + #include #include #include @@ -29,6 +32,13 @@ void RosenbrockJtjnjtrDirect(double* x_njtr, unsigned int x_njtr_num_alloc, RosenbrockJtjnjtrDirectKernel<<>>(x_njtr, x_njtr_num_alloc, x_njtr_indices, x_jac, x_jac_num_alloc, out_x_njtr, out_x_njtr_num_alloc, problem_size); + // A launch that fails (e.g. from exceeding shared memory or register limits) + // otherwise leaves its outputs untouched without any error. + const cudaError_t launch_error = cudaGetLastError(); + if (launch_error != cudaSuccess) { + throw std::runtime_error(std::string("RosenbrockJtjnjtrDirectKernel launch failed: ") + + cudaGetErrorString(launch_error)); + } } } // namespace caspar \ No newline at end of file diff --git a/test/symforce_function_codegen_test_data/symengine/symforce_caspar_solver_test/kernel_rosenbrock_res_jac.cu b/test/symforce_function_codegen_test_data/symengine/symforce_caspar_solver_test/kernel_rosenbrock_res_jac.cu index cae75c48..289664c3 100644 --- a/test/symforce_function_codegen_test_data/symengine/symforce_caspar_solver_test/kernel_rosenbrock_res_jac.cu +++ b/test/symforce_function_codegen_test_data/symengine/symforce_caspar_solver_test/kernel_rosenbrock_res_jac.cu @@ -1,3 +1,6 @@ +#include +#include + #include #include #include @@ -86,6 +89,13 @@ void RosenbrockResJac(double* x, unsigned int x_num_alloc, SharedIndex* x_indice out_x_njtr, out_x_njtr_num_alloc, out_x_precond_diag, out_x_precond_diag_num_alloc, out_x_precond_tril, out_x_precond_tril_num_alloc, problem_size); + // A launch that fails (e.g. from exceeding shared memory or register limits) + // otherwise leaves its outputs untouched without any error. + const cudaError_t launch_error = cudaGetLastError(); + if (launch_error != cudaSuccess) { + throw std::runtime_error(std::string("RosenbrockResJacKernel launch failed: ") + + cudaGetErrorString(launch_error)); + } } } // namespace caspar \ No newline at end of file diff --git a/test/symforce_function_codegen_test_data/symengine/symforce_caspar_solver_test/kernel_rosenbrock_res_jac_first.cu b/test/symforce_function_codegen_test_data/symengine/symforce_caspar_solver_test/kernel_rosenbrock_res_jac_first.cu index d1b9617c..f1b90ad0 100644 --- a/test/symforce_function_codegen_test_data/symengine/symforce_caspar_solver_test/kernel_rosenbrock_res_jac_first.cu +++ b/test/symforce_function_codegen_test_data/symengine/symforce_caspar_solver_test/kernel_rosenbrock_res_jac_first.cu @@ -1,3 +1,6 @@ +#include +#include + #include #include #include @@ -96,6 +99,13 @@ void RosenbrockResJacFirst(double* x, unsigned int x_num_alloc, SharedIndex* x_i x, x_num_alloc, x_indices, out_res, out_res_num_alloc, out_rTr, out_x_njtr, out_x_njtr_num_alloc, out_x_precond_diag, out_x_precond_diag_num_alloc, out_x_precond_tril, out_x_precond_tril_num_alloc, problem_size); + // A launch that fails (e.g. from exceeding shared memory or register limits) + // otherwise leaves its outputs untouched without any error. + const cudaError_t launch_error = cudaGetLastError(); + if (launch_error != cudaSuccess) { + throw std::runtime_error(std::string("RosenbrockResJacFirstKernel launch failed: ") + + cudaGetErrorString(launch_error)); + } } } // namespace caspar \ No newline at end of file diff --git a/test/symforce_function_codegen_test_data/symengine/symforce_caspar_solver_test/kernel_rosenbrock_score.cu b/test/symforce_function_codegen_test_data/symengine/symforce_caspar_solver_test/kernel_rosenbrock_score.cu index 047b7ec0..6b9913f7 100644 --- a/test/symforce_function_codegen_test_data/symengine/symforce_caspar_solver_test/kernel_rosenbrock_score.cu +++ b/test/symforce_function_codegen_test_data/symengine/symforce_caspar_solver_test/kernel_rosenbrock_score.cu @@ -1,3 +1,6 @@ +#include +#include + #include #include #include @@ -55,6 +58,13 @@ void RosenbrockScore(double* x, unsigned int x_num_alloc, SharedIndex* x_indices const int n_blocks = (problem_size + 1024 - 1) / 1024; RosenbrockScoreKernel<<>>(x, x_num_alloc, x_indices, out_rTr, problem_size); + // A launch that fails (e.g. from exceeding shared memory or register limits) + // otherwise leaves its outputs untouched without any error. + const cudaError_t launch_error = cudaGetLastError(); + if (launch_error != cudaSuccess) { + throw std::runtime_error(std::string("RosenbrockScoreKernel launch failed: ") + + cudaGetErrorString(launch_error)); + } } } // namespace caspar \ No newline at end of file From 7642702870834adb1b592cf80774b8bd5badb8d7 Mon Sep 17 00:00:00 2001 From: Nathan Date: Wed, 14 Oct 2026 00:18:18 +0000 Subject: [PATCH 45/68] [SymForce] Add block tri-diagonal solver This adds a custom block tri-diagonal solver for use with trajectory optimization problems (where the hessian structure is block tri-diagonal). This is often dramatically faster than using the existing sparse cholesky solver `sym::SparseCholeskySolver` when the diagonal and off-diagonal blocks are relatively dense. GitOrigin-RevId: a676e2285da81ee977fa30c567f951476d5f24e3 --- symforce/opt/block_tridiagonal_ldlt.h | 371 ++++++++++++++++++++++++++ test/block_tridiagonal_ldlt_test.cc | 105 ++++++++ 2 files changed, 476 insertions(+) create mode 100644 symforce/opt/block_tridiagonal_ldlt.h create mode 100644 test/block_tridiagonal_ldlt_test.cc diff --git a/symforce/opt/block_tridiagonal_ldlt.h b/symforce/opt/block_tridiagonal_ldlt.h new file mode 100644 index 00000000..f07f86e4 --- /dev/null +++ b/symforce/opt/block_tridiagonal_ldlt.h @@ -0,0 +1,371 @@ +/* ---------------------------------------------------------------------------- + * SymForce - Copyright 2022, Skydio, Inc. + * This source code is under the Apache 2.0 license found in the LICENSE file. + * ---------------------------------------------------------------------------- */ + +#pragma once + +#include + +#include +#include + +#include "./assert.h" + +namespace sym { + +// LDL^T factorization of a symmetric block tridiagonal matrix +// +// A_0 C_0^T 0 ... +// A = C_0 A_1 C_1^T ... +// 0 C_1 A_2 ... +// ... ... ... ... +// +// whose first diagonal block A_0 is kFirstBlock wide and whose remaining kNumBlocks - 1 diagonal +// blocks are kBlock wide. This matches the hessian of a trajectory optimization problem where the +// variables of each timestep only couple to the neighboring timesteps, with possibly fewer free +// variables in the first timestep. +// +// The matrix is given as the lower triangle of an Eigen::SparseMatrix, exactly as +// sym::LevenbergMarquardtSolver hands it to its linear solver, and the class exposes the same +// interface as sym::SparseCholeskySolver so it can be used as the LinearSolverType of the LM +// solver. AnalyzeSparsityPattern() builds a scatter map from the sparse value array into dense +// block storage, so Factorize() only does a gather plus dense block operations, and the sparse +// matrix never needs to be permuted or walked. +// +// The factorization is the plain (unpivoted) LDL^T in natural order, so L and D are the same as +// those of sym::SparseCholeskySolver with Eigen::NaturalOrdering up to rounding. +template +class BlockTridiagonalLdlt { + public: + static_assert(kNumBlocks >= 2, "Need at least two diagonal blocks"); + static_assert(kFirstBlock > 0 && kBlock > 0, "Block sizes must be positive"); + + using Scalar = ScalarType; + using MatrixType = Eigen::SparseMatrix; + using StorageIndex = typename MatrixType::StorageIndex; + using CholMatrixType = Eigen::SparseMatrix; + using VectorType = Eigen::Matrix; + using PermutationMatrixType = + Eigen::PermutationMatrix; + + static constexpr int kDim = kFirstBlock + kBlock * (kNumBlocks - 1); + + // A panel holds one diagonal block stacked on top of the sub-diagonal block below it. After + // factorization the strictly lower triangle of the top square holds the unit lower triangular + // factor of the diagonal block and the bottom rows hold the corresponding block row of L. + using FirstPanel = Eigen::Matrix; + using Panel = Eigen::Matrix; + using DiagVector = Eigen::Matrix; + + bool IsInitialized() const { + return is_initialized_; + } + + // Build the scatter map from the lower triangle of A into dense block storage. Every nonzero + // must lie on the block tridiagonal band; the values of A are irrelevant. + void AnalyzeSparsityPattern(const MatrixType& A_lower) { + SYM_ASSERT_EQ(A_lower.rows(), kDim); + SYM_ASSERT_EQ(A_lower.cols(), kDim); + SYM_ASSERT(A_lower.isCompressed(), "BlockTridiagonalLdlt requires a compressed matrix"); + + const StorageIndex* const outer = A_lower.outerIndexPtr(); + const StorageIndex* const inner = A_lower.innerIndexPtr(); + scatter_destination_.resize(A_lower.nonZeros()); + for (int col = 0; col < kDim; col++) { + for (int value_index = outer[col]; value_index < outer[col + 1]; value_index++) { + const int row = inner[value_index]; + SYM_ASSERT(row >= col, "Only the lower triangle may be stored, found entry ({}, {})", row, + col); + // Get which block this row/col of the overall matrix is in + const int row_block = BlockOf(row); + const int col_block = BlockOf(col); + SYM_ASSERT(row_block == col_block || row_block == col_block + 1, + "Entry ({}, {}) lies outside the block tridiagonal band", row, col); + // Get the row of this entry in the panel (top square + off-diagonal below) + const int panel_row = + OffsetInBlock(row) + (row_block == col_block ? 0 : TopSize(col_block)); + // Map this entry in the original sparse matrix nonzeros to an index in the dense panel + // storage. The dense storage is in column-major, and stores the entries for each panel + // sequentially. + scatter_destination_[value_index] = + PanelOffset(col_block) + OffsetInBlock(col) * PanelRows(col_block) + panel_row; + } + } + + storage_.resize(kStorageSize); + is_initialized_ = true; + } + + // Factorize A, which must have the same storage layout as the matrix that was analyzed. + bool Factorize(const MatrixType& A_lower) { + SYM_ASSERT(is_initialized_); + SYM_ASSERT(A_lower.isCompressed() && + A_lower.nonZeros() == static_cast(scatter_destination_.size()), + "Matrix layout differs from the analyzed one"); + + // Copy the values of the sparse matrix into the dense storage so that we can do dense + // factorization on the blocks in place. + storage_.setZero(); + const Scalar* const values = A_lower.valuePtr(); + Scalar* const input = storage_.data(); + const int* const destination = scatter_destination_.data(); + const int nnz = static_cast(scatter_destination_.size()); + for (int value_index = 0; value_index < nnz; value_index++) { + input[destination[value_index]] = values[value_index]; + } + + // We want A = L * D * L^T, which are structured as: + // + // A_0 C_0^T 0 ... L_0 0 0 ... D_0 0 0 ... + // A = C_0 A_1 C_1^T ... L = W_0 L_1 0 ... D = 0 D_1 0 ... + // 0 C_1 A_2 ... 0 W_1 L_2 ... 0 0 D_2 ... + // ... ... ... ... ... ... ... ... ... ... ... ... + // + // with each L_t unit lower triangular. Multiplying out L * D * L^T and matching blocks gives + // + // A_t = W_{t-1} D_{t-1} W_{t-1}^T + L_t D_t L_t^T + // C_t = W_t D_t L_t^T + // + // so going down the block rows, where we initialize S_0 = A_0: + // + // L_t D_t L_t^T = S_t (dense LDL^T of S_t) + // W_t = C_t L_t^{-T} D_t^{-1} + // S_{t+1} = A_{t+1} - W_t D_t W_t^T (Schur complement of blocks 0..t) + // + // Each panel starts out as [A_t; C_t] from the copy above. PanelLdlt() turns a panel holding + // [S_t; C_t] into [L_t; W_t] in place and writes D_t, and SchurUpdate() turns the next panel's + // A_{t+1} into S_{t+1}. FirstFactor() is the panel of block 0 and Factor(t) that of block t + // + 1. + + // Block 0: S_0 = A_0, so the first panel can be factored right away + Eigen::Map first_factor = FirstFactor(); + Eigen::Matrix d_first; + PanelLdlt(first_factor, kFirstBlock + kBlock, d_first, d_inv_.template head()); + + // Block 1: replace A_1 with S_1 = A_1 - W_0 D_0 W_0^T + SchurUpdate(first_factor.template bottomRows(), d_first, Factor(0)); + + Eigen::Matrix d; + for (int t = 0; t < kNumBlocks - 1; t++) { + // Factor block t + 1. The last block has no C below it, so only its top square is factored. + const bool is_last = t == kNumBlocks - 2; + Eigen::Map factor = Factor(t); + PanelLdlt(factor, is_last ? kBlock : 2 * kBlock, d, + d_inv_.template segment(kFirstBlock + kBlock * t)); + + // Form the Schur complement of block t + 2 from W_{t+1} and D_{t+1} + if (!is_last) { + SchurUpdate(factor.template bottomRows(), d, Factor(t + 1)); + } + } + return true; + } + + // Returns x for A x = b, where b is a dense vector or matrix + template + Eigen::Matrix Solve(const Eigen::MatrixBase& b) const { + Eigen::Matrix x = b; + SolveInPlace(x); + return x; + } + + // Solves A x = b in place for a dense vector or matrix. + template + void SolveInPlace(Eigen::MatrixBase& b) const { + SYM_ASSERT(is_initialized_); + SYM_ASSERT_EQ(b.rows(), kDim); + + // With A = L * D * L^T, solve A x = b as L y = b, then D z = y, then L^T x = z, overwriting b + // with y, z and x in turn. In block form (block rows of b written b_t): + // + // L_0 0 0 ... y_0 b_0 + // W_0 L_1 0 ... y_1 = b_1 => y_t = L_t^{-1} (b_t - W_{t-1} y_{t-1}) + // 0 W_1 L_2 ... y_2 b_2 + // ... ... ... ... ... ... + // + // L_0^T W_0^T 0 ... x_0 z_0 + // 0 L_1^T W_1^T ... x_1 = z_1 => x_t = L_t^{-T} (z_t - W_t^T x_{t+1}) + // 0 0 L_2^T ... x_2 z_2 + // ... ... ... ... ... ... + // + // so forward substitution runs from the top block row down and back substitution from the + // bottom block row up. + + // Forward substitution L y = b + UnitLowerOf(FirstFactor()).solveInPlace(b.template topRows()); + b.template middleRows(kFirstBlock).noalias() -= + FirstFactor().template bottomRows() * b.template topRows(); + for (int t = 0; t < kNumBlocks - 1; t++) { + const int start = kFirstBlock + kBlock * t; + UnitLowerOf(Factor(t)).solveInPlace(b.template middleRows(start)); + if (t < kNumBlocks - 2) { + b.template middleRows(start + kBlock).noalias() -= + Factor(t).template bottomRows() * b.template middleRows(start); + } + } + + // Diagonal D z = y + b = d_inv_.asDiagonal() * b; + + // Back substitution L^T x = z + for (int t = kNumBlocks - 2; t >= 0; t--) { + const int start = kFirstBlock + kBlock * t; + if (t < kNumBlocks - 2) { + b.template middleRows(start).noalias() -= + Factor(t).template bottomRows().transpose() * + b.template middleRows(start + kBlock); + } + UnitLowerOf(Factor(t)).adjoint().solveInPlace(b.template middleRows(start)); + } + b.template topRows().noalias() -= + FirstFactor().template bottomRows().transpose() * + b.template middleRows(kFirstBlock); + UnitLowerOf(FirstFactor()).adjoint().solveInPlace(b.template topRows()); + } + + // The strictly lower triangle of the unit lower triangular factor as a sparse matrix. This is + // assembled on demand for debugging and is not used by Factorize() or Solve(). + // + // Every entry of the dense blocks is stored, including exact zeros, so the sparsity pattern is + // the full block band that this solver computes rather than the symbolic pattern of L that + // sym::SparseCholeskySolver would report. + CholMatrixType L() const { + SYM_ASSERT(is_initialized_); + std::vector> triplets; + const auto add_panel = [&](const auto& panel, const int rows, const int start, const int cols) { + for (int c = 0; c < cols; c++) { + for (int r = c + 1; r < rows; r++) { + triplets.emplace_back(start + r, start + c, panel(r, c)); + } + } + }; + add_panel(FirstFactor(), kFirstBlock + kBlock, 0, kFirstBlock); + for (int t = 0; t < kNumBlocks - 1; t++) { + add_panel(Factor(t), t == kNumBlocks - 2 ? kBlock : 2 * kBlock, kFirstBlock + kBlock * t, + kBlock); + } + CholMatrixType L(kDim, kDim); + L.setFromTriplets(triplets.begin(), triplets.end()); + return L; + } + + DiagVector D() const { + SYM_ASSERT(is_initialized_); + return d_inv_.cwiseInverse(); + } + + // This solver does not permute the matrix, so return an identity permutation. + PermutationMatrixType Permutation() const { + SYM_ASSERT(is_initialized_); + PermutationMatrixType identity(kDim); + identity.setIdentity(); + return identity; + } + + private: + // Number of entries in the first panel, in every other panel, and in all of storage_. + static constexpr int kFirstPanelSize = (kFirstBlock + kBlock) * kFirstBlock; + static constexpr int kPanelSize = 2 * kBlock * kBlock; + static constexpr int kStorageSize = kFirstPanelSize + kPanelSize * (kNumBlocks - 1); + + // Returns the block index for a given row/column index in the overall matrix + static constexpr int BlockOf(const int index) { + return index < kFirstBlock ? 0 : 1 + (index - kFirstBlock) / kBlock; + } + + // Returns the offset of a given row/column index within its block + static constexpr int OffsetInBlock(const int index) { + return index < kFirstBlock ? index : (index - kFirstBlock) % kBlock; + } + + // Returns the number of rows/cols in the top square of the panel of the given block + static constexpr int TopSize(const int block) { + return block == 0 ? kFirstBlock : kBlock; + } + + // Returns the number of rows in the panel of the given block (top square + off-diagonal) + static constexpr int PanelRows(const int block) { + return TopSize(block) + kBlock; + } + + // Offset of a block's panel in storage_. The last block has no sub-diagonal block, but gets a + // full panel anyway so the layout stays uniform. + static constexpr int PanelOffset(const int block) { + return block == 0 ? 0 : kFirstPanelSize + kPanelSize * (block - 1); + } + + // The panel of block 0 + Eigen::Map FirstFactor() { + return Eigen::Map(storage_.data()); + } + Eigen::Map FirstFactor() const { + return Eigen::Map(storage_.data()); + } + // The panel of block t + 1 + Eigen::Map Factor(const int t) { + return Eigen::Map(storage_.data() + PanelOffset(t + 1)); + } + Eigen::Map Factor(const int t) const { + return Eigen::Map(storage_.data() + PanelOffset(t + 1)); + } + + template + static auto UnitLowerOf(const PanelType& panel) { + constexpr int kCols = PanelType::ColsAtCompileTime; + return panel.template topRows().template triangularView(); + } + + // Left-looking LDL^T of the first num_rows rows of a panel [S_t; C_t], where S_t is the Schur + // complement of the diagonal block. On exit the top square holds L_t (strictly lower part, + // diagonal implied) and the bottom rows hold W_t = C_t L_t^{-T} D_t^{-1}. D_t and its inverse are + // written to d and d_inv. Factoring the bottom rows along with the top square works because each + // row of W_t is computed exactly like a row of L_t. + // + // Column j is computed from the previous columns with one matrix-vector product, which is + // where nearly all of the arithmetic happens; the upper triangle of the top square is never + // read, so whatever it contains is irrelevant. + template + static void PanelLdlt(PanelType& panel, const int num_rows, + Eigen::Ref> d, + Eigen::Ref> d_inv) { + constexpr int kCols = PanelType::ColsAtCompileTime; + Eigen::Matrix scaled_row; + for (int j = 0; j < kCols; j++) { + // Subtract the contributions of the already factored columns 0..j-1, + // panel(j:, j) -= panel(j:, 0:j) * D(0:j) * panel(j, 0:j)^T + // after which panel(j, j) is D(j) and the entries below it are L(j+1:, j) * D(j). + if (j > 0) { + scaled_row.head(j) = panel.row(j).head(j).transpose().cwiseProduct(d.head(j)); + panel.col(j).segment(j, num_rows - j).noalias() -= + panel.block(j, 0, num_rows - j, j) * scaled_row.head(j); + } + // Store D(j) and divide it out of the column to get L(j+1:, j) + d[j] = panel(j, j); + d_inv[j] = Scalar(1.0) / d[j]; + panel.col(j).segment(j + 1, num_rows - j - 1) *= d_inv[j]; + } + } + + // Turns the top square of the next panel from A_{t+1} into S_{t+1} = A_{t+1} - W_t D_t W_t^T, + // where d holds the diagonal of D_t. + template + static void SchurUpdate(const Eigen::MatrixBase& w, const Eigen::MatrixBase& d, + Eigen::Map next_panel) { + constexpr int kWidth = WType::ColsAtCompileTime; + const Eigen::Matrix w_times_d = w * d.asDiagonal(); + next_panel.template topRows().noalias() -= w_times_d * w.transpose(); + } + + bool is_initialized_ = false; + + // Map from the sparse matrix entries to the indices of the dense storage_ + std::vector scatter_destination_; + + // One panel per block, column major. Factorize() copies the input blocks in and factors them in + // place, so after factorization this holds the factors. + VectorType storage_; + DiagVector d_inv_; +}; + +} // namespace sym diff --git a/test/block_tridiagonal_ldlt_test.cc b/test/block_tridiagonal_ldlt_test.cc new file mode 100644 index 00000000..ae2fc703 --- /dev/null +++ b/test/block_tridiagonal_ldlt_test.cc @@ -0,0 +1,105 @@ +/* ---------------------------------------------------------------------------- + * SymForce - Copyright 2022, Skydio, Inc. + * This source code is under the Apache 2.0 license found in the LICENSE file. + * ---------------------------------------------------------------------------- */ + +#include +#include +#include + +#include +#include +#include +#include +#include + +#include + +namespace { + +using SparseMatrix = Eigen::SparseMatrix; + +// Largest absolute difference between the entries of a and b +double MaxAbsDiff(const Eigen::MatrixXd& a, const Eigen::MatrixXd& b) { + return (a - b).cwiseAbs().maxCoeff(); +} + +// Builds the lower triangle of a random symmetric matrix with the given block tridiagonal layout. +// Each off-diagonal entry in the band is stored with probability `density` and has magnitude at +// most 1, while every diagonal entry is at least kDim. The matrix is therefore strictly diagonally +// dominant with a positive diagonal, and so positive definite. +template +SparseMatrix RandomBlockTridiagonalLower(const double density, const int seed) { + // Helper to get the block index of a given row/column index + const auto block_of = [](const int i) { + return i < kFirstBlock ? 0 : 1 + (i - kFirstBlock) / kBlock; + }; + constexpr int kDim = kFirstBlock + kBlock * (kNumBlocks - 1); + + std::mt19937 rng(seed); + std::uniform_real_distribution value(-1.0, 1.0); + std::bernoulli_distribution stored(density); + + std::vector> triplets; + for (int c = 0; c < kDim; c++) { + triplets.emplace_back(c, c, kDim + std::abs(value(rng))); + for (int r = c + 1; r < kDim && block_of(r) <= block_of(c) + 1; r++) { + if (stored(rng)) { + triplets.emplace_back(r, c, value(rng)); + } + } + } + SparseMatrix lower(kDim, kDim); + lower.setFromTriplets(triplets.begin(), triplets.end()); + return lower; +} + +// Factorizes a random matrix with the given layout and checks the results match Eigen's built-in +// LDLT solver. +template +void CheckMatchesSparseLdlt(const double density, const int seed) { + using Solver = sym::BlockTridiagonalLdlt; + constexpr int kDim = Solver::kDim; + + // Build a random, positive definite matrix + const SparseMatrix lower = + RandomBlockTridiagonalLower(density, seed); + const Eigen::MatrixXd full = Eigen::MatrixXd(lower).selfadjointView(); + + Solver solver; + solver.AnalyzeSparsityPattern(lower); + solver.Factorize(lower); + + const Eigen::SimplicialLDLT> + reference(lower); + REQUIRE(reference.info() == Eigen::Success); + CHECK(MaxAbsDiff(solver.D(), reference.vectorD()) < 1e-9); + // Both store only the strictly lower part of the unit lower triangular factor + CHECK(MaxAbsDiff(Eigen::MatrixXd(solver.L()), + Eigen::MatrixXd(reference.matrixL().nestedExpression())) < 1e-9); + + // Check that solving A*x = b gives the correct solution + const Eigen::VectorXd b = Eigen::VectorXd::LinSpaced(kDim, -1.0, 2.0); + CHECK(MaxAbsDiff(full * solver.Solve(b), b) < 1e-9); + + // Check that solving A*I gives A^-1 + Eigen::MatrixXd x = Eigen::MatrixXd::Identity(kDim, kDim); + solver.SolveInPlace(x); + CHECK(MaxAbsDiff(full * x, Eigen::MatrixXd::Identity(kDim, kDim)) < 1e-9); +} + +} // namespace + +TEST_CASE("BlockTridiagonalLdlt matches Eigen on a sparse band", "[block_tridiagonal_ldlt]") { + CheckMatchesSparseLdlt<3, 5, 4>(0.5, 1); +} + +TEST_CASE("BlockTridiagonalLdlt matches Eigen with two blocks and a larger first block", + "[block_tridiagonal_ldlt]") { + CheckMatchesSparseLdlt<6, 2, 2>(0.9, 2); +} + +TEST_CASE("BlockTridiagonalLdlt matches Eigen on a dense band", "[block_tridiagonal_ldlt]") { + CheckMatchesSparseLdlt<2, 3, 6>(1.0, 3); +} From dd53d3e90a856d6324c39c139f9bebf20e1fc981 Mon Sep 17 00:00:00 2001 From: James Clarke Date: Wed, 14 Oct 2026 22:25:02 +0000 Subject: [PATCH 46/68] skymarshal: add --proto-package-prefix and --proto-flat-output Two independent, opt-in flags on Skymarshal's proto emitter, mirroring the existing `--python-package-prefix` pattern - both default to today's behavior, so no existing caller is affected: - `--proto-package-prefix`: override the generated proto's package namespace. - `--proto-flat-output`: skip the `/pbtypes/` subdirectory convention and write the generated `.proto` directly under `--proto-path`. ## Test plan - [x] Verified both flags standalone against a real `.lcm` file, with and without each flag, confirming unchanged output when omitted. - [x] Verified the two flags combine correctly (package prefix applied, output flattened). GitOrigin-RevId: ee928a4f1a3c1c08bc55b1a2e88c0fabc48702a9 --- .../skymarshal/skymarshal/emit_proto.py | 41 +++++++++++++++++-- 1 file changed, 37 insertions(+), 4 deletions(-) diff --git a/third_party/skymarshal/skymarshal/emit_proto.py b/third_party/skymarshal/skymarshal/emit_proto.py index 6929d3ff..500da352 100644 --- a/third_party/skymarshal/skymarshal/emit_proto.py +++ b/third_party/skymarshal/skymarshal/emit_proto.py @@ -4,6 +4,7 @@ from __future__ import annotations import argparse # typing +import copy import json import os import typing as T @@ -123,7 +124,11 @@ def __init__(self, package_name, enum, args): # names for templating self.definition_name = f"{package_name}.{enum.name}" - self.proto_package = package_name + self.proto_package = ( + f"{args.package_prefix}.{package_name}" + if getattr(args, "package_prefix", None) + else package_name + ) self.proto_java_package = f"com.skydio.pbtypes.{package_name}" self.proto_java_outer_classname = "{}Proto".format( snakecase_to_camelcase(camelcase_to_snakecase(proto_filename_base)) @@ -147,7 +152,11 @@ def __init__(self, package_name, enum, args): self.proto_cpp_type = self.proto_cpp_container_type # filenames for generated converter sources - self.proto_filename = f"{package_name}/pbtypes/{proto_filename_base}.proto" + self.proto_filename = ( + f"{proto_filename_base}.proto" + if getattr(args, "proto_flat_output", False) + else f"{package_name}/pbtypes/{proto_filename_base}.proto" + ) # include paths self.proto_import_path = os.path.join(self.args.proto_import_path, self.proto_filename) @@ -368,7 +377,11 @@ def __init__(self, package, struct, type_map, args): # names for templating self.definition_name = f"{package.name}.{struct.name}" - self.proto_package = package.name + self.proto_package = ( + f"{args.package_prefix}.{package.name}" + if getattr(args, "package_prefix", None) + else package.name + ) self.proto_java_package = f"com.skydio.pbtypes.{package.name}" self.proto_java_outer_classname = "{}Proto".format( snakecase_to_camelcase(camelcase_to_snakecase(proto_filename_base)) @@ -379,7 +392,11 @@ def __init__(self, package, struct, type_map, args): self.lcm_cpp_type = f"::{package.name}::{struct.name}" # filenames for generated files sources - self.proto_filename = f"{package.name}/pbtypes/{proto_filename_base}.proto" + self.proto_filename = ( + f"{proto_filename_base}.proto" + if getattr(args, "proto_flat_output", False) + else f"{package.name}/pbtypes/{proto_filename_base}.proto" + ) self.protolcm_filename_h = f"{package.name}/{proto_filename_base}.h" self.protolcm_filename_cc = f"{package.name}/{proto_filename_base}.cc" @@ -569,6 +586,17 @@ def add_args(cls, parser: argparse.ArgumentParser) -> None: default="", help="path prefix to use when importing other generated .proto files", ) + parser.add_argument( + "--proto-package-prefix", + default=None, + help="override package-prefix for proto only", + ) + parser.add_argument( + "--proto-flat-output", + action="store_true", + help="write the generated .proto directly under --proto-path, " + "skipping the /pbtypes/ subdirectory convention", + ) parser.add_argument( "--proto-deps-info", nargs="*", @@ -594,6 +622,11 @@ def create_files( if not args.proto: return {} + proto_package_prefix = getattr(args, "proto_package_prefix", None) + if proto_package_prefix is not None: + args = copy.copy(args) + args.package_prefix = proto_package_prefix + render = TemplateRenderer(os.path.dirname(__file__)) type_map = make_proto_type_map(packages, args) file_map: T.Dict[str, T.Union[str, bytes]] = {} From 8d648a42508b5b3f06c1e54974e2ca5f1d5bb339 Mon Sep 17 00:00:00 2001 From: Ankit Agarwal Date: Mon, 19 Oct 2026 17:25:24 +0000 Subject: [PATCH 47/68] [SkyMarshal] Some changes for clang-tidy include-cleaner include-cleaner only understands macro-based header guards if they're at the top of the file, otherwise it treats the file as not self-contained which interferes with include-cleaner correctness for files that include headers like this. Fix this ordering, and temporarily add `IWYU pragma: export` where necessary for compatibility. GitOrigin-RevId: 7b0d3e67575520d52b48149b43c735a6248c67a2 --- .../lcmtypes/codegen_cpp_test/constants_t.hpp | 6 +- .../lcmtypes/codegen_cpp_test/states_t.hpp | 8 +- .../codegen_cpp_test/values_vec_t.hpp | 8 +- .../lcmtypes/codegen_test/my_dataclass_t.hpp | 8 +- .../constants_t.hpp | 6 +- .../states_t.hpp | 8 +- .../values_vec_t.hpp | 8 +- .../inputs_constants_t.hpp | 6 +- .../inputs_states_t.hpp | 8 +- .../codegen_multi_function_test/inputs_t.hpp | 18 +-- .../outputs_1_t.hpp | 12 +- .../outputs_2_t.hpp | 6 +- .../values_vec_t.hpp | 8 +- .../codegen_python_test/constants_t.hpp | 6 +- .../lcmtypes/codegen_python_test/states_t.hpp | 8 +- .../codegen_python_test/values_vec_t.hpp | 8 +- .../cpp/lcmtypes/sym/d_out_t.hpp | 6 +- .../cpp/lcmtypes/sym/d_t.hpp | 8 +- .../lcmtypes/codegen_cpp_test/constants_t.hpp | 6 +- .../lcmtypes/codegen_cpp_test/states_t.hpp | 8 +- .../codegen_cpp_test/values_vec_t.hpp | 8 +- .../lcmtypes/codegen_test/my_dataclass_t.hpp | 8 +- .../constants_t.hpp | 6 +- .../states_t.hpp | 8 +- .../values_vec_t.hpp | 8 +- .../inputs_constants_t.hpp | 6 +- .../inputs_states_t.hpp | 8 +- .../codegen_multi_function_test/inputs_t.hpp | 18 +-- .../outputs_1_t.hpp | 12 +- .../outputs_2_t.hpp | 6 +- .../values_vec_t.hpp | 8 +- .../codegen_python_test/constants_t.hpp | 6 +- .../lcmtypes/codegen_python_test/states_t.hpp | 8 +- .../codegen_python_test/values_vec_t.hpp | 8 +- .../cpp/lcmtypes/sym/d_out_t.hpp | 6 +- .../cpp/lcmtypes/sym/d_t.hpp | 8 +- .../eigen_lcm_lcm/cpp/lcmtypes/eigen_lcm.hpp | 108 +++++++++--------- third_party/skymarshal/skymarshal/emit_cpp.py | 7 +- .../templates/aggregate.hpp.template | 2 +- .../templates/enumtype.hpp.template | 4 +- .../skymarshal/templates/lcmtype.hpp.template | 6 +- .../skymarshal/templates/protolcm.h.template | 6 +- 42 files changed, 212 insertions(+), 213 deletions(-) diff --git a/test/symforce_function_codegen_test_data/symengine/codegen_cpp_test_data/cpp/lcmtypes/codegen_cpp_test/constants_t.hpp b/test/symforce_function_codegen_test_data/symengine/codegen_cpp_test_data/cpp/lcmtypes/codegen_cpp_test/constants_t.hpp index 01297339..b0dadd36 100644 --- a/test/symforce_function_codegen_test_data/symengine/codegen_cpp_test_data/cpp/lcmtypes/codegen_cpp_test/constants_t.hpp +++ b/test/symforce_function_codegen_test_data/symengine/codegen_cpp_test_data/cpp/lcmtypes/codegen_cpp_test/constants_t.hpp @@ -4,12 +4,12 @@ * Generated by lcm-gen **/ -#include -#include - #ifndef __codegen_cpp_test_constants_t_hpp__ #define __codegen_cpp_test_constants_t_hpp__ +#include +#include + #if defined(SKYMARSHAL_PRINTING_ENABLED) #include #include diff --git a/test/symforce_function_codegen_test_data/symengine/codegen_cpp_test_data/cpp/lcmtypes/codegen_cpp_test/states_t.hpp b/test/symforce_function_codegen_test_data/symengine/codegen_cpp_test_data/cpp/lcmtypes/codegen_cpp_test/states_t.hpp index 20eac645..58867dca 100644 --- a/test/symforce_function_codegen_test_data/symengine/codegen_cpp_test_data/cpp/lcmtypes/codegen_cpp_test/states_t.hpp +++ b/test/symforce_function_codegen_test_data/symengine/codegen_cpp_test_data/cpp/lcmtypes/codegen_cpp_test/states_t.hpp @@ -4,12 +4,12 @@ * Generated by lcm-gen **/ -#include -#include - #ifndef __codegen_cpp_test_states_t_hpp__ #define __codegen_cpp_test_states_t_hpp__ +#include +#include + #if defined(SKYMARSHAL_PRINTING_ENABLED) #include #include @@ -17,7 +17,7 @@ #include #include -#include "lcmtypes/eigen_lcm/Vector2d.hpp" +#include "lcmtypes/eigen_lcm/Vector2d.hpp" // IWYU pragma: export namespace codegen_cpp_test { diff --git a/test/symforce_function_codegen_test_data/symengine/codegen_cpp_test_data/cpp/lcmtypes/codegen_cpp_test/values_vec_t.hpp b/test/symforce_function_codegen_test_data/symengine/codegen_cpp_test_data/cpp/lcmtypes/codegen_cpp_test/values_vec_t.hpp index f6135ce7..8c257c45 100644 --- a/test/symforce_function_codegen_test_data/symengine/codegen_cpp_test_data/cpp/lcmtypes/codegen_cpp_test/values_vec_t.hpp +++ b/test/symforce_function_codegen_test_data/symengine/codegen_cpp_test_data/cpp/lcmtypes/codegen_cpp_test/values_vec_t.hpp @@ -4,12 +4,12 @@ * Generated by lcm-gen **/ -#include -#include - #ifndef __codegen_cpp_test_values_vec_t_hpp__ #define __codegen_cpp_test_values_vec_t_hpp__ +#include +#include + #if defined(SKYMARSHAL_PRINTING_ENABLED) #include #include @@ -18,7 +18,7 @@ #include #include -#include "lcmtypes/eigen_lcm/Vector4d.hpp" +#include "lcmtypes/eigen_lcm/Vector4d.hpp" // IWYU pragma: export namespace codegen_cpp_test { diff --git a/test/symforce_function_codegen_test_data/symengine/codegen_dataclass_in_values_test_data/cpp/lcmtypes/codegen_test/my_dataclass_t.hpp b/test/symforce_function_codegen_test_data/symengine/codegen_dataclass_in_values_test_data/cpp/lcmtypes/codegen_test/my_dataclass_t.hpp index f7297938..afc9a8a9 100644 --- a/test/symforce_function_codegen_test_data/symengine/codegen_dataclass_in_values_test_data/cpp/lcmtypes/codegen_test/my_dataclass_t.hpp +++ b/test/symforce_function_codegen_test_data/symengine/codegen_dataclass_in_values_test_data/cpp/lcmtypes/codegen_test/my_dataclass_t.hpp @@ -4,12 +4,12 @@ * Generated by lcm-gen **/ -#include -#include - #ifndef __codegen_test_my_dataclass_t_hpp__ #define __codegen_test_my_dataclass_t_hpp__ +#include +#include + #if defined(SKYMARSHAL_PRINTING_ENABLED) #include #include @@ -17,7 +17,7 @@ #include #include -#include "lcmtypes/eigen_lcm/Vector4d.hpp" +#include "lcmtypes/eigen_lcm/Vector4d.hpp" // IWYU pragma: export namespace codegen_test { diff --git a/test/symforce_function_codegen_test_data/symengine/codegen_explicit_template_instantiation_test_data/cpp/lcmtypes/codegen_explicit_template_instantiation_test/constants_t.hpp b/test/symforce_function_codegen_test_data/symengine/codegen_explicit_template_instantiation_test_data/cpp/lcmtypes/codegen_explicit_template_instantiation_test/constants_t.hpp index ba724c54..3f09315e 100644 --- a/test/symforce_function_codegen_test_data/symengine/codegen_explicit_template_instantiation_test_data/cpp/lcmtypes/codegen_explicit_template_instantiation_test/constants_t.hpp +++ b/test/symforce_function_codegen_test_data/symengine/codegen_explicit_template_instantiation_test_data/cpp/lcmtypes/codegen_explicit_template_instantiation_test/constants_t.hpp @@ -4,12 +4,12 @@ * Generated by lcm-gen **/ -#include -#include - #ifndef __codegen_explicit_template_instantiation_test_constants_t_hpp__ #define __codegen_explicit_template_instantiation_test_constants_t_hpp__ +#include +#include + #if defined(SKYMARSHAL_PRINTING_ENABLED) #include #include diff --git a/test/symforce_function_codegen_test_data/symengine/codegen_explicit_template_instantiation_test_data/cpp/lcmtypes/codegen_explicit_template_instantiation_test/states_t.hpp b/test/symforce_function_codegen_test_data/symengine/codegen_explicit_template_instantiation_test_data/cpp/lcmtypes/codegen_explicit_template_instantiation_test/states_t.hpp index 59c7f9c4..b9f113ea 100644 --- a/test/symforce_function_codegen_test_data/symengine/codegen_explicit_template_instantiation_test_data/cpp/lcmtypes/codegen_explicit_template_instantiation_test/states_t.hpp +++ b/test/symforce_function_codegen_test_data/symengine/codegen_explicit_template_instantiation_test_data/cpp/lcmtypes/codegen_explicit_template_instantiation_test/states_t.hpp @@ -4,12 +4,12 @@ * Generated by lcm-gen **/ -#include -#include - #ifndef __codegen_explicit_template_instantiation_test_states_t_hpp__ #define __codegen_explicit_template_instantiation_test_states_t_hpp__ +#include +#include + #if defined(SKYMARSHAL_PRINTING_ENABLED) #include #include @@ -17,7 +17,7 @@ #include #include -#include "lcmtypes/eigen_lcm/Vector2d.hpp" +#include "lcmtypes/eigen_lcm/Vector2d.hpp" // IWYU pragma: export namespace codegen_explicit_template_instantiation_test { diff --git a/test/symforce_function_codegen_test_data/symengine/codegen_explicit_template_instantiation_test_data/cpp/lcmtypes/codegen_explicit_template_instantiation_test/values_vec_t.hpp b/test/symforce_function_codegen_test_data/symengine/codegen_explicit_template_instantiation_test_data/cpp/lcmtypes/codegen_explicit_template_instantiation_test/values_vec_t.hpp index 88106679..a2e2a7de 100644 --- a/test/symforce_function_codegen_test_data/symengine/codegen_explicit_template_instantiation_test_data/cpp/lcmtypes/codegen_explicit_template_instantiation_test/values_vec_t.hpp +++ b/test/symforce_function_codegen_test_data/symengine/codegen_explicit_template_instantiation_test_data/cpp/lcmtypes/codegen_explicit_template_instantiation_test/values_vec_t.hpp @@ -4,12 +4,12 @@ * Generated by lcm-gen **/ -#include -#include - #ifndef __codegen_explicit_template_instantiation_test_values_vec_t_hpp__ #define __codegen_explicit_template_instantiation_test_values_vec_t_hpp__ +#include +#include + #if defined(SKYMARSHAL_PRINTING_ENABLED) #include #include @@ -18,7 +18,7 @@ #include #include -#include "lcmtypes/eigen_lcm/Vector4d.hpp" +#include "lcmtypes/eigen_lcm/Vector4d.hpp" // IWYU pragma: export namespace codegen_explicit_template_instantiation_test { diff --git a/test/symforce_function_codegen_test_data/symengine/codegen_multi_function_test_data/cpp/lcmtypes/codegen_multi_function_test/inputs_constants_t.hpp b/test/symforce_function_codegen_test_data/symengine/codegen_multi_function_test_data/cpp/lcmtypes/codegen_multi_function_test/inputs_constants_t.hpp index 7cf9cee2..1274058c 100644 --- a/test/symforce_function_codegen_test_data/symengine/codegen_multi_function_test_data/cpp/lcmtypes/codegen_multi_function_test/inputs_constants_t.hpp +++ b/test/symforce_function_codegen_test_data/symengine/codegen_multi_function_test_data/cpp/lcmtypes/codegen_multi_function_test/inputs_constants_t.hpp @@ -4,12 +4,12 @@ * Generated by lcm-gen **/ -#include -#include - #ifndef __codegen_multi_function_test_inputs_constants_t_hpp__ #define __codegen_multi_function_test_inputs_constants_t_hpp__ +#include +#include + #if defined(SKYMARSHAL_PRINTING_ENABLED) #include #include diff --git a/test/symforce_function_codegen_test_data/symengine/codegen_multi_function_test_data/cpp/lcmtypes/codegen_multi_function_test/inputs_states_t.hpp b/test/symforce_function_codegen_test_data/symengine/codegen_multi_function_test_data/cpp/lcmtypes/codegen_multi_function_test/inputs_states_t.hpp index cff05483..5d2fd85b 100644 --- a/test/symforce_function_codegen_test_data/symengine/codegen_multi_function_test_data/cpp/lcmtypes/codegen_multi_function_test/inputs_states_t.hpp +++ b/test/symforce_function_codegen_test_data/symengine/codegen_multi_function_test_data/cpp/lcmtypes/codegen_multi_function_test/inputs_states_t.hpp @@ -4,12 +4,12 @@ * Generated by lcm-gen **/ -#include -#include - #ifndef __codegen_multi_function_test_inputs_states_t_hpp__ #define __codegen_multi_function_test_inputs_states_t_hpp__ +#include +#include + #if defined(SKYMARSHAL_PRINTING_ENABLED) #include #include @@ -17,7 +17,7 @@ #include #include -#include "lcmtypes/eigen_lcm/Vector2d.hpp" +#include "lcmtypes/eigen_lcm/Vector2d.hpp" // IWYU pragma: export namespace codegen_multi_function_test { diff --git a/test/symforce_function_codegen_test_data/symengine/codegen_multi_function_test_data/cpp/lcmtypes/codegen_multi_function_test/inputs_t.hpp b/test/symforce_function_codegen_test_data/symengine/codegen_multi_function_test_data/cpp/lcmtypes/codegen_multi_function_test/inputs_t.hpp index e08a918c..b6d389d9 100644 --- a/test/symforce_function_codegen_test_data/symengine/codegen_multi_function_test_data/cpp/lcmtypes/codegen_multi_function_test/inputs_t.hpp +++ b/test/symforce_function_codegen_test_data/symengine/codegen_multi_function_test_data/cpp/lcmtypes/codegen_multi_function_test/inputs_t.hpp @@ -4,12 +4,12 @@ * Generated by lcm-gen **/ -#include -#include - #ifndef __codegen_multi_function_test_inputs_t_hpp__ #define __codegen_multi_function_test_inputs_t_hpp__ +#include +#include + #if defined(SKYMARSHAL_PRINTING_ENABLED) #include #include @@ -18,12 +18,12 @@ #include #include -#include "lcmtypes/codegen_multi_function_test/inputs_constants_t.hpp" -#include "lcmtypes/codegen_multi_function_test/inputs_states_t.hpp" -#include "lcmtypes/codegen_multi_function_test/values_vec_t.hpp" -#include "lcmtypes/eigen_lcm/Matrix4d.hpp" -#include "lcmtypes/eigen_lcm/MatrixXd.hpp" -#include "lcmtypes/eigen_lcm/Vector4d.hpp" +#include "lcmtypes/codegen_multi_function_test/inputs_constants_t.hpp" // IWYU pragma: export +#include "lcmtypes/codegen_multi_function_test/inputs_states_t.hpp" // IWYU pragma: export +#include "lcmtypes/codegen_multi_function_test/values_vec_t.hpp" // IWYU pragma: export +#include "lcmtypes/eigen_lcm/Matrix4d.hpp" // IWYU pragma: export +#include "lcmtypes/eigen_lcm/MatrixXd.hpp" // IWYU pragma: export +#include "lcmtypes/eigen_lcm/Vector4d.hpp" // IWYU pragma: export namespace codegen_multi_function_test { diff --git a/test/symforce_function_codegen_test_data/symengine/codegen_multi_function_test_data/cpp/lcmtypes/codegen_multi_function_test/outputs_1_t.hpp b/test/symforce_function_codegen_test_data/symengine/codegen_multi_function_test_data/cpp/lcmtypes/codegen_multi_function_test/outputs_1_t.hpp index 87270f90..eeeb29e1 100644 --- a/test/symforce_function_codegen_test_data/symengine/codegen_multi_function_test_data/cpp/lcmtypes/codegen_multi_function_test/outputs_1_t.hpp +++ b/test/symforce_function_codegen_test_data/symengine/codegen_multi_function_test_data/cpp/lcmtypes/codegen_multi_function_test/outputs_1_t.hpp @@ -4,12 +4,12 @@ * Generated by lcm-gen **/ -#include -#include - #ifndef __codegen_multi_function_test_outputs_1_t_hpp__ #define __codegen_multi_function_test_outputs_1_t_hpp__ +#include +#include + #if defined(SKYMARSHAL_PRINTING_ENABLED) #include #include @@ -18,9 +18,9 @@ #include #include -#include "lcmtypes/codegen_multi_function_test/values_vec_t.hpp" -#include "lcmtypes/eigen_lcm/Matrix4d.hpp" -#include "lcmtypes/eigen_lcm/MatrixXd.hpp" +#include "lcmtypes/codegen_multi_function_test/values_vec_t.hpp" // IWYU pragma: export +#include "lcmtypes/eigen_lcm/Matrix4d.hpp" // IWYU pragma: export +#include "lcmtypes/eigen_lcm/MatrixXd.hpp" // IWYU pragma: export namespace codegen_multi_function_test { diff --git a/test/symforce_function_codegen_test_data/symengine/codegen_multi_function_test_data/cpp/lcmtypes/codegen_multi_function_test/outputs_2_t.hpp b/test/symforce_function_codegen_test_data/symengine/codegen_multi_function_test_data/cpp/lcmtypes/codegen_multi_function_test/outputs_2_t.hpp index 05a1ebec..0bd32c96 100644 --- a/test/symforce_function_codegen_test_data/symengine/codegen_multi_function_test_data/cpp/lcmtypes/codegen_multi_function_test/outputs_2_t.hpp +++ b/test/symforce_function_codegen_test_data/symengine/codegen_multi_function_test_data/cpp/lcmtypes/codegen_multi_function_test/outputs_2_t.hpp @@ -4,12 +4,12 @@ * Generated by lcm-gen **/ -#include -#include - #ifndef __codegen_multi_function_test_outputs_2_t_hpp__ #define __codegen_multi_function_test_outputs_2_t_hpp__ +#include +#include + #if defined(SKYMARSHAL_PRINTING_ENABLED) #include #include diff --git a/test/symforce_function_codegen_test_data/symengine/codegen_multi_function_test_data/cpp/lcmtypes/codegen_multi_function_test/values_vec_t.hpp b/test/symforce_function_codegen_test_data/symengine/codegen_multi_function_test_data/cpp/lcmtypes/codegen_multi_function_test/values_vec_t.hpp index 73dc29c9..e0928021 100644 --- a/test/symforce_function_codegen_test_data/symengine/codegen_multi_function_test_data/cpp/lcmtypes/codegen_multi_function_test/values_vec_t.hpp +++ b/test/symforce_function_codegen_test_data/symengine/codegen_multi_function_test_data/cpp/lcmtypes/codegen_multi_function_test/values_vec_t.hpp @@ -4,12 +4,12 @@ * Generated by lcm-gen **/ -#include -#include - #ifndef __codegen_multi_function_test_values_vec_t_hpp__ #define __codegen_multi_function_test_values_vec_t_hpp__ +#include +#include + #if defined(SKYMARSHAL_PRINTING_ENABLED) #include #include @@ -18,7 +18,7 @@ #include #include -#include "lcmtypes/eigen_lcm/Vector4d.hpp" +#include "lcmtypes/eigen_lcm/Vector4d.hpp" // IWYU pragma: export namespace codegen_multi_function_test { diff --git a/test/symforce_function_codegen_test_data/symengine/codegen_python_test_data/cpp/lcmtypes/codegen_python_test/constants_t.hpp b/test/symforce_function_codegen_test_data/symengine/codegen_python_test_data/cpp/lcmtypes/codegen_python_test/constants_t.hpp index 36661c14..fcc7667c 100644 --- a/test/symforce_function_codegen_test_data/symengine/codegen_python_test_data/cpp/lcmtypes/codegen_python_test/constants_t.hpp +++ b/test/symforce_function_codegen_test_data/symengine/codegen_python_test_data/cpp/lcmtypes/codegen_python_test/constants_t.hpp @@ -4,12 +4,12 @@ * Generated by lcm-gen **/ -#include -#include - #ifndef __codegen_python_test_constants_t_hpp__ #define __codegen_python_test_constants_t_hpp__ +#include +#include + #if defined(SKYMARSHAL_PRINTING_ENABLED) #include #include diff --git a/test/symforce_function_codegen_test_data/symengine/codegen_python_test_data/cpp/lcmtypes/codegen_python_test/states_t.hpp b/test/symforce_function_codegen_test_data/symengine/codegen_python_test_data/cpp/lcmtypes/codegen_python_test/states_t.hpp index 0c2cb117..1ba97e43 100644 --- a/test/symforce_function_codegen_test_data/symengine/codegen_python_test_data/cpp/lcmtypes/codegen_python_test/states_t.hpp +++ b/test/symforce_function_codegen_test_data/symengine/codegen_python_test_data/cpp/lcmtypes/codegen_python_test/states_t.hpp @@ -4,12 +4,12 @@ * Generated by lcm-gen **/ -#include -#include - #ifndef __codegen_python_test_states_t_hpp__ #define __codegen_python_test_states_t_hpp__ +#include +#include + #if defined(SKYMARSHAL_PRINTING_ENABLED) #include #include @@ -17,7 +17,7 @@ #include #include -#include "lcmtypes/eigen_lcm/Vector2d.hpp" +#include "lcmtypes/eigen_lcm/Vector2d.hpp" // IWYU pragma: export namespace codegen_python_test { diff --git a/test/symforce_function_codegen_test_data/symengine/codegen_python_test_data/cpp/lcmtypes/codegen_python_test/values_vec_t.hpp b/test/symforce_function_codegen_test_data/symengine/codegen_python_test_data/cpp/lcmtypes/codegen_python_test/values_vec_t.hpp index 16963fe0..829dfe2b 100644 --- a/test/symforce_function_codegen_test_data/symengine/codegen_python_test_data/cpp/lcmtypes/codegen_python_test/values_vec_t.hpp +++ b/test/symforce_function_codegen_test_data/symengine/codegen_python_test_data/cpp/lcmtypes/codegen_python_test/values_vec_t.hpp @@ -4,12 +4,12 @@ * Generated by lcm-gen **/ -#include -#include - #ifndef __codegen_python_test_values_vec_t_hpp__ #define __codegen_python_test_values_vec_t_hpp__ +#include +#include + #if defined(SKYMARSHAL_PRINTING_ENABLED) #include #include @@ -18,7 +18,7 @@ #include #include -#include "lcmtypes/eigen_lcm/Vector4d.hpp" +#include "lcmtypes/eigen_lcm/Vector4d.hpp" // IWYU pragma: export namespace codegen_python_test { diff --git a/test/symforce_function_codegen_test_data/symengine/with_jacobians_values/cpp/lcmtypes/sym/d_out_t.hpp b/test/symforce_function_codegen_test_data/symengine/with_jacobians_values/cpp/lcmtypes/sym/d_out_t.hpp index 5ded3dd2..7b601a24 100644 --- a/test/symforce_function_codegen_test_data/symengine/with_jacobians_values/cpp/lcmtypes/sym/d_out_t.hpp +++ b/test/symforce_function_codegen_test_data/symengine/with_jacobians_values/cpp/lcmtypes/sym/d_out_t.hpp @@ -4,12 +4,12 @@ * Generated by lcm-gen **/ -#include -#include - #ifndef __sym_d_out_t_hpp__ #define __sym_d_out_t_hpp__ +#include +#include + #if defined(SKYMARSHAL_PRINTING_ENABLED) #include #include diff --git a/test/symforce_function_codegen_test_data/symengine/with_jacobians_values/cpp/lcmtypes/sym/d_t.hpp b/test/symforce_function_codegen_test_data/symengine/with_jacobians_values/cpp/lcmtypes/sym/d_t.hpp index b3c8656e..66e956bc 100644 --- a/test/symforce_function_codegen_test_data/symengine/with_jacobians_values/cpp/lcmtypes/sym/d_t.hpp +++ b/test/symforce_function_codegen_test_data/symengine/with_jacobians_values/cpp/lcmtypes/sym/d_t.hpp @@ -4,12 +4,12 @@ * Generated by lcm-gen **/ -#include -#include - #ifndef __sym_d_t_hpp__ #define __sym_d_t_hpp__ +#include +#include + #if defined(SKYMARSHAL_PRINTING_ENABLED) #include #include @@ -17,7 +17,7 @@ #include #include -#include "lcmtypes/eigen_lcm/Vector2d.hpp" +#include "lcmtypes/eigen_lcm/Vector2d.hpp" // IWYU pragma: export namespace sym { diff --git a/test/symforce_function_codegen_test_data/sympy/codegen_cpp_test_data/cpp/lcmtypes/codegen_cpp_test/constants_t.hpp b/test/symforce_function_codegen_test_data/sympy/codegen_cpp_test_data/cpp/lcmtypes/codegen_cpp_test/constants_t.hpp index ef8b31cf..70dbc007 100644 --- a/test/symforce_function_codegen_test_data/sympy/codegen_cpp_test_data/cpp/lcmtypes/codegen_cpp_test/constants_t.hpp +++ b/test/symforce_function_codegen_test_data/sympy/codegen_cpp_test_data/cpp/lcmtypes/codegen_cpp_test/constants_t.hpp @@ -4,12 +4,12 @@ * Generated by lcm-gen **/ -#include -#include - #ifndef __codegen_cpp_test_constants_t_hpp__ #define __codegen_cpp_test_constants_t_hpp__ +#include +#include + #if defined(SKYMARSHAL_PRINTING_ENABLED) #include #include diff --git a/test/symforce_function_codegen_test_data/sympy/codegen_cpp_test_data/cpp/lcmtypes/codegen_cpp_test/states_t.hpp b/test/symforce_function_codegen_test_data/sympy/codegen_cpp_test_data/cpp/lcmtypes/codegen_cpp_test/states_t.hpp index e93fa2f3..d206ae65 100644 --- a/test/symforce_function_codegen_test_data/sympy/codegen_cpp_test_data/cpp/lcmtypes/codegen_cpp_test/states_t.hpp +++ b/test/symforce_function_codegen_test_data/sympy/codegen_cpp_test_data/cpp/lcmtypes/codegen_cpp_test/states_t.hpp @@ -4,19 +4,19 @@ * Generated by lcm-gen **/ -#include -#include - #ifndef __codegen_cpp_test_states_t_hpp__ #define __codegen_cpp_test_states_t_hpp__ +#include +#include + #if defined(SKYMARSHAL_PRINTING_ENABLED) #include #include #endif #include -#include "lcmtypes/eigen_lcm/Vector2d.hpp" +#include "lcmtypes/eigen_lcm/Vector2d.hpp" // IWYU pragma: export namespace codegen_cpp_test { diff --git a/test/symforce_function_codegen_test_data/sympy/codegen_cpp_test_data/cpp/lcmtypes/codegen_cpp_test/values_vec_t.hpp b/test/symforce_function_codegen_test_data/sympy/codegen_cpp_test_data/cpp/lcmtypes/codegen_cpp_test/values_vec_t.hpp index c0efce2a..d4ea8acf 100644 --- a/test/symforce_function_codegen_test_data/sympy/codegen_cpp_test_data/cpp/lcmtypes/codegen_cpp_test/values_vec_t.hpp +++ b/test/symforce_function_codegen_test_data/sympy/codegen_cpp_test_data/cpp/lcmtypes/codegen_cpp_test/values_vec_t.hpp @@ -4,12 +4,12 @@ * Generated by lcm-gen **/ -#include -#include - #ifndef __codegen_cpp_test_values_vec_t_hpp__ #define __codegen_cpp_test_values_vec_t_hpp__ +#include +#include + #if defined(SKYMARSHAL_PRINTING_ENABLED) #include #include @@ -17,7 +17,7 @@ #include #include -#include "lcmtypes/eigen_lcm/Vector4d.hpp" +#include "lcmtypes/eigen_lcm/Vector4d.hpp" // IWYU pragma: export namespace codegen_cpp_test { diff --git a/test/symforce_function_codegen_test_data/sympy/codegen_dataclass_in_values_test_data/cpp/lcmtypes/codegen_test/my_dataclass_t.hpp b/test/symforce_function_codegen_test_data/sympy/codegen_dataclass_in_values_test_data/cpp/lcmtypes/codegen_test/my_dataclass_t.hpp index f7297938..afc9a8a9 100644 --- a/test/symforce_function_codegen_test_data/sympy/codegen_dataclass_in_values_test_data/cpp/lcmtypes/codegen_test/my_dataclass_t.hpp +++ b/test/symforce_function_codegen_test_data/sympy/codegen_dataclass_in_values_test_data/cpp/lcmtypes/codegen_test/my_dataclass_t.hpp @@ -4,12 +4,12 @@ * Generated by lcm-gen **/ -#include -#include - #ifndef __codegen_test_my_dataclass_t_hpp__ #define __codegen_test_my_dataclass_t_hpp__ +#include +#include + #if defined(SKYMARSHAL_PRINTING_ENABLED) #include #include @@ -17,7 +17,7 @@ #include #include -#include "lcmtypes/eigen_lcm/Vector4d.hpp" +#include "lcmtypes/eigen_lcm/Vector4d.hpp" // IWYU pragma: export namespace codegen_test { diff --git a/test/symforce_function_codegen_test_data/sympy/codegen_explicit_template_instantiation_test_data/cpp/lcmtypes/codegen_explicit_template_instantiation_test/constants_t.hpp b/test/symforce_function_codegen_test_data/sympy/codegen_explicit_template_instantiation_test_data/cpp/lcmtypes/codegen_explicit_template_instantiation_test/constants_t.hpp index ca80ea2d..91ce48a9 100644 --- a/test/symforce_function_codegen_test_data/sympy/codegen_explicit_template_instantiation_test_data/cpp/lcmtypes/codegen_explicit_template_instantiation_test/constants_t.hpp +++ b/test/symforce_function_codegen_test_data/sympy/codegen_explicit_template_instantiation_test_data/cpp/lcmtypes/codegen_explicit_template_instantiation_test/constants_t.hpp @@ -4,12 +4,12 @@ * Generated by lcm-gen **/ -#include -#include - #ifndef __codegen_explicit_template_instantiation_test_constants_t_hpp__ #define __codegen_explicit_template_instantiation_test_constants_t_hpp__ +#include +#include + #if defined(SKYMARSHAL_PRINTING_ENABLED) #include #include diff --git a/test/symforce_function_codegen_test_data/sympy/codegen_explicit_template_instantiation_test_data/cpp/lcmtypes/codegen_explicit_template_instantiation_test/states_t.hpp b/test/symforce_function_codegen_test_data/sympy/codegen_explicit_template_instantiation_test_data/cpp/lcmtypes/codegen_explicit_template_instantiation_test/states_t.hpp index 7afee35c..17388a56 100644 --- a/test/symforce_function_codegen_test_data/sympy/codegen_explicit_template_instantiation_test_data/cpp/lcmtypes/codegen_explicit_template_instantiation_test/states_t.hpp +++ b/test/symforce_function_codegen_test_data/sympy/codegen_explicit_template_instantiation_test_data/cpp/lcmtypes/codegen_explicit_template_instantiation_test/states_t.hpp @@ -4,19 +4,19 @@ * Generated by lcm-gen **/ -#include -#include - #ifndef __codegen_explicit_template_instantiation_test_states_t_hpp__ #define __codegen_explicit_template_instantiation_test_states_t_hpp__ +#include +#include + #if defined(SKYMARSHAL_PRINTING_ENABLED) #include #include #endif #include -#include "lcmtypes/eigen_lcm/Vector2d.hpp" +#include "lcmtypes/eigen_lcm/Vector2d.hpp" // IWYU pragma: export namespace codegen_explicit_template_instantiation_test { diff --git a/test/symforce_function_codegen_test_data/sympy/codegen_explicit_template_instantiation_test_data/cpp/lcmtypes/codegen_explicit_template_instantiation_test/values_vec_t.hpp b/test/symforce_function_codegen_test_data/sympy/codegen_explicit_template_instantiation_test_data/cpp/lcmtypes/codegen_explicit_template_instantiation_test/values_vec_t.hpp index 110f3fd4..19120459 100644 --- a/test/symforce_function_codegen_test_data/sympy/codegen_explicit_template_instantiation_test_data/cpp/lcmtypes/codegen_explicit_template_instantiation_test/values_vec_t.hpp +++ b/test/symforce_function_codegen_test_data/sympy/codegen_explicit_template_instantiation_test_data/cpp/lcmtypes/codegen_explicit_template_instantiation_test/values_vec_t.hpp @@ -4,12 +4,12 @@ * Generated by lcm-gen **/ -#include -#include - #ifndef __codegen_explicit_template_instantiation_test_values_vec_t_hpp__ #define __codegen_explicit_template_instantiation_test_values_vec_t_hpp__ +#include +#include + #if defined(SKYMARSHAL_PRINTING_ENABLED) #include #include @@ -17,7 +17,7 @@ #include #include -#include "lcmtypes/eigen_lcm/Vector4d.hpp" +#include "lcmtypes/eigen_lcm/Vector4d.hpp" // IWYU pragma: export namespace codegen_explicit_template_instantiation_test { diff --git a/test/symforce_function_codegen_test_data/sympy/codegen_multi_function_test_data/cpp/lcmtypes/codegen_multi_function_test/inputs_constants_t.hpp b/test/symforce_function_codegen_test_data/sympy/codegen_multi_function_test_data/cpp/lcmtypes/codegen_multi_function_test/inputs_constants_t.hpp index 1f66ef83..3ed171a9 100644 --- a/test/symforce_function_codegen_test_data/sympy/codegen_multi_function_test_data/cpp/lcmtypes/codegen_multi_function_test/inputs_constants_t.hpp +++ b/test/symforce_function_codegen_test_data/sympy/codegen_multi_function_test_data/cpp/lcmtypes/codegen_multi_function_test/inputs_constants_t.hpp @@ -4,12 +4,12 @@ * Generated by lcm-gen **/ -#include -#include - #ifndef __codegen_multi_function_test_inputs_constants_t_hpp__ #define __codegen_multi_function_test_inputs_constants_t_hpp__ +#include +#include + #if defined(SKYMARSHAL_PRINTING_ENABLED) #include #include diff --git a/test/symforce_function_codegen_test_data/sympy/codegen_multi_function_test_data/cpp/lcmtypes/codegen_multi_function_test/inputs_states_t.hpp b/test/symforce_function_codegen_test_data/sympy/codegen_multi_function_test_data/cpp/lcmtypes/codegen_multi_function_test/inputs_states_t.hpp index c7080e90..0511cc42 100644 --- a/test/symforce_function_codegen_test_data/sympy/codegen_multi_function_test_data/cpp/lcmtypes/codegen_multi_function_test/inputs_states_t.hpp +++ b/test/symforce_function_codegen_test_data/sympy/codegen_multi_function_test_data/cpp/lcmtypes/codegen_multi_function_test/inputs_states_t.hpp @@ -4,19 +4,19 @@ * Generated by lcm-gen **/ -#include -#include - #ifndef __codegen_multi_function_test_inputs_states_t_hpp__ #define __codegen_multi_function_test_inputs_states_t_hpp__ +#include +#include + #if defined(SKYMARSHAL_PRINTING_ENABLED) #include #include #endif #include -#include "lcmtypes/eigen_lcm/Vector2d.hpp" +#include "lcmtypes/eigen_lcm/Vector2d.hpp" // IWYU pragma: export namespace codegen_multi_function_test { diff --git a/test/symforce_function_codegen_test_data/sympy/codegen_multi_function_test_data/cpp/lcmtypes/codegen_multi_function_test/inputs_t.hpp b/test/symforce_function_codegen_test_data/sympy/codegen_multi_function_test_data/cpp/lcmtypes/codegen_multi_function_test/inputs_t.hpp index a5c4b4c9..c0da9c78 100644 --- a/test/symforce_function_codegen_test_data/sympy/codegen_multi_function_test_data/cpp/lcmtypes/codegen_multi_function_test/inputs_t.hpp +++ b/test/symforce_function_codegen_test_data/sympy/codegen_multi_function_test_data/cpp/lcmtypes/codegen_multi_function_test/inputs_t.hpp @@ -4,12 +4,12 @@ * Generated by lcm-gen **/ -#include -#include - #ifndef __codegen_multi_function_test_inputs_t_hpp__ #define __codegen_multi_function_test_inputs_t_hpp__ +#include +#include + #if defined(SKYMARSHAL_PRINTING_ENABLED) #include #include @@ -17,12 +17,12 @@ #include #include -#include "lcmtypes/codegen_multi_function_test/inputs_constants_t.hpp" -#include "lcmtypes/codegen_multi_function_test/inputs_states_t.hpp" -#include "lcmtypes/codegen_multi_function_test/values_vec_t.hpp" -#include "lcmtypes/eigen_lcm/Matrix4d.hpp" -#include "lcmtypes/eigen_lcm/MatrixXd.hpp" -#include "lcmtypes/eigen_lcm/Vector4d.hpp" +#include "lcmtypes/codegen_multi_function_test/inputs_constants_t.hpp" // IWYU pragma: export +#include "lcmtypes/codegen_multi_function_test/inputs_states_t.hpp" // IWYU pragma: export +#include "lcmtypes/codegen_multi_function_test/values_vec_t.hpp" // IWYU pragma: export +#include "lcmtypes/eigen_lcm/Matrix4d.hpp" // IWYU pragma: export +#include "lcmtypes/eigen_lcm/MatrixXd.hpp" // IWYU pragma: export +#include "lcmtypes/eigen_lcm/Vector4d.hpp" // IWYU pragma: export namespace codegen_multi_function_test { diff --git a/test/symforce_function_codegen_test_data/sympy/codegen_multi_function_test_data/cpp/lcmtypes/codegen_multi_function_test/outputs_1_t.hpp b/test/symforce_function_codegen_test_data/sympy/codegen_multi_function_test_data/cpp/lcmtypes/codegen_multi_function_test/outputs_1_t.hpp index 6db01b50..1440799b 100644 --- a/test/symforce_function_codegen_test_data/sympy/codegen_multi_function_test_data/cpp/lcmtypes/codegen_multi_function_test/outputs_1_t.hpp +++ b/test/symforce_function_codegen_test_data/sympy/codegen_multi_function_test_data/cpp/lcmtypes/codegen_multi_function_test/outputs_1_t.hpp @@ -4,12 +4,12 @@ * Generated by lcm-gen **/ -#include -#include - #ifndef __codegen_multi_function_test_outputs_1_t_hpp__ #define __codegen_multi_function_test_outputs_1_t_hpp__ +#include +#include + #if defined(SKYMARSHAL_PRINTING_ENABLED) #include #include @@ -17,9 +17,9 @@ #include #include -#include "lcmtypes/codegen_multi_function_test/values_vec_t.hpp" -#include "lcmtypes/eigen_lcm/Matrix4d.hpp" -#include "lcmtypes/eigen_lcm/MatrixXd.hpp" +#include "lcmtypes/codegen_multi_function_test/values_vec_t.hpp" // IWYU pragma: export +#include "lcmtypes/eigen_lcm/Matrix4d.hpp" // IWYU pragma: export +#include "lcmtypes/eigen_lcm/MatrixXd.hpp" // IWYU pragma: export namespace codegen_multi_function_test { diff --git a/test/symforce_function_codegen_test_data/sympy/codegen_multi_function_test_data/cpp/lcmtypes/codegen_multi_function_test/outputs_2_t.hpp b/test/symforce_function_codegen_test_data/sympy/codegen_multi_function_test_data/cpp/lcmtypes/codegen_multi_function_test/outputs_2_t.hpp index e79e2d24..0e524944 100644 --- a/test/symforce_function_codegen_test_data/sympy/codegen_multi_function_test_data/cpp/lcmtypes/codegen_multi_function_test/outputs_2_t.hpp +++ b/test/symforce_function_codegen_test_data/sympy/codegen_multi_function_test_data/cpp/lcmtypes/codegen_multi_function_test/outputs_2_t.hpp @@ -4,12 +4,12 @@ * Generated by lcm-gen **/ -#include -#include - #ifndef __codegen_multi_function_test_outputs_2_t_hpp__ #define __codegen_multi_function_test_outputs_2_t_hpp__ +#include +#include + #if defined(SKYMARSHAL_PRINTING_ENABLED) #include #include diff --git a/test/symforce_function_codegen_test_data/sympy/codegen_multi_function_test_data/cpp/lcmtypes/codegen_multi_function_test/values_vec_t.hpp b/test/symforce_function_codegen_test_data/sympy/codegen_multi_function_test_data/cpp/lcmtypes/codegen_multi_function_test/values_vec_t.hpp index b2d4004c..8af5ccc4 100644 --- a/test/symforce_function_codegen_test_data/sympy/codegen_multi_function_test_data/cpp/lcmtypes/codegen_multi_function_test/values_vec_t.hpp +++ b/test/symforce_function_codegen_test_data/sympy/codegen_multi_function_test_data/cpp/lcmtypes/codegen_multi_function_test/values_vec_t.hpp @@ -4,12 +4,12 @@ * Generated by lcm-gen **/ -#include -#include - #ifndef __codegen_multi_function_test_values_vec_t_hpp__ #define __codegen_multi_function_test_values_vec_t_hpp__ +#include +#include + #if defined(SKYMARSHAL_PRINTING_ENABLED) #include #include @@ -17,7 +17,7 @@ #include #include -#include "lcmtypes/eigen_lcm/Vector4d.hpp" +#include "lcmtypes/eigen_lcm/Vector4d.hpp" // IWYU pragma: export namespace codegen_multi_function_test { diff --git a/test/symforce_function_codegen_test_data/sympy/codegen_python_test_data/cpp/lcmtypes/codegen_python_test/constants_t.hpp b/test/symforce_function_codegen_test_data/sympy/codegen_python_test_data/cpp/lcmtypes/codegen_python_test/constants_t.hpp index 97bdd318..75010ffb 100644 --- a/test/symforce_function_codegen_test_data/sympy/codegen_python_test_data/cpp/lcmtypes/codegen_python_test/constants_t.hpp +++ b/test/symforce_function_codegen_test_data/sympy/codegen_python_test_data/cpp/lcmtypes/codegen_python_test/constants_t.hpp @@ -4,12 +4,12 @@ * Generated by lcm-gen **/ -#include -#include - #ifndef __codegen_python_test_constants_t_hpp__ #define __codegen_python_test_constants_t_hpp__ +#include +#include + #if defined(SKYMARSHAL_PRINTING_ENABLED) #include #include diff --git a/test/symforce_function_codegen_test_data/sympy/codegen_python_test_data/cpp/lcmtypes/codegen_python_test/states_t.hpp b/test/symforce_function_codegen_test_data/sympy/codegen_python_test_data/cpp/lcmtypes/codegen_python_test/states_t.hpp index 33addd39..df0495cf 100644 --- a/test/symforce_function_codegen_test_data/sympy/codegen_python_test_data/cpp/lcmtypes/codegen_python_test/states_t.hpp +++ b/test/symforce_function_codegen_test_data/sympy/codegen_python_test_data/cpp/lcmtypes/codegen_python_test/states_t.hpp @@ -4,19 +4,19 @@ * Generated by lcm-gen **/ -#include -#include - #ifndef __codegen_python_test_states_t_hpp__ #define __codegen_python_test_states_t_hpp__ +#include +#include + #if defined(SKYMARSHAL_PRINTING_ENABLED) #include #include #endif #include -#include "lcmtypes/eigen_lcm/Vector2d.hpp" +#include "lcmtypes/eigen_lcm/Vector2d.hpp" // IWYU pragma: export namespace codegen_python_test { diff --git a/test/symforce_function_codegen_test_data/sympy/codegen_python_test_data/cpp/lcmtypes/codegen_python_test/values_vec_t.hpp b/test/symforce_function_codegen_test_data/sympy/codegen_python_test_data/cpp/lcmtypes/codegen_python_test/values_vec_t.hpp index 8bb1ae8a..51b77b8b 100644 --- a/test/symforce_function_codegen_test_data/sympy/codegen_python_test_data/cpp/lcmtypes/codegen_python_test/values_vec_t.hpp +++ b/test/symforce_function_codegen_test_data/sympy/codegen_python_test_data/cpp/lcmtypes/codegen_python_test/values_vec_t.hpp @@ -4,12 +4,12 @@ * Generated by lcm-gen **/ -#include -#include - #ifndef __codegen_python_test_values_vec_t_hpp__ #define __codegen_python_test_values_vec_t_hpp__ +#include +#include + #if defined(SKYMARSHAL_PRINTING_ENABLED) #include #include @@ -17,7 +17,7 @@ #include #include -#include "lcmtypes/eigen_lcm/Vector4d.hpp" +#include "lcmtypes/eigen_lcm/Vector4d.hpp" // IWYU pragma: export namespace codegen_python_test { diff --git a/test/symforce_function_codegen_test_data/sympy/with_jacobians_values/cpp/lcmtypes/sym/d_out_t.hpp b/test/symforce_function_codegen_test_data/sympy/with_jacobians_values/cpp/lcmtypes/sym/d_out_t.hpp index 5ded3dd2..7b601a24 100644 --- a/test/symforce_function_codegen_test_data/sympy/with_jacobians_values/cpp/lcmtypes/sym/d_out_t.hpp +++ b/test/symforce_function_codegen_test_data/sympy/with_jacobians_values/cpp/lcmtypes/sym/d_out_t.hpp @@ -4,12 +4,12 @@ * Generated by lcm-gen **/ -#include -#include - #ifndef __sym_d_out_t_hpp__ #define __sym_d_out_t_hpp__ +#include +#include + #if defined(SKYMARSHAL_PRINTING_ENABLED) #include #include diff --git a/test/symforce_function_codegen_test_data/sympy/with_jacobians_values/cpp/lcmtypes/sym/d_t.hpp b/test/symforce_function_codegen_test_data/sympy/with_jacobians_values/cpp/lcmtypes/sym/d_t.hpp index b3c8656e..66e956bc 100644 --- a/test/symforce_function_codegen_test_data/sympy/with_jacobians_values/cpp/lcmtypes/sym/d_t.hpp +++ b/test/symforce_function_codegen_test_data/sympy/with_jacobians_values/cpp/lcmtypes/sym/d_t.hpp @@ -4,12 +4,12 @@ * Generated by lcm-gen **/ -#include -#include - #ifndef __sym_d_t_hpp__ #define __sym_d_t_hpp__ +#include +#include + #if defined(SKYMARSHAL_PRINTING_ENABLED) #include #include @@ -17,7 +17,7 @@ #include #include -#include "lcmtypes/eigen_lcm/Vector2d.hpp" +#include "lcmtypes/eigen_lcm/Vector2d.hpp" // IWYU pragma: export namespace sym { diff --git a/third_party/eigen_lcm/lcmtypes/eigen_lcm_lcm/cpp/lcmtypes/eigen_lcm.hpp b/third_party/eigen_lcm/lcmtypes/eigen_lcm_lcm/cpp/lcmtypes/eigen_lcm.hpp index 8a124a04..bfeefd86 100644 --- a/third_party/eigen_lcm/lcmtypes/eigen_lcm_lcm/cpp/lcmtypes/eigen_lcm.hpp +++ b/third_party/eigen_lcm/lcmtypes/eigen_lcm_lcm/cpp/lcmtypes/eigen_lcm.hpp @@ -1,56 +1,56 @@ // This file was autogenerated by skymarshal. Do not modify by hand! #pragma once -#include -#include -#include -#include -#include -#include -#include -#include -#include -#include -#include -#include -#include -#include -#include -#include -#include -#include -#include -#include -#include -#include -#include -#include -#include -#include -#include -#include -#include -#include -#include -#include -#include -#include -#include -#include -#include -#include -#include -#include -#include -#include -#include -#include -#include -#include -#include -#include -#include -#include -#include -#include -#include -#include +#include // IWYU pragma: export +#include // IWYU pragma: export +#include // IWYU pragma: export +#include // IWYU pragma: export +#include // IWYU pragma: export +#include // IWYU pragma: export +#include // IWYU pragma: export +#include // IWYU pragma: export +#include // IWYU pragma: export +#include // IWYU pragma: export +#include // IWYU pragma: export +#include // IWYU pragma: export +#include // IWYU pragma: export +#include // IWYU pragma: export +#include // IWYU pragma: export +#include // IWYU pragma: export +#include // IWYU pragma: export +#include // IWYU pragma: export +#include // IWYU pragma: export +#include // IWYU pragma: export +#include // IWYU pragma: export +#include // IWYU pragma: export +#include // IWYU pragma: export +#include // IWYU pragma: export +#include // IWYU pragma: export +#include // IWYU pragma: export +#include // IWYU pragma: export +#include // IWYU pragma: export +#include // IWYU pragma: export +#include // IWYU pragma: export +#include // IWYU pragma: export +#include // IWYU pragma: export +#include // IWYU pragma: export +#include // IWYU pragma: export +#include // IWYU pragma: export +#include // IWYU pragma: export +#include // IWYU pragma: export +#include // IWYU pragma: export +#include // IWYU pragma: export +#include // IWYU pragma: export +#include // IWYU pragma: export +#include // IWYU pragma: export +#include // IWYU pragma: export +#include // IWYU pragma: export +#include // IWYU pragma: export +#include // IWYU pragma: export +#include // IWYU pragma: export +#include // IWYU pragma: export +#include // IWYU pragma: export +#include // IWYU pragma: export +#include // IWYU pragma: export +#include // IWYU pragma: export +#include // IWYU pragma: export +#include // IWYU pragma: export diff --git a/third_party/skymarshal/skymarshal/emit_cpp.py b/third_party/skymarshal/skymarshal/emit_cpp.py index 9526e9a3..25592df6 100644 --- a/third_party/skymarshal/skymarshal/emit_cpp.py +++ b/third_party/skymarshal/skymarshal/emit_cpp.py @@ -193,10 +193,9 @@ def absolute_path(self): def directive(self): name = self.absolute_path if self.std is not None: - name = f"<{name}>" - else: - name = f'"{name}"' - return f"#include {name}\n" + return f"#include <{name}>\n" + # A struct's member types are part of its interface, so it exports their headers. + return f'#include "{name}" // IWYU pragma: export\n' @property def package(self): diff --git a/third_party/skymarshal/skymarshal/templates/aggregate.hpp.template b/third_party/skymarshal/skymarshal/templates/aggregate.hpp.template index ff8a1b43..587d1474 100644 --- a/third_party/skymarshal/skymarshal/templates/aggregate.hpp.template +++ b/third_party/skymarshal/skymarshal/templates/aggregate.hpp.template @@ -1,5 +1,5 @@ // This file was autogenerated by skymarshal. Do not modify by hand! #pragma once {% for type_name in type_names %} -#include +#include // IWYU pragma: export {% endfor %} diff --git a/third_party/skymarshal/skymarshal/templates/enumtype.hpp.template b/third_party/skymarshal/skymarshal/templates/enumtype.hpp.template index 3c6e782e..28482fc4 100644 --- a/third_party/skymarshal/skymarshal/templates/enumtype.hpp.template +++ b/third_party/skymarshal/skymarshal/templates/enumtype.hpp.template @@ -8,11 +8,11 @@ {% endif %} **/ -#include - #ifndef __{{enumtype.underscored}}_hpp__ #define __{{enumtype.underscored}}_hpp__ +#include + #include #include #include diff --git a/third_party/skymarshal/skymarshal/templates/lcmtype.hpp.template b/third_party/skymarshal/skymarshal/templates/lcmtype.hpp.template index b2c2b95c..96393e80 100644 --- a/third_party/skymarshal/skymarshal/templates/lcmtype.hpp.template +++ b/third_party/skymarshal/skymarshal/templates/lcmtype.hpp.template @@ -8,12 +8,12 @@ {% endif %} **/ -#include -#include - #ifndef __{{lcmtype.underscored}}_hpp__ #define __{{lcmtype.underscored}}_hpp__ +#include +#include + {% if not lcmtype.cpp_no_print_helpers and not lcmtype.args.cpp_no_print_helpers %} {% if not lcmtype.cpp_display_everywhere %} #if defined(SKYMARSHAL_PRINTING_ENABLED) diff --git a/third_party/skymarshal/skymarshal/templates/protolcm.h.template b/third_party/skymarshal/skymarshal/templates/protolcm.h.template index 9eaaafef..96eb981f 100644 --- a/third_party/skymarshal/skymarshal/templates/protolcm.h.template +++ b/third_party/skymarshal/skymarshal/templates/protolcm.h.template @@ -6,11 +6,11 @@ {% endif %} #pragma once -#include <{{struct_type.lcmgen_header}}> -#include <{{struct_type.protogen_header}}> +#include <{{struct_type.lcmgen_header}}> // IWYU pragma: export +#include <{{struct_type.protogen_header}}> // IWYU pragma: export {% for referenced_struct in struct_type.referenced_structs %} -#include <{{referenced_struct.protolcm_include_path}}> +#include <{{referenced_struct.protolcm_include_path}}> // IWYU pragma: export {% endfor %} {{struct_type.lcm_cpp_type}} PbToLcm(const {{struct_type.proto_cpp_type}}& in); From 78e380a39465bb8a404987c30873cffcb1f0ca71 Mon Sep 17 00:00:00 2001 From: Aaron Date: Fri, 23 Oct 2026 02:00:45 +0000 Subject: [PATCH 48/68] [Caspar] Use dynamic shared memory in generated kernels Generated kernels declared their scratch buffer and one SharedIndex array per shared argument as static `__shared__` arrays. Static shared memory is capped at 48 KB per block, and fp64 factors with several shared (Tunable) node arguments can exceed it at the fixed block size of 1024. The scratch buffer and the shared index arrays now live in one dynamic shared memory buffer, at offsets computed at generation time, and each wrapper opts its kernel in with `cudaFuncSetAttribute(..., cudaFuncAttributeMaxDynamicSharedMemorySize, ...)` once before the first launch, throwing if the GPU refuses. Kernels under 48 KB behave as before. Generation also checks the size: it raises, naming the kernel and its shared arguments, above 227 KB (the largest opt-in limit of any GPU), and warns above 48 KB, since such kernels only launch on GPUs with a larger opt-in limit (64 KB on sm_75, 99 KB on sm_86, 163 KB on sm_80). The checked-in outputs of `symforce_caspar_codegen_test` are regenerated with dynamic shared memory, and pass with their CUDA tests. GitOrigin-RevId: 68c16e606cbca80545288d9941c881f40c0c3e19 --- symforce/caspar/code_generation/kernel.py | 44 +++++++++++++++++++ symforce/caspar/memory/accessors.py | 6 ++- .../caspar/source/templates/kernel.cu.jinja | 21 +++++++-- .../kernel_caspar_padding_lane_score.cu | 26 ++++++++--- ...x21_alpha_denominator_or_beta_numerator.cu | 15 ++++++- ...el_Matrix21_alpha_numerator_denominator.cu | 14 +++++- .../kernel_Matrix21_normalize.cu | 14 +++++- ...kernel_Matrix21_pred_decrease_times_two.cu | 14 +++++- .../kernel_Matrix21_retract.cu | 6 +-- .../kernel_Matrix21_start_w.cu | 18 ++++++-- .../kernel_Matrix21_start_w_contribute.cu | 14 +++++- .../kernel_Matrix21_update_Mp.cu | 20 ++++++--- .../kernel_Matrix21_update_p.cu | 18 ++++++-- .../kernel_Matrix21_update_r.cu | 14 +++++- .../kernel_Matrix21_update_r_first.cu | 14 +++++- .../kernel_Matrix21_update_step.cu | 14 +++++- .../kernel_Matrix21_update_step_first.cu | 18 ++++++-- .../kernel_rosenbrock_jtjnjtr_direct.cu | 13 ++++-- .../kernel_rosenbrock_res_jac.cu | 24 +++++++--- .../kernel_rosenbrock_res_jac_first.cu | 18 ++++++-- .../kernel_rosenbrock_score.cu | 19 ++++++-- 21 files changed, 303 insertions(+), 61 deletions(-) diff --git a/symforce/caspar/code_generation/kernel.py b/symforce/caspar/code_generation/kernel.py index fd1a9561..965b19bd 100644 --- a/symforce/caspar/code_generation/kernel.py +++ b/symforce/caspar/code_generation/kernel.py @@ -5,6 +5,7 @@ from __future__ import annotations +import logging import re from pathlib import Path @@ -13,6 +14,8 @@ from ..code_formulation.dabseg_from_accessors import make_dabseg from ..code_formulation.dabseg_sorter import get_lines from ..memory.accessors import Accessor +from ..memory.accessors import AddSharedSum +from ..memory.accessors import ReadShared from ..memory.accessors import _ReadAccessor from ..memory.accessors import _WriteAccessor from ..memory.dtype import DType @@ -22,6 +25,19 @@ EMPTY_BLOCK_PATTERN = re.compile(r"\s*if \(global_thread_idx < problem_size\)\s*\{\n\s*\};\s*\n") +# sizeof(SharedIndex) in source/runtime/shared_indices.h: {uint32_t unique; uint16_t target, argsort}. +SHARED_INDEX_BYTES = 8 +SHARED_ALIGNMENT = 16 +# Shared memory per block available without opt-in on every GPU, and the largest opt-in limit of +# any (sm_90). +DEFAULT_SHARED_BYTES_PER_BLOCK = 48 * 1024 +MAX_SHARED_BYTES_PER_BLOCK = 227 * 1024 + + +def _align(value: int, alignment: int) -> int: + return (value + alignment - 1) // alignment * alignment + + class Kernel: """ Class representing a single kernel in the caspar library. @@ -47,6 +63,34 @@ def __init__( self.kernel_t = dtype self.block_size = block_size + # Dynamic shared memory layout: the scratch buffer, then one block of shared indices per + # shared-index accessor that owns its indices. + offset = _align(self.shared_size_req, SHARED_ALIGNMENT) + self.shared_index_offsets: dict[str, int] = {} + for acc in self.accessors: + if isinstance(acc, (ReadShared, AddSharedSum)) and acc.prep_lines: + self.shared_index_offsets[acc.idx_name] = offset + offset = _align(offset + SHARED_INDEX_BYTES * block_size, SHARED_ALIGNMENT) + self.dynamic_shared_bytes = offset + if self.dynamic_shared_bytes > MAX_SHARED_BYTES_PER_BLOCK: + shared_args = ", ".join(self.shared_index_offsets) or "none" + raise ValueError( + f"Kernel {name} needs {self.dynamic_shared_bytes} bytes of shared memory per block " + f"({self.shared_size_req} scratch + {SHARED_INDEX_BYTES * block_size} per shared " + f"argument: {shared_args}), more than any GPU supports " + f"({MAX_SHARED_BYTES_PER_BLOCK}). Use fewer shared (Tunable/Shared) arguments, " + "e.g. indexed constants, or a smaller dtype." + ) + if self.dynamic_shared_bytes > DEFAULT_SHARED_BYTES_PER_BLOCK: + logging.warning( + "Kernel %s needs %d bytes of shared memory per block, above the %d every GPU " + "supports; it will only launch on GPUs with a larger opt-in limit (e.g. 64 KB on " + "sm_75, 99 KB on sm_86, 163 KB on sm_80).", + name, + self.dynamic_shared_bytes, + DEFAULT_SHARED_BYTES_PER_BLOCK, + ) + def generate(self, out_dir: Path) -> None: dabseg = make_dabseg(self.inputs, self.outputs) self.code_lines, n_registers = get_lines(dabseg, dtype=self.kernel_t) diff --git a/symforce/caspar/memory/accessors.py b/symforce/caspar/memory/accessors.py index 76ee0e31..3c42e199 100644 --- a/symforce/caspar/memory/accessors.py +++ b/symforce/caspar/memory/accessors.py @@ -357,7 +357,8 @@ class ReadShared(_UsingIndexData, _UsingSharedMem, _ReadAccessor): } KERNEL_INIT_LINES_TEMPLATE = textwrap.dedent(""" - __shared__ SharedIndex {idx_name}_indices_loc[{block_size}]; + SharedIndex* const {idx_name}_indices_loc = + reinterpret_cast(inout_shared + {idx_name}_indices_shared_offset); {idx_name}_indices_loc[threadIdx.x] = (global_thread_idx(inout_shared + {idx_name}_indices_shared_offset); {idx_name}_indices_loc[threadIdx.x] = (global_thread_idx 0 %} - __shared__ uint8_t inout_shared[{{kernel.shared_size_req}}]; + {% if kernel.dynamic_shared_bytes > 0 %} + // Scratch data, then the shared indices of each shared accessor; dynamic, so that it may exceed + // the 48 KB static shared memory limit (see the launch below). + extern __shared__ __align__(16) uint8_t inout_shared[]; {% endif %} + {% for idx_name, offset in kernel.shared_index_offsets.items() %} + constexpr unsigned int {{idx_name}}_indices_shared_offset = {{offset}}; + {% endfor %} {% endif %} {% for accessor in kernel.accessors %} @@ -88,7 +93,17 @@ void {{parts_to_pascal(kernel.name)}} ( {{accessor.pre_kernel_code()}} {% endif %} {% endfor %} - {{parts_to_pascal(kernel.name)}}Kernel<<>>( + {% if kernel.dynamic_shared_bytes > 0 %} + // Kernels using more than 48 KB of shared memory per block must opt in. + static const cudaError_t attribute_error = cudaFuncSetAttribute( + {{parts_to_pascal(kernel.name)}}Kernel, cudaFuncAttributeMaxDynamicSharedMemorySize, + {{kernel.dynamic_shared_bytes}}); + if (attribute_error != cudaSuccess) { + throw std::runtime_error(std::string("{{parts_to_pascal(kernel.name)}}Kernel: ") + + cudaGetErrorString(attribute_error)); + } + {% endif %} + {{parts_to_pascal(kernel.name)}}Kernel<<>>( {% for accessor in kernel.accessors %} {% for name in accessor.kernel_sig %} {{name}}, diff --git a/test/symforce_function_codegen_test_data/symengine/symforce_caspar_codegen_test/kernel_caspar_padding_lane_score.cu b/test/symforce_function_codegen_test_data/symengine/symforce_caspar_codegen_test/kernel_caspar_padding_lane_score.cu index f29c197f..82e4d136 100644 --- a/test/symforce_function_codegen_test_data/symengine/symforce_caspar_codegen_test/kernel_caspar_padding_lane_score.cu +++ b/test/symforce_function_codegen_test_data/symengine/symforce_caspar_codegen_test/kernel_caspar_padding_lane_score.cu @@ -20,17 +20,26 @@ __global__ void __launch_bounds__(1024, 1) CasparPaddingLaneScoreKernel( unsigned int calibration_num_alloc, SharedIndex* calibration_indices, float* pixel, unsigned int pixel_num_alloc, float* const out_rTr, size_t problem_size) { const int global_thread_idx = blockIdx.x * blockDim.x + threadIdx.x; - __shared__ uint8_t inout_shared[16384]; + // Scratch data, then the shared indices of each shared accessor; dynamic, so + // that it may exceed the 48 KB static shared memory limit (see the launch + // below). + extern __shared__ __align__(16) uint8_t inout_shared[]; + constexpr unsigned int cam_T_world_indices_shared_offset = 16384; + constexpr unsigned int point_indices_shared_offset = 24576; + constexpr unsigned int calibration_indices_shared_offset = 32768; - __shared__ SharedIndex cam_T_world_indices_loc[1024]; + SharedIndex* const cam_T_world_indices_loc = + reinterpret_cast(inout_shared + cam_T_world_indices_shared_offset); cam_T_world_indices_loc[threadIdx.x] = (global_thread_idx < problem_size ? cam_T_world_indices[global_thread_idx] : SharedIndex{0xffffffff, 0xffff, 0xffff}); - __shared__ SharedIndex point_indices_loc[1024]; + SharedIndex* const point_indices_loc = + reinterpret_cast(inout_shared + point_indices_shared_offset); point_indices_loc[threadIdx.x] = (global_thread_idx < problem_size ? point_indices[global_thread_idx] : SharedIndex{0xffffffff, 0xffff, 0xffff}); - __shared__ SharedIndex calibration_indices_loc[1024]; + SharedIndex* const calibration_indices_loc = + reinterpret_cast(inout_shared + calibration_indices_shared_offset); calibration_indices_loc[threadIdx.x] = (global_thread_idx < problem_size ? calibration_indices[global_thread_idx] : SharedIndex{0xffffffff, 0xffff, 0xffff}); @@ -158,7 +167,14 @@ void CasparPaddingLaneScore(float* cam_T_world, unsigned int cam_T_world_num_all } const int n_blocks = (problem_size + 1024 - 1) / 1024; - CasparPaddingLaneScoreKernel<<>>( + // Kernels using more than 48 KB of shared memory per block must opt in. + static const cudaError_t attribute_error = cudaFuncSetAttribute( + CasparPaddingLaneScoreKernel, cudaFuncAttributeMaxDynamicSharedMemorySize, 40960); + if (attribute_error != cudaSuccess) { + throw std::runtime_error(std::string("CasparPaddingLaneScoreKernel: ") + + cudaGetErrorString(attribute_error)); + } + CasparPaddingLaneScoreKernel<<>>( cam_T_world, cam_T_world_num_alloc, cam_T_world_indices, point, point_num_alloc, point_indices, calibration, calibration_num_alloc, calibration_indices, pixel, pixel_num_alloc, out_rTr, problem_size); diff --git a/test/symforce_function_codegen_test_data/symengine/symforce_caspar_solver_test/kernel_Matrix21_alpha_denominator_or_beta_numerator.cu b/test/symforce_function_codegen_test_data/symengine/symforce_caspar_solver_test/kernel_Matrix21_alpha_denominator_or_beta_numerator.cu index 49389edc..1331046a 100644 --- a/test/symforce_function_codegen_test_data/symengine/symforce_caspar_solver_test/kernel_Matrix21_alpha_denominator_or_beta_numerator.cu +++ b/test/symforce_function_codegen_test_data/symengine/symforce_caspar_solver_test/kernel_Matrix21_alpha_denominator_or_beta_numerator.cu @@ -18,7 +18,10 @@ __global__ void __launch_bounds__(1024, 1) Matrix21AlphaDenominatorOrBetaNumerat double* Matrix21_p_kp1, unsigned int Matrix21_p_kp1_num_alloc, double* Matrix21_w, unsigned int Matrix21_w_num_alloc, double* const Matrix21_out, size_t problem_size) { const int global_thread_idx = blockIdx.x * blockDim.x + threadIdx.x; - __shared__ uint8_t inout_shared[256]; + // Scratch data, then the shared indices of each shared accessor; dynamic, so + // that it may exceed the 48 KB static shared memory limit (see the launch + // below). + extern __shared__ __align__(16) uint8_t inout_shared[]; __shared__ double Matrix21_out_local[1]; @@ -45,7 +48,15 @@ void Matrix21AlphaDenominatorOrBetaNumerator(double* Matrix21_p_kp1, } const int n_blocks = (problem_size + 1024 - 1) / 1024; - Matrix21AlphaDenominatorOrBetaNumeratorKernel<<>>( + // Kernels using more than 48 KB of shared memory per block must opt in. + static const cudaError_t attribute_error = + cudaFuncSetAttribute(Matrix21AlphaDenominatorOrBetaNumeratorKernel, + cudaFuncAttributeMaxDynamicSharedMemorySize, 256); + if (attribute_error != cudaSuccess) { + throw std::runtime_error(std::string("Matrix21AlphaDenominatorOrBetaNumeratorKernel: ") + + cudaGetErrorString(attribute_error)); + } + Matrix21AlphaDenominatorOrBetaNumeratorKernel<<>>( Matrix21_p_kp1, Matrix21_p_kp1_num_alloc, Matrix21_w, Matrix21_w_num_alloc, Matrix21_out, problem_size); // A launch that fails (e.g. from exceeding shared memory or register limits) diff --git a/test/symforce_function_codegen_test_data/symengine/symforce_caspar_solver_test/kernel_Matrix21_alpha_numerator_denominator.cu b/test/symforce_function_codegen_test_data/symengine/symforce_caspar_solver_test/kernel_Matrix21_alpha_numerator_denominator.cu index efdd5216..f90df48a 100644 --- a/test/symforce_function_codegen_test_data/symengine/symforce_caspar_solver_test/kernel_Matrix21_alpha_numerator_denominator.cu +++ b/test/symforce_function_codegen_test_data/symengine/symforce_caspar_solver_test/kernel_Matrix21_alpha_numerator_denominator.cu @@ -19,7 +19,10 @@ __global__ void __launch_bounds__(1024, 1) Matrix21AlphaNumeratorDenominatorKern unsigned int Matrix21_r_k_num_alloc, double* Matrix21_w, unsigned int Matrix21_w_num_alloc, double* const Matrix21_total_ag, double* const Matrix21_total_ac, size_t problem_size) { const int global_thread_idx = blockIdx.x * blockDim.x + threadIdx.x; - __shared__ uint8_t inout_shared[256]; + // Scratch data, then the shared indices of each shared accessor; dynamic, so + // that it may exceed the 48 KB static shared memory limit (see the launch + // below). + extern __shared__ __align__(16) uint8_t inout_shared[]; __shared__ double Matrix21_total_ag_local[1]; @@ -58,7 +61,14 @@ void Matrix21AlphaNumeratorDenominator(double* Matrix21_p_kp1, } const int n_blocks = (problem_size + 1024 - 1) / 1024; - Matrix21AlphaNumeratorDenominatorKernel<<>>( + // Kernels using more than 48 KB of shared memory per block must opt in. + static const cudaError_t attribute_error = cudaFuncSetAttribute( + Matrix21AlphaNumeratorDenominatorKernel, cudaFuncAttributeMaxDynamicSharedMemorySize, 256); + if (attribute_error != cudaSuccess) { + throw std::runtime_error(std::string("Matrix21AlphaNumeratorDenominatorKernel: ") + + cudaGetErrorString(attribute_error)); + } + Matrix21AlphaNumeratorDenominatorKernel<<>>( Matrix21_p_kp1, Matrix21_p_kp1_num_alloc, Matrix21_r_k, Matrix21_r_k_num_alloc, Matrix21_w, Matrix21_w_num_alloc, Matrix21_total_ag, Matrix21_total_ac, problem_size); // A launch that fails (e.g. from exceeding shared memory or register limits) diff --git a/test/symforce_function_codegen_test_data/symengine/symforce_caspar_solver_test/kernel_Matrix21_normalize.cu b/test/symforce_function_codegen_test_data/symengine/symforce_caspar_solver_test/kernel_Matrix21_normalize.cu index 45ba1d4c..65302139 100644 --- a/test/symforce_function_codegen_test_data/symengine/symforce_caspar_solver_test/kernel_Matrix21_normalize.cu +++ b/test/symforce_function_codegen_test_data/symengine/symforce_caspar_solver_test/kernel_Matrix21_normalize.cu @@ -21,7 +21,10 @@ __global__ void __launch_bounds__(1024, 1) double* out_normalized, unsigned int out_normalized_num_alloc, size_t problem_size) { const int global_thread_idx = blockIdx.x * blockDim.x + threadIdx.x; - __shared__ uint8_t inout_shared[8192]; + // Scratch data, then the shared indices of each shared accessor; dynamic, so + // that it may exceed the 48 KB static shared memory limit (see the launch + // below). + extern __shared__ __align__(16) uint8_t inout_shared[]; double r0 = 0, r1 = 0, r2 = 0, r3 = 0, r4 = 0, r5 = 0, r6 = 0, r7 = 0, r8 = 0; @@ -68,7 +71,14 @@ void Matrix21Normalize(double* precond_diag, unsigned int precond_diag_num_alloc } const int n_blocks = (problem_size + 1024 - 1) / 1024; - Matrix21NormalizeKernel<<>>( + // Kernels using more than 48 KB of shared memory per block must opt in. + static const cudaError_t attribute_error = cudaFuncSetAttribute( + Matrix21NormalizeKernel, cudaFuncAttributeMaxDynamicSharedMemorySize, 8192); + if (attribute_error != cudaSuccess) { + throw std::runtime_error(std::string("Matrix21NormalizeKernel: ") + + cudaGetErrorString(attribute_error)); + } + Matrix21NormalizeKernel<<>>( precond_diag, precond_diag_num_alloc, precond_tril, precond_tril_num_alloc, njtr, njtr_num_alloc, diag, out_normalized, out_normalized_num_alloc, problem_size); // A launch that fails (e.g. from exceeding shared memory or register limits) diff --git a/test/symforce_function_codegen_test_data/symengine/symforce_caspar_solver_test/kernel_Matrix21_pred_decrease_times_two.cu b/test/symforce_function_codegen_test_data/symengine/symforce_caspar_solver_test/kernel_Matrix21_pred_decrease_times_two.cu index d31e9f1b..44488925 100644 --- a/test/symforce_function_codegen_test_data/symengine/symforce_caspar_solver_test/kernel_Matrix21_pred_decrease_times_two.cu +++ b/test/symforce_function_codegen_test_data/symengine/symforce_caspar_solver_test/kernel_Matrix21_pred_decrease_times_two.cu @@ -22,7 +22,10 @@ __global__ void __launch_bounds__(1024, 1) unsigned int Matrix21_njtr_num_alloc, double* const out_Matrix21_pred_dec, size_t problem_size) { const int global_thread_idx = blockIdx.x * blockDim.x + threadIdx.x; - __shared__ uint8_t inout_shared[8192]; + // Scratch data, then the shared indices of each shared accessor; dynamic, so + // that it may exceed the 48 KB static shared memory limit (see the launch + // below). + extern __shared__ __align__(16) uint8_t inout_shared[]; __shared__ double out_Matrix21_pred_dec_local[1]; @@ -64,7 +67,14 @@ void Matrix21PredDecreaseTimesTwo(double* Matrix21_step, unsigned int Matrix21_s } const int n_blocks = (problem_size + 1024 - 1) / 1024; - Matrix21PredDecreaseTimesTwoKernel<<>>( + // Kernels using more than 48 KB of shared memory per block must opt in. + static const cudaError_t attribute_error = cudaFuncSetAttribute( + Matrix21PredDecreaseTimesTwoKernel, cudaFuncAttributeMaxDynamicSharedMemorySize, 8192); + if (attribute_error != cudaSuccess) { + throw std::runtime_error(std::string("Matrix21PredDecreaseTimesTwoKernel: ") + + cudaGetErrorString(attribute_error)); + } + Matrix21PredDecreaseTimesTwoKernel<<>>( Matrix21_step, Matrix21_step_num_alloc, Matrix21_precond_diag, Matrix21_precond_diag_num_alloc, diag, Matrix21_njtr, Matrix21_njtr_num_alloc, out_Matrix21_pred_dec, problem_size); diff --git a/test/symforce_function_codegen_test_data/symengine/symforce_caspar_solver_test/kernel_Matrix21_retract.cu b/test/symforce_function_codegen_test_data/symengine/symforce_caspar_solver_test/kernel_Matrix21_retract.cu index fa999ec9..14e7d572 100644 --- a/test/symforce_function_codegen_test_data/symengine/symforce_caspar_solver_test/kernel_Matrix21_retract.cu +++ b/test/symforce_function_codegen_test_data/symengine/symforce_caspar_solver_test/kernel_Matrix21_retract.cu @@ -41,9 +41,9 @@ void Matrix21Retract(double* Matrix21, unsigned int Matrix21_num_alloc, double* } const int n_blocks = (problem_size + 1024 - 1) / 1024; - Matrix21RetractKernel<<>>(Matrix21, Matrix21_num_alloc, delta, delta_num_alloc, - out_Matrix21_retracted, - out_Matrix21_retracted_num_alloc, problem_size); + Matrix21RetractKernel<<>>(Matrix21, Matrix21_num_alloc, delta, delta_num_alloc, + out_Matrix21_retracted, + out_Matrix21_retracted_num_alloc, problem_size); // A launch that fails (e.g. from exceeding shared memory or register limits) // otherwise leaves its outputs untouched without any error. const cudaError_t launch_error = cudaGetLastError(); diff --git a/test/symforce_function_codegen_test_data/symengine/symforce_caspar_solver_test/kernel_Matrix21_start_w.cu b/test/symforce_function_codegen_test_data/symengine/symforce_caspar_solver_test/kernel_Matrix21_start_w.cu index 541e8d19..1a370cb0 100644 --- a/test/symforce_function_codegen_test_data/symengine/symforce_caspar_solver_test/kernel_Matrix21_start_w.cu +++ b/test/symforce_function_codegen_test_data/symengine/symforce_caspar_solver_test/kernel_Matrix21_start_w.cu @@ -21,7 +21,10 @@ __global__ void __launch_bounds__(1024, 1) double* out_Matrix21_w, unsigned int out_Matrix21_w_num_alloc, size_t problem_size) { const int global_thread_idx = blockIdx.x * blockDim.x + threadIdx.x; - __shared__ uint8_t inout_shared[8192]; + // Scratch data, then the shared indices of each shared accessor; dynamic, so + // that it may exceed the 48 KB static shared memory limit (see the launch + // below). + extern __shared__ __align__(16) uint8_t inout_shared[]; double r0 = 0, r1 = 0, r2 = 0, r3 = 0, r4 = 0; @@ -55,9 +58,16 @@ void Matrix21StartW(double* Matrix21_precond_diag, unsigned int Matrix21_precond } const int n_blocks = (problem_size + 1024 - 1) / 1024; - Matrix21StartWKernel<<>>(Matrix21_precond_diag, Matrix21_precond_diag_num_alloc, - diag, Matrix21_p, Matrix21_p_num_alloc, out_Matrix21_w, - out_Matrix21_w_num_alloc, problem_size); + // Kernels using more than 48 KB of shared memory per block must opt in. + static const cudaError_t attribute_error = + cudaFuncSetAttribute(Matrix21StartWKernel, cudaFuncAttributeMaxDynamicSharedMemorySize, 8192); + if (attribute_error != cudaSuccess) { + throw std::runtime_error(std::string("Matrix21StartWKernel: ") + + cudaGetErrorString(attribute_error)); + } + Matrix21StartWKernel<<>>( + Matrix21_precond_diag, Matrix21_precond_diag_num_alloc, diag, Matrix21_p, + Matrix21_p_num_alloc, out_Matrix21_w, out_Matrix21_w_num_alloc, problem_size); // A launch that fails (e.g. from exceeding shared memory or register limits) // otherwise leaves its outputs untouched without any error. const cudaError_t launch_error = cudaGetLastError(); diff --git a/test/symforce_function_codegen_test_data/symengine/symforce_caspar_solver_test/kernel_Matrix21_start_w_contribute.cu b/test/symforce_function_codegen_test_data/symengine/symforce_caspar_solver_test/kernel_Matrix21_start_w_contribute.cu index 6e11cbdb..95c95c4c 100644 --- a/test/symforce_function_codegen_test_data/symengine/symforce_caspar_solver_test/kernel_Matrix21_start_w_contribute.cu +++ b/test/symforce_function_codegen_test_data/symengine/symforce_caspar_solver_test/kernel_Matrix21_start_w_contribute.cu @@ -21,7 +21,10 @@ __global__ void __launch_bounds__(1024, 1) unsigned int Matrix21_p_num_alloc, double* out_Matrix21_w, unsigned int out_Matrix21_w_num_alloc, size_t problem_size) { const int global_thread_idx = blockIdx.x * blockDim.x + threadIdx.x; - __shared__ uint8_t inout_shared[8192]; + // Scratch data, then the shared indices of each shared accessor; dynamic, so + // that it may exceed the 48 KB static shared memory limit (see the launch + // below). + extern __shared__ __align__(16) uint8_t inout_shared[]; double r0 = 0, r1 = 0, r2 = 0, r3 = 0, r4 = 0; @@ -56,7 +59,14 @@ void Matrix21StartWContribute(double* Matrix21_precond_diag, } const int n_blocks = (problem_size + 1024 - 1) / 1024; - Matrix21StartWContributeKernel<<>>( + // Kernels using more than 48 KB of shared memory per block must opt in. + static const cudaError_t attribute_error = cudaFuncSetAttribute( + Matrix21StartWContributeKernel, cudaFuncAttributeMaxDynamicSharedMemorySize, 8192); + if (attribute_error != cudaSuccess) { + throw std::runtime_error(std::string("Matrix21StartWContributeKernel: ") + + cudaGetErrorString(attribute_error)); + } + Matrix21StartWContributeKernel<<>>( Matrix21_precond_diag, Matrix21_precond_diag_num_alloc, diag, Matrix21_p, Matrix21_p_num_alloc, out_Matrix21_w, out_Matrix21_w_num_alloc, problem_size); // A launch that fails (e.g. from exceeding shared memory or register limits) diff --git a/test/symforce_function_codegen_test_data/symengine/symforce_caspar_solver_test/kernel_Matrix21_update_Mp.cu b/test/symforce_function_codegen_test_data/symengine/symforce_caspar_solver_test/kernel_Matrix21_update_Mp.cu index 8e744289..49611002 100644 --- a/test/symforce_function_codegen_test_data/symengine/symforce_caspar_solver_test/kernel_Matrix21_update_Mp.cu +++ b/test/symforce_function_codegen_test_data/symengine/symforce_caspar_solver_test/kernel_Matrix21_update_Mp.cu @@ -21,7 +21,10 @@ __global__ void __launch_bounds__(1024, 1) unsigned int out_Matrix21_Mp_kp1_num_alloc, double* out_Matrix21_w, unsigned int out_Matrix21_w_num_alloc, size_t problem_size) { const int global_thread_idx = blockIdx.x * blockDim.x + threadIdx.x; - __shared__ uint8_t inout_shared[8192]; + // Scratch data, then the shared indices of each shared accessor; dynamic, so + // that it may exceed the 48 KB static shared memory limit (see the launch + // below). + extern __shared__ __align__(16) uint8_t inout_shared[]; double r0 = 0, r1 = 0, r2 = 0, r3 = 0, r4 = 0; @@ -56,10 +59,17 @@ void Matrix21UpdateMp(double* Matrix21_r_k, unsigned int Matrix21_r_k_num_alloc, } const int n_blocks = (problem_size + 1024 - 1) / 1024; - Matrix21UpdateMpKernel<<>>(Matrix21_r_k, Matrix21_r_k_num_alloc, Matrix21_Mp, - Matrix21_Mp_num_alloc, beta, out_Matrix21_Mp_kp1, - out_Matrix21_Mp_kp1_num_alloc, out_Matrix21_w, - out_Matrix21_w_num_alloc, problem_size); + // Kernels using more than 48 KB of shared memory per block must opt in. + static const cudaError_t attribute_error = cudaFuncSetAttribute( + Matrix21UpdateMpKernel, cudaFuncAttributeMaxDynamicSharedMemorySize, 8192); + if (attribute_error != cudaSuccess) { + throw std::runtime_error(std::string("Matrix21UpdateMpKernel: ") + + cudaGetErrorString(attribute_error)); + } + Matrix21UpdateMpKernel<<>>( + Matrix21_r_k, Matrix21_r_k_num_alloc, Matrix21_Mp, Matrix21_Mp_num_alloc, beta, + out_Matrix21_Mp_kp1, out_Matrix21_Mp_kp1_num_alloc, out_Matrix21_w, out_Matrix21_w_num_alloc, + problem_size); // A launch that fails (e.g. from exceeding shared memory or register limits) // otherwise leaves its outputs untouched without any error. const cudaError_t launch_error = cudaGetLastError(); diff --git a/test/symforce_function_codegen_test_data/symengine/symforce_caspar_solver_test/kernel_Matrix21_update_p.cu b/test/symforce_function_codegen_test_data/symengine/symforce_caspar_solver_test/kernel_Matrix21_update_p.cu index dd9b9021..eee35a76 100644 --- a/test/symforce_function_codegen_test_data/symengine/symforce_caspar_solver_test/kernel_Matrix21_update_p.cu +++ b/test/symforce_function_codegen_test_data/symengine/symforce_caspar_solver_test/kernel_Matrix21_update_p.cu @@ -20,7 +20,10 @@ __global__ void __launch_bounds__(1024, 1) const double* const beta, double* out_Matrix21_p_kp1, unsigned int out_Matrix21_p_kp1_num_alloc, size_t problem_size) { const int global_thread_idx = blockIdx.x * blockDim.x + threadIdx.x; - __shared__ uint8_t inout_shared[8192]; + // Scratch data, then the shared indices of each shared accessor; dynamic, so + // that it may exceed the 48 KB static shared memory limit (see the launch + // below). + extern __shared__ __align__(16) uint8_t inout_shared[]; double r0 = 0, r1 = 0, r2 = 0, r3 = 0, r4 = 0; @@ -52,9 +55,16 @@ void Matrix21UpdateP(double* Matrix21_z, unsigned int Matrix21_z_num_alloc, doub } const int n_blocks = (problem_size + 1024 - 1) / 1024; - Matrix21UpdatePKernel<<>>(Matrix21_z, Matrix21_z_num_alloc, Matrix21_p_k, - Matrix21_p_k_num_alloc, beta, out_Matrix21_p_kp1, - out_Matrix21_p_kp1_num_alloc, problem_size); + // Kernels using more than 48 KB of shared memory per block must opt in. + static const cudaError_t attribute_error = cudaFuncSetAttribute( + Matrix21UpdatePKernel, cudaFuncAttributeMaxDynamicSharedMemorySize, 8192); + if (attribute_error != cudaSuccess) { + throw std::runtime_error(std::string("Matrix21UpdatePKernel: ") + + cudaGetErrorString(attribute_error)); + } + Matrix21UpdatePKernel<<>>(Matrix21_z, Matrix21_z_num_alloc, Matrix21_p_k, + Matrix21_p_k_num_alloc, beta, out_Matrix21_p_kp1, + out_Matrix21_p_kp1_num_alloc, problem_size); // A launch that fails (e.g. from exceeding shared memory or register limits) // otherwise leaves its outputs untouched without any error. const cudaError_t launch_error = cudaGetLastError(); diff --git a/test/symforce_function_codegen_test_data/symengine/symforce_caspar_solver_test/kernel_Matrix21_update_r.cu b/test/symforce_function_codegen_test_data/symengine/symforce_caspar_solver_test/kernel_Matrix21_update_r.cu index ba15b1be..2dca6a4e 100644 --- a/test/symforce_function_codegen_test_data/symengine/symforce_caspar_solver_test/kernel_Matrix21_update_r.cu +++ b/test/symforce_function_codegen_test_data/symengine/symforce_caspar_solver_test/kernel_Matrix21_update_r.cu @@ -21,7 +21,10 @@ __global__ void __launch_bounds__(1024, 1) unsigned int out_Matrix21_r_kp1_num_alloc, double* const out_Matrix21_r_kp1_norm2_tot, size_t problem_size) { const int global_thread_idx = blockIdx.x * blockDim.x + threadIdx.x; - __shared__ uint8_t inout_shared[8192]; + // Scratch data, then the shared indices of each shared accessor; dynamic, so + // that it may exceed the 48 KB static shared memory limit (see the launch + // below). + extern __shared__ __align__(16) uint8_t inout_shared[]; __shared__ double out_Matrix21_r_kp1_norm2_tot_local[1]; @@ -59,7 +62,14 @@ void Matrix21UpdateR(double* Matrix21_r_k, unsigned int Matrix21_r_k_num_alloc, } const int n_blocks = (problem_size + 1024 - 1) / 1024; - Matrix21UpdateRKernel<<>>( + // Kernels using more than 48 KB of shared memory per block must opt in. + static const cudaError_t attribute_error = cudaFuncSetAttribute( + Matrix21UpdateRKernel, cudaFuncAttributeMaxDynamicSharedMemorySize, 8192); + if (attribute_error != cudaSuccess) { + throw std::runtime_error(std::string("Matrix21UpdateRKernel: ") + + cudaGetErrorString(attribute_error)); + } + Matrix21UpdateRKernel<<>>( Matrix21_r_k, Matrix21_r_k_num_alloc, Matrix21_w, Matrix21_w_num_alloc, negalpha, out_Matrix21_r_kp1, out_Matrix21_r_kp1_num_alloc, out_Matrix21_r_kp1_norm2_tot, problem_size); // A launch that fails (e.g. from exceeding shared memory or register limits) diff --git a/test/symforce_function_codegen_test_data/symengine/symforce_caspar_solver_test/kernel_Matrix21_update_r_first.cu b/test/symforce_function_codegen_test_data/symengine/symforce_caspar_solver_test/kernel_Matrix21_update_r_first.cu index cb5dd733..9519aa50 100644 --- a/test/symforce_function_codegen_test_data/symengine/symforce_caspar_solver_test/kernel_Matrix21_update_r_first.cu +++ b/test/symforce_function_codegen_test_data/symengine/symforce_caspar_solver_test/kernel_Matrix21_update_r_first.cu @@ -22,7 +22,10 @@ __global__ void __launch_bounds__(1024, 1) double* const out_Matrix21_r_0_norm2_tot, double* const out_Matrix21_r_kp1_norm2_tot, size_t problem_size) { const int global_thread_idx = blockIdx.x * blockDim.x + threadIdx.x; - __shared__ uint8_t inout_shared[8192]; + // Scratch data, then the shared indices of each shared accessor; dynamic, so + // that it may exceed the 48 KB static shared memory limit (see the launch + // below). + extern __shared__ __align__(16) uint8_t inout_shared[]; __shared__ double out_Matrix21_r_0_norm2_tot_local[1]; @@ -70,7 +73,14 @@ void Matrix21UpdateRFirst(double* Matrix21_r_k, unsigned int Matrix21_r_k_num_al } const int n_blocks = (problem_size + 1024 - 1) / 1024; - Matrix21UpdateRFirstKernel<<>>( + // Kernels using more than 48 KB of shared memory per block must opt in. + static const cudaError_t attribute_error = cudaFuncSetAttribute( + Matrix21UpdateRFirstKernel, cudaFuncAttributeMaxDynamicSharedMemorySize, 8192); + if (attribute_error != cudaSuccess) { + throw std::runtime_error(std::string("Matrix21UpdateRFirstKernel: ") + + cudaGetErrorString(attribute_error)); + } + Matrix21UpdateRFirstKernel<<>>( Matrix21_r_k, Matrix21_r_k_num_alloc, Matrix21_w, Matrix21_w_num_alloc, negalpha, out_Matrix21_r_kp1, out_Matrix21_r_kp1_num_alloc, out_Matrix21_r_0_norm2_tot, out_Matrix21_r_kp1_norm2_tot, problem_size); diff --git a/test/symforce_function_codegen_test_data/symengine/symforce_caspar_solver_test/kernel_Matrix21_update_step.cu b/test/symforce_function_codegen_test_data/symengine/symforce_caspar_solver_test/kernel_Matrix21_update_step.cu index 5f84d923..fdcbc605 100644 --- a/test/symforce_function_codegen_test_data/symengine/symforce_caspar_solver_test/kernel_Matrix21_update_step.cu +++ b/test/symforce_function_codegen_test_data/symengine/symforce_caspar_solver_test/kernel_Matrix21_update_step.cu @@ -20,7 +20,10 @@ __global__ void __launch_bounds__(1024, 1) const double* const alpha, double* out_Matrix21_step_kp1, unsigned int out_Matrix21_step_kp1_num_alloc, size_t problem_size) { const int global_thread_idx = blockIdx.x * blockDim.x + threadIdx.x; - __shared__ uint8_t inout_shared[8192]; + // Scratch data, then the shared indices of each shared accessor; dynamic, so + // that it may exceed the 48 KB static shared memory limit (see the launch + // below). + extern __shared__ __align__(16) uint8_t inout_shared[]; double r0 = 0, r1 = 0, r2 = 0, r3 = 0, r4 = 0; @@ -52,7 +55,14 @@ void Matrix21UpdateStep(double* Matrix21_step_k, unsigned int Matrix21_step_k_nu } const int n_blocks = (problem_size + 1024 - 1) / 1024; - Matrix21UpdateStepKernel<<>>( + // Kernels using more than 48 KB of shared memory per block must opt in. + static const cudaError_t attribute_error = cudaFuncSetAttribute( + Matrix21UpdateStepKernel, cudaFuncAttributeMaxDynamicSharedMemorySize, 8192); + if (attribute_error != cudaSuccess) { + throw std::runtime_error(std::string("Matrix21UpdateStepKernel: ") + + cudaGetErrorString(attribute_error)); + } + Matrix21UpdateStepKernel<<>>( Matrix21_step_k, Matrix21_step_k_num_alloc, Matrix21_p_kp1, Matrix21_p_kp1_num_alloc, alpha, out_Matrix21_step_kp1, out_Matrix21_step_kp1_num_alloc, problem_size); // A launch that fails (e.g. from exceeding shared memory or register limits) diff --git a/test/symforce_function_codegen_test_data/symengine/symforce_caspar_solver_test/kernel_Matrix21_update_step_first.cu b/test/symforce_function_codegen_test_data/symengine/symforce_caspar_solver_test/kernel_Matrix21_update_step_first.cu index 41129866..7bf44110 100644 --- a/test/symforce_function_codegen_test_data/symengine/symforce_caspar_solver_test/kernel_Matrix21_update_step_first.cu +++ b/test/symforce_function_codegen_test_data/symengine/symforce_caspar_solver_test/kernel_Matrix21_update_step_first.cu @@ -20,7 +20,10 @@ __global__ void __launch_bounds__(1024, 1) unsigned int out_Matrix21_step_kp1_num_alloc, size_t problem_size) { const int global_thread_idx = blockIdx.x * blockDim.x + threadIdx.x; - __shared__ uint8_t inout_shared[8192]; + // Scratch data, then the shared indices of each shared accessor; dynamic, so + // that it may exceed the 48 KB static shared memory limit (see the launch + // below). + extern __shared__ __align__(16) uint8_t inout_shared[]; double r0 = 0, r1 = 0, r2 = 0; @@ -49,9 +52,16 @@ void Matrix21UpdateStepFirst(double* Matrix21_p_kp1, unsigned int Matrix21_p_kp1 } const int n_blocks = (problem_size + 1024 - 1) / 1024; - Matrix21UpdateStepFirstKernel<<>>(Matrix21_p_kp1, Matrix21_p_kp1_num_alloc, alpha, - out_Matrix21_step_kp1, - out_Matrix21_step_kp1_num_alloc, problem_size); + // Kernels using more than 48 KB of shared memory per block must opt in. + static const cudaError_t attribute_error = cudaFuncSetAttribute( + Matrix21UpdateStepFirstKernel, cudaFuncAttributeMaxDynamicSharedMemorySize, 8192); + if (attribute_error != cudaSuccess) { + throw std::runtime_error(std::string("Matrix21UpdateStepFirstKernel: ") + + cudaGetErrorString(attribute_error)); + } + Matrix21UpdateStepFirstKernel<<>>( + Matrix21_p_kp1, Matrix21_p_kp1_num_alloc, alpha, out_Matrix21_step_kp1, + out_Matrix21_step_kp1_num_alloc, problem_size); // A launch that fails (e.g. from exceeding shared memory or register limits) // otherwise leaves its outputs untouched without any error. const cudaError_t launch_error = cudaGetLastError(); diff --git a/test/symforce_function_codegen_test_data/symengine/symforce_caspar_solver_test/kernel_rosenbrock_jtjnjtr_direct.cu b/test/symforce_function_codegen_test_data/symengine/symforce_caspar_solver_test/kernel_rosenbrock_jtjnjtr_direct.cu index 0c0a66c1..956e7b88 100644 --- a/test/symforce_function_codegen_test_data/symengine/symforce_caspar_solver_test/kernel_rosenbrock_jtjnjtr_direct.cu +++ b/test/symforce_function_codegen_test_data/symengine/symforce_caspar_solver_test/kernel_rosenbrock_jtjnjtr_direct.cu @@ -29,9 +29,16 @@ void RosenbrockJtjnjtrDirect(double* x_njtr, unsigned int x_njtr_num_alloc, } const int n_blocks = (problem_size + 1024 - 1) / 1024; - RosenbrockJtjnjtrDirectKernel<<>>(x_njtr, x_njtr_num_alloc, x_njtr_indices, x_jac, - x_jac_num_alloc, out_x_njtr, - out_x_njtr_num_alloc, problem_size); + // Kernels using more than 48 KB of shared memory per block must opt in. + static const cudaError_t attribute_error = cudaFuncSetAttribute( + RosenbrockJtjnjtrDirectKernel, cudaFuncAttributeMaxDynamicSharedMemorySize, 24576); + if (attribute_error != cudaSuccess) { + throw std::runtime_error(std::string("RosenbrockJtjnjtrDirectKernel: ") + + cudaGetErrorString(attribute_error)); + } + RosenbrockJtjnjtrDirectKernel<<>>(x_njtr, x_njtr_num_alloc, x_njtr_indices, + x_jac, x_jac_num_alloc, out_x_njtr, + out_x_njtr_num_alloc, problem_size); // A launch that fails (e.g. from exceeding shared memory or register limits) // otherwise leaves its outputs untouched without any error. const cudaError_t launch_error = cudaGetLastError(); diff --git a/test/symforce_function_codegen_test_data/symengine/symforce_caspar_solver_test/kernel_rosenbrock_res_jac.cu b/test/symforce_function_codegen_test_data/symengine/symforce_caspar_solver_test/kernel_rosenbrock_res_jac.cu index 289664c3..8c17c53f 100644 --- a/test/symforce_function_codegen_test_data/symengine/symforce_caspar_solver_test/kernel_rosenbrock_res_jac.cu +++ b/test/symforce_function_codegen_test_data/symengine/symforce_caspar_solver_test/kernel_rosenbrock_res_jac.cu @@ -23,9 +23,14 @@ __global__ void __launch_bounds__(1024, 1) double* const out_x_precond_tril, unsigned int out_x_precond_tril_num_alloc, size_t problem_size) { const int global_thread_idx = blockIdx.x * blockDim.x + threadIdx.x; - __shared__ uint8_t inout_shared[16384]; + // Scratch data, then the shared indices of each shared accessor; dynamic, so + // that it may exceed the 48 KB static shared memory limit (see the launch + // below). + extern __shared__ __align__(16) uint8_t inout_shared[]; + constexpr unsigned int x_indices_shared_offset = 16384; - __shared__ SharedIndex x_indices_loc[1024]; + SharedIndex* const x_indices_loc = + reinterpret_cast(inout_shared + x_indices_shared_offset); x_indices_loc[threadIdx.x] = (global_thread_idx < problem_size ? x_indices[global_thread_idx] : SharedIndex{0xffffffff, 0xffff, 0xffff}); @@ -85,10 +90,17 @@ void RosenbrockResJac(double* x, unsigned int x_num_alloc, SharedIndex* x_indice } const int n_blocks = (problem_size + 1024 - 1) / 1024; - RosenbrockResJacKernel<<>>(x, x_num_alloc, x_indices, out_res, out_res_num_alloc, - out_x_njtr, out_x_njtr_num_alloc, out_x_precond_diag, - out_x_precond_diag_num_alloc, out_x_precond_tril, - out_x_precond_tril_num_alloc, problem_size); + // Kernels using more than 48 KB of shared memory per block must opt in. + static const cudaError_t attribute_error = cudaFuncSetAttribute( + RosenbrockResJacKernel, cudaFuncAttributeMaxDynamicSharedMemorySize, 24576); + if (attribute_error != cudaSuccess) { + throw std::runtime_error(std::string("RosenbrockResJacKernel: ") + + cudaGetErrorString(attribute_error)); + } + RosenbrockResJacKernel<<>>( + x, x_num_alloc, x_indices, out_res, out_res_num_alloc, out_x_njtr, out_x_njtr_num_alloc, + out_x_precond_diag, out_x_precond_diag_num_alloc, out_x_precond_tril, + out_x_precond_tril_num_alloc, problem_size); // A launch that fails (e.g. from exceeding shared memory or register limits) // otherwise leaves its outputs untouched without any error. const cudaError_t launch_error = cudaGetLastError(); diff --git a/test/symforce_function_codegen_test_data/symengine/symforce_caspar_solver_test/kernel_rosenbrock_res_jac_first.cu b/test/symforce_function_codegen_test_data/symengine/symforce_caspar_solver_test/kernel_rosenbrock_res_jac_first.cu index f1b90ad0..94cdbac1 100644 --- a/test/symforce_function_codegen_test_data/symengine/symforce_caspar_solver_test/kernel_rosenbrock_res_jac_first.cu +++ b/test/symforce_function_codegen_test_data/symengine/symforce_caspar_solver_test/kernel_rosenbrock_res_jac_first.cu @@ -23,9 +23,14 @@ __global__ void __launch_bounds__(1024, 1) double* const out_x_precond_tril, unsigned int out_x_precond_tril_num_alloc, size_t problem_size) { const int global_thread_idx = blockIdx.x * blockDim.x + threadIdx.x; - __shared__ uint8_t inout_shared[16384]; + // Scratch data, then the shared indices of each shared accessor; dynamic, so + // that it may exceed the 48 KB static shared memory limit (see the launch + // below). + extern __shared__ __align__(16) uint8_t inout_shared[]; + constexpr unsigned int x_indices_shared_offset = 16384; - __shared__ SharedIndex x_indices_loc[1024]; + SharedIndex* const x_indices_loc = + reinterpret_cast(inout_shared + x_indices_shared_offset); x_indices_loc[threadIdx.x] = (global_thread_idx < problem_size ? x_indices[global_thread_idx] : SharedIndex{0xffffffff, 0xffff, 0xffff}); @@ -95,7 +100,14 @@ void RosenbrockResJacFirst(double* x, unsigned int x_num_alloc, SharedIndex* x_i } const int n_blocks = (problem_size + 1024 - 1) / 1024; - RosenbrockResJacFirstKernel<<>>( + // Kernels using more than 48 KB of shared memory per block must opt in. + static const cudaError_t attribute_error = cudaFuncSetAttribute( + RosenbrockResJacFirstKernel, cudaFuncAttributeMaxDynamicSharedMemorySize, 24576); + if (attribute_error != cudaSuccess) { + throw std::runtime_error(std::string("RosenbrockResJacFirstKernel: ") + + cudaGetErrorString(attribute_error)); + } + RosenbrockResJacFirstKernel<<>>( x, x_num_alloc, x_indices, out_res, out_res_num_alloc, out_rTr, out_x_njtr, out_x_njtr_num_alloc, out_x_precond_diag, out_x_precond_diag_num_alloc, out_x_precond_tril, out_x_precond_tril_num_alloc, problem_size); diff --git a/test/symforce_function_codegen_test_data/symengine/symforce_caspar_solver_test/kernel_rosenbrock_score.cu b/test/symforce_function_codegen_test_data/symengine/symforce_caspar_solver_test/kernel_rosenbrock_score.cu index 6b9913f7..0932d18e 100644 --- a/test/symforce_function_codegen_test_data/symengine/symforce_caspar_solver_test/kernel_rosenbrock_score.cu +++ b/test/symforce_function_codegen_test_data/symengine/symforce_caspar_solver_test/kernel_rosenbrock_score.cu @@ -18,9 +18,14 @@ __global__ void __launch_bounds__(1024, 1) RosenbrockScoreKernel(double* x, unsigned int x_num_alloc, SharedIndex* x_indices, double* const out_rTr, size_t problem_size) { const int global_thread_idx = blockIdx.x * blockDim.x + threadIdx.x; - __shared__ uint8_t inout_shared[16384]; + // Scratch data, then the shared indices of each shared accessor; dynamic, so + // that it may exceed the 48 KB static shared memory limit (see the launch + // below). + extern __shared__ __align__(16) uint8_t inout_shared[]; + constexpr unsigned int x_indices_shared_offset = 16384; - __shared__ SharedIndex x_indices_loc[1024]; + SharedIndex* const x_indices_loc = + reinterpret_cast(inout_shared + x_indices_shared_offset); x_indices_loc[threadIdx.x] = (global_thread_idx < problem_size ? x_indices[global_thread_idx] : SharedIndex{0xffffffff, 0xffff, 0xffff}); @@ -57,7 +62,15 @@ void RosenbrockScore(double* x, unsigned int x_num_alloc, SharedIndex* x_indices } const int n_blocks = (problem_size + 1024 - 1) / 1024; - RosenbrockScoreKernel<<>>(x, x_num_alloc, x_indices, out_rTr, problem_size); + // Kernels using more than 48 KB of shared memory per block must opt in. + static const cudaError_t attribute_error = cudaFuncSetAttribute( + RosenbrockScoreKernel, cudaFuncAttributeMaxDynamicSharedMemorySize, 24576); + if (attribute_error != cudaSuccess) { + throw std::runtime_error(std::string("RosenbrockScoreKernel: ") + + cudaGetErrorString(attribute_error)); + } + RosenbrockScoreKernel<<>>(x, x_num_alloc, x_indices, out_rTr, + problem_size); // A launch that fails (e.g. from exceeding shared memory or register limits) // otherwise leaves its outputs untouched without any error. const cudaError_t launch_error = cudaGetLastError(); From abb954b551260db06a649981c05a936614895b66 Mon Sep 17 00:00:00 2001 From: Aaron Date: Fri, 23 Oct 2026 02:00:59 +0000 Subject: [PATCH 49/68] [Caspar] Fix the block-tridiagonal preconditioner for several types and short chains Caspar gives every node type used by a `Pair` factor a block-tridiagonal preconditioner, solved by cyclic reduction in `DoNormalize()`. The generated host code for it had three bugs: - The reduction loop was emitted inline for each node type, with `i`, `offset` and `remaining` declared at function scope. With two or more such node types (say an IMU factor over consecutive poses and velocities, plus bias random walks) solver.cc didn't compile. - For a chain of one node, or none, the final two-node solve still wrote a second node's solution past the end of the buffer. For a 3D node type it landed on the first node's third component, which then never moved. - For chains of one or two nodes that solve used a stride of `2 << -1`, which is undefined. Chains shorter than two nodes now use the block-diagonal `Normalize` kernel, which is exact when there are no off-diagonal blocks. The stride is `1 << (i + 1)`, and the reduction is scoped per node type. `symforce_caspar_codegen_test` now also generates a library with a 2D and a 3D chain, each linked by its own `Pair` factor, priors on every node, and a factor coupling the two. `caspar_tridiagonal_cuda_test` solves it for chains of 1, 2, 3, 7 and 8 nodes and compares against a dense Eigen solve. Without coupling the preconditioner is exact, so one LM iteration with one CG iteration lands on the dense solution; with coupling the solver converges to it. The single-node 3D cases fail without the fix. Rather than add a third copy of the CMake block each Caspar CUDA test had, the CMake build now defines them in one loop over `*_cuda_test.cc`, as it does the C++ tests. Each test compiles the code generated into `symforce_caspar__test` and links one library of the Caspar runtime sources, and Eigen. `caspar_padding_lane_cuda_test` is the one exception: its kernel is generated into `symforce_caspar_codegen_test`. Built the Caspar CUDA tests from `test/CMakeLists.txt`, configured alone with CUDA 12.6 and stub targets for the SymForce libraries, and they passed under `ctest -R caspar` on a Quadro RTX 4000, both here and with the next commit's backend coverage test. GitOrigin-RevId: 16c04302de4d5b61e28410a60d39a077121d5723 --- .../caspar/source/templates/solver.cc.jinja | 17 +- test/CMakeLists.txt | 88 +- test/caspar_tridiagonal_cuda_test.cc | 225 +++ test/symforce_caspar_codegen_test.py | 113 +- .../caspar_mappings.cu | 588 ++++++++ .../caspar_mappings.h | 63 + ...inA_alpha_denominator_or_beta_numerator.cu | 73 + ...ainA_alpha_denominator_or_beta_numerator.h | 14 + ...rnel_ChainA_alpha_numerator_denominator.cu | 84 ++ ...ernel_ChainA_alpha_numerator_denominator.h | 15 + .../kernel_ChainA_cyclic_reduction_down.cu | 268 ++++ .../kernel_ChainA_cyclic_reduction_down.h | 15 + ...ernel_ChainA_cyclic_reduction_solve_two.cu | 199 +++ ...kernel_ChainA_cyclic_reduction_solve_two.h | 15 + .../kernel_ChainA_cyclic_reduction_up.cu | 107 ++ .../kernel_ChainA_cyclic_reduction_up.h | 15 + .../kernel_ChainA_normalize.cu | 92 ++ .../kernel_ChainA_normalize.h | 14 + .../kernel_ChainA_pred_decrease_times_two.cu | 86 ++ .../kernel_ChainA_pred_decrease_times_two.h | 16 + .../kernel_ChainA_retract.cu | 56 + .../kernel_ChainA_retract.h | 13 + .../kernel_ChainA_start_w.cu | 78 + .../kernel_ChainA_start_w.h | 13 + .../kernel_ChainA_start_w_contribute.cu | 80 + .../kernel_ChainA_start_w_contribute.h | 14 + .../kernel_ChainA_tridig_make_eq.cu | 109 ++ .../kernel_ChainA_tridig_make_eq.h | 16 + .../kernel_ChainA_update_Mp.cu | 81 ++ .../kernel_ChainA_update_Mp.h | 14 + .../kernel_ChainA_update_p.cu | 77 + .../kernel_ChainA_update_p.h | 14 + .../kernel_ChainA_update_r.cu | 83 ++ .../kernel_ChainA_update_r.h | 14 + .../kernel_ChainA_update_r_first.cu | 95 ++ .../kernel_ChainA_update_r_first.h | 15 + .../kernel_ChainA_update_step.cu | 77 + .../kernel_ChainA_update_step.h | 14 + .../kernel_ChainA_update_step_first.cu | 73 + .../kernel_ChainA_update_step_first.h | 13 + ...inB_alpha_denominator_or_beta_numerator.cu | 77 + ...ainB_alpha_denominator_or_beta_numerator.h | 14 + ...rnel_ChainB_alpha_numerator_denominator.cu | 91 ++ ...ernel_ChainB_alpha_numerator_denominator.h | 15 + .../kernel_ChainB_cyclic_reduction_down.cu | 633 ++++++++ .../kernel_ChainB_cyclic_reduction_down.h | 15 + ...ernel_ChainB_cyclic_reduction_solve_two.cu | 438 ++++++ ...kernel_ChainB_cyclic_reduction_solve_two.h | 15 + .../kernel_ChainB_cyclic_reduction_up.cu | 155 ++ .../kernel_ChainB_cyclic_reduction_up.h | 15 + .../kernel_ChainB_normalize.cu | 111 ++ .../kernel_ChainB_normalize.h | 14 + .../kernel_ChainB_pred_decrease_times_two.cu | 95 ++ .../kernel_ChainB_pred_decrease_times_two.h | 16 + .../kernel_ChainB_retract.cu | 61 + .../kernel_ChainB_retract.h | 13 + .../kernel_ChainB_start_w.cu | 85 ++ .../kernel_ChainB_start_w.h | 13 + .../kernel_ChainB_start_w_contribute.cu | 87 ++ .../kernel_ChainB_start_w_contribute.h | 14 + .../kernel_ChainB_tridig_make_eq.cu | 158 ++ .../kernel_ChainB_tridig_make_eq.h | 16 + .../kernel_ChainB_update_Mp.cu | 90 ++ .../kernel_ChainB_update_Mp.h | 14 + .../kernel_ChainB_update_p.cu | 83 ++ .../kernel_ChainB_update_p.h | 14 + .../kernel_ChainB_update_r.cu | 90 ++ .../kernel_ChainB_update_r.h | 14 + .../kernel_ChainB_update_r_first.cu | 103 ++ .../kernel_ChainB_update_r_first.h | 15 + .../kernel_ChainB_update_step.cu | 84 ++ .../kernel_ChainB_update_step.h | 14 + .../kernel_ChainB_update_step_first.cu | 78 + .../kernel_ChainB_update_step_first.h | 13 + .../kernel_chain_a_link_jtjnjtr_direct.cu | 53 + .../kernel_chain_a_link_jtjnjtr_direct.h | 15 + .../kernel_chain_a_link_res_jac.cu | 125 ++ .../kernel_chain_a_link_res_jac.h | 17 + .../kernel_chain_a_link_res_jac_first.cu | 132 ++ .../kernel_chain_a_link_res_jac_first.h | 17 + .../kernel_chain_a_link_score.cu | 83 ++ .../kernel_chain_a_link_score.h | 13 + .../kernel_chain_a_prior_jtjnjtr_direct.cu | 51 + .../kernel_chain_a_prior_jtjnjtr_direct.h | 14 + .../kernel_chain_a_prior_res_jac.cu | 97 ++ .../kernel_chain_a_prior_res_jac.h | 16 + .../kernel_chain_a_prior_res_jac_first.cu | 107 ++ .../kernel_chain_a_prior_res_jac_first.h | 18 + .../kernel_chain_a_prior_score.cu | 79 + .../kernel_chain_a_prior_score.h | 12 + .../kernel_chain_b_link_jtjnjtr_direct.cu | 53 + .../kernel_chain_b_link_jtjnjtr_direct.h | 15 + .../kernel_chain_b_link_res_jac.cu | 207 +++ .../kernel_chain_b_link_res_jac.h | 17 + .../kernel_chain_b_link_res_jac_first.cu | 215 +++ .../kernel_chain_b_link_res_jac_first.h | 17 + .../kernel_chain_b_link_score.cu | 102 ++ .../kernel_chain_b_link_score.h | 13 + .../kernel_chain_b_prior_jtjnjtr_direct.cu | 51 + .../kernel_chain_b_prior_jtjnjtr_direct.h | 14 + .../kernel_chain_b_prior_res_jac.cu | 118 ++ .../kernel_chain_b_prior_res_jac.h | 16 + .../kernel_chain_b_prior_res_jac_first.cu | 129 ++ .../kernel_chain_b_prior_res_jac_first.h | 18 + .../kernel_chain_b_prior_score.cu | 89 ++ .../kernel_chain_b_prior_score.h | 12 + .../kernel_chain_coupling_jtjnjtr_direct.cu | 124 ++ .../kernel_chain_coupling_jtjnjtr_direct.h | 18 + .../kernel_chain_coupling_res_jac.cu | 192 +++ .../kernel_chain_coupling_res_jac.h | 21 + .../kernel_chain_coupling_res_jac_first.cu | 199 +++ .../kernel_chain_coupling_res_jac_first.h | 21 + .../kernel_chain_coupling_score.cu | 117 ++ .../kernel_chain_coupling_score.h | 14 + .../solver.cc | 1284 +++++++++++++++++ .../symforce_caspar_tridiagonal_test/solver.h | 532 +++++++ 116 files changed, 10212 insertions(+), 64 deletions(-) create mode 100644 test/caspar_tridiagonal_cuda_test.cc create mode 100644 test/symforce_function_codegen_test_data/symengine/symforce_caspar_tridiagonal_test/caspar_mappings.cu create mode 100644 test/symforce_function_codegen_test_data/symengine/symforce_caspar_tridiagonal_test/caspar_mappings.h create mode 100644 test/symforce_function_codegen_test_data/symengine/symforce_caspar_tridiagonal_test/kernel_ChainA_alpha_denominator_or_beta_numerator.cu create mode 100644 test/symforce_function_codegen_test_data/symengine/symforce_caspar_tridiagonal_test/kernel_ChainA_alpha_denominator_or_beta_numerator.h create mode 100644 test/symforce_function_codegen_test_data/symengine/symforce_caspar_tridiagonal_test/kernel_ChainA_alpha_numerator_denominator.cu create mode 100644 test/symforce_function_codegen_test_data/symengine/symforce_caspar_tridiagonal_test/kernel_ChainA_alpha_numerator_denominator.h create mode 100644 test/symforce_function_codegen_test_data/symengine/symforce_caspar_tridiagonal_test/kernel_ChainA_cyclic_reduction_down.cu create mode 100644 test/symforce_function_codegen_test_data/symengine/symforce_caspar_tridiagonal_test/kernel_ChainA_cyclic_reduction_down.h create mode 100644 test/symforce_function_codegen_test_data/symengine/symforce_caspar_tridiagonal_test/kernel_ChainA_cyclic_reduction_solve_two.cu create mode 100644 test/symforce_function_codegen_test_data/symengine/symforce_caspar_tridiagonal_test/kernel_ChainA_cyclic_reduction_solve_two.h create mode 100644 test/symforce_function_codegen_test_data/symengine/symforce_caspar_tridiagonal_test/kernel_ChainA_cyclic_reduction_up.cu create mode 100644 test/symforce_function_codegen_test_data/symengine/symforce_caspar_tridiagonal_test/kernel_ChainA_cyclic_reduction_up.h create mode 100644 test/symforce_function_codegen_test_data/symengine/symforce_caspar_tridiagonal_test/kernel_ChainA_normalize.cu create mode 100644 test/symforce_function_codegen_test_data/symengine/symforce_caspar_tridiagonal_test/kernel_ChainA_normalize.h create mode 100644 test/symforce_function_codegen_test_data/symengine/symforce_caspar_tridiagonal_test/kernel_ChainA_pred_decrease_times_two.cu create mode 100644 test/symforce_function_codegen_test_data/symengine/symforce_caspar_tridiagonal_test/kernel_ChainA_pred_decrease_times_two.h create mode 100644 test/symforce_function_codegen_test_data/symengine/symforce_caspar_tridiagonal_test/kernel_ChainA_retract.cu create mode 100644 test/symforce_function_codegen_test_data/symengine/symforce_caspar_tridiagonal_test/kernel_ChainA_retract.h create mode 100644 test/symforce_function_codegen_test_data/symengine/symforce_caspar_tridiagonal_test/kernel_ChainA_start_w.cu create mode 100644 test/symforce_function_codegen_test_data/symengine/symforce_caspar_tridiagonal_test/kernel_ChainA_start_w.h create mode 100644 test/symforce_function_codegen_test_data/symengine/symforce_caspar_tridiagonal_test/kernel_ChainA_start_w_contribute.cu create mode 100644 test/symforce_function_codegen_test_data/symengine/symforce_caspar_tridiagonal_test/kernel_ChainA_start_w_contribute.h create mode 100644 test/symforce_function_codegen_test_data/symengine/symforce_caspar_tridiagonal_test/kernel_ChainA_tridig_make_eq.cu create mode 100644 test/symforce_function_codegen_test_data/symengine/symforce_caspar_tridiagonal_test/kernel_ChainA_tridig_make_eq.h create mode 100644 test/symforce_function_codegen_test_data/symengine/symforce_caspar_tridiagonal_test/kernel_ChainA_update_Mp.cu create mode 100644 test/symforce_function_codegen_test_data/symengine/symforce_caspar_tridiagonal_test/kernel_ChainA_update_Mp.h create mode 100644 test/symforce_function_codegen_test_data/symengine/symforce_caspar_tridiagonal_test/kernel_ChainA_update_p.cu create mode 100644 test/symforce_function_codegen_test_data/symengine/symforce_caspar_tridiagonal_test/kernel_ChainA_update_p.h create mode 100644 test/symforce_function_codegen_test_data/symengine/symforce_caspar_tridiagonal_test/kernel_ChainA_update_r.cu create mode 100644 test/symforce_function_codegen_test_data/symengine/symforce_caspar_tridiagonal_test/kernel_ChainA_update_r.h create mode 100644 test/symforce_function_codegen_test_data/symengine/symforce_caspar_tridiagonal_test/kernel_ChainA_update_r_first.cu create mode 100644 test/symforce_function_codegen_test_data/symengine/symforce_caspar_tridiagonal_test/kernel_ChainA_update_r_first.h create mode 100644 test/symforce_function_codegen_test_data/symengine/symforce_caspar_tridiagonal_test/kernel_ChainA_update_step.cu create mode 100644 test/symforce_function_codegen_test_data/symengine/symforce_caspar_tridiagonal_test/kernel_ChainA_update_step.h create mode 100644 test/symforce_function_codegen_test_data/symengine/symforce_caspar_tridiagonal_test/kernel_ChainA_update_step_first.cu create mode 100644 test/symforce_function_codegen_test_data/symengine/symforce_caspar_tridiagonal_test/kernel_ChainA_update_step_first.h create mode 100644 test/symforce_function_codegen_test_data/symengine/symforce_caspar_tridiagonal_test/kernel_ChainB_alpha_denominator_or_beta_numerator.cu create mode 100644 test/symforce_function_codegen_test_data/symengine/symforce_caspar_tridiagonal_test/kernel_ChainB_alpha_denominator_or_beta_numerator.h create mode 100644 test/symforce_function_codegen_test_data/symengine/symforce_caspar_tridiagonal_test/kernel_ChainB_alpha_numerator_denominator.cu create mode 100644 test/symforce_function_codegen_test_data/symengine/symforce_caspar_tridiagonal_test/kernel_ChainB_alpha_numerator_denominator.h create mode 100644 test/symforce_function_codegen_test_data/symengine/symforce_caspar_tridiagonal_test/kernel_ChainB_cyclic_reduction_down.cu create mode 100644 test/symforce_function_codegen_test_data/symengine/symforce_caspar_tridiagonal_test/kernel_ChainB_cyclic_reduction_down.h create mode 100644 test/symforce_function_codegen_test_data/symengine/symforce_caspar_tridiagonal_test/kernel_ChainB_cyclic_reduction_solve_two.cu create mode 100644 test/symforce_function_codegen_test_data/symengine/symforce_caspar_tridiagonal_test/kernel_ChainB_cyclic_reduction_solve_two.h create mode 100644 test/symforce_function_codegen_test_data/symengine/symforce_caspar_tridiagonal_test/kernel_ChainB_cyclic_reduction_up.cu create mode 100644 test/symforce_function_codegen_test_data/symengine/symforce_caspar_tridiagonal_test/kernel_ChainB_cyclic_reduction_up.h create mode 100644 test/symforce_function_codegen_test_data/symengine/symforce_caspar_tridiagonal_test/kernel_ChainB_normalize.cu create mode 100644 test/symforce_function_codegen_test_data/symengine/symforce_caspar_tridiagonal_test/kernel_ChainB_normalize.h create mode 100644 test/symforce_function_codegen_test_data/symengine/symforce_caspar_tridiagonal_test/kernel_ChainB_pred_decrease_times_two.cu create mode 100644 test/symforce_function_codegen_test_data/symengine/symforce_caspar_tridiagonal_test/kernel_ChainB_pred_decrease_times_two.h create mode 100644 test/symforce_function_codegen_test_data/symengine/symforce_caspar_tridiagonal_test/kernel_ChainB_retract.cu create mode 100644 test/symforce_function_codegen_test_data/symengine/symforce_caspar_tridiagonal_test/kernel_ChainB_retract.h create mode 100644 test/symforce_function_codegen_test_data/symengine/symforce_caspar_tridiagonal_test/kernel_ChainB_start_w.cu create mode 100644 test/symforce_function_codegen_test_data/symengine/symforce_caspar_tridiagonal_test/kernel_ChainB_start_w.h create mode 100644 test/symforce_function_codegen_test_data/symengine/symforce_caspar_tridiagonal_test/kernel_ChainB_start_w_contribute.cu create mode 100644 test/symforce_function_codegen_test_data/symengine/symforce_caspar_tridiagonal_test/kernel_ChainB_start_w_contribute.h create mode 100644 test/symforce_function_codegen_test_data/symengine/symforce_caspar_tridiagonal_test/kernel_ChainB_tridig_make_eq.cu create mode 100644 test/symforce_function_codegen_test_data/symengine/symforce_caspar_tridiagonal_test/kernel_ChainB_tridig_make_eq.h create mode 100644 test/symforce_function_codegen_test_data/symengine/symforce_caspar_tridiagonal_test/kernel_ChainB_update_Mp.cu create mode 100644 test/symforce_function_codegen_test_data/symengine/symforce_caspar_tridiagonal_test/kernel_ChainB_update_Mp.h create mode 100644 test/symforce_function_codegen_test_data/symengine/symforce_caspar_tridiagonal_test/kernel_ChainB_update_p.cu create mode 100644 test/symforce_function_codegen_test_data/symengine/symforce_caspar_tridiagonal_test/kernel_ChainB_update_p.h create mode 100644 test/symforce_function_codegen_test_data/symengine/symforce_caspar_tridiagonal_test/kernel_ChainB_update_r.cu create mode 100644 test/symforce_function_codegen_test_data/symengine/symforce_caspar_tridiagonal_test/kernel_ChainB_update_r.h create mode 100644 test/symforce_function_codegen_test_data/symengine/symforce_caspar_tridiagonal_test/kernel_ChainB_update_r_first.cu create mode 100644 test/symforce_function_codegen_test_data/symengine/symforce_caspar_tridiagonal_test/kernel_ChainB_update_r_first.h create mode 100644 test/symforce_function_codegen_test_data/symengine/symforce_caspar_tridiagonal_test/kernel_ChainB_update_step.cu create mode 100644 test/symforce_function_codegen_test_data/symengine/symforce_caspar_tridiagonal_test/kernel_ChainB_update_step.h create mode 100644 test/symforce_function_codegen_test_data/symengine/symforce_caspar_tridiagonal_test/kernel_ChainB_update_step_first.cu create mode 100644 test/symforce_function_codegen_test_data/symengine/symforce_caspar_tridiagonal_test/kernel_ChainB_update_step_first.h create mode 100644 test/symforce_function_codegen_test_data/symengine/symforce_caspar_tridiagonal_test/kernel_chain_a_link_jtjnjtr_direct.cu create mode 100644 test/symforce_function_codegen_test_data/symengine/symforce_caspar_tridiagonal_test/kernel_chain_a_link_jtjnjtr_direct.h create mode 100644 test/symforce_function_codegen_test_data/symengine/symforce_caspar_tridiagonal_test/kernel_chain_a_link_res_jac.cu create mode 100644 test/symforce_function_codegen_test_data/symengine/symforce_caspar_tridiagonal_test/kernel_chain_a_link_res_jac.h create mode 100644 test/symforce_function_codegen_test_data/symengine/symforce_caspar_tridiagonal_test/kernel_chain_a_link_res_jac_first.cu create mode 100644 test/symforce_function_codegen_test_data/symengine/symforce_caspar_tridiagonal_test/kernel_chain_a_link_res_jac_first.h create mode 100644 test/symforce_function_codegen_test_data/symengine/symforce_caspar_tridiagonal_test/kernel_chain_a_link_score.cu create mode 100644 test/symforce_function_codegen_test_data/symengine/symforce_caspar_tridiagonal_test/kernel_chain_a_link_score.h create mode 100644 test/symforce_function_codegen_test_data/symengine/symforce_caspar_tridiagonal_test/kernel_chain_a_prior_jtjnjtr_direct.cu create mode 100644 test/symforce_function_codegen_test_data/symengine/symforce_caspar_tridiagonal_test/kernel_chain_a_prior_jtjnjtr_direct.h create mode 100644 test/symforce_function_codegen_test_data/symengine/symforce_caspar_tridiagonal_test/kernel_chain_a_prior_res_jac.cu create mode 100644 test/symforce_function_codegen_test_data/symengine/symforce_caspar_tridiagonal_test/kernel_chain_a_prior_res_jac.h create mode 100644 test/symforce_function_codegen_test_data/symengine/symforce_caspar_tridiagonal_test/kernel_chain_a_prior_res_jac_first.cu create mode 100644 test/symforce_function_codegen_test_data/symengine/symforce_caspar_tridiagonal_test/kernel_chain_a_prior_res_jac_first.h create mode 100644 test/symforce_function_codegen_test_data/symengine/symforce_caspar_tridiagonal_test/kernel_chain_a_prior_score.cu create mode 100644 test/symforce_function_codegen_test_data/symengine/symforce_caspar_tridiagonal_test/kernel_chain_a_prior_score.h create mode 100644 test/symforce_function_codegen_test_data/symengine/symforce_caspar_tridiagonal_test/kernel_chain_b_link_jtjnjtr_direct.cu create mode 100644 test/symforce_function_codegen_test_data/symengine/symforce_caspar_tridiagonal_test/kernel_chain_b_link_jtjnjtr_direct.h create mode 100644 test/symforce_function_codegen_test_data/symengine/symforce_caspar_tridiagonal_test/kernel_chain_b_link_res_jac.cu create mode 100644 test/symforce_function_codegen_test_data/symengine/symforce_caspar_tridiagonal_test/kernel_chain_b_link_res_jac.h create mode 100644 test/symforce_function_codegen_test_data/symengine/symforce_caspar_tridiagonal_test/kernel_chain_b_link_res_jac_first.cu create mode 100644 test/symforce_function_codegen_test_data/symengine/symforce_caspar_tridiagonal_test/kernel_chain_b_link_res_jac_first.h create mode 100644 test/symforce_function_codegen_test_data/symengine/symforce_caspar_tridiagonal_test/kernel_chain_b_link_score.cu create mode 100644 test/symforce_function_codegen_test_data/symengine/symforce_caspar_tridiagonal_test/kernel_chain_b_link_score.h create mode 100644 test/symforce_function_codegen_test_data/symengine/symforce_caspar_tridiagonal_test/kernel_chain_b_prior_jtjnjtr_direct.cu create mode 100644 test/symforce_function_codegen_test_data/symengine/symforce_caspar_tridiagonal_test/kernel_chain_b_prior_jtjnjtr_direct.h create mode 100644 test/symforce_function_codegen_test_data/symengine/symforce_caspar_tridiagonal_test/kernel_chain_b_prior_res_jac.cu create mode 100644 test/symforce_function_codegen_test_data/symengine/symforce_caspar_tridiagonal_test/kernel_chain_b_prior_res_jac.h create mode 100644 test/symforce_function_codegen_test_data/symengine/symforce_caspar_tridiagonal_test/kernel_chain_b_prior_res_jac_first.cu create mode 100644 test/symforce_function_codegen_test_data/symengine/symforce_caspar_tridiagonal_test/kernel_chain_b_prior_res_jac_first.h create mode 100644 test/symforce_function_codegen_test_data/symengine/symforce_caspar_tridiagonal_test/kernel_chain_b_prior_score.cu create mode 100644 test/symforce_function_codegen_test_data/symengine/symforce_caspar_tridiagonal_test/kernel_chain_b_prior_score.h create mode 100644 test/symforce_function_codegen_test_data/symengine/symforce_caspar_tridiagonal_test/kernel_chain_coupling_jtjnjtr_direct.cu create mode 100644 test/symforce_function_codegen_test_data/symengine/symforce_caspar_tridiagonal_test/kernel_chain_coupling_jtjnjtr_direct.h create mode 100644 test/symforce_function_codegen_test_data/symengine/symforce_caspar_tridiagonal_test/kernel_chain_coupling_res_jac.cu create mode 100644 test/symforce_function_codegen_test_data/symengine/symforce_caspar_tridiagonal_test/kernel_chain_coupling_res_jac.h create mode 100644 test/symforce_function_codegen_test_data/symengine/symforce_caspar_tridiagonal_test/kernel_chain_coupling_res_jac_first.cu create mode 100644 test/symforce_function_codegen_test_data/symengine/symforce_caspar_tridiagonal_test/kernel_chain_coupling_res_jac_first.h create mode 100644 test/symforce_function_codegen_test_data/symengine/symforce_caspar_tridiagonal_test/kernel_chain_coupling_score.cu create mode 100644 test/symforce_function_codegen_test_data/symengine/symforce_caspar_tridiagonal_test/kernel_chain_coupling_score.h create mode 100644 test/symforce_function_codegen_test_data/symengine/symforce_caspar_tridiagonal_test/solver.cc create mode 100644 test/symforce_function_codegen_test_data/symengine/symforce_caspar_tridiagonal_test/solver.h diff --git a/symforce/caspar/source/templates/solver.cc.jinja b/symforce/caspar/source/templates/solver.cc.jinja index dd02e567..9d15f5c5 100644 --- a/symforce/caspar/source/templates/solver.cc.jinja +++ b/symforce/caspar/source/templates/solver.cc.jinja @@ -364,6 +364,18 @@ void {{ solver.struct_name }}::DoNormalize() { {{num_key(nodetype)}} ); {% else %} + if ({{num_key(nodetype)}} < 2) { + // Without a second node there are no off-diagonal blocks, and the cyclic reduction would + // write a second node's solution. + {{nodetype.__name__}}Normalize( + {{node_key(nodetype, "precond_diag")}}, {{num_key(nodetype)}}, + {{node_key(nodetype, "precond_tril")}}, {{num_key(nodetype)}}, + {{node_key(nodetype, "r_k")}}, {{num_key(nodetype)}}, + {{solver_key("current_diag")}}, + z, {{num_key(nodetype)}}, + {{num_key(nodetype)}} + ); + } else { Zero(z, pcg_iter_ == 0 ? {{node_key(nodetype, "p_end_")}} : {{node_key(nodetype, "z_end_")}}); {{nodetype.__name__}}TridigMakeEq( {{node_key(nodetype, "precond_diag")}}, {{num_key(nodetype)}}, @@ -393,9 +405,9 @@ void {{ solver.struct_name }}::DoNormalize() { i--; {{nodetype.__name__}}CyclicReductionSolveTwo( - {{node_key(nodetype, "tridig_eq")}}, {{num_key(nodetype)}}, offset, (2<_cuda_test.cc runs the code generated into symforce_caspar__test, + # except caspar_padding_lane_cuda_test, whose kernel symforce_caspar_codegen_test generates + # into its own directory. + set(caspar_padding_lane_cuda_test_DATA_DIR symforce_caspar_codegen_test) - set(CASPAR_SOLVER_DIR - ${CMAKE_CURRENT_SOURCE_DIR}/symforce_function_codegen_test_data/symengine/symforce_caspar_solver_test - ) - file(GLOB CASPAR_SOLVER_SOURCES CONFIGURE_DEPENDS - ${CASPAR_SOLVER_DIR}/*.cu - ${CASPAR_SOLVER_DIR}/*.cc - ) + foreach(SOURCE_FILE ${SYMFORCE_CUDA_TEST_CC_SOURCES}) + get_filename_component(TEST_NAME ${SOURCE_FILE} NAME_WE) + set(BINARY_NAME tests/${TEST_NAME}) + set(TARGET_NAME bin.tests.${TEST_NAME}) + + if(DEFINED ${TEST_NAME}_DATA_DIR) + set(DATA_DIR ${CASPAR_TEST_DATA_DIR}/${${TEST_NAME}_DATA_DIR}) + else() + string(REGEX REPLACE "_cuda_test$" "_test" DATA_DIR_NAME ${TEST_NAME}) + set(DATA_DIR ${CASPAR_TEST_DATA_DIR}/symforce_${DATA_DIR_NAME}) + endif() + file(GLOB DATA_SOURCES CONFIGURE_DEPENDS ${DATA_DIR}/*.cu ${DATA_DIR}/*.cc) + + add_executable(${TARGET_NAME} ${SOURCE_FILE} ${DATA_SOURCES}) + set_target_properties(${TARGET_NAME} PROPERTIES + CUDA_ARCHITECTURES 75 + OUTPUT_NAME ${BINARY_NAME} + TEST_NAME ${TEST_NAME} + RUNTIME_OUTPUT_DIRECTORY ${CMAKE_BINARY_DIR}/bin + ) + # The parent too, for includes like "symforce_caspar_tridiagonal_test/solver.h": a bare + # "solver.h" is ambiguous between the generated solvers. + target_include_directories(${TARGET_NAME} PRIVATE ${DATA_DIR} ${CASPAR_TEST_DATA_DIR}) + target_link_libraries(${TARGET_NAME} + Catch2::Catch2WithMain + caspar_test_runtime + ${SYMFORCE_EIGEN_TARGET} + ) - add_executable( - bin.tests.caspar_solver_cuda_test - caspar_solver_cuda_test.cc - ${CASPAR_SOLVER_SOURCES} - ${CASPAR_RUNTIME_DIR}/shared_indices.cu - ${CASPAR_RUNTIME_DIR}/sort_indices.cu - ${CASPAR_RUNTIME_DIR}/solver_tools.cu - ) - set_target_properties(bin.tests.caspar_solver_cuda_test PROPERTIES - CUDA_ARCHITECTURES 75 - OUTPUT_NAME tests/caspar_solver_cuda_test - TEST_NAME caspar_solver_cuda_test - RUNTIME_OUTPUT_DIRECTORY ${CMAKE_BINARY_DIR}/bin - ) - target_include_directories(bin.tests.caspar_solver_cuda_test PRIVATE - ${CASPAR_SOLVER_DIR} - ${CASPAR_RUNTIME_DIR} - ) - target_link_libraries(bin.tests.caspar_solver_cuda_test Catch2::Catch2WithMain CUDA::cudart) + list(APPEND SYMFORCE_CC_TEST_TARGETS ${TARGET_NAME}) - list(APPEND SYMFORCE_CC_TEST_TARGETS bin.tests.caspar_solver_cuda_test) - add_test(caspar_solver_cuda_test ${CMAKE_BINARY_DIR}/bin/tests/caspar_solver_cuda_test) + add_test(${TEST_NAME} ${CMAKE_BINARY_DIR}/bin/${BINARY_NAME}) + endforeach() endif() if(SYMFORCE_ADD_PYTHON_TESTS) diff --git a/test/caspar_tridiagonal_cuda_test.cc b/test/caspar_tridiagonal_cuda_test.cc new file mode 100644 index 00000000..0f303918 --- /dev/null +++ b/test/caspar_tridiagonal_cuda_test.cc @@ -0,0 +1,225 @@ +/* ---------------------------------------------------------------------------- + * SymForce - Copyright 2025, Skydio, Inc. + * This source code is under the Apache 2.0 license found in the LICENSE file. + * ---------------------------------------------------------------------------- */ + +#include +#include + +#include +#include +#include +#include +#include + +#include "symforce_caspar_tridiagonal_test/solver.h" + +namespace { + +bool HaveDevice() { + int count = 0; + return cudaGetDeviceCount(&count) == cudaSuccess && count > 0; +} + +// The linear problem of the generated library: chains of ChainA (2D) and ChainB (3D) nodes, each +// node with a prior, consecutive nodes linked by a weighted difference, and optional couplings +// between an A node and a B node. +struct Problem { + int num_a = 0; + int num_b = 0; + std::vector a_link_weight; + std::vector a_link_offset; + std::vector a_target; + std::vector b_link_weight; + std::vector b_link_offset; + std::vector b_target; + std::vector coupling_a; + std::vector coupling_b; + std::vector> coupling_weight; + std::vector coupling_offset; + Eigen::VectorXd initial; // [a_0, ..., a_{num_a - 1}, b_0, ..., b_{num_b - 1}] +}; + +Problem MakeProblem(const int num_a, const int num_b, const int num_couplings, + const unsigned int seed) { + std::mt19937 rng(seed); + std::uniform_real_distribution uniform(-1.0, 1.0); + const auto random = [&](auto matrix) { + for (int i = 0; i < matrix.size(); i++) { + matrix.data()[i] = uniform(rng); + } + return matrix; + }; + + Problem problem; + problem.num_a = num_a; + problem.num_b = num_b; + for (int i = 0; i + 1 < num_a; i++) { + problem.a_link_weight.push_back(Eigen::Matrix2d::Identity() * 3.0 + random(Eigen::Matrix2d())); + problem.a_link_offset.push_back(random(Eigen::Vector2d())); + } + for (int i = 0; i < num_a; i++) { + problem.a_target.push_back(random(Eigen::Vector2d())); + } + for (int i = 0; i + 1 < num_b; i++) { + problem.b_link_weight.push_back(Eigen::Matrix3d::Identity() * 3.0 + random(Eigen::Matrix3d())); + problem.b_link_offset.push_back(random(Eigen::Vector3d())); + } + for (int i = 0; i < num_b; i++) { + problem.b_target.push_back(random(Eigen::Vector3d())); + } + for (int i = 0; i < num_couplings; i++) { + problem.coupling_a.push_back(static_cast(rng() % num_a)); + problem.coupling_b.push_back(static_cast(rng() % num_b)); + problem.coupling_weight.push_back(random(Eigen::Matrix()) * 2.0); + problem.coupling_offset.push_back(random(Eigen::Vector2d())); + } + problem.initial = random(Eigen::VectorXd(2 * num_a + 3 * num_b)) * 5.0; + return problem; +} + +// The minimizer of the sum of squared residuals, from a dense solve of J^T J x = J^T c, where the +// residuals are J x - c. +Eigen::VectorXd DenseSolution(const Problem& problem) { + const int num_rows = 2 * (problem.num_a - 1) + 2 * problem.num_a + 3 * (problem.num_b - 1) + + 3 * problem.num_b + 2 * static_cast(problem.coupling_a.size()); + const int num_cols = 2 * problem.num_a + 3 * problem.num_b; + const int b_col = 2 * problem.num_a; + Eigen::MatrixXd jacobian = Eigen::MatrixXd::Zero(num_rows, num_cols); + Eigen::VectorXd constant = Eigen::VectorXd::Zero(num_rows); + int row = 0; + for (int i = 0; i + 1 < problem.num_a; i++, row += 2) { + jacobian.block<2, 2>(row, 2 * i) = -problem.a_link_weight[i]; + jacobian.block<2, 2>(row, 2 * i + 2) = problem.a_link_weight[i]; + constant.segment<2>(row) = problem.a_link_offset[i]; + } + for (int i = 0; i < problem.num_a; i++, row += 2) { + jacobian.block<2, 2>(row, 2 * i).setIdentity(); + constant.segment<2>(row) = problem.a_target[i]; + } + for (int i = 0; i + 1 < problem.num_b; i++, row += 3) { + jacobian.block<3, 3>(row, b_col + 3 * i) = -problem.b_link_weight[i]; + jacobian.block<3, 3>(row, b_col + 3 * i + 3) = problem.b_link_weight[i]; + constant.segment<3>(row) = problem.b_link_offset[i]; + } + for (int i = 0; i < problem.num_b; i++, row += 3) { + jacobian.block<3, 3>(row, b_col + 3 * i).setIdentity(); + constant.segment<3>(row) = problem.b_target[i]; + } + for (size_t i = 0; i < problem.coupling_a.size(); i++, row += 2) { + jacobian.block<2, 2>(row, 2 * problem.coupling_a[i]).setIdentity(); + jacobian.block<2, 3>(row, b_col + 3 * problem.coupling_b[i]) = -problem.coupling_weight[i]; + constant.segment<2>(row) = problem.coupling_offset[i]; + } + return (jacobian.transpose() * jacobian).ldlt().solve(jacobian.transpose() * constant); +} + +template +std::vector Stacked(const std::vector& matrices) { + std::vector stacked; + for (const Matrix& matrix : matrices) { + stacked.insert(stacked.end(), matrix.data(), matrix.data() + matrix.size()); + } + return stacked; +} + +std::vector Range(const int num) { + std::vector range(num); + for (int i = 0; i < num; i++) { + range[i] = static_cast(i); + } + return range; +} + +struct Solve { + caspar::SolveResult result; + Eigen::VectorXd x; +}; + +Solve Run(const Problem& problem, const caspar::SolverParams& params) { + const int num_a = problem.num_a; + const int num_b = problem.num_b; + const int num_couplings = static_cast(problem.coupling_a.size()); + caspar::GraphSolver solver(params, num_a, num_b, num_a - 1, num_a, num_b - 1, num_b, + num_couplings); + + solver.SetChainANodesFromStackedHost(problem.initial.data(), 0, num_a); + solver.SetChainBNodesFromStackedHost(problem.initial.data() + 2 * num_a, 0, num_b); + if (num_a > 1) { + solver.SetChainALinkWeightDataFromStackedHost(Stacked(problem.a_link_weight).data(), 0, + num_a - 1); + solver.SetChainALinkOffsetDataFromStackedHost(Stacked(problem.a_link_offset).data(), 0, + num_a - 1); + } + solver.SetChainAPriorAIndicesFromHost(Range(num_a).data(), num_a); + solver.SetChainAPriorTargetDataFromStackedHost(Stacked(problem.a_target).data(), 0, num_a); + if (num_b > 1) { + solver.SetChainBLinkWeightDataFromStackedHost(Stacked(problem.b_link_weight).data(), 0, + num_b - 1); + solver.SetChainBLinkOffsetDataFromStackedHost(Stacked(problem.b_link_offset).data(), 0, + num_b - 1); + } + solver.SetChainBPriorBIndicesFromHost(Range(num_b).data(), num_b); + solver.SetChainBPriorTargetDataFromStackedHost(Stacked(problem.b_target).data(), 0, num_b); + if (num_couplings > 0) { + solver.SetChainCouplingAIndicesFromHost(problem.coupling_a.data(), num_couplings); + solver.SetChainCouplingBIndicesFromHost(problem.coupling_b.data(), num_couplings); + solver.SetChainCouplingWeightDataFromStackedHost(Stacked(problem.coupling_weight).data(), 0, + num_couplings); + solver.SetChainCouplingOffsetDataFromStackedHost(Stacked(problem.coupling_offset).data(), 0, + num_couplings); + } + solver.finish_indices(); + + Solve solve; + solve.result = solver.solve(/* print_progress */ false, /* verbose_logging */ true); + solve.x.resize(2 * num_a + 3 * num_b); + solver.GetChainANodesToStackedHost(solve.x.data(), 0, num_a); + solver.GetChainBNodesToStackedHost(solve.x.data() + 2 * num_a, 0, num_b); + return solve; +} + +caspar::SolverParams Params(const int solver_iter_max) { + caspar::SolverParams params; + params.solver_iter_max = solver_iter_max; + params.pcg_iter_max = 200; + params.pcg_rel_error_exit = 1e-24; + params.diag_init = 1e-12; + return params; +} + +} // namespace + +TEST_CASE("Uncoupled chains are solved exactly by one preconditioned CG iteration", + "[caspar_tridiagonal_cuda_test]") { + REQUIRE(HaveDevice()); + const int num_a = GENERATE(1, 2, 3, 7, 8); + const int num_b = GENERATE(1, 2, 7, 8); + CAPTURE(num_a, num_b); + + const Problem problem = MakeProblem(num_a, num_b, /* num_couplings */ 0, num_a * 100 + num_b); + const Solve solve = Run(problem, Params(/* solver_iter_max */ 1)); + + REQUIRE(solve.result.iterations.size() == 1); + CHECK(solve.result.iterations[0].step_accepted); + // The block-tridiagonal preconditioner is the inverse of the damped normal matrix. + CHECK(solve.result.iterations[0].pcg_iter <= 1); + const Eigen::VectorXd expected = DenseSolution(problem); + CAPTURE(solve.x.transpose(), expected.transpose()); + CHECK((solve.x - expected).norm() < 1e-8 * (1.0 + expected.norm())); +} + +TEST_CASE("Coupled chains converge to the dense solution", "[caspar_tridiagonal_cuda_test]") { + REQUIRE(HaveDevice()); + const int num_a = GENERATE(1, 2, 3, 7, 8); + const int num_b = GENERATE(1, 2, 7, 8); + CAPTURE(num_a, num_b); + + const Problem problem = + MakeProblem(num_a, num_b, /* num_couplings */ num_a + num_b, num_a * 100 + num_b + 1); + const Solve solve = Run(problem, Params(/* solver_iter_max */ 5)); + + const Eigen::VectorXd expected = DenseSolution(problem); + CAPTURE(solve.x.transpose(), expected.transpose()); + CHECK((solve.x - expected).norm() < 1e-8 * (1.0 + expected.norm())); +} diff --git a/test/symforce_caspar_codegen_test.py b/test/symforce_caspar_codegen_test.py index 123bb3aa..e37a1a13 100644 --- a/test/symforce_caspar_codegen_test.py +++ b/test/symforce_caspar_codegen_test.py @@ -36,6 +36,14 @@ / "symforce_caspar_solver_test" ) +TRIDIAGONAL_TEST_DATA_DIR = ( + path_util.symforce_data_root(__file__) + / "test" + / "symforce_function_codegen_test_data" + / symforce.get_symbolic_api() + / "symforce_caspar_tridiagonal_test" +) + KERNEL_FILENAMES = ( "kernel_caspar_padding_lane_score.cu", "kernel_caspar_padding_lane_score.h", @@ -87,6 +95,83 @@ def rosenbrock( return caslib +class ChainA(sf.V2): + pass + + +class ChainB(sf.V3): + pass + + +def _make_tridiagonal_library() -> CasparLibrary: + """ + Two node types, each a chain linked by its own ``Pair`` factor so each gets a block-tridiagonal + preconditioner, plus a factor coupling the two types. Every residual is linear, so one exact + Gauss-Newton step reaches the optimum. + """ + caslib = CasparLibrary(dtype=DType.DOUBLE) + + @caslib.add_factor + def chain_a_link( + a: T.Annotated[mem.Pair[ChainA], mem.TunablePair], + weight: T.Annotated[sf.M22, mem.ConstantSequential], + offset: T.Annotated[sf.V2, mem.ConstantSequential], + ) -> sf.V2: + return sf.V2(weight * (a[1] - a[0]) - offset) + + @caslib.add_factor + def chain_a_prior( + a: T.Annotated[ChainA, mem.TunableShared], + target: T.Annotated[sf.V2, mem.ConstantSequential], + ) -> sf.V2: + return sf.V2(a - target) + + @caslib.add_factor + def chain_b_link( + b: T.Annotated[mem.Pair[ChainB], mem.TunablePair], + weight: T.Annotated[sf.M33, mem.ConstantSequential], + offset: T.Annotated[sf.V3, mem.ConstantSequential], + ) -> sf.V3: + return sf.V3(weight * (b[1] - b[0]) - offset) + + @caslib.add_factor + def chain_b_prior( + b: T.Annotated[ChainB, mem.TunableShared], + target: T.Annotated[sf.V3, mem.ConstantSequential], + ) -> sf.V3: + return sf.V3(b - target) + + @caslib.add_factor + def chain_coupling( + a: T.Annotated[ChainA, mem.TunableShared], + b: T.Annotated[ChainB, mem.TunableShared], + weight: T.Annotated[sf.M23, mem.ConstantSequential], + offset: T.Annotated[sf.V2, mem.ConstantSequential], + ) -> sf.V2: + return sf.V2(a - weight * b - offset) + + return caslib + + +def _generate_solver(caslib: CasparLibrary, output_dir: Path, data_dir: Path) -> Path: + """ + Generate ``caslib`` without Python bindings, formatted, keeping only the files generated for it. + """ + caslib.generate(output_dir, python_bindings=False) + + # The runtime is compiled from its own directory; check in only what was generated. + runtime_dir = Path(caspar.__file__).parent / "source" / "runtime" + generated_dir = output_dir / "generated" + generated_dir.mkdir() + for path in sorted(output_dir.glob("*")): + if path.suffix not in {".cu", ".cc", ".h", ".cuh"} or (runtime_dir / path.name).exists(): + continue + (generated_dir / path.name).write_text( + format_cpp(path.read_text(), str(data_dir / path.name)) + ) + return generated_dir + + class SymforceCasparCodegenTest(TestCase): """ Tests the CUDA kernels generated by caspar. @@ -115,24 +200,20 @@ def test_generate_solver(self) -> None: Keep the solver caspar_solver_cuda_test.cc runs up to date. """ output_dir = self.make_output_dir("sf_caspar_solver_") - _make_solver_library().generate(output_dir, python_bindings=False) - - # The runtime is compiled from its own directory; check in only what was generated. - runtime_dir = Path(caspar.__file__).parent / "source" / "runtime" - generated_dir = output_dir / "generated" - generated_dir.mkdir() - for path in sorted(output_dir.glob("*")): - if ( - path.suffix not in {".cu", ".cc", ".h", ".cuh"} - or (runtime_dir / path.name).exists() - ): - continue - (generated_dir / path.name).write_text( - format_cpp(path.read_text(), str(SOLVER_TEST_DATA_DIR / path.name)) - ) - + generated_dir = _generate_solver(_make_solver_library(), output_dir, SOLVER_TEST_DATA_DIR) self.compare_or_update_directory(generated_dir, SOLVER_TEST_DATA_DIR) + @symengine_only + def test_generate_tridiagonal_solver(self) -> None: + """ + Keep the solver caspar_tridiagonal_cuda_test.cc runs up to date. + """ + output_dir = self.make_output_dir("sf_caspar_tridiagonal_") + generated_dir = _generate_solver( + _make_tridiagonal_library(), output_dir, TRIDIAGONAL_TEST_DATA_DIR + ) + self.compare_or_update_directory(generated_dir, TRIDIAGONAL_TEST_DATA_DIR) + if __name__ == "__main__": SymforceCasparCodegenTest.main() diff --git a/test/symforce_function_codegen_test_data/symengine/symforce_caspar_tridiagonal_test/caspar_mappings.cu b/test/symforce_function_codegen_test_data/symengine/symforce_caspar_tridiagonal_test/caspar_mappings.cu new file mode 100644 index 00000000..0b2a5761 --- /dev/null +++ b/test/symforce_function_codegen_test_data/symengine/symforce_caspar_tridiagonal_test/caspar_mappings.cu @@ -0,0 +1,588 @@ +#include + +#include +#include + +#include "caspar_mappings.h" + +namespace cg = cooperative_groups; + +// We use shared memory to improve the memory access. +// A smaller block size of 32 allows for larger nodetypes. +constexpr int block_size = 32; + +namespace caspar { + +__global__ __launch_bounds__(block_size, 1) void ChainAStackedToCaspar_kernel( + const double* const __restrict__ stacked_data, double* const __restrict__ cas_data, + const unsigned int cas_stride, const unsigned int cas_offset, const unsigned int num_objects) { + const unsigned int global_thread_idx = blockIdx.x * blockDim.x + threadIdx.x; + __shared__ double stacked_data_local[block_size * 2]; + + for (unsigned int target = (blockIdx.x * blockDim.x) * 2 + threadIdx.x; + target < min(num_objects, (blockIdx.x + 1) * blockDim.x) * 2; target += blockDim.x) { + stacked_data_local[target - (blockIdx.x * blockDim.x) * 2] = stacked_data[target]; + } + + __syncthreads(); + + if (global_thread_idx < num_objects) { + double data[4] = {0, 0, 0, 0}; + double* stacked_local_ptr = stacked_data_local + threadIdx.x * 2; + double* out_ptr; + data[0] = stacked_local_ptr[0]; + data[1] = stacked_local_ptr[1]; + + out_ptr = cas_data + 2 * (global_thread_idx + cas_offset) + 0 * cas_stride; + reinterpret_cast(out_ptr)[0] = reinterpret_cast(data)[0]; + } +} + +__global__ __launch_bounds__(block_size, 1) void ChainACasparToStacked_kernel( + const double* const __restrict__ cas_data, double* const __restrict__ stacked_data, + const unsigned int cas_stride, const unsigned int cas_offset, const unsigned int num_objects) { + const unsigned int global_thread_idx = blockIdx.x * blockDim.x + threadIdx.x; + __shared__ double stacked_data_local[block_size * 2]; + + if (global_thread_idx < num_objects) { + double data[4] = {0, 0, 0, 0}; + double* stacked_local_ptr = stacked_data_local + threadIdx.x * 2; + const double* in_ptr; + in_ptr = cas_data + 2 * (global_thread_idx + cas_offset) + 0 * cas_stride; + reinterpret_cast(data)[0] = reinterpret_cast(in_ptr)[0]; + stacked_local_ptr[0] = data[0]; + stacked_local_ptr[1] = data[1]; + } + + __syncthreads(); + + for (unsigned int target = (blockIdx.x * blockDim.x) * 2 + threadIdx.x; + target < min(num_objects, (blockIdx.x + 1) * blockDim.x) * 2; target += blockDim.x) { + stacked_data[target] = stacked_data_local[target - (blockIdx.x * blockDim.x) * 2]; + } +} + +cudaError_t ChainAStackedToCaspar(const double* stacked_data, double* cas_data, + const unsigned int cas_stride, const unsigned int cas_offset, + const unsigned int num_objects) { + const int num_blocks = (num_objects + block_size - 1) / block_size; + + ChainAStackedToCaspar_kernel<<>>(stacked_data, cas_data, cas_stride, + cas_offset, num_objects); + + return cudaGetLastError(); +} + +cudaError_t ChainACasparToStacked(const double* cas_data, double* stacked_data, + const unsigned int cas_stride, const unsigned int cas_offset, + const unsigned int num_objects) { + const int num_blocks = (num_objects + block_size - 1) / block_size; + + ChainACasparToStacked_kernel<<>>(cas_data, stacked_data, cas_stride, + cas_offset, num_objects); + + return cudaGetLastError(); +} + +__global__ __launch_bounds__(block_size, 1) void ChainBStackedToCaspar_kernel( + const double* const __restrict__ stacked_data, double* const __restrict__ cas_data, + const unsigned int cas_stride, const unsigned int cas_offset, const unsigned int num_objects) { + const unsigned int global_thread_idx = blockIdx.x * blockDim.x + threadIdx.x; + __shared__ double stacked_data_local[block_size * 3]; + + for (unsigned int target = (blockIdx.x * blockDim.x) * 3 + threadIdx.x; + target < min(num_objects, (blockIdx.x + 1) * blockDim.x) * 3; target += blockDim.x) { + stacked_data_local[target - (blockIdx.x * blockDim.x) * 3] = stacked_data[target]; + } + + __syncthreads(); + + if (global_thread_idx < num_objects) { + double data[4] = {0, 0, 0, 0}; + double* stacked_local_ptr = stacked_data_local + threadIdx.x * 3; + double* out_ptr; + data[0] = stacked_local_ptr[0]; + data[1] = stacked_local_ptr[1]; + + out_ptr = cas_data + 2 * (global_thread_idx + cas_offset) + 0 * cas_stride; + reinterpret_cast(out_ptr)[0] = reinterpret_cast(data)[0]; + data[0] = stacked_local_ptr[2]; + + out_ptr = cas_data + 1 * (global_thread_idx + cas_offset) + 2 * cas_stride; + out_ptr[0] = data[0]; + } +} + +__global__ __launch_bounds__(block_size, 1) void ChainBCasparToStacked_kernel( + const double* const __restrict__ cas_data, double* const __restrict__ stacked_data, + const unsigned int cas_stride, const unsigned int cas_offset, const unsigned int num_objects) { + const unsigned int global_thread_idx = blockIdx.x * blockDim.x + threadIdx.x; + __shared__ double stacked_data_local[block_size * 3]; + + if (global_thread_idx < num_objects) { + double data[4] = {0, 0, 0, 0}; + double* stacked_local_ptr = stacked_data_local + threadIdx.x * 3; + const double* in_ptr; + in_ptr = cas_data + 2 * (global_thread_idx + cas_offset) + 0 * cas_stride; + reinterpret_cast(data)[0] = reinterpret_cast(in_ptr)[0]; + stacked_local_ptr[0] = data[0]; + stacked_local_ptr[1] = data[1]; + in_ptr = cas_data + 1 * (global_thread_idx + cas_offset) + 2 * cas_stride; + data[0] = in_ptr[0]; + stacked_local_ptr[2] = data[0]; + } + + __syncthreads(); + + for (unsigned int target = (blockIdx.x * blockDim.x) * 3 + threadIdx.x; + target < min(num_objects, (blockIdx.x + 1) * blockDim.x) * 3; target += blockDim.x) { + stacked_data[target] = stacked_data_local[target - (blockIdx.x * blockDim.x) * 3]; + } +} + +cudaError_t ChainBStackedToCaspar(const double* stacked_data, double* cas_data, + const unsigned int cas_stride, const unsigned int cas_offset, + const unsigned int num_objects) { + const int num_blocks = (num_objects + block_size - 1) / block_size; + + ChainBStackedToCaspar_kernel<<>>(stacked_data, cas_data, cas_stride, + cas_offset, num_objects); + + return cudaGetLastError(); +} + +cudaError_t ChainBCasparToStacked(const double* cas_data, double* stacked_data, + const unsigned int cas_stride, const unsigned int cas_offset, + const unsigned int num_objects) { + const int num_blocks = (num_objects + block_size - 1) / block_size; + + ChainBCasparToStacked_kernel<<>>(cas_data, stacked_data, cas_stride, + cas_offset, num_objects); + + return cudaGetLastError(); +} + +__global__ __launch_bounds__(block_size, 1) void Matrix21StackedToCaspar_kernel( + const double* const __restrict__ stacked_data, double* const __restrict__ cas_data, + const unsigned int cas_stride, const unsigned int cas_offset, const unsigned int num_objects) { + const unsigned int global_thread_idx = blockIdx.x * blockDim.x + threadIdx.x; + __shared__ double stacked_data_local[block_size * 2]; + + for (unsigned int target = (blockIdx.x * blockDim.x) * 2 + threadIdx.x; + target < min(num_objects, (blockIdx.x + 1) * blockDim.x) * 2; target += blockDim.x) { + stacked_data_local[target - (blockIdx.x * blockDim.x) * 2] = stacked_data[target]; + } + + __syncthreads(); + + if (global_thread_idx < num_objects) { + double data[4] = {0, 0, 0, 0}; + double* stacked_local_ptr = stacked_data_local + threadIdx.x * 2; + double* out_ptr; + data[0] = stacked_local_ptr[0]; + data[1] = stacked_local_ptr[1]; + + out_ptr = cas_data + 2 * (global_thread_idx + cas_offset) + 0 * cas_stride; + reinterpret_cast(out_ptr)[0] = reinterpret_cast(data)[0]; + } +} + +__global__ __launch_bounds__(block_size, 1) void Matrix21CasparToStacked_kernel( + const double* const __restrict__ cas_data, double* const __restrict__ stacked_data, + const unsigned int cas_stride, const unsigned int cas_offset, const unsigned int num_objects) { + const unsigned int global_thread_idx = blockIdx.x * blockDim.x + threadIdx.x; + __shared__ double stacked_data_local[block_size * 2]; + + if (global_thread_idx < num_objects) { + double data[4] = {0, 0, 0, 0}; + double* stacked_local_ptr = stacked_data_local + threadIdx.x * 2; + const double* in_ptr; + in_ptr = cas_data + 2 * (global_thread_idx + cas_offset) + 0 * cas_stride; + reinterpret_cast(data)[0] = reinterpret_cast(in_ptr)[0]; + stacked_local_ptr[0] = data[0]; + stacked_local_ptr[1] = data[1]; + } + + __syncthreads(); + + for (unsigned int target = (blockIdx.x * blockDim.x) * 2 + threadIdx.x; + target < min(num_objects, (blockIdx.x + 1) * blockDim.x) * 2; target += blockDim.x) { + stacked_data[target] = stacked_data_local[target - (blockIdx.x * blockDim.x) * 2]; + } +} + +cudaError_t Matrix21StackedToCaspar(const double* stacked_data, double* cas_data, + const unsigned int cas_stride, const unsigned int cas_offset, + const unsigned int num_objects) { + const int num_blocks = (num_objects + block_size - 1) / block_size; + + Matrix21StackedToCaspar_kernel<<>>(stacked_data, cas_data, cas_stride, + cas_offset, num_objects); + + return cudaGetLastError(); +} + +cudaError_t Matrix21CasparToStacked(const double* cas_data, double* stacked_data, + const unsigned int cas_stride, const unsigned int cas_offset, + const unsigned int num_objects) { + const int num_blocks = (num_objects + block_size - 1) / block_size; + + Matrix21CasparToStacked_kernel<<>>(cas_data, stacked_data, cas_stride, + cas_offset, num_objects); + + return cudaGetLastError(); +} + +__global__ __launch_bounds__(block_size, 1) void Matrix22StackedToCaspar_kernel( + const double* const __restrict__ stacked_data, double* const __restrict__ cas_data, + const unsigned int cas_stride, const unsigned int cas_offset, const unsigned int num_objects) { + const unsigned int global_thread_idx = blockIdx.x * blockDim.x + threadIdx.x; + __shared__ double stacked_data_local[block_size * 4]; + + for (unsigned int target = (blockIdx.x * blockDim.x) * 4 + threadIdx.x; + target < min(num_objects, (blockIdx.x + 1) * blockDim.x) * 4; target += blockDim.x) { + stacked_data_local[target - (blockIdx.x * blockDim.x) * 4] = stacked_data[target]; + } + + __syncthreads(); + + if (global_thread_idx < num_objects) { + double data[4] = {0, 0, 0, 0}; + double* stacked_local_ptr = stacked_data_local + threadIdx.x * 4; + double* out_ptr; + data[0] = stacked_local_ptr[0]; + data[1] = stacked_local_ptr[1]; + + out_ptr = cas_data + 2 * (global_thread_idx + cas_offset) + 0 * cas_stride; + reinterpret_cast(out_ptr)[0] = reinterpret_cast(data)[0]; + data[0] = stacked_local_ptr[2]; + data[1] = stacked_local_ptr[3]; + + out_ptr = cas_data + 2 * (global_thread_idx + cas_offset) + 2 * cas_stride; + reinterpret_cast(out_ptr)[0] = reinterpret_cast(data)[0]; + } +} + +__global__ __launch_bounds__(block_size, 1) void Matrix22CasparToStacked_kernel( + const double* const __restrict__ cas_data, double* const __restrict__ stacked_data, + const unsigned int cas_stride, const unsigned int cas_offset, const unsigned int num_objects) { + const unsigned int global_thread_idx = blockIdx.x * blockDim.x + threadIdx.x; + __shared__ double stacked_data_local[block_size * 4]; + + if (global_thread_idx < num_objects) { + double data[4] = {0, 0, 0, 0}; + double* stacked_local_ptr = stacked_data_local + threadIdx.x * 4; + const double* in_ptr; + in_ptr = cas_data + 2 * (global_thread_idx + cas_offset) + 0 * cas_stride; + reinterpret_cast(data)[0] = reinterpret_cast(in_ptr)[0]; + stacked_local_ptr[0] = data[0]; + stacked_local_ptr[1] = data[1]; + in_ptr = cas_data + 2 * (global_thread_idx + cas_offset) + 2 * cas_stride; + reinterpret_cast(data)[0] = reinterpret_cast(in_ptr)[0]; + stacked_local_ptr[2] = data[0]; + stacked_local_ptr[3] = data[1]; + } + + __syncthreads(); + + for (unsigned int target = (blockIdx.x * blockDim.x) * 4 + threadIdx.x; + target < min(num_objects, (blockIdx.x + 1) * blockDim.x) * 4; target += blockDim.x) { + stacked_data[target] = stacked_data_local[target - (blockIdx.x * blockDim.x) * 4]; + } +} + +cudaError_t Matrix22StackedToCaspar(const double* stacked_data, double* cas_data, + const unsigned int cas_stride, const unsigned int cas_offset, + const unsigned int num_objects) { + const int num_blocks = (num_objects + block_size - 1) / block_size; + + Matrix22StackedToCaspar_kernel<<>>(stacked_data, cas_data, cas_stride, + cas_offset, num_objects); + + return cudaGetLastError(); +} + +cudaError_t Matrix22CasparToStacked(const double* cas_data, double* stacked_data, + const unsigned int cas_stride, const unsigned int cas_offset, + const unsigned int num_objects) { + const int num_blocks = (num_objects + block_size - 1) / block_size; + + Matrix22CasparToStacked_kernel<<>>(cas_data, stacked_data, cas_stride, + cas_offset, num_objects); + + return cudaGetLastError(); +} + +__global__ __launch_bounds__(block_size, 1) void Matrix23StackedToCaspar_kernel( + const double* const __restrict__ stacked_data, double* const __restrict__ cas_data, + const unsigned int cas_stride, const unsigned int cas_offset, const unsigned int num_objects) { + const unsigned int global_thread_idx = blockIdx.x * blockDim.x + threadIdx.x; + __shared__ double stacked_data_local[block_size * 6]; + + for (unsigned int target = (blockIdx.x * blockDim.x) * 6 + threadIdx.x; + target < min(num_objects, (blockIdx.x + 1) * blockDim.x) * 6; target += blockDim.x) { + stacked_data_local[target - (blockIdx.x * blockDim.x) * 6] = stacked_data[target]; + } + + __syncthreads(); + + if (global_thread_idx < num_objects) { + double data[4] = {0, 0, 0, 0}; + double* stacked_local_ptr = stacked_data_local + threadIdx.x * 6; + double* out_ptr; + data[0] = stacked_local_ptr[0]; + data[1] = stacked_local_ptr[1]; + + out_ptr = cas_data + 2 * (global_thread_idx + cas_offset) + 0 * cas_stride; + reinterpret_cast(out_ptr)[0] = reinterpret_cast(data)[0]; + data[0] = stacked_local_ptr[2]; + data[1] = stacked_local_ptr[3]; + + out_ptr = cas_data + 2 * (global_thread_idx + cas_offset) + 2 * cas_stride; + reinterpret_cast(out_ptr)[0] = reinterpret_cast(data)[0]; + data[0] = stacked_local_ptr[4]; + data[1] = stacked_local_ptr[5]; + + out_ptr = cas_data + 2 * (global_thread_idx + cas_offset) + 4 * cas_stride; + reinterpret_cast(out_ptr)[0] = reinterpret_cast(data)[0]; + } +} + +__global__ __launch_bounds__(block_size, 1) void Matrix23CasparToStacked_kernel( + const double* const __restrict__ cas_data, double* const __restrict__ stacked_data, + const unsigned int cas_stride, const unsigned int cas_offset, const unsigned int num_objects) { + const unsigned int global_thread_idx = blockIdx.x * blockDim.x + threadIdx.x; + __shared__ double stacked_data_local[block_size * 6]; + + if (global_thread_idx < num_objects) { + double data[4] = {0, 0, 0, 0}; + double* stacked_local_ptr = stacked_data_local + threadIdx.x * 6; + const double* in_ptr; + in_ptr = cas_data + 2 * (global_thread_idx + cas_offset) + 0 * cas_stride; + reinterpret_cast(data)[0] = reinterpret_cast(in_ptr)[0]; + stacked_local_ptr[0] = data[0]; + stacked_local_ptr[1] = data[1]; + in_ptr = cas_data + 2 * (global_thread_idx + cas_offset) + 2 * cas_stride; + reinterpret_cast(data)[0] = reinterpret_cast(in_ptr)[0]; + stacked_local_ptr[2] = data[0]; + stacked_local_ptr[3] = data[1]; + in_ptr = cas_data + 2 * (global_thread_idx + cas_offset) + 4 * cas_stride; + reinterpret_cast(data)[0] = reinterpret_cast(in_ptr)[0]; + stacked_local_ptr[4] = data[0]; + stacked_local_ptr[5] = data[1]; + } + + __syncthreads(); + + for (unsigned int target = (blockIdx.x * blockDim.x) * 6 + threadIdx.x; + target < min(num_objects, (blockIdx.x + 1) * blockDim.x) * 6; target += blockDim.x) { + stacked_data[target] = stacked_data_local[target - (blockIdx.x * blockDim.x) * 6]; + } +} + +cudaError_t Matrix23StackedToCaspar(const double* stacked_data, double* cas_data, + const unsigned int cas_stride, const unsigned int cas_offset, + const unsigned int num_objects) { + const int num_blocks = (num_objects + block_size - 1) / block_size; + + Matrix23StackedToCaspar_kernel<<>>(stacked_data, cas_data, cas_stride, + cas_offset, num_objects); + + return cudaGetLastError(); +} + +cudaError_t Matrix23CasparToStacked(const double* cas_data, double* stacked_data, + const unsigned int cas_stride, const unsigned int cas_offset, + const unsigned int num_objects) { + const int num_blocks = (num_objects + block_size - 1) / block_size; + + Matrix23CasparToStacked_kernel<<>>(cas_data, stacked_data, cas_stride, + cas_offset, num_objects); + + return cudaGetLastError(); +} + +__global__ __launch_bounds__(block_size, 1) void Matrix31StackedToCaspar_kernel( + const double* const __restrict__ stacked_data, double* const __restrict__ cas_data, + const unsigned int cas_stride, const unsigned int cas_offset, const unsigned int num_objects) { + const unsigned int global_thread_idx = blockIdx.x * blockDim.x + threadIdx.x; + __shared__ double stacked_data_local[block_size * 3]; + + for (unsigned int target = (blockIdx.x * blockDim.x) * 3 + threadIdx.x; + target < min(num_objects, (blockIdx.x + 1) * blockDim.x) * 3; target += blockDim.x) { + stacked_data_local[target - (blockIdx.x * blockDim.x) * 3] = stacked_data[target]; + } + + __syncthreads(); + + if (global_thread_idx < num_objects) { + double data[4] = {0, 0, 0, 0}; + double* stacked_local_ptr = stacked_data_local + threadIdx.x * 3; + double* out_ptr; + data[0] = stacked_local_ptr[0]; + data[1] = stacked_local_ptr[1]; + + out_ptr = cas_data + 2 * (global_thread_idx + cas_offset) + 0 * cas_stride; + reinterpret_cast(out_ptr)[0] = reinterpret_cast(data)[0]; + data[0] = stacked_local_ptr[2]; + + out_ptr = cas_data + 1 * (global_thread_idx + cas_offset) + 2 * cas_stride; + out_ptr[0] = data[0]; + } +} + +__global__ __launch_bounds__(block_size, 1) void Matrix31CasparToStacked_kernel( + const double* const __restrict__ cas_data, double* const __restrict__ stacked_data, + const unsigned int cas_stride, const unsigned int cas_offset, const unsigned int num_objects) { + const unsigned int global_thread_idx = blockIdx.x * blockDim.x + threadIdx.x; + __shared__ double stacked_data_local[block_size * 3]; + + if (global_thread_idx < num_objects) { + double data[4] = {0, 0, 0, 0}; + double* stacked_local_ptr = stacked_data_local + threadIdx.x * 3; + const double* in_ptr; + in_ptr = cas_data + 2 * (global_thread_idx + cas_offset) + 0 * cas_stride; + reinterpret_cast(data)[0] = reinterpret_cast(in_ptr)[0]; + stacked_local_ptr[0] = data[0]; + stacked_local_ptr[1] = data[1]; + in_ptr = cas_data + 1 * (global_thread_idx + cas_offset) + 2 * cas_stride; + data[0] = in_ptr[0]; + stacked_local_ptr[2] = data[0]; + } + + __syncthreads(); + + for (unsigned int target = (blockIdx.x * blockDim.x) * 3 + threadIdx.x; + target < min(num_objects, (blockIdx.x + 1) * blockDim.x) * 3; target += blockDim.x) { + stacked_data[target] = stacked_data_local[target - (blockIdx.x * blockDim.x) * 3]; + } +} + +cudaError_t Matrix31StackedToCaspar(const double* stacked_data, double* cas_data, + const unsigned int cas_stride, const unsigned int cas_offset, + const unsigned int num_objects) { + const int num_blocks = (num_objects + block_size - 1) / block_size; + + Matrix31StackedToCaspar_kernel<<>>(stacked_data, cas_data, cas_stride, + cas_offset, num_objects); + + return cudaGetLastError(); +} + +cudaError_t Matrix31CasparToStacked(const double* cas_data, double* stacked_data, + const unsigned int cas_stride, const unsigned int cas_offset, + const unsigned int num_objects) { + const int num_blocks = (num_objects + block_size - 1) / block_size; + + Matrix31CasparToStacked_kernel<<>>(cas_data, stacked_data, cas_stride, + cas_offset, num_objects); + + return cudaGetLastError(); +} + +__global__ __launch_bounds__(block_size, 1) void Matrix33StackedToCaspar_kernel( + const double* const __restrict__ stacked_data, double* const __restrict__ cas_data, + const unsigned int cas_stride, const unsigned int cas_offset, const unsigned int num_objects) { + const unsigned int global_thread_idx = blockIdx.x * blockDim.x + threadIdx.x; + __shared__ double stacked_data_local[block_size * 9]; + + for (unsigned int target = (blockIdx.x * blockDim.x) * 9 + threadIdx.x; + target < min(num_objects, (blockIdx.x + 1) * blockDim.x) * 9; target += blockDim.x) { + stacked_data_local[target - (blockIdx.x * blockDim.x) * 9] = stacked_data[target]; + } + + __syncthreads(); + + if (global_thread_idx < num_objects) { + double data[4] = {0, 0, 0, 0}; + double* stacked_local_ptr = stacked_data_local + threadIdx.x * 9; + double* out_ptr; + data[0] = stacked_local_ptr[0]; + data[1] = stacked_local_ptr[1]; + + out_ptr = cas_data + 2 * (global_thread_idx + cas_offset) + 0 * cas_stride; + reinterpret_cast(out_ptr)[0] = reinterpret_cast(data)[0]; + data[0] = stacked_local_ptr[2]; + data[1] = stacked_local_ptr[3]; + + out_ptr = cas_data + 2 * (global_thread_idx + cas_offset) + 2 * cas_stride; + reinterpret_cast(out_ptr)[0] = reinterpret_cast(data)[0]; + data[0] = stacked_local_ptr[4]; + data[1] = stacked_local_ptr[5]; + + out_ptr = cas_data + 2 * (global_thread_idx + cas_offset) + 4 * cas_stride; + reinterpret_cast(out_ptr)[0] = reinterpret_cast(data)[0]; + data[0] = stacked_local_ptr[6]; + data[1] = stacked_local_ptr[7]; + + out_ptr = cas_data + 2 * (global_thread_idx + cas_offset) + 6 * cas_stride; + reinterpret_cast(out_ptr)[0] = reinterpret_cast(data)[0]; + data[0] = stacked_local_ptr[8]; + + out_ptr = cas_data + 1 * (global_thread_idx + cas_offset) + 8 * cas_stride; + out_ptr[0] = data[0]; + } +} + +__global__ __launch_bounds__(block_size, 1) void Matrix33CasparToStacked_kernel( + const double* const __restrict__ cas_data, double* const __restrict__ stacked_data, + const unsigned int cas_stride, const unsigned int cas_offset, const unsigned int num_objects) { + const unsigned int global_thread_idx = blockIdx.x * blockDim.x + threadIdx.x; + __shared__ double stacked_data_local[block_size * 9]; + + if (global_thread_idx < num_objects) { + double data[4] = {0, 0, 0, 0}; + double* stacked_local_ptr = stacked_data_local + threadIdx.x * 9; + const double* in_ptr; + in_ptr = cas_data + 2 * (global_thread_idx + cas_offset) + 0 * cas_stride; + reinterpret_cast(data)[0] = reinterpret_cast(in_ptr)[0]; + stacked_local_ptr[0] = data[0]; + stacked_local_ptr[1] = data[1]; + in_ptr = cas_data + 2 * (global_thread_idx + cas_offset) + 2 * cas_stride; + reinterpret_cast(data)[0] = reinterpret_cast(in_ptr)[0]; + stacked_local_ptr[2] = data[0]; + stacked_local_ptr[3] = data[1]; + in_ptr = cas_data + 2 * (global_thread_idx + cas_offset) + 4 * cas_stride; + reinterpret_cast(data)[0] = reinterpret_cast(in_ptr)[0]; + stacked_local_ptr[4] = data[0]; + stacked_local_ptr[5] = data[1]; + in_ptr = cas_data + 2 * (global_thread_idx + cas_offset) + 6 * cas_stride; + reinterpret_cast(data)[0] = reinterpret_cast(in_ptr)[0]; + stacked_local_ptr[6] = data[0]; + stacked_local_ptr[7] = data[1]; + in_ptr = cas_data + 1 * (global_thread_idx + cas_offset) + 8 * cas_stride; + data[0] = in_ptr[0]; + stacked_local_ptr[8] = data[0]; + } + + __syncthreads(); + + for (unsigned int target = (blockIdx.x * blockDim.x) * 9 + threadIdx.x; + target < min(num_objects, (blockIdx.x + 1) * blockDim.x) * 9; target += blockDim.x) { + stacked_data[target] = stacked_data_local[target - (blockIdx.x * blockDim.x) * 9]; + } +} + +cudaError_t Matrix33StackedToCaspar(const double* stacked_data, double* cas_data, + const unsigned int cas_stride, const unsigned int cas_offset, + const unsigned int num_objects) { + const int num_blocks = (num_objects + block_size - 1) / block_size; + + Matrix33StackedToCaspar_kernel<<>>(stacked_data, cas_data, cas_stride, + cas_offset, num_objects); + + return cudaGetLastError(); +} + +cudaError_t Matrix33CasparToStacked(const double* cas_data, double* stacked_data, + const unsigned int cas_stride, const unsigned int cas_offset, + const unsigned int num_objects) { + const int num_blocks = (num_objects + block_size - 1) / block_size; + + Matrix33CasparToStacked_kernel<<>>(cas_data, stacked_data, cas_stride, + cas_offset, num_objects); + + return cudaGetLastError(); +} + +} // namespace caspar \ No newline at end of file diff --git a/test/symforce_function_codegen_test_data/symengine/symforce_caspar_tridiagonal_test/caspar_mappings.h b/test/symforce_function_codegen_test_data/symengine/symforce_caspar_tridiagonal_test/caspar_mappings.h new file mode 100644 index 00000000..6d656e85 --- /dev/null +++ b/test/symforce_function_codegen_test_data/symengine/symforce_caspar_tridiagonal_test/caspar_mappings.h @@ -0,0 +1,63 @@ +#pragma once + +#include + +namespace caspar { + +cudaError_t ChainAStackedToCaspar(const double* stacked_data, double* cas_data, + const unsigned int cas_stride, const unsigned int cas_offset, + const unsigned int num_objects); + +cudaError_t ChainACasparToStacked(const double* cas_data, double* stacked_data, + const unsigned int cas_stride, const unsigned int cas_offset, + const unsigned int num_objects); + +cudaError_t ChainBStackedToCaspar(const double* stacked_data, double* cas_data, + const unsigned int cas_stride, const unsigned int cas_offset, + const unsigned int num_objects); + +cudaError_t ChainBCasparToStacked(const double* cas_data, double* stacked_data, + const unsigned int cas_stride, const unsigned int cas_offset, + const unsigned int num_objects); + +cudaError_t Matrix21StackedToCaspar(const double* stacked_data, double* cas_data, + const unsigned int cas_stride, const unsigned int cas_offset, + const unsigned int num_objects); + +cudaError_t Matrix21CasparToStacked(const double* cas_data, double* stacked_data, + const unsigned int cas_stride, const unsigned int cas_offset, + const unsigned int num_objects); + +cudaError_t Matrix22StackedToCaspar(const double* stacked_data, double* cas_data, + const unsigned int cas_stride, const unsigned int cas_offset, + const unsigned int num_objects); + +cudaError_t Matrix22CasparToStacked(const double* cas_data, double* stacked_data, + const unsigned int cas_stride, const unsigned int cas_offset, + const unsigned int num_objects); + +cudaError_t Matrix23StackedToCaspar(const double* stacked_data, double* cas_data, + const unsigned int cas_stride, const unsigned int cas_offset, + const unsigned int num_objects); + +cudaError_t Matrix23CasparToStacked(const double* cas_data, double* stacked_data, + const unsigned int cas_stride, const unsigned int cas_offset, + const unsigned int num_objects); + +cudaError_t Matrix31StackedToCaspar(const double* stacked_data, double* cas_data, + const unsigned int cas_stride, const unsigned int cas_offset, + const unsigned int num_objects); + +cudaError_t Matrix31CasparToStacked(const double* cas_data, double* stacked_data, + const unsigned int cas_stride, const unsigned int cas_offset, + const unsigned int num_objects); + +cudaError_t Matrix33StackedToCaspar(const double* stacked_data, double* cas_data, + const unsigned int cas_stride, const unsigned int cas_offset, + const unsigned int num_objects); + +cudaError_t Matrix33CasparToStacked(const double* cas_data, double* stacked_data, + const unsigned int cas_stride, const unsigned int cas_offset, + const unsigned int num_objects); + +} // namespace caspar \ No newline at end of file diff --git a/test/symforce_function_codegen_test_data/symengine/symforce_caspar_tridiagonal_test/kernel_ChainA_alpha_denominator_or_beta_numerator.cu b/test/symforce_function_codegen_test_data/symengine/symforce_caspar_tridiagonal_test/kernel_ChainA_alpha_denominator_or_beta_numerator.cu new file mode 100644 index 00000000..495c7be2 --- /dev/null +++ b/test/symforce_function_codegen_test_data/symengine/symforce_caspar_tridiagonal_test/kernel_ChainA_alpha_denominator_or_beta_numerator.cu @@ -0,0 +1,73 @@ +#include +#include + +#include +#include +#include +#include +#include + +#include "kernel_ChainA_alpha_denominator_or_beta_numerator.h" +#include "memops.cuh" + +namespace cg = cooperative_groups; + +namespace caspar { + +__global__ void __launch_bounds__(1024, 1) + ChainAAlphaDenominatorOrBetaNumeratorKernel(double* ChainA_p_kp1, + unsigned int ChainA_p_kp1_num_alloc, + double* ChainA_w, unsigned int ChainA_w_num_alloc, + double* const ChainA_out, size_t problem_size) { + const int global_thread_idx = blockIdx.x * blockDim.x + threadIdx.x; + // Scratch data, then the shared indices of each shared accessor; dynamic, so + // that it may exceed the 48 KB static shared memory limit (see the launch + // below). + extern __shared__ __align__(16) uint8_t inout_shared[]; + + __shared__ double ChainA_out_local[1]; + + double r0 = 0, r1 = 0, r2 = 0, r3 = 0; + + if (global_thread_idx < problem_size) { + ReadIdx2<1024, double, double, double2>(ChainA_p_kp1, 0 * ChainA_p_kp1_num_alloc, + global_thread_idx, r0, r1); + ReadIdx2<1024, double, double, double2>(ChainA_w, 0 * ChainA_w_num_alloc, global_thread_idx, r2, + r3); + r2 = fma(r0, r2, r1 * r3); + }; + SumStore(ChainA_out_local, (double*)inout_shared, 0, global_thread_idx < problem_size, + r2); + SumFlushFinal(ChainA_out_local, ChainA_out, 1); +} + +void ChainAAlphaDenominatorOrBetaNumerator(double* ChainA_p_kp1, + unsigned int ChainA_p_kp1_num_alloc, double* ChainA_w, + unsigned int ChainA_w_num_alloc, + double* const ChainA_out, size_t problem_size) { + if (problem_size == 0) { + return; + } + + const int n_blocks = (problem_size + 1024 - 1) / 1024; + // Kernels using more than 48 KB of shared memory per block must opt in. + static const cudaError_t attribute_error = + cudaFuncSetAttribute(ChainAAlphaDenominatorOrBetaNumeratorKernel, + cudaFuncAttributeMaxDynamicSharedMemorySize, 256); + if (attribute_error != cudaSuccess) { + throw std::runtime_error(std::string("ChainAAlphaDenominatorOrBetaNumeratorKernel: ") + + cudaGetErrorString(attribute_error)); + } + ChainAAlphaDenominatorOrBetaNumeratorKernel<<>>( + ChainA_p_kp1, ChainA_p_kp1_num_alloc, ChainA_w, ChainA_w_num_alloc, ChainA_out, problem_size); + // A launch that fails (e.g. from exceeding shared memory or register limits) + // otherwise leaves its outputs untouched without any error. + const cudaError_t launch_error = cudaGetLastError(); + if (launch_error != cudaSuccess) { + throw std::runtime_error( + std::string("ChainAAlphaDenominatorOrBetaNumeratorKernel launch failed: ") + + cudaGetErrorString(launch_error)); + } +} + +} // namespace caspar \ No newline at end of file diff --git a/test/symforce_function_codegen_test_data/symengine/symforce_caspar_tridiagonal_test/kernel_ChainA_alpha_denominator_or_beta_numerator.h b/test/symforce_function_codegen_test_data/symengine/symforce_caspar_tridiagonal_test/kernel_ChainA_alpha_denominator_or_beta_numerator.h new file mode 100644 index 00000000..b02b452a --- /dev/null +++ b/test/symforce_function_codegen_test_data/symengine/symforce_caspar_tridiagonal_test/kernel_ChainA_alpha_denominator_or_beta_numerator.h @@ -0,0 +1,14 @@ +#pragma once + +#include + +#include "shared_indices.h" + +namespace caspar { + +void ChainAAlphaDenominatorOrBetaNumerator(double* ChainA_p_kp1, + unsigned int ChainA_p_kp1_num_alloc, double* ChainA_w, + unsigned int ChainA_w_num_alloc, + double* const ChainA_out, size_t problem_size); + +} // namespace caspar \ No newline at end of file diff --git a/test/symforce_function_codegen_test_data/symengine/symforce_caspar_tridiagonal_test/kernel_ChainA_alpha_numerator_denominator.cu b/test/symforce_function_codegen_test_data/symengine/symforce_caspar_tridiagonal_test/kernel_ChainA_alpha_numerator_denominator.cu new file mode 100644 index 00000000..20c3096e --- /dev/null +++ b/test/symforce_function_codegen_test_data/symengine/symforce_caspar_tridiagonal_test/kernel_ChainA_alpha_numerator_denominator.cu @@ -0,0 +1,84 @@ +#include +#include + +#include +#include +#include +#include +#include + +#include "kernel_ChainA_alpha_numerator_denominator.h" +#include "memops.cuh" + +namespace cg = cooperative_groups; + +namespace caspar { + +__global__ void __launch_bounds__(1024, 1) + ChainAAlphaNumeratorDenominatorKernel(double* ChainA_p_kp1, unsigned int ChainA_p_kp1_num_alloc, + double* ChainA_r_k, unsigned int ChainA_r_k_num_alloc, + double* ChainA_w, unsigned int ChainA_w_num_alloc, + double* const ChainA_total_ag, + double* const ChainA_total_ac, size_t problem_size) { + const int global_thread_idx = blockIdx.x * blockDim.x + threadIdx.x; + // Scratch data, then the shared indices of each shared accessor; dynamic, so + // that it may exceed the 48 KB static shared memory limit (see the launch + // below). + extern __shared__ __align__(16) uint8_t inout_shared[]; + + __shared__ double ChainA_total_ag_local[1]; + + __shared__ double ChainA_total_ac_local[1]; + + double r0 = 0, r1 = 0, r2 = 0, r3 = 0; + + if (global_thread_idx < problem_size) { + ReadIdx2<1024, double, double, double2>(ChainA_p_kp1, 0 * ChainA_p_kp1_num_alloc, + global_thread_idx, r0, r1); + ReadIdx2<1024, double, double, double2>(ChainA_r_k, 0 * ChainA_r_k_num_alloc, global_thread_idx, + r2, r3); + r3 = fma(r1, r3, r0 * r2); + }; + SumStore(ChainA_total_ag_local, (double*)inout_shared, 0, + global_thread_idx < problem_size, r3); + if (global_thread_idx < problem_size) { + ReadIdx2<1024, double, double, double2>(ChainA_w, 0 * ChainA_w_num_alloc, global_thread_idx, r3, + r2); + r3 = fma(r0, r3, r1 * r2); + }; + SumStore(ChainA_total_ac_local, (double*)inout_shared, 0, + global_thread_idx < problem_size, r3); + SumFlushFinal(ChainA_total_ag_local, ChainA_total_ag, 1); + SumFlushFinal(ChainA_total_ac_local, ChainA_total_ac, 1); +} + +void ChainAAlphaNumeratorDenominator(double* ChainA_p_kp1, unsigned int ChainA_p_kp1_num_alloc, + double* ChainA_r_k, unsigned int ChainA_r_k_num_alloc, + double* ChainA_w, unsigned int ChainA_w_num_alloc, + double* const ChainA_total_ag, double* const ChainA_total_ac, + size_t problem_size) { + if (problem_size == 0) { + return; + } + + const int n_blocks = (problem_size + 1024 - 1) / 1024; + // Kernels using more than 48 KB of shared memory per block must opt in. + static const cudaError_t attribute_error = cudaFuncSetAttribute( + ChainAAlphaNumeratorDenominatorKernel, cudaFuncAttributeMaxDynamicSharedMemorySize, 256); + if (attribute_error != cudaSuccess) { + throw std::runtime_error(std::string("ChainAAlphaNumeratorDenominatorKernel: ") + + cudaGetErrorString(attribute_error)); + } + ChainAAlphaNumeratorDenominatorKernel<<>>( + ChainA_p_kp1, ChainA_p_kp1_num_alloc, ChainA_r_k, ChainA_r_k_num_alloc, ChainA_w, + ChainA_w_num_alloc, ChainA_total_ag, ChainA_total_ac, problem_size); + // A launch that fails (e.g. from exceeding shared memory or register limits) + // otherwise leaves its outputs untouched without any error. + const cudaError_t launch_error = cudaGetLastError(); + if (launch_error != cudaSuccess) { + throw std::runtime_error(std::string("ChainAAlphaNumeratorDenominatorKernel launch failed: ") + + cudaGetErrorString(launch_error)); + } +} + +} // namespace caspar \ No newline at end of file diff --git a/test/symforce_function_codegen_test_data/symengine/symforce_caspar_tridiagonal_test/kernel_ChainA_alpha_numerator_denominator.h b/test/symforce_function_codegen_test_data/symengine/symforce_caspar_tridiagonal_test/kernel_ChainA_alpha_numerator_denominator.h new file mode 100644 index 00000000..94a7d660 --- /dev/null +++ b/test/symforce_function_codegen_test_data/symengine/symforce_caspar_tridiagonal_test/kernel_ChainA_alpha_numerator_denominator.h @@ -0,0 +1,15 @@ +#pragma once + +#include + +#include "shared_indices.h" + +namespace caspar { + +void ChainAAlphaNumeratorDenominator(double* ChainA_p_kp1, unsigned int ChainA_p_kp1_num_alloc, + double* ChainA_r_k, unsigned int ChainA_r_k_num_alloc, + double* ChainA_w, unsigned int ChainA_w_num_alloc, + double* const ChainA_total_ag, double* const ChainA_total_ac, + size_t problem_size); + +} // namespace caspar \ No newline at end of file diff --git a/test/symforce_function_codegen_test_data/symengine/symforce_caspar_tridiagonal_test/kernel_ChainA_cyclic_reduction_down.cu b/test/symforce_function_codegen_test_data/symengine/symforce_caspar_tridiagonal_test/kernel_ChainA_cyclic_reduction_down.cu new file mode 100644 index 00000000..5a945d07 --- /dev/null +++ b/test/symforce_function_codegen_test_data/symengine/symforce_caspar_tridiagonal_test/kernel_ChainA_cyclic_reduction_down.cu @@ -0,0 +1,268 @@ +#include +#include + +#include +#include +#include +#include +#include + +#include "kernel_ChainA_cyclic_reduction_down.h" +#include "memops.cuh" + +namespace cg = cooperative_groups; + +namespace caspar { + +__global__ void __launch_bounds__(64, 1) + ChainACyclicReductionDownKernel(double* eqk, unsigned int eqk_num_alloc, int eqk_offset, + int eqk_stride, double* const eq, unsigned int eq_num_alloc, + int eq_offset, int eq_stride, double* eq_marked, + unsigned int eq_marked_num_alloc, int eq_marked_offset, + int eq_marked_stride, size_t problem_size) { + const int global_thread_idx = blockIdx.x * blockDim.x + threadIdx.x; + // Scratch data, then the shared indices of each shared accessor; dynamic, so + // that it may exceed the 48 KB static shared memory limit (see the launch + // below). + extern __shared__ __align__(16) uint8_t inout_shared[]; + + double r0 = 0, r1 = 0, r2 = 0, r3 = 0, r4 = 0, r5 = 0, r6 = 0, r7 = 0, r8 = 0, r9 = 0, r10 = 0, + r11 = 0, r12 = 0, r13 = 0, r14 = 0, r15 = 0, r16 = 0, r17 = 0, r18 = 0, r19 = 0, r20 = 0, + r21 = 0, r22 = 0, r23 = 0, r24 = 0, r25 = 0, r26 = 0, r27 = 0, r28 = 0, r29 = 0, r30 = 0, + r31 = 0, r32 = 0, r33 = 0, r34 = 0, r35 = 0, r36 = 0, r37 = 0, r38 = 0, r39 = 0, r40 = 0, + r41 = 0; + + if (global_thread_idx < problem_size) { + ReadIdx2<64, double, double, double2>(eqk, 0 * eqk_num_alloc, + global_thread_idx * eqk_stride + eqk_offset, r0, r1); + }; + ReadAndShuffleWithDefault2<64, double, double, double2>( + (double*)inout_shared, eq, 0 * eq_num_alloc, global_thread_idx * eq_stride + eq_offset, + threadIdx.x == 63, global_thread_idx <= problem_size, eq_num_alloc, eq_stride, r2, r3, r4, r5, + 0.000000f, 0.000000f); + if (global_thread_idx < problem_size) { + r6 = -1.00000000000000000e+00; + r7 = r2 * r6; + }; + ReadAndShuffleWithDefault2<64, double, double, double2>( + (double*)inout_shared, eq, 16 * eq_num_alloc, global_thread_idx * eq_stride + eq_offset, + threadIdx.x == 63, global_thread_idx <= problem_size, eq_num_alloc, eq_stride, r8, r9, r10, + r11, 1.000000f, 1.000000f); + if (global_thread_idx < problem_size) { + r9 = 1.0 / r9; + }; + ReadAndShuffleWithDefault2<64, double, double, double2>( + (double*)inout_shared, eq, 14 * eq_num_alloc, global_thread_idx * eq_stride + eq_offset, + threadIdx.x == 63, global_thread_idx <= problem_size, eq_num_alloc, eq_stride, r12, r13, r14, + r15, 1.000000f, 0.000000f); + if (global_thread_idx < problem_size) { + ReadIdx2<64, double, double, double2>(eqk, 2 * eqk_num_alloc, + global_thread_idx * eqk_stride + eqk_offset, r16, r17); + }; + ReadAndShuffleWithDefault2<64, double, double, double2>( + (double*)inout_shared, eq, 18 * eq_num_alloc, global_thread_idx * eq_stride + eq_offset, + threadIdx.x == 63, global_thread_idx <= problem_size, eq_num_alloc, eq_stride, r18, r19, r20, + r21, 0.000000f, 1.000000f); + if (global_thread_idx < problem_size) { + r18 = r18 * r6; + r18 = r18 * r9; + r16 = fma(r0, r18, r16); + r19 = 1.0 / r19; + r8 = 1.0 / r8; + r8 = r19 * r8; + r19 = r6 * r8; + r22 = r16 * r19; + r0 = fma(r13, r22, r0 * r9); + r12 = 1.0 / r12; + r0 = r0 * r12; + r7 = fma(r3, r22, r0 * r7); + r23 = r2 * r6; + r18 = fma(r1, r18, r17); + r17 = r13 * r18; + r17 = fma(r19, r17, r1 * r9); + r23 = r23 * r17; + r9 = r3 * r18; + r9 = fma(r19, r9, r12 * r23); + WriteIdx2<64, double, double, double2>(eq_marked, 0 * eq_marked_num_alloc, + global_thread_idx * eq_marked_stride + eq_marked_offset, + r7, r9); + }; + ReadAndShuffleWithDefault2<64, double, double, double2>( + (double*)inout_shared, eq, 2 * eq_num_alloc, global_thread_idx * eq_stride + eq_offset, + threadIdx.x == 63, global_thread_idx <= problem_size, eq_num_alloc, eq_stride, r9, r7, r23, + r1, 0.000000f, 0.000000f); + if (global_thread_idx < problem_size) { + r24 = r9 * r6; + r22 = fma(r7, r22, r0 * r24); + r24 = r9 * r6; + r24 = r24 * r17; + r25 = r7 * r18; + r25 = fma(r19, r25, r12 * r24); + WriteIdx2<64, double, double, double2>(eq_marked, 2 * eq_marked_num_alloc, + global_thread_idx * eq_marked_stride + eq_marked_offset, + r22, r25); + ReadIdx2<64, double, double, double2>(eqk, 4 * eqk_num_alloc, + global_thread_idx * eqk_stride + eqk_offset, r25, r22); + ReadIdx2<64, double, double, double2>(eqk, 8 * eqk_num_alloc, + global_thread_idx * eqk_stride + eqk_offset, r24, r19); + r11 = 1.0 / r11; + ReadIdx2<64, double, double, double2>(eqk, 10 * eqk_num_alloc, + global_thread_idx * eqk_stride + eqk_offset, r26, r27); + r20 = r20 * r6; + r20 = r20 * r11; + r26 = fma(r24, r20, r26); + r21 = 1.0 / r21; + r10 = 1.0 / r10; + r10 = r21 * r10; + r26 = r26 * r10; + r21 = r6 * r26; + r24 = fma(r15, r21, r24 * r11); + r14 = 1.0 / r14; + r24 = r24 * r14; + r28 = fma(r5, r26, r4 * r24); + r28 = fma(r6, r28, r25); + }; + ReadAndShuffleWithDefault2<64, double, double, double2>( + (double*)inout_shared, eq, 8 * eq_num_alloc, global_thread_idx * eq_stride + eq_offset, + threadIdx.x == 63, global_thread_idx <= problem_size, eq_num_alloc, eq_stride, r25, r29, r30, + r31, 0.000000f, 0.000000f); + if (global_thread_idx < problem_size) { + r32 = r29 * r16; + r32 = fma(r8, r32, r25 * r0); + r28 = fma(r6, r32, r28); + r32 = r25 * r17; + r33 = r29 * r18; + r33 = fma(r8, r33, r12 * r32); + r33 = fma(r6, r33, r22); + r22 = r15 * r6; + r20 = fma(r19, r20, r27); + r22 = r22 * r20; + r22 = fma(r10, r22, r19 * r11); + r11 = r4 * r22; + r19 = r5 * r20; + r19 = fma(r10, r19, r14 * r11); + r33 = fma(r6, r19, r33); + WriteIdx2<64, double, double, double2>(eq_marked, 4 * eq_marked_num_alloc, + global_thread_idx * eq_marked_stride + eq_marked_offset, + r28, r33); + ReadIdx2<64, double, double, double2>(eqk, 6 * eqk_num_alloc, + global_thread_idx * eqk_stride + eqk_offset, r19, r11); + r27 = fma(r1, r26, r23 * r24); + r27 = fma(r6, r27, r19); + }; + ReadAndShuffleWithDefault2<64, double, double, double2>( + (double*)inout_shared, eq, 10 * eq_num_alloc, global_thread_idx * eq_stride + eq_offset, + threadIdx.x == 63, global_thread_idx <= problem_size, eq_num_alloc, eq_stride, r19, r32, r34, + r35, 0.000000f, 0.000000f); + if (global_thread_idx < problem_size) { + r36 = r32 * r16; + r36 = fma(r8, r36, r19 * r0); + r27 = fma(r6, r36, r27); + r36 = r19 * r17; + r37 = r32 * r18; + r37 = fma(r8, r37, r12 * r36); + r37 = fma(r6, r37, r11); + r11 = r23 * r22; + r36 = r1 * r20; + r36 = fma(r10, r36, r14 * r11); + r37 = fma(r6, r36, r37); + WriteIdx2<64, double, double, double2>(eq_marked, 6 * eq_marked_num_alloc, + global_thread_idx * eq_marked_stride + eq_marked_offset, + r27, r37); + r36 = r30 * r6; + r36 = fma(r31, r21, r24 * r36); + r11 = r30 * r6; + r11 = r11 * r22; + r38 = r31 * r6; + r38 = r38 * r20; + r38 = fma(r10, r38, r14 * r11); + WriteIdx2<64, double, double, double2>(eq_marked, 8 * eq_marked_num_alloc, + global_thread_idx * eq_marked_stride + eq_marked_offset, + r36, r38); + r38 = r34 * r6; + r21 = fma(r35, r21, r24 * r38); + r38 = r34 * r6; + r38 = r38 * r22; + r36 = r35 * r6; + r36 = r36 * r20; + r36 = fma(r10, r36, r14 * r38); + WriteIdx2<64, double, double, double2>(eq_marked, 10 * eq_marked_num_alloc, + global_thread_idx * eq_marked_stride + eq_marked_offset, + r21, r36); + ReadIdx2<64, double, double, double2>(eqk, 12 * eqk_num_alloc, + global_thread_idx * eqk_stride + eqk_offset, r36, r21); + }; + ReadAndShuffleWithDefault2<64, double, double, double2>( + (double*)inout_shared, eq, 12 * eq_num_alloc, global_thread_idx * eq_stride + eq_offset, + threadIdx.x == 63, global_thread_idx <= problem_size, eq_num_alloc, eq_stride, r38, r11, r39, + r40, 0.000000f, 0.000000f); + if (global_thread_idx < problem_size) { + r41 = r11 * r16; + r41 = fma(r8, r41, r38 * r0); + r41 = fma(r6, r41, r36); + r26 = fma(r40, r26, r39 * r24); + r41 = fma(r6, r26, r41); + r26 = r39 * r22; + r24 = r40 * r20; + r24 = fma(r10, r24, r14 * r26); + r24 = fma(r6, r24, r21); + r21 = r38 * r17; + r26 = r11 * r18; + r26 = fma(r8, r26, r12 * r21); + r24 = fma(r6, r26, r24); + WriteIdx2<64, double, double, double2>(eq_marked, 12 * eq_marked_num_alloc, + global_thread_idx * eq_marked_stride + eq_marked_offset, + r41, r24); + ReadIdx2<64, double, double, double2>(eqk, 14 * eqk_num_alloc, + global_thread_idx * eqk_stride + eqk_offset, r24, r41); + r41 = 1.00000000000000000e+00; + r24 = 1.0 / r28; + r24 = r33 * r24; + WriteIdx2<64, double, double, double2>(eq_marked, 14 * eq_marked_num_alloc, + global_thread_idx * eq_marked_stride + eq_marked_offset, + r41, r24); + ReadIdx2<64, double, double, double2>(eqk, 16 * eqk_num_alloc, + global_thread_idx * eqk_stride + eqk_offset, r33, r26); + WriteIdx2<64, double, double, double2>(eq_marked, 16 * eq_marked_num_alloc, + global_thread_idx * eq_marked_stride + eq_marked_offset, + r41, r28); + ReadIdx2<64, double, double, double2>(eqk, 18 * eqk_num_alloc, + global_thread_idx * eqk_stride + eqk_offset, r28, r41); + r41 = r6 * r27; + r41 = fma(r24, r41, r37); + WriteIdx2<64, double, double, double2>(eq_marked, 18 * eq_marked_num_alloc, + global_thread_idx * eq_marked_stride + eq_marked_offset, + r27, r41); + }; +} + +void ChainACyclicReductionDown(double* eqk, unsigned int eqk_num_alloc, int eqk_offset, + int eqk_stride, double* const eq, unsigned int eq_num_alloc, + int eq_offset, int eq_stride, double* eq_marked, + unsigned int eq_marked_num_alloc, int eq_marked_offset, + int eq_marked_stride, size_t problem_size) { + if (problem_size == 0) { + return; + } + + const int n_blocks = (problem_size + 64 - 1) / 64; + // Kernels using more than 48 KB of shared memory per block must opt in. + static const cudaError_t attribute_error = cudaFuncSetAttribute( + ChainACyclicReductionDownKernel, cudaFuncAttributeMaxDynamicSharedMemorySize, 1024); + if (attribute_error != cudaSuccess) { + throw std::runtime_error(std::string("ChainACyclicReductionDownKernel: ") + + cudaGetErrorString(attribute_error)); + } + ChainACyclicReductionDownKernel<<>>( + eqk, eqk_num_alloc, eqk_offset, eqk_stride, eq, eq_num_alloc, eq_offset, eq_stride, eq_marked, + eq_marked_num_alloc, eq_marked_offset, eq_marked_stride, problem_size); + // A launch that fails (e.g. from exceeding shared memory or register limits) + // otherwise leaves its outputs untouched without any error. + const cudaError_t launch_error = cudaGetLastError(); + if (launch_error != cudaSuccess) { + throw std::runtime_error(std::string("ChainACyclicReductionDownKernel launch failed: ") + + cudaGetErrorString(launch_error)); + } +} + +} // namespace caspar \ No newline at end of file diff --git a/test/symforce_function_codegen_test_data/symengine/symforce_caspar_tridiagonal_test/kernel_ChainA_cyclic_reduction_down.h b/test/symforce_function_codegen_test_data/symengine/symforce_caspar_tridiagonal_test/kernel_ChainA_cyclic_reduction_down.h new file mode 100644 index 00000000..ce406fc6 --- /dev/null +++ b/test/symforce_function_codegen_test_data/symengine/symforce_caspar_tridiagonal_test/kernel_ChainA_cyclic_reduction_down.h @@ -0,0 +1,15 @@ +#pragma once + +#include + +#include "shared_indices.h" + +namespace caspar { + +void ChainACyclicReductionDown(double* eqk, unsigned int eqk_num_alloc, int eqk_offset, + int eqk_stride, double* const eq, unsigned int eq_num_alloc, + int eq_offset, int eq_stride, double* eq_marked, + unsigned int eq_marked_num_alloc, int eq_marked_offset, + int eq_marked_stride, size_t problem_size); + +} // namespace caspar \ No newline at end of file diff --git a/test/symforce_function_codegen_test_data/symengine/symforce_caspar_tridiagonal_test/kernel_ChainA_cyclic_reduction_solve_two.cu b/test/symforce_function_codegen_test_data/symengine/symforce_caspar_tridiagonal_test/kernel_ChainA_cyclic_reduction_solve_two.cu new file mode 100644 index 00000000..b3cca154 --- /dev/null +++ b/test/symforce_function_codegen_test_data/symengine/symforce_caspar_tridiagonal_test/kernel_ChainA_cyclic_reduction_solve_two.cu @@ -0,0 +1,199 @@ +#include +#include + +#include +#include +#include +#include +#include + +#include "kernel_ChainA_cyclic_reduction_solve_two.h" +#include "memops.cuh" + +namespace cg = cooperative_groups; + +namespace caspar { + +__global__ void __launch_bounds__(32, 1) ChainACyclicReductionSolveTwoKernel( + double* const eq, unsigned int eq_num_alloc, int eq_offset, int eq_stride, double* solu2km1, + unsigned int solu2km1_num_alloc, int solu2km1_offset, int solu2km1_stride, double* solu2k, + unsigned int solu2k_num_alloc, int solu2k_offset, int solu2k_stride, size_t problem_size) { + const int global_thread_idx = blockIdx.x * blockDim.x + threadIdx.x; + // Scratch data, then the shared indices of each shared accessor; dynamic, so + // that it may exceed the 48 KB static shared memory limit (see the launch + // below). + extern __shared__ __align__(16) uint8_t inout_shared[]; + + double r0 = 0, r1 = 0, r2 = 0, r3 = 0, r4 = 0, r5 = 0, r6 = 0, r7 = 0, r8 = 0, r9 = 0, r10 = 0, + r11 = 0, r12 = 0, r13 = 0, r14 = 0, r15 = 0, r16 = 0, r17 = 0, r18 = 0, r19 = 0, r20 = 0, + r21 = 0, r22 = 0, r23 = 0, r24 = 0, r25 = 0, r26 = 0, r27 = 0, r28 = 0, r29 = 0, r30 = 0, + r31 = 0; + + if (global_thread_idx < problem_size) { + r0 = -1.00000000000000000e+00; + }; + ReadAndShuffleWithDefault2<32, double, double, double2>( + (double*)inout_shared, eq, 8 * eq_num_alloc, global_thread_idx * eq_stride + eq_offset, + threadIdx.x == 31, global_thread_idx <= problem_size, eq_num_alloc, eq_stride, r1, r2, r3, r4, + 0.000000f, 0.000000f); + ReadAndShuffleWithDefault2<32, double, double, double2>( + (double*)inout_shared, eq, 14 * eq_num_alloc, global_thread_idx * eq_stride + eq_offset, + threadIdx.x == 31, global_thread_idx <= problem_size, eq_num_alloc, eq_stride, r4, r3, r5, r6, + 1.000000f, 0.000000f); + if (global_thread_idx < problem_size) { + r4 = 1.0 / r4; + }; + ReadAndShuffleWithDefault2<32, double, double, double2>( + (double*)inout_shared, eq, 18 * eq_num_alloc, global_thread_idx * eq_stride + eq_offset, + threadIdx.x == 31, global_thread_idx <= problem_size, eq_num_alloc, eq_stride, r7, r8, r9, + r10, 0.000000f, 1.000000f); + if (global_thread_idx < problem_size) { + r3 = r3 * r0; + r3 = r3 * r4; + r2 = fma(r1, r3, r2); + r11 = r7 * r2; + r8 = 1.0 / r8; + }; + ReadAndShuffleWithDefault2<32, double, double, double2>( + (double*)inout_shared, eq, 16 * eq_num_alloc, global_thread_idx * eq_stride + eq_offset, + threadIdx.x == 31, global_thread_idx <= problem_size, eq_num_alloc, eq_stride, r12, r13, r14, + r15, 1.000000f, 1.000000f); + if (global_thread_idx < problem_size) { + r12 = 1.0 / r12; + r12 = r8 * r12; + r8 = r0 * r12; + r11 = fma(r8, r11, r1 * r4); + r1 = r0 * r11; + r13 = 1.0 / r13; + r16 = 1.00000000000000000e+00; + }; + ReadAndShuffleWithDefault2<32, double, double, double2>( + (double*)inout_shared, eq, 2 * eq_num_alloc, global_thread_idx * eq_stride + eq_offset, + threadIdx.x == 31, global_thread_idx <= problem_size, eq_num_alloc, eq_stride, r17, r18, r19, + r20, 0.000000f, 0.000000f); + if (global_thread_idx < problem_size) { + r6 = r6 * r0; + r5 = 1.0 / r5; + r6 = r6 * r5; + r20 = fma(r19, r6, r20); + r18 = r9 * r20; + r14 = 1.0 / r14; + r10 = 1.0 / r10; + r10 = r14 * r10; + r14 = r0 * r10; + r19 = fma(r19, r5, r14 * r18); + r18 = r2 * r19; + r15 = 1.0 / r15; + r18 = r18 * r15; + r18 = fma(r8, r18, r16); + }; + ReadAndShuffleWithDefault2<32, double, double, double2>( + (double*)inout_shared, eq, 0 * eq_num_alloc, global_thread_idx * eq_stride + eq_offset, + threadIdx.x == 31, global_thread_idx <= problem_size, eq_num_alloc, eq_stride, r17, r21, r22, + r23, 0.000000f, 0.000000f); + if (global_thread_idx < problem_size) { + r23 = fma(r22, r6, r23); + r23 = r23 * r14; + r22 = fma(r22, r5, r9 * r23); + r22 = r0 * r22; + r22 = r22 * r13; + r22 = r22 * r15; + r18 = fma(r11, r22, r18); + r18 = 1.0 / r18; + r21 = r19 * r15; + }; + ReadAndShuffleWithDefault2<32, double, double, double2>( + (double*)inout_shared, eq, 10 * eq_num_alloc, global_thread_idx * eq_stride + eq_offset, + threadIdx.x == 31, global_thread_idx <= problem_size, eq_num_alloc, eq_stride, r17, r24, r25, + r26, 0.000000f, 0.000000f); + if (global_thread_idx < problem_size) { + r24 = fma(r17, r3, r24); + r24 = r24 * r8; + r17 = fma(r17, r4, r7 * r24); + r21 = fma(r17, r22, r24 * r21); + r26 = r0 * r21; + r25 = r11 * r13; + r27 = r2 * r20; + r27 = r27 * r8; + r27 = fma(r10, r27, r23 * r25); + r25 = r0 * r27; + }; + ReadAndShuffleWithDefault2<32, double, double, double2>( + (double*)inout_shared, eq, 12 * eq_num_alloc, global_thread_idx * eq_stride + eq_offset, + threadIdx.x == 31, global_thread_idx <= problem_size, eq_num_alloc, eq_stride, r28, r29, r30, + r31, 0.000000f, 0.000000f); + if (global_thread_idx < problem_size) { + r6 = fma(r30, r6, r31); + r31 = r9 * r6; + r31 = fma(r14, r31, r30 * r5); + r3 = fma(r28, r3, r29); + r29 = r19 * r3; + r29 = r29 * r15; + r29 = fma(r8, r29, r31 * r15); + r31 = r7 * r3; + r4 = fma(r28, r4, r8 * r31); + r29 = fma(r4, r22, r29); + r25 = r25 * r29; + r22 = r20 * r3; + r22 = r22 * r8; + r22 = fma(r10, r22, r18 * r25); + r25 = r4 * r13; + r22 = fma(r23, r25, r22); + r22 = fma(r6, r10, r22); + r25 = r17 * r13; + r25 = fma(r23, r25, r16); + r16 = r20 * r10; + r25 = fma(r24, r16, r25); + r23 = r0 * r27; + r23 = r23 * r21; + r25 = fma(r18, r23, r25); + r25 = 1.0 / r25; + r25 = r22 * r25; + r26 = fma(r25, r26, r29); + r26 = r18 * r26; + r1 = r1 * r13; + r1 = fma(r4, r13, r26 * r1); + r18 = r0 * r17; + r18 = r18 * r13; + r1 = fma(r25, r18, r1); + r12 = fma(r3, r12, r25 * r24); + r24 = r2 * r8; + r12 = fma(r26, r24, r12); + WriteIdx2<32, double, double, double2>(solu2km1, 0 * solu2km1_num_alloc, + global_thread_idx * solu2km1_stride + solu2km1_offset, + r1, r12); + WriteIdx2<32, double, double, double2>( + solu2k, 0 * solu2k_num_alloc, global_thread_idx * solu2k_stride + solu2k_offset, r26, r25); + }; +} + +void ChainACyclicReductionSolveTwo(double* const eq, unsigned int eq_num_alloc, int eq_offset, + int eq_stride, double* solu2km1, unsigned int solu2km1_num_alloc, + int solu2km1_offset, int solu2km1_stride, double* solu2k, + unsigned int solu2k_num_alloc, int solu2k_offset, + int solu2k_stride, size_t problem_size) { + if (problem_size == 0) { + return; + } + + const int n_blocks = (problem_size + 32 - 1) / 32; + // Kernels using more than 48 KB of shared memory per block must opt in. + static const cudaError_t attribute_error = cudaFuncSetAttribute( + ChainACyclicReductionSolveTwoKernel, cudaFuncAttributeMaxDynamicSharedMemorySize, 512); + if (attribute_error != cudaSuccess) { + throw std::runtime_error(std::string("ChainACyclicReductionSolveTwoKernel: ") + + cudaGetErrorString(attribute_error)); + } + ChainACyclicReductionSolveTwoKernel<<>>( + eq, eq_num_alloc, eq_offset, eq_stride, solu2km1, solu2km1_num_alloc, solu2km1_offset, + solu2km1_stride, solu2k, solu2k_num_alloc, solu2k_offset, solu2k_stride, problem_size); + // A launch that fails (e.g. from exceeding shared memory or register limits) + // otherwise leaves its outputs untouched without any error. + const cudaError_t launch_error = cudaGetLastError(); + if (launch_error != cudaSuccess) { + throw std::runtime_error(std::string("ChainACyclicReductionSolveTwoKernel launch failed: ") + + cudaGetErrorString(launch_error)); + } +} + +} // namespace caspar \ No newline at end of file diff --git a/test/symforce_function_codegen_test_data/symengine/symforce_caspar_tridiagonal_test/kernel_ChainA_cyclic_reduction_solve_two.h b/test/symforce_function_codegen_test_data/symengine/symforce_caspar_tridiagonal_test/kernel_ChainA_cyclic_reduction_solve_two.h new file mode 100644 index 00000000..06a5d1c6 --- /dev/null +++ b/test/symforce_function_codegen_test_data/symengine/symforce_caspar_tridiagonal_test/kernel_ChainA_cyclic_reduction_solve_two.h @@ -0,0 +1,15 @@ +#pragma once + +#include + +#include "shared_indices.h" + +namespace caspar { + +void ChainACyclicReductionSolveTwo(double* const eq, unsigned int eq_num_alloc, int eq_offset, + int eq_stride, double* solu2km1, unsigned int solu2km1_num_alloc, + int solu2km1_offset, int solu2km1_stride, double* solu2k, + unsigned int solu2k_num_alloc, int solu2k_offset, + int solu2k_stride, size_t problem_size); + +} // namespace caspar \ No newline at end of file diff --git a/test/symforce_function_codegen_test_data/symengine/symforce_caspar_tridiagonal_test/kernel_ChainA_cyclic_reduction_up.cu b/test/symforce_function_codegen_test_data/symengine/symforce_caspar_tridiagonal_test/kernel_ChainA_cyclic_reduction_up.cu new file mode 100644 index 00000000..4528c2a3 --- /dev/null +++ b/test/symforce_function_codegen_test_data/symengine/symforce_caspar_tridiagonal_test/kernel_ChainA_cyclic_reduction_up.cu @@ -0,0 +1,107 @@ +#include +#include + +#include +#include +#include +#include +#include + +#include "kernel_ChainA_cyclic_reduction_up.h" +#include "memops.cuh" + +namespace cg = cooperative_groups; + +namespace caspar { + +__global__ void __launch_bounds__(32, 1) + ChainACyclicReductionUpKernel(double* eqk, unsigned int eqk_num_alloc, int eqk_offset, + int eqk_stride, double* const x, unsigned int x_num_alloc, + int x_offset, int x_stride, double* soluk, + unsigned int soluk_num_alloc, int soluk_offset, int soluk_stride, + size_t problem_size) { + const int global_thread_idx = blockIdx.x * blockDim.x + threadIdx.x; + // Scratch data, then the shared indices of each shared accessor; dynamic, so + // that it may exceed the 48 KB static shared memory limit (see the launch + // below). + extern __shared__ __align__(16) uint8_t inout_shared[]; + + double r0 = 0, r1 = 0, r2 = 0, r3 = 0, r4 = 0, r5 = 0, r6 = 0, r7 = 0, r8 = 0, r9 = 0, r10 = 0, + r11 = 0, r12 = 0, r13 = 0, r14 = 0; + ReadAndShuffleWithDefault2<32, double, double, double2>( + (double*)inout_shared, x, 0 * x_num_alloc, global_thread_idx * x_stride + x_offset, + threadIdx.x == 31, global_thread_idx <= problem_size, x_num_alloc, x_stride, r0, r1, r2, r3, + 0.000000f, 0.000000f); + if (global_thread_idx < problem_size) { + ReadIdx2<32, double, double, double2>(eqk, 12 * eqk_num_alloc, + global_thread_idx * eqk_stride + eqk_offset, r4, r5); + r6 = -1.00000000000000000e+00; + ReadIdx2<32, double, double, double2>(eqk, 0 * eqk_num_alloc, + global_thread_idx * eqk_stride + eqk_offset, r7, r8); + ReadIdx2<32, double, double, double2>(eqk, 2 * eqk_num_alloc, + global_thread_idx * eqk_stride + eqk_offset, r9, r10); + r10 = fma(r10, r1, r8 * r0); + r10 = fma(r6, r10, r5); + ReadIdx2<32, double, double, double2>(eqk, 10 * eqk_num_alloc, + global_thread_idx * eqk_stride + eqk_offset, r5, r8); + ReadIdx2<32, double, double, double2>(eqk, 8 * eqk_num_alloc, + global_thread_idx * eqk_stride + eqk_offset, r11, r12); + r12 = fma(r12, r2, r8 * r3); + ReadIdx2<32, double, double, double2>(eqk, 14 * eqk_num_alloc, + global_thread_idx * eqk_stride + eqk_offset, r8, r13); + r14 = r13 * r6; + r0 = fma(r7, r0, r9 * r1); + r0 = fma(r6, r0, r4); + r2 = fma(r11, r2, r5 * r3); + r0 = fma(r6, r2, r0); + r8 = 1.0 / r8; + r8 = r0 * r8; + r10 = fma(r8, r14, r10); + r10 = fma(r6, r12, r10); + ReadIdx2<32, double, double, double2>(eqk, 16 * eqk_num_alloc, + global_thread_idx * eqk_stride + eqk_offset, r14, r12); + r14 = 1.0 / r14; + r14 = r10 * r14; + ReadIdx2<32, double, double, double2>(eqk, 18 * eqk_num_alloc, + global_thread_idx * eqk_stride + eqk_offset, r10, r0); + r0 = 1.0 / r0; + r14 = r14 * r0; + r0 = r10 * r6; + r0 = fma(r14, r0, r8); + r12 = 1.0 / r12; + r12 = r0 * r12; + WriteIdx2<32, double, double, double2>( + soluk, 0 * soluk_num_alloc, global_thread_idx * soluk_stride + soluk_offset, r12, r14); + }; +} + +void ChainACyclicReductionUp(double* eqk, unsigned int eqk_num_alloc, int eqk_offset, + int eqk_stride, double* const x, unsigned int x_num_alloc, + int x_offset, int x_stride, double* soluk, + unsigned int soluk_num_alloc, int soluk_offset, int soluk_stride, + size_t problem_size) { + if (problem_size == 0) { + return; + } + + const int n_blocks = (problem_size + 32 - 1) / 32; + // Kernels using more than 48 KB of shared memory per block must opt in. + static const cudaError_t attribute_error = cudaFuncSetAttribute( + ChainACyclicReductionUpKernel, cudaFuncAttributeMaxDynamicSharedMemorySize, 512); + if (attribute_error != cudaSuccess) { + throw std::runtime_error(std::string("ChainACyclicReductionUpKernel: ") + + cudaGetErrorString(attribute_error)); + } + ChainACyclicReductionUpKernel<<>>( + eqk, eqk_num_alloc, eqk_offset, eqk_stride, x, x_num_alloc, x_offset, x_stride, soluk, + soluk_num_alloc, soluk_offset, soluk_stride, problem_size); + // A launch that fails (e.g. from exceeding shared memory or register limits) + // otherwise leaves its outputs untouched without any error. + const cudaError_t launch_error = cudaGetLastError(); + if (launch_error != cudaSuccess) { + throw std::runtime_error(std::string("ChainACyclicReductionUpKernel launch failed: ") + + cudaGetErrorString(launch_error)); + } +} + +} // namespace caspar \ No newline at end of file diff --git a/test/symforce_function_codegen_test_data/symengine/symforce_caspar_tridiagonal_test/kernel_ChainA_cyclic_reduction_up.h b/test/symforce_function_codegen_test_data/symengine/symforce_caspar_tridiagonal_test/kernel_ChainA_cyclic_reduction_up.h new file mode 100644 index 00000000..39ef29d7 --- /dev/null +++ b/test/symforce_function_codegen_test_data/symengine/symforce_caspar_tridiagonal_test/kernel_ChainA_cyclic_reduction_up.h @@ -0,0 +1,15 @@ +#pragma once + +#include + +#include "shared_indices.h" + +namespace caspar { + +void ChainACyclicReductionUp(double* eqk, unsigned int eqk_num_alloc, int eqk_offset, + int eqk_stride, double* const x, unsigned int x_num_alloc, + int x_offset, int x_stride, double* soluk, + unsigned int soluk_num_alloc, int soluk_offset, int soluk_stride, + size_t problem_size); + +} // namespace caspar \ No newline at end of file diff --git a/test/symforce_function_codegen_test_data/symengine/symforce_caspar_tridiagonal_test/kernel_ChainA_normalize.cu b/test/symforce_function_codegen_test_data/symengine/symforce_caspar_tridiagonal_test/kernel_ChainA_normalize.cu new file mode 100644 index 00000000..79c73bb1 --- /dev/null +++ b/test/symforce_function_codegen_test_data/symengine/symforce_caspar_tridiagonal_test/kernel_ChainA_normalize.cu @@ -0,0 +1,92 @@ +#include +#include + +#include +#include +#include +#include +#include + +#include "kernel_ChainA_normalize.h" +#include "memops.cuh" + +namespace cg = cooperative_groups; + +namespace caspar { + +__global__ void __launch_bounds__(1024, 1) + ChainANormalizeKernel(double* precond_diag, unsigned int precond_diag_num_alloc, + double* precond_tril, unsigned int precond_tril_num_alloc, double* njtr, + unsigned int njtr_num_alloc, const double* const diag, + double* out_normalized, unsigned int out_normalized_num_alloc, + size_t problem_size) { + const int global_thread_idx = blockIdx.x * blockDim.x + threadIdx.x; + // Scratch data, then the shared indices of each shared accessor; dynamic, so + // that it may exceed the 48 KB static shared memory limit (see the launch + // below). + extern __shared__ __align__(16) uint8_t inout_shared[]; + + double r0 = 0, r1 = 0, r2 = 0, r3 = 0, r4 = 0, r5 = 0, r6 = 0, r7 = 0, r8 = 0; + + if (global_thread_idx < problem_size) { + ReadIdx2<1024, double, double, double2>(njtr, 0 * njtr_num_alloc, global_thread_idx, r0, r1); + ReadIdx1<1024, double, double, double>(precond_tril, 0 * precond_tril_num_alloc, + global_thread_idx, r2); + r3 = -1.00000000000000000e+00; + r3 = r2 * r3; + ReadIdx2<1024, double, double, double2>(precond_diag, 0 * precond_diag_num_alloc, + global_thread_idx, r4, r5); + }; + LoadUnique<1, double, double>(diag, 0, (double*)inout_shared); + if (global_thread_idx < problem_size) { + ReadShared1((double*)inout_shared, 0, r6); + }; + __syncthreads(); + if (global_thread_idx < problem_size) { + r7 = 1.00000000000000000e+00; + r7 = r6 + r7; + r8 = 2.22044604925031308e-15; + r8 = r6 * r8; + r4 = fma(r4, r7, r8); + r4 = 1.0 / r4; + r3 = r3 * r4; + r1 = fma(r0, r3, r1); + r7 = fma(r5, r7, r8); + r7 = fma(r2, r3, r7); + r7 = 1.0 / r7; + r7 = r1 * r7; + r4 = fma(r0, r4, r3 * r7); + WriteIdx2<1024, double, double, double2>(out_normalized, 0 * out_normalized_num_alloc, + global_thread_idx, r4, r7); + }; +} + +void ChainANormalize(double* precond_diag, unsigned int precond_diag_num_alloc, + double* precond_tril, unsigned int precond_tril_num_alloc, double* njtr, + unsigned int njtr_num_alloc, const double* const diag, double* out_normalized, + unsigned int out_normalized_num_alloc, size_t problem_size) { + if (problem_size == 0) { + return; + } + + const int n_blocks = (problem_size + 1024 - 1) / 1024; + // Kernels using more than 48 KB of shared memory per block must opt in. + static const cudaError_t attribute_error = cudaFuncSetAttribute( + ChainANormalizeKernel, cudaFuncAttributeMaxDynamicSharedMemorySize, 8192); + if (attribute_error != cudaSuccess) { + throw std::runtime_error(std::string("ChainANormalizeKernel: ") + + cudaGetErrorString(attribute_error)); + } + ChainANormalizeKernel<<>>( + precond_diag, precond_diag_num_alloc, precond_tril, precond_tril_num_alloc, njtr, + njtr_num_alloc, diag, out_normalized, out_normalized_num_alloc, problem_size); + // A launch that fails (e.g. from exceeding shared memory or register limits) + // otherwise leaves its outputs untouched without any error. + const cudaError_t launch_error = cudaGetLastError(); + if (launch_error != cudaSuccess) { + throw std::runtime_error(std::string("ChainANormalizeKernel launch failed: ") + + cudaGetErrorString(launch_error)); + } +} + +} // namespace caspar \ No newline at end of file diff --git a/test/symforce_function_codegen_test_data/symengine/symforce_caspar_tridiagonal_test/kernel_ChainA_normalize.h b/test/symforce_function_codegen_test_data/symengine/symforce_caspar_tridiagonal_test/kernel_ChainA_normalize.h new file mode 100644 index 00000000..89f4215b --- /dev/null +++ b/test/symforce_function_codegen_test_data/symengine/symforce_caspar_tridiagonal_test/kernel_ChainA_normalize.h @@ -0,0 +1,14 @@ +#pragma once + +#include + +#include "shared_indices.h" + +namespace caspar { + +void ChainANormalize(double* precond_diag, unsigned int precond_diag_num_alloc, + double* precond_tril, unsigned int precond_tril_num_alloc, double* njtr, + unsigned int njtr_num_alloc, const double* const diag, double* out_normalized, + unsigned int out_normalized_num_alloc, size_t problem_size); + +} // namespace caspar \ No newline at end of file diff --git a/test/symforce_function_codegen_test_data/symengine/symforce_caspar_tridiagonal_test/kernel_ChainA_pred_decrease_times_two.cu b/test/symforce_function_codegen_test_data/symengine/symforce_caspar_tridiagonal_test/kernel_ChainA_pred_decrease_times_two.cu new file mode 100644 index 00000000..f65466e3 --- /dev/null +++ b/test/symforce_function_codegen_test_data/symengine/symforce_caspar_tridiagonal_test/kernel_ChainA_pred_decrease_times_two.cu @@ -0,0 +1,86 @@ +#include +#include + +#include +#include +#include +#include +#include + +#include "kernel_ChainA_pred_decrease_times_two.h" +#include "memops.cuh" + +namespace cg = cooperative_groups; + +namespace caspar { + +__global__ void __launch_bounds__(1024, 1) ChainAPredDecreaseTimesTwoKernel( + double* ChainA_step, unsigned int ChainA_step_num_alloc, double* ChainA_precond_diag, + unsigned int ChainA_precond_diag_num_alloc, const double* const diag, double* ChainA_njtr, + unsigned int ChainA_njtr_num_alloc, double* const out_ChainA_pred_dec, size_t problem_size) { + const int global_thread_idx = blockIdx.x * blockDim.x + threadIdx.x; + // Scratch data, then the shared indices of each shared accessor; dynamic, so + // that it may exceed the 48 KB static shared memory limit (see the launch + // below). + extern __shared__ __align__(16) uint8_t inout_shared[]; + + __shared__ double out_ChainA_pred_dec_local[1]; + + double r0 = 0, r1 = 0, r2 = 0, r3 = 0, r4 = 0, r5 = 0, r6 = 0, r7 = 0; + + if (global_thread_idx < problem_size) { + ReadIdx2<1024, double, double, double2>(ChainA_step, 0 * ChainA_step_num_alloc, + global_thread_idx, r0, r1); + ReadIdx2<1024, double, double, double2>(ChainA_njtr, 0 * ChainA_njtr_num_alloc, + global_thread_idx, r2, r3); + ReadIdx2<1024, double, double, double2>(ChainA_precond_diag, 0 * ChainA_precond_diag_num_alloc, + global_thread_idx, r4, r5); + r6 = r0 * r4; + }; + LoadUnique<1, double, double>(diag, 0, (double*)inout_shared); + if (global_thread_idx < problem_size) { + ReadShared1((double*)inout_shared, 0, r7); + }; + __syncthreads(); + if (global_thread_idx < problem_size) { + r6 = fma(r7, r6, r2); + r2 = r1 * r5; + r2 = fma(r7, r2, r3); + r2 = fma(r1, r2, r0 * r6); + }; + SumStore(out_ChainA_pred_dec_local, (double*)inout_shared, 0, + global_thread_idx < problem_size, r2); + SumFlushFinal(out_ChainA_pred_dec_local, out_ChainA_pred_dec, 1); +} + +void ChainAPredDecreaseTimesTwo(double* ChainA_step, unsigned int ChainA_step_num_alloc, + double* ChainA_precond_diag, + unsigned int ChainA_precond_diag_num_alloc, + const double* const diag, double* ChainA_njtr, + unsigned int ChainA_njtr_num_alloc, + double* const out_ChainA_pred_dec, size_t problem_size) { + if (problem_size == 0) { + return; + } + + const int n_blocks = (problem_size + 1024 - 1) / 1024; + // Kernels using more than 48 KB of shared memory per block must opt in. + static const cudaError_t attribute_error = cudaFuncSetAttribute( + ChainAPredDecreaseTimesTwoKernel, cudaFuncAttributeMaxDynamicSharedMemorySize, 8192); + if (attribute_error != cudaSuccess) { + throw std::runtime_error(std::string("ChainAPredDecreaseTimesTwoKernel: ") + + cudaGetErrorString(attribute_error)); + } + ChainAPredDecreaseTimesTwoKernel<<>>( + ChainA_step, ChainA_step_num_alloc, ChainA_precond_diag, ChainA_precond_diag_num_alloc, diag, + ChainA_njtr, ChainA_njtr_num_alloc, out_ChainA_pred_dec, problem_size); + // A launch that fails (e.g. from exceeding shared memory or register limits) + // otherwise leaves its outputs untouched without any error. + const cudaError_t launch_error = cudaGetLastError(); + if (launch_error != cudaSuccess) { + throw std::runtime_error(std::string("ChainAPredDecreaseTimesTwoKernel launch failed: ") + + cudaGetErrorString(launch_error)); + } +} + +} // namespace caspar \ No newline at end of file diff --git a/test/symforce_function_codegen_test_data/symengine/symforce_caspar_tridiagonal_test/kernel_ChainA_pred_decrease_times_two.h b/test/symforce_function_codegen_test_data/symengine/symforce_caspar_tridiagonal_test/kernel_ChainA_pred_decrease_times_two.h new file mode 100644 index 00000000..e4dce58f --- /dev/null +++ b/test/symforce_function_codegen_test_data/symengine/symforce_caspar_tridiagonal_test/kernel_ChainA_pred_decrease_times_two.h @@ -0,0 +1,16 @@ +#pragma once + +#include + +#include "shared_indices.h" + +namespace caspar { + +void ChainAPredDecreaseTimesTwo(double* ChainA_step, unsigned int ChainA_step_num_alloc, + double* ChainA_precond_diag, + unsigned int ChainA_precond_diag_num_alloc, + const double* const diag, double* ChainA_njtr, + unsigned int ChainA_njtr_num_alloc, + double* const out_ChainA_pred_dec, size_t problem_size); + +} // namespace caspar \ No newline at end of file diff --git a/test/symforce_function_codegen_test_data/symengine/symforce_caspar_tridiagonal_test/kernel_ChainA_retract.cu b/test/symforce_function_codegen_test_data/symengine/symforce_caspar_tridiagonal_test/kernel_ChainA_retract.cu new file mode 100644 index 00000000..840f1547 --- /dev/null +++ b/test/symforce_function_codegen_test_data/symengine/symforce_caspar_tridiagonal_test/kernel_ChainA_retract.cu @@ -0,0 +1,56 @@ +#include +#include + +#include +#include +#include +#include +#include + +#include "kernel_ChainA_retract.h" +#include "memops.cuh" + +namespace cg = cooperative_groups; + +namespace caspar { + +__global__ void __launch_bounds__(1024, 1) + ChainARetractKernel(double* ChainA, unsigned int ChainA_num_alloc, double* delta, + unsigned int delta_num_alloc, double* out_ChainA_retracted, + unsigned int out_ChainA_retracted_num_alloc, size_t problem_size) { + const int global_thread_idx = blockIdx.x * blockDim.x + threadIdx.x; + + double r0 = 0, r1 = 0, r2 = 0, r3 = 0; + + if (global_thread_idx < problem_size) { + ReadIdx2<1024, double, double, double2>(ChainA, 0 * ChainA_num_alloc, global_thread_idx, r0, + r1); + ReadIdx2<1024, double, double, double2>(delta, 0 * delta_num_alloc, global_thread_idx, r2, r3); + r2 = r0 + r2; + r3 = r1 + r3; + WriteIdx2<1024, double, double, double2>( + out_ChainA_retracted, 0 * out_ChainA_retracted_num_alloc, global_thread_idx, r2, r3); + }; +} + +void ChainARetract(double* ChainA, unsigned int ChainA_num_alloc, double* delta, + unsigned int delta_num_alloc, double* out_ChainA_retracted, + unsigned int out_ChainA_retracted_num_alloc, size_t problem_size) { + if (problem_size == 0) { + return; + } + + const int n_blocks = (problem_size + 1024 - 1) / 1024; + ChainARetractKernel<<>>(ChainA, ChainA_num_alloc, delta, delta_num_alloc, + out_ChainA_retracted, out_ChainA_retracted_num_alloc, + problem_size); + // A launch that fails (e.g. from exceeding shared memory or register limits) + // otherwise leaves its outputs untouched without any error. + const cudaError_t launch_error = cudaGetLastError(); + if (launch_error != cudaSuccess) { + throw std::runtime_error(std::string("ChainARetractKernel launch failed: ") + + cudaGetErrorString(launch_error)); + } +} + +} // namespace caspar \ No newline at end of file diff --git a/test/symforce_function_codegen_test_data/symengine/symforce_caspar_tridiagonal_test/kernel_ChainA_retract.h b/test/symforce_function_codegen_test_data/symengine/symforce_caspar_tridiagonal_test/kernel_ChainA_retract.h new file mode 100644 index 00000000..ed36ee7e --- /dev/null +++ b/test/symforce_function_codegen_test_data/symengine/symforce_caspar_tridiagonal_test/kernel_ChainA_retract.h @@ -0,0 +1,13 @@ +#pragma once + +#include + +#include "shared_indices.h" + +namespace caspar { + +void ChainARetract(double* ChainA, unsigned int ChainA_num_alloc, double* delta, + unsigned int delta_num_alloc, double* out_ChainA_retracted, + unsigned int out_ChainA_retracted_num_alloc, size_t problem_size); + +} // namespace caspar \ No newline at end of file diff --git a/test/symforce_function_codegen_test_data/symengine/symforce_caspar_tridiagonal_test/kernel_ChainA_start_w.cu b/test/symforce_function_codegen_test_data/symengine/symforce_caspar_tridiagonal_test/kernel_ChainA_start_w.cu new file mode 100644 index 00000000..8e5a69c0 --- /dev/null +++ b/test/symforce_function_codegen_test_data/symengine/symforce_caspar_tridiagonal_test/kernel_ChainA_start_w.cu @@ -0,0 +1,78 @@ +#include +#include + +#include +#include +#include +#include +#include + +#include "kernel_ChainA_start_w.h" +#include "memops.cuh" + +namespace cg = cooperative_groups; + +namespace caspar { + +__global__ void __launch_bounds__(1024, 1) + ChainAStartWKernel(double* ChainA_precond_diag, unsigned int ChainA_precond_diag_num_alloc, + const double* const diag, double* ChainA_p, unsigned int ChainA_p_num_alloc, + double* out_ChainA_w, unsigned int out_ChainA_w_num_alloc, + size_t problem_size) { + const int global_thread_idx = blockIdx.x * blockDim.x + threadIdx.x; + // Scratch data, then the shared indices of each shared accessor; dynamic, so + // that it may exceed the 48 KB static shared memory limit (see the launch + // below). + extern __shared__ __align__(16) uint8_t inout_shared[]; + + double r0 = 0, r1 = 0, r2 = 0, r3 = 0, r4 = 0; + + if (global_thread_idx < problem_size) { + ReadIdx2<1024, double, double, double2>(ChainA_precond_diag, 0 * ChainA_precond_diag_num_alloc, + global_thread_idx, r0, r1); + }; + LoadUnique<1, double, double>(diag, 0, (double*)inout_shared); + if (global_thread_idx < problem_size) { + ReadShared1((double*)inout_shared, 0, r2); + }; + __syncthreads(); + if (global_thread_idx < problem_size) { + r0 = r0 * r2; + ReadIdx2<1024, double, double, double2>(ChainA_p, 0 * ChainA_p_num_alloc, global_thread_idx, r3, + r4); + r0 = r0 * r3; + r2 = r1 * r2; + r2 = r2 * r4; + WriteIdx2<1024, double, double, double2>(out_ChainA_w, 0 * out_ChainA_w_num_alloc, + global_thread_idx, r0, r2); + }; +} + +void ChainAStartW(double* ChainA_precond_diag, unsigned int ChainA_precond_diag_num_alloc, + const double* const diag, double* ChainA_p, unsigned int ChainA_p_num_alloc, + double* out_ChainA_w, unsigned int out_ChainA_w_num_alloc, size_t problem_size) { + if (problem_size == 0) { + return; + } + + const int n_blocks = (problem_size + 1024 - 1) / 1024; + // Kernels using more than 48 KB of shared memory per block must opt in. + static const cudaError_t attribute_error = + cudaFuncSetAttribute(ChainAStartWKernel, cudaFuncAttributeMaxDynamicSharedMemorySize, 8192); + if (attribute_error != cudaSuccess) { + throw std::runtime_error(std::string("ChainAStartWKernel: ") + + cudaGetErrorString(attribute_error)); + } + ChainAStartWKernel<<>>(ChainA_precond_diag, ChainA_precond_diag_num_alloc, + diag, ChainA_p, ChainA_p_num_alloc, out_ChainA_w, + out_ChainA_w_num_alloc, problem_size); + // A launch that fails (e.g. from exceeding shared memory or register limits) + // otherwise leaves its outputs untouched without any error. + const cudaError_t launch_error = cudaGetLastError(); + if (launch_error != cudaSuccess) { + throw std::runtime_error(std::string("ChainAStartWKernel launch failed: ") + + cudaGetErrorString(launch_error)); + } +} + +} // namespace caspar \ No newline at end of file diff --git a/test/symforce_function_codegen_test_data/symengine/symforce_caspar_tridiagonal_test/kernel_ChainA_start_w.h b/test/symforce_function_codegen_test_data/symengine/symforce_caspar_tridiagonal_test/kernel_ChainA_start_w.h new file mode 100644 index 00000000..e64ad145 --- /dev/null +++ b/test/symforce_function_codegen_test_data/symengine/symforce_caspar_tridiagonal_test/kernel_ChainA_start_w.h @@ -0,0 +1,13 @@ +#pragma once + +#include + +#include "shared_indices.h" + +namespace caspar { + +void ChainAStartW(double* ChainA_precond_diag, unsigned int ChainA_precond_diag_num_alloc, + const double* const diag, double* ChainA_p, unsigned int ChainA_p_num_alloc, + double* out_ChainA_w, unsigned int out_ChainA_w_num_alloc, size_t problem_size); + +} // namespace caspar \ No newline at end of file diff --git a/test/symforce_function_codegen_test_data/symengine/symforce_caspar_tridiagonal_test/kernel_ChainA_start_w_contribute.cu b/test/symforce_function_codegen_test_data/symengine/symforce_caspar_tridiagonal_test/kernel_ChainA_start_w_contribute.cu new file mode 100644 index 00000000..a6b6817b --- /dev/null +++ b/test/symforce_function_codegen_test_data/symengine/symforce_caspar_tridiagonal_test/kernel_ChainA_start_w_contribute.cu @@ -0,0 +1,80 @@ +#include +#include + +#include +#include +#include +#include +#include + +#include "kernel_ChainA_start_w_contribute.h" +#include "memops.cuh" + +namespace cg = cooperative_groups; + +namespace caspar { + +__global__ void __launch_bounds__(1024, 1) + ChainAStartWContributeKernel(double* ChainA_precond_diag, + unsigned int ChainA_precond_diag_num_alloc, + const double* const diag, double* ChainA_p, + unsigned int ChainA_p_num_alloc, double* out_ChainA_w, + unsigned int out_ChainA_w_num_alloc, size_t problem_size) { + const int global_thread_idx = blockIdx.x * blockDim.x + threadIdx.x; + // Scratch data, then the shared indices of each shared accessor; dynamic, so + // that it may exceed the 48 KB static shared memory limit (see the launch + // below). + extern __shared__ __align__(16) uint8_t inout_shared[]; + + double r0 = 0, r1 = 0, r2 = 0, r3 = 0, r4 = 0; + + if (global_thread_idx < problem_size) { + ReadIdx2<1024, double, double, double2>(ChainA_precond_diag, 0 * ChainA_precond_diag_num_alloc, + global_thread_idx, r0, r1); + }; + LoadUnique<1, double, double>(diag, 0, (double*)inout_shared); + if (global_thread_idx < problem_size) { + ReadShared1((double*)inout_shared, 0, r2); + }; + __syncthreads(); + if (global_thread_idx < problem_size) { + r0 = r0 * r2; + ReadIdx2<1024, double, double, double2>(ChainA_p, 0 * ChainA_p_num_alloc, global_thread_idx, r3, + r4); + r0 = r0 * r3; + r2 = r1 * r2; + r2 = r2 * r4; + AddIdx2<1024, double, double, double2>(out_ChainA_w, 0 * out_ChainA_w_num_alloc, + global_thread_idx, r0, r2); + }; +} + +void ChainAStartWContribute(double* ChainA_precond_diag, unsigned int ChainA_precond_diag_num_alloc, + const double* const diag, double* ChainA_p, + unsigned int ChainA_p_num_alloc, double* out_ChainA_w, + unsigned int out_ChainA_w_num_alloc, size_t problem_size) { + if (problem_size == 0) { + return; + } + + const int n_blocks = (problem_size + 1024 - 1) / 1024; + // Kernels using more than 48 KB of shared memory per block must opt in. + static const cudaError_t attribute_error = cudaFuncSetAttribute( + ChainAStartWContributeKernel, cudaFuncAttributeMaxDynamicSharedMemorySize, 8192); + if (attribute_error != cudaSuccess) { + throw std::runtime_error(std::string("ChainAStartWContributeKernel: ") + + cudaGetErrorString(attribute_error)); + } + ChainAStartWContributeKernel<<>>( + ChainA_precond_diag, ChainA_precond_diag_num_alloc, diag, ChainA_p, ChainA_p_num_alloc, + out_ChainA_w, out_ChainA_w_num_alloc, problem_size); + // A launch that fails (e.g. from exceeding shared memory or register limits) + // otherwise leaves its outputs untouched without any error. + const cudaError_t launch_error = cudaGetLastError(); + if (launch_error != cudaSuccess) { + throw std::runtime_error(std::string("ChainAStartWContributeKernel launch failed: ") + + cudaGetErrorString(launch_error)); + } +} + +} // namespace caspar \ No newline at end of file diff --git a/test/symforce_function_codegen_test_data/symengine/symforce_caspar_tridiagonal_test/kernel_ChainA_start_w_contribute.h b/test/symforce_function_codegen_test_data/symengine/symforce_caspar_tridiagonal_test/kernel_ChainA_start_w_contribute.h new file mode 100644 index 00000000..31df0106 --- /dev/null +++ b/test/symforce_function_codegen_test_data/symengine/symforce_caspar_tridiagonal_test/kernel_ChainA_start_w_contribute.h @@ -0,0 +1,14 @@ +#pragma once + +#include + +#include "shared_indices.h" + +namespace caspar { + +void ChainAStartWContribute(double* ChainA_precond_diag, unsigned int ChainA_precond_diag_num_alloc, + const double* const diag, double* ChainA_p, + unsigned int ChainA_p_num_alloc, double* out_ChainA_w, + unsigned int out_ChainA_w_num_alloc, size_t problem_size); + +} // namespace caspar \ No newline at end of file diff --git a/test/symforce_function_codegen_test_data/symengine/symforce_caspar_tridiagonal_test/kernel_ChainA_tridig_make_eq.cu b/test/symforce_function_codegen_test_data/symengine/symforce_caspar_tridiagonal_test/kernel_ChainA_tridig_make_eq.cu new file mode 100644 index 00000000..a0781406 --- /dev/null +++ b/test/symforce_function_codegen_test_data/symengine/symforce_caspar_tridiagonal_test/kernel_ChainA_tridig_make_eq.cu @@ -0,0 +1,109 @@ +#include +#include + +#include +#include +#include +#include +#include + +#include "kernel_ChainA_tridig_make_eq.h" +#include "memops.cuh" + +namespace cg = cooperative_groups; + +namespace caspar { + +__global__ void __launch_bounds__(1024, 1) + ChainATridigMakeEqKernel(double* precond_diag, unsigned int precond_diag_num_alloc, + double* precond_tril, unsigned int precond_tril_num_alloc, + double* const tridig_U, unsigned int tridig_U_num_alloc, + int tridig_U_offset, int tridig_U_stride, double* njtr, + unsigned int njtr_num_alloc, const double* const diag, double* eq, + unsigned int eq_num_alloc, size_t problem_size) { + const int global_thread_idx = blockIdx.x * blockDim.x + threadIdx.x; + // Scratch data, then the shared indices of each shared accessor; dynamic, so + // that it may exceed the 48 KB static shared memory limit (see the launch + // below). + extern __shared__ __align__(16) uint8_t inout_shared[]; + + double r0 = 0, r1 = 0, r2 = 0, r3 = 0, r4 = 0, r5 = 0, r6 = 0, r7 = 0, r8 = 0, r9 = 0, r10 = 0; + ReadAndShuffleWithDefault2<1024, double, double, double2>( + (double*)inout_shared, tridig_U, 0 * tridig_U_num_alloc, + global_thread_idx * tridig_U_stride + tridig_U_offset, threadIdx.x == 1023, + global_thread_idx <= problem_size, tridig_U_num_alloc, tridig_U_stride, r0, r1, r2, r3, + 0.000000f, 0.000000f); + ReadAndShuffleWithDefault2<1024, double, double, double2>( + (double*)inout_shared, tridig_U, 2 * tridig_U_num_alloc, + global_thread_idx * tridig_U_stride + tridig_U_offset, threadIdx.x == 1023, + global_thread_idx <= problem_size, tridig_U_num_alloc, tridig_U_stride, r4, r5, r6, r7, + 0.000000f, 0.000000f); + if (global_thread_idx < problem_size) { + WriteIdx2<1024, double, double, double2>(eq, 0 * eq_num_alloc, global_thread_idx, r0, r4); + WriteIdx2<1024, double, double, double2>(eq, 2 * eq_num_alloc, global_thread_idx, r1, r5); + ReadIdx1<1024, double, double, double>(precond_tril, 0 * precond_tril_num_alloc, + global_thread_idx, r5); + ReadIdx2<1024, double, double, double2>(precond_diag, 0 * precond_diag_num_alloc, + global_thread_idx, r1, r4); + }; + LoadUnique<1, double, double>(diag, 0, (double*)inout_shared); + if (global_thread_idx < problem_size) { + ReadShared1((double*)inout_shared, 0, r0); + }; + __syncthreads(); + if (global_thread_idx < problem_size) { + r8 = 1.00000000000000000e+00; + r9 = r0 + r8; + r10 = 2.22044604925031308e-15; + r10 = r0 * r10; + r1 = fma(r1, r9, r10); + WriteIdx2<1024, double, double, double2>(eq, 4 * eq_num_alloc, global_thread_idx, r1, r5); + r9 = fma(r4, r9, r10); + WriteIdx2<1024, double, double, double2>(eq, 6 * eq_num_alloc, global_thread_idx, r5, r9); + WriteIdx2<1024, double, double, double2>(eq, 8 * eq_num_alloc, global_thread_idx, r2, r3); + WriteIdx2<1024, double, double, double2>(eq, 10 * eq_num_alloc, global_thread_idx, r6, r7); + ReadIdx2<1024, double, double, double2>(njtr, 0 * njtr_num_alloc, global_thread_idx, r7, r6); + WriteIdx2<1024, double, double, double2>(eq, 12 * eq_num_alloc, global_thread_idx, r7, r6); + r6 = 1.0 / r1; + r6 = r5 * r6; + WriteIdx2<1024, double, double, double2>(eq, 14 * eq_num_alloc, global_thread_idx, r8, r6); + WriteIdx2<1024, double, double, double2>(eq, 16 * eq_num_alloc, global_thread_idx, r8, r1); + r1 = -1.00000000000000000e+00; + r8 = r5 * r1; + r8 = fma(r6, r8, r9); + WriteIdx2<1024, double, double, double2>(eq, 18 * eq_num_alloc, global_thread_idx, r5, r8); + }; +} + +void ChainATridigMakeEq(double* precond_diag, unsigned int precond_diag_num_alloc, + double* precond_tril, unsigned int precond_tril_num_alloc, + double* const tridig_U, unsigned int tridig_U_num_alloc, + int tridig_U_offset, int tridig_U_stride, double* njtr, + unsigned int njtr_num_alloc, const double* const diag, double* eq, + unsigned int eq_num_alloc, size_t problem_size) { + if (problem_size == 0) { + return; + } + + const int n_blocks = (problem_size + 1024 - 1) / 1024; + // Kernels using more than 48 KB of shared memory per block must opt in. + static const cudaError_t attribute_error = cudaFuncSetAttribute( + ChainATridigMakeEqKernel, cudaFuncAttributeMaxDynamicSharedMemorySize, 16384); + if (attribute_error != cudaSuccess) { + throw std::runtime_error(std::string("ChainATridigMakeEqKernel: ") + + cudaGetErrorString(attribute_error)); + } + ChainATridigMakeEqKernel<<>>( + precond_diag, precond_diag_num_alloc, precond_tril, precond_tril_num_alloc, tridig_U, + tridig_U_num_alloc, tridig_U_offset, tridig_U_stride, njtr, njtr_num_alloc, diag, eq, + eq_num_alloc, problem_size); + // A launch that fails (e.g. from exceeding shared memory or register limits) + // otherwise leaves its outputs untouched without any error. + const cudaError_t launch_error = cudaGetLastError(); + if (launch_error != cudaSuccess) { + throw std::runtime_error(std::string("ChainATridigMakeEqKernel launch failed: ") + + cudaGetErrorString(launch_error)); + } +} + +} // namespace caspar \ No newline at end of file diff --git a/test/symforce_function_codegen_test_data/symengine/symforce_caspar_tridiagonal_test/kernel_ChainA_tridig_make_eq.h b/test/symforce_function_codegen_test_data/symengine/symforce_caspar_tridiagonal_test/kernel_ChainA_tridig_make_eq.h new file mode 100644 index 00000000..9052869a --- /dev/null +++ b/test/symforce_function_codegen_test_data/symengine/symforce_caspar_tridiagonal_test/kernel_ChainA_tridig_make_eq.h @@ -0,0 +1,16 @@ +#pragma once + +#include + +#include "shared_indices.h" + +namespace caspar { + +void ChainATridigMakeEq(double* precond_diag, unsigned int precond_diag_num_alloc, + double* precond_tril, unsigned int precond_tril_num_alloc, + double* const tridig_U, unsigned int tridig_U_num_alloc, + int tridig_U_offset, int tridig_U_stride, double* njtr, + unsigned int njtr_num_alloc, const double* const diag, double* eq, + unsigned int eq_num_alloc, size_t problem_size); + +} // namespace caspar \ No newline at end of file diff --git a/test/symforce_function_codegen_test_data/symengine/symforce_caspar_tridiagonal_test/kernel_ChainA_update_Mp.cu b/test/symforce_function_codegen_test_data/symengine/symforce_caspar_tridiagonal_test/kernel_ChainA_update_Mp.cu new file mode 100644 index 00000000..48d5d026 --- /dev/null +++ b/test/symforce_function_codegen_test_data/symengine/symforce_caspar_tridiagonal_test/kernel_ChainA_update_Mp.cu @@ -0,0 +1,81 @@ +#include +#include + +#include +#include +#include +#include +#include + +#include "kernel_ChainA_update_Mp.h" +#include "memops.cuh" + +namespace cg = cooperative_groups; + +namespace caspar { + +__global__ void __launch_bounds__(1024, 1) + ChainAUpdateMpKernel(double* ChainA_r_k, unsigned int ChainA_r_k_num_alloc, double* ChainA_Mp, + unsigned int ChainA_Mp_num_alloc, const double* const beta, + double* out_ChainA_Mp_kp1, unsigned int out_ChainA_Mp_kp1_num_alloc, + double* out_ChainA_w, unsigned int out_ChainA_w_num_alloc, + size_t problem_size) { + const int global_thread_idx = blockIdx.x * blockDim.x + threadIdx.x; + // Scratch data, then the shared indices of each shared accessor; dynamic, so + // that it may exceed the 48 KB static shared memory limit (see the launch + // below). + extern __shared__ __align__(16) uint8_t inout_shared[]; + + double r0 = 0, r1 = 0, r2 = 0, r3 = 0, r4 = 0; + + if (global_thread_idx < problem_size) { + ReadIdx2<1024, double, double, double2>(ChainA_Mp, 0 * ChainA_Mp_num_alloc, global_thread_idx, + r0, r1); + ReadIdx2<1024, double, double, double2>(ChainA_r_k, 0 * ChainA_r_k_num_alloc, global_thread_idx, + r2, r3); + }; + LoadUnique<1, double, double>(beta, 0, (double*)inout_shared); + if (global_thread_idx < problem_size) { + ReadShared1((double*)inout_shared, 0, r4); + }; + __syncthreads(); + if (global_thread_idx < problem_size) { + r0 = fma(r0, r4, r2); + r4 = fma(r1, r4, r3); + WriteIdx2<1024, double, double, double2>(out_ChainA_Mp_kp1, 0 * out_ChainA_Mp_kp1_num_alloc, + global_thread_idx, r0, r4); + WriteIdx2<1024, double, double, double2>(out_ChainA_w, 0 * out_ChainA_w_num_alloc, + global_thread_idx, r0, r4); + }; +} + +void ChainAUpdateMp(double* ChainA_r_k, unsigned int ChainA_r_k_num_alloc, double* ChainA_Mp, + unsigned int ChainA_Mp_num_alloc, const double* const beta, + double* out_ChainA_Mp_kp1, unsigned int out_ChainA_Mp_kp1_num_alloc, + double* out_ChainA_w, unsigned int out_ChainA_w_num_alloc, + size_t problem_size) { + if (problem_size == 0) { + return; + } + + const int n_blocks = (problem_size + 1024 - 1) / 1024; + // Kernels using more than 48 KB of shared memory per block must opt in. + static const cudaError_t attribute_error = + cudaFuncSetAttribute(ChainAUpdateMpKernel, cudaFuncAttributeMaxDynamicSharedMemorySize, 8192); + if (attribute_error != cudaSuccess) { + throw std::runtime_error(std::string("ChainAUpdateMpKernel: ") + + cudaGetErrorString(attribute_error)); + } + ChainAUpdateMpKernel<<>>( + ChainA_r_k, ChainA_r_k_num_alloc, ChainA_Mp, ChainA_Mp_num_alloc, beta, out_ChainA_Mp_kp1, + out_ChainA_Mp_kp1_num_alloc, out_ChainA_w, out_ChainA_w_num_alloc, problem_size); + // A launch that fails (e.g. from exceeding shared memory or register limits) + // otherwise leaves its outputs untouched without any error. + const cudaError_t launch_error = cudaGetLastError(); + if (launch_error != cudaSuccess) { + throw std::runtime_error(std::string("ChainAUpdateMpKernel launch failed: ") + + cudaGetErrorString(launch_error)); + } +} + +} // namespace caspar \ No newline at end of file diff --git a/test/symforce_function_codegen_test_data/symengine/symforce_caspar_tridiagonal_test/kernel_ChainA_update_Mp.h b/test/symforce_function_codegen_test_data/symengine/symforce_caspar_tridiagonal_test/kernel_ChainA_update_Mp.h new file mode 100644 index 00000000..12f1567d --- /dev/null +++ b/test/symforce_function_codegen_test_data/symengine/symforce_caspar_tridiagonal_test/kernel_ChainA_update_Mp.h @@ -0,0 +1,14 @@ +#pragma once + +#include + +#include "shared_indices.h" + +namespace caspar { + +void ChainAUpdateMp(double* ChainA_r_k, unsigned int ChainA_r_k_num_alloc, double* ChainA_Mp, + unsigned int ChainA_Mp_num_alloc, const double* const beta, + double* out_ChainA_Mp_kp1, unsigned int out_ChainA_Mp_kp1_num_alloc, + double* out_ChainA_w, unsigned int out_ChainA_w_num_alloc, size_t problem_size); + +} // namespace caspar \ No newline at end of file diff --git a/test/symforce_function_codegen_test_data/symengine/symforce_caspar_tridiagonal_test/kernel_ChainA_update_p.cu b/test/symforce_function_codegen_test_data/symengine/symforce_caspar_tridiagonal_test/kernel_ChainA_update_p.cu new file mode 100644 index 00000000..c2116156 --- /dev/null +++ b/test/symforce_function_codegen_test_data/symengine/symforce_caspar_tridiagonal_test/kernel_ChainA_update_p.cu @@ -0,0 +1,77 @@ +#include +#include + +#include +#include +#include +#include +#include + +#include "kernel_ChainA_update_p.h" +#include "memops.cuh" + +namespace cg = cooperative_groups; + +namespace caspar { + +__global__ void __launch_bounds__(1024, 1) + ChainAUpdatePKernel(double* ChainA_z, unsigned int ChainA_z_num_alloc, double* ChainA_p_k, + unsigned int ChainA_p_k_num_alloc, const double* const beta, + double* out_ChainA_p_kp1, unsigned int out_ChainA_p_kp1_num_alloc, + size_t problem_size) { + const int global_thread_idx = blockIdx.x * blockDim.x + threadIdx.x; + // Scratch data, then the shared indices of each shared accessor; dynamic, so + // that it may exceed the 48 KB static shared memory limit (see the launch + // below). + extern __shared__ __align__(16) uint8_t inout_shared[]; + + double r0 = 0, r1 = 0, r2 = 0, r3 = 0, r4 = 0; + + if (global_thread_idx < problem_size) { + ReadIdx2<1024, double, double, double2>(ChainA_p_k, 0 * ChainA_p_k_num_alloc, global_thread_idx, + r0, r1); + ReadIdx2<1024, double, double, double2>(ChainA_z, 0 * ChainA_z_num_alloc, global_thread_idx, r2, + r3); + }; + LoadUnique<1, double, double>(beta, 0, (double*)inout_shared); + if (global_thread_idx < problem_size) { + ReadShared1((double*)inout_shared, 0, r4); + }; + __syncthreads(); + if (global_thread_idx < problem_size) { + r0 = fma(r0, r4, r2); + r4 = fma(r1, r4, r3); + WriteIdx2<1024, double, double, double2>(out_ChainA_p_kp1, 0 * out_ChainA_p_kp1_num_alloc, + global_thread_idx, r0, r4); + }; +} + +void ChainAUpdateP(double* ChainA_z, unsigned int ChainA_z_num_alloc, double* ChainA_p_k, + unsigned int ChainA_p_k_num_alloc, const double* const beta, + double* out_ChainA_p_kp1, unsigned int out_ChainA_p_kp1_num_alloc, + size_t problem_size) { + if (problem_size == 0) { + return; + } + + const int n_blocks = (problem_size + 1024 - 1) / 1024; + // Kernels using more than 48 KB of shared memory per block must opt in. + static const cudaError_t attribute_error = + cudaFuncSetAttribute(ChainAUpdatePKernel, cudaFuncAttributeMaxDynamicSharedMemorySize, 8192); + if (attribute_error != cudaSuccess) { + throw std::runtime_error(std::string("ChainAUpdatePKernel: ") + + cudaGetErrorString(attribute_error)); + } + ChainAUpdatePKernel<<>>(ChainA_z, ChainA_z_num_alloc, ChainA_p_k, + ChainA_p_k_num_alloc, beta, out_ChainA_p_kp1, + out_ChainA_p_kp1_num_alloc, problem_size); + // A launch that fails (e.g. from exceeding shared memory or register limits) + // otherwise leaves its outputs untouched without any error. + const cudaError_t launch_error = cudaGetLastError(); + if (launch_error != cudaSuccess) { + throw std::runtime_error(std::string("ChainAUpdatePKernel launch failed: ") + + cudaGetErrorString(launch_error)); + } +} + +} // namespace caspar \ No newline at end of file diff --git a/test/symforce_function_codegen_test_data/symengine/symforce_caspar_tridiagonal_test/kernel_ChainA_update_p.h b/test/symforce_function_codegen_test_data/symengine/symforce_caspar_tridiagonal_test/kernel_ChainA_update_p.h new file mode 100644 index 00000000..ffce655a --- /dev/null +++ b/test/symforce_function_codegen_test_data/symengine/symforce_caspar_tridiagonal_test/kernel_ChainA_update_p.h @@ -0,0 +1,14 @@ +#pragma once + +#include + +#include "shared_indices.h" + +namespace caspar { + +void ChainAUpdateP(double* ChainA_z, unsigned int ChainA_z_num_alloc, double* ChainA_p_k, + unsigned int ChainA_p_k_num_alloc, const double* const beta, + double* out_ChainA_p_kp1, unsigned int out_ChainA_p_kp1_num_alloc, + size_t problem_size); + +} // namespace caspar \ No newline at end of file diff --git a/test/symforce_function_codegen_test_data/symengine/symforce_caspar_tridiagonal_test/kernel_ChainA_update_r.cu b/test/symforce_function_codegen_test_data/symengine/symforce_caspar_tridiagonal_test/kernel_ChainA_update_r.cu new file mode 100644 index 00000000..ff725db8 --- /dev/null +++ b/test/symforce_function_codegen_test_data/symengine/symforce_caspar_tridiagonal_test/kernel_ChainA_update_r.cu @@ -0,0 +1,83 @@ +#include +#include + +#include +#include +#include +#include +#include + +#include "kernel_ChainA_update_r.h" +#include "memops.cuh" + +namespace cg = cooperative_groups; + +namespace caspar { + +__global__ void __launch_bounds__(1024, 1) + ChainAUpdateRKernel(double* ChainA_r_k, unsigned int ChainA_r_k_num_alloc, double* ChainA_w, + unsigned int ChainA_w_num_alloc, const double* const negalpha, + double* out_ChainA_r_kp1, unsigned int out_ChainA_r_kp1_num_alloc, + double* const out_ChainA_r_kp1_norm2_tot, size_t problem_size) { + const int global_thread_idx = blockIdx.x * blockDim.x + threadIdx.x; + // Scratch data, then the shared indices of each shared accessor; dynamic, so + // that it may exceed the 48 KB static shared memory limit (see the launch + // below). + extern __shared__ __align__(16) uint8_t inout_shared[]; + + __shared__ double out_ChainA_r_kp1_norm2_tot_local[1]; + + double r0 = 0, r1 = 0, r2 = 0, r3 = 0, r4 = 0; + + if (global_thread_idx < problem_size) { + ReadIdx2<1024, double, double, double2>(ChainA_r_k, 0 * ChainA_r_k_num_alloc, global_thread_idx, + r0, r1); + ReadIdx2<1024, double, double, double2>(ChainA_w, 0 * ChainA_w_num_alloc, global_thread_idx, r2, + r3); + }; + LoadUnique<1, double, double>(negalpha, 0, (double*)inout_shared); + if (global_thread_idx < problem_size) { + ReadShared1((double*)inout_shared, 0, r4); + }; + __syncthreads(); + if (global_thread_idx < problem_size) { + r2 = fma(r2, r4, r0); + r4 = fma(r3, r4, r1); + WriteIdx2<1024, double, double, double2>(out_ChainA_r_kp1, 0 * out_ChainA_r_kp1_num_alloc, + global_thread_idx, r2, r4); + r2 = fma(r2, r2, r4 * r4); + }; + SumStore(out_ChainA_r_kp1_norm2_tot_local, (double*)inout_shared, 0, + global_thread_idx < problem_size, r2); + SumFlushFinal(out_ChainA_r_kp1_norm2_tot_local, out_ChainA_r_kp1_norm2_tot, 1); +} + +void ChainAUpdateR(double* ChainA_r_k, unsigned int ChainA_r_k_num_alloc, double* ChainA_w, + unsigned int ChainA_w_num_alloc, const double* const negalpha, + double* out_ChainA_r_kp1, unsigned int out_ChainA_r_kp1_num_alloc, + double* const out_ChainA_r_kp1_norm2_tot, size_t problem_size) { + if (problem_size == 0) { + return; + } + + const int n_blocks = (problem_size + 1024 - 1) / 1024; + // Kernels using more than 48 KB of shared memory per block must opt in. + static const cudaError_t attribute_error = + cudaFuncSetAttribute(ChainAUpdateRKernel, cudaFuncAttributeMaxDynamicSharedMemorySize, 8192); + if (attribute_error != cudaSuccess) { + throw std::runtime_error(std::string("ChainAUpdateRKernel: ") + + cudaGetErrorString(attribute_error)); + } + ChainAUpdateRKernel<<>>( + ChainA_r_k, ChainA_r_k_num_alloc, ChainA_w, ChainA_w_num_alloc, negalpha, out_ChainA_r_kp1, + out_ChainA_r_kp1_num_alloc, out_ChainA_r_kp1_norm2_tot, problem_size); + // A launch that fails (e.g. from exceeding shared memory or register limits) + // otherwise leaves its outputs untouched without any error. + const cudaError_t launch_error = cudaGetLastError(); + if (launch_error != cudaSuccess) { + throw std::runtime_error(std::string("ChainAUpdateRKernel launch failed: ") + + cudaGetErrorString(launch_error)); + } +} + +} // namespace caspar \ No newline at end of file diff --git a/test/symforce_function_codegen_test_data/symengine/symforce_caspar_tridiagonal_test/kernel_ChainA_update_r.h b/test/symforce_function_codegen_test_data/symengine/symforce_caspar_tridiagonal_test/kernel_ChainA_update_r.h new file mode 100644 index 00000000..c5caa08e --- /dev/null +++ b/test/symforce_function_codegen_test_data/symengine/symforce_caspar_tridiagonal_test/kernel_ChainA_update_r.h @@ -0,0 +1,14 @@ +#pragma once + +#include + +#include "shared_indices.h" + +namespace caspar { + +void ChainAUpdateR(double* ChainA_r_k, unsigned int ChainA_r_k_num_alloc, double* ChainA_w, + unsigned int ChainA_w_num_alloc, const double* const negalpha, + double* out_ChainA_r_kp1, unsigned int out_ChainA_r_kp1_num_alloc, + double* const out_ChainA_r_kp1_norm2_tot, size_t problem_size); + +} // namespace caspar \ No newline at end of file diff --git a/test/symforce_function_codegen_test_data/symengine/symforce_caspar_tridiagonal_test/kernel_ChainA_update_r_first.cu b/test/symforce_function_codegen_test_data/symengine/symforce_caspar_tridiagonal_test/kernel_ChainA_update_r_first.cu new file mode 100644 index 00000000..e35670ca --- /dev/null +++ b/test/symforce_function_codegen_test_data/symengine/symforce_caspar_tridiagonal_test/kernel_ChainA_update_r_first.cu @@ -0,0 +1,95 @@ +#include +#include + +#include +#include +#include +#include +#include + +#include "kernel_ChainA_update_r_first.h" +#include "memops.cuh" + +namespace cg = cooperative_groups; + +namespace caspar { + +__global__ void __launch_bounds__(1024, 1) + ChainAUpdateRFirstKernel(double* ChainA_r_k, unsigned int ChainA_r_k_num_alloc, + double* ChainA_w, unsigned int ChainA_w_num_alloc, + const double* const negalpha, double* out_ChainA_r_kp1, + unsigned int out_ChainA_r_kp1_num_alloc, + double* const out_ChainA_r_0_norm2_tot, + double* const out_ChainA_r_kp1_norm2_tot, size_t problem_size) { + const int global_thread_idx = blockIdx.x * blockDim.x + threadIdx.x; + // Scratch data, then the shared indices of each shared accessor; dynamic, so + // that it may exceed the 48 KB static shared memory limit (see the launch + // below). + extern __shared__ __align__(16) uint8_t inout_shared[]; + + __shared__ double out_ChainA_r_0_norm2_tot_local[1]; + + __shared__ double out_ChainA_r_kp1_norm2_tot_local[1]; + + double r0 = 0, r1 = 0, r2 = 0, r3 = 0, r4 = 0; + + if (global_thread_idx < problem_size) { + ReadIdx2<1024, double, double, double2>(ChainA_r_k, 0 * ChainA_r_k_num_alloc, global_thread_idx, + r0, r1); + ReadIdx2<1024, double, double, double2>(ChainA_w, 0 * ChainA_w_num_alloc, global_thread_idx, r2, + r3); + }; + LoadUnique<1, double, double>(negalpha, 0, (double*)inout_shared); + if (global_thread_idx < problem_size) { + ReadShared1((double*)inout_shared, 0, r4); + }; + __syncthreads(); + if (global_thread_idx < problem_size) { + r2 = fma(r2, r4, r0); + r4 = fma(r3, r4, r1); + WriteIdx2<1024, double, double, double2>(out_ChainA_r_kp1, 0 * out_ChainA_r_kp1_num_alloc, + global_thread_idx, r2, r4); + r0 = fma(r0, r0, r1 * r1); + }; + SumStore(out_ChainA_r_0_norm2_tot_local, (double*)inout_shared, 0, + global_thread_idx < problem_size, r0); + if (global_thread_idx < problem_size) { + r2 = fma(r2, r2, r4 * r4); + }; + SumStore(out_ChainA_r_kp1_norm2_tot_local, (double*)inout_shared, 0, + global_thread_idx < problem_size, r2); + SumFlushFinal(out_ChainA_r_0_norm2_tot_local, out_ChainA_r_0_norm2_tot, 1); + SumFlushFinal(out_ChainA_r_kp1_norm2_tot_local, out_ChainA_r_kp1_norm2_tot, 1); +} + +void ChainAUpdateRFirst(double* ChainA_r_k, unsigned int ChainA_r_k_num_alloc, double* ChainA_w, + unsigned int ChainA_w_num_alloc, const double* const negalpha, + double* out_ChainA_r_kp1, unsigned int out_ChainA_r_kp1_num_alloc, + double* const out_ChainA_r_0_norm2_tot, + double* const out_ChainA_r_kp1_norm2_tot, size_t problem_size) { + if (problem_size == 0) { + return; + } + + const int n_blocks = (problem_size + 1024 - 1) / 1024; + // Kernels using more than 48 KB of shared memory per block must opt in. + static const cudaError_t attribute_error = cudaFuncSetAttribute( + ChainAUpdateRFirstKernel, cudaFuncAttributeMaxDynamicSharedMemorySize, 8192); + if (attribute_error != cudaSuccess) { + throw std::runtime_error(std::string("ChainAUpdateRFirstKernel: ") + + cudaGetErrorString(attribute_error)); + } + ChainAUpdateRFirstKernel<<>>( + ChainA_r_k, ChainA_r_k_num_alloc, ChainA_w, ChainA_w_num_alloc, negalpha, out_ChainA_r_kp1, + out_ChainA_r_kp1_num_alloc, out_ChainA_r_0_norm2_tot, out_ChainA_r_kp1_norm2_tot, + problem_size); + // A launch that fails (e.g. from exceeding shared memory or register limits) + // otherwise leaves its outputs untouched without any error. + const cudaError_t launch_error = cudaGetLastError(); + if (launch_error != cudaSuccess) { + throw std::runtime_error(std::string("ChainAUpdateRFirstKernel launch failed: ") + + cudaGetErrorString(launch_error)); + } +} + +} // namespace caspar \ No newline at end of file diff --git a/test/symforce_function_codegen_test_data/symengine/symforce_caspar_tridiagonal_test/kernel_ChainA_update_r_first.h b/test/symforce_function_codegen_test_data/symengine/symforce_caspar_tridiagonal_test/kernel_ChainA_update_r_first.h new file mode 100644 index 00000000..270fdda1 --- /dev/null +++ b/test/symforce_function_codegen_test_data/symengine/symforce_caspar_tridiagonal_test/kernel_ChainA_update_r_first.h @@ -0,0 +1,15 @@ +#pragma once + +#include + +#include "shared_indices.h" + +namespace caspar { + +void ChainAUpdateRFirst(double* ChainA_r_k, unsigned int ChainA_r_k_num_alloc, double* ChainA_w, + unsigned int ChainA_w_num_alloc, const double* const negalpha, + double* out_ChainA_r_kp1, unsigned int out_ChainA_r_kp1_num_alloc, + double* const out_ChainA_r_0_norm2_tot, + double* const out_ChainA_r_kp1_norm2_tot, size_t problem_size); + +} // namespace caspar \ No newline at end of file diff --git a/test/symforce_function_codegen_test_data/symengine/symforce_caspar_tridiagonal_test/kernel_ChainA_update_step.cu b/test/symforce_function_codegen_test_data/symengine/symforce_caspar_tridiagonal_test/kernel_ChainA_update_step.cu new file mode 100644 index 00000000..187263ef --- /dev/null +++ b/test/symforce_function_codegen_test_data/symengine/symforce_caspar_tridiagonal_test/kernel_ChainA_update_step.cu @@ -0,0 +1,77 @@ +#include +#include + +#include +#include +#include +#include +#include + +#include "kernel_ChainA_update_step.h" +#include "memops.cuh" + +namespace cg = cooperative_groups; + +namespace caspar { + +__global__ void __launch_bounds__(1024, 1) + ChainAUpdateStepKernel(double* ChainA_step_k, unsigned int ChainA_step_k_num_alloc, + double* ChainA_p_kp1, unsigned int ChainA_p_kp1_num_alloc, + const double* const alpha, double* out_ChainA_step_kp1, + unsigned int out_ChainA_step_kp1_num_alloc, size_t problem_size) { + const int global_thread_idx = blockIdx.x * blockDim.x + threadIdx.x; + // Scratch data, then the shared indices of each shared accessor; dynamic, so + // that it may exceed the 48 KB static shared memory limit (see the launch + // below). + extern __shared__ __align__(16) uint8_t inout_shared[]; + + double r0 = 0, r1 = 0, r2 = 0, r3 = 0, r4 = 0; + + if (global_thread_idx < problem_size) { + ReadIdx2<1024, double, double, double2>(ChainA_step_k, 0 * ChainA_step_k_num_alloc, + global_thread_idx, r0, r1); + ReadIdx2<1024, double, double, double2>(ChainA_p_kp1, 0 * ChainA_p_kp1_num_alloc, + global_thread_idx, r2, r3); + }; + LoadUnique<1, double, double>(alpha, 0, (double*)inout_shared); + if (global_thread_idx < problem_size) { + ReadShared1((double*)inout_shared, 0, r4); + }; + __syncthreads(); + if (global_thread_idx < problem_size) { + r2 = fma(r2, r4, r0); + r4 = fma(r3, r4, r1); + WriteIdx2<1024, double, double, double2>(out_ChainA_step_kp1, 0 * out_ChainA_step_kp1_num_alloc, + global_thread_idx, r2, r4); + }; +} + +void ChainAUpdateStep(double* ChainA_step_k, unsigned int ChainA_step_k_num_alloc, + double* ChainA_p_kp1, unsigned int ChainA_p_kp1_num_alloc, + const double* const alpha, double* out_ChainA_step_kp1, + unsigned int out_ChainA_step_kp1_num_alloc, size_t problem_size) { + if (problem_size == 0) { + return; + } + + const int n_blocks = (problem_size + 1024 - 1) / 1024; + // Kernels using more than 48 KB of shared memory per block must opt in. + static const cudaError_t attribute_error = cudaFuncSetAttribute( + ChainAUpdateStepKernel, cudaFuncAttributeMaxDynamicSharedMemorySize, 8192); + if (attribute_error != cudaSuccess) { + throw std::runtime_error(std::string("ChainAUpdateStepKernel: ") + + cudaGetErrorString(attribute_error)); + } + ChainAUpdateStepKernel<<>>( + ChainA_step_k, ChainA_step_k_num_alloc, ChainA_p_kp1, ChainA_p_kp1_num_alloc, alpha, + out_ChainA_step_kp1, out_ChainA_step_kp1_num_alloc, problem_size); + // A launch that fails (e.g. from exceeding shared memory or register limits) + // otherwise leaves its outputs untouched without any error. + const cudaError_t launch_error = cudaGetLastError(); + if (launch_error != cudaSuccess) { + throw std::runtime_error(std::string("ChainAUpdateStepKernel launch failed: ") + + cudaGetErrorString(launch_error)); + } +} + +} // namespace caspar \ No newline at end of file diff --git a/test/symforce_function_codegen_test_data/symengine/symforce_caspar_tridiagonal_test/kernel_ChainA_update_step.h b/test/symforce_function_codegen_test_data/symengine/symforce_caspar_tridiagonal_test/kernel_ChainA_update_step.h new file mode 100644 index 00000000..1e4a1968 --- /dev/null +++ b/test/symforce_function_codegen_test_data/symengine/symforce_caspar_tridiagonal_test/kernel_ChainA_update_step.h @@ -0,0 +1,14 @@ +#pragma once + +#include + +#include "shared_indices.h" + +namespace caspar { + +void ChainAUpdateStep(double* ChainA_step_k, unsigned int ChainA_step_k_num_alloc, + double* ChainA_p_kp1, unsigned int ChainA_p_kp1_num_alloc, + const double* const alpha, double* out_ChainA_step_kp1, + unsigned int out_ChainA_step_kp1_num_alloc, size_t problem_size); + +} // namespace caspar \ No newline at end of file diff --git a/test/symforce_function_codegen_test_data/symengine/symforce_caspar_tridiagonal_test/kernel_ChainA_update_step_first.cu b/test/symforce_function_codegen_test_data/symengine/symforce_caspar_tridiagonal_test/kernel_ChainA_update_step_first.cu new file mode 100644 index 00000000..6ce1c156 --- /dev/null +++ b/test/symforce_function_codegen_test_data/symengine/symforce_caspar_tridiagonal_test/kernel_ChainA_update_step_first.cu @@ -0,0 +1,73 @@ +#include +#include + +#include +#include +#include +#include +#include + +#include "kernel_ChainA_update_step_first.h" +#include "memops.cuh" + +namespace cg = cooperative_groups; + +namespace caspar { + +__global__ void __launch_bounds__(1024, 1) + ChainAUpdateStepFirstKernel(double* ChainA_p_kp1, unsigned int ChainA_p_kp1_num_alloc, + const double* const alpha, double* out_ChainA_step_kp1, + unsigned int out_ChainA_step_kp1_num_alloc, size_t problem_size) { + const int global_thread_idx = blockIdx.x * blockDim.x + threadIdx.x; + // Scratch data, then the shared indices of each shared accessor; dynamic, so + // that it may exceed the 48 KB static shared memory limit (see the launch + // below). + extern __shared__ __align__(16) uint8_t inout_shared[]; + + double r0 = 0, r1 = 0, r2 = 0; + + if (global_thread_idx < problem_size) { + ReadIdx2<1024, double, double, double2>(ChainA_p_kp1, 0 * ChainA_p_kp1_num_alloc, + global_thread_idx, r0, r1); + }; + LoadUnique<1, double, double>(alpha, 0, (double*)inout_shared); + if (global_thread_idx < problem_size) { + ReadShared1((double*)inout_shared, 0, r2); + }; + __syncthreads(); + if (global_thread_idx < problem_size) { + r0 = r0 * r2; + r2 = r1 * r2; + WriteIdx2<1024, double, double, double2>(out_ChainA_step_kp1, 0 * out_ChainA_step_kp1_num_alloc, + global_thread_idx, r0, r2); + }; +} + +void ChainAUpdateStepFirst(double* ChainA_p_kp1, unsigned int ChainA_p_kp1_num_alloc, + const double* const alpha, double* out_ChainA_step_kp1, + unsigned int out_ChainA_step_kp1_num_alloc, size_t problem_size) { + if (problem_size == 0) { + return; + } + + const int n_blocks = (problem_size + 1024 - 1) / 1024; + // Kernels using more than 48 KB of shared memory per block must opt in. + static const cudaError_t attribute_error = cudaFuncSetAttribute( + ChainAUpdateStepFirstKernel, cudaFuncAttributeMaxDynamicSharedMemorySize, 8192); + if (attribute_error != cudaSuccess) { + throw std::runtime_error(std::string("ChainAUpdateStepFirstKernel: ") + + cudaGetErrorString(attribute_error)); + } + ChainAUpdateStepFirstKernel<<>>( + ChainA_p_kp1, ChainA_p_kp1_num_alloc, alpha, out_ChainA_step_kp1, + out_ChainA_step_kp1_num_alloc, problem_size); + // A launch that fails (e.g. from exceeding shared memory or register limits) + // otherwise leaves its outputs untouched without any error. + const cudaError_t launch_error = cudaGetLastError(); + if (launch_error != cudaSuccess) { + throw std::runtime_error(std::string("ChainAUpdateStepFirstKernel launch failed: ") + + cudaGetErrorString(launch_error)); + } +} + +} // namespace caspar \ No newline at end of file diff --git a/test/symforce_function_codegen_test_data/symengine/symforce_caspar_tridiagonal_test/kernel_ChainA_update_step_first.h b/test/symforce_function_codegen_test_data/symengine/symforce_caspar_tridiagonal_test/kernel_ChainA_update_step_first.h new file mode 100644 index 00000000..461de55f --- /dev/null +++ b/test/symforce_function_codegen_test_data/symengine/symforce_caspar_tridiagonal_test/kernel_ChainA_update_step_first.h @@ -0,0 +1,13 @@ +#pragma once + +#include + +#include "shared_indices.h" + +namespace caspar { + +void ChainAUpdateStepFirst(double* ChainA_p_kp1, unsigned int ChainA_p_kp1_num_alloc, + const double* const alpha, double* out_ChainA_step_kp1, + unsigned int out_ChainA_step_kp1_num_alloc, size_t problem_size); + +} // namespace caspar \ No newline at end of file diff --git a/test/symforce_function_codegen_test_data/symengine/symforce_caspar_tridiagonal_test/kernel_ChainB_alpha_denominator_or_beta_numerator.cu b/test/symforce_function_codegen_test_data/symengine/symforce_caspar_tridiagonal_test/kernel_ChainB_alpha_denominator_or_beta_numerator.cu new file mode 100644 index 00000000..c5e4aa53 --- /dev/null +++ b/test/symforce_function_codegen_test_data/symengine/symforce_caspar_tridiagonal_test/kernel_ChainB_alpha_denominator_or_beta_numerator.cu @@ -0,0 +1,77 @@ +#include +#include + +#include +#include +#include +#include +#include + +#include "kernel_ChainB_alpha_denominator_or_beta_numerator.h" +#include "memops.cuh" + +namespace cg = cooperative_groups; + +namespace caspar { + +__global__ void __launch_bounds__(1024, 1) + ChainBAlphaDenominatorOrBetaNumeratorKernel(double* ChainB_p_kp1, + unsigned int ChainB_p_kp1_num_alloc, + double* ChainB_w, unsigned int ChainB_w_num_alloc, + double* const ChainB_out, size_t problem_size) { + const int global_thread_idx = blockIdx.x * blockDim.x + threadIdx.x; + // Scratch data, then the shared indices of each shared accessor; dynamic, so + // that it may exceed the 48 KB static shared memory limit (see the launch + // below). + extern __shared__ __align__(16) uint8_t inout_shared[]; + + __shared__ double ChainB_out_local[1]; + + double r0 = 0, r1 = 0, r2 = 0, r3 = 0, r4 = 0, r5 = 0; + + if (global_thread_idx < problem_size) { + ReadIdx1<1024, double, double, double>(ChainB_p_kp1, 2 * ChainB_p_kp1_num_alloc, + global_thread_idx, r0); + ReadIdx1<1024, double, double, double>(ChainB_w, 2 * ChainB_w_num_alloc, global_thread_idx, r1); + ReadIdx2<1024, double, double, double2>(ChainB_p_kp1, 0 * ChainB_p_kp1_num_alloc, + global_thread_idx, r2, r3); + ReadIdx2<1024, double, double, double2>(ChainB_w, 0 * ChainB_w_num_alloc, global_thread_idx, r4, + r5); + r5 = fma(r3, r5, r0 * r1); + r5 = fma(r2, r4, r5); + }; + SumStore(ChainB_out_local, (double*)inout_shared, 0, global_thread_idx < problem_size, + r5); + SumFlushFinal(ChainB_out_local, ChainB_out, 1); +} + +void ChainBAlphaDenominatorOrBetaNumerator(double* ChainB_p_kp1, + unsigned int ChainB_p_kp1_num_alloc, double* ChainB_w, + unsigned int ChainB_w_num_alloc, + double* const ChainB_out, size_t problem_size) { + if (problem_size == 0) { + return; + } + + const int n_blocks = (problem_size + 1024 - 1) / 1024; + // Kernels using more than 48 KB of shared memory per block must opt in. + static const cudaError_t attribute_error = + cudaFuncSetAttribute(ChainBAlphaDenominatorOrBetaNumeratorKernel, + cudaFuncAttributeMaxDynamicSharedMemorySize, 256); + if (attribute_error != cudaSuccess) { + throw std::runtime_error(std::string("ChainBAlphaDenominatorOrBetaNumeratorKernel: ") + + cudaGetErrorString(attribute_error)); + } + ChainBAlphaDenominatorOrBetaNumeratorKernel<<>>( + ChainB_p_kp1, ChainB_p_kp1_num_alloc, ChainB_w, ChainB_w_num_alloc, ChainB_out, problem_size); + // A launch that fails (e.g. from exceeding shared memory or register limits) + // otherwise leaves its outputs untouched without any error. + const cudaError_t launch_error = cudaGetLastError(); + if (launch_error != cudaSuccess) { + throw std::runtime_error( + std::string("ChainBAlphaDenominatorOrBetaNumeratorKernel launch failed: ") + + cudaGetErrorString(launch_error)); + } +} + +} // namespace caspar \ No newline at end of file diff --git a/test/symforce_function_codegen_test_data/symengine/symforce_caspar_tridiagonal_test/kernel_ChainB_alpha_denominator_or_beta_numerator.h b/test/symforce_function_codegen_test_data/symengine/symforce_caspar_tridiagonal_test/kernel_ChainB_alpha_denominator_or_beta_numerator.h new file mode 100644 index 00000000..5089b1c7 --- /dev/null +++ b/test/symforce_function_codegen_test_data/symengine/symforce_caspar_tridiagonal_test/kernel_ChainB_alpha_denominator_or_beta_numerator.h @@ -0,0 +1,14 @@ +#pragma once + +#include + +#include "shared_indices.h" + +namespace caspar { + +void ChainBAlphaDenominatorOrBetaNumerator(double* ChainB_p_kp1, + unsigned int ChainB_p_kp1_num_alloc, double* ChainB_w, + unsigned int ChainB_w_num_alloc, + double* const ChainB_out, size_t problem_size); + +} // namespace caspar \ No newline at end of file diff --git a/test/symforce_function_codegen_test_data/symengine/symforce_caspar_tridiagonal_test/kernel_ChainB_alpha_numerator_denominator.cu b/test/symforce_function_codegen_test_data/symengine/symforce_caspar_tridiagonal_test/kernel_ChainB_alpha_numerator_denominator.cu new file mode 100644 index 00000000..4c8b49e2 --- /dev/null +++ b/test/symforce_function_codegen_test_data/symengine/symforce_caspar_tridiagonal_test/kernel_ChainB_alpha_numerator_denominator.cu @@ -0,0 +1,91 @@ +#include +#include + +#include +#include +#include +#include +#include + +#include "kernel_ChainB_alpha_numerator_denominator.h" +#include "memops.cuh" + +namespace cg = cooperative_groups; + +namespace caspar { + +__global__ void __launch_bounds__(1024, 1) + ChainBAlphaNumeratorDenominatorKernel(double* ChainB_p_kp1, unsigned int ChainB_p_kp1_num_alloc, + double* ChainB_r_k, unsigned int ChainB_r_k_num_alloc, + double* ChainB_w, unsigned int ChainB_w_num_alloc, + double* const ChainB_total_ag, + double* const ChainB_total_ac, size_t problem_size) { + const int global_thread_idx = blockIdx.x * blockDim.x + threadIdx.x; + // Scratch data, then the shared indices of each shared accessor; dynamic, so + // that it may exceed the 48 KB static shared memory limit (see the launch + // below). + extern __shared__ __align__(16) uint8_t inout_shared[]; + + __shared__ double ChainB_total_ag_local[1]; + + __shared__ double ChainB_total_ac_local[1]; + + double r0 = 0, r1 = 0, r2 = 0, r3 = 0, r4 = 0, r5 = 0; + + if (global_thread_idx < problem_size) { + ReadIdx2<1024, double, double, double2>(ChainB_p_kp1, 0 * ChainB_p_kp1_num_alloc, + global_thread_idx, r0, r1); + ReadIdx2<1024, double, double, double2>(ChainB_r_k, 0 * ChainB_r_k_num_alloc, global_thread_idx, + r2, r3); + r2 = fma(r0, r2, r1 * r3); + ReadIdx1<1024, double, double, double>(ChainB_p_kp1, 2 * ChainB_p_kp1_num_alloc, + global_thread_idx, r3); + ReadIdx1<1024, double, double, double>(ChainB_r_k, 2 * ChainB_r_k_num_alloc, global_thread_idx, + r4); + r2 = fma(r3, r4, r2); + }; + SumStore(ChainB_total_ag_local, (double*)inout_shared, 0, + global_thread_idx < problem_size, r2); + if (global_thread_idx < problem_size) { + ReadIdx1<1024, double, double, double>(ChainB_w, 2 * ChainB_w_num_alloc, global_thread_idx, r2); + ReadIdx2<1024, double, double, double2>(ChainB_w, 0 * ChainB_w_num_alloc, global_thread_idx, r4, + r5); + r5 = fma(r1, r5, r3 * r2); + r5 = fma(r0, r4, r5); + }; + SumStore(ChainB_total_ac_local, (double*)inout_shared, 0, + global_thread_idx < problem_size, r5); + SumFlushFinal(ChainB_total_ag_local, ChainB_total_ag, 1); + SumFlushFinal(ChainB_total_ac_local, ChainB_total_ac, 1); +} + +void ChainBAlphaNumeratorDenominator(double* ChainB_p_kp1, unsigned int ChainB_p_kp1_num_alloc, + double* ChainB_r_k, unsigned int ChainB_r_k_num_alloc, + double* ChainB_w, unsigned int ChainB_w_num_alloc, + double* const ChainB_total_ag, double* const ChainB_total_ac, + size_t problem_size) { + if (problem_size == 0) { + return; + } + + const int n_blocks = (problem_size + 1024 - 1) / 1024; + // Kernels using more than 48 KB of shared memory per block must opt in. + static const cudaError_t attribute_error = cudaFuncSetAttribute( + ChainBAlphaNumeratorDenominatorKernel, cudaFuncAttributeMaxDynamicSharedMemorySize, 256); + if (attribute_error != cudaSuccess) { + throw std::runtime_error(std::string("ChainBAlphaNumeratorDenominatorKernel: ") + + cudaGetErrorString(attribute_error)); + } + ChainBAlphaNumeratorDenominatorKernel<<>>( + ChainB_p_kp1, ChainB_p_kp1_num_alloc, ChainB_r_k, ChainB_r_k_num_alloc, ChainB_w, + ChainB_w_num_alloc, ChainB_total_ag, ChainB_total_ac, problem_size); + // A launch that fails (e.g. from exceeding shared memory or register limits) + // otherwise leaves its outputs untouched without any error. + const cudaError_t launch_error = cudaGetLastError(); + if (launch_error != cudaSuccess) { + throw std::runtime_error(std::string("ChainBAlphaNumeratorDenominatorKernel launch failed: ") + + cudaGetErrorString(launch_error)); + } +} + +} // namespace caspar \ No newline at end of file diff --git a/test/symforce_function_codegen_test_data/symengine/symforce_caspar_tridiagonal_test/kernel_ChainB_alpha_numerator_denominator.h b/test/symforce_function_codegen_test_data/symengine/symforce_caspar_tridiagonal_test/kernel_ChainB_alpha_numerator_denominator.h new file mode 100644 index 00000000..613341f5 --- /dev/null +++ b/test/symforce_function_codegen_test_data/symengine/symforce_caspar_tridiagonal_test/kernel_ChainB_alpha_numerator_denominator.h @@ -0,0 +1,15 @@ +#pragma once + +#include + +#include "shared_indices.h" + +namespace caspar { + +void ChainBAlphaNumeratorDenominator(double* ChainB_p_kp1, unsigned int ChainB_p_kp1_num_alloc, + double* ChainB_r_k, unsigned int ChainB_r_k_num_alloc, + double* ChainB_w, unsigned int ChainB_w_num_alloc, + double* const ChainB_total_ag, double* const ChainB_total_ac, + size_t problem_size); + +} // namespace caspar \ No newline at end of file diff --git a/test/symforce_function_codegen_test_data/symengine/symforce_caspar_tridiagonal_test/kernel_ChainB_cyclic_reduction_down.cu b/test/symforce_function_codegen_test_data/symengine/symforce_caspar_tridiagonal_test/kernel_ChainB_cyclic_reduction_down.cu new file mode 100644 index 00000000..d1485291 --- /dev/null +++ b/test/symforce_function_codegen_test_data/symengine/symforce_caspar_tridiagonal_test/kernel_ChainB_cyclic_reduction_down.cu @@ -0,0 +1,633 @@ +#include +#include + +#include +#include +#include +#include +#include + +#include "kernel_ChainB_cyclic_reduction_down.h" +#include "memops.cuh" + +namespace cg = cooperative_groups; + +namespace caspar { + +__global__ void __launch_bounds__(64, 1) + ChainBCyclicReductionDownKernel(double* eqk, unsigned int eqk_num_alloc, int eqk_offset, + int eqk_stride, double* const eq, unsigned int eq_num_alloc, + int eq_offset, int eq_stride, double* eq_marked, + unsigned int eq_marked_num_alloc, int eq_marked_offset, + int eq_marked_stride, size_t problem_size) { + const int global_thread_idx = blockIdx.x * blockDim.x + threadIdx.x; + // Scratch data, then the shared indices of each shared accessor; dynamic, so + // that it may exceed the 48 KB static shared memory limit (see the launch + // below). + extern __shared__ __align__(16) uint8_t inout_shared[]; + + double r0 = 0, r1 = 0, r2 = 0, r3 = 0, r4 = 0, r5 = 0, r6 = 0, r7 = 0, r8 = 0, r9 = 0, r10 = 0, + r11 = 0, r12 = 0, r13 = 0, r14 = 0, r15 = 0, r16 = 0, r17 = 0, r18 = 0, r19 = 0, r20 = 0, + r21 = 0, r22 = 0, r23 = 0, r24 = 0, r25 = 0, r26 = 0, r27 = 0, r28 = 0, r29 = 0, r30 = 0, + r31 = 0, r32 = 0, r33 = 0, r34 = 0, r35 = 0, r36 = 0, r37 = 0, r38 = 0, r39 = 0, r40 = 0, + r41 = 0, r42 = 0, r43 = 0, r44 = 0, r45 = 0, r46 = 0, r47 = 0, r48 = 0, r49 = 0, r50 = 0, + r51 = 0, r52 = 0, r53 = 0, r54 = 0, r55 = 0, r56 = 0, r57 = 0, r58 = 0, r59 = 0, r60 = 0, + r61 = 0, r62 = 0, r63 = 0, r64 = 0, r65 = 0, r66 = 0, r67 = 0, r68 = 0, r69 = 0, r70 = 0, + r71 = 0, r72 = 0, r73 = 0, r74 = 0, r75 = 0, r76 = 0, r77 = 0, r78 = 0, r79 = 0, r80 = 0, + r81 = 0, r82 = 0, r83 = 0, r84 = 0, r85 = 0, r86 = 0, r87 = 0, r88 = 0, r89 = 0, r90 = 0; + + if (global_thread_idx < problem_size) { + ReadIdx2<64, double, double, double2>(eqk, 0 * eqk_num_alloc, + global_thread_idx * eqk_stride + eqk_offset, r0, r1); + }; + ReadAndShuffleWithDefault2<64, double, double, double2>( + (double*)inout_shared, eq, 2 * eq_num_alloc, global_thread_idx * eq_stride + eq_offset, + threadIdx.x == 63, global_thread_idx <= problem_size, eq_num_alloc, eq_stride, r2, r3, r4, r5, + 0.000000f, 0.000000f); + if (global_thread_idx < problem_size) { + ReadIdx2<64, double, double, double2>(eqk, 6 * eqk_num_alloc, + global_thread_idx * eqk_stride + eqk_offset, r6, r7); + }; + ReadAndShuffleWithDefault2<64, double, double, double2>( + (double*)inout_shared, eq, 38 * eq_num_alloc, global_thread_idx * eq_stride + eq_offset, + threadIdx.x == 63, global_thread_idx <= problem_size, eq_num_alloc, eq_stride, r8, r9, r10, + r11, 0.000000f, 1.000000f); + if (global_thread_idx < problem_size) { + r12 = -1.00000000000000000e+00; + r8 = r8 * r12; + }; + ReadAndShuffleWithDefault2<64, double, double, double2>( + (double*)inout_shared, eq, 36 * eq_num_alloc, global_thread_idx * eq_stride + eq_offset, + threadIdx.x == 63, global_thread_idx <= problem_size, eq_num_alloc, eq_stride, r13, r14, r15, + r16, 1.000000f, 0.000000f); + if (global_thread_idx < problem_size) { + r13 = 1.0 / r13; + r8 = r8 * r13; + r6 = fma(r0, r8, r6); + }; + ReadAndShuffleWithDefault2<64, double, double, double2>( + (double*)inout_shared, eq, 40 * eq_num_alloc, global_thread_idx * eq_stride + eq_offset, + threadIdx.x == 63, global_thread_idx <= problem_size, eq_num_alloc, eq_stride, r17, r18, r19, + r20, 0.000000f, 1.000000f); + if (global_thread_idx < problem_size) { + r17 = r17 * r12; + r9 = 1.0 / r9; + r17 = r17 * r9; + ReadIdx2<64, double, double, double2>(eqk, 2 * eqk_num_alloc, + global_thread_idx * eqk_stride + eqk_offset, r21, r22); + r23 = r0 * r14; + r23 = r23 * r12; + r23 = fma(r13, r23, r22); + r6 = fma(r23, r17, r6); + r18 = 1.0 / r18; + }; + ReadAndShuffleWithDefault2<64, double, double, double2>( + (double*)inout_shared, eq, 34 * eq_num_alloc, global_thread_idx * eq_stride + eq_offset, + threadIdx.x == 63, global_thread_idx <= problem_size, eq_num_alloc, eq_stride, r22, r24, r25, + r26, 0.000000f, 1.000000f); + if (global_thread_idx < problem_size) { + r24 = 1.0 / r24; + r24 = r18 * r24; + r18 = r12 * r24; + r27 = r6 * r18; + }; + ReadAndShuffleWithDefault2<64, double, double, double2>( + (double*)inout_shared, eq, 0 * eq_num_alloc, global_thread_idx * eq_stride + eq_offset, + threadIdx.x == 63, global_thread_idx <= problem_size, eq_num_alloc, eq_stride, r28, r29, r30, + r31, 0.000000f, 0.000000f); + if (global_thread_idx < problem_size) { + r32 = r29 * r12; + r23 = fma(r23, r9, r22 * r27); + }; + ReadAndShuffleWithDefault2<64, double, double, double2>( + (double*)inout_shared, eq, 32 * eq_num_alloc, global_thread_idx * eq_stride + eq_offset, + threadIdx.x == 63, global_thread_idx <= problem_size, eq_num_alloc, eq_stride, r33, r34, r35, + r36, 1.000000f, 0.000000f); + if (global_thread_idx < problem_size) { + r33 = 1.0 / r33; + r23 = r23 * r33; + r32 = fma(r23, r32, r2 * r27); + r37 = r28 * r12; + }; + ReadAndShuffleWithDefault2<64, double, double, double2>( + (double*)inout_shared, eq, 30 * eq_num_alloc, global_thread_idx * eq_stride + eq_offset, + threadIdx.x == 63, global_thread_idx <= problem_size, eq_num_alloc, eq_stride, r38, r39, r40, + r41, 1.000000f, 0.000000f); + if (global_thread_idx < problem_size) { + r42 = r39 * r12; + r42 = fma(r0, r13, r23 * r42); + r42 = fma(r34, r27, r42); + r38 = 1.0 / r38; + r42 = r42 * r38; + r32 = fma(r42, r37, r32); + r37 = r28 * r12; + r43 = r39 * r12; + ReadIdx2<64, double, double, double2>(eqk, 4 * eqk_num_alloc, + global_thread_idx * eqk_stride + eqk_offset, r44, r45); + r46 = r1 * r14; + r46 = r46 * r12; + r46 = fma(r13, r46, r44); + r7 = fma(r46, r17, r7); + r7 = fma(r1, r8, r7); + r44 = r22 * r7; + r44 = fma(r18, r44, r46 * r9); + r43 = r43 * r44; + r43 = fma(r33, r43, r1 * r13); + r46 = r34 * r7; + r43 = fma(r18, r46, r43); + r37 = r37 * r43; + r46 = r2 * r7; + r46 = fma(r18, r46, r38 * r37); + r37 = r29 * r12; + r37 = r37 * r44; + r46 = fma(r33, r37, r46); + WriteIdx2<64, double, double, double2>(eq_marked, 0 * eq_marked_num_alloc, + global_thread_idx * eq_marked_stride + eq_marked_offset, + r32, r46); + r46 = r28 * r12; + r32 = r39 * r12; + ReadIdx2<64, double, double, double2>(eqk, 8 * eqk_num_alloc, + global_thread_idx * eqk_stride + eqk_offset, r37, r47); + r8 = fma(r21, r8, r37); + r37 = r21 * r14; + r37 = r37 * r12; + r37 = fma(r13, r37, r45); + r8 = fma(r37, r17, r8); + r17 = r22 * r8; + r9 = fma(r37, r9, r18 * r17); + r32 = r32 * r9; + r13 = fma(r21, r13, r33 * r32); + r32 = r34 * r8; + r13 = fma(r18, r32, r13); + r46 = r46 * r13; + r32 = r2 * r8; + r32 = fma(r18, r32, r38 * r46); + r46 = r29 * r12; + r46 = r46 * r9; + r32 = fma(r33, r46, r32); + }; + ReadAndShuffleWithDefault2<64, double, double, double2>( + (double*)inout_shared, eq, 4 * eq_num_alloc, global_thread_idx * eq_stride + eq_offset, + threadIdx.x == 63, global_thread_idx <= problem_size, eq_num_alloc, eq_stride, r46, r37, r17, + r45, 0.000000f, 0.000000f); + if (global_thread_idx < problem_size) { + r48 = r46 * r12; + r48 = fma(r23, r48, r37 * r27); + r49 = r3 * r12; + r48 = fma(r42, r49, r48); + WriteIdx2<64, double, double, double2>(eq_marked, 2 * eq_marked_num_alloc, + global_thread_idx * eq_marked_stride + eq_marked_offset, + r32, r48); + r48 = r3 * r12; + r48 = r48 * r43; + r32 = r37 * r7; + r32 = fma(r18, r32, r38 * r48); + r48 = r46 * r12; + r48 = r48 * r44; + r32 = fma(r33, r48, r32); + r48 = r3 * r12; + r48 = r48 * r13; + r49 = r37 * r8; + r49 = fma(r18, r49, r38 * r48); + r48 = r46 * r12; + r48 = r48 * r9; + r49 = fma(r33, r48, r49); + WriteIdx2<64, double, double, double2>(eq_marked, 4 * eq_marked_num_alloc, + global_thread_idx * eq_marked_stride + eq_marked_offset, + r32, r49); + }; + ReadAndShuffleWithDefault2<64, double, double, double2>( + (double*)inout_shared, eq, 8 * eq_num_alloc, global_thread_idx * eq_stride + eq_offset, + threadIdx.x == 63, global_thread_idx <= problem_size, eq_num_alloc, eq_stride, r49, r32, r48, + r50, 0.000000f, 1.000000f); + ReadAndShuffleWithDefault2<64, double, double, double2>( + (double*)inout_shared, eq, 6 * eq_num_alloc, global_thread_idx * eq_stride + eq_offset, + threadIdx.x == 63, global_thread_idx <= problem_size, eq_num_alloc, eq_stride, r50, r32, r51, + r52, 0.000000f, 0.000000f); + if (global_thread_idx < problem_size) { + r53 = r32 * r12; + r53 = fma(r23, r53, r49 * r27); + r27 = r50 * r12; + r53 = fma(r42, r27, r53); + r27 = r50 * r12; + r27 = r27 * r43; + r54 = r49 * r7; + r54 = fma(r18, r54, r38 * r27); + r27 = r32 * r12; + r27 = r27 * r44; + r54 = fma(r33, r27, r54); + WriteIdx2<64, double, double, double2>(eq_marked, 6 * eq_marked_num_alloc, + global_thread_idx * eq_marked_stride + eq_marked_offset, + r53, r54); + }; + ReadAndShuffleWithDefault2<64, double, double, double2>( + (double*)inout_shared, eq, 20 * eq_num_alloc, global_thread_idx * eq_stride + eq_offset, + threadIdx.x == 63, global_thread_idx <= problem_size, eq_num_alloc, eq_stride, r54, r53, r27, + r55, 0.000000f, 0.000000f); + if (global_thread_idx < problem_size) { + r56 = r54 * r6; + }; + ReadAndShuffleWithDefault2<64, double, double, double2>( + (double*)inout_shared, eq, 18 * eq_num_alloc, global_thread_idx * eq_stride + eq_offset, + threadIdx.x == 63, global_thread_idx <= problem_size, eq_num_alloc, eq_stride, r57, r58, r59, + r60, 0.000000f, 0.000000f); + if (global_thread_idx < problem_size) { + r56 = fma(r58, r23, r24 * r56); + r56 = fma(r57, r42, r56); + r56 = fma(r12, r56, r47); + r11 = 1.0 / r11; + ReadIdx2<64, double, double, double2>(eqk, 20 * eqk_num_alloc, + global_thread_idx * eqk_stride + eqk_offset, r47, r61); + ReadIdx2<64, double, double, double2>(eqk, 18 * eqk_num_alloc, + global_thread_idx * eqk_stride + eqk_offset, r62, r63); + r16 = r16 * r12; + r15 = 1.0 / r15; + r16 = r16 * r15; + r61 = fma(r62, r16, r61); + ReadIdx2<64, double, double, double2>(eqk, 24 * eqk_num_alloc, + global_thread_idx * eqk_stride + eqk_offset, r64, r65); + r19 = r19 * r12; + r19 = r19 * r11; + r64 = fma(r61, r19, r64); + r66 = r62 * r10; + r66 = r66 * r12; + r64 = fma(r15, r66, r64); + r20 = 1.0 / r20; + r26 = 1.0 / r26; + r26 = r20 * r26; + r64 = r64 * r26; + r20 = r12 * r64; + r61 = fma(r25, r20, r61 * r11); + r35 = 1.0 / r35; + r61 = r61 * r35; + r66 = r41 * r12; + r66 = fma(r61, r66, r62 * r15); + r66 = fma(r36, r20, r66); + r40 = 1.0 / r40; + r66 = r66 * r40; + r67 = fma(r30, r66, r31 * r61); + r67 = fma(r4, r64, r67); + r56 = fma(r12, r67, r56); + r67 = r50 * r12; + r67 = r67 * r13; + r68 = r49 * r8; + r68 = fma(r18, r68, r38 * r67); + r67 = r32 * r12; + r67 = r67 * r9; + r68 = fma(r33, r67, r68); + WriteIdx2<64, double, double, double2>(eq_marked, 8 * eq_marked_num_alloc, + global_thread_idx * eq_marked_stride + eq_marked_offset, + r68, r56); + ReadIdx2<64, double, double, double2>(eqk, 10 * eqk_num_alloc, + global_thread_idx * eqk_stride + eqk_offset, r68, r67); + r18 = r41 * r12; + r69 = r25 * r12; + ReadIdx2<64, double, double, double2>(eqk, 22 * eqk_num_alloc, + global_thread_idx * eqk_stride + eqk_offset, r70, r71); + r70 = fma(r63, r16, r70); + r65 = fma(r70, r19, r65); + r72 = r63 * r10; + r72 = r72 * r12; + r65 = fma(r15, r72, r65); + r69 = r69 * r65; + r70 = fma(r70, r11, r26 * r69); + r18 = r18 * r70; + r18 = fma(r35, r18, r63 * r15); + r69 = r36 * r12; + r69 = r69 * r65; + r18 = fma(r26, r69, r18); + r69 = r30 * r18; + r72 = r4 * r65; + r72 = fma(r26, r72, r40 * r69); + r69 = r31 * r70; + r72 = fma(r35, r69, r72); + r72 = fma(r12, r72, r68); + r68 = r57 * r43; + r69 = r58 * r44; + r69 = fma(r33, r69, r38 * r68); + r68 = r54 * r7; + r69 = fma(r24, r68, r69); + r72 = fma(r12, r69, r72); + r69 = r25 * r12; + ReadIdx2<64, double, double, double2>(eqk, 26 * eqk_num_alloc, + global_thread_idx * eqk_stride + eqk_offset, r68, r73); + r16 = fma(r47, r16, r71); + r19 = fma(r16, r19, r68); + r68 = r47 * r10; + r68 = r68 * r12; + r19 = fma(r15, r68, r19); + r69 = r69 * r19; + r11 = fma(r16, r11, r26 * r69); + r16 = r31 * r11; + r69 = r4 * r19; + r69 = fma(r26, r69, r35 * r16); + r16 = r36 * r12; + r16 = r16 * r19; + r16 = fma(r26, r16, r47 * r15); + r15 = r41 * r12; + r15 = r15 * r11; + r16 = fma(r35, r15, r16); + r15 = r30 * r16; + r69 = fma(r40, r15, r69); + r69 = fma(r12, r69, r67); + r67 = r57 * r13; + r15 = r54 * r8; + r15 = fma(r24, r15, r38 * r67); + r67 = r58 * r9; + r15 = fma(r33, r67, r15); + r69 = fma(r12, r15, r69); + WriteIdx2<64, double, double, double2>(eq_marked, 10 * eq_marked_num_alloc, + global_thread_idx * eq_marked_stride + eq_marked_offset, + r72, r69); + ReadIdx2<64, double, double, double2>(eqk, 12 * eqk_num_alloc, + global_thread_idx * eqk_stride + eqk_offset, r15, r67); + }; + ReadAndShuffleWithDefault2<64, double, double, double2>( + (double*)inout_shared, eq, 22 * eq_num_alloc, global_thread_idx * eq_stride + eq_offset, + threadIdx.x == 63, global_thread_idx <= problem_size, eq_num_alloc, eq_stride, r68, r71, r74, + r75, 0.000000f, 0.000000f); + if (global_thread_idx < problem_size) { + r76 = r71 * r6; + r76 = fma(r68, r23, r24 * r76); + r76 = fma(r53, r42, r76); + r76 = fma(r12, r76, r15); + r15 = fma(r5, r66, r17 * r61); + r15 = fma(r45, r64, r15); + r76 = fma(r12, r15, r76); + r15 = r5 * r18; + r77 = r45 * r65; + r77 = fma(r26, r77, r40 * r15); + r15 = r17 * r70; + r77 = fma(r35, r15, r77); + r77 = fma(r12, r77, r67); + r67 = r53 * r43; + r15 = r68 * r44; + r15 = fma(r33, r15, r38 * r67); + r67 = r71 * r7; + r15 = fma(r24, r67, r15); + r77 = fma(r12, r15, r77); + WriteIdx2<64, double, double, double2>(eq_marked, 12 * eq_marked_num_alloc, + global_thread_idx * eq_marked_stride + eq_marked_offset, + r76, r77); + ReadIdx2<64, double, double, double2>(eqk, 14 * eqk_num_alloc, + global_thread_idx * eqk_stride + eqk_offset, r15, r67); + r78 = r17 * r11; + r79 = r45 * r19; + r79 = fma(r26, r79, r35 * r78); + r78 = r5 * r16; + r79 = fma(r40, r78, r79); + r79 = fma(r12, r79, r15); + r15 = r53 * r13; + r78 = r71 * r8; + r78 = fma(r24, r78, r38 * r15); + r15 = r68 * r9; + r78 = fma(r33, r15, r78); + r79 = fma(r12, r78, r79); + }; + ReadAndShuffleWithDefault2<64, double, double, double2>( + (double*)inout_shared, eq, 26 * eq_num_alloc, global_thread_idx * eq_stride + eq_offset, + threadIdx.x == 63, global_thread_idx <= problem_size, eq_num_alloc, eq_stride, r78, r15, r80, + r81, 0.000000f, 0.000000f); + if (global_thread_idx < problem_size) { + r82 = r78 * r6; + }; + ReadAndShuffleWithDefault2<64, double, double, double2>( + (double*)inout_shared, eq, 24 * eq_num_alloc, global_thread_idx * eq_stride + eq_offset, + threadIdx.x == 63, global_thread_idx <= problem_size, eq_num_alloc, eq_stride, r83, r84, r85, + r86, 0.000000f, 0.000000f); + if (global_thread_idx < problem_size) { + r82 = fma(r84, r23, r24 * r82); + r82 = fma(r83, r42, r82); + r82 = fma(r12, r82, r67); + r67 = fma(r51, r66, r52 * r61); + r67 = fma(r48, r64, r67); + r82 = fma(r12, r67, r82); + WriteIdx2<64, double, double, double2>(eq_marked, 14 * eq_marked_num_alloc, + global_thread_idx * eq_marked_stride + eq_marked_offset, + r79, r82); + ReadIdx2<64, double, double, double2>(eqk, 16 * eqk_num_alloc, + global_thread_idx * eqk_stride + eqk_offset, r67, r87); + r88 = r51 * r18; + r89 = r48 * r65; + r89 = fma(r26, r89, r40 * r88); + r88 = r52 * r70; + r89 = fma(r35, r88, r89); + r89 = fma(r12, r89, r67); + r67 = r83 * r43; + r88 = r84 * r44; + r88 = fma(r33, r88, r38 * r67); + r67 = r78 * r7; + r88 = fma(r24, r67, r88); + r89 = fma(r12, r88, r89); + r88 = r52 * r11; + r67 = r48 * r19; + r67 = fma(r26, r67, r35 * r88); + r88 = r51 * r16; + r67 = fma(r40, r88, r67); + r67 = fma(r12, r67, r87); + r87 = r83 * r13; + r88 = r78 * r8; + r88 = fma(r24, r88, r38 * r87); + r87 = r84 * r9; + r88 = fma(r33, r87, r88); + r67 = fma(r12, r88, r67); + WriteIdx2<64, double, double, double2>(eq_marked, 16 * eq_marked_num_alloc, + global_thread_idx * eq_marked_stride + eq_marked_offset, + r89, r67); + r88 = r60 * r12; + r87 = r59 * r12; + r87 = fma(r66, r87, r61 * r88); + r87 = fma(r27, r20, r87); + r88 = r59 * r12; + r88 = r88 * r18; + r90 = r27 * r12; + r90 = r90 * r65; + r90 = fma(r26, r90, r40 * r88); + r88 = r60 * r12; + r88 = r88 * r70; + r90 = fma(r35, r88, r90); + WriteIdx2<64, double, double, double2>(eq_marked, 18 * eq_marked_num_alloc, + global_thread_idx * eq_marked_stride + eq_marked_offset, + r87, r90); + r90 = r60 * r12; + r90 = r90 * r11; + r87 = r27 * r12; + r87 = r87 * r19; + r87 = fma(r26, r87, r35 * r90); + r90 = r59 * r12; + r90 = r90 * r16; + r87 = fma(r40, r90, r87); + r90 = r74 * r12; + r88 = r55 * r12; + r88 = fma(r66, r88, r61 * r90); + r88 = fma(r75, r20, r88); + WriteIdx2<64, double, double, double2>(eq_marked, 20 * eq_marked_num_alloc, + global_thread_idx * eq_marked_stride + eq_marked_offset, + r87, r88); + r88 = r55 * r12; + r88 = r88 * r18; + r87 = r75 * r12; + r87 = r87 * r65; + r87 = fma(r26, r87, r40 * r88); + r88 = r74 * r12; + r88 = r88 * r70; + r87 = fma(r35, r88, r87); + r88 = r74 * r12; + r88 = r88 * r11; + r90 = r75 * r12; + r90 = r90 * r19; + r90 = fma(r26, r90, r35 * r88); + r88 = r55 * r12; + r88 = r88 * r16; + r90 = fma(r40, r88, r90); + WriteIdx2<64, double, double, double2>(eq_marked, 22 * eq_marked_num_alloc, + global_thread_idx * eq_marked_stride + eq_marked_offset, + r87, r90); + r90 = r86 * r12; + r87 = r85 * r12; + r87 = fma(r66, r87, r61 * r90); + r87 = fma(r80, r20, r87); + r20 = r85 * r12; + r20 = r20 * r18; + r90 = r80 * r12; + r90 = r90 * r65; + r90 = fma(r26, r90, r40 * r20); + r20 = r86 * r12; + r20 = r20 * r70; + r90 = fma(r35, r20, r90); + WriteIdx2<64, double, double, double2>(eq_marked, 24 * eq_marked_num_alloc, + global_thread_idx * eq_marked_stride + eq_marked_offset, + r87, r90); + }; + ReadAndShuffleWithDefault2<64, double, double, double2>( + (double*)inout_shared, eq, 28 * eq_num_alloc, global_thread_idx * eq_stride + eq_offset, + threadIdx.x == 63, global_thread_idx <= problem_size, eq_num_alloc, eq_stride, r90, r87, r20, + r88, 0.000000f, 0.000000f); + if (global_thread_idx < problem_size) { + r64 = fma(r88, r64, r20 * r61); + r64 = fma(r81, r66, r64); + r64 = fma(r12, r64, r73); + r23 = fma(r90, r23, r15 * r42); + r42 = r87 * r6; + r23 = fma(r24, r42, r23); + r64 = fma(r12, r23, r64); + r23 = r86 * r12; + r23 = r23 * r11; + r42 = r80 * r12; + r42 = r42 * r19; + r42 = fma(r26, r42, r35 * r23); + r23 = r85 * r12; + r23 = r23 * r16; + r42 = fma(r40, r23, r42); + WriteIdx2<64, double, double, double2>(eq_marked, 26 * eq_marked_num_alloc, + global_thread_idx * eq_marked_stride + eq_marked_offset, + r42, r64); + ReadIdx2<64, double, double, double2>(eqk, 28 * eqk_num_alloc, + global_thread_idx * eqk_stride + eqk_offset, r64, r42); + r23 = r20 * r70; + r73 = r81 * r18; + r73 = fma(r40, r73, r35 * r23); + r23 = r88 * r65; + r73 = fma(r26, r23, r73); + r73 = fma(r12, r73, r64); + r64 = r15 * r43; + r23 = r90 * r44; + r23 = fma(r33, r23, r38 * r64); + r64 = r87 * r7; + r23 = fma(r24, r64, r23); + r73 = fma(r12, r23, r73); + r23 = r90 * r9; + r64 = r87 * r8; + r64 = fma(r24, r64, r33 * r23); + r23 = r15 * r13; + r64 = fma(r38, r23, r64); + r64 = fma(r12, r64, r42); + r42 = r88 * r19; + r23 = r81 * r16; + r23 = fma(r40, r23, r26 * r42); + r42 = r20 * r11; + r23 = fma(r35, r42, r23); + r64 = fma(r12, r23, r64); + WriteIdx2<64, double, double, double2>(eq_marked, 28 * eq_marked_num_alloc, + global_thread_idx * eq_marked_stride + eq_marked_offset, + r73, r64); + ReadIdx2<64, double, double, double2>(eqk, 30 * eqk_num_alloc, + global_thread_idx * eqk_stride + eqk_offset, r64, r73); + r73 = 1.00000000000000000e+00; + r64 = 1.0 / r56; + r72 = r72 * r64; + WriteIdx2<64, double, double, double2>(eq_marked, 30 * eq_marked_num_alloc, + global_thread_idx * eq_marked_stride + eq_marked_offset, + r73, r72); + ReadIdx2<64, double, double, double2>(eqk, 32 * eqk_num_alloc, + global_thread_idx * eqk_stride + eqk_offset, r23, r42); + r42 = r69 * r64; + WriteIdx2<64, double, double, double2>(eq_marked, 32 * eq_marked_num_alloc, + global_thread_idx * eq_marked_stride + eq_marked_offset, + r73, r42); + ReadIdx2<64, double, double, double2>(eqk, 34 * eqk_num_alloc, + global_thread_idx * eqk_stride + eqk_offset, r42, r23); + r72 = r12 * r72; + r77 = fma(r76, r72, r77); + r23 = 1.0 / r77; + r42 = r12 * r69; + r42 = r42 * r76; + r42 = fma(r64, r42, r79); + r42 = r23 * r42; + WriteIdx2<64, double, double, double2>(eq_marked, 34 * eq_marked_num_alloc, + global_thread_idx * eq_marked_stride + eq_marked_offset, + r42, r73); + ReadIdx2<64, double, double, double2>(eqk, 36 * eqk_num_alloc, + global_thread_idx * eqk_stride + eqk_offset, r73, r23); + WriteIdx2<64, double, double, double2>(eq_marked, 36 * eq_marked_num_alloc, + global_thread_idx * eq_marked_stride + eq_marked_offset, + r56, r76); + ReadIdx2<64, double, double, double2>(eqk, 38 * eqk_num_alloc, + global_thread_idx * eqk_stride + eqk_offset, r76, r56); + WriteIdx2<64, double, double, double2>(eq_marked, 38 * eq_marked_num_alloc, + global_thread_idx * eq_marked_stride + eq_marked_offset, + r82, r77); + ReadIdx2<64, double, double, double2>(eqk, 40 * eqk_num_alloc, + global_thread_idx * eqk_stride + eqk_offset, r77, r56); + r72 = fma(r82, r72, r89); + r89 = r12 * r72; + r56 = r12 * r69; + r56 = r56 * r82; + r56 = fma(r64, r56, r42 * r89); + r56 = r56 + r67; + WriteIdx2<64, double, double, double2>(eq_marked, 40 * eq_marked_num_alloc, + global_thread_idx * eq_marked_stride + eq_marked_offset, + r72, r56); + }; +} + +void ChainBCyclicReductionDown(double* eqk, unsigned int eqk_num_alloc, int eqk_offset, + int eqk_stride, double* const eq, unsigned int eq_num_alloc, + int eq_offset, int eq_stride, double* eq_marked, + unsigned int eq_marked_num_alloc, int eq_marked_offset, + int eq_marked_stride, size_t problem_size) { + if (problem_size == 0) { + return; + } + + const int n_blocks = (problem_size + 64 - 1) / 64; + // Kernels using more than 48 KB of shared memory per block must opt in. + static const cudaError_t attribute_error = cudaFuncSetAttribute( + ChainBCyclicReductionDownKernel, cudaFuncAttributeMaxDynamicSharedMemorySize, 1024); + if (attribute_error != cudaSuccess) { + throw std::runtime_error(std::string("ChainBCyclicReductionDownKernel: ") + + cudaGetErrorString(attribute_error)); + } + ChainBCyclicReductionDownKernel<<>>( + eqk, eqk_num_alloc, eqk_offset, eqk_stride, eq, eq_num_alloc, eq_offset, eq_stride, eq_marked, + eq_marked_num_alloc, eq_marked_offset, eq_marked_stride, problem_size); + // A launch that fails (e.g. from exceeding shared memory or register limits) + // otherwise leaves its outputs untouched without any error. + const cudaError_t launch_error = cudaGetLastError(); + if (launch_error != cudaSuccess) { + throw std::runtime_error(std::string("ChainBCyclicReductionDownKernel launch failed: ") + + cudaGetErrorString(launch_error)); + } +} + +} // namespace caspar \ No newline at end of file diff --git a/test/symforce_function_codegen_test_data/symengine/symforce_caspar_tridiagonal_test/kernel_ChainB_cyclic_reduction_down.h b/test/symforce_function_codegen_test_data/symengine/symforce_caspar_tridiagonal_test/kernel_ChainB_cyclic_reduction_down.h new file mode 100644 index 00000000..8ceb4040 --- /dev/null +++ b/test/symforce_function_codegen_test_data/symengine/symforce_caspar_tridiagonal_test/kernel_ChainB_cyclic_reduction_down.h @@ -0,0 +1,15 @@ +#pragma once + +#include + +#include "shared_indices.h" + +namespace caspar { + +void ChainBCyclicReductionDown(double* eqk, unsigned int eqk_num_alloc, int eqk_offset, + int eqk_stride, double* const eq, unsigned int eq_num_alloc, + int eq_offset, int eq_stride, double* eq_marked, + unsigned int eq_marked_num_alloc, int eq_marked_offset, + int eq_marked_stride, size_t problem_size); + +} // namespace caspar \ No newline at end of file diff --git a/test/symforce_function_codegen_test_data/symengine/symforce_caspar_tridiagonal_test/kernel_ChainB_cyclic_reduction_solve_two.cu b/test/symforce_function_codegen_test_data/symengine/symforce_caspar_tridiagonal_test/kernel_ChainB_cyclic_reduction_solve_two.cu new file mode 100644 index 00000000..aee9c96d --- /dev/null +++ b/test/symforce_function_codegen_test_data/symengine/symforce_caspar_tridiagonal_test/kernel_ChainB_cyclic_reduction_solve_two.cu @@ -0,0 +1,438 @@ +#include +#include + +#include +#include +#include +#include +#include + +#include "kernel_ChainB_cyclic_reduction_solve_two.h" +#include "memops.cuh" + +namespace cg = cooperative_groups; + +namespace caspar { + +__global__ void __launch_bounds__(32, 1) ChainBCyclicReductionSolveTwoKernel( + double* const eq, unsigned int eq_num_alloc, int eq_offset, int eq_stride, double* solu2km1, + unsigned int solu2km1_num_alloc, int solu2km1_offset, int solu2km1_stride, double* solu2k, + unsigned int solu2k_num_alloc, int solu2k_offset, int solu2k_stride, size_t problem_size) { + const int global_thread_idx = blockIdx.x * blockDim.x + threadIdx.x; + // Scratch data, then the shared indices of each shared accessor; dynamic, so + // that it may exceed the 48 KB static shared memory limit (see the launch + // below). + extern __shared__ __align__(16) uint8_t inout_shared[]; + + double r0 = 0, r1 = 0, r2 = 0, r3 = 0, r4 = 0, r5 = 0, r6 = 0, r7 = 0, r8 = 0, r9 = 0, r10 = 0, + r11 = 0, r12 = 0, r13 = 0, r14 = 0, r15 = 0, r16 = 0, r17 = 0, r18 = 0, r19 = 0, r20 = 0, + r21 = 0, r22 = 0, r23 = 0, r24 = 0, r25 = 0, r26 = 0, r27 = 0, r28 = 0, r29 = 0, r30 = 0, + r31 = 0, r32 = 0, r33 = 0, r34 = 0, r35 = 0, r36 = 0, r37 = 0, r38 = 0, r39 = 0, r40 = 0, + r41 = 0, r42 = 0, r43 = 0, r44 = 0, r45 = 0, r46 = 0, r47 = 0, r48 = 0, r49 = 0, r50 = 0, + r51 = 0, r52 = 0, r53 = 0, r54 = 0, r55 = 0, r56 = 0, r57 = 0, r58 = 0, r59 = 0, r60 = 0, + r61 = 0, r62 = 0, r63 = 0; + + if (global_thread_idx < problem_size) { + r0 = -1.00000000000000000e+00; + }; + ReadAndShuffleWithDefault2<32, double, double, double2>( + (double*)inout_shared, eq, 24 * eq_num_alloc, global_thread_idx * eq_stride + eq_offset, + threadIdx.x == 31, global_thread_idx <= problem_size, eq_num_alloc, eq_stride, r1, r2, r3, r4, + 0.000000f, 0.000000f); + ReadAndShuffleWithDefault2<32, double, double, double2>( + (double*)inout_shared, eq, 30 * eq_num_alloc, global_thread_idx * eq_stride + eq_offset, + threadIdx.x == 31, global_thread_idx <= problem_size, eq_num_alloc, eq_stride, r4, r3, r5, r6, + 1.000000f, 0.000000f); + if (global_thread_idx < problem_size) { + r4 = 1.0 / r4; + }; + ReadAndShuffleWithDefault2<32, double, double, double2>( + (double*)inout_shared, eq, 36 * eq_num_alloc, global_thread_idx * eq_stride + eq_offset, + threadIdx.x == 31, global_thread_idx <= problem_size, eq_num_alloc, eq_stride, r7, r8, r9, + r10, 1.000000f, 0.000000f); + if (global_thread_idx < problem_size) { + r11 = r8 * r0; + }; + ReadAndShuffleWithDefault2<32, double, double, double2>( + (double*)inout_shared, eq, 32 * eq_num_alloc, global_thread_idx * eq_stride + eq_offset, + threadIdx.x == 31, global_thread_idx <= problem_size, eq_num_alloc, eq_stride, r12, r13, r14, + r15, 1.000000f, 0.000000f); + if (global_thread_idx < problem_size) { + r12 = 1.0 / r12; + r3 = r3 * r0; + r3 = r3 * r4; + r2 = fma(r1, r3, r2); + }; + ReadAndShuffleWithDefault2<32, double, double, double2>( + (double*)inout_shared, eq, 40 * eq_num_alloc, global_thread_idx * eq_stride + eq_offset, + threadIdx.x == 31, global_thread_idx <= problem_size, eq_num_alloc, eq_stride, r16, r17, r18, + r19, 0.000000f, 1.000000f); + ReadAndShuffleWithDefault2<32, double, double, double2>( + (double*)inout_shared, eq, 26 * eq_num_alloc, global_thread_idx * eq_stride + eq_offset, + threadIdx.x == 31, global_thread_idx <= problem_size, eq_num_alloc, eq_stride, r20, r21, r22, + r23, 0.000000f, 0.000000f); + ReadAndShuffleWithDefault2<32, double, double, double2>( + (double*)inout_shared, eq, 34 * eq_num_alloc, global_thread_idx * eq_stride + eq_offset, + threadIdx.x == 31, global_thread_idx <= problem_size, eq_num_alloc, eq_stride, r22, r24, r25, + r26, 0.000000f, 1.000000f); + if (global_thread_idx < problem_size) { + r22 = r22 * r0; + r22 = r22 * r12; + r20 = fma(r2, r22, r20); + r27 = r1 * r13; + r27 = r27 * r0; + r20 = fma(r4, r27, r20); + r27 = r16 * r20; + r17 = 1.0 / r17; + r24 = 1.0 / r24; + r24 = r17 * r24; + r17 = r0 * r24; + r27 = fma(r17, r27, r2 * r12); + }; + ReadAndShuffleWithDefault2<32, double, double, double2>( + (double*)inout_shared, eq, 38 * eq_num_alloc, global_thread_idx * eq_stride + eq_offset, + threadIdx.x == 31, global_thread_idx <= problem_size, eq_num_alloc, eq_stride, r2, r28, r29, + r30, 0.000000f, 1.000000f); + if (global_thread_idx < problem_size) { + r28 = 1.0 / r28; + r11 = r11 * r27; + r11 = fma(r28, r11, r1 * r4); + r31 = r2 * r20; + r11 = fma(r17, r31, r11); + r31 = r0 * r11; + r7 = 1.0 / r7; + }; + ReadAndShuffleWithDefault2<32, double, double, double2>( + (double*)inout_shared, eq, 4 * eq_num_alloc, global_thread_idx * eq_stride + eq_offset, + threadIdx.x == 31, global_thread_idx <= problem_size, eq_num_alloc, eq_stride, r32, r33, r34, + r35, 0.000000f, 0.000000f); + if (global_thread_idx < problem_size) { + r25 = r25 * r0; + r14 = 1.0 / r14; + r25 = r25 * r14; + }; + ReadAndShuffleWithDefault2<32, double, double, double2>( + (double*)inout_shared, eq, 2 * eq_num_alloc, global_thread_idx * eq_stride + eq_offset, + threadIdx.x == 31, global_thread_idx <= problem_size, eq_num_alloc, eq_stride, r33, r32, r36, + r37, 0.000000f, 0.000000f); + if (global_thread_idx < problem_size) { + r6 = r6 * r0; + r5 = 1.0 / r5; + r6 = r6 * r5; + r34 = fma(r37, r6, r34); + r35 = fma(r34, r25, r35); + r32 = r37 * r15; + r32 = r32 * r0; + r35 = fma(r5, r32, r35); + r26 = 1.0 / r26; + r19 = 1.0 / r19; + r19 = r26 * r19; + r26 = r0 * r19; + r32 = r35 * r26; + }; + ReadAndShuffleWithDefault2<32, double, double, double2>( + (double*)inout_shared, eq, 22 * eq_num_alloc, global_thread_idx * eq_stride + eq_offset, + threadIdx.x == 31, global_thread_idx <= problem_size, eq_num_alloc, eq_stride, r33, r38, r39, + r40, 0.000000f, 0.000000f); + ReadAndShuffleWithDefault2<32, double, double, double2>( + (double*)inout_shared, eq, 20 * eq_num_alloc, global_thread_idx * eq_stride + eq_offset, + threadIdx.x == 31, global_thread_idx <= problem_size, eq_num_alloc, eq_stride, r40, r39, r41, + r42, 0.000000f, 0.000000f); + if (global_thread_idx < problem_size) { + r33 = fma(r39, r3, r33); + r38 = fma(r33, r22, r38); + r42 = r39 * r13; + r42 = r42 * r0; + r38 = fma(r4, r42, r38); + r38 = r38 * r17; + r33 = fma(r33, r12, r16 * r38); + r33 = r33 * r28; + }; + ReadAndShuffleWithDefault2<32, double, double, double2>( + (double*)inout_shared, eq, 8 * eq_num_alloc, global_thread_idx * eq_stride + eq_offset, + threadIdx.x == 31, global_thread_idx <= problem_size, eq_num_alloc, eq_stride, r42, r41, r43, + r44, 0.000000f, 1.000000f); + ReadAndShuffleWithDefault2<32, double, double, double2>( + (double*)inout_shared, eq, 6 * eq_num_alloc, global_thread_idx * eq_stride + eq_offset, + threadIdx.x == 31, global_thread_idx <= problem_size, eq_num_alloc, eq_stride, r44, r41, r42, + r45, 0.000000f, 0.000000f); + if (global_thread_idx < problem_size) { + r41 = r42 * r15; + r41 = r41 * r0; + r41 = fma(r5, r41, r43); + r45 = fma(r42, r6, r45); + r41 = fma(r45, r25, r41); + r43 = r41 * r19; + r43 = fma(r38, r43, r33 * r32); + r32 = r8 * r0; + r32 = fma(r39, r4, r33 * r32); + r32 = fma(r2, r38, r32); + r44 = r32 * r7; + }; + ReadAndShuffleWithDefault2<32, double, double, double2>( + (double*)inout_shared, eq, 0 * eq_num_alloc, global_thread_idx * eq_stride + eq_offset, + threadIdx.x == 31, global_thread_idx <= problem_size, eq_num_alloc, eq_stride, r46, r47, r48, + r49, 0.000000f, 0.000000f); + if (global_thread_idx < problem_size) { + r49 = fma(r48, r6, r49); + r36 = fma(r49, r25, r36); + r47 = r48 * r15; + r47 = r47 * r0; + r36 = fma(r5, r47, r36); + r36 = r36 * r26; + r43 = fma(r36, r44, r43); + r47 = r29 * r35; + r46 = r18 * r35; + r34 = fma(r34, r14, r26 * r46); + r34 = r0 * r34; + r30 = 1.0 / r30; + r34 = r34 * r30; + r47 = fma(r10, r34, r26 * r47); + r47 = fma(r37, r5, r47); + r46 = r0 * r47; + r9 = 1.0 / r9; + r46 = r46 * r9; + r50 = r10 * r0; + r51 = r18 * r41; + r45 = fma(r45, r14, r26 * r51); + r50 = r50 * r45; + r51 = r29 * r41; + r51 = fma(r26, r51, r30 * r50); + r51 = fma(r42, r5, r51); + r50 = r51 * r9; + r50 = fma(r38, r50, r33 * r46); + r46 = r10 * r0; + r49 = fma(r18, r36, r49 * r14); + r46 = r46 * r49; + r46 = fma(r30, r46, r29 * r36); + r46 = fma(r48, r5, r46); + r46 = r0 * r46; + r46 = r46 * r7; + r46 = r46 * r9; + r50 = fma(r32, r46, r50); + r52 = r0 * r50; + }; + ReadAndShuffleWithDefault2<32, double, double, double2>( + (double*)inout_shared, eq, 18 * eq_num_alloc, global_thread_idx * eq_stride + eq_offset, + threadIdx.x == 31, global_thread_idx <= problem_size, eq_num_alloc, eq_stride, r53, r54, r55, + r56, 0.000000f, 0.000000f); + if (global_thread_idx < problem_size) { + r54 = fma(r53, r3, r54); + r40 = fma(r54, r22, r40); + r56 = r53 * r13; + r56 = r56 * r0; + r40 = fma(r4, r56, r40); + r56 = r41 * r40; + r56 = r56 * r17; + r55 = r8 * r0; + r57 = r16 * r40; + r54 = fma(r54, r12, r17 * r57); + r55 = r55 * r54; + r57 = r2 * r40; + r57 = fma(r17, r57, r28 * r55); + r57 = fma(r53, r4, r57); + r55 = r57 * r7; + r55 = fma(r36, r55, r19 * r56); + r56 = r35 * r54; + r56 = r56 * r28; + r55 = fma(r26, r56, r55); + r56 = 1.00000000000000000e+00; + r58 = r40 * r51; + r58 = r58 * r9; + r58 = fma(r17, r58, r56); + r59 = r0 * r54; + r59 = r59 * r47; + r59 = r59 * r28; + r58 = fma(r9, r59, r58); + r58 = fma(r57, r46, r58); + r58 = 1.0 / r58; + r52 = r52 * r55; + r43 = fma(r58, r52, r43); + r52 = r0 * r43; + r44 = r45 * r40; + r44 = r44 * r30; + r59 = r0 * r49; + r59 = r59 * r57; + r59 = r59 * r7; + r59 = fma(r30, r59, r17 * r44); + r44 = r54 * r28; + r59 = fma(r34, r44, r59); + r44 = r0 * r59; + }; + ReadAndShuffleWithDefault2<32, double, double, double2>( + (double*)inout_shared, eq, 28 * eq_num_alloc, global_thread_idx * eq_stride + eq_offset, + threadIdx.x == 31, global_thread_idx <= problem_size, eq_num_alloc, eq_stride, r60, r61, r62, + r63, 0.000000f, 0.000000f); + if (global_thread_idx < problem_size) { + r3 = fma(r21, r3, r60); + r22 = fma(r3, r22, r61); + r61 = r21 * r13; + r61 = r61 * r0; + r22 = fma(r4, r61, r22); + r61 = r2 * r22; + r4 = fma(r21, r4, r17 * r61); + r61 = r8 * r0; + r60 = r16 * r22; + r60 = fma(r17, r60, r3 * r12); + r61 = r61 * r60; + r4 = fma(r28, r61, r4); + r61 = r0 * r47; + r61 = r61 * r60; + r61 = r61 * r28; + r61 = fma(r9, r61, r4 * r46); + r12 = r51 * r22; + r12 = r12 * r9; + r61 = fma(r17, r12, r61); + r6 = fma(r23, r6, r62); + r25 = fma(r6, r25, r63); + r63 = r23 * r15; + r63 = r63 * r0; + r25 = fma(r5, r63, r25); + r63 = r29 * r25; + r5 = fma(r23, r5, r26 * r63); + r63 = r10 * r0; + r62 = r18 * r25; + r14 = fma(r6, r14, r26 * r62); + r63 = r63 * r14; + r5 = fma(r30, r63, r5); + r61 = fma(r5, r9, r61); + r44 = r44 * r61; + r5 = r0 * r49; + r5 = r5 * r4; + r5 = r5 * r7; + r5 = fma(r30, r5, r58 * r44); + r44 = r45 * r22; + r44 = r44 * r30; + r5 = fma(r17, r44, r5); + r12 = r60 * r28; + r5 = fma(r34, r12, r5); + r5 = fma(r14, r30, r5); + r14 = r45 * r30; + r14 = fma(r38, r14, r56); + r12 = r0 * r59; + r12 = r12 * r50; + r14 = fma(r58, r12, r14); + r44 = r0 * r49; + r44 = r44 * r32; + r44 = r44 * r7; + r14 = fma(r30, r44, r14); + r14 = fma(r34, r33, r14); + r14 = 1.0 / r14; + r52 = r52 * r5; + r44 = r41 * r22; + r44 = r44 * r17; + r44 = fma(r19, r44, r14 * r52); + r52 = r0 * r55; + r52 = r52 * r61; + r44 = fma(r58, r52, r44); + r12 = r35 * r60; + r12 = r12 * r28; + r44 = fma(r26, r12, r44); + r63 = r4 * r7; + r44 = fma(r36, r63, r44); + r44 = fma(r25, r19, r44); + r63 = r0 * r43; + r12 = r27 * r28; + r52 = r0 * r49; + r52 = r52 * r11; + r52 = r52 * r7; + r52 = fma(r30, r52, r34 * r12); + r12 = r0 * r59; + r34 = r51 * r20; + r34 = r34 * r9; + r34 = fma(r17, r34, r11 * r46); + r46 = r0 * r47; + r46 = r46 * r27; + r46 = r46 * r28; + r34 = fma(r9, r46, r34); + r12 = r12 * r34; + r52 = fma(r58, r12, r52); + r46 = r45 * r20; + r46 = r46 * r30; + r52 = fma(r17, r46, r52); + r63 = r63 * r52; + r63 = fma(r14, r63, r56); + r56 = r41 * r20; + r56 = r56 * r17; + r63 = fma(r19, r56, r63); + r46 = r0 * r55; + r46 = r46 * r34; + r63 = fma(r58, r46, r63); + r12 = r35 * r27; + r12 = r12 * r28; + r63 = fma(r26, r12, r63); + r6 = r11 * r7; + r63 = fma(r36, r6, r63); + r63 = 1.0 / r63; + r63 = r44 * r63; + r31 = r31 * r7; + r44 = r57 * r7; + r6 = r0 * r50; + r12 = r0 * r52; + r12 = fma(r63, r12, r5); + r12 = r14 * r12; + r14 = r0 * r34; + r14 = fma(r63, r14, r12 * r6); + r14 = r14 + r61; + r14 = r58 * r14; + r58 = r0 * r14; + r44 = fma(r58, r44, r63 * r31); + r31 = r0 * r32; + r31 = r31 * r7; + r44 = fma(r12, r31, r44); + r44 = fma(r4, r7, r44); + r31 = r54 * r28; + r61 = r0 * r27; + r61 = r61 * r28; + r61 = fma(r63, r61, r58 * r31); + r31 = r0 * r33; + r61 = fma(r12, r31, r61); + r61 = fma(r60, r28, r61); + WriteIdx2<32, double, double, double2>(solu2km1, 0 * solu2km1_num_alloc, + global_thread_idx * solu2km1_stride + solu2km1_offset, + r44, r61); + r61 = r40 * r17; + r61 = fma(r14, r61, r22 * r24); + r24 = r20 * r17; + r61 = fma(r63, r24, r61); + r61 = fma(r38, r12, r61); + WriteIdx1<32, double, double, double>(solu2km1, 2 * solu2km1_num_alloc, + global_thread_idx * solu2km1_stride + solu2km1_offset, + r61); + WriteIdx2<32, double, double, double2>( + solu2k, 0 * solu2k_num_alloc, global_thread_idx * solu2k_stride + solu2k_offset, r14, r12); + WriteIdx1<32, double, double, double>(solu2k, 2 * solu2k_num_alloc, + global_thread_idx * solu2k_stride + solu2k_offset, r63); + }; +} + +void ChainBCyclicReductionSolveTwo(double* const eq, unsigned int eq_num_alloc, int eq_offset, + int eq_stride, double* solu2km1, unsigned int solu2km1_num_alloc, + int solu2km1_offset, int solu2km1_stride, double* solu2k, + unsigned int solu2k_num_alloc, int solu2k_offset, + int solu2k_stride, size_t problem_size) { + if (problem_size == 0) { + return; + } + + const int n_blocks = (problem_size + 32 - 1) / 32; + // Kernels using more than 48 KB of shared memory per block must opt in. + static const cudaError_t attribute_error = cudaFuncSetAttribute( + ChainBCyclicReductionSolveTwoKernel, cudaFuncAttributeMaxDynamicSharedMemorySize, 512); + if (attribute_error != cudaSuccess) { + throw std::runtime_error(std::string("ChainBCyclicReductionSolveTwoKernel: ") + + cudaGetErrorString(attribute_error)); + } + ChainBCyclicReductionSolveTwoKernel<<>>( + eq, eq_num_alloc, eq_offset, eq_stride, solu2km1, solu2km1_num_alloc, solu2km1_offset, + solu2km1_stride, solu2k, solu2k_num_alloc, solu2k_offset, solu2k_stride, problem_size); + // A launch that fails (e.g. from exceeding shared memory or register limits) + // otherwise leaves its outputs untouched without any error. + const cudaError_t launch_error = cudaGetLastError(); + if (launch_error != cudaSuccess) { + throw std::runtime_error(std::string("ChainBCyclicReductionSolveTwoKernel launch failed: ") + + cudaGetErrorString(launch_error)); + } +} + +} // namespace caspar \ No newline at end of file diff --git a/test/symforce_function_codegen_test_data/symengine/symforce_caspar_tridiagonal_test/kernel_ChainB_cyclic_reduction_solve_two.h b/test/symforce_function_codegen_test_data/symengine/symforce_caspar_tridiagonal_test/kernel_ChainB_cyclic_reduction_solve_two.h new file mode 100644 index 00000000..9fae819f --- /dev/null +++ b/test/symforce_function_codegen_test_data/symengine/symforce_caspar_tridiagonal_test/kernel_ChainB_cyclic_reduction_solve_two.h @@ -0,0 +1,15 @@ +#pragma once + +#include + +#include "shared_indices.h" + +namespace caspar { + +void ChainBCyclicReductionSolveTwo(double* const eq, unsigned int eq_num_alloc, int eq_offset, + int eq_stride, double* solu2km1, unsigned int solu2km1_num_alloc, + int solu2km1_offset, int solu2km1_stride, double* solu2k, + unsigned int solu2k_num_alloc, int solu2k_offset, + int solu2k_stride, size_t problem_size); + +} // namespace caspar \ No newline at end of file diff --git a/test/symforce_function_codegen_test_data/symengine/symforce_caspar_tridiagonal_test/kernel_ChainB_cyclic_reduction_up.cu b/test/symforce_function_codegen_test_data/symengine/symforce_caspar_tridiagonal_test/kernel_ChainB_cyclic_reduction_up.cu new file mode 100644 index 00000000..66441e66 --- /dev/null +++ b/test/symforce_function_codegen_test_data/symengine/symforce_caspar_tridiagonal_test/kernel_ChainB_cyclic_reduction_up.cu @@ -0,0 +1,155 @@ +#include +#include + +#include +#include +#include +#include +#include + +#include "kernel_ChainB_cyclic_reduction_up.h" +#include "memops.cuh" + +namespace cg = cooperative_groups; + +namespace caspar { + +__global__ void __launch_bounds__(32, 1) + ChainBCyclicReductionUpKernel(double* eqk, unsigned int eqk_num_alloc, int eqk_offset, + int eqk_stride, double* const x, unsigned int x_num_alloc, + int x_offset, int x_stride, double* soluk, + unsigned int soluk_num_alloc, int soluk_offset, int soluk_stride, + size_t problem_size) { + const int global_thread_idx = blockIdx.x * blockDim.x + threadIdx.x; + // Scratch data, then the shared indices of each shared accessor; dynamic, so + // that it may exceed the 48 KB static shared memory limit (see the launch + // below). + extern __shared__ __align__(16) uint8_t inout_shared[]; + + double r0 = 0, r1 = 0, r2 = 0, r3 = 0, r4 = 0, r5 = 0, r6 = 0, r7 = 0, r8 = 0, r9 = 0, r10 = 0, + r11 = 0, r12 = 0, r13 = 0, r14 = 0, r15 = 0, r16 = 0, r17 = 0, r18 = 0, r19 = 0, r20 = 0, + r21 = 0, r22 = 0; + ReadAndShuffleWithDefault2<32, double, double, double2>( + (double*)inout_shared, x, 0 * x_num_alloc, global_thread_idx * x_stride + x_offset, + threadIdx.x == 31, global_thread_idx <= problem_size, x_num_alloc, x_stride, r0, r1, r2, r3, + 0.000000f, 0.000000f); + if (global_thread_idx < problem_size) { + ReadIdx2<32, double, double, double2>(eqk, 28 * eqk_num_alloc, + global_thread_idx * eqk_stride + eqk_offset, r4, r5); + r6 = -1.00000000000000000e+00; + ReadIdx2<32, double, double, double2>(eqk, 22 * eqk_num_alloc, + global_thread_idx * eqk_stride + eqk_offset, r7, r8); + ReadIdx2<32, double, double, double2>(eqk, 18 * eqk_num_alloc, + global_thread_idx * eqk_stride + eqk_offset, r9, r10); + r10 = fma(r10, r2, r7 * r3); + ReadIdx2<32, double, double, double2>(eqk, 24 * eqk_num_alloc, + global_thread_idx * eqk_stride + eqk_offset, r7, r11); + }; + ReadAndShuffleWithDefault1<32, double, double, double>( + (double*)inout_shared, x, 2 * x_num_alloc, global_thread_idx * x_stride + x_offset, + threadIdx.x == 31, global_thread_idx <= problem_size, x_num_alloc, x_stride, r12, r13, + 0.000000f); + if (global_thread_idx < problem_size) { + r10 = fma(r11, r13, r10); + r10 = fma(r6, r10, r4); + ReadIdx2<32, double, double, double2>(eqk, 0 * eqk_num_alloc, + global_thread_idx * eqk_stride + eqk_offset, r4, r11); + ReadIdx2<32, double, double, double2>(eqk, 4 * eqk_num_alloc, + global_thread_idx * eqk_stride + eqk_offset, r14, r15); + r14 = fma(r14, r1, r11 * r0); + ReadIdx2<32, double, double, double2>(eqk, 6 * eqk_num_alloc, + global_thread_idx * eqk_stride + eqk_offset, r11, r16); + r14 = fma(r16, r12, r14); + ReadIdx2<32, double, double, double2>(eqk, 30 * eqk_num_alloc, + global_thread_idx * eqk_stride + eqk_offset, r16, r17); + r18 = r17 * r6; + ReadIdx2<32, double, double, double2>(eqk, 26 * eqk_num_alloc, + global_thread_idx * eqk_stride + eqk_offset, r19, r20); + ReadIdx2<32, double, double, double2>(eqk, 20 * eqk_num_alloc, + global_thread_idx * eqk_stride + eqk_offset, r21, r22); + r7 = fma(r7, r13, r22 * r3); + r7 = fma(r9, r2, r7); + r7 = fma(r6, r7, r20); + ReadIdx2<32, double, double, double2>(eqk, 2 * eqk_num_alloc, + global_thread_idx * eqk_stride + eqk_offset, r20, r9); + r4 = fma(r4, r0, r9 * r1); + r4 = fma(r11, r12, r4); + r7 = fma(r6, r4, r7); + r16 = 1.0 / r16; + r16 = r7 * r16; + r10 = fma(r16, r18, r10); + r10 = fma(r6, r14, r10); + ReadIdx2<32, double, double, double2>(eqk, 32 * eqk_num_alloc, + global_thread_idx * eqk_stride + eqk_offset, r18, r14); + r18 = 1.0 / r18; + r18 = r10 * r18; + ReadIdx2<32, double, double, double2>(eqk, 40 * eqk_num_alloc, + global_thread_idx * eqk_stride + eqk_offset, r10, r7); + r2 = fma(r21, r2, r19 * r13); + r2 = fma(r8, r3, r2); + r2 = fma(r6, r2, r5); + ReadIdx2<32, double, double, double2>(eqk, 8 * eqk_num_alloc, + global_thread_idx * eqk_stride + eqk_offset, r5, r3); + r12 = fma(r5, r12, r20 * r0); + r12 = fma(r15, r1, r12); + ReadIdx2<32, double, double, double2>(eqk, 34 * eqk_num_alloc, + global_thread_idx * eqk_stride + eqk_offset, r1, r15); + r5 = r1 * r6; + r2 = fma(r18, r5, r2); + r0 = r14 * r6; + r2 = fma(r16, r0, r2); + r2 = fma(r6, r12, r2); + r15 = 1.0 / r15; + r15 = r2 * r15; + r7 = 1.0 / r7; + r15 = r15 * r7; + r7 = r6 * r15; + r10 = fma(r10, r7, r18); + ReadIdx2<32, double, double, double2>(eqk, 38 * eqk_num_alloc, + global_thread_idx * eqk_stride + eqk_offset, r18, r2); + r2 = 1.0 / r2; + r2 = r10 * r2; + r7 = fma(r18, r7, r16); + ReadIdx2<32, double, double, double2>(eqk, 36 * eqk_num_alloc, + global_thread_idx * eqk_stride + eqk_offset, r18, r16); + r10 = r16 * r6; + r7 = fma(r2, r10, r7); + r18 = 1.0 / r18; + r18 = r7 * r18; + WriteIdx2<32, double, double, double2>( + soluk, 0 * soluk_num_alloc, global_thread_idx * soluk_stride + soluk_offset, r18, r2); + WriteIdx1<32, double, double, double>(soluk, 2 * soluk_num_alloc, + global_thread_idx * soluk_stride + soluk_offset, r15); + }; +} + +void ChainBCyclicReductionUp(double* eqk, unsigned int eqk_num_alloc, int eqk_offset, + int eqk_stride, double* const x, unsigned int x_num_alloc, + int x_offset, int x_stride, double* soluk, + unsigned int soluk_num_alloc, int soluk_offset, int soluk_stride, + size_t problem_size) { + if (problem_size == 0) { + return; + } + + const int n_blocks = (problem_size + 32 - 1) / 32; + // Kernels using more than 48 KB of shared memory per block must opt in. + static const cudaError_t attribute_error = cudaFuncSetAttribute( + ChainBCyclicReductionUpKernel, cudaFuncAttributeMaxDynamicSharedMemorySize, 512); + if (attribute_error != cudaSuccess) { + throw std::runtime_error(std::string("ChainBCyclicReductionUpKernel: ") + + cudaGetErrorString(attribute_error)); + } + ChainBCyclicReductionUpKernel<<>>( + eqk, eqk_num_alloc, eqk_offset, eqk_stride, x, x_num_alloc, x_offset, x_stride, soluk, + soluk_num_alloc, soluk_offset, soluk_stride, problem_size); + // A launch that fails (e.g. from exceeding shared memory or register limits) + // otherwise leaves its outputs untouched without any error. + const cudaError_t launch_error = cudaGetLastError(); + if (launch_error != cudaSuccess) { + throw std::runtime_error(std::string("ChainBCyclicReductionUpKernel launch failed: ") + + cudaGetErrorString(launch_error)); + } +} + +} // namespace caspar \ No newline at end of file diff --git a/test/symforce_function_codegen_test_data/symengine/symforce_caspar_tridiagonal_test/kernel_ChainB_cyclic_reduction_up.h b/test/symforce_function_codegen_test_data/symengine/symforce_caspar_tridiagonal_test/kernel_ChainB_cyclic_reduction_up.h new file mode 100644 index 00000000..01c1a58a --- /dev/null +++ b/test/symforce_function_codegen_test_data/symengine/symforce_caspar_tridiagonal_test/kernel_ChainB_cyclic_reduction_up.h @@ -0,0 +1,15 @@ +#pragma once + +#include + +#include "shared_indices.h" + +namespace caspar { + +void ChainBCyclicReductionUp(double* eqk, unsigned int eqk_num_alloc, int eqk_offset, + int eqk_stride, double* const x, unsigned int x_num_alloc, + int x_offset, int x_stride, double* soluk, + unsigned int soluk_num_alloc, int soluk_offset, int soluk_stride, + size_t problem_size); + +} // namespace caspar \ No newline at end of file diff --git a/test/symforce_function_codegen_test_data/symengine/symforce_caspar_tridiagonal_test/kernel_ChainB_normalize.cu b/test/symforce_function_codegen_test_data/symengine/symforce_caspar_tridiagonal_test/kernel_ChainB_normalize.cu new file mode 100644 index 00000000..15e36382 --- /dev/null +++ b/test/symforce_function_codegen_test_data/symengine/symforce_caspar_tridiagonal_test/kernel_ChainB_normalize.cu @@ -0,0 +1,111 @@ +#include +#include + +#include +#include +#include +#include +#include + +#include "kernel_ChainB_normalize.h" +#include "memops.cuh" + +namespace cg = cooperative_groups; + +namespace caspar { + +__global__ void __launch_bounds__(1024, 1) + ChainBNormalizeKernel(double* precond_diag, unsigned int precond_diag_num_alloc, + double* precond_tril, unsigned int precond_tril_num_alloc, double* njtr, + unsigned int njtr_num_alloc, const double* const diag, + double* out_normalized, unsigned int out_normalized_num_alloc, + size_t problem_size) { + const int global_thread_idx = blockIdx.x * blockDim.x + threadIdx.x; + // Scratch data, then the shared indices of each shared accessor; dynamic, so + // that it may exceed the 48 KB static shared memory limit (see the launch + // below). + extern __shared__ __align__(16) uint8_t inout_shared[]; + + double r0 = 0, r1 = 0, r2 = 0, r3 = 0, r4 = 0, r5 = 0, r6 = 0, r7 = 0, r8 = 0, r9 = 0, r10 = 0, + r11 = 0, r12 = 0, r13 = 0, r14 = 0; + LoadUnique<1, double, double>(diag, 0, (double*)inout_shared); + if (global_thread_idx < problem_size) { + ReadShared1((double*)inout_shared, 0, r0); + }; + __syncthreads(); + if (global_thread_idx < problem_size) { + r1 = 2.22044604925031308e-15; + r1 = r0 * r1; + ReadIdx2<1024, double, double, double2>(precond_diag, 0 * precond_diag_num_alloc, + global_thread_idx, r2, r3); + r4 = 1.00000000000000000e+00; + r4 = r0 + r4; + r3 = fma(r3, r4, r1); + ReadIdx2<1024, double, double, double2>(precond_tril, 0 * precond_tril_num_alloc, + global_thread_idx, r0, r5); + r6 = -1.00000000000000000e+00; + r2 = fma(r2, r4, r1); + r2 = 1.0 / r2; + r7 = r6 * r2; + r8 = r0 * r7; + r3 = fma(r0, r8, r3); + r3 = 1.0 / r3; + ReadIdx2<1024, double, double, double2>(njtr, 0 * njtr_num_alloc, global_thread_idx, r0, r9); + r9 = fma(r0, r8, r9); + ReadIdx1<1024, double, double, double>(precond_tril, 2 * precond_tril_num_alloc, + global_thread_idx, r10); + r10 = fma(r5, r8, r10); + r11 = r10 * r3; + r12 = r6 * r11; + ReadIdx1<1024, double, double, double>(njtr, 2 * njtr_num_alloc, global_thread_idx, r13); + r13 = fma(r9, r12, r13); + r14 = r5 * r0; + r13 = fma(r7, r14, r13); + ReadIdx1<1024, double, double, double>(precond_diag, 2 * precond_diag_num_alloc, + global_thread_idx, r14); + r4 = fma(r14, r4, r1); + r14 = r5 * r5; + r14 = fma(r2, r14, r10 * r11); + r4 = fma(r6, r14, r4); + r4 = 1.0 / r4; + r4 = r13 * r4; + r12 = fma(r4, r12, r9 * r3); + r3 = r5 * r7; + r2 = fma(r0, r2, r4 * r3); + r2 = fma(r12, r8, r2); + WriteIdx2<1024, double, double, double2>(out_normalized, 0 * out_normalized_num_alloc, + global_thread_idx, r2, r12); + WriteIdx1<1024, double, double, double>(out_normalized, 2 * out_normalized_num_alloc, + global_thread_idx, r4); + }; +} + +void ChainBNormalize(double* precond_diag, unsigned int precond_diag_num_alloc, + double* precond_tril, unsigned int precond_tril_num_alloc, double* njtr, + unsigned int njtr_num_alloc, const double* const diag, double* out_normalized, + unsigned int out_normalized_num_alloc, size_t problem_size) { + if (problem_size == 0) { + return; + } + + const int n_blocks = (problem_size + 1024 - 1) / 1024; + // Kernels using more than 48 KB of shared memory per block must opt in. + static const cudaError_t attribute_error = cudaFuncSetAttribute( + ChainBNormalizeKernel, cudaFuncAttributeMaxDynamicSharedMemorySize, 8192); + if (attribute_error != cudaSuccess) { + throw std::runtime_error(std::string("ChainBNormalizeKernel: ") + + cudaGetErrorString(attribute_error)); + } + ChainBNormalizeKernel<<>>( + precond_diag, precond_diag_num_alloc, precond_tril, precond_tril_num_alloc, njtr, + njtr_num_alloc, diag, out_normalized, out_normalized_num_alloc, problem_size); + // A launch that fails (e.g. from exceeding shared memory or register limits) + // otherwise leaves its outputs untouched without any error. + const cudaError_t launch_error = cudaGetLastError(); + if (launch_error != cudaSuccess) { + throw std::runtime_error(std::string("ChainBNormalizeKernel launch failed: ") + + cudaGetErrorString(launch_error)); + } +} + +} // namespace caspar \ No newline at end of file diff --git a/test/symforce_function_codegen_test_data/symengine/symforce_caspar_tridiagonal_test/kernel_ChainB_normalize.h b/test/symforce_function_codegen_test_data/symengine/symforce_caspar_tridiagonal_test/kernel_ChainB_normalize.h new file mode 100644 index 00000000..de57b746 --- /dev/null +++ b/test/symforce_function_codegen_test_data/symengine/symforce_caspar_tridiagonal_test/kernel_ChainB_normalize.h @@ -0,0 +1,14 @@ +#pragma once + +#include + +#include "shared_indices.h" + +namespace caspar { + +void ChainBNormalize(double* precond_diag, unsigned int precond_diag_num_alloc, + double* precond_tril, unsigned int precond_tril_num_alloc, double* njtr, + unsigned int njtr_num_alloc, const double* const diag, double* out_normalized, + unsigned int out_normalized_num_alloc, size_t problem_size); + +} // namespace caspar \ No newline at end of file diff --git a/test/symforce_function_codegen_test_data/symengine/symforce_caspar_tridiagonal_test/kernel_ChainB_pred_decrease_times_two.cu b/test/symforce_function_codegen_test_data/symengine/symforce_caspar_tridiagonal_test/kernel_ChainB_pred_decrease_times_two.cu new file mode 100644 index 00000000..f2e5ad81 --- /dev/null +++ b/test/symforce_function_codegen_test_data/symengine/symforce_caspar_tridiagonal_test/kernel_ChainB_pred_decrease_times_two.cu @@ -0,0 +1,95 @@ +#include +#include + +#include +#include +#include +#include +#include + +#include "kernel_ChainB_pred_decrease_times_two.h" +#include "memops.cuh" + +namespace cg = cooperative_groups; + +namespace caspar { + +__global__ void __launch_bounds__(1024, 1) ChainBPredDecreaseTimesTwoKernel( + double* ChainB_step, unsigned int ChainB_step_num_alloc, double* ChainB_precond_diag, + unsigned int ChainB_precond_diag_num_alloc, const double* const diag, double* ChainB_njtr, + unsigned int ChainB_njtr_num_alloc, double* const out_ChainB_pred_dec, size_t problem_size) { + const int global_thread_idx = blockIdx.x * blockDim.x + threadIdx.x; + // Scratch data, then the shared indices of each shared accessor; dynamic, so + // that it may exceed the 48 KB static shared memory limit (see the launch + // below). + extern __shared__ __align__(16) uint8_t inout_shared[]; + + __shared__ double out_ChainB_pred_dec_local[1]; + + double r0 = 0, r1 = 0, r2 = 0, r3 = 0, r4 = 0, r5 = 0, r6 = 0, r7 = 0, r8 = 0, r9 = 0; + + if (global_thread_idx < problem_size) { + ReadIdx2<1024, double, double, double2>(ChainB_step, 0 * ChainB_step_num_alloc, + global_thread_idx, r0, r1); + ReadIdx2<1024, double, double, double2>(ChainB_njtr, 0 * ChainB_njtr_num_alloc, + global_thread_idx, r2, r3); + ReadIdx2<1024, double, double, double2>(ChainB_precond_diag, 0 * ChainB_precond_diag_num_alloc, + global_thread_idx, r4, r5); + r6 = r0 * r4; + }; + LoadUnique<1, double, double>(diag, 0, (double*)inout_shared); + if (global_thread_idx < problem_size) { + ReadShared1((double*)inout_shared, 0, r7); + }; + __syncthreads(); + if (global_thread_idx < problem_size) { + r6 = fma(r7, r6, r2); + r2 = r1 * r5; + r2 = fma(r7, r2, r3); + r2 = fma(r1, r2, r0 * r6); + ReadIdx1<1024, double, double, double>(ChainB_step, 2 * ChainB_step_num_alloc, + global_thread_idx, r6); + ReadIdx1<1024, double, double, double>(ChainB_njtr, 2 * ChainB_njtr_num_alloc, + global_thread_idx, r3); + ReadIdx1<1024, double, double, double>(ChainB_precond_diag, 2 * ChainB_precond_diag_num_alloc, + global_thread_idx, r8); + r9 = r6 * r8; + r9 = fma(r7, r9, r3); + r2 = fma(r6, r9, r2); + }; + SumStore(out_ChainB_pred_dec_local, (double*)inout_shared, 0, + global_thread_idx < problem_size, r2); + SumFlushFinal(out_ChainB_pred_dec_local, out_ChainB_pred_dec, 1); +} + +void ChainBPredDecreaseTimesTwo(double* ChainB_step, unsigned int ChainB_step_num_alloc, + double* ChainB_precond_diag, + unsigned int ChainB_precond_diag_num_alloc, + const double* const diag, double* ChainB_njtr, + unsigned int ChainB_njtr_num_alloc, + double* const out_ChainB_pred_dec, size_t problem_size) { + if (problem_size == 0) { + return; + } + + const int n_blocks = (problem_size + 1024 - 1) / 1024; + // Kernels using more than 48 KB of shared memory per block must opt in. + static const cudaError_t attribute_error = cudaFuncSetAttribute( + ChainBPredDecreaseTimesTwoKernel, cudaFuncAttributeMaxDynamicSharedMemorySize, 8192); + if (attribute_error != cudaSuccess) { + throw std::runtime_error(std::string("ChainBPredDecreaseTimesTwoKernel: ") + + cudaGetErrorString(attribute_error)); + } + ChainBPredDecreaseTimesTwoKernel<<>>( + ChainB_step, ChainB_step_num_alloc, ChainB_precond_diag, ChainB_precond_diag_num_alloc, diag, + ChainB_njtr, ChainB_njtr_num_alloc, out_ChainB_pred_dec, problem_size); + // A launch that fails (e.g. from exceeding shared memory or register limits) + // otherwise leaves its outputs untouched without any error. + const cudaError_t launch_error = cudaGetLastError(); + if (launch_error != cudaSuccess) { + throw std::runtime_error(std::string("ChainBPredDecreaseTimesTwoKernel launch failed: ") + + cudaGetErrorString(launch_error)); + } +} + +} // namespace caspar \ No newline at end of file diff --git a/test/symforce_function_codegen_test_data/symengine/symforce_caspar_tridiagonal_test/kernel_ChainB_pred_decrease_times_two.h b/test/symforce_function_codegen_test_data/symengine/symforce_caspar_tridiagonal_test/kernel_ChainB_pred_decrease_times_two.h new file mode 100644 index 00000000..88b292b1 --- /dev/null +++ b/test/symforce_function_codegen_test_data/symengine/symforce_caspar_tridiagonal_test/kernel_ChainB_pred_decrease_times_two.h @@ -0,0 +1,16 @@ +#pragma once + +#include + +#include "shared_indices.h" + +namespace caspar { + +void ChainBPredDecreaseTimesTwo(double* ChainB_step, unsigned int ChainB_step_num_alloc, + double* ChainB_precond_diag, + unsigned int ChainB_precond_diag_num_alloc, + const double* const diag, double* ChainB_njtr, + unsigned int ChainB_njtr_num_alloc, + double* const out_ChainB_pred_dec, size_t problem_size); + +} // namespace caspar \ No newline at end of file diff --git a/test/symforce_function_codegen_test_data/symengine/symforce_caspar_tridiagonal_test/kernel_ChainB_retract.cu b/test/symforce_function_codegen_test_data/symengine/symforce_caspar_tridiagonal_test/kernel_ChainB_retract.cu new file mode 100644 index 00000000..a70477ad --- /dev/null +++ b/test/symforce_function_codegen_test_data/symengine/symforce_caspar_tridiagonal_test/kernel_ChainB_retract.cu @@ -0,0 +1,61 @@ +#include +#include + +#include +#include +#include +#include +#include + +#include "kernel_ChainB_retract.h" +#include "memops.cuh" + +namespace cg = cooperative_groups; + +namespace caspar { + +__global__ void __launch_bounds__(1024, 1) + ChainBRetractKernel(double* ChainB, unsigned int ChainB_num_alloc, double* delta, + unsigned int delta_num_alloc, double* out_ChainB_retracted, + unsigned int out_ChainB_retracted_num_alloc, size_t problem_size) { + const int global_thread_idx = blockIdx.x * blockDim.x + threadIdx.x; + + double r0 = 0, r1 = 0, r2 = 0, r3 = 0; + + if (global_thread_idx < problem_size) { + ReadIdx2<1024, double, double, double2>(ChainB, 0 * ChainB_num_alloc, global_thread_idx, r0, + r1); + ReadIdx2<1024, double, double, double2>(delta, 0 * delta_num_alloc, global_thread_idx, r2, r3); + r2 = r0 + r2; + r3 = r1 + r3; + WriteIdx2<1024, double, double, double2>( + out_ChainB_retracted, 0 * out_ChainB_retracted_num_alloc, global_thread_idx, r2, r3); + ReadIdx1<1024, double, double, double>(ChainB, 2 * ChainB_num_alloc, global_thread_idx, r3); + ReadIdx1<1024, double, double, double>(delta, 2 * delta_num_alloc, global_thread_idx, r2); + r2 = r3 + r2; + WriteIdx1<1024, double, double, double>( + out_ChainB_retracted, 2 * out_ChainB_retracted_num_alloc, global_thread_idx, r2); + }; +} + +void ChainBRetract(double* ChainB, unsigned int ChainB_num_alloc, double* delta, + unsigned int delta_num_alloc, double* out_ChainB_retracted, + unsigned int out_ChainB_retracted_num_alloc, size_t problem_size) { + if (problem_size == 0) { + return; + } + + const int n_blocks = (problem_size + 1024 - 1) / 1024; + ChainBRetractKernel<<>>(ChainB, ChainB_num_alloc, delta, delta_num_alloc, + out_ChainB_retracted, out_ChainB_retracted_num_alloc, + problem_size); + // A launch that fails (e.g. from exceeding shared memory or register limits) + // otherwise leaves its outputs untouched without any error. + const cudaError_t launch_error = cudaGetLastError(); + if (launch_error != cudaSuccess) { + throw std::runtime_error(std::string("ChainBRetractKernel launch failed: ") + + cudaGetErrorString(launch_error)); + } +} + +} // namespace caspar \ No newline at end of file diff --git a/test/symforce_function_codegen_test_data/symengine/symforce_caspar_tridiagonal_test/kernel_ChainB_retract.h b/test/symforce_function_codegen_test_data/symengine/symforce_caspar_tridiagonal_test/kernel_ChainB_retract.h new file mode 100644 index 00000000..4b7699ee --- /dev/null +++ b/test/symforce_function_codegen_test_data/symengine/symforce_caspar_tridiagonal_test/kernel_ChainB_retract.h @@ -0,0 +1,13 @@ +#pragma once + +#include + +#include "shared_indices.h" + +namespace caspar { + +void ChainBRetract(double* ChainB, unsigned int ChainB_num_alloc, double* delta, + unsigned int delta_num_alloc, double* out_ChainB_retracted, + unsigned int out_ChainB_retracted_num_alloc, size_t problem_size); + +} // namespace caspar \ No newline at end of file diff --git a/test/symforce_function_codegen_test_data/symengine/symforce_caspar_tridiagonal_test/kernel_ChainB_start_w.cu b/test/symforce_function_codegen_test_data/symengine/symforce_caspar_tridiagonal_test/kernel_ChainB_start_w.cu new file mode 100644 index 00000000..b704e6e7 --- /dev/null +++ b/test/symforce_function_codegen_test_data/symengine/symforce_caspar_tridiagonal_test/kernel_ChainB_start_w.cu @@ -0,0 +1,85 @@ +#include +#include + +#include +#include +#include +#include +#include + +#include "kernel_ChainB_start_w.h" +#include "memops.cuh" + +namespace cg = cooperative_groups; + +namespace caspar { + +__global__ void __launch_bounds__(1024, 1) + ChainBStartWKernel(double* ChainB_precond_diag, unsigned int ChainB_precond_diag_num_alloc, + const double* const diag, double* ChainB_p, unsigned int ChainB_p_num_alloc, + double* out_ChainB_w, unsigned int out_ChainB_w_num_alloc, + size_t problem_size) { + const int global_thread_idx = blockIdx.x * blockDim.x + threadIdx.x; + // Scratch data, then the shared indices of each shared accessor; dynamic, so + // that it may exceed the 48 KB static shared memory limit (see the launch + // below). + extern __shared__ __align__(16) uint8_t inout_shared[]; + + double r0 = 0, r1 = 0, r2 = 0, r3 = 0, r4 = 0; + + if (global_thread_idx < problem_size) { + ReadIdx2<1024, double, double, double2>(ChainB_precond_diag, 0 * ChainB_precond_diag_num_alloc, + global_thread_idx, r0, r1); + }; + LoadUnique<1, double, double>(diag, 0, (double*)inout_shared); + if (global_thread_idx < problem_size) { + ReadShared1((double*)inout_shared, 0, r2); + }; + __syncthreads(); + if (global_thread_idx < problem_size) { + r0 = r0 * r2; + ReadIdx2<1024, double, double, double2>(ChainB_p, 0 * ChainB_p_num_alloc, global_thread_idx, r3, + r4); + r0 = r0 * r3; + r1 = r1 * r2; + r1 = r1 * r4; + WriteIdx2<1024, double, double, double2>(out_ChainB_w, 0 * out_ChainB_w_num_alloc, + global_thread_idx, r0, r1); + ReadIdx1<1024, double, double, double>(ChainB_precond_diag, 2 * ChainB_precond_diag_num_alloc, + global_thread_idx, r1); + r2 = r1 * r2; + ReadIdx1<1024, double, double, double>(ChainB_p, 2 * ChainB_p_num_alloc, global_thread_idx, r1); + r2 = r2 * r1; + WriteIdx1<1024, double, double, double>(out_ChainB_w, 2 * out_ChainB_w_num_alloc, + global_thread_idx, r2); + }; +} + +void ChainBStartW(double* ChainB_precond_diag, unsigned int ChainB_precond_diag_num_alloc, + const double* const diag, double* ChainB_p, unsigned int ChainB_p_num_alloc, + double* out_ChainB_w, unsigned int out_ChainB_w_num_alloc, size_t problem_size) { + if (problem_size == 0) { + return; + } + + const int n_blocks = (problem_size + 1024 - 1) / 1024; + // Kernels using more than 48 KB of shared memory per block must opt in. + static const cudaError_t attribute_error = + cudaFuncSetAttribute(ChainBStartWKernel, cudaFuncAttributeMaxDynamicSharedMemorySize, 8192); + if (attribute_error != cudaSuccess) { + throw std::runtime_error(std::string("ChainBStartWKernel: ") + + cudaGetErrorString(attribute_error)); + } + ChainBStartWKernel<<>>(ChainB_precond_diag, ChainB_precond_diag_num_alloc, + diag, ChainB_p, ChainB_p_num_alloc, out_ChainB_w, + out_ChainB_w_num_alloc, problem_size); + // A launch that fails (e.g. from exceeding shared memory or register limits) + // otherwise leaves its outputs untouched without any error. + const cudaError_t launch_error = cudaGetLastError(); + if (launch_error != cudaSuccess) { + throw std::runtime_error(std::string("ChainBStartWKernel launch failed: ") + + cudaGetErrorString(launch_error)); + } +} + +} // namespace caspar \ No newline at end of file diff --git a/test/symforce_function_codegen_test_data/symengine/symforce_caspar_tridiagonal_test/kernel_ChainB_start_w.h b/test/symforce_function_codegen_test_data/symengine/symforce_caspar_tridiagonal_test/kernel_ChainB_start_w.h new file mode 100644 index 00000000..537d1853 --- /dev/null +++ b/test/symforce_function_codegen_test_data/symengine/symforce_caspar_tridiagonal_test/kernel_ChainB_start_w.h @@ -0,0 +1,13 @@ +#pragma once + +#include + +#include "shared_indices.h" + +namespace caspar { + +void ChainBStartW(double* ChainB_precond_diag, unsigned int ChainB_precond_diag_num_alloc, + const double* const diag, double* ChainB_p, unsigned int ChainB_p_num_alloc, + double* out_ChainB_w, unsigned int out_ChainB_w_num_alloc, size_t problem_size); + +} // namespace caspar \ No newline at end of file diff --git a/test/symforce_function_codegen_test_data/symengine/symforce_caspar_tridiagonal_test/kernel_ChainB_start_w_contribute.cu b/test/symforce_function_codegen_test_data/symengine/symforce_caspar_tridiagonal_test/kernel_ChainB_start_w_contribute.cu new file mode 100644 index 00000000..e1dbea27 --- /dev/null +++ b/test/symforce_function_codegen_test_data/symengine/symforce_caspar_tridiagonal_test/kernel_ChainB_start_w_contribute.cu @@ -0,0 +1,87 @@ +#include +#include + +#include +#include +#include +#include +#include + +#include "kernel_ChainB_start_w_contribute.h" +#include "memops.cuh" + +namespace cg = cooperative_groups; + +namespace caspar { + +__global__ void __launch_bounds__(1024, 1) + ChainBStartWContributeKernel(double* ChainB_precond_diag, + unsigned int ChainB_precond_diag_num_alloc, + const double* const diag, double* ChainB_p, + unsigned int ChainB_p_num_alloc, double* out_ChainB_w, + unsigned int out_ChainB_w_num_alloc, size_t problem_size) { + const int global_thread_idx = blockIdx.x * blockDim.x + threadIdx.x; + // Scratch data, then the shared indices of each shared accessor; dynamic, so + // that it may exceed the 48 KB static shared memory limit (see the launch + // below). + extern __shared__ __align__(16) uint8_t inout_shared[]; + + double r0 = 0, r1 = 0, r2 = 0, r3 = 0, r4 = 0; + + if (global_thread_idx < problem_size) { + ReadIdx2<1024, double, double, double2>(ChainB_precond_diag, 0 * ChainB_precond_diag_num_alloc, + global_thread_idx, r0, r1); + }; + LoadUnique<1, double, double>(diag, 0, (double*)inout_shared); + if (global_thread_idx < problem_size) { + ReadShared1((double*)inout_shared, 0, r2); + }; + __syncthreads(); + if (global_thread_idx < problem_size) { + r0 = r0 * r2; + ReadIdx2<1024, double, double, double2>(ChainB_p, 0 * ChainB_p_num_alloc, global_thread_idx, r3, + r4); + r0 = r0 * r3; + r1 = r1 * r2; + r1 = r1 * r4; + AddIdx2<1024, double, double, double2>(out_ChainB_w, 0 * out_ChainB_w_num_alloc, + global_thread_idx, r0, r1); + ReadIdx1<1024, double, double, double>(ChainB_precond_diag, 2 * ChainB_precond_diag_num_alloc, + global_thread_idx, r1); + r2 = r1 * r2; + ReadIdx1<1024, double, double, double>(ChainB_p, 2 * ChainB_p_num_alloc, global_thread_idx, r1); + r2 = r2 * r1; + AddIdx1<1024, double, double, double>(out_ChainB_w, 2 * out_ChainB_w_num_alloc, + global_thread_idx, r2); + }; +} + +void ChainBStartWContribute(double* ChainB_precond_diag, unsigned int ChainB_precond_diag_num_alloc, + const double* const diag, double* ChainB_p, + unsigned int ChainB_p_num_alloc, double* out_ChainB_w, + unsigned int out_ChainB_w_num_alloc, size_t problem_size) { + if (problem_size == 0) { + return; + } + + const int n_blocks = (problem_size + 1024 - 1) / 1024; + // Kernels using more than 48 KB of shared memory per block must opt in. + static const cudaError_t attribute_error = cudaFuncSetAttribute( + ChainBStartWContributeKernel, cudaFuncAttributeMaxDynamicSharedMemorySize, 8192); + if (attribute_error != cudaSuccess) { + throw std::runtime_error(std::string("ChainBStartWContributeKernel: ") + + cudaGetErrorString(attribute_error)); + } + ChainBStartWContributeKernel<<>>( + ChainB_precond_diag, ChainB_precond_diag_num_alloc, diag, ChainB_p, ChainB_p_num_alloc, + out_ChainB_w, out_ChainB_w_num_alloc, problem_size); + // A launch that fails (e.g. from exceeding shared memory or register limits) + // otherwise leaves its outputs untouched without any error. + const cudaError_t launch_error = cudaGetLastError(); + if (launch_error != cudaSuccess) { + throw std::runtime_error(std::string("ChainBStartWContributeKernel launch failed: ") + + cudaGetErrorString(launch_error)); + } +} + +} // namespace caspar \ No newline at end of file diff --git a/test/symforce_function_codegen_test_data/symengine/symforce_caspar_tridiagonal_test/kernel_ChainB_start_w_contribute.h b/test/symforce_function_codegen_test_data/symengine/symforce_caspar_tridiagonal_test/kernel_ChainB_start_w_contribute.h new file mode 100644 index 00000000..5ccd0fd1 --- /dev/null +++ b/test/symforce_function_codegen_test_data/symengine/symforce_caspar_tridiagonal_test/kernel_ChainB_start_w_contribute.h @@ -0,0 +1,14 @@ +#pragma once + +#include + +#include "shared_indices.h" + +namespace caspar { + +void ChainBStartWContribute(double* ChainB_precond_diag, unsigned int ChainB_precond_diag_num_alloc, + const double* const diag, double* ChainB_p, + unsigned int ChainB_p_num_alloc, double* out_ChainB_w, + unsigned int out_ChainB_w_num_alloc, size_t problem_size); + +} // namespace caspar \ No newline at end of file diff --git a/test/symforce_function_codegen_test_data/symengine/symforce_caspar_tridiagonal_test/kernel_ChainB_tridig_make_eq.cu b/test/symforce_function_codegen_test_data/symengine/symforce_caspar_tridiagonal_test/kernel_ChainB_tridig_make_eq.cu new file mode 100644 index 00000000..d6d1fb4b --- /dev/null +++ b/test/symforce_function_codegen_test_data/symengine/symforce_caspar_tridiagonal_test/kernel_ChainB_tridig_make_eq.cu @@ -0,0 +1,158 @@ +#include +#include + +#include +#include +#include +#include +#include + +#include "kernel_ChainB_tridig_make_eq.h" +#include "memops.cuh" + +namespace cg = cooperative_groups; + +namespace caspar { + +__global__ void __launch_bounds__(1024, 1) + ChainBTridigMakeEqKernel(double* precond_diag, unsigned int precond_diag_num_alloc, + double* precond_tril, unsigned int precond_tril_num_alloc, + double* const tridig_U, unsigned int tridig_U_num_alloc, + int tridig_U_offset, int tridig_U_stride, double* njtr, + unsigned int njtr_num_alloc, const double* const diag, double* eq, + unsigned int eq_num_alloc, size_t problem_size) { + const int global_thread_idx = blockIdx.x * blockDim.x + threadIdx.x; + // Scratch data, then the shared indices of each shared accessor; dynamic, so + // that it may exceed the 48 KB static shared memory limit (see the launch + // below). + extern __shared__ __align__(16) uint8_t inout_shared[]; + + double r0 = 0, r1 = 0, r2 = 0, r3 = 0, r4 = 0, r5 = 0, r6 = 0, r7 = 0, r8 = 0, r9 = 0, r10 = 0, + r11 = 0, r12 = 0, r13 = 0, r14 = 0, r15 = 0, r16 = 0, r17 = 0; + ReadAndShuffleWithDefault2<1024, double, double, double2>( + (double*)inout_shared, tridig_U, 0 * tridig_U_num_alloc, + global_thread_idx * tridig_U_stride + tridig_U_offset, threadIdx.x == 1023, + global_thread_idx <= problem_size, tridig_U_num_alloc, tridig_U_stride, r0, r1, r2, r3, + 0.000000f, 0.000000f); + ReadAndShuffleWithDefault2<1024, double, double, double2>( + (double*)inout_shared, tridig_U, 2 * tridig_U_num_alloc, + global_thread_idx * tridig_U_stride + tridig_U_offset, threadIdx.x == 1023, + global_thread_idx <= problem_size, tridig_U_num_alloc, tridig_U_stride, r4, r5, r6, r7, + 0.000000f, 0.000000f); + if (global_thread_idx < problem_size) { + WriteIdx2<1024, double, double, double2>(eq, 0 * eq_num_alloc, global_thread_idx, r0, r5); + }; + ReadAndShuffleWithDefault2<1024, double, double, double2>( + (double*)inout_shared, tridig_U, 6 * tridig_U_num_alloc, + global_thread_idx * tridig_U_stride + tridig_U_offset, threadIdx.x == 1023, + global_thread_idx <= problem_size, tridig_U_num_alloc, tridig_U_stride, r5, r0, r8, r9, + 0.000000f, 0.000000f); + if (global_thread_idx < problem_size) { + WriteIdx2<1024, double, double, double2>(eq, 2 * eq_num_alloc, global_thread_idx, r5, r1); + }; + ReadAndShuffleWithDefault2<1024, double, double, double2>( + (double*)inout_shared, tridig_U, 4 * tridig_U_num_alloc, + global_thread_idx * tridig_U_stride + tridig_U_offset, threadIdx.x == 1023, + global_thread_idx <= problem_size, tridig_U_num_alloc, tridig_U_stride, r1, r5, r10, r11, + 0.000000f, 0.000000f); + if (global_thread_idx < problem_size) { + WriteIdx2<1024, double, double, double2>(eq, 4 * eq_num_alloc, global_thread_idx, r1, r0); + WriteIdx2<1024, double, double, double2>(eq, 6 * eq_num_alloc, global_thread_idx, r4, r5); + }; + ReadAndShuffleWithDefault1<1024, double, double, double>( + (double*)inout_shared, tridig_U, 8 * tridig_U_num_alloc, + global_thread_idx * tridig_U_stride + tridig_U_offset, threadIdx.x == 1023, + global_thread_idx <= problem_size, tridig_U_num_alloc, tridig_U_stride, r5, r4, 0.000000f); + if (global_thread_idx < problem_size) { + ReadIdx2<1024, double, double, double2>(precond_diag, 0 * precond_diag_num_alloc, + global_thread_idx, r0, r1); + }; + LoadUnique<1, double, double>(diag, 0, (double*)inout_shared); + if (global_thread_idx < problem_size) { + ReadShared1((double*)inout_shared, 0, r12); + }; + __syncthreads(); + if (global_thread_idx < problem_size) { + r13 = 1.00000000000000000e+00; + r14 = r12 + r13; + r15 = 2.22044604925031308e-15; + r15 = r12 * r15; + r0 = fma(r0, r14, r15); + WriteIdx2<1024, double, double, double2>(eq, 8 * eq_num_alloc, global_thread_idx, r5, r0); + ReadIdx2<1024, double, double, double2>(precond_tril, 0 * precond_tril_num_alloc, + global_thread_idx, r5, r12); + WriteIdx2<1024, double, double, double2>(eq, 10 * eq_num_alloc, global_thread_idx, r5, r12); + r1 = fma(r1, r14, r15); + WriteIdx2<1024, double, double, double2>(eq, 12 * eq_num_alloc, global_thread_idx, r5, r1); + ReadIdx1<1024, double, double, double>(precond_tril, 2 * precond_tril_num_alloc, + global_thread_idx, r16); + WriteIdx2<1024, double, double, double2>(eq, 14 * eq_num_alloc, global_thread_idx, r16, r12); + ReadIdx1<1024, double, double, double>(precond_diag, 2 * precond_diag_num_alloc, + global_thread_idx, r17); + r14 = r17 * r14; + r17 = r15 + r14; + WriteIdx2<1024, double, double, double2>(eq, 16 * eq_num_alloc, global_thread_idx, r16, r17); + WriteIdx2<1024, double, double, double2>(eq, 18 * eq_num_alloc, global_thread_idx, r2, r3); + WriteIdx2<1024, double, double, double2>(eq, 20 * eq_num_alloc, global_thread_idx, r6, r7); + WriteIdx2<1024, double, double, double2>(eq, 22 * eq_num_alloc, global_thread_idx, r10, r11); + WriteIdx2<1024, double, double, double2>(eq, 24 * eq_num_alloc, global_thread_idx, r8, r9); + ReadIdx2<1024, double, double, double2>(njtr, 0 * njtr_num_alloc, global_thread_idx, r9, r8); + WriteIdx2<1024, double, double, double2>(eq, 26 * eq_num_alloc, global_thread_idx, r4, r9); + ReadIdx1<1024, double, double, double>(njtr, 2 * njtr_num_alloc, global_thread_idx, r9); + WriteIdx2<1024, double, double, double2>(eq, 28 * eq_num_alloc, global_thread_idx, r8, r9); + r9 = 1.0 / r0; + r8 = r5 * r9; + WriteIdx2<1024, double, double, double2>(eq, 30 * eq_num_alloc, global_thread_idx, r13, r8); + r4 = r12 * r9; + WriteIdx2<1024, double, double, double2>(eq, 32 * eq_num_alloc, global_thread_idx, r13, r4); + r4 = -1.00000000000000000e+00; + r11 = r5 * r4; + r11 = fma(r8, r11, r1); + r1 = 1.0 / r11; + r10 = r12 * r4; + r8 = fma(r8, r10, r16); + r1 = r1 * r8; + WriteIdx2<1024, double, double, double2>(eq, 34 * eq_num_alloc, global_thread_idx, r1, r13); + WriteIdx2<1024, double, double, double2>(eq, 36 * eq_num_alloc, global_thread_idx, r0, r5); + WriteIdx2<1024, double, double, double2>(eq, 38 * eq_num_alloc, global_thread_idx, r12, r11); + r14 = r15 + r14; + r15 = r4 * r8; + r14 = fma(r1, r15, r14); + r1 = r12 * r9; + r14 = fma(r10, r1, r14); + WriteIdx2<1024, double, double, double2>(eq, 40 * eq_num_alloc, global_thread_idx, r8, r14); + }; +} + +void ChainBTridigMakeEq(double* precond_diag, unsigned int precond_diag_num_alloc, + double* precond_tril, unsigned int precond_tril_num_alloc, + double* const tridig_U, unsigned int tridig_U_num_alloc, + int tridig_U_offset, int tridig_U_stride, double* njtr, + unsigned int njtr_num_alloc, const double* const diag, double* eq, + unsigned int eq_num_alloc, size_t problem_size) { + if (problem_size == 0) { + return; + } + + const int n_blocks = (problem_size + 1024 - 1) / 1024; + // Kernels using more than 48 KB of shared memory per block must opt in. + static const cudaError_t attribute_error = cudaFuncSetAttribute( + ChainBTridigMakeEqKernel, cudaFuncAttributeMaxDynamicSharedMemorySize, 16384); + if (attribute_error != cudaSuccess) { + throw std::runtime_error(std::string("ChainBTridigMakeEqKernel: ") + + cudaGetErrorString(attribute_error)); + } + ChainBTridigMakeEqKernel<<>>( + precond_diag, precond_diag_num_alloc, precond_tril, precond_tril_num_alloc, tridig_U, + tridig_U_num_alloc, tridig_U_offset, tridig_U_stride, njtr, njtr_num_alloc, diag, eq, + eq_num_alloc, problem_size); + // A launch that fails (e.g. from exceeding shared memory or register limits) + // otherwise leaves its outputs untouched without any error. + const cudaError_t launch_error = cudaGetLastError(); + if (launch_error != cudaSuccess) { + throw std::runtime_error(std::string("ChainBTridigMakeEqKernel launch failed: ") + + cudaGetErrorString(launch_error)); + } +} + +} // namespace caspar \ No newline at end of file diff --git a/test/symforce_function_codegen_test_data/symengine/symforce_caspar_tridiagonal_test/kernel_ChainB_tridig_make_eq.h b/test/symforce_function_codegen_test_data/symengine/symforce_caspar_tridiagonal_test/kernel_ChainB_tridig_make_eq.h new file mode 100644 index 00000000..8872219e --- /dev/null +++ b/test/symforce_function_codegen_test_data/symengine/symforce_caspar_tridiagonal_test/kernel_ChainB_tridig_make_eq.h @@ -0,0 +1,16 @@ +#pragma once + +#include + +#include "shared_indices.h" + +namespace caspar { + +void ChainBTridigMakeEq(double* precond_diag, unsigned int precond_diag_num_alloc, + double* precond_tril, unsigned int precond_tril_num_alloc, + double* const tridig_U, unsigned int tridig_U_num_alloc, + int tridig_U_offset, int tridig_U_stride, double* njtr, + unsigned int njtr_num_alloc, const double* const diag, double* eq, + unsigned int eq_num_alloc, size_t problem_size); + +} // namespace caspar \ No newline at end of file diff --git a/test/symforce_function_codegen_test_data/symengine/symforce_caspar_tridiagonal_test/kernel_ChainB_update_Mp.cu b/test/symforce_function_codegen_test_data/symengine/symforce_caspar_tridiagonal_test/kernel_ChainB_update_Mp.cu new file mode 100644 index 00000000..479a3026 --- /dev/null +++ b/test/symforce_function_codegen_test_data/symengine/symforce_caspar_tridiagonal_test/kernel_ChainB_update_Mp.cu @@ -0,0 +1,90 @@ +#include +#include + +#include +#include +#include +#include +#include + +#include "kernel_ChainB_update_Mp.h" +#include "memops.cuh" + +namespace cg = cooperative_groups; + +namespace caspar { + +__global__ void __launch_bounds__(1024, 1) + ChainBUpdateMpKernel(double* ChainB_r_k, unsigned int ChainB_r_k_num_alloc, double* ChainB_Mp, + unsigned int ChainB_Mp_num_alloc, const double* const beta, + double* out_ChainB_Mp_kp1, unsigned int out_ChainB_Mp_kp1_num_alloc, + double* out_ChainB_w, unsigned int out_ChainB_w_num_alloc, + size_t problem_size) { + const int global_thread_idx = blockIdx.x * blockDim.x + threadIdx.x; + // Scratch data, then the shared indices of each shared accessor; dynamic, so + // that it may exceed the 48 KB static shared memory limit (see the launch + // below). + extern __shared__ __align__(16) uint8_t inout_shared[]; + + double r0 = 0, r1 = 0, r2 = 0, r3 = 0, r4 = 0; + + if (global_thread_idx < problem_size) { + ReadIdx2<1024, double, double, double2>(ChainB_Mp, 0 * ChainB_Mp_num_alloc, global_thread_idx, + r0, r1); + ReadIdx2<1024, double, double, double2>(ChainB_r_k, 0 * ChainB_r_k_num_alloc, global_thread_idx, + r2, r3); + }; + LoadUnique<1, double, double>(beta, 0, (double*)inout_shared); + if (global_thread_idx < problem_size) { + ReadShared1((double*)inout_shared, 0, r4); + }; + __syncthreads(); + if (global_thread_idx < problem_size) { + r0 = fma(r0, r4, r2); + r1 = fma(r1, r4, r3); + WriteIdx2<1024, double, double, double2>(out_ChainB_Mp_kp1, 0 * out_ChainB_Mp_kp1_num_alloc, + global_thread_idx, r0, r1); + ReadIdx1<1024, double, double, double>(ChainB_Mp, 2 * ChainB_Mp_num_alloc, global_thread_idx, + r3); + ReadIdx1<1024, double, double, double>(ChainB_r_k, 2 * ChainB_r_k_num_alloc, global_thread_idx, + r2); + r4 = fma(r3, r4, r2); + WriteIdx1<1024, double, double, double>(out_ChainB_Mp_kp1, 2 * out_ChainB_Mp_kp1_num_alloc, + global_thread_idx, r4); + WriteIdx2<1024, double, double, double2>(out_ChainB_w, 0 * out_ChainB_w_num_alloc, + global_thread_idx, r0, r1); + WriteIdx1<1024, double, double, double>(out_ChainB_w, 2 * out_ChainB_w_num_alloc, + global_thread_idx, r4); + }; +} + +void ChainBUpdateMp(double* ChainB_r_k, unsigned int ChainB_r_k_num_alloc, double* ChainB_Mp, + unsigned int ChainB_Mp_num_alloc, const double* const beta, + double* out_ChainB_Mp_kp1, unsigned int out_ChainB_Mp_kp1_num_alloc, + double* out_ChainB_w, unsigned int out_ChainB_w_num_alloc, + size_t problem_size) { + if (problem_size == 0) { + return; + } + + const int n_blocks = (problem_size + 1024 - 1) / 1024; + // Kernels using more than 48 KB of shared memory per block must opt in. + static const cudaError_t attribute_error = + cudaFuncSetAttribute(ChainBUpdateMpKernel, cudaFuncAttributeMaxDynamicSharedMemorySize, 8192); + if (attribute_error != cudaSuccess) { + throw std::runtime_error(std::string("ChainBUpdateMpKernel: ") + + cudaGetErrorString(attribute_error)); + } + ChainBUpdateMpKernel<<>>( + ChainB_r_k, ChainB_r_k_num_alloc, ChainB_Mp, ChainB_Mp_num_alloc, beta, out_ChainB_Mp_kp1, + out_ChainB_Mp_kp1_num_alloc, out_ChainB_w, out_ChainB_w_num_alloc, problem_size); + // A launch that fails (e.g. from exceeding shared memory or register limits) + // otherwise leaves its outputs untouched without any error. + const cudaError_t launch_error = cudaGetLastError(); + if (launch_error != cudaSuccess) { + throw std::runtime_error(std::string("ChainBUpdateMpKernel launch failed: ") + + cudaGetErrorString(launch_error)); + } +} + +} // namespace caspar \ No newline at end of file diff --git a/test/symforce_function_codegen_test_data/symengine/symforce_caspar_tridiagonal_test/kernel_ChainB_update_Mp.h b/test/symforce_function_codegen_test_data/symengine/symforce_caspar_tridiagonal_test/kernel_ChainB_update_Mp.h new file mode 100644 index 00000000..13c7935f --- /dev/null +++ b/test/symforce_function_codegen_test_data/symengine/symforce_caspar_tridiagonal_test/kernel_ChainB_update_Mp.h @@ -0,0 +1,14 @@ +#pragma once + +#include + +#include "shared_indices.h" + +namespace caspar { + +void ChainBUpdateMp(double* ChainB_r_k, unsigned int ChainB_r_k_num_alloc, double* ChainB_Mp, + unsigned int ChainB_Mp_num_alloc, const double* const beta, + double* out_ChainB_Mp_kp1, unsigned int out_ChainB_Mp_kp1_num_alloc, + double* out_ChainB_w, unsigned int out_ChainB_w_num_alloc, size_t problem_size); + +} // namespace caspar \ No newline at end of file diff --git a/test/symforce_function_codegen_test_data/symengine/symforce_caspar_tridiagonal_test/kernel_ChainB_update_p.cu b/test/symforce_function_codegen_test_data/symengine/symforce_caspar_tridiagonal_test/kernel_ChainB_update_p.cu new file mode 100644 index 00000000..e2a6843d --- /dev/null +++ b/test/symforce_function_codegen_test_data/symengine/symforce_caspar_tridiagonal_test/kernel_ChainB_update_p.cu @@ -0,0 +1,83 @@ +#include +#include + +#include +#include +#include +#include +#include + +#include "kernel_ChainB_update_p.h" +#include "memops.cuh" + +namespace cg = cooperative_groups; + +namespace caspar { + +__global__ void __launch_bounds__(1024, 1) + ChainBUpdatePKernel(double* ChainB_z, unsigned int ChainB_z_num_alloc, double* ChainB_p_k, + unsigned int ChainB_p_k_num_alloc, const double* const beta, + double* out_ChainB_p_kp1, unsigned int out_ChainB_p_kp1_num_alloc, + size_t problem_size) { + const int global_thread_idx = blockIdx.x * blockDim.x + threadIdx.x; + // Scratch data, then the shared indices of each shared accessor; dynamic, so + // that it may exceed the 48 KB static shared memory limit (see the launch + // below). + extern __shared__ __align__(16) uint8_t inout_shared[]; + + double r0 = 0, r1 = 0, r2 = 0, r3 = 0, r4 = 0; + + if (global_thread_idx < problem_size) { + ReadIdx2<1024, double, double, double2>(ChainB_p_k, 0 * ChainB_p_k_num_alloc, global_thread_idx, + r0, r1); + ReadIdx2<1024, double, double, double2>(ChainB_z, 0 * ChainB_z_num_alloc, global_thread_idx, r2, + r3); + }; + LoadUnique<1, double, double>(beta, 0, (double*)inout_shared); + if (global_thread_idx < problem_size) { + ReadShared1((double*)inout_shared, 0, r4); + }; + __syncthreads(); + if (global_thread_idx < problem_size) { + r0 = fma(r0, r4, r2); + r1 = fma(r1, r4, r3); + WriteIdx2<1024, double, double, double2>(out_ChainB_p_kp1, 0 * out_ChainB_p_kp1_num_alloc, + global_thread_idx, r0, r1); + ReadIdx1<1024, double, double, double>(ChainB_p_k, 2 * ChainB_p_k_num_alloc, global_thread_idx, + r1); + ReadIdx1<1024, double, double, double>(ChainB_z, 2 * ChainB_z_num_alloc, global_thread_idx, r0); + r4 = fma(r1, r4, r0); + WriteIdx1<1024, double, double, double>(out_ChainB_p_kp1, 2 * out_ChainB_p_kp1_num_alloc, + global_thread_idx, r4); + }; +} + +void ChainBUpdateP(double* ChainB_z, unsigned int ChainB_z_num_alloc, double* ChainB_p_k, + unsigned int ChainB_p_k_num_alloc, const double* const beta, + double* out_ChainB_p_kp1, unsigned int out_ChainB_p_kp1_num_alloc, + size_t problem_size) { + if (problem_size == 0) { + return; + } + + const int n_blocks = (problem_size + 1024 - 1) / 1024; + // Kernels using more than 48 KB of shared memory per block must opt in. + static const cudaError_t attribute_error = + cudaFuncSetAttribute(ChainBUpdatePKernel, cudaFuncAttributeMaxDynamicSharedMemorySize, 8192); + if (attribute_error != cudaSuccess) { + throw std::runtime_error(std::string("ChainBUpdatePKernel: ") + + cudaGetErrorString(attribute_error)); + } + ChainBUpdatePKernel<<>>(ChainB_z, ChainB_z_num_alloc, ChainB_p_k, + ChainB_p_k_num_alloc, beta, out_ChainB_p_kp1, + out_ChainB_p_kp1_num_alloc, problem_size); + // A launch that fails (e.g. from exceeding shared memory or register limits) + // otherwise leaves its outputs untouched without any error. + const cudaError_t launch_error = cudaGetLastError(); + if (launch_error != cudaSuccess) { + throw std::runtime_error(std::string("ChainBUpdatePKernel launch failed: ") + + cudaGetErrorString(launch_error)); + } +} + +} // namespace caspar \ No newline at end of file diff --git a/test/symforce_function_codegen_test_data/symengine/symforce_caspar_tridiagonal_test/kernel_ChainB_update_p.h b/test/symforce_function_codegen_test_data/symengine/symforce_caspar_tridiagonal_test/kernel_ChainB_update_p.h new file mode 100644 index 00000000..3c6125d5 --- /dev/null +++ b/test/symforce_function_codegen_test_data/symengine/symforce_caspar_tridiagonal_test/kernel_ChainB_update_p.h @@ -0,0 +1,14 @@ +#pragma once + +#include + +#include "shared_indices.h" + +namespace caspar { + +void ChainBUpdateP(double* ChainB_z, unsigned int ChainB_z_num_alloc, double* ChainB_p_k, + unsigned int ChainB_p_k_num_alloc, const double* const beta, + double* out_ChainB_p_kp1, unsigned int out_ChainB_p_kp1_num_alloc, + size_t problem_size); + +} // namespace caspar \ No newline at end of file diff --git a/test/symforce_function_codegen_test_data/symengine/symforce_caspar_tridiagonal_test/kernel_ChainB_update_r.cu b/test/symforce_function_codegen_test_data/symengine/symforce_caspar_tridiagonal_test/kernel_ChainB_update_r.cu new file mode 100644 index 00000000..355656ca --- /dev/null +++ b/test/symforce_function_codegen_test_data/symengine/symforce_caspar_tridiagonal_test/kernel_ChainB_update_r.cu @@ -0,0 +1,90 @@ +#include +#include + +#include +#include +#include +#include +#include + +#include "kernel_ChainB_update_r.h" +#include "memops.cuh" + +namespace cg = cooperative_groups; + +namespace caspar { + +__global__ void __launch_bounds__(1024, 1) + ChainBUpdateRKernel(double* ChainB_r_k, unsigned int ChainB_r_k_num_alloc, double* ChainB_w, + unsigned int ChainB_w_num_alloc, const double* const negalpha, + double* out_ChainB_r_kp1, unsigned int out_ChainB_r_kp1_num_alloc, + double* const out_ChainB_r_kp1_norm2_tot, size_t problem_size) { + const int global_thread_idx = blockIdx.x * blockDim.x + threadIdx.x; + // Scratch data, then the shared indices of each shared accessor; dynamic, so + // that it may exceed the 48 KB static shared memory limit (see the launch + // below). + extern __shared__ __align__(16) uint8_t inout_shared[]; + + __shared__ double out_ChainB_r_kp1_norm2_tot_local[1]; + + double r0 = 0, r1 = 0, r2 = 0, r3 = 0, r4 = 0; + + if (global_thread_idx < problem_size) { + ReadIdx2<1024, double, double, double2>(ChainB_r_k, 0 * ChainB_r_k_num_alloc, global_thread_idx, + r0, r1); + ReadIdx2<1024, double, double, double2>(ChainB_w, 0 * ChainB_w_num_alloc, global_thread_idx, r2, + r3); + }; + LoadUnique<1, double, double>(negalpha, 0, (double*)inout_shared); + if (global_thread_idx < problem_size) { + ReadShared1((double*)inout_shared, 0, r4); + }; + __syncthreads(); + if (global_thread_idx < problem_size) { + r2 = fma(r2, r4, r0); + r3 = fma(r3, r4, r1); + WriteIdx2<1024, double, double, double2>(out_ChainB_r_kp1, 0 * out_ChainB_r_kp1_num_alloc, + global_thread_idx, r2, r3); + ReadIdx1<1024, double, double, double>(ChainB_r_k, 2 * ChainB_r_k_num_alloc, global_thread_idx, + r1); + ReadIdx1<1024, double, double, double>(ChainB_w, 2 * ChainB_w_num_alloc, global_thread_idx, r0); + r4 = fma(r0, r4, r1); + WriteIdx1<1024, double, double, double>(out_ChainB_r_kp1, 2 * out_ChainB_r_kp1_num_alloc, + global_thread_idx, r4); + r3 = fma(r3, r3, r2 * r2); + r3 = fma(r4, r4, r3); + }; + SumStore(out_ChainB_r_kp1_norm2_tot_local, (double*)inout_shared, 0, + global_thread_idx < problem_size, r3); + SumFlushFinal(out_ChainB_r_kp1_norm2_tot_local, out_ChainB_r_kp1_norm2_tot, 1); +} + +void ChainBUpdateR(double* ChainB_r_k, unsigned int ChainB_r_k_num_alloc, double* ChainB_w, + unsigned int ChainB_w_num_alloc, const double* const negalpha, + double* out_ChainB_r_kp1, unsigned int out_ChainB_r_kp1_num_alloc, + double* const out_ChainB_r_kp1_norm2_tot, size_t problem_size) { + if (problem_size == 0) { + return; + } + + const int n_blocks = (problem_size + 1024 - 1) / 1024; + // Kernels using more than 48 KB of shared memory per block must opt in. + static const cudaError_t attribute_error = + cudaFuncSetAttribute(ChainBUpdateRKernel, cudaFuncAttributeMaxDynamicSharedMemorySize, 8192); + if (attribute_error != cudaSuccess) { + throw std::runtime_error(std::string("ChainBUpdateRKernel: ") + + cudaGetErrorString(attribute_error)); + } + ChainBUpdateRKernel<<>>( + ChainB_r_k, ChainB_r_k_num_alloc, ChainB_w, ChainB_w_num_alloc, negalpha, out_ChainB_r_kp1, + out_ChainB_r_kp1_num_alloc, out_ChainB_r_kp1_norm2_tot, problem_size); + // A launch that fails (e.g. from exceeding shared memory or register limits) + // otherwise leaves its outputs untouched without any error. + const cudaError_t launch_error = cudaGetLastError(); + if (launch_error != cudaSuccess) { + throw std::runtime_error(std::string("ChainBUpdateRKernel launch failed: ") + + cudaGetErrorString(launch_error)); + } +} + +} // namespace caspar \ No newline at end of file diff --git a/test/symforce_function_codegen_test_data/symengine/symforce_caspar_tridiagonal_test/kernel_ChainB_update_r.h b/test/symforce_function_codegen_test_data/symengine/symforce_caspar_tridiagonal_test/kernel_ChainB_update_r.h new file mode 100644 index 00000000..c8eb9f28 --- /dev/null +++ b/test/symforce_function_codegen_test_data/symengine/symforce_caspar_tridiagonal_test/kernel_ChainB_update_r.h @@ -0,0 +1,14 @@ +#pragma once + +#include + +#include "shared_indices.h" + +namespace caspar { + +void ChainBUpdateR(double* ChainB_r_k, unsigned int ChainB_r_k_num_alloc, double* ChainB_w, + unsigned int ChainB_w_num_alloc, const double* const negalpha, + double* out_ChainB_r_kp1, unsigned int out_ChainB_r_kp1_num_alloc, + double* const out_ChainB_r_kp1_norm2_tot, size_t problem_size); + +} // namespace caspar \ No newline at end of file diff --git a/test/symforce_function_codegen_test_data/symengine/symforce_caspar_tridiagonal_test/kernel_ChainB_update_r_first.cu b/test/symforce_function_codegen_test_data/symengine/symforce_caspar_tridiagonal_test/kernel_ChainB_update_r_first.cu new file mode 100644 index 00000000..9f7c746f --- /dev/null +++ b/test/symforce_function_codegen_test_data/symengine/symforce_caspar_tridiagonal_test/kernel_ChainB_update_r_first.cu @@ -0,0 +1,103 @@ +#include +#include + +#include +#include +#include +#include +#include + +#include "kernel_ChainB_update_r_first.h" +#include "memops.cuh" + +namespace cg = cooperative_groups; + +namespace caspar { + +__global__ void __launch_bounds__(1024, 1) + ChainBUpdateRFirstKernel(double* ChainB_r_k, unsigned int ChainB_r_k_num_alloc, + double* ChainB_w, unsigned int ChainB_w_num_alloc, + const double* const negalpha, double* out_ChainB_r_kp1, + unsigned int out_ChainB_r_kp1_num_alloc, + double* const out_ChainB_r_0_norm2_tot, + double* const out_ChainB_r_kp1_norm2_tot, size_t problem_size) { + const int global_thread_idx = blockIdx.x * blockDim.x + threadIdx.x; + // Scratch data, then the shared indices of each shared accessor; dynamic, so + // that it may exceed the 48 KB static shared memory limit (see the launch + // below). + extern __shared__ __align__(16) uint8_t inout_shared[]; + + __shared__ double out_ChainB_r_0_norm2_tot_local[1]; + + __shared__ double out_ChainB_r_kp1_norm2_tot_local[1]; + + double r0 = 0, r1 = 0, r2 = 0, r3 = 0, r4 = 0, r5 = 0, r6 = 0; + + if (global_thread_idx < problem_size) { + ReadIdx2<1024, double, double, double2>(ChainB_r_k, 0 * ChainB_r_k_num_alloc, global_thread_idx, + r0, r1); + ReadIdx2<1024, double, double, double2>(ChainB_w, 0 * ChainB_w_num_alloc, global_thread_idx, r2, + r3); + }; + LoadUnique<1, double, double>(negalpha, 0, (double*)inout_shared); + if (global_thread_idx < problem_size) { + ReadShared1((double*)inout_shared, 0, r4); + }; + __syncthreads(); + if (global_thread_idx < problem_size) { + r2 = fma(r2, r4, r0); + r3 = fma(r3, r4, r1); + WriteIdx2<1024, double, double, double2>(out_ChainB_r_kp1, 0 * out_ChainB_r_kp1_num_alloc, + global_thread_idx, r2, r3); + ReadIdx1<1024, double, double, double>(ChainB_r_k, 2 * ChainB_r_k_num_alloc, global_thread_idx, + r5); + ReadIdx1<1024, double, double, double>(ChainB_w, 2 * ChainB_w_num_alloc, global_thread_idx, r6); + r4 = fma(r6, r4, r5); + WriteIdx1<1024, double, double, double>(out_ChainB_r_kp1, 2 * out_ChainB_r_kp1_num_alloc, + global_thread_idx, r4); + r1 = fma(r1, r1, r0 * r0); + r1 = fma(r5, r5, r1); + }; + SumStore(out_ChainB_r_0_norm2_tot_local, (double*)inout_shared, 0, + global_thread_idx < problem_size, r1); + if (global_thread_idx < problem_size) { + r3 = fma(r3, r3, r2 * r2); + r3 = fma(r4, r4, r3); + }; + SumStore(out_ChainB_r_kp1_norm2_tot_local, (double*)inout_shared, 0, + global_thread_idx < problem_size, r3); + SumFlushFinal(out_ChainB_r_0_norm2_tot_local, out_ChainB_r_0_norm2_tot, 1); + SumFlushFinal(out_ChainB_r_kp1_norm2_tot_local, out_ChainB_r_kp1_norm2_tot, 1); +} + +void ChainBUpdateRFirst(double* ChainB_r_k, unsigned int ChainB_r_k_num_alloc, double* ChainB_w, + unsigned int ChainB_w_num_alloc, const double* const negalpha, + double* out_ChainB_r_kp1, unsigned int out_ChainB_r_kp1_num_alloc, + double* const out_ChainB_r_0_norm2_tot, + double* const out_ChainB_r_kp1_norm2_tot, size_t problem_size) { + if (problem_size == 0) { + return; + } + + const int n_blocks = (problem_size + 1024 - 1) / 1024; + // Kernels using more than 48 KB of shared memory per block must opt in. + static const cudaError_t attribute_error = cudaFuncSetAttribute( + ChainBUpdateRFirstKernel, cudaFuncAttributeMaxDynamicSharedMemorySize, 8192); + if (attribute_error != cudaSuccess) { + throw std::runtime_error(std::string("ChainBUpdateRFirstKernel: ") + + cudaGetErrorString(attribute_error)); + } + ChainBUpdateRFirstKernel<<>>( + ChainB_r_k, ChainB_r_k_num_alloc, ChainB_w, ChainB_w_num_alloc, negalpha, out_ChainB_r_kp1, + out_ChainB_r_kp1_num_alloc, out_ChainB_r_0_norm2_tot, out_ChainB_r_kp1_norm2_tot, + problem_size); + // A launch that fails (e.g. from exceeding shared memory or register limits) + // otherwise leaves its outputs untouched without any error. + const cudaError_t launch_error = cudaGetLastError(); + if (launch_error != cudaSuccess) { + throw std::runtime_error(std::string("ChainBUpdateRFirstKernel launch failed: ") + + cudaGetErrorString(launch_error)); + } +} + +} // namespace caspar \ No newline at end of file diff --git a/test/symforce_function_codegen_test_data/symengine/symforce_caspar_tridiagonal_test/kernel_ChainB_update_r_first.h b/test/symforce_function_codegen_test_data/symengine/symforce_caspar_tridiagonal_test/kernel_ChainB_update_r_first.h new file mode 100644 index 00000000..1ff22f75 --- /dev/null +++ b/test/symforce_function_codegen_test_data/symengine/symforce_caspar_tridiagonal_test/kernel_ChainB_update_r_first.h @@ -0,0 +1,15 @@ +#pragma once + +#include + +#include "shared_indices.h" + +namespace caspar { + +void ChainBUpdateRFirst(double* ChainB_r_k, unsigned int ChainB_r_k_num_alloc, double* ChainB_w, + unsigned int ChainB_w_num_alloc, const double* const negalpha, + double* out_ChainB_r_kp1, unsigned int out_ChainB_r_kp1_num_alloc, + double* const out_ChainB_r_0_norm2_tot, + double* const out_ChainB_r_kp1_norm2_tot, size_t problem_size); + +} // namespace caspar \ No newline at end of file diff --git a/test/symforce_function_codegen_test_data/symengine/symforce_caspar_tridiagonal_test/kernel_ChainB_update_step.cu b/test/symforce_function_codegen_test_data/symengine/symforce_caspar_tridiagonal_test/kernel_ChainB_update_step.cu new file mode 100644 index 00000000..9cd0cc24 --- /dev/null +++ b/test/symforce_function_codegen_test_data/symengine/symforce_caspar_tridiagonal_test/kernel_ChainB_update_step.cu @@ -0,0 +1,84 @@ +#include +#include + +#include +#include +#include +#include +#include + +#include "kernel_ChainB_update_step.h" +#include "memops.cuh" + +namespace cg = cooperative_groups; + +namespace caspar { + +__global__ void __launch_bounds__(1024, 1) + ChainBUpdateStepKernel(double* ChainB_step_k, unsigned int ChainB_step_k_num_alloc, + double* ChainB_p_kp1, unsigned int ChainB_p_kp1_num_alloc, + const double* const alpha, double* out_ChainB_step_kp1, + unsigned int out_ChainB_step_kp1_num_alloc, size_t problem_size) { + const int global_thread_idx = blockIdx.x * blockDim.x + threadIdx.x; + // Scratch data, then the shared indices of each shared accessor; dynamic, so + // that it may exceed the 48 KB static shared memory limit (see the launch + // below). + extern __shared__ __align__(16) uint8_t inout_shared[]; + + double r0 = 0, r1 = 0, r2 = 0, r3 = 0, r4 = 0; + + if (global_thread_idx < problem_size) { + ReadIdx2<1024, double, double, double2>(ChainB_step_k, 0 * ChainB_step_k_num_alloc, + global_thread_idx, r0, r1); + ReadIdx2<1024, double, double, double2>(ChainB_p_kp1, 0 * ChainB_p_kp1_num_alloc, + global_thread_idx, r2, r3); + }; + LoadUnique<1, double, double>(alpha, 0, (double*)inout_shared); + if (global_thread_idx < problem_size) { + ReadShared1((double*)inout_shared, 0, r4); + }; + __syncthreads(); + if (global_thread_idx < problem_size) { + r2 = fma(r2, r4, r0); + r3 = fma(r3, r4, r1); + WriteIdx2<1024, double, double, double2>(out_ChainB_step_kp1, 0 * out_ChainB_step_kp1_num_alloc, + global_thread_idx, r2, r3); + ReadIdx1<1024, double, double, double>(ChainB_step_k, 2 * ChainB_step_k_num_alloc, + global_thread_idx, r3); + ReadIdx1<1024, double, double, double>(ChainB_p_kp1, 2 * ChainB_p_kp1_num_alloc, + global_thread_idx, r2); + r4 = fma(r2, r4, r3); + WriteIdx1<1024, double, double, double>(out_ChainB_step_kp1, 2 * out_ChainB_step_kp1_num_alloc, + global_thread_idx, r4); + }; +} + +void ChainBUpdateStep(double* ChainB_step_k, unsigned int ChainB_step_k_num_alloc, + double* ChainB_p_kp1, unsigned int ChainB_p_kp1_num_alloc, + const double* const alpha, double* out_ChainB_step_kp1, + unsigned int out_ChainB_step_kp1_num_alloc, size_t problem_size) { + if (problem_size == 0) { + return; + } + + const int n_blocks = (problem_size + 1024 - 1) / 1024; + // Kernels using more than 48 KB of shared memory per block must opt in. + static const cudaError_t attribute_error = cudaFuncSetAttribute( + ChainBUpdateStepKernel, cudaFuncAttributeMaxDynamicSharedMemorySize, 8192); + if (attribute_error != cudaSuccess) { + throw std::runtime_error(std::string("ChainBUpdateStepKernel: ") + + cudaGetErrorString(attribute_error)); + } + ChainBUpdateStepKernel<<>>( + ChainB_step_k, ChainB_step_k_num_alloc, ChainB_p_kp1, ChainB_p_kp1_num_alloc, alpha, + out_ChainB_step_kp1, out_ChainB_step_kp1_num_alloc, problem_size); + // A launch that fails (e.g. from exceeding shared memory or register limits) + // otherwise leaves its outputs untouched without any error. + const cudaError_t launch_error = cudaGetLastError(); + if (launch_error != cudaSuccess) { + throw std::runtime_error(std::string("ChainBUpdateStepKernel launch failed: ") + + cudaGetErrorString(launch_error)); + } +} + +} // namespace caspar \ No newline at end of file diff --git a/test/symforce_function_codegen_test_data/symengine/symforce_caspar_tridiagonal_test/kernel_ChainB_update_step.h b/test/symforce_function_codegen_test_data/symengine/symforce_caspar_tridiagonal_test/kernel_ChainB_update_step.h new file mode 100644 index 00000000..006779e7 --- /dev/null +++ b/test/symforce_function_codegen_test_data/symengine/symforce_caspar_tridiagonal_test/kernel_ChainB_update_step.h @@ -0,0 +1,14 @@ +#pragma once + +#include + +#include "shared_indices.h" + +namespace caspar { + +void ChainBUpdateStep(double* ChainB_step_k, unsigned int ChainB_step_k_num_alloc, + double* ChainB_p_kp1, unsigned int ChainB_p_kp1_num_alloc, + const double* const alpha, double* out_ChainB_step_kp1, + unsigned int out_ChainB_step_kp1_num_alloc, size_t problem_size); + +} // namespace caspar \ No newline at end of file diff --git a/test/symforce_function_codegen_test_data/symengine/symforce_caspar_tridiagonal_test/kernel_ChainB_update_step_first.cu b/test/symforce_function_codegen_test_data/symengine/symforce_caspar_tridiagonal_test/kernel_ChainB_update_step_first.cu new file mode 100644 index 00000000..e3f1301d --- /dev/null +++ b/test/symforce_function_codegen_test_data/symengine/symforce_caspar_tridiagonal_test/kernel_ChainB_update_step_first.cu @@ -0,0 +1,78 @@ +#include +#include + +#include +#include +#include +#include +#include + +#include "kernel_ChainB_update_step_first.h" +#include "memops.cuh" + +namespace cg = cooperative_groups; + +namespace caspar { + +__global__ void __launch_bounds__(1024, 1) + ChainBUpdateStepFirstKernel(double* ChainB_p_kp1, unsigned int ChainB_p_kp1_num_alloc, + const double* const alpha, double* out_ChainB_step_kp1, + unsigned int out_ChainB_step_kp1_num_alloc, size_t problem_size) { + const int global_thread_idx = blockIdx.x * blockDim.x + threadIdx.x; + // Scratch data, then the shared indices of each shared accessor; dynamic, so + // that it may exceed the 48 KB static shared memory limit (see the launch + // below). + extern __shared__ __align__(16) uint8_t inout_shared[]; + + double r0 = 0, r1 = 0, r2 = 0; + + if (global_thread_idx < problem_size) { + ReadIdx2<1024, double, double, double2>(ChainB_p_kp1, 0 * ChainB_p_kp1_num_alloc, + global_thread_idx, r0, r1); + }; + LoadUnique<1, double, double>(alpha, 0, (double*)inout_shared); + if (global_thread_idx < problem_size) { + ReadShared1((double*)inout_shared, 0, r2); + }; + __syncthreads(); + if (global_thread_idx < problem_size) { + r0 = r0 * r2; + r1 = r1 * r2; + WriteIdx2<1024, double, double, double2>(out_ChainB_step_kp1, 0 * out_ChainB_step_kp1_num_alloc, + global_thread_idx, r0, r1); + ReadIdx1<1024, double, double, double>(ChainB_p_kp1, 2 * ChainB_p_kp1_num_alloc, + global_thread_idx, r1); + r2 = r1 * r2; + WriteIdx1<1024, double, double, double>(out_ChainB_step_kp1, 2 * out_ChainB_step_kp1_num_alloc, + global_thread_idx, r2); + }; +} + +void ChainBUpdateStepFirst(double* ChainB_p_kp1, unsigned int ChainB_p_kp1_num_alloc, + const double* const alpha, double* out_ChainB_step_kp1, + unsigned int out_ChainB_step_kp1_num_alloc, size_t problem_size) { + if (problem_size == 0) { + return; + } + + const int n_blocks = (problem_size + 1024 - 1) / 1024; + // Kernels using more than 48 KB of shared memory per block must opt in. + static const cudaError_t attribute_error = cudaFuncSetAttribute( + ChainBUpdateStepFirstKernel, cudaFuncAttributeMaxDynamicSharedMemorySize, 8192); + if (attribute_error != cudaSuccess) { + throw std::runtime_error(std::string("ChainBUpdateStepFirstKernel: ") + + cudaGetErrorString(attribute_error)); + } + ChainBUpdateStepFirstKernel<<>>( + ChainB_p_kp1, ChainB_p_kp1_num_alloc, alpha, out_ChainB_step_kp1, + out_ChainB_step_kp1_num_alloc, problem_size); + // A launch that fails (e.g. from exceeding shared memory or register limits) + // otherwise leaves its outputs untouched without any error. + const cudaError_t launch_error = cudaGetLastError(); + if (launch_error != cudaSuccess) { + throw std::runtime_error(std::string("ChainBUpdateStepFirstKernel launch failed: ") + + cudaGetErrorString(launch_error)); + } +} + +} // namespace caspar \ No newline at end of file diff --git a/test/symforce_function_codegen_test_data/symengine/symforce_caspar_tridiagonal_test/kernel_ChainB_update_step_first.h b/test/symforce_function_codegen_test_data/symengine/symforce_caspar_tridiagonal_test/kernel_ChainB_update_step_first.h new file mode 100644 index 00000000..1036592e --- /dev/null +++ b/test/symforce_function_codegen_test_data/symengine/symforce_caspar_tridiagonal_test/kernel_ChainB_update_step_first.h @@ -0,0 +1,13 @@ +#pragma once + +#include + +#include "shared_indices.h" + +namespace caspar { + +void ChainBUpdateStepFirst(double* ChainB_p_kp1, unsigned int ChainB_p_kp1_num_alloc, + const double* const alpha, double* out_ChainB_step_kp1, + unsigned int out_ChainB_step_kp1_num_alloc, size_t problem_size); + +} // namespace caspar \ No newline at end of file diff --git a/test/symforce_function_codegen_test_data/symengine/symforce_caspar_tridiagonal_test/kernel_chain_a_link_jtjnjtr_direct.cu b/test/symforce_function_codegen_test_data/symengine/symforce_caspar_tridiagonal_test/kernel_chain_a_link_jtjnjtr_direct.cu new file mode 100644 index 00000000..369a87ed --- /dev/null +++ b/test/symforce_function_codegen_test_data/symengine/symforce_caspar_tridiagonal_test/kernel_chain_a_link_jtjnjtr_direct.cu @@ -0,0 +1,53 @@ +#include +#include + +#include +#include +#include +#include +#include + +#include "kernel_chain_a_link_jtjnjtr_direct.h" +#include "memops.cuh" + +namespace cg = cooperative_groups; + +namespace caspar { + +__global__ void __launch_bounds__(1024, 1) + ChainALinkJtjnjtrDirectKernel(double* const a_njtr, unsigned int a_njtr_num_alloc, + double* a_jac_first, unsigned int a_jac_first_num_alloc, + double* a_jac_second, unsigned int a_jac_second_num_alloc, + double* const out_a_njtr, unsigned int out_a_njtr_num_alloc, + size_t problem_size) {} + +void ChainALinkJtjnjtrDirect(double* const a_njtr, unsigned int a_njtr_num_alloc, + double* a_jac_first, unsigned int a_jac_first_num_alloc, + double* a_jac_second, unsigned int a_jac_second_num_alloc, + double* const out_a_njtr, unsigned int out_a_njtr_num_alloc, + size_t problem_size) { + if (problem_size == 0) { + return; + } + + const int n_blocks = (problem_size + 1024 - 1) / 1024; + // Kernels using more than 48 KB of shared memory per block must opt in. + static const cudaError_t attribute_error = cudaFuncSetAttribute( + ChainALinkJtjnjtrDirectKernel, cudaFuncAttributeMaxDynamicSharedMemorySize, 16400); + if (attribute_error != cudaSuccess) { + throw std::runtime_error(std::string("ChainALinkJtjnjtrDirectKernel: ") + + cudaGetErrorString(attribute_error)); + } + ChainALinkJtjnjtrDirectKernel<<>>( + a_njtr, a_njtr_num_alloc, a_jac_first, a_jac_first_num_alloc, a_jac_second, + a_jac_second_num_alloc, out_a_njtr, out_a_njtr_num_alloc, problem_size); + // A launch that fails (e.g. from exceeding shared memory or register limits) + // otherwise leaves its outputs untouched without any error. + const cudaError_t launch_error = cudaGetLastError(); + if (launch_error != cudaSuccess) { + throw std::runtime_error(std::string("ChainALinkJtjnjtrDirectKernel launch failed: ") + + cudaGetErrorString(launch_error)); + } +} + +} // namespace caspar \ No newline at end of file diff --git a/test/symforce_function_codegen_test_data/symengine/symforce_caspar_tridiagonal_test/kernel_chain_a_link_jtjnjtr_direct.h b/test/symforce_function_codegen_test_data/symengine/symforce_caspar_tridiagonal_test/kernel_chain_a_link_jtjnjtr_direct.h new file mode 100644 index 00000000..ed6ae6d4 --- /dev/null +++ b/test/symforce_function_codegen_test_data/symengine/symforce_caspar_tridiagonal_test/kernel_chain_a_link_jtjnjtr_direct.h @@ -0,0 +1,15 @@ +#pragma once + +#include + +#include "shared_indices.h" + +namespace caspar { + +void ChainALinkJtjnjtrDirect(double* const a_njtr, unsigned int a_njtr_num_alloc, + double* a_jac_first, unsigned int a_jac_first_num_alloc, + double* a_jac_second, unsigned int a_jac_second_num_alloc, + double* const out_a_njtr, unsigned int out_a_njtr_num_alloc, + size_t problem_size); + +} // namespace caspar \ No newline at end of file diff --git a/test/symforce_function_codegen_test_data/symengine/symforce_caspar_tridiagonal_test/kernel_chain_a_link_res_jac.cu b/test/symforce_function_codegen_test_data/symengine/symforce_caspar_tridiagonal_test/kernel_chain_a_link_res_jac.cu new file mode 100644 index 00000000..7495787b --- /dev/null +++ b/test/symforce_function_codegen_test_data/symengine/symforce_caspar_tridiagonal_test/kernel_chain_a_link_res_jac.cu @@ -0,0 +1,125 @@ +#include +#include + +#include +#include +#include +#include +#include + +#include "kernel_chain_a_link_res_jac.h" +#include "memops.cuh" + +namespace cg = cooperative_groups; + +namespace caspar { + +__global__ void __launch_bounds__(1024, 1) ChainALinkResJacKernel( + double* const a, unsigned int a_num_alloc, double* weight, unsigned int weight_num_alloc, + double* offset, unsigned int offset_num_alloc, double* out_res, unsigned int out_res_num_alloc, + double* out_a_tridig_U, unsigned int out_a_tridig_U_num_alloc, double* const out_a_njtr, + unsigned int out_a_njtr_num_alloc, double* const out_a_precond_diag, + unsigned int out_a_precond_diag_num_alloc, double* const out_a_precond_tril, + unsigned int out_a_precond_tril_num_alloc, size_t problem_size) { + const int global_thread_idx = blockIdx.x * blockDim.x + threadIdx.x; + // Scratch data, then the shared indices of each shared accessor; dynamic, so + // that it may exceed the 48 KB static shared memory limit (see the launch + // below). + extern __shared__ __align__(16) uint8_t inout_shared[]; + + double r0 = 0, r1 = 0, r2 = 0, r3 = 0, r4 = 0, r5 = 0, r6 = 0, r7 = 0, r8 = 0, r9 = 0, r10 = 0, + r11 = 0, r12 = 0, r13 = 0, r14 = 0; + + if (global_thread_idx < problem_size) { + ReadIdx2<1024, double, double, double2>(offset, 0 * offset_num_alloc, global_thread_idx, r0, + r1); + r2 = -1.00000000000000000e+00; + ReadIdx2<1024, double, double, double2>(weight, 0 * weight_num_alloc, global_thread_idx, r3, + r4); + }; + ReadAndShuffle2<1024, double, double, double2>((double*)inout_shared, a, 0 * a_num_alloc, + global_thread_idx, threadIdx.x == 1023, + global_thread_idx <= problem_size, r5, r6, r7, r8); + if (global_thread_idx < problem_size) { + r5 = fma(r5, r2, r7); + r0 = fma(r3, r5, r0 * r2); + ReadIdx2<1024, double, double, double2>(weight, 2 * weight_num_alloc, global_thread_idx, r7, + r9); + r6 = fma(r6, r2, r8); + r0 = fma(r7, r6, r0); + r5 = fma(r4, r5, r1 * r2); + r5 = fma(r9, r6, r5); + WriteIdx2<1024, double, double, double2>(out_res, 0 * out_res_num_alloc, global_thread_idx, r0, + r5); + r6 = r4 * r2; + r1 = r3 * r3; + r8 = fma(r2, r1, r4 * r6); + r10 = r3 * r7; + r10 = fma(r9, r6, r2 * r10); + WriteIdx2<1024, double, double, double2>(out_a_tridig_U, 0 * out_a_tridig_U_num_alloc, + global_thread_idx, r8, r10); + r8 = r9 * r9; + r11 = r7 * r7; + r12 = fma(r2, r11, r2 * r8); + WriteIdx2<1024, double, double, double2>(out_a_tridig_U, 2 * out_a_tridig_U_num_alloc, + global_thread_idx, r10, r12); + r12 = fma(r3, r0, r4 * r5); + r10 = fma(r7, r0, r9 * r5); + r13 = r9 * r2; + r14 = r7 * r2; + r14 = fma(r0, r14, r5 * r13); + r13 = r3 * r2; + r6 = fma(r5, r6, r0 * r13); + }; + ShuffleAndWrite2((double*)inout_shared, out_a_njtr, + 0 * out_a_njtr_num_alloc, global_thread_idx, + problem_size, r12, r10, r6, r14); + if (global_thread_idx < problem_size) { + r1 = fma(r4, r4, r1); + r11 = r8 + r11; + }; + ShuffleAndWrite2( + (double*)inout_shared, out_a_precond_diag, 0 * out_a_precond_diag_num_alloc, + global_thread_idx, problem_size, r1, r11, r1, r11); + if (global_thread_idx < problem_size) { + r4 = fma(r4, r9, r3 * r7); + }; + ShuffleAndWrite1((double*)inout_shared, out_a_precond_tril, + 0 * out_a_precond_tril_num_alloc, + global_thread_idx, problem_size, r4, r4); +} + +void ChainALinkResJac(double* const a, unsigned int a_num_alloc, double* weight, + unsigned int weight_num_alloc, double* offset, unsigned int offset_num_alloc, + double* out_res, unsigned int out_res_num_alloc, double* out_a_tridig_U, + unsigned int out_a_tridig_U_num_alloc, double* const out_a_njtr, + unsigned int out_a_njtr_num_alloc, double* const out_a_precond_diag, + unsigned int out_a_precond_diag_num_alloc, double* const out_a_precond_tril, + unsigned int out_a_precond_tril_num_alloc, size_t problem_size) { + if (problem_size == 0) { + return; + } + + const int n_blocks = (problem_size + 1024 - 1) / 1024; + // Kernels using more than 48 KB of shared memory per block must opt in. + static const cudaError_t attribute_error = cudaFuncSetAttribute( + ChainALinkResJacKernel, cudaFuncAttributeMaxDynamicSharedMemorySize, 16400); + if (attribute_error != cudaSuccess) { + throw std::runtime_error(std::string("ChainALinkResJacKernel: ") + + cudaGetErrorString(attribute_error)); + } + ChainALinkResJacKernel<<>>( + a, a_num_alloc, weight, weight_num_alloc, offset, offset_num_alloc, out_res, + out_res_num_alloc, out_a_tridig_U, out_a_tridig_U_num_alloc, out_a_njtr, out_a_njtr_num_alloc, + out_a_precond_diag, out_a_precond_diag_num_alloc, out_a_precond_tril, + out_a_precond_tril_num_alloc, problem_size); + // A launch that fails (e.g. from exceeding shared memory or register limits) + // otherwise leaves its outputs untouched without any error. + const cudaError_t launch_error = cudaGetLastError(); + if (launch_error != cudaSuccess) { + throw std::runtime_error(std::string("ChainALinkResJacKernel launch failed: ") + + cudaGetErrorString(launch_error)); + } +} + +} // namespace caspar \ No newline at end of file diff --git a/test/symforce_function_codegen_test_data/symengine/symforce_caspar_tridiagonal_test/kernel_chain_a_link_res_jac.h b/test/symforce_function_codegen_test_data/symengine/symforce_caspar_tridiagonal_test/kernel_chain_a_link_res_jac.h new file mode 100644 index 00000000..28cff54b --- /dev/null +++ b/test/symforce_function_codegen_test_data/symengine/symforce_caspar_tridiagonal_test/kernel_chain_a_link_res_jac.h @@ -0,0 +1,17 @@ +#pragma once + +#include + +#include "shared_indices.h" + +namespace caspar { + +void ChainALinkResJac(double* const a, unsigned int a_num_alloc, double* weight, + unsigned int weight_num_alloc, double* offset, unsigned int offset_num_alloc, + double* out_res, unsigned int out_res_num_alloc, double* out_a_tridig_U, + unsigned int out_a_tridig_U_num_alloc, double* const out_a_njtr, + unsigned int out_a_njtr_num_alloc, double* const out_a_precond_diag, + unsigned int out_a_precond_diag_num_alloc, double* const out_a_precond_tril, + unsigned int out_a_precond_tril_num_alloc, size_t problem_size); + +} // namespace caspar \ No newline at end of file diff --git a/test/symforce_function_codegen_test_data/symengine/symforce_caspar_tridiagonal_test/kernel_chain_a_link_res_jac_first.cu b/test/symforce_function_codegen_test_data/symengine/symforce_caspar_tridiagonal_test/kernel_chain_a_link_res_jac_first.cu new file mode 100644 index 00000000..df421ac3 --- /dev/null +++ b/test/symforce_function_codegen_test_data/symengine/symforce_caspar_tridiagonal_test/kernel_chain_a_link_res_jac_first.cu @@ -0,0 +1,132 @@ +#include +#include + +#include +#include +#include +#include +#include + +#include "kernel_chain_a_link_res_jac_first.h" +#include "memops.cuh" + +namespace cg = cooperative_groups; + +namespace caspar { + +__global__ void __launch_bounds__(1024, 1) ChainALinkResJacFirstKernel( + double* const a, unsigned int a_num_alloc, double* weight, unsigned int weight_num_alloc, + double* offset, unsigned int offset_num_alloc, double* out_res, unsigned int out_res_num_alloc, + double* const out_rTr, double* out_a_tridig_U, unsigned int out_a_tridig_U_num_alloc, + double* const out_a_njtr, unsigned int out_a_njtr_num_alloc, double* const out_a_precond_diag, + unsigned int out_a_precond_diag_num_alloc, double* const out_a_precond_tril, + unsigned int out_a_precond_tril_num_alloc, size_t problem_size) { + const int global_thread_idx = blockIdx.x * blockDim.x + threadIdx.x; + // Scratch data, then the shared indices of each shared accessor; dynamic, so + // that it may exceed the 48 KB static shared memory limit (see the launch + // below). + extern __shared__ __align__(16) uint8_t inout_shared[]; + + __shared__ double out_rTr_local[1]; + + double r0 = 0, r1 = 0, r2 = 0, r3 = 0, r4 = 0, r5 = 0, r6 = 0, r7 = 0, r8 = 0, r9 = 0, r10 = 0, + r11 = 0, r12 = 0, r13 = 0, r14 = 0; + + if (global_thread_idx < problem_size) { + ReadIdx2<1024, double, double, double2>(offset, 0 * offset_num_alloc, global_thread_idx, r0, + r1); + r2 = -1.00000000000000000e+00; + ReadIdx2<1024, double, double, double2>(weight, 0 * weight_num_alloc, global_thread_idx, r3, + r4); + }; + ReadAndShuffle2<1024, double, double, double2>((double*)inout_shared, a, 0 * a_num_alloc, + global_thread_idx, threadIdx.x == 1023, + global_thread_idx <= problem_size, r5, r6, r7, r8); + if (global_thread_idx < problem_size) { + r5 = fma(r5, r2, r7); + r0 = fma(r3, r5, r0 * r2); + ReadIdx2<1024, double, double, double2>(weight, 2 * weight_num_alloc, global_thread_idx, r7, + r9); + r6 = fma(r6, r2, r8); + r0 = fma(r7, r6, r0); + r5 = fma(r4, r5, r1 * r2); + r5 = fma(r9, r6, r5); + WriteIdx2<1024, double, double, double2>(out_res, 0 * out_res_num_alloc, global_thread_idx, r0, + r5); + r6 = fma(r0, r0, r5 * r5); + }; + SumStore(out_rTr_local, (double*)inout_shared, 0, global_thread_idx < problem_size, r6); + if (global_thread_idx < problem_size) { + r6 = r4 * r2; + r1 = r3 * r3; + r8 = fma(r2, r1, r4 * r6); + r10 = r3 * r7; + r10 = fma(r9, r6, r2 * r10); + WriteIdx2<1024, double, double, double2>(out_a_tridig_U, 0 * out_a_tridig_U_num_alloc, + global_thread_idx, r8, r10); + r8 = r9 * r9; + r11 = r7 * r7; + r12 = fma(r2, r11, r2 * r8); + WriteIdx2<1024, double, double, double2>(out_a_tridig_U, 2 * out_a_tridig_U_num_alloc, + global_thread_idx, r10, r12); + r12 = fma(r3, r0, r4 * r5); + r10 = fma(r7, r0, r9 * r5); + r13 = r9 * r2; + r14 = r7 * r2; + r14 = fma(r0, r14, r5 * r13); + r13 = r3 * r2; + r6 = fma(r5, r6, r0 * r13); + }; + ShuffleAndWrite2((double*)inout_shared, out_a_njtr, + 0 * out_a_njtr_num_alloc, global_thread_idx, + problem_size, r12, r10, r6, r14); + if (global_thread_idx < problem_size) { + r1 = fma(r4, r4, r1); + r11 = r8 + r11; + }; + ShuffleAndWrite2( + (double*)inout_shared, out_a_precond_diag, 0 * out_a_precond_diag_num_alloc, + global_thread_idx, problem_size, r1, r11, r1, r11); + if (global_thread_idx < problem_size) { + r4 = fma(r4, r9, r3 * r7); + }; + ShuffleAndWrite1((double*)inout_shared, out_a_precond_tril, + 0 * out_a_precond_tril_num_alloc, + global_thread_idx, problem_size, r4, r4); + SumFlushFinal(out_rTr_local, out_rTr, 1); +} + +void ChainALinkResJacFirst( + double* const a, unsigned int a_num_alloc, double* weight, unsigned int weight_num_alloc, + double* offset, unsigned int offset_num_alloc, double* out_res, unsigned int out_res_num_alloc, + double* const out_rTr, double* out_a_tridig_U, unsigned int out_a_tridig_U_num_alloc, + double* const out_a_njtr, unsigned int out_a_njtr_num_alloc, double* const out_a_precond_diag, + unsigned int out_a_precond_diag_num_alloc, double* const out_a_precond_tril, + unsigned int out_a_precond_tril_num_alloc, size_t problem_size) { + if (problem_size == 0) { + return; + } + + const int n_blocks = (problem_size + 1024 - 1) / 1024; + // Kernels using more than 48 KB of shared memory per block must opt in. + static const cudaError_t attribute_error = cudaFuncSetAttribute( + ChainALinkResJacFirstKernel, cudaFuncAttributeMaxDynamicSharedMemorySize, 16400); + if (attribute_error != cudaSuccess) { + throw std::runtime_error(std::string("ChainALinkResJacFirstKernel: ") + + cudaGetErrorString(attribute_error)); + } + ChainALinkResJacFirstKernel<<>>( + a, a_num_alloc, weight, weight_num_alloc, offset, offset_num_alloc, out_res, + out_res_num_alloc, out_rTr, out_a_tridig_U, out_a_tridig_U_num_alloc, out_a_njtr, + out_a_njtr_num_alloc, out_a_precond_diag, out_a_precond_diag_num_alloc, out_a_precond_tril, + out_a_precond_tril_num_alloc, problem_size); + // A launch that fails (e.g. from exceeding shared memory or register limits) + // otherwise leaves its outputs untouched without any error. + const cudaError_t launch_error = cudaGetLastError(); + if (launch_error != cudaSuccess) { + throw std::runtime_error(std::string("ChainALinkResJacFirstKernel launch failed: ") + + cudaGetErrorString(launch_error)); + } +} + +} // namespace caspar \ No newline at end of file diff --git a/test/symforce_function_codegen_test_data/symengine/symforce_caspar_tridiagonal_test/kernel_chain_a_link_res_jac_first.h b/test/symforce_function_codegen_test_data/symengine/symforce_caspar_tridiagonal_test/kernel_chain_a_link_res_jac_first.h new file mode 100644 index 00000000..b757536c --- /dev/null +++ b/test/symforce_function_codegen_test_data/symengine/symforce_caspar_tridiagonal_test/kernel_chain_a_link_res_jac_first.h @@ -0,0 +1,17 @@ +#pragma once + +#include + +#include "shared_indices.h" + +namespace caspar { + +void ChainALinkResJacFirst( + double* const a, unsigned int a_num_alloc, double* weight, unsigned int weight_num_alloc, + double* offset, unsigned int offset_num_alloc, double* out_res, unsigned int out_res_num_alloc, + double* const out_rTr, double* out_a_tridig_U, unsigned int out_a_tridig_U_num_alloc, + double* const out_a_njtr, unsigned int out_a_njtr_num_alloc, double* const out_a_precond_diag, + unsigned int out_a_precond_diag_num_alloc, double* const out_a_precond_tril, + unsigned int out_a_precond_tril_num_alloc, size_t problem_size); + +} // namespace caspar \ No newline at end of file diff --git a/test/symforce_function_codegen_test_data/symengine/symforce_caspar_tridiagonal_test/kernel_chain_a_link_score.cu b/test/symforce_function_codegen_test_data/symengine/symforce_caspar_tridiagonal_test/kernel_chain_a_link_score.cu new file mode 100644 index 00000000..50df9650 --- /dev/null +++ b/test/symforce_function_codegen_test_data/symengine/symforce_caspar_tridiagonal_test/kernel_chain_a_link_score.cu @@ -0,0 +1,83 @@ +#include +#include + +#include +#include +#include +#include +#include + +#include "kernel_chain_a_link_score.h" +#include "memops.cuh" + +namespace cg = cooperative_groups; + +namespace caspar { + +__global__ void __launch_bounds__(1024, 1) + ChainALinkScoreKernel(double* const a, unsigned int a_num_alloc, double* weight, + unsigned int weight_num_alloc, double* offset, + unsigned int offset_num_alloc, double* const out_rTr, + size_t problem_size) { + const int global_thread_idx = blockIdx.x * blockDim.x + threadIdx.x; + // Scratch data, then the shared indices of each shared accessor; dynamic, so + // that it may exceed the 48 KB static shared memory limit (see the launch + // below). + extern __shared__ __align__(16) uint8_t inout_shared[]; + + __shared__ double out_rTr_local[1]; + + double r0 = 0, r1 = 0, r2 = 0, r3 = 0, r4 = 0, r5 = 0, r6 = 0, r7 = 0, r8 = 0; + + if (global_thread_idx < problem_size) { + ReadIdx2<1024, double, double, double2>(offset, 0 * offset_num_alloc, global_thread_idx, r0, + r1); + r2 = -1.00000000000000000e+00; + ReadIdx2<1024, double, double, double2>(weight, 0 * weight_num_alloc, global_thread_idx, r3, + r4); + }; + ReadAndShuffle2<1024, double, double, double2>((double*)inout_shared, a, 0 * a_num_alloc, + global_thread_idx, threadIdx.x == 1023, + global_thread_idx <= problem_size, r5, r6, r7, r8); + if (global_thread_idx < problem_size) { + r5 = fma(r5, r2, r7); + r4 = fma(r4, r5, r1 * r2); + ReadIdx2<1024, double, double, double2>(weight, 2 * weight_num_alloc, global_thread_idx, r1, + r7); + r6 = fma(r6, r2, r8); + r4 = fma(r7, r6, r4); + r5 = fma(r3, r5, r0 * r2); + r5 = fma(r1, r6, r5); + r5 = fma(r5, r5, r4 * r4); + }; + SumStore(out_rTr_local, (double*)inout_shared, 0, global_thread_idx < problem_size, r5); + SumFlushFinal(out_rTr_local, out_rTr, 1); +} + +void ChainALinkScore(double* const a, unsigned int a_num_alloc, double* weight, + unsigned int weight_num_alloc, double* offset, unsigned int offset_num_alloc, + double* const out_rTr, size_t problem_size) { + if (problem_size == 0) { + return; + } + + const int n_blocks = (problem_size + 1024 - 1) / 1024; + // Kernels using more than 48 KB of shared memory per block must opt in. + static const cudaError_t attribute_error = cudaFuncSetAttribute( + ChainALinkScoreKernel, cudaFuncAttributeMaxDynamicSharedMemorySize, 16384); + if (attribute_error != cudaSuccess) { + throw std::runtime_error(std::string("ChainALinkScoreKernel: ") + + cudaGetErrorString(attribute_error)); + } + ChainALinkScoreKernel<<>>(a, a_num_alloc, weight, weight_num_alloc, offset, + offset_num_alloc, out_rTr, problem_size); + // A launch that fails (e.g. from exceeding shared memory or register limits) + // otherwise leaves its outputs untouched without any error. + const cudaError_t launch_error = cudaGetLastError(); + if (launch_error != cudaSuccess) { + throw std::runtime_error(std::string("ChainALinkScoreKernel launch failed: ") + + cudaGetErrorString(launch_error)); + } +} + +} // namespace caspar \ No newline at end of file diff --git a/test/symforce_function_codegen_test_data/symengine/symforce_caspar_tridiagonal_test/kernel_chain_a_link_score.h b/test/symforce_function_codegen_test_data/symengine/symforce_caspar_tridiagonal_test/kernel_chain_a_link_score.h new file mode 100644 index 00000000..633032eb --- /dev/null +++ b/test/symforce_function_codegen_test_data/symengine/symforce_caspar_tridiagonal_test/kernel_chain_a_link_score.h @@ -0,0 +1,13 @@ +#pragma once + +#include + +#include "shared_indices.h" + +namespace caspar { + +void ChainALinkScore(double* const a, unsigned int a_num_alloc, double* weight, + unsigned int weight_num_alloc, double* offset, unsigned int offset_num_alloc, + double* const out_rTr, size_t problem_size); + +} // namespace caspar \ No newline at end of file diff --git a/test/symforce_function_codegen_test_data/symengine/symforce_caspar_tridiagonal_test/kernel_chain_a_prior_jtjnjtr_direct.cu b/test/symforce_function_codegen_test_data/symengine/symforce_caspar_tridiagonal_test/kernel_chain_a_prior_jtjnjtr_direct.cu new file mode 100644 index 00000000..4f00ae2b --- /dev/null +++ b/test/symforce_function_codegen_test_data/symengine/symforce_caspar_tridiagonal_test/kernel_chain_a_prior_jtjnjtr_direct.cu @@ -0,0 +1,51 @@ +#include +#include + +#include +#include +#include +#include +#include + +#include "kernel_chain_a_prior_jtjnjtr_direct.h" +#include "memops.cuh" + +namespace cg = cooperative_groups; + +namespace caspar { + +__global__ void __launch_bounds__(1024, 1) + ChainAPriorJtjnjtrDirectKernel(double* a_njtr, unsigned int a_njtr_num_alloc, + SharedIndex* a_njtr_indices, double* a_jac, + unsigned int a_jac_num_alloc, double* const out_a_njtr, + unsigned int out_a_njtr_num_alloc, size_t problem_size) {} + +void ChainAPriorJtjnjtrDirect(double* a_njtr, unsigned int a_njtr_num_alloc, + SharedIndex* a_njtr_indices, double* a_jac, + unsigned int a_jac_num_alloc, double* const out_a_njtr, + unsigned int out_a_njtr_num_alloc, size_t problem_size) { + if (problem_size == 0) { + return; + } + + const int n_blocks = (problem_size + 1024 - 1) / 1024; + // Kernels using more than 48 KB of shared memory per block must opt in. + static const cudaError_t attribute_error = cudaFuncSetAttribute( + ChainAPriorJtjnjtrDirectKernel, cudaFuncAttributeMaxDynamicSharedMemorySize, 24576); + if (attribute_error != cudaSuccess) { + throw std::runtime_error(std::string("ChainAPriorJtjnjtrDirectKernel: ") + + cudaGetErrorString(attribute_error)); + } + ChainAPriorJtjnjtrDirectKernel<<>>( + a_njtr, a_njtr_num_alloc, a_njtr_indices, a_jac, a_jac_num_alloc, out_a_njtr, + out_a_njtr_num_alloc, problem_size); + // A launch that fails (e.g. from exceeding shared memory or register limits) + // otherwise leaves its outputs untouched without any error. + const cudaError_t launch_error = cudaGetLastError(); + if (launch_error != cudaSuccess) { + throw std::runtime_error(std::string("ChainAPriorJtjnjtrDirectKernel launch failed: ") + + cudaGetErrorString(launch_error)); + } +} + +} // namespace caspar \ No newline at end of file diff --git a/test/symforce_function_codegen_test_data/symengine/symforce_caspar_tridiagonal_test/kernel_chain_a_prior_jtjnjtr_direct.h b/test/symforce_function_codegen_test_data/symengine/symforce_caspar_tridiagonal_test/kernel_chain_a_prior_jtjnjtr_direct.h new file mode 100644 index 00000000..1f456876 --- /dev/null +++ b/test/symforce_function_codegen_test_data/symengine/symforce_caspar_tridiagonal_test/kernel_chain_a_prior_jtjnjtr_direct.h @@ -0,0 +1,14 @@ +#pragma once + +#include + +#include "shared_indices.h" + +namespace caspar { + +void ChainAPriorJtjnjtrDirect(double* a_njtr, unsigned int a_njtr_num_alloc, + SharedIndex* a_njtr_indices, double* a_jac, + unsigned int a_jac_num_alloc, double* const out_a_njtr, + unsigned int out_a_njtr_num_alloc, size_t problem_size); + +} // namespace caspar \ No newline at end of file diff --git a/test/symforce_function_codegen_test_data/symengine/symforce_caspar_tridiagonal_test/kernel_chain_a_prior_res_jac.cu b/test/symforce_function_codegen_test_data/symengine/symforce_caspar_tridiagonal_test/kernel_chain_a_prior_res_jac.cu new file mode 100644 index 00000000..7da8cd8d --- /dev/null +++ b/test/symforce_function_codegen_test_data/symengine/symforce_caspar_tridiagonal_test/kernel_chain_a_prior_res_jac.cu @@ -0,0 +1,97 @@ +#include +#include + +#include +#include +#include +#include +#include + +#include "kernel_chain_a_prior_res_jac.h" +#include "memops.cuh" + +namespace cg = cooperative_groups; + +namespace caspar { + +__global__ void __launch_bounds__(1024, 1) + ChainAPriorResJacKernel(double* a, unsigned int a_num_alloc, SharedIndex* a_indices, + double* target, unsigned int target_num_alloc, double* out_res, + unsigned int out_res_num_alloc, double* const out_a_njtr, + unsigned int out_a_njtr_num_alloc, double* const out_a_precond_diag, + unsigned int out_a_precond_diag_num_alloc, + double* const out_a_precond_tril, + unsigned int out_a_precond_tril_num_alloc, size_t problem_size) { + const int global_thread_idx = blockIdx.x * blockDim.x + threadIdx.x; + // Scratch data, then the shared indices of each shared accessor; dynamic, so + // that it may exceed the 48 KB static shared memory limit (see the launch + // below). + extern __shared__ __align__(16) uint8_t inout_shared[]; + constexpr unsigned int a_indices_shared_offset = 16384; + + SharedIndex* const a_indices_loc = + reinterpret_cast(inout_shared + a_indices_shared_offset); + a_indices_loc[threadIdx.x] = + (global_thread_idx < problem_size ? a_indices[global_thread_idx] + : SharedIndex{0xffffffff, 0xffff, 0xffff}); + + double r0 = 0, r1 = 0, r2 = 0, r3 = 0, r4 = 0; + LoadShared<2, double, double>(a, 0 * a_num_alloc, a_indices_loc, (double*)inout_shared); + if (global_thread_idx < problem_size) { + ReadShared2((double*)inout_shared, a_indices_loc[threadIdx.x].target, r0, r1); + }; + __syncthreads(); + if (global_thread_idx < problem_size) { + ReadIdx2<1024, double, double, double2>(target, 0 * target_num_alloc, global_thread_idx, r2, + r3); + r4 = -1.00000000000000000e+00; + r2 = fma(r2, r4, r0); + r3 = fma(r3, r4, r1); + WriteIdx2<1024, double, double, double2>(out_res, 0 * out_res_num_alloc, global_thread_idx, r2, + r3); + r2 = r4 * r2; + r3 = r4 * r3; + WriteSum2((double*)inout_shared, r2, r3); + }; + FlushSumShared<2, double>(out_a_njtr, 0 * out_a_njtr_num_alloc, a_indices_loc, + (double*)inout_shared); + if (global_thread_idx < problem_size) { + r3 = 1.00000000000000000e+00; + WriteSum2((double*)inout_shared, r3, r3); + }; + FlushSumShared<2, double>(out_a_precond_diag, 0 * out_a_precond_diag_num_alloc, a_indices_loc, + (double*)inout_shared); +} + +void ChainAPriorResJac(double* a, unsigned int a_num_alloc, SharedIndex* a_indices, double* target, + unsigned int target_num_alloc, double* out_res, + unsigned int out_res_num_alloc, double* const out_a_njtr, + unsigned int out_a_njtr_num_alloc, double* const out_a_precond_diag, + unsigned int out_a_precond_diag_num_alloc, double* const out_a_precond_tril, + unsigned int out_a_precond_tril_num_alloc, size_t problem_size) { + if (problem_size == 0) { + return; + } + + const int n_blocks = (problem_size + 1024 - 1) / 1024; + // Kernels using more than 48 KB of shared memory per block must opt in. + static const cudaError_t attribute_error = cudaFuncSetAttribute( + ChainAPriorResJacKernel, cudaFuncAttributeMaxDynamicSharedMemorySize, 24576); + if (attribute_error != cudaSuccess) { + throw std::runtime_error(std::string("ChainAPriorResJacKernel: ") + + cudaGetErrorString(attribute_error)); + } + ChainAPriorResJacKernel<<>>( + a, a_num_alloc, a_indices, target, target_num_alloc, out_res, out_res_num_alloc, out_a_njtr, + out_a_njtr_num_alloc, out_a_precond_diag, out_a_precond_diag_num_alloc, out_a_precond_tril, + out_a_precond_tril_num_alloc, problem_size); + // A launch that fails (e.g. from exceeding shared memory or register limits) + // otherwise leaves its outputs untouched without any error. + const cudaError_t launch_error = cudaGetLastError(); + if (launch_error != cudaSuccess) { + throw std::runtime_error(std::string("ChainAPriorResJacKernel launch failed: ") + + cudaGetErrorString(launch_error)); + } +} + +} // namespace caspar \ No newline at end of file diff --git a/test/symforce_function_codegen_test_data/symengine/symforce_caspar_tridiagonal_test/kernel_chain_a_prior_res_jac.h b/test/symforce_function_codegen_test_data/symengine/symforce_caspar_tridiagonal_test/kernel_chain_a_prior_res_jac.h new file mode 100644 index 00000000..5ca63a90 --- /dev/null +++ b/test/symforce_function_codegen_test_data/symengine/symforce_caspar_tridiagonal_test/kernel_chain_a_prior_res_jac.h @@ -0,0 +1,16 @@ +#pragma once + +#include + +#include "shared_indices.h" + +namespace caspar { + +void ChainAPriorResJac(double* a, unsigned int a_num_alloc, SharedIndex* a_indices, double* target, + unsigned int target_num_alloc, double* out_res, + unsigned int out_res_num_alloc, double* const out_a_njtr, + unsigned int out_a_njtr_num_alloc, double* const out_a_precond_diag, + unsigned int out_a_precond_diag_num_alloc, double* const out_a_precond_tril, + unsigned int out_a_precond_tril_num_alloc, size_t problem_size); + +} // namespace caspar \ No newline at end of file diff --git a/test/symforce_function_codegen_test_data/symengine/symforce_caspar_tridiagonal_test/kernel_chain_a_prior_res_jac_first.cu b/test/symforce_function_codegen_test_data/symengine/symforce_caspar_tridiagonal_test/kernel_chain_a_prior_res_jac_first.cu new file mode 100644 index 00000000..ddbab613 --- /dev/null +++ b/test/symforce_function_codegen_test_data/symengine/symforce_caspar_tridiagonal_test/kernel_chain_a_prior_res_jac_first.cu @@ -0,0 +1,107 @@ +#include +#include + +#include +#include +#include +#include +#include + +#include "kernel_chain_a_prior_res_jac_first.h" +#include "memops.cuh" + +namespace cg = cooperative_groups; + +namespace caspar { + +__global__ void __launch_bounds__(1024, 1) + ChainAPriorResJacFirstKernel(double* a, unsigned int a_num_alloc, SharedIndex* a_indices, + double* target, unsigned int target_num_alloc, double* out_res, + unsigned int out_res_num_alloc, double* const out_rTr, + double* const out_a_njtr, unsigned int out_a_njtr_num_alloc, + double* const out_a_precond_diag, + unsigned int out_a_precond_diag_num_alloc, + double* const out_a_precond_tril, + unsigned int out_a_precond_tril_num_alloc, size_t problem_size) { + const int global_thread_idx = blockIdx.x * blockDim.x + threadIdx.x; + // Scratch data, then the shared indices of each shared accessor; dynamic, so + // that it may exceed the 48 KB static shared memory limit (see the launch + // below). + extern __shared__ __align__(16) uint8_t inout_shared[]; + constexpr unsigned int a_indices_shared_offset = 16384; + + SharedIndex* const a_indices_loc = + reinterpret_cast(inout_shared + a_indices_shared_offset); + a_indices_loc[threadIdx.x] = + (global_thread_idx < problem_size ? a_indices[global_thread_idx] + : SharedIndex{0xffffffff, 0xffff, 0xffff}); + + __shared__ double out_rTr_local[1]; + + double r0 = 0, r1 = 0, r2 = 0, r3 = 0, r4 = 0; + LoadShared<2, double, double>(a, 0 * a_num_alloc, a_indices_loc, (double*)inout_shared); + if (global_thread_idx < problem_size) { + ReadShared2((double*)inout_shared, a_indices_loc[threadIdx.x].target, r0, r1); + }; + __syncthreads(); + if (global_thread_idx < problem_size) { + ReadIdx2<1024, double, double, double2>(target, 0 * target_num_alloc, global_thread_idx, r2, + r3); + r4 = -1.00000000000000000e+00; + r2 = fma(r2, r4, r0); + r3 = fma(r3, r4, r1); + WriteIdx2<1024, double, double, double2>(out_res, 0 * out_res_num_alloc, global_thread_idx, r2, + r3); + r1 = fma(r3, r3, r2 * r2); + }; + SumStore(out_rTr_local, (double*)inout_shared, 0, global_thread_idx < problem_size, r1); + if (global_thread_idx < problem_size) { + r2 = r4 * r2; + r3 = r4 * r3; + WriteSum2((double*)inout_shared, r2, r3); + }; + FlushSumShared<2, double>(out_a_njtr, 0 * out_a_njtr_num_alloc, a_indices_loc, + (double*)inout_shared); + if (global_thread_idx < problem_size) { + r3 = 1.00000000000000000e+00; + WriteSum2((double*)inout_shared, r3, r3); + }; + FlushSumShared<2, double>(out_a_precond_diag, 0 * out_a_precond_diag_num_alloc, a_indices_loc, + (double*)inout_shared); + SumFlushFinal(out_rTr_local, out_rTr, 1); +} + +void ChainAPriorResJacFirst(double* a, unsigned int a_num_alloc, SharedIndex* a_indices, + double* target, unsigned int target_num_alloc, double* out_res, + unsigned int out_res_num_alloc, double* const out_rTr, + double* const out_a_njtr, unsigned int out_a_njtr_num_alloc, + double* const out_a_precond_diag, + unsigned int out_a_precond_diag_num_alloc, + double* const out_a_precond_tril, + unsigned int out_a_precond_tril_num_alloc, size_t problem_size) { + if (problem_size == 0) { + return; + } + + const int n_blocks = (problem_size + 1024 - 1) / 1024; + // Kernels using more than 48 KB of shared memory per block must opt in. + static const cudaError_t attribute_error = cudaFuncSetAttribute( + ChainAPriorResJacFirstKernel, cudaFuncAttributeMaxDynamicSharedMemorySize, 24576); + if (attribute_error != cudaSuccess) { + throw std::runtime_error(std::string("ChainAPriorResJacFirstKernel: ") + + cudaGetErrorString(attribute_error)); + } + ChainAPriorResJacFirstKernel<<>>( + a, a_num_alloc, a_indices, target, target_num_alloc, out_res, out_res_num_alloc, out_rTr, + out_a_njtr, out_a_njtr_num_alloc, out_a_precond_diag, out_a_precond_diag_num_alloc, + out_a_precond_tril, out_a_precond_tril_num_alloc, problem_size); + // A launch that fails (e.g. from exceeding shared memory or register limits) + // otherwise leaves its outputs untouched without any error. + const cudaError_t launch_error = cudaGetLastError(); + if (launch_error != cudaSuccess) { + throw std::runtime_error(std::string("ChainAPriorResJacFirstKernel launch failed: ") + + cudaGetErrorString(launch_error)); + } +} + +} // namespace caspar \ No newline at end of file diff --git a/test/symforce_function_codegen_test_data/symengine/symforce_caspar_tridiagonal_test/kernel_chain_a_prior_res_jac_first.h b/test/symforce_function_codegen_test_data/symengine/symforce_caspar_tridiagonal_test/kernel_chain_a_prior_res_jac_first.h new file mode 100644 index 00000000..3cdceb88 --- /dev/null +++ b/test/symforce_function_codegen_test_data/symengine/symforce_caspar_tridiagonal_test/kernel_chain_a_prior_res_jac_first.h @@ -0,0 +1,18 @@ +#pragma once + +#include + +#include "shared_indices.h" + +namespace caspar { + +void ChainAPriorResJacFirst(double* a, unsigned int a_num_alloc, SharedIndex* a_indices, + double* target, unsigned int target_num_alloc, double* out_res, + unsigned int out_res_num_alloc, double* const out_rTr, + double* const out_a_njtr, unsigned int out_a_njtr_num_alloc, + double* const out_a_precond_diag, + unsigned int out_a_precond_diag_num_alloc, + double* const out_a_precond_tril, + unsigned int out_a_precond_tril_num_alloc, size_t problem_size); + +} // namespace caspar \ No newline at end of file diff --git a/test/symforce_function_codegen_test_data/symengine/symforce_caspar_tridiagonal_test/kernel_chain_a_prior_score.cu b/test/symforce_function_codegen_test_data/symengine/symforce_caspar_tridiagonal_test/kernel_chain_a_prior_score.cu new file mode 100644 index 00000000..6335d83c --- /dev/null +++ b/test/symforce_function_codegen_test_data/symengine/symforce_caspar_tridiagonal_test/kernel_chain_a_prior_score.cu @@ -0,0 +1,79 @@ +#include +#include + +#include +#include +#include +#include +#include + +#include "kernel_chain_a_prior_score.h" +#include "memops.cuh" + +namespace cg = cooperative_groups; + +namespace caspar { + +__global__ void __launch_bounds__(1024, 1) + ChainAPriorScoreKernel(double* a, unsigned int a_num_alloc, SharedIndex* a_indices, + double* target, unsigned int target_num_alloc, double* const out_rTr, + size_t problem_size) { + const int global_thread_idx = blockIdx.x * blockDim.x + threadIdx.x; + // Scratch data, then the shared indices of each shared accessor; dynamic, so + // that it may exceed the 48 KB static shared memory limit (see the launch + // below). + extern __shared__ __align__(16) uint8_t inout_shared[]; + constexpr unsigned int a_indices_shared_offset = 16384; + + SharedIndex* const a_indices_loc = + reinterpret_cast(inout_shared + a_indices_shared_offset); + a_indices_loc[threadIdx.x] = + (global_thread_idx < problem_size ? a_indices[global_thread_idx] + : SharedIndex{0xffffffff, 0xffff, 0xffff}); + + __shared__ double out_rTr_local[1]; + + double r0 = 0, r1 = 0, r2 = 0, r3 = 0, r4 = 0; + LoadShared<2, double, double>(a, 0 * a_num_alloc, a_indices_loc, (double*)inout_shared); + if (global_thread_idx < problem_size) { + ReadShared2((double*)inout_shared, a_indices_loc[threadIdx.x].target, r0, r1); + }; + __syncthreads(); + if (global_thread_idx < problem_size) { + ReadIdx2<1024, double, double, double2>(target, 0 * target_num_alloc, global_thread_idx, r2, + r3); + r4 = -1.00000000000000000e+00; + r2 = fma(r2, r4, r0); + r4 = fma(r3, r4, r1); + r4 = fma(r4, r4, r2 * r2); + }; + SumStore(out_rTr_local, (double*)inout_shared, 0, global_thread_idx < problem_size, r4); + SumFlushFinal(out_rTr_local, out_rTr, 1); +} + +void ChainAPriorScore(double* a, unsigned int a_num_alloc, SharedIndex* a_indices, double* target, + unsigned int target_num_alloc, double* const out_rTr, size_t problem_size) { + if (problem_size == 0) { + return; + } + + const int n_blocks = (problem_size + 1024 - 1) / 1024; + // Kernels using more than 48 KB of shared memory per block must opt in. + static const cudaError_t attribute_error = cudaFuncSetAttribute( + ChainAPriorScoreKernel, cudaFuncAttributeMaxDynamicSharedMemorySize, 24576); + if (attribute_error != cudaSuccess) { + throw std::runtime_error(std::string("ChainAPriorScoreKernel: ") + + cudaGetErrorString(attribute_error)); + } + ChainAPriorScoreKernel<<>>(a, a_num_alloc, a_indices, target, + target_num_alloc, out_rTr, problem_size); + // A launch that fails (e.g. from exceeding shared memory or register limits) + // otherwise leaves its outputs untouched without any error. + const cudaError_t launch_error = cudaGetLastError(); + if (launch_error != cudaSuccess) { + throw std::runtime_error(std::string("ChainAPriorScoreKernel launch failed: ") + + cudaGetErrorString(launch_error)); + } +} + +} // namespace caspar \ No newline at end of file diff --git a/test/symforce_function_codegen_test_data/symengine/symforce_caspar_tridiagonal_test/kernel_chain_a_prior_score.h b/test/symforce_function_codegen_test_data/symengine/symforce_caspar_tridiagonal_test/kernel_chain_a_prior_score.h new file mode 100644 index 00000000..f380ace1 --- /dev/null +++ b/test/symforce_function_codegen_test_data/symengine/symforce_caspar_tridiagonal_test/kernel_chain_a_prior_score.h @@ -0,0 +1,12 @@ +#pragma once + +#include + +#include "shared_indices.h" + +namespace caspar { + +void ChainAPriorScore(double* a, unsigned int a_num_alloc, SharedIndex* a_indices, double* target, + unsigned int target_num_alloc, double* const out_rTr, size_t problem_size); + +} // namespace caspar \ No newline at end of file diff --git a/test/symforce_function_codegen_test_data/symengine/symforce_caspar_tridiagonal_test/kernel_chain_b_link_jtjnjtr_direct.cu b/test/symforce_function_codegen_test_data/symengine/symforce_caspar_tridiagonal_test/kernel_chain_b_link_jtjnjtr_direct.cu new file mode 100644 index 00000000..3b336af2 --- /dev/null +++ b/test/symforce_function_codegen_test_data/symengine/symforce_caspar_tridiagonal_test/kernel_chain_b_link_jtjnjtr_direct.cu @@ -0,0 +1,53 @@ +#include +#include + +#include +#include +#include +#include +#include + +#include "kernel_chain_b_link_jtjnjtr_direct.h" +#include "memops.cuh" + +namespace cg = cooperative_groups; + +namespace caspar { + +__global__ void __launch_bounds__(1024, 1) + ChainBLinkJtjnjtrDirectKernel(double* const b_njtr, unsigned int b_njtr_num_alloc, + double* b_jac_first, unsigned int b_jac_first_num_alloc, + double* b_jac_second, unsigned int b_jac_second_num_alloc, + double* const out_b_njtr, unsigned int out_b_njtr_num_alloc, + size_t problem_size) {} + +void ChainBLinkJtjnjtrDirect(double* const b_njtr, unsigned int b_njtr_num_alloc, + double* b_jac_first, unsigned int b_jac_first_num_alloc, + double* b_jac_second, unsigned int b_jac_second_num_alloc, + double* const out_b_njtr, unsigned int out_b_njtr_num_alloc, + size_t problem_size) { + if (problem_size == 0) { + return; + } + + const int n_blocks = (problem_size + 1024 - 1) / 1024; + // Kernels using more than 48 KB of shared memory per block must opt in. + static const cudaError_t attribute_error = cudaFuncSetAttribute( + ChainBLinkJtjnjtrDirectKernel, cudaFuncAttributeMaxDynamicSharedMemorySize, 16400); + if (attribute_error != cudaSuccess) { + throw std::runtime_error(std::string("ChainBLinkJtjnjtrDirectKernel: ") + + cudaGetErrorString(attribute_error)); + } + ChainBLinkJtjnjtrDirectKernel<<>>( + b_njtr, b_njtr_num_alloc, b_jac_first, b_jac_first_num_alloc, b_jac_second, + b_jac_second_num_alloc, out_b_njtr, out_b_njtr_num_alloc, problem_size); + // A launch that fails (e.g. from exceeding shared memory or register limits) + // otherwise leaves its outputs untouched without any error. + const cudaError_t launch_error = cudaGetLastError(); + if (launch_error != cudaSuccess) { + throw std::runtime_error(std::string("ChainBLinkJtjnjtrDirectKernel launch failed: ") + + cudaGetErrorString(launch_error)); + } +} + +} // namespace caspar \ No newline at end of file diff --git a/test/symforce_function_codegen_test_data/symengine/symforce_caspar_tridiagonal_test/kernel_chain_b_link_jtjnjtr_direct.h b/test/symforce_function_codegen_test_data/symengine/symforce_caspar_tridiagonal_test/kernel_chain_b_link_jtjnjtr_direct.h new file mode 100644 index 00000000..de1461c2 --- /dev/null +++ b/test/symforce_function_codegen_test_data/symengine/symforce_caspar_tridiagonal_test/kernel_chain_b_link_jtjnjtr_direct.h @@ -0,0 +1,15 @@ +#pragma once + +#include + +#include "shared_indices.h" + +namespace caspar { + +void ChainBLinkJtjnjtrDirect(double* const b_njtr, unsigned int b_njtr_num_alloc, + double* b_jac_first, unsigned int b_jac_first_num_alloc, + double* b_jac_second, unsigned int b_jac_second_num_alloc, + double* const out_b_njtr, unsigned int out_b_njtr_num_alloc, + size_t problem_size); + +} // namespace caspar \ No newline at end of file diff --git a/test/symforce_function_codegen_test_data/symengine/symforce_caspar_tridiagonal_test/kernel_chain_b_link_res_jac.cu b/test/symforce_function_codegen_test_data/symengine/symforce_caspar_tridiagonal_test/kernel_chain_b_link_res_jac.cu new file mode 100644 index 00000000..4642b781 --- /dev/null +++ b/test/symforce_function_codegen_test_data/symengine/symforce_caspar_tridiagonal_test/kernel_chain_b_link_res_jac.cu @@ -0,0 +1,207 @@ +#include +#include + +#include +#include +#include +#include +#include + +#include "kernel_chain_b_link_res_jac.h" +#include "memops.cuh" + +namespace cg = cooperative_groups; + +namespace caspar { + +__global__ void __launch_bounds__(1024, 1) ChainBLinkResJacKernel( + double* const b, unsigned int b_num_alloc, double* weight, unsigned int weight_num_alloc, + double* offset, unsigned int offset_num_alloc, double* out_res, unsigned int out_res_num_alloc, + double* out_b_tridig_U, unsigned int out_b_tridig_U_num_alloc, double* const out_b_njtr, + unsigned int out_b_njtr_num_alloc, double* const out_b_precond_diag, + unsigned int out_b_precond_diag_num_alloc, double* const out_b_precond_tril, + unsigned int out_b_precond_tril_num_alloc, size_t problem_size) { + const int global_thread_idx = blockIdx.x * blockDim.x + threadIdx.x; + // Scratch data, then the shared indices of each shared accessor; dynamic, so + // that it may exceed the 48 KB static shared memory limit (see the launch + // below). + extern __shared__ __align__(16) uint8_t inout_shared[]; + + double r0 = 0, r1 = 0, r2 = 0, r3 = 0, r4 = 0, r5 = 0, r6 = 0, r7 = 0, r8 = 0, r9 = 0, r10 = 0, + r11 = 0, r12 = 0, r13 = 0, r14 = 0, r15 = 0, r16 = 0, r17 = 0, r18 = 0, r19 = 0, r20 = 0, + r21 = 0, r22 = 0, r23 = 0, r24 = 0, r25 = 0, r26 = 0; + + if (global_thread_idx < problem_size) { + ReadIdx2<1024, double, double, double2>(offset, 0 * offset_num_alloc, global_thread_idx, r0, + r1); + r2 = -1.00000000000000000e+00; + ReadIdx2<1024, double, double, double2>(weight, 6 * weight_num_alloc, global_thread_idx, r3, + r4); + }; + ReadAndShuffle1<1024, double, double, double>((double*)inout_shared, b, 2 * b_num_alloc, + global_thread_idx, threadIdx.x == 1023, + global_thread_idx <= problem_size, r5, r6); + if (global_thread_idx < problem_size) { + r5 = fma(r5, r2, r6); + r0 = fma(r3, r5, r0 * r2); + ReadIdx2<1024, double, double, double2>(weight, 0 * weight_num_alloc, global_thread_idx, r6, + r7); + }; + ReadAndShuffle2<1024, double, double, double2>( + (double*)inout_shared, b, 0 * b_num_alloc, global_thread_idx, threadIdx.x == 1023, + global_thread_idx <= problem_size, r8, r9, r10, r11); + if (global_thread_idx < problem_size) { + r8 = fma(r8, r2, r10); + ReadIdx2<1024, double, double, double2>(weight, 2 * weight_num_alloc, global_thread_idx, r10, + r12); + r9 = fma(r9, r2, r11); + r0 = fma(r6, r8, r0); + r0 = fma(r12, r9, r0); + r1 = fma(r4, r5, r1 * r2); + ReadIdx2<1024, double, double, double2>(weight, 4 * weight_num_alloc, global_thread_idx, r11, + r13); + r1 = fma(r7, r8, r1); + r1 = fma(r11, r9, r1); + WriteIdx2<1024, double, double, double2>(out_res, 0 * out_res_num_alloc, global_thread_idx, r0, + r1); + ReadIdx1<1024, double, double, double>(offset, 2 * offset_num_alloc, global_thread_idx, r14); + ReadIdx1<1024, double, double, double>(weight, 8 * weight_num_alloc, global_thread_idx, r15); + r5 = fma(r15, r5, r14 * r2); + r5 = fma(r10, r8, r5); + r5 = fma(r13, r9, r5); + WriteIdx1<1024, double, double, double>(out_res, 2 * out_res_num_alloc, global_thread_idx, r5); + r9 = r7 * r2; + r8 = r10 * r10; + r14 = fma(r2, r8, r7 * r9); + r16 = r6 * r6; + r14 = fma(r2, r16, r14); + r17 = r6 * r12; + r18 = r10 * r13; + r18 = fma(r2, r18, r2 * r17); + r18 = fma(r11, r9, r18); + WriteIdx2<1024, double, double, double2>(out_b_tridig_U, 0 * out_b_tridig_U_num_alloc, + global_thread_idx, r14, r18); + r14 = r6 * r3; + r17 = r10 * r15; + r17 = fma(r2, r17, r2 * r14); + r17 = fma(r4, r9, r17); + WriteIdx2<1024, double, double, double2>(out_b_tridig_U, 2 * out_b_tridig_U_num_alloc, + global_thread_idx, r17, r18); + r18 = r12 * r3; + r14 = r13 * r15; + r14 = fma(r2, r14, r2 * r18); + r18 = r11 * r4; + r14 = fma(r2, r18, r14); + r18 = r11 * r11; + r19 = r13 * r13; + r20 = fma(r2, r19, r2 * r18); + r21 = r12 * r12; + r20 = fma(r2, r21, r20); + WriteIdx2<1024, double, double, double2>(out_b_tridig_U, 4 * out_b_tridig_U_num_alloc, + global_thread_idx, r20, r14); + WriteIdx2<1024, double, double, double2>(out_b_tridig_U, 6 * out_b_tridig_U_num_alloc, + global_thread_idx, r17, r14); + r14 = r4 * r4; + r17 = r15 * r15; + r20 = fma(r2, r17, r2 * r14); + r22 = r3 * r3; + r20 = fma(r2, r22, r20); + WriteIdx1<1024, double, double, double>(out_b_tridig_U, 8 * out_b_tridig_U_num_alloc, + global_thread_idx, r20); + r20 = fma(r6, r0, r10 * r5); + r20 = fma(r7, r1, r20); + r23 = fma(r12, r0, r13 * r5); + r23 = fma(r11, r1, r23); + r24 = r13 * r2; + r25 = r12 * r2; + r25 = fma(r0, r25, r5 * r24); + r24 = r11 * r2; + r25 = fma(r1, r24, r25); + r24 = r10 * r2; + r26 = r6 * r2; + r26 = fma(r0, r26, r5 * r24); + r26 = fma(r1, r9, r26); + }; + ShuffleAndWrite2((double*)inout_shared, out_b_njtr, + 0 * out_b_njtr_num_alloc, global_thread_idx, + problem_size, r20, r23, r26, r25); + if (global_thread_idx < problem_size) { + r25 = fma(r3, r0, r15 * r5); + r25 = fma(r4, r1, r25); + r26 = r15 * r2; + r23 = r3 * r2; + r23 = fma(r0, r23, r5 * r26); + r26 = r4 * r2; + r23 = fma(r1, r26, r23); + }; + ShuffleAndWrite1((double*)inout_shared, out_b_njtr, + 2 * out_b_njtr_num_alloc, global_thread_idx, + problem_size, r25, r23); + if (global_thread_idx < problem_size) { + r8 = fma(r7, r7, r8); + r8 = r8 + r16; + r19 = r18 + r19; + r19 = r19 + r21; + }; + ShuffleAndWrite2( + (double*)inout_shared, out_b_precond_diag, 0 * out_b_precond_diag_num_alloc, + global_thread_idx, problem_size, r8, r19, r8, r19); + if (global_thread_idx < problem_size) { + r17 = r14 + r17; + r17 = r17 + r22; + }; + ShuffleAndWrite1((double*)inout_shared, out_b_precond_diag, + 2 * out_b_precond_diag_num_alloc, + global_thread_idx, problem_size, r17, r17); + if (global_thread_idx < problem_size) { + r17 = fma(r10, r13, r6 * r12); + r17 = fma(r7, r11, r17); + r22 = fma(r10, r15, r6 * r3); + r22 = fma(r7, r4, r22); + }; + ShuffleAndWrite2( + (double*)inout_shared, out_b_precond_tril, 0 * out_b_precond_tril_num_alloc, + global_thread_idx, problem_size, r17, r22, r17, r22); + if (global_thread_idx < problem_size) { + r22 = fma(r13, r15, r12 * r3); + r22 = fma(r11, r4, r22); + }; + ShuffleAndWrite1((double*)inout_shared, out_b_precond_tril, + 2 * out_b_precond_tril_num_alloc, + global_thread_idx, problem_size, r22, r22); +} + +void ChainBLinkResJac(double* const b, unsigned int b_num_alloc, double* weight, + unsigned int weight_num_alloc, double* offset, unsigned int offset_num_alloc, + double* out_res, unsigned int out_res_num_alloc, double* out_b_tridig_U, + unsigned int out_b_tridig_U_num_alloc, double* const out_b_njtr, + unsigned int out_b_njtr_num_alloc, double* const out_b_precond_diag, + unsigned int out_b_precond_diag_num_alloc, double* const out_b_precond_tril, + unsigned int out_b_precond_tril_num_alloc, size_t problem_size) { + if (problem_size == 0) { + return; + } + + const int n_blocks = (problem_size + 1024 - 1) / 1024; + // Kernels using more than 48 KB of shared memory per block must opt in. + static const cudaError_t attribute_error = cudaFuncSetAttribute( + ChainBLinkResJacKernel, cudaFuncAttributeMaxDynamicSharedMemorySize, 16400); + if (attribute_error != cudaSuccess) { + throw std::runtime_error(std::string("ChainBLinkResJacKernel: ") + + cudaGetErrorString(attribute_error)); + } + ChainBLinkResJacKernel<<>>( + b, b_num_alloc, weight, weight_num_alloc, offset, offset_num_alloc, out_res, + out_res_num_alloc, out_b_tridig_U, out_b_tridig_U_num_alloc, out_b_njtr, out_b_njtr_num_alloc, + out_b_precond_diag, out_b_precond_diag_num_alloc, out_b_precond_tril, + out_b_precond_tril_num_alloc, problem_size); + // A launch that fails (e.g. from exceeding shared memory or register limits) + // otherwise leaves its outputs untouched without any error. + const cudaError_t launch_error = cudaGetLastError(); + if (launch_error != cudaSuccess) { + throw std::runtime_error(std::string("ChainBLinkResJacKernel launch failed: ") + + cudaGetErrorString(launch_error)); + } +} + +} // namespace caspar \ No newline at end of file diff --git a/test/symforce_function_codegen_test_data/symengine/symforce_caspar_tridiagonal_test/kernel_chain_b_link_res_jac.h b/test/symforce_function_codegen_test_data/symengine/symforce_caspar_tridiagonal_test/kernel_chain_b_link_res_jac.h new file mode 100644 index 00000000..d3ca19d4 --- /dev/null +++ b/test/symforce_function_codegen_test_data/symengine/symforce_caspar_tridiagonal_test/kernel_chain_b_link_res_jac.h @@ -0,0 +1,17 @@ +#pragma once + +#include + +#include "shared_indices.h" + +namespace caspar { + +void ChainBLinkResJac(double* const b, unsigned int b_num_alloc, double* weight, + unsigned int weight_num_alloc, double* offset, unsigned int offset_num_alloc, + double* out_res, unsigned int out_res_num_alloc, double* out_b_tridig_U, + unsigned int out_b_tridig_U_num_alloc, double* const out_b_njtr, + unsigned int out_b_njtr_num_alloc, double* const out_b_precond_diag, + unsigned int out_b_precond_diag_num_alloc, double* const out_b_precond_tril, + unsigned int out_b_precond_tril_num_alloc, size_t problem_size); + +} // namespace caspar \ No newline at end of file diff --git a/test/symforce_function_codegen_test_data/symengine/symforce_caspar_tridiagonal_test/kernel_chain_b_link_res_jac_first.cu b/test/symforce_function_codegen_test_data/symengine/symforce_caspar_tridiagonal_test/kernel_chain_b_link_res_jac_first.cu new file mode 100644 index 00000000..22ff48f3 --- /dev/null +++ b/test/symforce_function_codegen_test_data/symengine/symforce_caspar_tridiagonal_test/kernel_chain_b_link_res_jac_first.cu @@ -0,0 +1,215 @@ +#include +#include + +#include +#include +#include +#include +#include + +#include "kernel_chain_b_link_res_jac_first.h" +#include "memops.cuh" + +namespace cg = cooperative_groups; + +namespace caspar { + +__global__ void __launch_bounds__(1024, 1) ChainBLinkResJacFirstKernel( + double* const b, unsigned int b_num_alloc, double* weight, unsigned int weight_num_alloc, + double* offset, unsigned int offset_num_alloc, double* out_res, unsigned int out_res_num_alloc, + double* const out_rTr, double* out_b_tridig_U, unsigned int out_b_tridig_U_num_alloc, + double* const out_b_njtr, unsigned int out_b_njtr_num_alloc, double* const out_b_precond_diag, + unsigned int out_b_precond_diag_num_alloc, double* const out_b_precond_tril, + unsigned int out_b_precond_tril_num_alloc, size_t problem_size) { + const int global_thread_idx = blockIdx.x * blockDim.x + threadIdx.x; + // Scratch data, then the shared indices of each shared accessor; dynamic, so + // that it may exceed the 48 KB static shared memory limit (see the launch + // below). + extern __shared__ __align__(16) uint8_t inout_shared[]; + + __shared__ double out_rTr_local[1]; + + double r0 = 0, r1 = 0, r2 = 0, r3 = 0, r4 = 0, r5 = 0, r6 = 0, r7 = 0, r8 = 0, r9 = 0, r10 = 0, + r11 = 0, r12 = 0, r13 = 0, r14 = 0, r15 = 0, r16 = 0, r17 = 0, r18 = 0, r19 = 0, r20 = 0, + r21 = 0, r22 = 0, r23 = 0, r24 = 0, r25 = 0, r26 = 0; + + if (global_thread_idx < problem_size) { + ReadIdx2<1024, double, double, double2>(offset, 0 * offset_num_alloc, global_thread_idx, r0, + r1); + r2 = -1.00000000000000000e+00; + ReadIdx2<1024, double, double, double2>(weight, 6 * weight_num_alloc, global_thread_idx, r3, + r4); + }; + ReadAndShuffle1<1024, double, double, double>((double*)inout_shared, b, 2 * b_num_alloc, + global_thread_idx, threadIdx.x == 1023, + global_thread_idx <= problem_size, r5, r6); + if (global_thread_idx < problem_size) { + r5 = fma(r5, r2, r6); + r0 = fma(r3, r5, r0 * r2); + ReadIdx2<1024, double, double, double2>(weight, 0 * weight_num_alloc, global_thread_idx, r6, + r7); + }; + ReadAndShuffle2<1024, double, double, double2>( + (double*)inout_shared, b, 0 * b_num_alloc, global_thread_idx, threadIdx.x == 1023, + global_thread_idx <= problem_size, r8, r9, r10, r11); + if (global_thread_idx < problem_size) { + r8 = fma(r8, r2, r10); + ReadIdx2<1024, double, double, double2>(weight, 2 * weight_num_alloc, global_thread_idx, r10, + r12); + r9 = fma(r9, r2, r11); + r0 = fma(r6, r8, r0); + r0 = fma(r12, r9, r0); + r1 = fma(r4, r5, r1 * r2); + ReadIdx2<1024, double, double, double2>(weight, 4 * weight_num_alloc, global_thread_idx, r11, + r13); + r1 = fma(r7, r8, r1); + r1 = fma(r11, r9, r1); + WriteIdx2<1024, double, double, double2>(out_res, 0 * out_res_num_alloc, global_thread_idx, r0, + r1); + ReadIdx1<1024, double, double, double>(offset, 2 * offset_num_alloc, global_thread_idx, r14); + ReadIdx1<1024, double, double, double>(weight, 8 * weight_num_alloc, global_thread_idx, r15); + r5 = fma(r15, r5, r14 * r2); + r5 = fma(r10, r8, r5); + r5 = fma(r13, r9, r5); + WriteIdx1<1024, double, double, double>(out_res, 2 * out_res_num_alloc, global_thread_idx, r5); + r9 = fma(r0, r0, r5 * r5); + r9 = fma(r1, r1, r9); + }; + SumStore(out_rTr_local, (double*)inout_shared, 0, global_thread_idx < problem_size, r9); + if (global_thread_idx < problem_size) { + r9 = r7 * r2; + r8 = r10 * r10; + r14 = fma(r2, r8, r7 * r9); + r16 = r6 * r6; + r14 = fma(r2, r16, r14); + r17 = r6 * r12; + r18 = r10 * r13; + r18 = fma(r2, r18, r2 * r17); + r18 = fma(r11, r9, r18); + WriteIdx2<1024, double, double, double2>(out_b_tridig_U, 0 * out_b_tridig_U_num_alloc, + global_thread_idx, r14, r18); + r14 = r6 * r3; + r17 = r10 * r15; + r17 = fma(r2, r17, r2 * r14); + r17 = fma(r4, r9, r17); + WriteIdx2<1024, double, double, double2>(out_b_tridig_U, 2 * out_b_tridig_U_num_alloc, + global_thread_idx, r17, r18); + r18 = r12 * r3; + r14 = r13 * r15; + r14 = fma(r2, r14, r2 * r18); + r18 = r11 * r4; + r14 = fma(r2, r18, r14); + r18 = r11 * r11; + r19 = r13 * r13; + r20 = fma(r2, r19, r2 * r18); + r21 = r12 * r12; + r20 = fma(r2, r21, r20); + WriteIdx2<1024, double, double, double2>(out_b_tridig_U, 4 * out_b_tridig_U_num_alloc, + global_thread_idx, r20, r14); + WriteIdx2<1024, double, double, double2>(out_b_tridig_U, 6 * out_b_tridig_U_num_alloc, + global_thread_idx, r17, r14); + r14 = r4 * r4; + r17 = r15 * r15; + r20 = fma(r2, r17, r2 * r14); + r22 = r3 * r3; + r20 = fma(r2, r22, r20); + WriteIdx1<1024, double, double, double>(out_b_tridig_U, 8 * out_b_tridig_U_num_alloc, + global_thread_idx, r20); + r20 = fma(r6, r0, r10 * r5); + r20 = fma(r7, r1, r20); + r23 = fma(r12, r0, r13 * r5); + r23 = fma(r11, r1, r23); + r24 = r13 * r2; + r25 = r12 * r2; + r25 = fma(r0, r25, r5 * r24); + r24 = r11 * r2; + r25 = fma(r1, r24, r25); + r24 = r10 * r2; + r26 = r6 * r2; + r26 = fma(r0, r26, r5 * r24); + r26 = fma(r1, r9, r26); + }; + ShuffleAndWrite2((double*)inout_shared, out_b_njtr, + 0 * out_b_njtr_num_alloc, global_thread_idx, + problem_size, r20, r23, r26, r25); + if (global_thread_idx < problem_size) { + r25 = fma(r3, r0, r15 * r5); + r25 = fma(r4, r1, r25); + r26 = r15 * r2; + r23 = r3 * r2; + r23 = fma(r0, r23, r5 * r26); + r26 = r4 * r2; + r23 = fma(r1, r26, r23); + }; + ShuffleAndWrite1((double*)inout_shared, out_b_njtr, + 2 * out_b_njtr_num_alloc, global_thread_idx, + problem_size, r25, r23); + if (global_thread_idx < problem_size) { + r8 = fma(r7, r7, r8); + r8 = r8 + r16; + r19 = r18 + r19; + r19 = r19 + r21; + }; + ShuffleAndWrite2( + (double*)inout_shared, out_b_precond_diag, 0 * out_b_precond_diag_num_alloc, + global_thread_idx, problem_size, r8, r19, r8, r19); + if (global_thread_idx < problem_size) { + r17 = r14 + r17; + r17 = r17 + r22; + }; + ShuffleAndWrite1((double*)inout_shared, out_b_precond_diag, + 2 * out_b_precond_diag_num_alloc, + global_thread_idx, problem_size, r17, r17); + if (global_thread_idx < problem_size) { + r17 = fma(r10, r13, r6 * r12); + r17 = fma(r7, r11, r17); + r22 = fma(r10, r15, r6 * r3); + r22 = fma(r7, r4, r22); + }; + ShuffleAndWrite2( + (double*)inout_shared, out_b_precond_tril, 0 * out_b_precond_tril_num_alloc, + global_thread_idx, problem_size, r17, r22, r17, r22); + if (global_thread_idx < problem_size) { + r22 = fma(r13, r15, r12 * r3); + r22 = fma(r11, r4, r22); + }; + ShuffleAndWrite1((double*)inout_shared, out_b_precond_tril, + 2 * out_b_precond_tril_num_alloc, + global_thread_idx, problem_size, r22, r22); + SumFlushFinal(out_rTr_local, out_rTr, 1); +} + +void ChainBLinkResJacFirst( + double* const b, unsigned int b_num_alloc, double* weight, unsigned int weight_num_alloc, + double* offset, unsigned int offset_num_alloc, double* out_res, unsigned int out_res_num_alloc, + double* const out_rTr, double* out_b_tridig_U, unsigned int out_b_tridig_U_num_alloc, + double* const out_b_njtr, unsigned int out_b_njtr_num_alloc, double* const out_b_precond_diag, + unsigned int out_b_precond_diag_num_alloc, double* const out_b_precond_tril, + unsigned int out_b_precond_tril_num_alloc, size_t problem_size) { + if (problem_size == 0) { + return; + } + + const int n_blocks = (problem_size + 1024 - 1) / 1024; + // Kernels using more than 48 KB of shared memory per block must opt in. + static const cudaError_t attribute_error = cudaFuncSetAttribute( + ChainBLinkResJacFirstKernel, cudaFuncAttributeMaxDynamicSharedMemorySize, 16400); + if (attribute_error != cudaSuccess) { + throw std::runtime_error(std::string("ChainBLinkResJacFirstKernel: ") + + cudaGetErrorString(attribute_error)); + } + ChainBLinkResJacFirstKernel<<>>( + b, b_num_alloc, weight, weight_num_alloc, offset, offset_num_alloc, out_res, + out_res_num_alloc, out_rTr, out_b_tridig_U, out_b_tridig_U_num_alloc, out_b_njtr, + out_b_njtr_num_alloc, out_b_precond_diag, out_b_precond_diag_num_alloc, out_b_precond_tril, + out_b_precond_tril_num_alloc, problem_size); + // A launch that fails (e.g. from exceeding shared memory or register limits) + // otherwise leaves its outputs untouched without any error. + const cudaError_t launch_error = cudaGetLastError(); + if (launch_error != cudaSuccess) { + throw std::runtime_error(std::string("ChainBLinkResJacFirstKernel launch failed: ") + + cudaGetErrorString(launch_error)); + } +} + +} // namespace caspar \ No newline at end of file diff --git a/test/symforce_function_codegen_test_data/symengine/symforce_caspar_tridiagonal_test/kernel_chain_b_link_res_jac_first.h b/test/symforce_function_codegen_test_data/symengine/symforce_caspar_tridiagonal_test/kernel_chain_b_link_res_jac_first.h new file mode 100644 index 00000000..748c5f8e --- /dev/null +++ b/test/symforce_function_codegen_test_data/symengine/symforce_caspar_tridiagonal_test/kernel_chain_b_link_res_jac_first.h @@ -0,0 +1,17 @@ +#pragma once + +#include + +#include "shared_indices.h" + +namespace caspar { + +void ChainBLinkResJacFirst( + double* const b, unsigned int b_num_alloc, double* weight, unsigned int weight_num_alloc, + double* offset, unsigned int offset_num_alloc, double* out_res, unsigned int out_res_num_alloc, + double* const out_rTr, double* out_b_tridig_U, unsigned int out_b_tridig_U_num_alloc, + double* const out_b_njtr, unsigned int out_b_njtr_num_alloc, double* const out_b_precond_diag, + unsigned int out_b_precond_diag_num_alloc, double* const out_b_precond_tril, + unsigned int out_b_precond_tril_num_alloc, size_t problem_size); + +} // namespace caspar \ No newline at end of file diff --git a/test/symforce_function_codegen_test_data/symengine/symforce_caspar_tridiagonal_test/kernel_chain_b_link_score.cu b/test/symforce_function_codegen_test_data/symengine/symforce_caspar_tridiagonal_test/kernel_chain_b_link_score.cu new file mode 100644 index 00000000..5fb16e3b --- /dev/null +++ b/test/symforce_function_codegen_test_data/symengine/symforce_caspar_tridiagonal_test/kernel_chain_b_link_score.cu @@ -0,0 +1,102 @@ +#include +#include + +#include +#include +#include +#include +#include + +#include "kernel_chain_b_link_score.h" +#include "memops.cuh" + +namespace cg = cooperative_groups; + +namespace caspar { + +__global__ void __launch_bounds__(1024, 1) + ChainBLinkScoreKernel(double* const b, unsigned int b_num_alloc, double* weight, + unsigned int weight_num_alloc, double* offset, + unsigned int offset_num_alloc, double* const out_rTr, + size_t problem_size) { + const int global_thread_idx = blockIdx.x * blockDim.x + threadIdx.x; + // Scratch data, then the shared indices of each shared accessor; dynamic, so + // that it may exceed the 48 KB static shared memory limit (see the launch + // below). + extern __shared__ __align__(16) uint8_t inout_shared[]; + + __shared__ double out_rTr_local[1]; + + double r0 = 0, r1 = 0, r2 = 0, r3 = 0, r4 = 0, r5 = 0, r6 = 0, r7 = 0, r8 = 0, r9 = 0, r10 = 0, + r11 = 0; + + if (global_thread_idx < problem_size) { + ReadIdx1<1024, double, double, double>(offset, 2 * offset_num_alloc, global_thread_idx, r0); + r1 = -1.00000000000000000e+00; + ReadIdx1<1024, double, double, double>(weight, 8 * weight_num_alloc, global_thread_idx, r2); + }; + ReadAndShuffle1<1024, double, double, double>((double*)inout_shared, b, 2 * b_num_alloc, + global_thread_idx, threadIdx.x == 1023, + global_thread_idx <= problem_size, r3, r4); + if (global_thread_idx < problem_size) { + r3 = fma(r3, r1, r4); + r2 = fma(r2, r3, r0 * r1); + ReadIdx2<1024, double, double, double2>(weight, 2 * weight_num_alloc, global_thread_idx, r0, + r4); + }; + ReadAndShuffle2<1024, double, double, double2>((double*)inout_shared, b, 0 * b_num_alloc, + global_thread_idx, threadIdx.x == 1023, + global_thread_idx <= problem_size, r5, r6, r7, r8); + if (global_thread_idx < problem_size) { + r5 = fma(r5, r1, r7); + ReadIdx2<1024, double, double, double2>(weight, 4 * weight_num_alloc, global_thread_idx, r7, + r9); + r6 = fma(r6, r1, r8); + r2 = fma(r0, r5, r2); + r2 = fma(r9, r6, r2); + ReadIdx2<1024, double, double, double2>(offset, 0 * offset_num_alloc, global_thread_idx, r9, + r0); + ReadIdx2<1024, double, double, double2>(weight, 6 * weight_num_alloc, global_thread_idx, r8, + r10); + r8 = fma(r8, r3, r9 * r1); + ReadIdx2<1024, double, double, double2>(weight, 0 * weight_num_alloc, global_thread_idx, r9, + r11); + r8 = fma(r9, r5, r8); + r8 = fma(r4, r6, r8); + r8 = fma(r8, r8, r2 * r2); + r3 = fma(r10, r3, r0 * r1); + r3 = fma(r11, r5, r3); + r3 = fma(r7, r6, r3); + r8 = fma(r3, r3, r8); + }; + SumStore(out_rTr_local, (double*)inout_shared, 0, global_thread_idx < problem_size, r8); + SumFlushFinal(out_rTr_local, out_rTr, 1); +} + +void ChainBLinkScore(double* const b, unsigned int b_num_alloc, double* weight, + unsigned int weight_num_alloc, double* offset, unsigned int offset_num_alloc, + double* const out_rTr, size_t problem_size) { + if (problem_size == 0) { + return; + } + + const int n_blocks = (problem_size + 1024 - 1) / 1024; + // Kernels using more than 48 KB of shared memory per block must opt in. + static const cudaError_t attribute_error = cudaFuncSetAttribute( + ChainBLinkScoreKernel, cudaFuncAttributeMaxDynamicSharedMemorySize, 16384); + if (attribute_error != cudaSuccess) { + throw std::runtime_error(std::string("ChainBLinkScoreKernel: ") + + cudaGetErrorString(attribute_error)); + } + ChainBLinkScoreKernel<<>>(b, b_num_alloc, weight, weight_num_alloc, offset, + offset_num_alloc, out_rTr, problem_size); + // A launch that fails (e.g. from exceeding shared memory or register limits) + // otherwise leaves its outputs untouched without any error. + const cudaError_t launch_error = cudaGetLastError(); + if (launch_error != cudaSuccess) { + throw std::runtime_error(std::string("ChainBLinkScoreKernel launch failed: ") + + cudaGetErrorString(launch_error)); + } +} + +} // namespace caspar \ No newline at end of file diff --git a/test/symforce_function_codegen_test_data/symengine/symforce_caspar_tridiagonal_test/kernel_chain_b_link_score.h b/test/symforce_function_codegen_test_data/symengine/symforce_caspar_tridiagonal_test/kernel_chain_b_link_score.h new file mode 100644 index 00000000..c7986d12 --- /dev/null +++ b/test/symforce_function_codegen_test_data/symengine/symforce_caspar_tridiagonal_test/kernel_chain_b_link_score.h @@ -0,0 +1,13 @@ +#pragma once + +#include + +#include "shared_indices.h" + +namespace caspar { + +void ChainBLinkScore(double* const b, unsigned int b_num_alloc, double* weight, + unsigned int weight_num_alloc, double* offset, unsigned int offset_num_alloc, + double* const out_rTr, size_t problem_size); + +} // namespace caspar \ No newline at end of file diff --git a/test/symforce_function_codegen_test_data/symengine/symforce_caspar_tridiagonal_test/kernel_chain_b_prior_jtjnjtr_direct.cu b/test/symforce_function_codegen_test_data/symengine/symforce_caspar_tridiagonal_test/kernel_chain_b_prior_jtjnjtr_direct.cu new file mode 100644 index 00000000..fad4fa17 --- /dev/null +++ b/test/symforce_function_codegen_test_data/symengine/symforce_caspar_tridiagonal_test/kernel_chain_b_prior_jtjnjtr_direct.cu @@ -0,0 +1,51 @@ +#include +#include + +#include +#include +#include +#include +#include + +#include "kernel_chain_b_prior_jtjnjtr_direct.h" +#include "memops.cuh" + +namespace cg = cooperative_groups; + +namespace caspar { + +__global__ void __launch_bounds__(1024, 1) + ChainBPriorJtjnjtrDirectKernel(double* b_njtr, unsigned int b_njtr_num_alloc, + SharedIndex* b_njtr_indices, double* b_jac, + unsigned int b_jac_num_alloc, double* const out_b_njtr, + unsigned int out_b_njtr_num_alloc, size_t problem_size) {} + +void ChainBPriorJtjnjtrDirect(double* b_njtr, unsigned int b_njtr_num_alloc, + SharedIndex* b_njtr_indices, double* b_jac, + unsigned int b_jac_num_alloc, double* const out_b_njtr, + unsigned int out_b_njtr_num_alloc, size_t problem_size) { + if (problem_size == 0) { + return; + } + + const int n_blocks = (problem_size + 1024 - 1) / 1024; + // Kernels using more than 48 KB of shared memory per block must opt in. + static const cudaError_t attribute_error = cudaFuncSetAttribute( + ChainBPriorJtjnjtrDirectKernel, cudaFuncAttributeMaxDynamicSharedMemorySize, 24576); + if (attribute_error != cudaSuccess) { + throw std::runtime_error(std::string("ChainBPriorJtjnjtrDirectKernel: ") + + cudaGetErrorString(attribute_error)); + } + ChainBPriorJtjnjtrDirectKernel<<>>( + b_njtr, b_njtr_num_alloc, b_njtr_indices, b_jac, b_jac_num_alloc, out_b_njtr, + out_b_njtr_num_alloc, problem_size); + // A launch that fails (e.g. from exceeding shared memory or register limits) + // otherwise leaves its outputs untouched without any error. + const cudaError_t launch_error = cudaGetLastError(); + if (launch_error != cudaSuccess) { + throw std::runtime_error(std::string("ChainBPriorJtjnjtrDirectKernel launch failed: ") + + cudaGetErrorString(launch_error)); + } +} + +} // namespace caspar \ No newline at end of file diff --git a/test/symforce_function_codegen_test_data/symengine/symforce_caspar_tridiagonal_test/kernel_chain_b_prior_jtjnjtr_direct.h b/test/symforce_function_codegen_test_data/symengine/symforce_caspar_tridiagonal_test/kernel_chain_b_prior_jtjnjtr_direct.h new file mode 100644 index 00000000..34f3b745 --- /dev/null +++ b/test/symforce_function_codegen_test_data/symengine/symforce_caspar_tridiagonal_test/kernel_chain_b_prior_jtjnjtr_direct.h @@ -0,0 +1,14 @@ +#pragma once + +#include + +#include "shared_indices.h" + +namespace caspar { + +void ChainBPriorJtjnjtrDirect(double* b_njtr, unsigned int b_njtr_num_alloc, + SharedIndex* b_njtr_indices, double* b_jac, + unsigned int b_jac_num_alloc, double* const out_b_njtr, + unsigned int out_b_njtr_num_alloc, size_t problem_size); + +} // namespace caspar \ No newline at end of file diff --git a/test/symforce_function_codegen_test_data/symengine/symforce_caspar_tridiagonal_test/kernel_chain_b_prior_res_jac.cu b/test/symforce_function_codegen_test_data/symengine/symforce_caspar_tridiagonal_test/kernel_chain_b_prior_res_jac.cu new file mode 100644 index 00000000..1d01a9ea --- /dev/null +++ b/test/symforce_function_codegen_test_data/symengine/symforce_caspar_tridiagonal_test/kernel_chain_b_prior_res_jac.cu @@ -0,0 +1,118 @@ +#include +#include + +#include +#include +#include +#include +#include + +#include "kernel_chain_b_prior_res_jac.h" +#include "memops.cuh" + +namespace cg = cooperative_groups; + +namespace caspar { + +__global__ void __launch_bounds__(1024, 1) + ChainBPriorResJacKernel(double* b, unsigned int b_num_alloc, SharedIndex* b_indices, + double* target, unsigned int target_num_alloc, double* out_res, + unsigned int out_res_num_alloc, double* const out_b_njtr, + unsigned int out_b_njtr_num_alloc, double* const out_b_precond_diag, + unsigned int out_b_precond_diag_num_alloc, + double* const out_b_precond_tril, + unsigned int out_b_precond_tril_num_alloc, size_t problem_size) { + const int global_thread_idx = blockIdx.x * blockDim.x + threadIdx.x; + // Scratch data, then the shared indices of each shared accessor; dynamic, so + // that it may exceed the 48 KB static shared memory limit (see the launch + // below). + extern __shared__ __align__(16) uint8_t inout_shared[]; + constexpr unsigned int b_indices_shared_offset = 16384; + + SharedIndex* const b_indices_loc = + reinterpret_cast(inout_shared + b_indices_shared_offset); + b_indices_loc[threadIdx.x] = + (global_thread_idx < problem_size ? b_indices[global_thread_idx] + : SharedIndex{0xffffffff, 0xffff, 0xffff}); + + double r0 = 0, r1 = 0, r2 = 0, r3 = 0, r4 = 0; + LoadShared<2, double, double>(b, 0 * b_num_alloc, b_indices_loc, (double*)inout_shared); + if (global_thread_idx < problem_size) { + ReadShared2((double*)inout_shared, b_indices_loc[threadIdx.x].target, r0, r1); + }; + __syncthreads(); + if (global_thread_idx < problem_size) { + ReadIdx2<1024, double, double, double2>(target, 0 * target_num_alloc, global_thread_idx, r2, + r3); + r4 = -1.00000000000000000e+00; + r2 = fma(r2, r4, r0); + r3 = fma(r3, r4, r1); + WriteIdx2<1024, double, double, double2>(out_res, 0 * out_res_num_alloc, global_thread_idx, r2, + r3); + }; + LoadShared<1, double, double>(b, 2 * b_num_alloc, b_indices_loc, (double*)inout_shared); + if (global_thread_idx < problem_size) { + ReadShared1((double*)inout_shared, b_indices_loc[threadIdx.x].target, r1); + }; + __syncthreads(); + if (global_thread_idx < problem_size) { + ReadIdx1<1024, double, double, double>(target, 2 * target_num_alloc, global_thread_idx, r0); + r0 = fma(r0, r4, r1); + WriteIdx1<1024, double, double, double>(out_res, 2 * out_res_num_alloc, global_thread_idx, r0); + r2 = r4 * r2; + r3 = r4 * r3; + WriteSum2((double*)inout_shared, r2, r3); + }; + FlushSumShared<2, double>(out_b_njtr, 0 * out_b_njtr_num_alloc, b_indices_loc, + (double*)inout_shared); + if (global_thread_idx < problem_size) { + r0 = r4 * r0; + WriteSum1((double*)inout_shared, r0); + }; + FlushSumShared<1, double>(out_b_njtr, 2 * out_b_njtr_num_alloc, b_indices_loc, + (double*)inout_shared); + if (global_thread_idx < problem_size) { + r0 = 1.00000000000000000e+00; + WriteSum2((double*)inout_shared, r0, r0); + }; + FlushSumShared<2, double>(out_b_precond_diag, 0 * out_b_precond_diag_num_alloc, b_indices_loc, + (double*)inout_shared); + if (global_thread_idx < problem_size) { + WriteSum1((double*)inout_shared, r0); + }; + FlushSumShared<1, double>(out_b_precond_diag, 2 * out_b_precond_diag_num_alloc, b_indices_loc, + (double*)inout_shared); +} + +void ChainBPriorResJac(double* b, unsigned int b_num_alloc, SharedIndex* b_indices, double* target, + unsigned int target_num_alloc, double* out_res, + unsigned int out_res_num_alloc, double* const out_b_njtr, + unsigned int out_b_njtr_num_alloc, double* const out_b_precond_diag, + unsigned int out_b_precond_diag_num_alloc, double* const out_b_precond_tril, + unsigned int out_b_precond_tril_num_alloc, size_t problem_size) { + if (problem_size == 0) { + return; + } + + const int n_blocks = (problem_size + 1024 - 1) / 1024; + // Kernels using more than 48 KB of shared memory per block must opt in. + static const cudaError_t attribute_error = cudaFuncSetAttribute( + ChainBPriorResJacKernel, cudaFuncAttributeMaxDynamicSharedMemorySize, 24576); + if (attribute_error != cudaSuccess) { + throw std::runtime_error(std::string("ChainBPriorResJacKernel: ") + + cudaGetErrorString(attribute_error)); + } + ChainBPriorResJacKernel<<>>( + b, b_num_alloc, b_indices, target, target_num_alloc, out_res, out_res_num_alloc, out_b_njtr, + out_b_njtr_num_alloc, out_b_precond_diag, out_b_precond_diag_num_alloc, out_b_precond_tril, + out_b_precond_tril_num_alloc, problem_size); + // A launch that fails (e.g. from exceeding shared memory or register limits) + // otherwise leaves its outputs untouched without any error. + const cudaError_t launch_error = cudaGetLastError(); + if (launch_error != cudaSuccess) { + throw std::runtime_error(std::string("ChainBPriorResJacKernel launch failed: ") + + cudaGetErrorString(launch_error)); + } +} + +} // namespace caspar \ No newline at end of file diff --git a/test/symforce_function_codegen_test_data/symengine/symforce_caspar_tridiagonal_test/kernel_chain_b_prior_res_jac.h b/test/symforce_function_codegen_test_data/symengine/symforce_caspar_tridiagonal_test/kernel_chain_b_prior_res_jac.h new file mode 100644 index 00000000..434b6f81 --- /dev/null +++ b/test/symforce_function_codegen_test_data/symengine/symforce_caspar_tridiagonal_test/kernel_chain_b_prior_res_jac.h @@ -0,0 +1,16 @@ +#pragma once + +#include + +#include "shared_indices.h" + +namespace caspar { + +void ChainBPriorResJac(double* b, unsigned int b_num_alloc, SharedIndex* b_indices, double* target, + unsigned int target_num_alloc, double* out_res, + unsigned int out_res_num_alloc, double* const out_b_njtr, + unsigned int out_b_njtr_num_alloc, double* const out_b_precond_diag, + unsigned int out_b_precond_diag_num_alloc, double* const out_b_precond_tril, + unsigned int out_b_precond_tril_num_alloc, size_t problem_size); + +} // namespace caspar \ No newline at end of file diff --git a/test/symforce_function_codegen_test_data/symengine/symforce_caspar_tridiagonal_test/kernel_chain_b_prior_res_jac_first.cu b/test/symforce_function_codegen_test_data/symengine/symforce_caspar_tridiagonal_test/kernel_chain_b_prior_res_jac_first.cu new file mode 100644 index 00000000..a7df9eb8 --- /dev/null +++ b/test/symforce_function_codegen_test_data/symengine/symforce_caspar_tridiagonal_test/kernel_chain_b_prior_res_jac_first.cu @@ -0,0 +1,129 @@ +#include +#include + +#include +#include +#include +#include +#include + +#include "kernel_chain_b_prior_res_jac_first.h" +#include "memops.cuh" + +namespace cg = cooperative_groups; + +namespace caspar { + +__global__ void __launch_bounds__(1024, 1) + ChainBPriorResJacFirstKernel(double* b, unsigned int b_num_alloc, SharedIndex* b_indices, + double* target, unsigned int target_num_alloc, double* out_res, + unsigned int out_res_num_alloc, double* const out_rTr, + double* const out_b_njtr, unsigned int out_b_njtr_num_alloc, + double* const out_b_precond_diag, + unsigned int out_b_precond_diag_num_alloc, + double* const out_b_precond_tril, + unsigned int out_b_precond_tril_num_alloc, size_t problem_size) { + const int global_thread_idx = blockIdx.x * blockDim.x + threadIdx.x; + // Scratch data, then the shared indices of each shared accessor; dynamic, so + // that it may exceed the 48 KB static shared memory limit (see the launch + // below). + extern __shared__ __align__(16) uint8_t inout_shared[]; + constexpr unsigned int b_indices_shared_offset = 16384; + + SharedIndex* const b_indices_loc = + reinterpret_cast(inout_shared + b_indices_shared_offset); + b_indices_loc[threadIdx.x] = + (global_thread_idx < problem_size ? b_indices[global_thread_idx] + : SharedIndex{0xffffffff, 0xffff, 0xffff}); + + __shared__ double out_rTr_local[1]; + + double r0 = 0, r1 = 0, r2 = 0, r3 = 0, r4 = 0; + LoadShared<2, double, double>(b, 0 * b_num_alloc, b_indices_loc, (double*)inout_shared); + if (global_thread_idx < problem_size) { + ReadShared2((double*)inout_shared, b_indices_loc[threadIdx.x].target, r0, r1); + }; + __syncthreads(); + if (global_thread_idx < problem_size) { + ReadIdx2<1024, double, double, double2>(target, 0 * target_num_alloc, global_thread_idx, r2, + r3); + r4 = -1.00000000000000000e+00; + r2 = fma(r2, r4, r0); + r3 = fma(r3, r4, r1); + WriteIdx2<1024, double, double, double2>(out_res, 0 * out_res_num_alloc, global_thread_idx, r2, + r3); + }; + LoadShared<1, double, double>(b, 2 * b_num_alloc, b_indices_loc, (double*)inout_shared); + if (global_thread_idx < problem_size) { + ReadShared1((double*)inout_shared, b_indices_loc[threadIdx.x].target, r1); + }; + __syncthreads(); + if (global_thread_idx < problem_size) { + ReadIdx1<1024, double, double, double>(target, 2 * target_num_alloc, global_thread_idx, r0); + r0 = fma(r0, r4, r1); + WriteIdx1<1024, double, double, double>(out_res, 2 * out_res_num_alloc, global_thread_idx, r0); + r1 = fma(r2, r2, r0 * r0); + r1 = fma(r3, r3, r1); + }; + SumStore(out_rTr_local, (double*)inout_shared, 0, global_thread_idx < problem_size, r1); + if (global_thread_idx < problem_size) { + r2 = r4 * r2; + r3 = r4 * r3; + WriteSum2((double*)inout_shared, r2, r3); + }; + FlushSumShared<2, double>(out_b_njtr, 0 * out_b_njtr_num_alloc, b_indices_loc, + (double*)inout_shared); + if (global_thread_idx < problem_size) { + r0 = r4 * r0; + WriteSum1((double*)inout_shared, r0); + }; + FlushSumShared<1, double>(out_b_njtr, 2 * out_b_njtr_num_alloc, b_indices_loc, + (double*)inout_shared); + if (global_thread_idx < problem_size) { + r0 = 1.00000000000000000e+00; + WriteSum2((double*)inout_shared, r0, r0); + }; + FlushSumShared<2, double>(out_b_precond_diag, 0 * out_b_precond_diag_num_alloc, b_indices_loc, + (double*)inout_shared); + if (global_thread_idx < problem_size) { + WriteSum1((double*)inout_shared, r0); + }; + FlushSumShared<1, double>(out_b_precond_diag, 2 * out_b_precond_diag_num_alloc, b_indices_loc, + (double*)inout_shared); + SumFlushFinal(out_rTr_local, out_rTr, 1); +} + +void ChainBPriorResJacFirst(double* b, unsigned int b_num_alloc, SharedIndex* b_indices, + double* target, unsigned int target_num_alloc, double* out_res, + unsigned int out_res_num_alloc, double* const out_rTr, + double* const out_b_njtr, unsigned int out_b_njtr_num_alloc, + double* const out_b_precond_diag, + unsigned int out_b_precond_diag_num_alloc, + double* const out_b_precond_tril, + unsigned int out_b_precond_tril_num_alloc, size_t problem_size) { + if (problem_size == 0) { + return; + } + + const int n_blocks = (problem_size + 1024 - 1) / 1024; + // Kernels using more than 48 KB of shared memory per block must opt in. + static const cudaError_t attribute_error = cudaFuncSetAttribute( + ChainBPriorResJacFirstKernel, cudaFuncAttributeMaxDynamicSharedMemorySize, 24576); + if (attribute_error != cudaSuccess) { + throw std::runtime_error(std::string("ChainBPriorResJacFirstKernel: ") + + cudaGetErrorString(attribute_error)); + } + ChainBPriorResJacFirstKernel<<>>( + b, b_num_alloc, b_indices, target, target_num_alloc, out_res, out_res_num_alloc, out_rTr, + out_b_njtr, out_b_njtr_num_alloc, out_b_precond_diag, out_b_precond_diag_num_alloc, + out_b_precond_tril, out_b_precond_tril_num_alloc, problem_size); + // A launch that fails (e.g. from exceeding shared memory or register limits) + // otherwise leaves its outputs untouched without any error. + const cudaError_t launch_error = cudaGetLastError(); + if (launch_error != cudaSuccess) { + throw std::runtime_error(std::string("ChainBPriorResJacFirstKernel launch failed: ") + + cudaGetErrorString(launch_error)); + } +} + +} // namespace caspar \ No newline at end of file diff --git a/test/symforce_function_codegen_test_data/symengine/symforce_caspar_tridiagonal_test/kernel_chain_b_prior_res_jac_first.h b/test/symforce_function_codegen_test_data/symengine/symforce_caspar_tridiagonal_test/kernel_chain_b_prior_res_jac_first.h new file mode 100644 index 00000000..47af0a26 --- /dev/null +++ b/test/symforce_function_codegen_test_data/symengine/symforce_caspar_tridiagonal_test/kernel_chain_b_prior_res_jac_first.h @@ -0,0 +1,18 @@ +#pragma once + +#include + +#include "shared_indices.h" + +namespace caspar { + +void ChainBPriorResJacFirst(double* b, unsigned int b_num_alloc, SharedIndex* b_indices, + double* target, unsigned int target_num_alloc, double* out_res, + unsigned int out_res_num_alloc, double* const out_rTr, + double* const out_b_njtr, unsigned int out_b_njtr_num_alloc, + double* const out_b_precond_diag, + unsigned int out_b_precond_diag_num_alloc, + double* const out_b_precond_tril, + unsigned int out_b_precond_tril_num_alloc, size_t problem_size); + +} // namespace caspar \ No newline at end of file diff --git a/test/symforce_function_codegen_test_data/symengine/symforce_caspar_tridiagonal_test/kernel_chain_b_prior_score.cu b/test/symforce_function_codegen_test_data/symengine/symforce_caspar_tridiagonal_test/kernel_chain_b_prior_score.cu new file mode 100644 index 00000000..cb476e7f --- /dev/null +++ b/test/symforce_function_codegen_test_data/symengine/symforce_caspar_tridiagonal_test/kernel_chain_b_prior_score.cu @@ -0,0 +1,89 @@ +#include +#include + +#include +#include +#include +#include +#include + +#include "kernel_chain_b_prior_score.h" +#include "memops.cuh" + +namespace cg = cooperative_groups; + +namespace caspar { + +__global__ void __launch_bounds__(1024, 1) + ChainBPriorScoreKernel(double* b, unsigned int b_num_alloc, SharedIndex* b_indices, + double* target, unsigned int target_num_alloc, double* const out_rTr, + size_t problem_size) { + const int global_thread_idx = blockIdx.x * blockDim.x + threadIdx.x; + // Scratch data, then the shared indices of each shared accessor; dynamic, so + // that it may exceed the 48 KB static shared memory limit (see the launch + // below). + extern __shared__ __align__(16) uint8_t inout_shared[]; + constexpr unsigned int b_indices_shared_offset = 16384; + + SharedIndex* const b_indices_loc = + reinterpret_cast(inout_shared + b_indices_shared_offset); + b_indices_loc[threadIdx.x] = + (global_thread_idx < problem_size ? b_indices[global_thread_idx] + : SharedIndex{0xffffffff, 0xffff, 0xffff}); + + __shared__ double out_rTr_local[1]; + + double r0 = 0, r1 = 0, r2 = 0, r3 = 0, r4 = 0, r5 = 0; + LoadShared<1, double, double>(b, 2 * b_num_alloc, b_indices_loc, (double*)inout_shared); + if (global_thread_idx < problem_size) { + ReadShared1((double*)inout_shared, b_indices_loc[threadIdx.x].target, r0); + }; + __syncthreads(); + if (global_thread_idx < problem_size) { + ReadIdx1<1024, double, double, double>(target, 2 * target_num_alloc, global_thread_idx, r1); + r2 = -1.00000000000000000e+00; + r1 = fma(r1, r2, r0); + }; + LoadShared<2, double, double>(b, 0 * b_num_alloc, b_indices_loc, (double*)inout_shared); + if (global_thread_idx < problem_size) { + ReadShared2((double*)inout_shared, b_indices_loc[threadIdx.x].target, r0, r3); + }; + __syncthreads(); + if (global_thread_idx < problem_size) { + ReadIdx2<1024, double, double, double2>(target, 0 * target_num_alloc, global_thread_idx, r4, + r5); + r4 = fma(r4, r2, r0); + r4 = fma(r4, r4, r1 * r1); + r2 = fma(r5, r2, r3); + r4 = fma(r2, r2, r4); + }; + SumStore(out_rTr_local, (double*)inout_shared, 0, global_thread_idx < problem_size, r4); + SumFlushFinal(out_rTr_local, out_rTr, 1); +} + +void ChainBPriorScore(double* b, unsigned int b_num_alloc, SharedIndex* b_indices, double* target, + unsigned int target_num_alloc, double* const out_rTr, size_t problem_size) { + if (problem_size == 0) { + return; + } + + const int n_blocks = (problem_size + 1024 - 1) / 1024; + // Kernels using more than 48 KB of shared memory per block must opt in. + static const cudaError_t attribute_error = cudaFuncSetAttribute( + ChainBPriorScoreKernel, cudaFuncAttributeMaxDynamicSharedMemorySize, 24576); + if (attribute_error != cudaSuccess) { + throw std::runtime_error(std::string("ChainBPriorScoreKernel: ") + + cudaGetErrorString(attribute_error)); + } + ChainBPriorScoreKernel<<>>(b, b_num_alloc, b_indices, target, + target_num_alloc, out_rTr, problem_size); + // A launch that fails (e.g. from exceeding shared memory or register limits) + // otherwise leaves its outputs untouched without any error. + const cudaError_t launch_error = cudaGetLastError(); + if (launch_error != cudaSuccess) { + throw std::runtime_error(std::string("ChainBPriorScoreKernel launch failed: ") + + cudaGetErrorString(launch_error)); + } +} + +} // namespace caspar \ No newline at end of file diff --git a/test/symforce_function_codegen_test_data/symengine/symforce_caspar_tridiagonal_test/kernel_chain_b_prior_score.h b/test/symforce_function_codegen_test_data/symengine/symforce_caspar_tridiagonal_test/kernel_chain_b_prior_score.h new file mode 100644 index 00000000..239ad096 --- /dev/null +++ b/test/symforce_function_codegen_test_data/symengine/symforce_caspar_tridiagonal_test/kernel_chain_b_prior_score.h @@ -0,0 +1,12 @@ +#pragma once + +#include + +#include "shared_indices.h" + +namespace caspar { + +void ChainBPriorScore(double* b, unsigned int b_num_alloc, SharedIndex* b_indices, double* target, + unsigned int target_num_alloc, double* const out_rTr, size_t problem_size); + +} // namespace caspar \ No newline at end of file diff --git a/test/symforce_function_codegen_test_data/symengine/symforce_caspar_tridiagonal_test/kernel_chain_coupling_jtjnjtr_direct.cu b/test/symforce_function_codegen_test_data/symengine/symforce_caspar_tridiagonal_test/kernel_chain_coupling_jtjnjtr_direct.cu new file mode 100644 index 00000000..5836bbfc --- /dev/null +++ b/test/symforce_function_codegen_test_data/symengine/symforce_caspar_tridiagonal_test/kernel_chain_coupling_jtjnjtr_direct.cu @@ -0,0 +1,124 @@ +#include +#include + +#include +#include +#include +#include +#include + +#include "kernel_chain_coupling_jtjnjtr_direct.h" +#include "memops.cuh" + +namespace cg = cooperative_groups; + +namespace caspar { + +__global__ void __launch_bounds__(1024, 1) ChainCouplingJtjnjtrDirectKernel( + double* a_njtr, unsigned int a_njtr_num_alloc, SharedIndex* a_njtr_indices, double* a_jac, + unsigned int a_jac_num_alloc, double* b_njtr, unsigned int b_njtr_num_alloc, + SharedIndex* b_njtr_indices, double* b_jac, unsigned int b_jac_num_alloc, + double* const out_a_njtr, unsigned int out_a_njtr_num_alloc, double* const out_b_njtr, + unsigned int out_b_njtr_num_alloc, size_t problem_size) { + const int global_thread_idx = blockIdx.x * blockDim.x + threadIdx.x; + // Scratch data, then the shared indices of each shared accessor; dynamic, so + // that it may exceed the 48 KB static shared memory limit (see the launch + // below). + extern __shared__ __align__(16) uint8_t inout_shared[]; + constexpr unsigned int a_njtr_indices_shared_offset = 16384; + constexpr unsigned int b_njtr_indices_shared_offset = 24576; + + SharedIndex* const a_njtr_indices_loc = + reinterpret_cast(inout_shared + a_njtr_indices_shared_offset); + a_njtr_indices_loc[threadIdx.x] = + (global_thread_idx < problem_size ? a_njtr_indices[global_thread_idx] + : SharedIndex{0xffffffff, 0xffff, 0xffff}); + + SharedIndex* const b_njtr_indices_loc = + reinterpret_cast(inout_shared + b_njtr_indices_shared_offset); + b_njtr_indices_loc[threadIdx.x] = + (global_thread_idx < problem_size ? b_njtr_indices[global_thread_idx] + : SharedIndex{0xffffffff, 0xffff, 0xffff}); + + double r0 = 0, r1 = 0, r2 = 0, r3 = 0, r4 = 0, r5 = 0, r6 = 0, r7 = 0, r8 = 0, r9 = 0; + LoadShared<2, double, double>(b_njtr, 0 * b_njtr_num_alloc, b_njtr_indices_loc, + (double*)inout_shared); + if (global_thread_idx < problem_size) { + ReadShared2((double*)inout_shared, b_njtr_indices_loc[threadIdx.x].target, r0, r1); + }; + __syncthreads(); + if (global_thread_idx < problem_size) { + ReadIdx2<1024, double, double, double2>(b_jac, 2 * b_jac_num_alloc, global_thread_idx, r2, r3); + }; + LoadShared<1, double, double>(b_njtr, 2 * b_njtr_num_alloc, b_njtr_indices_loc, + (double*)inout_shared); + if (global_thread_idx < problem_size) { + ReadShared1((double*)inout_shared, b_njtr_indices_loc[threadIdx.x].target, r4); + }; + __syncthreads(); + if (global_thread_idx < problem_size) { + ReadIdx2<1024, double, double, double2>(b_jac, 4 * b_jac_num_alloc, global_thread_idx, r5, r6); + r7 = fma(r4, r5, r1 * r2); + ReadIdx2<1024, double, double, double2>(b_jac, 0 * b_jac_num_alloc, global_thread_idx, r8, r9); + r7 = fma(r0, r8, r7); + r4 = fma(r4, r6, r1 * r3); + r4 = fma(r0, r9, r4); + WriteSum2((double*)inout_shared, r7, r4); + }; + FlushSumShared<2, double>(out_a_njtr, 0 * out_a_njtr_num_alloc, a_njtr_indices_loc, + (double*)inout_shared); + LoadShared<2, double, double>(a_njtr, 0 * a_njtr_num_alloc, a_njtr_indices_loc, + (double*)inout_shared); + if (global_thread_idx < problem_size) { + ReadShared2((double*)inout_shared, a_njtr_indices_loc[threadIdx.x].target, r4, r7); + }; + __syncthreads(); + if (global_thread_idx < problem_size) { + r9 = fma(r7, r9, r4 * r8); + r3 = fma(r7, r3, r4 * r2); + WriteSum2((double*)inout_shared, r9, r3); + }; + FlushSumShared<2, double>(out_b_njtr, 0 * out_b_njtr_num_alloc, b_njtr_indices_loc, + (double*)inout_shared); + if (global_thread_idx < problem_size) { + r6 = fma(r7, r6, r4 * r5); + WriteSum1((double*)inout_shared, r6); + }; + FlushSumShared<1, double>(out_b_njtr, 2 * out_b_njtr_num_alloc, b_njtr_indices_loc, + (double*)inout_shared); +} + +void ChainCouplingJtjnjtrDirect(double* a_njtr, unsigned int a_njtr_num_alloc, + SharedIndex* a_njtr_indices, double* a_jac, + unsigned int a_jac_num_alloc, double* b_njtr, + unsigned int b_njtr_num_alloc, SharedIndex* b_njtr_indices, + double* b_jac, unsigned int b_jac_num_alloc, + double* const out_a_njtr, unsigned int out_a_njtr_num_alloc, + double* const out_b_njtr, unsigned int out_b_njtr_num_alloc, + size_t problem_size) { + if (problem_size == 0) { + return; + } + + const int n_blocks = (problem_size + 1024 - 1) / 1024; + // Kernels using more than 48 KB of shared memory per block must opt in. + static const cudaError_t attribute_error = cudaFuncSetAttribute( + ChainCouplingJtjnjtrDirectKernel, cudaFuncAttributeMaxDynamicSharedMemorySize, 32768); + if (attribute_error != cudaSuccess) { + throw std::runtime_error(std::string("ChainCouplingJtjnjtrDirectKernel: ") + + cudaGetErrorString(attribute_error)); + } + ChainCouplingJtjnjtrDirectKernel<<>>( + a_njtr, a_njtr_num_alloc, a_njtr_indices, a_jac, a_jac_num_alloc, b_njtr, b_njtr_num_alloc, + b_njtr_indices, b_jac, b_jac_num_alloc, out_a_njtr, out_a_njtr_num_alloc, out_b_njtr, + out_b_njtr_num_alloc, problem_size); + // A launch that fails (e.g. from exceeding shared memory or register limits) + // otherwise leaves its outputs untouched without any error. + const cudaError_t launch_error = cudaGetLastError(); + if (launch_error != cudaSuccess) { + throw std::runtime_error(std::string("ChainCouplingJtjnjtrDirectKernel launch failed: ") + + cudaGetErrorString(launch_error)); + } +} + +} // namespace caspar \ No newline at end of file diff --git a/test/symforce_function_codegen_test_data/symengine/symforce_caspar_tridiagonal_test/kernel_chain_coupling_jtjnjtr_direct.h b/test/symforce_function_codegen_test_data/symengine/symforce_caspar_tridiagonal_test/kernel_chain_coupling_jtjnjtr_direct.h new file mode 100644 index 00000000..0f76b031 --- /dev/null +++ b/test/symforce_function_codegen_test_data/symengine/symforce_caspar_tridiagonal_test/kernel_chain_coupling_jtjnjtr_direct.h @@ -0,0 +1,18 @@ +#pragma once + +#include + +#include "shared_indices.h" + +namespace caspar { + +void ChainCouplingJtjnjtrDirect(double* a_njtr, unsigned int a_njtr_num_alloc, + SharedIndex* a_njtr_indices, double* a_jac, + unsigned int a_jac_num_alloc, double* b_njtr, + unsigned int b_njtr_num_alloc, SharedIndex* b_njtr_indices, + double* b_jac, unsigned int b_jac_num_alloc, + double* const out_a_njtr, unsigned int out_a_njtr_num_alloc, + double* const out_b_njtr, unsigned int out_b_njtr_num_alloc, + size_t problem_size); + +} // namespace caspar \ No newline at end of file diff --git a/test/symforce_function_codegen_test_data/symengine/symforce_caspar_tridiagonal_test/kernel_chain_coupling_res_jac.cu b/test/symforce_function_codegen_test_data/symengine/symforce_caspar_tridiagonal_test/kernel_chain_coupling_res_jac.cu new file mode 100644 index 00000000..44138dfc --- /dev/null +++ b/test/symforce_function_codegen_test_data/symengine/symforce_caspar_tridiagonal_test/kernel_chain_coupling_res_jac.cu @@ -0,0 +1,192 @@ +#include +#include + +#include +#include +#include +#include +#include + +#include "kernel_chain_coupling_res_jac.h" +#include "memops.cuh" + +namespace cg = cooperative_groups; + +namespace caspar { + +__global__ void __launch_bounds__(1024, 1) ChainCouplingResJacKernel( + double* a, unsigned int a_num_alloc, SharedIndex* a_indices, double* b, + unsigned int b_num_alloc, SharedIndex* b_indices, double* weight, unsigned int weight_num_alloc, + double* offset, unsigned int offset_num_alloc, double* out_res, unsigned int out_res_num_alloc, + double* out_a_jac, unsigned int out_a_jac_num_alloc, double* const out_a_njtr, + unsigned int out_a_njtr_num_alloc, double* const out_a_precond_diag, + unsigned int out_a_precond_diag_num_alloc, double* const out_a_precond_tril, + unsigned int out_a_precond_tril_num_alloc, double* out_b_jac, unsigned int out_b_jac_num_alloc, + double* const out_b_njtr, unsigned int out_b_njtr_num_alloc, double* const out_b_precond_diag, + unsigned int out_b_precond_diag_num_alloc, double* const out_b_precond_tril, + unsigned int out_b_precond_tril_num_alloc, size_t problem_size) { + const int global_thread_idx = blockIdx.x * blockDim.x + threadIdx.x; + // Scratch data, then the shared indices of each shared accessor; dynamic, so + // that it may exceed the 48 KB static shared memory limit (see the launch + // below). + extern __shared__ __align__(16) uint8_t inout_shared[]; + constexpr unsigned int a_indices_shared_offset = 16384; + constexpr unsigned int b_indices_shared_offset = 24576; + + SharedIndex* const a_indices_loc = + reinterpret_cast(inout_shared + a_indices_shared_offset); + a_indices_loc[threadIdx.x] = + (global_thread_idx < problem_size ? a_indices[global_thread_idx] + : SharedIndex{0xffffffff, 0xffff, 0xffff}); + SharedIndex* const b_indices_loc = + reinterpret_cast(inout_shared + b_indices_shared_offset); + b_indices_loc[threadIdx.x] = + (global_thread_idx < problem_size ? b_indices[global_thread_idx] + : SharedIndex{0xffffffff, 0xffff, 0xffff}); + + double r0 = 0, r1 = 0, r2 = 0, r3 = 0, r4 = 0, r5 = 0, r6 = 0, r7 = 0, r8 = 0, r9 = 0, r10 = 0, + r11 = 0, r12 = 0, r13 = 0; + LoadShared<2, double, double>(a, 0 * a_num_alloc, a_indices_loc, (double*)inout_shared); + if (global_thread_idx < problem_size) { + ReadShared2((double*)inout_shared, a_indices_loc[threadIdx.x].target, r0, r1); + }; + __syncthreads(); + if (global_thread_idx < problem_size) { + ReadIdx2<1024, double, double, double2>(offset, 0 * offset_num_alloc, global_thread_idx, r2, + r3); + r4 = -1.00000000000000000e+00; + r2 = fma(r2, r4, r0); + }; + LoadShared<1, double, double>(b, 2 * b_num_alloc, b_indices_loc, (double*)inout_shared); + if (global_thread_idx < problem_size) { + ReadShared1((double*)inout_shared, b_indices_loc[threadIdx.x].target, r0); + }; + __syncthreads(); + if (global_thread_idx < problem_size) { + ReadIdx2<1024, double, double, double2>(weight, 4 * weight_num_alloc, global_thread_idx, r5, + r6); + }; + LoadShared<2, double, double>(b, 0 * b_num_alloc, b_indices_loc, (double*)inout_shared); + if (global_thread_idx < problem_size) { + ReadShared2((double*)inout_shared, b_indices_loc[threadIdx.x].target, r7, r8); + }; + __syncthreads(); + if (global_thread_idx < problem_size) { + ReadIdx2<1024, double, double, double2>(weight, 2 * weight_num_alloc, global_thread_idx, r9, + r10); + r11 = fma(r8, r9, r0 * r5); + ReadIdx2<1024, double, double, double2>(weight, 0 * weight_num_alloc, global_thread_idx, r12, + r13); + r11 = fma(r7, r12, r11); + r2 = fma(r4, r11, r2); + r3 = fma(r3, r4, r1); + r8 = fma(r8, r10, r0 * r6); + r8 = fma(r7, r13, r8); + r3 = fma(r4, r8, r3); + WriteIdx2<1024, double, double, double2>(out_res, 0 * out_res_num_alloc, global_thread_idx, r2, + r3); + r8 = r4 * r2; + r7 = r4 * r3; + WriteSum2((double*)inout_shared, r8, r7); + }; + FlushSumShared<2, double>(out_a_njtr, 0 * out_a_njtr_num_alloc, a_indices_loc, + (double*)inout_shared); + if (global_thread_idx < problem_size) { + r7 = 1.00000000000000000e+00; + WriteSum2((double*)inout_shared, r7, r7); + }; + FlushSumShared<2, double>(out_a_precond_diag, 0 * out_a_precond_diag_num_alloc, a_indices_loc, + (double*)inout_shared); + if (global_thread_idx < problem_size) { + r7 = r12 * r4; + r8 = r13 * r4; + WriteIdx2<1024, double, double, double2>(out_b_jac, 0 * out_b_jac_num_alloc, global_thread_idx, + r7, r8); + r8 = r9 * r4; + r7 = r10 * r4; + WriteIdx2<1024, double, double, double2>(out_b_jac, 2 * out_b_jac_num_alloc, global_thread_idx, + r8, r7); + r7 = r5 * r4; + r4 = r6 * r4; + WriteIdx2<1024, double, double, double2>(out_b_jac, 4 * out_b_jac_num_alloc, global_thread_idx, + r7, r4); + r4 = fma(r12, r2, r13 * r3); + r7 = fma(r9, r2, r10 * r3); + WriteSum2((double*)inout_shared, r4, r7); + }; + FlushSumShared<2, double>(out_b_njtr, 0 * out_b_njtr_num_alloc, b_indices_loc, + (double*)inout_shared); + if (global_thread_idx < problem_size) { + r2 = fma(r5, r2, r6 * r3); + WriteSum1((double*)inout_shared, r2); + }; + FlushSumShared<1, double>(out_b_njtr, 2 * out_b_njtr_num_alloc, b_indices_loc, + (double*)inout_shared); + if (global_thread_idx < problem_size) { + r2 = fma(r12, r12, r13 * r13); + r3 = fma(r9, r9, r10 * r10); + WriteSum2((double*)inout_shared, r2, r3); + }; + FlushSumShared<2, double>(out_b_precond_diag, 0 * out_b_precond_diag_num_alloc, b_indices_loc, + (double*)inout_shared); + if (global_thread_idx < problem_size) { + r3 = fma(r5, r5, r6 * r6); + WriteSum1((double*)inout_shared, r3); + }; + FlushSumShared<1, double>(out_b_precond_diag, 2 * out_b_precond_diag_num_alloc, b_indices_loc, + (double*)inout_shared); + if (global_thread_idx < problem_size) { + r3 = fma(r13, r10, r12 * r9); + r13 = fma(r13, r6, r12 * r5); + WriteSum2((double*)inout_shared, r3, r13); + }; + FlushSumShared<2, double>(out_b_precond_tril, 0 * out_b_precond_tril_num_alloc, b_indices_loc, + (double*)inout_shared); + if (global_thread_idx < problem_size) { + r6 = fma(r10, r6, r9 * r5); + WriteSum1((double*)inout_shared, r6); + }; + FlushSumShared<1, double>(out_b_precond_tril, 2 * out_b_precond_tril_num_alloc, b_indices_loc, + (double*)inout_shared); +} + +void ChainCouplingResJac( + double* a, unsigned int a_num_alloc, SharedIndex* a_indices, double* b, + unsigned int b_num_alloc, SharedIndex* b_indices, double* weight, unsigned int weight_num_alloc, + double* offset, unsigned int offset_num_alloc, double* out_res, unsigned int out_res_num_alloc, + double* out_a_jac, unsigned int out_a_jac_num_alloc, double* const out_a_njtr, + unsigned int out_a_njtr_num_alloc, double* const out_a_precond_diag, + unsigned int out_a_precond_diag_num_alloc, double* const out_a_precond_tril, + unsigned int out_a_precond_tril_num_alloc, double* out_b_jac, unsigned int out_b_jac_num_alloc, + double* const out_b_njtr, unsigned int out_b_njtr_num_alloc, double* const out_b_precond_diag, + unsigned int out_b_precond_diag_num_alloc, double* const out_b_precond_tril, + unsigned int out_b_precond_tril_num_alloc, size_t problem_size) { + if (problem_size == 0) { + return; + } + + const int n_blocks = (problem_size + 1024 - 1) / 1024; + // Kernels using more than 48 KB of shared memory per block must opt in. + static const cudaError_t attribute_error = cudaFuncSetAttribute( + ChainCouplingResJacKernel, cudaFuncAttributeMaxDynamicSharedMemorySize, 32768); + if (attribute_error != cudaSuccess) { + throw std::runtime_error(std::string("ChainCouplingResJacKernel: ") + + cudaGetErrorString(attribute_error)); + } + ChainCouplingResJacKernel<<>>( + a, a_num_alloc, a_indices, b, b_num_alloc, b_indices, weight, weight_num_alloc, offset, + offset_num_alloc, out_res, out_res_num_alloc, out_a_jac, out_a_jac_num_alloc, out_a_njtr, + out_a_njtr_num_alloc, out_a_precond_diag, out_a_precond_diag_num_alloc, out_a_precond_tril, + out_a_precond_tril_num_alloc, out_b_jac, out_b_jac_num_alloc, out_b_njtr, + out_b_njtr_num_alloc, out_b_precond_diag, out_b_precond_diag_num_alloc, out_b_precond_tril, + out_b_precond_tril_num_alloc, problem_size); + // A launch that fails (e.g. from exceeding shared memory or register limits) + // otherwise leaves its outputs untouched without any error. + const cudaError_t launch_error = cudaGetLastError(); + if (launch_error != cudaSuccess) { + throw std::runtime_error(std::string("ChainCouplingResJacKernel launch failed: ") + + cudaGetErrorString(launch_error)); + } +} + +} // namespace caspar \ No newline at end of file diff --git a/test/symforce_function_codegen_test_data/symengine/symforce_caspar_tridiagonal_test/kernel_chain_coupling_res_jac.h b/test/symforce_function_codegen_test_data/symengine/symforce_caspar_tridiagonal_test/kernel_chain_coupling_res_jac.h new file mode 100644 index 00000000..234789c6 --- /dev/null +++ b/test/symforce_function_codegen_test_data/symengine/symforce_caspar_tridiagonal_test/kernel_chain_coupling_res_jac.h @@ -0,0 +1,21 @@ +#pragma once + +#include + +#include "shared_indices.h" + +namespace caspar { + +void ChainCouplingResJac( + double* a, unsigned int a_num_alloc, SharedIndex* a_indices, double* b, + unsigned int b_num_alloc, SharedIndex* b_indices, double* weight, unsigned int weight_num_alloc, + double* offset, unsigned int offset_num_alloc, double* out_res, unsigned int out_res_num_alloc, + double* out_a_jac, unsigned int out_a_jac_num_alloc, double* const out_a_njtr, + unsigned int out_a_njtr_num_alloc, double* const out_a_precond_diag, + unsigned int out_a_precond_diag_num_alloc, double* const out_a_precond_tril, + unsigned int out_a_precond_tril_num_alloc, double* out_b_jac, unsigned int out_b_jac_num_alloc, + double* const out_b_njtr, unsigned int out_b_njtr_num_alloc, double* const out_b_precond_diag, + unsigned int out_b_precond_diag_num_alloc, double* const out_b_precond_tril, + unsigned int out_b_precond_tril_num_alloc, size_t problem_size); + +} // namespace caspar \ No newline at end of file diff --git a/test/symforce_function_codegen_test_data/symengine/symforce_caspar_tridiagonal_test/kernel_chain_coupling_res_jac_first.cu b/test/symforce_function_codegen_test_data/symengine/symforce_caspar_tridiagonal_test/kernel_chain_coupling_res_jac_first.cu new file mode 100644 index 00000000..38f5df97 --- /dev/null +++ b/test/symforce_function_codegen_test_data/symengine/symforce_caspar_tridiagonal_test/kernel_chain_coupling_res_jac_first.cu @@ -0,0 +1,199 @@ +#include +#include + +#include +#include +#include +#include +#include + +#include "kernel_chain_coupling_res_jac_first.h" +#include "memops.cuh" + +namespace cg = cooperative_groups; + +namespace caspar { + +__global__ void __launch_bounds__(1024, 1) ChainCouplingResJacFirstKernel( + double* a, unsigned int a_num_alloc, SharedIndex* a_indices, double* b, + unsigned int b_num_alloc, SharedIndex* b_indices, double* weight, unsigned int weight_num_alloc, + double* offset, unsigned int offset_num_alloc, double* out_res, unsigned int out_res_num_alloc, + double* const out_rTr, double* out_a_jac, unsigned int out_a_jac_num_alloc, + double* const out_a_njtr, unsigned int out_a_njtr_num_alloc, double* const out_a_precond_diag, + unsigned int out_a_precond_diag_num_alloc, double* const out_a_precond_tril, + unsigned int out_a_precond_tril_num_alloc, double* out_b_jac, unsigned int out_b_jac_num_alloc, + double* const out_b_njtr, unsigned int out_b_njtr_num_alloc, double* const out_b_precond_diag, + unsigned int out_b_precond_diag_num_alloc, double* const out_b_precond_tril, + unsigned int out_b_precond_tril_num_alloc, size_t problem_size) { + const int global_thread_idx = blockIdx.x * blockDim.x + threadIdx.x; + // Scratch data, then the shared indices of each shared accessor; dynamic, so + // that it may exceed the 48 KB static shared memory limit (see the launch + // below). + extern __shared__ __align__(16) uint8_t inout_shared[]; + constexpr unsigned int a_indices_shared_offset = 16384; + constexpr unsigned int b_indices_shared_offset = 24576; + + SharedIndex* const a_indices_loc = + reinterpret_cast(inout_shared + a_indices_shared_offset); + a_indices_loc[threadIdx.x] = + (global_thread_idx < problem_size ? a_indices[global_thread_idx] + : SharedIndex{0xffffffff, 0xffff, 0xffff}); + SharedIndex* const b_indices_loc = + reinterpret_cast(inout_shared + b_indices_shared_offset); + b_indices_loc[threadIdx.x] = + (global_thread_idx < problem_size ? b_indices[global_thread_idx] + : SharedIndex{0xffffffff, 0xffff, 0xffff}); + + __shared__ double out_rTr_local[1]; + + double r0 = 0, r1 = 0, r2 = 0, r3 = 0, r4 = 0, r5 = 0, r6 = 0, r7 = 0, r8 = 0, r9 = 0, r10 = 0, + r11 = 0, r12 = 0, r13 = 0; + LoadShared<2, double, double>(a, 0 * a_num_alloc, a_indices_loc, (double*)inout_shared); + if (global_thread_idx < problem_size) { + ReadShared2((double*)inout_shared, a_indices_loc[threadIdx.x].target, r0, r1); + }; + __syncthreads(); + if (global_thread_idx < problem_size) { + ReadIdx2<1024, double, double, double2>(offset, 0 * offset_num_alloc, global_thread_idx, r2, + r3); + r4 = -1.00000000000000000e+00; + r2 = fma(r2, r4, r0); + }; + LoadShared<1, double, double>(b, 2 * b_num_alloc, b_indices_loc, (double*)inout_shared); + if (global_thread_idx < problem_size) { + ReadShared1((double*)inout_shared, b_indices_loc[threadIdx.x].target, r0); + }; + __syncthreads(); + if (global_thread_idx < problem_size) { + ReadIdx2<1024, double, double, double2>(weight, 4 * weight_num_alloc, global_thread_idx, r5, + r6); + }; + LoadShared<2, double, double>(b, 0 * b_num_alloc, b_indices_loc, (double*)inout_shared); + if (global_thread_idx < problem_size) { + ReadShared2((double*)inout_shared, b_indices_loc[threadIdx.x].target, r7, r8); + }; + __syncthreads(); + if (global_thread_idx < problem_size) { + ReadIdx2<1024, double, double, double2>(weight, 2 * weight_num_alloc, global_thread_idx, r9, + r10); + r11 = fma(r8, r9, r0 * r5); + ReadIdx2<1024, double, double, double2>(weight, 0 * weight_num_alloc, global_thread_idx, r12, + r13); + r11 = fma(r7, r12, r11); + r2 = fma(r4, r11, r2); + r3 = fma(r3, r4, r1); + r8 = fma(r8, r10, r0 * r6); + r8 = fma(r7, r13, r8); + r3 = fma(r4, r8, r3); + WriteIdx2<1024, double, double, double2>(out_res, 0 * out_res_num_alloc, global_thread_idx, r2, + r3); + r8 = fma(r2, r2, r3 * r3); + }; + SumStore(out_rTr_local, (double*)inout_shared, 0, global_thread_idx < problem_size, r8); + if (global_thread_idx < problem_size) { + r8 = r4 * r2; + r7 = r4 * r3; + WriteSum2((double*)inout_shared, r8, r7); + }; + FlushSumShared<2, double>(out_a_njtr, 0 * out_a_njtr_num_alloc, a_indices_loc, + (double*)inout_shared); + if (global_thread_idx < problem_size) { + r7 = 1.00000000000000000e+00; + WriteSum2((double*)inout_shared, r7, r7); + }; + FlushSumShared<2, double>(out_a_precond_diag, 0 * out_a_precond_diag_num_alloc, a_indices_loc, + (double*)inout_shared); + if (global_thread_idx < problem_size) { + r7 = r12 * r4; + r8 = r13 * r4; + WriteIdx2<1024, double, double, double2>(out_b_jac, 0 * out_b_jac_num_alloc, global_thread_idx, + r7, r8); + r8 = r9 * r4; + r7 = r10 * r4; + WriteIdx2<1024, double, double, double2>(out_b_jac, 2 * out_b_jac_num_alloc, global_thread_idx, + r8, r7); + r7 = r5 * r4; + r4 = r6 * r4; + WriteIdx2<1024, double, double, double2>(out_b_jac, 4 * out_b_jac_num_alloc, global_thread_idx, + r7, r4); + r4 = fma(r12, r2, r13 * r3); + r7 = fma(r9, r2, r10 * r3); + WriteSum2((double*)inout_shared, r4, r7); + }; + FlushSumShared<2, double>(out_b_njtr, 0 * out_b_njtr_num_alloc, b_indices_loc, + (double*)inout_shared); + if (global_thread_idx < problem_size) { + r2 = fma(r5, r2, r6 * r3); + WriteSum1((double*)inout_shared, r2); + }; + FlushSumShared<1, double>(out_b_njtr, 2 * out_b_njtr_num_alloc, b_indices_loc, + (double*)inout_shared); + if (global_thread_idx < problem_size) { + r2 = fma(r12, r12, r13 * r13); + r3 = fma(r9, r9, r10 * r10); + WriteSum2((double*)inout_shared, r2, r3); + }; + FlushSumShared<2, double>(out_b_precond_diag, 0 * out_b_precond_diag_num_alloc, b_indices_loc, + (double*)inout_shared); + if (global_thread_idx < problem_size) { + r3 = fma(r5, r5, r6 * r6); + WriteSum1((double*)inout_shared, r3); + }; + FlushSumShared<1, double>(out_b_precond_diag, 2 * out_b_precond_diag_num_alloc, b_indices_loc, + (double*)inout_shared); + if (global_thread_idx < problem_size) { + r3 = fma(r13, r10, r12 * r9); + r13 = fma(r13, r6, r12 * r5); + WriteSum2((double*)inout_shared, r3, r13); + }; + FlushSumShared<2, double>(out_b_precond_tril, 0 * out_b_precond_tril_num_alloc, b_indices_loc, + (double*)inout_shared); + if (global_thread_idx < problem_size) { + r6 = fma(r10, r6, r9 * r5); + WriteSum1((double*)inout_shared, r6); + }; + FlushSumShared<1, double>(out_b_precond_tril, 2 * out_b_precond_tril_num_alloc, b_indices_loc, + (double*)inout_shared); + SumFlushFinal(out_rTr_local, out_rTr, 1); +} + +void ChainCouplingResJacFirst( + double* a, unsigned int a_num_alloc, SharedIndex* a_indices, double* b, + unsigned int b_num_alloc, SharedIndex* b_indices, double* weight, unsigned int weight_num_alloc, + double* offset, unsigned int offset_num_alloc, double* out_res, unsigned int out_res_num_alloc, + double* const out_rTr, double* out_a_jac, unsigned int out_a_jac_num_alloc, + double* const out_a_njtr, unsigned int out_a_njtr_num_alloc, double* const out_a_precond_diag, + unsigned int out_a_precond_diag_num_alloc, double* const out_a_precond_tril, + unsigned int out_a_precond_tril_num_alloc, double* out_b_jac, unsigned int out_b_jac_num_alloc, + double* const out_b_njtr, unsigned int out_b_njtr_num_alloc, double* const out_b_precond_diag, + unsigned int out_b_precond_diag_num_alloc, double* const out_b_precond_tril, + unsigned int out_b_precond_tril_num_alloc, size_t problem_size) { + if (problem_size == 0) { + return; + } + + const int n_blocks = (problem_size + 1024 - 1) / 1024; + // Kernels using more than 48 KB of shared memory per block must opt in. + static const cudaError_t attribute_error = cudaFuncSetAttribute( + ChainCouplingResJacFirstKernel, cudaFuncAttributeMaxDynamicSharedMemorySize, 32768); + if (attribute_error != cudaSuccess) { + throw std::runtime_error(std::string("ChainCouplingResJacFirstKernel: ") + + cudaGetErrorString(attribute_error)); + } + ChainCouplingResJacFirstKernel<<>>( + a, a_num_alloc, a_indices, b, b_num_alloc, b_indices, weight, weight_num_alloc, offset, + offset_num_alloc, out_res, out_res_num_alloc, out_rTr, out_a_jac, out_a_jac_num_alloc, + out_a_njtr, out_a_njtr_num_alloc, out_a_precond_diag, out_a_precond_diag_num_alloc, + out_a_precond_tril, out_a_precond_tril_num_alloc, out_b_jac, out_b_jac_num_alloc, out_b_njtr, + out_b_njtr_num_alloc, out_b_precond_diag, out_b_precond_diag_num_alloc, out_b_precond_tril, + out_b_precond_tril_num_alloc, problem_size); + // A launch that fails (e.g. from exceeding shared memory or register limits) + // otherwise leaves its outputs untouched without any error. + const cudaError_t launch_error = cudaGetLastError(); + if (launch_error != cudaSuccess) { + throw std::runtime_error(std::string("ChainCouplingResJacFirstKernel launch failed: ") + + cudaGetErrorString(launch_error)); + } +} + +} // namespace caspar \ No newline at end of file diff --git a/test/symforce_function_codegen_test_data/symengine/symforce_caspar_tridiagonal_test/kernel_chain_coupling_res_jac_first.h b/test/symforce_function_codegen_test_data/symengine/symforce_caspar_tridiagonal_test/kernel_chain_coupling_res_jac_first.h new file mode 100644 index 00000000..6ab04b67 --- /dev/null +++ b/test/symforce_function_codegen_test_data/symengine/symforce_caspar_tridiagonal_test/kernel_chain_coupling_res_jac_first.h @@ -0,0 +1,21 @@ +#pragma once + +#include + +#include "shared_indices.h" + +namespace caspar { + +void ChainCouplingResJacFirst( + double* a, unsigned int a_num_alloc, SharedIndex* a_indices, double* b, + unsigned int b_num_alloc, SharedIndex* b_indices, double* weight, unsigned int weight_num_alloc, + double* offset, unsigned int offset_num_alloc, double* out_res, unsigned int out_res_num_alloc, + double* const out_rTr, double* out_a_jac, unsigned int out_a_jac_num_alloc, + double* const out_a_njtr, unsigned int out_a_njtr_num_alloc, double* const out_a_precond_diag, + unsigned int out_a_precond_diag_num_alloc, double* const out_a_precond_tril, + unsigned int out_a_precond_tril_num_alloc, double* out_b_jac, unsigned int out_b_jac_num_alloc, + double* const out_b_njtr, unsigned int out_b_njtr_num_alloc, double* const out_b_precond_diag, + unsigned int out_b_precond_diag_num_alloc, double* const out_b_precond_tril, + unsigned int out_b_precond_tril_num_alloc, size_t problem_size); + +} // namespace caspar \ No newline at end of file diff --git a/test/symforce_function_codegen_test_data/symengine/symforce_caspar_tridiagonal_test/kernel_chain_coupling_score.cu b/test/symforce_function_codegen_test_data/symengine/symforce_caspar_tridiagonal_test/kernel_chain_coupling_score.cu new file mode 100644 index 00000000..ef2a7945 --- /dev/null +++ b/test/symforce_function_codegen_test_data/symengine/symforce_caspar_tridiagonal_test/kernel_chain_coupling_score.cu @@ -0,0 +1,117 @@ +#include +#include + +#include +#include +#include +#include +#include + +#include "kernel_chain_coupling_score.h" +#include "memops.cuh" + +namespace cg = cooperative_groups; + +namespace caspar { + +__global__ void __launch_bounds__(1024, 1) + ChainCouplingScoreKernel(double* a, unsigned int a_num_alloc, SharedIndex* a_indices, double* b, + unsigned int b_num_alloc, SharedIndex* b_indices, double* weight, + unsigned int weight_num_alloc, double* offset, + unsigned int offset_num_alloc, double* const out_rTr, + size_t problem_size) { + const int global_thread_idx = blockIdx.x * blockDim.x + threadIdx.x; + // Scratch data, then the shared indices of each shared accessor; dynamic, so + // that it may exceed the 48 KB static shared memory limit (see the launch + // below). + extern __shared__ __align__(16) uint8_t inout_shared[]; + constexpr unsigned int a_indices_shared_offset = 16384; + constexpr unsigned int b_indices_shared_offset = 24576; + + SharedIndex* const a_indices_loc = + reinterpret_cast(inout_shared + a_indices_shared_offset); + a_indices_loc[threadIdx.x] = + (global_thread_idx < problem_size ? a_indices[global_thread_idx] + : SharedIndex{0xffffffff, 0xffff, 0xffff}); + SharedIndex* const b_indices_loc = + reinterpret_cast(inout_shared + b_indices_shared_offset); + b_indices_loc[threadIdx.x] = + (global_thread_idx < problem_size ? b_indices[global_thread_idx] + : SharedIndex{0xffffffff, 0xffff, 0xffff}); + + __shared__ double out_rTr_local[1]; + + double r0 = 0, r1 = 0, r2 = 0, r3 = 0, r4 = 0, r5 = 0, r6 = 0, r7 = 0, r8 = 0, r9 = 0, r10 = 0, + r11 = 0; + LoadShared<2, double, double>(a, 0 * a_num_alloc, a_indices_loc, (double*)inout_shared); + if (global_thread_idx < problem_size) { + ReadShared2((double*)inout_shared, a_indices_loc[threadIdx.x].target, r0, r1); + }; + __syncthreads(); + if (global_thread_idx < problem_size) { + ReadIdx2<1024, double, double, double2>(offset, 0 * offset_num_alloc, global_thread_idx, r2, + r3); + r4 = -1.00000000000000000e+00; + r3 = fma(r3, r4, r1); + }; + LoadShared<1, double, double>(b, 2 * b_num_alloc, b_indices_loc, (double*)inout_shared); + if (global_thread_idx < problem_size) { + ReadShared1((double*)inout_shared, b_indices_loc[threadIdx.x].target, r1); + }; + __syncthreads(); + if (global_thread_idx < problem_size) { + ReadIdx2<1024, double, double, double2>(weight, 4 * weight_num_alloc, global_thread_idx, r5, + r6); + }; + LoadShared<2, double, double>(b, 0 * b_num_alloc, b_indices_loc, (double*)inout_shared); + if (global_thread_idx < problem_size) { + ReadShared2((double*)inout_shared, b_indices_loc[threadIdx.x].target, r7, r8); + }; + __syncthreads(); + if (global_thread_idx < problem_size) { + ReadIdx2<1024, double, double, double2>(weight, 2 * weight_num_alloc, global_thread_idx, r9, + r10); + r10 = fma(r8, r10, r1 * r6); + ReadIdx2<1024, double, double, double2>(weight, 0 * weight_num_alloc, global_thread_idx, r6, + r11); + r10 = fma(r7, r11, r10); + r3 = fma(r4, r10, r3); + r2 = fma(r2, r4, r0); + r9 = fma(r8, r9, r1 * r5); + r9 = fma(r7, r6, r9); + r2 = fma(r4, r9, r2); + r2 = fma(r2, r2, r3 * r3); + }; + SumStore(out_rTr_local, (double*)inout_shared, 0, global_thread_idx < problem_size, r2); + SumFlushFinal(out_rTr_local, out_rTr, 1); +} + +void ChainCouplingScore(double* a, unsigned int a_num_alloc, SharedIndex* a_indices, double* b, + unsigned int b_num_alloc, SharedIndex* b_indices, double* weight, + unsigned int weight_num_alloc, double* offset, + unsigned int offset_num_alloc, double* const out_rTr, size_t problem_size) { + if (problem_size == 0) { + return; + } + + const int n_blocks = (problem_size + 1024 - 1) / 1024; + // Kernels using more than 48 KB of shared memory per block must opt in. + static const cudaError_t attribute_error = cudaFuncSetAttribute( + ChainCouplingScoreKernel, cudaFuncAttributeMaxDynamicSharedMemorySize, 32768); + if (attribute_error != cudaSuccess) { + throw std::runtime_error(std::string("ChainCouplingScoreKernel: ") + + cudaGetErrorString(attribute_error)); + } + ChainCouplingScoreKernel<<>>(a, a_num_alloc, a_indices, b, b_num_alloc, + b_indices, weight, weight_num_alloc, offset, + offset_num_alloc, out_rTr, problem_size); + // A launch that fails (e.g. from exceeding shared memory or register limits) + // otherwise leaves its outputs untouched without any error. + const cudaError_t launch_error = cudaGetLastError(); + if (launch_error != cudaSuccess) { + throw std::runtime_error(std::string("ChainCouplingScoreKernel launch failed: ") + + cudaGetErrorString(launch_error)); + } +} + +} // namespace caspar \ No newline at end of file diff --git a/test/symforce_function_codegen_test_data/symengine/symforce_caspar_tridiagonal_test/kernel_chain_coupling_score.h b/test/symforce_function_codegen_test_data/symengine/symforce_caspar_tridiagonal_test/kernel_chain_coupling_score.h new file mode 100644 index 00000000..a073d176 --- /dev/null +++ b/test/symforce_function_codegen_test_data/symengine/symforce_caspar_tridiagonal_test/kernel_chain_coupling_score.h @@ -0,0 +1,14 @@ +#pragma once + +#include + +#include "shared_indices.h" + +namespace caspar { + +void ChainCouplingScore(double* a, unsigned int a_num_alloc, SharedIndex* a_indices, double* b, + unsigned int b_num_alloc, SharedIndex* b_indices, double* weight, + unsigned int weight_num_alloc, double* offset, + unsigned int offset_num_alloc, double* const out_rTr, size_t problem_size); + +} // namespace caspar \ No newline at end of file diff --git a/test/symforce_function_codegen_test_data/symengine/symforce_caspar_tridiagonal_test/solver.cc b/test/symforce_function_codegen_test_data/symengine/symforce_caspar_tridiagonal_test/solver.cc new file mode 100644 index 00000000..098befc3 --- /dev/null +++ b/test/symforce_function_codegen_test_data/symengine/symforce_caspar_tridiagonal_test/solver.cc @@ -0,0 +1,1284 @@ +#include "solver.h" + +#include +#include +#include + +#include "caspar_mappings.h" +#include "kernel_ChainA_alpha_denominator_or_beta_numerator.h" +#include "kernel_ChainA_alpha_numerator_denominator.h" +#include "kernel_ChainA_cyclic_reduction_down.h" +#include "kernel_ChainA_cyclic_reduction_solve_two.h" +#include "kernel_ChainA_cyclic_reduction_up.h" +#include "kernel_ChainA_normalize.h" +#include "kernel_ChainA_pred_decrease_times_two.h" +#include "kernel_ChainA_retract.h" +#include "kernel_ChainA_start_w.h" +#include "kernel_ChainA_start_w_contribute.h" +#include "kernel_ChainA_tridig_make_eq.h" +#include "kernel_ChainA_update_Mp.h" +#include "kernel_ChainA_update_p.h" +#include "kernel_ChainA_update_r.h" +#include "kernel_ChainA_update_r_first.h" +#include "kernel_ChainA_update_step.h" +#include "kernel_ChainA_update_step_first.h" +#include "kernel_ChainB_alpha_denominator_or_beta_numerator.h" +#include "kernel_ChainB_alpha_numerator_denominator.h" +#include "kernel_ChainB_cyclic_reduction_down.h" +#include "kernel_ChainB_cyclic_reduction_solve_two.h" +#include "kernel_ChainB_cyclic_reduction_up.h" +#include "kernel_ChainB_normalize.h" +#include "kernel_ChainB_pred_decrease_times_two.h" +#include "kernel_ChainB_retract.h" +#include "kernel_ChainB_start_w.h" +#include "kernel_ChainB_start_w_contribute.h" +#include "kernel_ChainB_tridig_make_eq.h" +#include "kernel_ChainB_update_Mp.h" +#include "kernel_ChainB_update_p.h" +#include "kernel_ChainB_update_r.h" +#include "kernel_ChainB_update_r_first.h" +#include "kernel_ChainB_update_step.h" +#include "kernel_ChainB_update_step_first.h" +#include "kernel_chain_a_link_jtjnjtr_direct.h" +#include "kernel_chain_a_link_res_jac.h" +#include "kernel_chain_a_link_res_jac_first.h" +#include "kernel_chain_a_link_score.h" +#include "kernel_chain_a_prior_jtjnjtr_direct.h" +#include "kernel_chain_a_prior_res_jac.h" +#include "kernel_chain_a_prior_res_jac_first.h" +#include "kernel_chain_a_prior_score.h" +#include "kernel_chain_b_link_jtjnjtr_direct.h" +#include "kernel_chain_b_link_res_jac.h" +#include "kernel_chain_b_link_res_jac_first.h" +#include "kernel_chain_b_link_score.h" +#include "kernel_chain_b_prior_jtjnjtr_direct.h" +#include "kernel_chain_b_prior_res_jac.h" +#include "kernel_chain_b_prior_res_jac_first.h" +#include "kernel_chain_b_prior_score.h" +#include "kernel_chain_coupling_jtjnjtr_direct.h" +#include "kernel_chain_coupling_res_jac.h" +#include "kernel_chain_coupling_res_jac_first.h" +#include "kernel_chain_coupling_score.h" +#include "shared_indices.h" +#include "solver_tools.h" +#include "sort_indices.h" + +namespace { + +void make_aligned(size_t& offset, size_t alignment_bytes) { + offset = ((offset + alignment_bytes - 1) / alignment_bytes) * alignment_bytes; +} + +template +void increment_offset(size_t& offset, size_t num_elements, size_t alignment_elements) { + make_aligned(offset, alignment_elements * sizeof(T)); + offset += num_elements * sizeof(T); +} + +template +T* assign_and_increment(uint8_t* origin_ptr, size_t& offset, size_t num_elements, + size_t alignment_elements) { + make_aligned(offset, alignment_elements * sizeof(T)); + size_t old_offset = offset; + offset += num_elements * sizeof(T); + return reinterpret_cast(origin_ptr + old_offset); +} + +} // namespace + +namespace caspar { + +GraphSolver::GraphSolver(const SolverParams& params, size_t ChainA_num_max, + size_t ChainB_num_max, size_t chain_a_link_num_max, + size_t chain_a_prior_num_max, size_t chain_b_link_num_max, + size_t chain_b_prior_num_max, size_t chain_coupling_num_max, int device_id) + : params_(params), + device_id_(device_id), + ChainA_num_(ChainA_num_max), + ChainA_num_max_(ChainA_num_max), + ChainB_num_(ChainB_num_max), + ChainB_num_max_(ChainB_num_max), + chain_a_link_num_(chain_a_link_num_max), + chain_a_link_num_max_(chain_a_link_num_max), + chain_a_prior_num_(chain_a_prior_num_max), + chain_a_prior_num_max_(chain_a_prior_num_max), + chain_b_link_num_(chain_b_link_num_max), + chain_b_link_num_max_(chain_b_link_num_max), + chain_b_prior_num_(chain_b_prior_num_max), + chain_b_prior_num_max_(chain_b_prior_num_max), + chain_coupling_num_(chain_coupling_num_max), + chain_coupling_num_max_(chain_coupling_num_max) { + indices_valid_ = false; + if (params.pcg_rel_error_exit <= 0.0f) { + throw std::runtime_error("params.pcg_rel_error_exit must be positive"); + } + if (params.diag_init < 0.0f) { + throw std::runtime_error("params.diag_init must be positive"); + } + if (params.pcg_iter_max < 1) { + throw std::runtime_error("params.pcg_iter_max must be at least 1"); + } + allocation_size_ = get_nbytes(); + + if (device_id_ < 0) { + throw std::runtime_error("Invalid CUDA device id: " + std::to_string(device_id_)); + } + if (device_id_ != 0) { + int deviceCount; + cudaGetDeviceCount(&deviceCount); + if (deviceCount <= device_id_) { + throw std::runtime_error("CUDA detected " + std::to_string(deviceCount) + + " devices, but device " + std::to_string(device_id_) + + " was requested (0-indexed)"); + } + } + cudaSetDevice(device_id_); + cudaMalloc(&origin_ptr_, allocation_size_); + + size_t offset = 0; + marker__start_ = assign_and_increment(origin_ptr_, offset, 0 * 0, 4); + nodes__ChainA__storage_current_ = + assign_and_increment(origin_ptr_, offset, 2 * ChainA_num_, 4); + nodes__ChainA__storage_check_ = + assign_and_increment(origin_ptr_, offset, 2 * ChainA_num_, 4); + nodes__ChainA__storage_new_best_ = + assign_and_increment(origin_ptr_, offset, 2 * ChainA_num_, 4); + nodes__ChainB__storage_current_ = + assign_and_increment(origin_ptr_, offset, 4 * ChainB_num_, 4); + nodes__ChainB__storage_check_ = + assign_and_increment(origin_ptr_, offset, 4 * ChainB_num_, 4); + nodes__ChainB__storage_new_best_ = + assign_and_increment(origin_ptr_, offset, 4 * ChainB_num_, 4); + facs__chain_a_link__args__a__idx_shared_ = + assign_and_increment(origin_ptr_, offset, 1 * chain_a_link_num_, 4); + facs__chain_a_link__args__weight__data_ = + assign_and_increment(origin_ptr_, offset, 4 * chain_a_link_num_, 4); + facs__chain_a_link__args__offset__data_ = + assign_and_increment(origin_ptr_, offset, 2 * chain_a_link_num_, 4); + facs__chain_a_prior__args__a__idx_shared_ = + assign_and_increment(origin_ptr_, offset, 1 * chain_a_prior_num_, 4); + facs__chain_a_prior__args__target__data_ = + assign_and_increment(origin_ptr_, offset, 2 * chain_a_prior_num_, 4); + facs__chain_b_link__args__b__idx_shared_ = + assign_and_increment(origin_ptr_, offset, 1 * chain_b_link_num_, 4); + facs__chain_b_link__args__weight__data_ = + assign_and_increment(origin_ptr_, offset, 9 * chain_b_link_num_, 4); + facs__chain_b_link__args__offset__data_ = + assign_and_increment(origin_ptr_, offset, 4 * chain_b_link_num_, 4); + facs__chain_b_prior__args__b__idx_shared_ = + assign_and_increment(origin_ptr_, offset, 1 * chain_b_prior_num_, 4); + facs__chain_b_prior__args__target__data_ = + assign_and_increment(origin_ptr_, offset, 4 * chain_b_prior_num_, 4); + facs__chain_coupling__args__a__idx_shared_ = + assign_and_increment(origin_ptr_, offset, 1 * chain_coupling_num_, 4); + facs__chain_coupling__args__b__idx_shared_ = + assign_and_increment(origin_ptr_, offset, 1 * chain_coupling_num_, 4); + facs__chain_coupling__args__weight__data_ = + assign_and_increment(origin_ptr_, offset, 6 * chain_coupling_num_, 4); + facs__chain_coupling__args__offset__data_ = + assign_and_increment(origin_ptr_, offset, 2 * chain_coupling_num_, 4); + marker__scratch_inout_ = assign_and_increment(origin_ptr_, offset, 0 * 0, 4); + facs__chain_a_link__res_ = + assign_and_increment(origin_ptr_, offset, 2 * chain_a_link_num_, 4); + facs__chain_a_prior__res_ = + assign_and_increment(origin_ptr_, offset, 2 * chain_a_prior_num_, 4); + facs__chain_b_link__res_ = + assign_and_increment(origin_ptr_, offset, 4 * chain_b_link_num_, 4); + facs__chain_b_prior__res_ = + assign_and_increment(origin_ptr_, offset, 4 * chain_b_prior_num_, 4); + facs__chain_coupling__res_ = + assign_and_increment(origin_ptr_, offset, 2 * chain_coupling_num_, 4); + facs__chain_a_link__args__a__jac_first_ = + assign_and_increment(origin_ptr_, offset, 4 * chain_a_link_num_, 4); + facs__chain_a_link__args__a__jac_second_ = + assign_and_increment(origin_ptr_, offset, 4 * chain_a_link_num_, 4); + nodes__ChainA__tridig_U_ = assign_and_increment(origin_ptr_, offset, 4 * ChainA_num_, 4); + facs__chain_a_prior__args__a__jac_ = + assign_and_increment(origin_ptr_, offset, 0 * chain_a_prior_num_, 4); + facs__chain_b_link__args__b__jac_first_ = + assign_and_increment(origin_ptr_, offset, 9 * chain_b_link_num_, 4); + facs__chain_b_link__args__b__jac_second_ = + assign_and_increment(origin_ptr_, offset, 9 * chain_b_link_num_, 4); + nodes__ChainB__tridig_U_ = assign_and_increment(origin_ptr_, offset, 9 * ChainB_num_, 4); + facs__chain_b_prior__args__b__jac_ = + assign_and_increment(origin_ptr_, offset, 0 * chain_b_prior_num_, 4); + facs__chain_coupling__args__a__jac_ = + assign_and_increment(origin_ptr_, offset, 0 * chain_coupling_num_, 4); + facs__chain_coupling__args__b__jac_ = + assign_and_increment(origin_ptr_, offset, 6 * chain_coupling_num_, 4); + nodes__ChainA__z_ = assign_and_increment(origin_ptr_, offset, 2 * ChainA_num_, 4); + nodes__ChainA__z_end__ = assign_and_increment(origin_ptr_, offset, 0 * 0, 4); + nodes__ChainB__z_ = assign_and_increment(origin_ptr_, offset, 4 * ChainB_num_, 4); + nodes__ChainB__z_end__ = assign_and_increment(origin_ptr_, offset, 0 * 0, 4); + nodes__ChainA__p_ = assign_and_increment(origin_ptr_, offset, 2 * ChainA_num_, 4); + nodes__ChainA__p_end__ = assign_and_increment(origin_ptr_, offset, 0 * 0, 4); + nodes__ChainB__p_ = assign_and_increment(origin_ptr_, offset, 4 * ChainB_num_, 4); + nodes__ChainB__p_end__ = assign_and_increment(origin_ptr_, offset, 0 * 0, 4); + nodes__ChainA__step_ = assign_and_increment(origin_ptr_, offset, 2 * ChainA_num_, 4); + nodes__ChainA__step_end__ = assign_and_increment(origin_ptr_, offset, 0 * 0, 4); + nodes__ChainB__step_ = assign_and_increment(origin_ptr_, offset, 4 * ChainB_num_, 4); + nodes__ChainB__step_end__ = assign_and_increment(origin_ptr_, offset, 0 * 0, 4); + marker__w_start_ = assign_and_increment(origin_ptr_, offset, 0 * 0, 4); + nodes__ChainA__w_ = assign_and_increment(origin_ptr_, offset, 2 * ChainA_num_, 4); + nodes__ChainB__w_ = assign_and_increment(origin_ptr_, offset, 4 * ChainB_num_, 4); + marker__w_end_ = assign_and_increment(origin_ptr_, offset, 0 * 0, 1); + marker__r_0_start_ = assign_and_increment(origin_ptr_, offset, 0 * 0, 4); + nodes__ChainA__r_0_ = assign_and_increment(origin_ptr_, offset, 2 * ChainA_num_, 4); + nodes__ChainB__r_0_ = assign_and_increment(origin_ptr_, offset, 4 * ChainB_num_, 4); + marker__r_0_end_ = assign_and_increment(origin_ptr_, offset, 0 * 0, 4); + marker__r_k_start_ = assign_and_increment(origin_ptr_, offset, 0 * 0, 4); + nodes__ChainA__r_k_ = assign_and_increment(origin_ptr_, offset, 2 * ChainA_num_, 4); + nodes__ChainB__r_k_ = assign_and_increment(origin_ptr_, offset, 4 * ChainB_num_, 4); + marker__r_k_end_ = assign_and_increment(origin_ptr_, offset, 0 * 0, 4); + marker__Mp_start_ = assign_and_increment(origin_ptr_, offset, 0 * 0, 4); + nodes__ChainA__Mp_ = assign_and_increment(origin_ptr_, offset, 2 * ChainA_num_, 4); + nodes__ChainB__Mp_ = assign_and_increment(origin_ptr_, offset, 4 * ChainB_num_, 4); + marker__Mp_end_ = assign_and_increment(origin_ptr_, offset, 0 * 0, 4); + marker__precond_start_ = assign_and_increment(origin_ptr_, offset, 0 * 0, 4); + nodes__ChainA__precond_diag_ = + assign_and_increment(origin_ptr_, offset, 2 * ChainA_num_, 4); + nodes__ChainA__precond_tril_ = + assign_and_increment(origin_ptr_, offset, 1 * ChainA_num_, 4); + nodes__ChainB__precond_diag_ = + assign_and_increment(origin_ptr_, offset, 4 * ChainB_num_, 4); + nodes__ChainB__precond_tril_ = + assign_and_increment(origin_ptr_, offset, 4 * ChainB_num_, 4); + marker__precond_end_ = assign_and_increment(origin_ptr_, offset, 0 * 0, 1); + marker__jp_start_ = assign_and_increment(origin_ptr_, offset, 0 * 0, 4); + facs__chain_a_link__jp_ = + assign_and_increment(origin_ptr_, offset, 2 * chain_a_link_num_, 4); + facs__chain_a_prior__jp_ = + assign_and_increment(origin_ptr_, offset, 2 * chain_a_prior_num_, 4); + facs__chain_b_link__jp_ = + assign_and_increment(origin_ptr_, offset, 4 * chain_b_link_num_, 4); + facs__chain_b_prior__jp_ = + assign_and_increment(origin_ptr_, offset, 4 * chain_b_prior_num_, 4); + facs__chain_coupling__jp_ = + assign_and_increment(origin_ptr_, offset, 2 * chain_coupling_num_, 4); + marker__jp_end_ = assign_and_increment(origin_ptr_, offset, 0 * 0, 1); + solver__current_diag_ = assign_and_increment(origin_ptr_, offset, 1 * 1, 1); + solver__alpha_numerator_ = assign_and_increment(origin_ptr_, offset, 1 * 1, 1); + solver__alpha_denominator_ = assign_and_increment(origin_ptr_, offset, 1 * 1, 1); + solver__alpha_ = assign_and_increment(origin_ptr_, offset, 1 * 1, 1); + solver__neg_alpha_ = assign_and_increment(origin_ptr_, offset, 1 * 1, 1); + solver__beta_numerator_ = assign_and_increment(origin_ptr_, offset, 1 * 1, 1); + solver__beta_ = assign_and_increment(origin_ptr_, offset, 1 * 1, 1); + solver__r_0_norm2_tot_ = assign_and_increment(origin_ptr_, offset, 1 * 1, 1); + solver__r_kp1_norm2_tot_ = assign_and_increment(origin_ptr_, offset, 1 * 1, 1); + solver__pred_decrease_tot_ = assign_and_increment(origin_ptr_, offset, 1 * 1, 1); + solver__res_tot_ = assign_and_increment(origin_ptr_, offset, 1 * 1, 1); + nodes__ChainA__tridig_eq_ = + assign_and_increment(origin_ptr_, offset, 20 * ChainA_num_, 4); + nodes__ChainB__tridig_eq_ = + assign_and_increment(origin_ptr_, offset, 42 * ChainB_num_, 4); + + scratch_inout_size_ = offset; // sorting, sum, +} + +GraphSolver::~GraphSolver() { + cudaSetDevice(device_id_); + cudaFree(origin_ptr_); +} + +void GraphSolver::set_params(const SolverParams& params) { + this->params_ = params; +} + +size_t GraphSolver::get_allocation_size() { + return allocation_size_; +} + +SolveResult GraphSolver::solve(bool print_progress, bool verbose_logging) { + cudaSetDevice(device_id_); + SolveResult result; + result.exit_reason = ExitReason::MAX_ITERATIONS; + double score_best; + double score_best_pcg; + double diag = params_.diag_init; + cudaMemcpy(solver__current_diag_, &diag, sizeof(double), cudaMemcpyHostToDevice); + + double up_scale = params_.diag_scaling_up; + double quality; + + std::chrono::time_point t0 = std::chrono::steady_clock::now(); + std::chrono::time_point t_prev = t0; + score_best = DoResJacFirst(); + result.initial_score = score_best; + if (print_progress) { + printf(" score_init: % .6e\n", score_best); + } + + for (solver_iter_ = 0; solver_iter_ < params_.solver_iter_max; solver_iter_++) { + if (solver_iter_ != 0) { + DoResJac(); + } + score_best_pcg = score_best; + // The inner loop can break before storing a proposal in storage_new_best_. + bool have_pcg_proposal = false; + for (pcg_iter_ = 0; pcg_iter_ < params_.pcg_iter_max; pcg_iter_++) { + DoNormalize(); + + if (pcg_iter_ == 0) { + Copy(marker__r_k_start_, marker__r_k_end_, marker__w_start_); + DoJtjpDirect(); + DoAlphaFirst(); + DoUpdateStepFirst(); + DoUpdateRFirst(); + } else { + DoBeta(); + DoUpdateP(); + DoUpdateMp(); + DoJtjpDirect(); + DoAlpha(); + DoUpdateStep(); + DoUpdateR(); + } + if (params_.pcg_rel_decrease_min != -1.0f || params_.pcg_rel_score_exit != -1.0f) { + double score_new_pcg = DoRetractScore(); + if (!(score_new_pcg <= score_best_pcg * params_.pcg_rel_decrease_min)) { + break; + } + std::swap(nodes__ChainA__storage_check_, nodes__ChainA__storage_new_best_); + std::swap(nodes__ChainB__storage_check_, nodes__ChainB__storage_new_best_); + score_best_pcg = score_new_pcg; + have_pcg_proposal = true; + if (params_.pcg_rel_score_exit != -1.0f && + score_best_pcg < score_best * params_.pcg_rel_score_exit) { + break; + } + } + if (pcg_r_kp1_norm2_ < pcg_r_0_norm2_ * params_.pcg_rel_error_exit) { + break; + } + } + pcg_iter_ = std::min(pcg_iter_, params_.pcg_iter_max - 1); + + if (params_.pcg_rel_decrease_min == -1.0f && params_.pcg_rel_score_exit == -1.0f) { + score_best_pcg = DoRetractScore(); + std::swap(nodes__ChainA__storage_check_, nodes__ChainA__storage_new_best_); + std::swap(nodes__ChainB__storage_check_, nodes__ChainB__storage_new_best_); + have_pcg_proposal = true; + } + + const double diag_current = diag; + bool step_accepted = false; + if (have_pcg_proposal && score_best_pcg < score_best * params_.solver_rel_decrease_min) { + quality = (score_best - score_best_pcg) / GetPredDecrease(); + const double quality_tmp = 2 * quality - 1; + double scale = + std::max(params_.diag_scaling_down, 1.0f - quality_tmp * quality_tmp * quality_tmp); + diag = std::max(params_.diag_min, diag * scale); + cudaMemcpy(solver__current_diag_, &diag, sizeof(double), cudaMemcpyHostToDevice); + up_scale = params_.diag_scaling_up; + score_best = score_best_pcg; + step_accepted = true; + std::swap(nodes__ChainA__storage_current_, nodes__ChainA__storage_new_best_); + std::swap(nodes__ChainB__storage_current_, nodes__ChainB__storage_new_best_); + + } else { + quality = 0.0f; + diag = diag * up_scale; + if (diag > params_.diag_exit_value) { + result.exit_reason = ExitReason::CONVERGED_DIAG_EXIT; + break; + } + cudaMemcpy(solver__current_diag_, &diag, sizeof(double), cudaMemcpyHostToDevice); + up_scale *= 2; + } + const auto t_now = std::chrono::steady_clock::now(); + const double dt_inc = std::chrono::duration(t_now - t_prev).count(); + const double dt_tot = std::chrono::duration(t_now - t0).count(); + + if (verbose_logging) { + IterationData iter_data; + iter_data.solver_iter = solver_iter_; + iter_data.pcg_iter = pcg_iter_; + iter_data.score_current = score_best_pcg; + iter_data.score_best = score_best; + iter_data.step_quality = quality; + iter_data.diag = diag_current; + iter_data.dt_inc = dt_inc; + iter_data.dt_tot = dt_tot; + iter_data.step_accepted = step_accepted; + result.iterations.push_back(iter_data); + } + + if (print_progress) { + printf("solver_iter: % 3d ", solver_iter_); + printf("pcg_iter: % 3d ", pcg_iter_); + printf("score_current: % 13.6e ", score_best_pcg); + printf("score_best: % 13.6e ", score_best); + printf("step_quality: % 7.3f ", quality); + printf("diag: % 6.3e ", diag_current); + printf("dt_inc: % 10.6f ", dt_inc); + printf("dt_tot: % 10.6f ", dt_tot); + t_prev = t_now; + printf("\n"); + } + if (score_best <= params_.score_exit_value) { + result.exit_reason = ExitReason::CONVERGED_SCORE_THRESHOLD; + break; + } + } + + const auto t_final = std::chrono::steady_clock::now(); + result.final_score = score_best; + result.iteration_count = solver_iter_; + result.runtime = std::chrono::duration(t_final - t0).count(); + return result; +} + +double GraphSolver::DoResJacFirst() { + Zero(solver__res_tot_, solver__res_tot_ + 1); + Zero(marker__r_0_start_, marker__precond_end_); + + ChainALinkResJacFirst( + nodes__ChainA__storage_current_, ChainA_num_max_, facs__chain_a_link__args__weight__data_, + chain_a_link_num_max_, facs__chain_a_link__args__offset__data_, chain_a_link_num_max_, + + facs__chain_a_link__res_, chain_a_link_num_, solver__res_tot_, nodes__ChainA__tridig_U_, + ChainA_num_ - 1, nodes__ChainA__r_k_, ChainA_num_, nodes__ChainA__precond_diag_, ChainA_num_, + nodes__ChainA__precond_tril_, ChainA_num_, chain_a_link_num_); + + ChainAPriorResJacFirst( + nodes__ChainA__storage_current_, ChainA_num_max_, facs__chain_a_prior__args__a__idx_shared_, + facs__chain_a_prior__args__target__data_, chain_a_prior_num_max_, + + facs__chain_a_prior__res_, chain_a_prior_num_, solver__res_tot_, nodes__ChainA__r_k_, + ChainA_num_, nodes__ChainA__precond_diag_, ChainA_num_, nodes__ChainA__precond_tril_, + ChainA_num_, chain_a_prior_num_); + + ChainBLinkResJacFirst( + nodes__ChainB__storage_current_, ChainB_num_max_, facs__chain_b_link__args__weight__data_, + chain_b_link_num_max_, facs__chain_b_link__args__offset__data_, chain_b_link_num_max_, + + facs__chain_b_link__res_, chain_b_link_num_, solver__res_tot_, nodes__ChainB__tridig_U_, + ChainB_num_ - 1, nodes__ChainB__r_k_, ChainB_num_, nodes__ChainB__precond_diag_, ChainB_num_, + nodes__ChainB__precond_tril_, ChainB_num_, chain_b_link_num_); + + ChainBPriorResJacFirst( + nodes__ChainB__storage_current_, ChainB_num_max_, facs__chain_b_prior__args__b__idx_shared_, + facs__chain_b_prior__args__target__data_, chain_b_prior_num_max_, + + facs__chain_b_prior__res_, chain_b_prior_num_, solver__res_tot_, nodes__ChainB__r_k_, + ChainB_num_, nodes__ChainB__precond_diag_, ChainB_num_, nodes__ChainB__precond_tril_, + ChainB_num_, chain_b_prior_num_); + + ChainCouplingResJacFirst( + nodes__ChainA__storage_current_, ChainA_num_max_, facs__chain_coupling__args__a__idx_shared_, + nodes__ChainB__storage_current_, ChainB_num_max_, facs__chain_coupling__args__b__idx_shared_, + facs__chain_coupling__args__weight__data_, chain_coupling_num_max_, + facs__chain_coupling__args__offset__data_, chain_coupling_num_max_, + + facs__chain_coupling__res_, chain_coupling_num_, solver__res_tot_, + facs__chain_coupling__args__a__jac_, chain_coupling_num_, nodes__ChainA__r_k_, ChainA_num_, + nodes__ChainA__precond_diag_, ChainA_num_, nodes__ChainA__precond_tril_, ChainA_num_, + facs__chain_coupling__args__b__jac_, chain_coupling_num_, nodes__ChainB__r_k_, ChainB_num_, + nodes__ChainB__precond_diag_, ChainB_num_, nodes__ChainB__precond_tril_, ChainB_num_, + chain_coupling_num_); + Copy(marker__r_k_start_, marker__r_k_end_, marker__r_0_start_); + Copy(marker__r_k_start_, marker__r_k_end_, marker__Mp_start_); + return 0.5 * ReadCuMem(solver__res_tot_); +} +void GraphSolver::DoResJac() { + Zero(solver__res_tot_, solver__res_tot_ + 1); + Zero(marker__r_0_start_, marker__precond_end_); + + ChainALinkResJac(nodes__ChainA__storage_current_, ChainA_num_max_, + facs__chain_a_link__args__weight__data_, chain_a_link_num_max_, + facs__chain_a_link__args__offset__data_, chain_a_link_num_max_, + + facs__chain_a_link__res_, chain_a_link_num_, + + nodes__ChainA__tridig_U_, ChainA_num_ - 1, nodes__ChainA__r_k_, ChainA_num_, + nodes__ChainA__precond_diag_, ChainA_num_, nodes__ChainA__precond_tril_, + ChainA_num_, chain_a_link_num_); + + ChainAPriorResJac(nodes__ChainA__storage_current_, ChainA_num_max_, + facs__chain_a_prior__args__a__idx_shared_, + facs__chain_a_prior__args__target__data_, chain_a_prior_num_max_, + + facs__chain_a_prior__res_, chain_a_prior_num_, + + nodes__ChainA__r_k_, ChainA_num_, nodes__ChainA__precond_diag_, ChainA_num_, + nodes__ChainA__precond_tril_, ChainA_num_, chain_a_prior_num_); + + ChainBLinkResJac(nodes__ChainB__storage_current_, ChainB_num_max_, + facs__chain_b_link__args__weight__data_, chain_b_link_num_max_, + facs__chain_b_link__args__offset__data_, chain_b_link_num_max_, + + facs__chain_b_link__res_, chain_b_link_num_, + + nodes__ChainB__tridig_U_, ChainB_num_ - 1, nodes__ChainB__r_k_, ChainB_num_, + nodes__ChainB__precond_diag_, ChainB_num_, nodes__ChainB__precond_tril_, + ChainB_num_, chain_b_link_num_); + + ChainBPriorResJac(nodes__ChainB__storage_current_, ChainB_num_max_, + facs__chain_b_prior__args__b__idx_shared_, + facs__chain_b_prior__args__target__data_, chain_b_prior_num_max_, + + facs__chain_b_prior__res_, chain_b_prior_num_, + + nodes__ChainB__r_k_, ChainB_num_, nodes__ChainB__precond_diag_, ChainB_num_, + nodes__ChainB__precond_tril_, ChainB_num_, chain_b_prior_num_); + + ChainCouplingResJac( + nodes__ChainA__storage_current_, ChainA_num_max_, facs__chain_coupling__args__a__idx_shared_, + nodes__ChainB__storage_current_, ChainB_num_max_, facs__chain_coupling__args__b__idx_shared_, + facs__chain_coupling__args__weight__data_, chain_coupling_num_max_, + facs__chain_coupling__args__offset__data_, chain_coupling_num_max_, + + facs__chain_coupling__res_, chain_coupling_num_, + + facs__chain_coupling__args__a__jac_, chain_coupling_num_, nodes__ChainA__r_k_, ChainA_num_, + nodes__ChainA__precond_diag_, ChainA_num_, nodes__ChainA__precond_tril_, ChainA_num_, + facs__chain_coupling__args__b__jac_, chain_coupling_num_, nodes__ChainB__r_k_, ChainB_num_, + nodes__ChainB__precond_diag_, ChainB_num_, nodes__ChainB__precond_tril_, ChainB_num_, + chain_coupling_num_); + Copy(marker__r_k_start_, marker__r_k_end_, marker__r_0_start_); + Copy(marker__r_k_start_, marker__r_k_end_, marker__Mp_start_); +} + +void GraphSolver::DoNormalize() { + double* z; + z = pcg_iter_ == 0 ? nodes__ChainA__p_ : nodes__ChainA__z_; + if (ChainA_num_ < 2) { + // Without a second node there are no off-diagonal blocks, and the cyclic + // reduction would write a second node's solution. + ChainANormalize(nodes__ChainA__precond_diag_, ChainA_num_, nodes__ChainA__precond_tril_, + ChainA_num_, nodes__ChainA__r_k_, ChainA_num_, solver__current_diag_, z, + ChainA_num_, ChainA_num_); + } else { + Zero(z, pcg_iter_ == 0 ? nodes__ChainA__p_end__ : nodes__ChainA__z_end__); + ChainATridigMakeEq(nodes__ChainA__precond_diag_, ChainA_num_, nodes__ChainA__precond_tril_, + ChainA_num_, nodes__ChainA__tridig_U_, ChainA_num_ - 1, -1, 1, + nodes__ChainA__r_k_, ChainA_num_, solver__current_diag_, + nodes__ChainA__tridig_eq_, ChainA_num_, ChainA_num_); + int i; + int offset = 0; + int remaining = ChainA_num_; + for (i = 0; 2 << i < ChainA_num_; i++) { + offset += (~remaining & 1) << i; + remaining = (remaining + 1) >> 1; + + ChainACyclicReductionDown(nodes__ChainA__tridig_eq_, ChainA_num_, offset, (2 << i), + nodes__ChainA__tridig_eq_, ChainA_num_, offset - (1 << i), (2 << i), + nodes__ChainA__tridig_eq_, ChainA_num_, offset, (2 << i), + remaining); + } + i--; + + ChainACyclicReductionSolveTwo(nodes__ChainA__tridig_eq_, ChainA_num_, offset, (1 << (i + 1)), z, + ChainA_num_, offset, 1, z, ChainA_num_, offset + (1 << (i + 1)), + 1, 1); + + for (; i >= 0; i--) { + int is_odd = offset < 1 << i; + int shift = (is_odd * 2 - 1) * (1 << i); + + ChainACyclicReductionUp(nodes__ChainA__tridig_eq_, ChainA_num_, offset + shift, (2 << i), z, + ChainA_num_, offset + shift - (1 << i), (2 << i), z, ChainA_num_, + offset + shift, (2 << i), remaining - is_odd); + offset += shift * (!is_odd); + remaining = remaining * 2 - is_odd; + } + } + z = pcg_iter_ == 0 ? nodes__ChainB__p_ : nodes__ChainB__z_; + if (ChainB_num_ < 2) { + // Without a second node there are no off-diagonal blocks, and the cyclic + // reduction would write a second node's solution. + ChainBNormalize(nodes__ChainB__precond_diag_, ChainB_num_, nodes__ChainB__precond_tril_, + ChainB_num_, nodes__ChainB__r_k_, ChainB_num_, solver__current_diag_, z, + ChainB_num_, ChainB_num_); + } else { + Zero(z, pcg_iter_ == 0 ? nodes__ChainB__p_end__ : nodes__ChainB__z_end__); + ChainBTridigMakeEq(nodes__ChainB__precond_diag_, ChainB_num_, nodes__ChainB__precond_tril_, + ChainB_num_, nodes__ChainB__tridig_U_, ChainB_num_ - 1, -1, 1, + nodes__ChainB__r_k_, ChainB_num_, solver__current_diag_, + nodes__ChainB__tridig_eq_, ChainB_num_, ChainB_num_); + int i; + int offset = 0; + int remaining = ChainB_num_; + for (i = 0; 2 << i < ChainB_num_; i++) { + offset += (~remaining & 1) << i; + remaining = (remaining + 1) >> 1; + + ChainBCyclicReductionDown(nodes__ChainB__tridig_eq_, ChainB_num_, offset, (2 << i), + nodes__ChainB__tridig_eq_, ChainB_num_, offset - (1 << i), (2 << i), + nodes__ChainB__tridig_eq_, ChainB_num_, offset, (2 << i), + remaining); + } + i--; + + ChainBCyclicReductionSolveTwo(nodes__ChainB__tridig_eq_, ChainB_num_, offset, (1 << (i + 1)), z, + ChainB_num_, offset, 1, z, ChainB_num_, offset + (1 << (i + 1)), + 1, 1); + + for (; i >= 0; i--) { + int is_odd = offset < 1 << i; + int shift = (is_odd * 2 - 1) * (1 << i); + + ChainBCyclicReductionUp(nodes__ChainB__tridig_eq_, ChainB_num_, offset + shift, (2 << i), z, + ChainB_num_, offset + shift - (1 << i), (2 << i), z, ChainB_num_, + offset + shift, (2 << i), remaining - is_odd); + offset += shift * (!is_odd); + remaining = remaining * 2 - is_odd; + } + } +} + +void GraphSolver::DoUpdateMp() { + ChainAUpdateMp(nodes__ChainA__r_k_, ChainA_num_, nodes__ChainA__Mp_, ChainA_num_, solver__beta_, + nodes__ChainA__Mp_, ChainA_num_, nodes__ChainA__w_, ChainA_num_, ChainA_num_); + ChainBUpdateMp(nodes__ChainB__r_k_, ChainB_num_, nodes__ChainB__Mp_, ChainB_num_, solver__beta_, + nodes__ChainB__Mp_, ChainB_num_, nodes__ChainB__w_, ChainB_num_, ChainB_num_); +} + +void GraphSolver::DoJtjpDirect() { + ChainCouplingJtjnjtrDirect( + nodes__ChainA__p_, ChainA_num_, facs__chain_coupling__args__a__idx_shared_, + facs__chain_coupling__args__a__jac_, chain_coupling_num_, nodes__ChainB__p_, ChainB_num_, + facs__chain_coupling__args__b__idx_shared_, facs__chain_coupling__args__b__jac_, + chain_coupling_num_, nodes__ChainA__w_, ChainA_num_, nodes__ChainB__w_, ChainB_num_, + chain_coupling_num_); +} + +void GraphSolver::DoAlphaFirst() { + Zero(solver__alpha_numerator_, solver__alpha_denominator_ + 1); + ChainAAlphaNumeratorDenominator(nodes__ChainA__p_, ChainA_num_, nodes__ChainA__r_k_, ChainA_num_, + nodes__ChainA__w_, ChainA_num_, solver__alpha_numerator_, + solver__alpha_denominator_, ChainA_num_); + ChainBAlphaNumeratorDenominator(nodes__ChainB__p_, ChainB_num_, nodes__ChainB__r_k_, ChainB_num_, + nodes__ChainB__w_, ChainB_num_, solver__alpha_numerator_, + solver__alpha_denominator_, ChainB_num_); + + AlphaFromNumDenom(solver__alpha_numerator_, solver__alpha_denominator_, solver__alpha_, + solver__neg_alpha_); +} + +void GraphSolver::DoAlpha() { + Zero(solver__alpha_denominator_, solver__alpha_denominator_ + 1); + ChainAAlphaDenominatorOrBetaNumerator(nodes__ChainA__p_, ChainA_num_, nodes__ChainA__w_, + ChainA_num_, solver__alpha_denominator_, ChainA_num_); + ChainBAlphaDenominatorOrBetaNumerator(nodes__ChainB__p_, ChainB_num_, nodes__ChainB__w_, + ChainB_num_, solver__alpha_denominator_, ChainB_num_); + + AlphaFromNumDenom(solver__beta_numerator_, solver__alpha_denominator_, solver__alpha_, + solver__neg_alpha_); +} + +void GraphSolver::DoUpdateStepFirst() { + ChainAUpdateStepFirst(nodes__ChainA__p_, ChainA_num_, solver__alpha_, nodes__ChainA__step_, + ChainA_num_, ChainA_num_); + ChainBUpdateStepFirst(nodes__ChainB__p_, ChainB_num_, solver__alpha_, nodes__ChainB__step_, + ChainB_num_, ChainB_num_); +} + +void GraphSolver::DoUpdateStep() { + ChainAUpdateStep(nodes__ChainA__step_, ChainA_num_, nodes__ChainA__p_, ChainA_num_, + solver__alpha_, nodes__ChainA__step_, ChainA_num_, ChainA_num_); + ChainBUpdateStep(nodes__ChainB__step_, ChainB_num_, nodes__ChainB__p_, ChainB_num_, + solver__alpha_, nodes__ChainB__step_, ChainB_num_, ChainB_num_); +} + +void GraphSolver::DoUpdateRFirst() { + Zero(solver__r_0_norm2_tot_, solver__r_0_norm2_tot_ + 1); + + ChainAUpdateRFirst(nodes__ChainA__r_k_, ChainA_num_, nodes__ChainA__w_, ChainA_num_, + solver__neg_alpha_, nodes__ChainA__r_k_, ChainA_num_, solver__r_0_norm2_tot_, + solver__r_kp1_norm2_tot_, ChainA_num_); + + ChainBUpdateRFirst(nodes__ChainB__r_k_, ChainB_num_, nodes__ChainB__w_, ChainB_num_, + solver__neg_alpha_, nodes__ChainB__r_k_, ChainB_num_, solver__r_0_norm2_tot_, + solver__r_kp1_norm2_tot_, ChainB_num_); + + pcg_r_0_norm2_ = ReadCuMem(solver__r_0_norm2_tot_); + pcg_r_kp1_norm2_ = ReadCuMem(solver__r_kp1_norm2_tot_); +} + +void GraphSolver::DoUpdateR() { + Zero(solver__r_kp1_norm2_tot_, solver__r_kp1_norm2_tot_ + 1); + + ChainAUpdateR(nodes__ChainA__r_k_, ChainA_num_, nodes__ChainA__w_, ChainA_num_, + solver__neg_alpha_, nodes__ChainA__r_k_, ChainA_num_, solver__r_kp1_norm2_tot_, + ChainA_num_); + ChainBUpdateR(nodes__ChainB__r_k_, ChainB_num_, nodes__ChainB__w_, ChainB_num_, + solver__neg_alpha_, nodes__ChainB__r_k_, ChainB_num_, solver__r_kp1_norm2_tot_, + ChainB_num_); + pcg_r_kp1_norm2_ = ReadCuMem(solver__r_kp1_norm2_tot_); +} + +double GraphSolver::DoRetractScore() { + ChainARetract(nodes__ChainA__storage_current_, ChainA_num_max_, nodes__ChainA__step_, ChainA_num_, + nodes__ChainA__storage_check_, ChainA_num_max_, ChainA_num_); + ChainBRetract(nodes__ChainB__storage_current_, ChainB_num_max_, nodes__ChainB__step_, ChainB_num_, + nodes__ChainB__storage_check_, ChainB_num_max_, ChainB_num_); + Zero(solver__res_tot_, solver__res_tot_ + 1); + ChainALinkScore(nodes__ChainA__storage_check_, ChainA_num_max_, + facs__chain_a_link__args__weight__data_, chain_a_link_num_max_, + facs__chain_a_link__args__offset__data_, chain_a_link_num_max_, solver__res_tot_, + chain_a_link_num_); + ChainAPriorScore(nodes__ChainA__storage_check_, ChainA_num_max_, + facs__chain_a_prior__args__a__idx_shared_, + facs__chain_a_prior__args__target__data_, chain_a_prior_num_max_, + solver__res_tot_, chain_a_prior_num_); + ChainBLinkScore(nodes__ChainB__storage_check_, ChainB_num_max_, + facs__chain_b_link__args__weight__data_, chain_b_link_num_max_, + facs__chain_b_link__args__offset__data_, chain_b_link_num_max_, solver__res_tot_, + chain_b_link_num_); + ChainBPriorScore(nodes__ChainB__storage_check_, ChainB_num_max_, + facs__chain_b_prior__args__b__idx_shared_, + facs__chain_b_prior__args__target__data_, chain_b_prior_num_max_, + solver__res_tot_, chain_b_prior_num_); + ChainCouplingScore(nodes__ChainA__storage_check_, ChainA_num_max_, + facs__chain_coupling__args__a__idx_shared_, nodes__ChainB__storage_check_, + ChainB_num_max_, facs__chain_coupling__args__b__idx_shared_, + facs__chain_coupling__args__weight__data_, chain_coupling_num_max_, + facs__chain_coupling__args__offset__data_, chain_coupling_num_max_, + solver__res_tot_, chain_coupling_num_); + return 0.5 * ReadCuMem(solver__res_tot_); +} + +void GraphSolver::DoBeta() { + Zero(solver__beta_numerator_, solver__beta_numerator_ + 1); + + ChainAAlphaDenominatorOrBetaNumerator(nodes__ChainA__r_k_, ChainA_num_, nodes__ChainA__z_, + ChainA_num_, solver__beta_numerator_, ChainA_num_); + + ChainBAlphaDenominatorOrBetaNumerator(nodes__ChainB__r_k_, ChainB_num_, nodes__ChainB__z_, + ChainB_num_, solver__beta_numerator_, ChainB_num_); + BetaFromNumDenom(solver__beta_numerator_, solver__alpha_numerator_, solver__beta_); +} + +void GraphSolver::DoUpdateP() { + ChainAUpdateP(nodes__ChainA__z_, ChainA_num_, nodes__ChainA__p_, ChainA_num_, solver__beta_, + nodes__ChainA__p_, ChainA_num_, ChainA_num_); + ChainBUpdateP(nodes__ChainB__z_, ChainB_num_, nodes__ChainB__p_, ChainB_num_, solver__beta_, + nodes__ChainB__p_, ChainB_num_, ChainB_num_); +} + +double GraphSolver::GetPredDecrease() { + Zero(solver__pred_decrease_tot_, solver__pred_decrease_tot_ + 1); + ChainAPredDecreaseTimesTwo(nodes__ChainA__step_, ChainA_num_, nodes__ChainA__precond_diag_, + ChainA_num_, solver__current_diag_, nodes__ChainA__r_0_, ChainA_num_, + solver__pred_decrease_tot_, ChainA_num_); + ChainBPredDecreaseTimesTwo(nodes__ChainB__step_, ChainB_num_, nodes__ChainB__precond_diag_, + ChainB_num_, solver__current_diag_, nodes__ChainB__r_0_, ChainB_num_, + solver__pred_decrease_tot_, ChainB_num_); + return 0.5 * ReadCuMem(solver__pred_decrease_tot_); +} + +void GraphSolver::finish_indices() { + indices_valid_ = true; +} + +void GraphSolver::SetChainANum(const size_t num) { + cudaSetDevice(device_id_); + if (num > ChainA_num_max_) { + throw std::runtime_error(std::to_string(num) + " > ChainA_num_max_"); + } + ChainA_num_ = num; +} + +void GraphSolver::SetChainANodesFromStackedHost(const double* const data, const size_t offset, + const size_t num) { + cudaSetDevice(device_id_); + if (offset + num > ChainA_num_) { + throw std::runtime_error(std::to_string(offset + num) + " > ChainA_num_"); + } + cudaMemcpy(marker__scratch_inout_, data, 2 * num * sizeof(double), cudaMemcpyHostToDevice); + ChainAStackedToCaspar(marker__scratch_inout_, nodes__ChainA__storage_current_, ChainA_num_max_, + offset, num); +} + +void GraphSolver::SetChainANodesFromStackedDevice(const double* const data, const size_t offset, + const size_t num) { + cudaSetDevice(device_id_); + if (offset + num > ChainA_num_) { + throw std::runtime_error(std::to_string(offset + num) + " > ChainA_num_"); + } + ChainAStackedToCaspar(data, nodes__ChainA__storage_current_, ChainA_num_max_, offset, num); +} + +void GraphSolver::GetChainANodesToStackedHost(double* const data, const size_t offset, + const size_t num) { + cudaSetDevice(device_id_); + if (offset + num > ChainA_num_) { + throw std::runtime_error(std::to_string(offset + num) + " > ChainA_num_"); + } + ChainACasparToStacked(nodes__ChainA__storage_current_, marker__scratch_inout_, ChainA_num_max_, + offset, num); + cudaMemcpy(data, marker__scratch_inout_, 2 * num * sizeof(double), cudaMemcpyDeviceToHost); +} + +void GraphSolver::GetChainANodesToStackedDevice(double* const data, const size_t offset, + const size_t num) { + cudaSetDevice(device_id_); + if (offset + num > ChainA_num_) { + throw std::runtime_error(std::to_string(offset + num) + " > ChainA_num_"); + } + ChainACasparToStacked(nodes__ChainA__storage_current_, data, ChainA_num_max_, offset, num); +} + +void GraphSolver::SetChainBNum(const size_t num) { + cudaSetDevice(device_id_); + if (num > ChainB_num_max_) { + throw std::runtime_error(std::to_string(num) + " > ChainB_num_max_"); + } + ChainB_num_ = num; +} + +void GraphSolver::SetChainBNodesFromStackedHost(const double* const data, const size_t offset, + const size_t num) { + cudaSetDevice(device_id_); + if (offset + num > ChainB_num_) { + throw std::runtime_error(std::to_string(offset + num) + " > ChainB_num_"); + } + cudaMemcpy(marker__scratch_inout_, data, 3 * num * sizeof(double), cudaMemcpyHostToDevice); + ChainBStackedToCaspar(marker__scratch_inout_, nodes__ChainB__storage_current_, ChainB_num_max_, + offset, num); +} + +void GraphSolver::SetChainBNodesFromStackedDevice(const double* const data, const size_t offset, + const size_t num) { + cudaSetDevice(device_id_); + if (offset + num > ChainB_num_) { + throw std::runtime_error(std::to_string(offset + num) + " > ChainB_num_"); + } + ChainBStackedToCaspar(data, nodes__ChainB__storage_current_, ChainB_num_max_, offset, num); +} + +void GraphSolver::GetChainBNodesToStackedHost(double* const data, const size_t offset, + const size_t num) { + cudaSetDevice(device_id_); + if (offset + num > ChainB_num_) { + throw std::runtime_error(std::to_string(offset + num) + " > ChainB_num_"); + } + ChainBCasparToStacked(nodes__ChainB__storage_current_, marker__scratch_inout_, ChainB_num_max_, + offset, num); + cudaMemcpy(data, marker__scratch_inout_, 3 * num * sizeof(double), cudaMemcpyDeviceToHost); +} + +void GraphSolver::GetChainBNodesToStackedDevice(double* const data, const size_t offset, + const size_t num) { + cudaSetDevice(device_id_); + if (offset + num > ChainB_num_) { + throw std::runtime_error(std::to_string(offset + num) + " > ChainB_num_"); + } + ChainBCasparToStacked(nodes__ChainB__storage_current_, data, ChainB_num_max_, offset, num); +} + +void GraphSolver::SetChainALinkNum(const size_t num) { + if (num > chain_a_link_num_max_) { + throw std::runtime_error(std::to_string(num) + " > chain_a_link_num_max_"); + } + chain_a_link_num_ = num; +} +void GraphSolver::SetChainALinkWeightDataFromStackedHost(const double* const data, size_t offset, + size_t num) { + cudaSetDevice(device_id_); + if (offset + num > chain_a_link_num_max_) { + throw std::runtime_error(std::to_string(offset + num) + " > chain_a_link_num_max_"); + } + cudaMemcpy(marker__scratch_inout_, data, 4 * num * sizeof(double), cudaMemcpyHostToDevice); + Matrix22StackedToCaspar(marker__scratch_inout_, facs__chain_a_link__args__weight__data_, + chain_a_link_num_max_, offset, num); +} + +void GraphSolver::SetChainALinkWeightDataFromStackedDevice(const double* const data, size_t offset, + size_t num) { + cudaSetDevice(device_id_); + if (offset + num > chain_a_link_num_max_) { + throw std::runtime_error(std::to_string(offset + num) + " > chain_a_link_num_max_"); + } + Matrix22StackedToCaspar(data, facs__chain_a_link__args__weight__data_, chain_a_link_num_max_, + offset, num); +} +void GraphSolver::SetChainALinkOffsetDataFromStackedHost(const double* const data, size_t offset, + size_t num) { + cudaSetDevice(device_id_); + if (offset + num > chain_a_link_num_max_) { + throw std::runtime_error(std::to_string(offset + num) + " > chain_a_link_num_max_"); + } + cudaMemcpy(marker__scratch_inout_, data, 2 * num * sizeof(double), cudaMemcpyHostToDevice); + Matrix21StackedToCaspar(marker__scratch_inout_, facs__chain_a_link__args__offset__data_, + chain_a_link_num_max_, offset, num); +} + +void GraphSolver::SetChainALinkOffsetDataFromStackedDevice(const double* const data, size_t offset, + size_t num) { + cudaSetDevice(device_id_); + if (offset + num > chain_a_link_num_max_) { + throw std::runtime_error(std::to_string(offset + num) + " > chain_a_link_num_max_"); + } + Matrix21StackedToCaspar(data, facs__chain_a_link__args__offset__data_, chain_a_link_num_max_, + offset, num); +} +void GraphSolver::SetChainAPriorNum(const size_t num) { + if (num > chain_a_prior_num_max_) { + throw std::runtime_error(std::to_string(num) + " > chain_a_prior_num_max_"); + } + chain_a_prior_num_ = num; +} +void GraphSolver::SetChainAPriorAIndicesFromHost(const unsigned int* const indices, size_t num) { + cudaSetDevice(device_id_); + if (num != chain_a_prior_num_) { + throw std::runtime_error(std::to_string(num) + + " != chain_a_prior_num_. Use Setchain_a_priorNum " + "before setting indices."); + } + cudaMemcpy((unsigned int*)marker__scratch_inout_, indices, num * sizeof(unsigned int), + cudaMemcpyHostToDevice); + SetChainAPriorAIndicesFromDevice((unsigned int*)marker__scratch_inout_, num); +} + +void GraphSolver::SetChainAPriorAIndicesFromDevice(const unsigned int* const indices, size_t num) { + indices_valid_ = false; + cudaSetDevice(device_id_); + + if (num != chain_a_prior_num_) { + throw std::runtime_error(std::to_string(num) + + " != chain_a_prior_num_. Use Setchain_a_priorNum " + "before setting indices."); + } + + size_t tmp_size = SortIndicesGetTmpNbytes(num); + if (tmp_size + num > scratch_inout_size_) { + throw std::runtime_error("Scratch_inout_size too small. tmp_size: " + std::to_string(tmp_size) + + ", num: " + std::to_string(num) + + ", scratch_inout_size_: " + std::to_string(scratch_inout_size_)); + } + SharedIndices(indices, facs__chain_a_prior__args__a__idx_shared_, num); +} +void GraphSolver::SetChainAPriorTargetDataFromStackedHost(const double* const data, size_t offset, + size_t num) { + cudaSetDevice(device_id_); + if (offset + num > chain_a_prior_num_max_) { + throw std::runtime_error(std::to_string(offset + num) + " > chain_a_prior_num_max_"); + } + cudaMemcpy(marker__scratch_inout_, data, 2 * num * sizeof(double), cudaMemcpyHostToDevice); + Matrix21StackedToCaspar(marker__scratch_inout_, facs__chain_a_prior__args__target__data_, + chain_a_prior_num_max_, offset, num); +} + +void GraphSolver::SetChainAPriorTargetDataFromStackedDevice(const double* const data, size_t offset, + size_t num) { + cudaSetDevice(device_id_); + if (offset + num > chain_a_prior_num_max_) { + throw std::runtime_error(std::to_string(offset + num) + " > chain_a_prior_num_max_"); + } + Matrix21StackedToCaspar(data, facs__chain_a_prior__args__target__data_, chain_a_prior_num_max_, + offset, num); +} +void GraphSolver::SetChainBLinkNum(const size_t num) { + if (num > chain_b_link_num_max_) { + throw std::runtime_error(std::to_string(num) + " > chain_b_link_num_max_"); + } + chain_b_link_num_ = num; +} +void GraphSolver::SetChainBLinkWeightDataFromStackedHost(const double* const data, size_t offset, + size_t num) { + cudaSetDevice(device_id_); + if (offset + num > chain_b_link_num_max_) { + throw std::runtime_error(std::to_string(offset + num) + " > chain_b_link_num_max_"); + } + cudaMemcpy(marker__scratch_inout_, data, 9 * num * sizeof(double), cudaMemcpyHostToDevice); + Matrix33StackedToCaspar(marker__scratch_inout_, facs__chain_b_link__args__weight__data_, + chain_b_link_num_max_, offset, num); +} + +void GraphSolver::SetChainBLinkWeightDataFromStackedDevice(const double* const data, size_t offset, + size_t num) { + cudaSetDevice(device_id_); + if (offset + num > chain_b_link_num_max_) { + throw std::runtime_error(std::to_string(offset + num) + " > chain_b_link_num_max_"); + } + Matrix33StackedToCaspar(data, facs__chain_b_link__args__weight__data_, chain_b_link_num_max_, + offset, num); +} +void GraphSolver::SetChainBLinkOffsetDataFromStackedHost(const double* const data, size_t offset, + size_t num) { + cudaSetDevice(device_id_); + if (offset + num > chain_b_link_num_max_) { + throw std::runtime_error(std::to_string(offset + num) + " > chain_b_link_num_max_"); + } + cudaMemcpy(marker__scratch_inout_, data, 3 * num * sizeof(double), cudaMemcpyHostToDevice); + Matrix31StackedToCaspar(marker__scratch_inout_, facs__chain_b_link__args__offset__data_, + chain_b_link_num_max_, offset, num); +} + +void GraphSolver::SetChainBLinkOffsetDataFromStackedDevice(const double* const data, size_t offset, + size_t num) { + cudaSetDevice(device_id_); + if (offset + num > chain_b_link_num_max_) { + throw std::runtime_error(std::to_string(offset + num) + " > chain_b_link_num_max_"); + } + Matrix31StackedToCaspar(data, facs__chain_b_link__args__offset__data_, chain_b_link_num_max_, + offset, num); +} +void GraphSolver::SetChainBPriorNum(const size_t num) { + if (num > chain_b_prior_num_max_) { + throw std::runtime_error(std::to_string(num) + " > chain_b_prior_num_max_"); + } + chain_b_prior_num_ = num; +} +void GraphSolver::SetChainBPriorBIndicesFromHost(const unsigned int* const indices, size_t num) { + cudaSetDevice(device_id_); + if (num != chain_b_prior_num_) { + throw std::runtime_error(std::to_string(num) + + " != chain_b_prior_num_. Use Setchain_b_priorNum " + "before setting indices."); + } + cudaMemcpy((unsigned int*)marker__scratch_inout_, indices, num * sizeof(unsigned int), + cudaMemcpyHostToDevice); + SetChainBPriorBIndicesFromDevice((unsigned int*)marker__scratch_inout_, num); +} + +void GraphSolver::SetChainBPriorBIndicesFromDevice(const unsigned int* const indices, size_t num) { + indices_valid_ = false; + cudaSetDevice(device_id_); + + if (num != chain_b_prior_num_) { + throw std::runtime_error(std::to_string(num) + + " != chain_b_prior_num_. Use Setchain_b_priorNum " + "before setting indices."); + } + + size_t tmp_size = SortIndicesGetTmpNbytes(num); + if (tmp_size + num > scratch_inout_size_) { + throw std::runtime_error("Scratch_inout_size too small. tmp_size: " + std::to_string(tmp_size) + + ", num: " + std::to_string(num) + + ", scratch_inout_size_: " + std::to_string(scratch_inout_size_)); + } + SharedIndices(indices, facs__chain_b_prior__args__b__idx_shared_, num); +} +void GraphSolver::SetChainBPriorTargetDataFromStackedHost(const double* const data, size_t offset, + size_t num) { + cudaSetDevice(device_id_); + if (offset + num > chain_b_prior_num_max_) { + throw std::runtime_error(std::to_string(offset + num) + " > chain_b_prior_num_max_"); + } + cudaMemcpy(marker__scratch_inout_, data, 3 * num * sizeof(double), cudaMemcpyHostToDevice); + Matrix31StackedToCaspar(marker__scratch_inout_, facs__chain_b_prior__args__target__data_, + chain_b_prior_num_max_, offset, num); +} + +void GraphSolver::SetChainBPriorTargetDataFromStackedDevice(const double* const data, size_t offset, + size_t num) { + cudaSetDevice(device_id_); + if (offset + num > chain_b_prior_num_max_) { + throw std::runtime_error(std::to_string(offset + num) + " > chain_b_prior_num_max_"); + } + Matrix31StackedToCaspar(data, facs__chain_b_prior__args__target__data_, chain_b_prior_num_max_, + offset, num); +} +void GraphSolver::SetChainCouplingNum(const size_t num) { + if (num > chain_coupling_num_max_) { + throw std::runtime_error(std::to_string(num) + " > chain_coupling_num_max_"); + } + chain_coupling_num_ = num; +} +void GraphSolver::SetChainCouplingAIndicesFromHost(const unsigned int* const indices, size_t num) { + cudaSetDevice(device_id_); + if (num != chain_coupling_num_) { + throw std::runtime_error(std::to_string(num) + + " != chain_coupling_num_. Use " + "Setchain_couplingNum before setting indices."); + } + cudaMemcpy((unsigned int*)marker__scratch_inout_, indices, num * sizeof(unsigned int), + cudaMemcpyHostToDevice); + SetChainCouplingAIndicesFromDevice((unsigned int*)marker__scratch_inout_, num); +} + +void GraphSolver::SetChainCouplingAIndicesFromDevice(const unsigned int* const indices, + size_t num) { + indices_valid_ = false; + cudaSetDevice(device_id_); + + if (num != chain_coupling_num_) { + throw std::runtime_error(std::to_string(num) + + " != chain_coupling_num_. Use " + "Setchain_couplingNum before setting indices."); + } + + size_t tmp_size = SortIndicesGetTmpNbytes(num); + if (tmp_size + num > scratch_inout_size_) { + throw std::runtime_error("Scratch_inout_size too small. tmp_size: " + std::to_string(tmp_size) + + ", num: " + std::to_string(num) + + ", scratch_inout_size_: " + std::to_string(scratch_inout_size_)); + } + SharedIndices(indices, facs__chain_coupling__args__a__idx_shared_, num); +} +void GraphSolver::SetChainCouplingBIndicesFromHost(const unsigned int* const indices, size_t num) { + cudaSetDevice(device_id_); + if (num != chain_coupling_num_) { + throw std::runtime_error(std::to_string(num) + + " != chain_coupling_num_. Use " + "Setchain_couplingNum before setting indices."); + } + cudaMemcpy((unsigned int*)marker__scratch_inout_, indices, num * sizeof(unsigned int), + cudaMemcpyHostToDevice); + SetChainCouplingBIndicesFromDevice((unsigned int*)marker__scratch_inout_, num); +} + +void GraphSolver::SetChainCouplingBIndicesFromDevice(const unsigned int* const indices, + size_t num) { + indices_valid_ = false; + cudaSetDevice(device_id_); + + if (num != chain_coupling_num_) { + throw std::runtime_error(std::to_string(num) + + " != chain_coupling_num_. Use " + "Setchain_couplingNum before setting indices."); + } + + size_t tmp_size = SortIndicesGetTmpNbytes(num); + if (tmp_size + num > scratch_inout_size_) { + throw std::runtime_error("Scratch_inout_size too small. tmp_size: " + std::to_string(tmp_size) + + ", num: " + std::to_string(num) + + ", scratch_inout_size_: " + std::to_string(scratch_inout_size_)); + } + SharedIndices(indices, facs__chain_coupling__args__b__idx_shared_, num); +} +void GraphSolver::SetChainCouplingWeightDataFromStackedHost(const double* const data, size_t offset, + size_t num) { + cudaSetDevice(device_id_); + if (offset + num > chain_coupling_num_max_) { + throw std::runtime_error(std::to_string(offset + num) + " > chain_coupling_num_max_"); + } + cudaMemcpy(marker__scratch_inout_, data, 6 * num * sizeof(double), cudaMemcpyHostToDevice); + Matrix23StackedToCaspar(marker__scratch_inout_, facs__chain_coupling__args__weight__data_, + chain_coupling_num_max_, offset, num); +} + +void GraphSolver::SetChainCouplingWeightDataFromStackedDevice(const double* const data, + size_t offset, size_t num) { + cudaSetDevice(device_id_); + if (offset + num > chain_coupling_num_max_) { + throw std::runtime_error(std::to_string(offset + num) + " > chain_coupling_num_max_"); + } + Matrix23StackedToCaspar(data, facs__chain_coupling__args__weight__data_, chain_coupling_num_max_, + offset, num); +} +void GraphSolver::SetChainCouplingOffsetDataFromStackedHost(const double* const data, size_t offset, + size_t num) { + cudaSetDevice(device_id_); + if (offset + num > chain_coupling_num_max_) { + throw std::runtime_error(std::to_string(offset + num) + " > chain_coupling_num_max_"); + } + cudaMemcpy(marker__scratch_inout_, data, 2 * num * sizeof(double), cudaMemcpyHostToDevice); + Matrix21StackedToCaspar(marker__scratch_inout_, facs__chain_coupling__args__offset__data_, + chain_coupling_num_max_, offset, num); +} + +void GraphSolver::SetChainCouplingOffsetDataFromStackedDevice(const double* const data, + size_t offset, size_t num) { + cudaSetDevice(device_id_); + if (offset + num > chain_coupling_num_max_) { + throw std::runtime_error(std::to_string(offset + num) + " > chain_coupling_num_max_"); + } + Matrix21StackedToCaspar(data, facs__chain_coupling__args__offset__data_, chain_coupling_num_max_, + offset, num); +} + +size_t GraphSolver::get_nbytes() { + size_t offset = 0; + size_t at_least = 0; + increment_offset(offset, 0 * 0, 4); + increment_offset(offset, 2 * ChainA_num_, 4); + increment_offset(offset, 2 * ChainA_num_, 4); + increment_offset(offset, 2 * ChainA_num_, 4); + increment_offset(offset, 4 * ChainB_num_, 4); + increment_offset(offset, 4 * ChainB_num_, 4); + increment_offset(offset, 4 * ChainB_num_, 4); + increment_offset(offset, 1 * chain_a_link_num_, 4); + increment_offset(offset, 4 * chain_a_link_num_, 4); + increment_offset(offset, 2 * chain_a_link_num_, 4); + increment_offset(offset, 1 * chain_a_prior_num_, 4); + increment_offset(offset, 2 * chain_a_prior_num_, 4); + increment_offset(offset, 1 * chain_b_link_num_, 4); + increment_offset(offset, 9 * chain_b_link_num_, 4); + increment_offset(offset, 4 * chain_b_link_num_, 4); + increment_offset(offset, 1 * chain_b_prior_num_, 4); + increment_offset(offset, 4 * chain_b_prior_num_, 4); + increment_offset(offset, 1 * chain_coupling_num_, 4); + increment_offset(offset, 1 * chain_coupling_num_, 4); + increment_offset(offset, 6 * chain_coupling_num_, 4); + increment_offset(offset, 2 * chain_coupling_num_, 4); + at_least = std::max( + at_least, offset + std::max({2 * ChainA_num_max_, 3 * ChainB_num_max_}) * sizeof(double)); + increment_offset(offset, 0 * 0, 4); + increment_offset(offset, 2 * chain_a_link_num_, 4); + increment_offset(offset, 2 * chain_a_prior_num_, 4); + increment_offset(offset, 4 * chain_b_link_num_, 4); + increment_offset(offset, 4 * chain_b_prior_num_, 4); + increment_offset(offset, 2 * chain_coupling_num_, 4); + increment_offset(offset, 4 * chain_a_link_num_, 4); + increment_offset(offset, 4 * chain_a_link_num_, 4); + increment_offset(offset, 4 * ChainA_num_, 4); + increment_offset(offset, 0 * chain_a_prior_num_, 4); + increment_offset(offset, 9 * chain_b_link_num_, 4); + increment_offset(offset, 9 * chain_b_link_num_, 4); + increment_offset(offset, 9 * ChainB_num_, 4); + increment_offset(offset, 0 * chain_b_prior_num_, 4); + increment_offset(offset, 0 * chain_coupling_num_, 4); + increment_offset(offset, 6 * chain_coupling_num_, 4); + increment_offset(offset, 2 * ChainA_num_, 4); + increment_offset(offset, 0 * 0, 4); + increment_offset(offset, 4 * ChainB_num_, 4); + increment_offset(offset, 0 * 0, 4); + increment_offset(offset, 2 * ChainA_num_, 4); + increment_offset(offset, 0 * 0, 4); + increment_offset(offset, 4 * ChainB_num_, 4); + increment_offset(offset, 0 * 0, 4); + increment_offset(offset, 2 * ChainA_num_, 4); + increment_offset(offset, 0 * 0, 4); + increment_offset(offset, 4 * ChainB_num_, 4); + increment_offset(offset, 0 * 0, 4); + increment_offset(offset, 0 * 0, 4); + increment_offset(offset, 2 * ChainA_num_, 4); + increment_offset(offset, 4 * ChainB_num_, 4); + increment_offset(offset, 0 * 0, 1); + increment_offset(offset, 0 * 0, 4); + increment_offset(offset, 2 * ChainA_num_, 4); + increment_offset(offset, 4 * ChainB_num_, 4); + increment_offset(offset, 0 * 0, 4); + increment_offset(offset, 0 * 0, 4); + increment_offset(offset, 2 * ChainA_num_, 4); + increment_offset(offset, 4 * ChainB_num_, 4); + increment_offset(offset, 0 * 0, 4); + increment_offset(offset, 0 * 0, 4); + increment_offset(offset, 2 * ChainA_num_, 4); + increment_offset(offset, 4 * ChainB_num_, 4); + increment_offset(offset, 0 * 0, 4); + increment_offset(offset, 0 * 0, 4); + increment_offset(offset, 2 * ChainA_num_, 4); + increment_offset(offset, 1 * ChainA_num_, 4); + increment_offset(offset, 4 * ChainB_num_, 4); + increment_offset(offset, 4 * ChainB_num_, 4); + increment_offset(offset, 0 * 0, 1); + increment_offset(offset, 0 * 0, 4); + increment_offset(offset, 2 * chain_a_link_num_, 4); + increment_offset(offset, 2 * chain_a_prior_num_, 4); + increment_offset(offset, 4 * chain_b_link_num_, 4); + increment_offset(offset, 4 * chain_b_prior_num_, 4); + increment_offset(offset, 2 * chain_coupling_num_, 4); + increment_offset(offset, 0 * 0, 1); + increment_offset(offset, 1 * 1, 1); + increment_offset(offset, 1 * 1, 1); + increment_offset(offset, 1 * 1, 1); + increment_offset(offset, 1 * 1, 1); + increment_offset(offset, 1 * 1, 1); + increment_offset(offset, 1 * 1, 1); + increment_offset(offset, 1 * 1, 1); + increment_offset(offset, 1 * 1, 1); + increment_offset(offset, 1 * 1, 1); + increment_offset(offset, 1 * 1, 1); + increment_offset(offset, 1 * 1, 1); + increment_offset(offset, 20 * ChainA_num_, 4); + increment_offset(offset, 42 * ChainB_num_, 4); + + return std::max(offset, at_least); +} + +} // namespace caspar \ No newline at end of file diff --git a/test/symforce_function_codegen_test_data/symengine/symforce_caspar_tridiagonal_test/solver.h b/test/symforce_function_codegen_test_data/symengine/symforce_caspar_tridiagonal_test/solver.h new file mode 100644 index 00000000..5a2242d3 --- /dev/null +++ b/test/symforce_function_codegen_test_data/symengine/symforce_caspar_tridiagonal_test/solver.h @@ -0,0 +1,532 @@ +#pragma once + +#include +#include + +#include + +#include "shared_indices.h" +#include "solver_params.h" + +namespace caspar { + +enum class ExitReason { MAX_ITERATIONS, CONVERGED_SCORE_THRESHOLD, CONVERGED_DIAG_EXIT }; + +struct IterationData { + int solver_iter; + int pcg_iter; + double score_current; + double score_best; + double step_quality; + double diag; + double dt_inc; + double dt_tot; + bool step_accepted; +}; + +struct SolveResult { + double initial_score; + double final_score; + int iteration_count; + double runtime; + ExitReason exit_reason; + std::vector iterations; +}; + +class GraphSolver { + public: + /** + * Base constructor. + * + * @param params: The params to use for the solver + * @param ChainA_num_max the maximum number of ChainAs + * @param ChainB_num_max the maximum number of ChainBs + * @param chain_a_link_num_max the maximum number of chain_a_links + * @param chain_a_prior_num_max the maximum number of chain_a_priors + * @param chain_b_link_num_max the maximum number of chain_b_links + * @param chain_b_prior_num_max the maximum number of chain_b_priors + * @param chain_coupling_num_max the maximum number of chain_couplings + */ + GraphSolver(const SolverParams& params, size_t ChainA_num_max, size_t ChainB_num_max, + size_t chain_a_link_num_max, size_t chain_a_prior_num_max, + size_t chain_b_link_num_max, size_t chain_b_prior_num_max, + size_t chain_coupling_num_max, int device_id = 0); + + // This class is managing cuda memory and cannot be copied. + GraphSolver(const GraphSolver&) = delete; + GraphSolver& operator=(const GraphSolver&) = delete; + + GraphSolver(GraphSolver&&) = default; + GraphSolver& operator=(GraphSolver&&) = default; + + ~GraphSolver(); + + /** + * Set the solver parameters. + */ + void set_params(const SolverParams& params); + + /** + * Run the solver. + */ + SolveResult solve(bool print_progress = false, bool verbose_logging = false); + + /** + * Finish the indices. + * + * This function has to be called after all indices are set and before the + * solve function is called. + */ + void finish_indices(); + + /** + * Get the number of allocated bytes. + */ + size_t get_allocation_size(); + + /** + * Set the current value for the ChainA nodes from the stacked host data. + * + * The offset can be used to start writing at a specific index. + */ + void SetChainANodesFromStackedHost(const double* const data, size_t offset, size_t num); + + /** + * Set the current value for the ChainA nodes from the stacked device data. + * + * The offset can be used to start writing at a specific index. + */ + void SetChainANodesFromStackedDevice(const double* const data, size_t offset, size_t num); + + /** + * Read the current value for the ChainA nodes into the stacked output host + * data. + * + * The offset can be used to start reading from a specific index. + */ + void GetChainANodesToStackedHost(double* const data, size_t offset, size_t num); + + /** + * Read the current value for the ChainA nodes into the stacked output device + * data. + * + * The offset can be used to start reading from a specific index. + */ + void GetChainANodesToStackedDevice(double* const data, size_t offset, size_t num); + + /** + * Set the current number of active nodes of type ChainA. + * + * The value is set during initialization and this function is only needed if + * you want to change the problem between optimization runs. This is work in + * progress and can have performance impacts. + */ + void SetChainANum(size_t num); + + /** + * Set the current value for the ChainB nodes from the stacked host data. + * + * The offset can be used to start writing at a specific index. + */ + void SetChainBNodesFromStackedHost(const double* const data, size_t offset, size_t num); + + /** + * Set the current value for the ChainB nodes from the stacked device data. + * + * The offset can be used to start writing at a specific index. + */ + void SetChainBNodesFromStackedDevice(const double* const data, size_t offset, size_t num); + + /** + * Read the current value for the ChainB nodes into the stacked output host + * data. + * + * The offset can be used to start reading from a specific index. + */ + void GetChainBNodesToStackedHost(double* const data, size_t offset, size_t num); + + /** + * Read the current value for the ChainB nodes into the stacked output device + * data. + * + * The offset can be used to start reading from a specific index. + */ + void GetChainBNodesToStackedDevice(double* const data, size_t offset, size_t num); + + /** + * Set the current number of active nodes of type ChainB. + * + * The value is set during initialization and this function is only needed if + * you want to change the problem between optimization runs. This is work in + * progress and can have performance impacts. + */ + void SetChainBNum(size_t num); + + /** + * Set the values for the weight consts ChainALink factor from stacked host + * data. + * + * The offset can be used to start writing from a specific index. + */ + void SetChainALinkWeightDataFromStackedHost(const double* const data, size_t offset, size_t num); + + /** + * Set the values for the weight consts ChainALink factor from stacked device + * data. + * + * The offset can be used to start writing from a specific index. + */ + void SetChainALinkWeightDataFromStackedDevice(const double* const data, size_t offset, + size_t num); + + /** + * Set the values for the offset consts ChainALink factor from stacked host + * data. + * + * The offset can be used to start writing from a specific index. + */ + void SetChainALinkOffsetDataFromStackedHost(const double* const data, size_t offset, size_t num); + + /** + * Set the values for the offset consts ChainALink factor from stacked device + * data. + * + * The offset can be used to start writing from a specific index. + */ + void SetChainALinkOffsetDataFromStackedDevice(const double* const data, size_t offset, + size_t num); + + /** + * Set the current number of ChainALink factors. + * + * The value is set during initialization and this function is only needed if + * you want to change the problem between optimization runs. This is work in + * progress and can have performance impacts. + */ + void SetChainALinkNum(size_t num); + + /** + * Set the indices for the a argument for the ChainAPrior factor from host. + */ + void SetChainAPriorAIndicesFromHost(const unsigned int* const indices, size_t num); + + /** + * Set the indices for the a argument for the ChainAPrior factor from device. + */ + void SetChainAPriorAIndicesFromDevice(const unsigned int* const indices, size_t num); + + /** + * Set the values for the target consts ChainAPrior factor from stacked host + * data. + * + * The offset can be used to start writing from a specific index. + */ + void SetChainAPriorTargetDataFromStackedHost(const double* const data, size_t offset, size_t num); + + /** + * Set the values for the target consts ChainAPrior factor from stacked device + * data. + * + * The offset can be used to start writing from a specific index. + */ + void SetChainAPriorTargetDataFromStackedDevice(const double* const data, size_t offset, + size_t num); + + /** + * Set the current number of ChainAPrior factors. + * + * The value is set during initialization and this function is only needed if + * you want to change the problem between optimization runs. This is work in + * progress and can have performance impacts. + */ + void SetChainAPriorNum(size_t num); + + /** + * Set the values for the weight consts ChainBLink factor from stacked host + * data. + * + * The offset can be used to start writing from a specific index. + */ + void SetChainBLinkWeightDataFromStackedHost(const double* const data, size_t offset, size_t num); + + /** + * Set the values for the weight consts ChainBLink factor from stacked device + * data. + * + * The offset can be used to start writing from a specific index. + */ + void SetChainBLinkWeightDataFromStackedDevice(const double* const data, size_t offset, + size_t num); + + /** + * Set the values for the offset consts ChainBLink factor from stacked host + * data. + * + * The offset can be used to start writing from a specific index. + */ + void SetChainBLinkOffsetDataFromStackedHost(const double* const data, size_t offset, size_t num); + + /** + * Set the values for the offset consts ChainBLink factor from stacked device + * data. + * + * The offset can be used to start writing from a specific index. + */ + void SetChainBLinkOffsetDataFromStackedDevice(const double* const data, size_t offset, + size_t num); + + /** + * Set the current number of ChainBLink factors. + * + * The value is set during initialization and this function is only needed if + * you want to change the problem between optimization runs. This is work in + * progress and can have performance impacts. + */ + void SetChainBLinkNum(size_t num); + + /** + * Set the indices for the b argument for the ChainBPrior factor from host. + */ + void SetChainBPriorBIndicesFromHost(const unsigned int* const indices, size_t num); + + /** + * Set the indices for the b argument for the ChainBPrior factor from device. + */ + void SetChainBPriorBIndicesFromDevice(const unsigned int* const indices, size_t num); + + /** + * Set the values for the target consts ChainBPrior factor from stacked host + * data. + * + * The offset can be used to start writing from a specific index. + */ + void SetChainBPriorTargetDataFromStackedHost(const double* const data, size_t offset, size_t num); + + /** + * Set the values for the target consts ChainBPrior factor from stacked device + * data. + * + * The offset can be used to start writing from a specific index. + */ + void SetChainBPriorTargetDataFromStackedDevice(const double* const data, size_t offset, + size_t num); + + /** + * Set the current number of ChainBPrior factors. + * + * The value is set during initialization and this function is only needed if + * you want to change the problem between optimization runs. This is work in + * progress and can have performance impacts. + */ + void SetChainBPriorNum(size_t num); + + /** + * Set the indices for the a argument for the ChainCoupling factor from host. + */ + void SetChainCouplingAIndicesFromHost(const unsigned int* const indices, size_t num); + + /** + * Set the indices for the a argument for the ChainCoupling factor from + * device. + */ + void SetChainCouplingAIndicesFromDevice(const unsigned int* const indices, size_t num); + + /** + * Set the indices for the b argument for the ChainCoupling factor from host. + */ + void SetChainCouplingBIndicesFromHost(const unsigned int* const indices, size_t num); + + /** + * Set the indices for the b argument for the ChainCoupling factor from + * device. + */ + void SetChainCouplingBIndicesFromDevice(const unsigned int* const indices, size_t num); + + /** + * Set the values for the weight consts ChainCoupling factor from stacked host + * data. + * + * The offset can be used to start writing from a specific index. + */ + void SetChainCouplingWeightDataFromStackedHost(const double* const data, size_t offset, + size_t num); + + /** + * Set the values for the weight consts ChainCoupling factor from stacked + * device data. + * + * The offset can be used to start writing from a specific index. + */ + void SetChainCouplingWeightDataFromStackedDevice(const double* const data, size_t offset, + size_t num); + + /** + * Set the values for the offset consts ChainCoupling factor from stacked host + * data. + * + * The offset can be used to start writing from a specific index. + */ + void SetChainCouplingOffsetDataFromStackedHost(const double* const data, size_t offset, + size_t num); + + /** + * Set the values for the offset consts ChainCoupling factor from stacked + * device data. + * + * The offset can be used to start writing from a specific index. + */ + void SetChainCouplingOffsetDataFromStackedDevice(const double* const data, size_t offset, + size_t num); + + /** + * Set the current number of ChainCoupling factors. + * + * The value is set during initialization and this function is only needed if + * you want to change the problem between optimization runs. This is work in + * progress and can have performance impacts. + */ + void SetChainCouplingNum(size_t num); + + private: + SolverParams params_; + int device_id_; + uint8_t* origin_ptr_; + size_t scratch_inout_size_; + size_t allocation_size_; + + int solver_iter_; + int pcg_iter_; + + bool indices_valid_; + + double pcg_r_0_norm2_; + double pcg_r_kp1_norm2_; + + size_t ChainA_num_; + size_t ChainA_num_max_; + size_t ChainB_num_; + size_t ChainB_num_max_; + size_t chain_a_link_num_; + size_t chain_a_link_num_max_; + size_t chain_a_prior_num_; + size_t chain_a_prior_num_max_; + size_t chain_b_link_num_; + size_t chain_b_link_num_max_; + size_t chain_b_prior_num_; + size_t chain_b_prior_num_max_; + size_t chain_coupling_num_; + size_t chain_coupling_num_max_; + + size_t get_nbytes(); + double LinearizeFirst(); + void Linearize(); + double DoResJacFirst(); + void DoResJac(); + void DoNormalize(); + void DoJtjpDirect(); + void DoAlphaFirst(); + void DoAlpha(); + void DoUpdateStepFirst(); + void DoUpdateStep(); + void DoUpdateRFirst(); + void DoUpdateR(); + double DoRetractScore(); + void DoBeta(); + void DoUpdateP(); + void DoUpdateMp(); + double GetPredDecrease(); + + double* marker__start_; + double* nodes__ChainA__storage_current_; + double* nodes__ChainA__storage_check_; + double* nodes__ChainA__storage_new_best_; + double* nodes__ChainB__storage_current_; + double* nodes__ChainB__storage_check_; + double* nodes__ChainB__storage_new_best_; + SharedIndex* facs__chain_a_link__args__a__idx_shared_; + double* facs__chain_a_link__args__weight__data_; + double* facs__chain_a_link__args__offset__data_; + SharedIndex* facs__chain_a_prior__args__a__idx_shared_; + double* facs__chain_a_prior__args__target__data_; + SharedIndex* facs__chain_b_link__args__b__idx_shared_; + double* facs__chain_b_link__args__weight__data_; + double* facs__chain_b_link__args__offset__data_; + SharedIndex* facs__chain_b_prior__args__b__idx_shared_; + double* facs__chain_b_prior__args__target__data_; + SharedIndex* facs__chain_coupling__args__a__idx_shared_; + SharedIndex* facs__chain_coupling__args__b__idx_shared_; + double* facs__chain_coupling__args__weight__data_; + double* facs__chain_coupling__args__offset__data_; + double* marker__scratch_inout_; + double* facs__chain_a_link__res_; + double* facs__chain_a_prior__res_; + double* facs__chain_b_link__res_; + double* facs__chain_b_prior__res_; + double* facs__chain_coupling__res_; + double* facs__chain_a_link__args__a__jac_first_; + double* facs__chain_a_link__args__a__jac_second_; + double* nodes__ChainA__tridig_U_; + double* facs__chain_a_prior__args__a__jac_; + double* facs__chain_b_link__args__b__jac_first_; + double* facs__chain_b_link__args__b__jac_second_; + double* nodes__ChainB__tridig_U_; + double* facs__chain_b_prior__args__b__jac_; + double* facs__chain_coupling__args__a__jac_; + double* facs__chain_coupling__args__b__jac_; + double* nodes__ChainA__z_; + double* nodes__ChainA__z_end__; + double* nodes__ChainB__z_; + double* nodes__ChainB__z_end__; + double* nodes__ChainA__p_; + double* nodes__ChainA__p_end__; + double* nodes__ChainB__p_; + double* nodes__ChainB__p_end__; + double* nodes__ChainA__step_; + double* nodes__ChainA__step_end__; + double* nodes__ChainB__step_; + double* nodes__ChainB__step_end__; + double* marker__w_start_; + double* nodes__ChainA__w_; + double* nodes__ChainB__w_; + double* marker__w_end_; + double* marker__r_0_start_; + double* nodes__ChainA__r_0_; + double* nodes__ChainB__r_0_; + double* marker__r_0_end_; + double* marker__r_k_start_; + double* nodes__ChainA__r_k_; + double* nodes__ChainB__r_k_; + double* marker__r_k_end_; + double* marker__Mp_start_; + double* nodes__ChainA__Mp_; + double* nodes__ChainB__Mp_; + double* marker__Mp_end_; + double* marker__precond_start_; + double* nodes__ChainA__precond_diag_; + double* nodes__ChainA__precond_tril_; + double* nodes__ChainB__precond_diag_; + double* nodes__ChainB__precond_tril_; + double* marker__precond_end_; + double* marker__jp_start_; + double* facs__chain_a_link__jp_; + double* facs__chain_a_prior__jp_; + double* facs__chain_b_link__jp_; + double* facs__chain_b_prior__jp_; + double* facs__chain_coupling__jp_; + double* marker__jp_end_; + double* solver__current_diag_; + double* solver__alpha_numerator_; + double* solver__alpha_denominator_; + double* solver__alpha_; + double* solver__neg_alpha_; + double* solver__beta_numerator_; + double* solver__beta_; + double* solver__r_0_norm2_tot_; + double* solver__r_kp1_norm2_tot_; + double* solver__pred_decrease_tot_; + double* solver__res_tot_; + double* nodes__ChainA__tridig_eq_; + double* nodes__ChainB__tridig_eq_; +}; + +} // namespace caspar \ No newline at end of file From 37c28158b2fa71758f4b8bd6867dbfbc51adcc3a Mon Sep 17 00:00:00 2001 From: Aaron Date: Fri, 23 Oct 2026 02:01:15 +0000 Subject: [PATCH 50/68] [Caspar] Generate pi, floor and the other backend test functions Caspar only turned `Number` atoms into constants, so an expression with pi or e, which SymEngine represents as number symbols, failed to generate with a `KeyError`. It also had no mapping for floor, so a factor couldn't use `sf.wrap_angle` (for a yaw error, say), and none for ceil, log, the hyperbolic functions and their inverses, erf, erfc, lgamma or tgamma. Any atom that isn't a symbol is now a constant, each of those functions maps to its CUDA math function, and `exp(x)` is generated as `exp` rather than `pow(e, x)`. To cover every expression type at once, `symforce_caspar_codegen_test` now generates a kernel from `backend_test_function`, the expression list the CUDA, Rust and PyTorch backends generate, with the same extra functions as the CUDA backend. Next to it the test checks in the values SymPy gives at five (x, y) points, NaN where the result isn't real. `caspar_backend_coverage_cuda_test` runs the kernel at those points and checks all 60 outputs to 1e-12 relative. Nothing had to be excluded. The SymForce CMake build picks the new test up with the other Caspar CUDA tests. GitOrigin-RevId: 1645d1e8cb66dd8ff819128b01a860cfa1048881 --- .../code_formulation/dabseg_from_accessors.py | 5 +- symforce/caspar/code_formulation/ftypes.py | 86 ++++++++++ test/caspar_backend_coverage_cuda_test.cc | 72 +++++++++ test/symforce_caspar_codegen_test.py | 127 +++++++++++++++ .../backend_test_function_expected.h | 110 +++++++++++++ .../kernel_backend_test_function.cu | 152 ++++++++++++++++++ .../kernel_backend_test_function.h | 12 ++ 7 files changed, 563 insertions(+), 1 deletion(-) create mode 100644 test/caspar_backend_coverage_cuda_test.cc create mode 100644 test/symforce_function_codegen_test_data/symengine/symforce_caspar_backend_coverage_test/backend_test_function_expected.h create mode 100644 test/symforce_function_codegen_test_data/symengine/symforce_caspar_backend_coverage_test/kernel_backend_test_function.cu create mode 100644 test/symforce_function_codegen_test_data/symengine/symforce_caspar_backend_coverage_test/kernel_backend_test_function.h diff --git a/symforce/caspar/code_formulation/dabseg_from_accessors.py b/symforce/caspar/code_formulation/dabseg_from_accessors.py index 052436c8..221ca16d 100644 --- a/symforce/caspar/code_formulation/dabseg_from_accessors.py +++ b/symforce/caspar/code_formulation/dabseg_from_accessors.py @@ -26,12 +26,15 @@ def expr_to_val(dabseg: Dabseg, expr: sf.Basic, expr_map: dict[sf.Basic, Val]) - if (out := expr_map.get(expr)) is not None: return out - if expr.is_Number or isinstance(expr, (int, float)): + # Atoms other than symbols are constants, including number symbols like pi that aren't Numbers. + if isinstance(expr, (int, float)) or expr.is_Number or not (expr.args or expr.is_Symbol): return expr_map.setdefault(expr, dabseg.add_call(ftypes.Store(data=float(expr)))[0]) # type: ignore[arg-type] func: Call if expr.is_Symbol: raise ValueError(f"Symbol {expr} not found in arg_values") + elif expr.is_Pow and expr.args[0] == sf.S.Exp1: + func = dabseg.add_call(ftypes.Exp(), args=(expr_to_val(dabseg, expr.args[1], expr_map),)) elif isinstance(expr, sf.Piecewise): args = list(expr.args) if len(args) != 4: diff --git a/symforce/caspar/code_formulation/ftypes.py b/symforce/caspar/code_formulation/ftypes.py index 1ad9c25f..ff737fff 100644 --- a/symforce/caspar/code_formulation/ftypes.py +++ b/symforce/caspar/code_formulation/ftypes.py @@ -357,6 +357,16 @@ def assign_code(self, outs: list[str], args: list[str], dtype: DType) -> str: return f"{outs[0]} = {_fname('fabs', dtype)}({args[0]});" +class Floor(Func): + def assign_code(self, outs: list[str], args: list[str], dtype: DType) -> str: + return f"{outs[0]} = {_fname('floor', dtype)}({args[0]});" + + +class Ceil(Func): + def assign_code(self, outs: list[str], args: list[str], dtype: DType) -> str: + return f"{outs[0]} = {_fname('ceil', dtype)}({args[0]});" + + class Sign(Func): def assign_code(self, outs: list[str], args: list[str], dtype: DType) -> str: if dtype: @@ -411,6 +421,58 @@ def assign_code(self, outs: list[str], args: list[str], dtype: DType) -> str: return f"{outs[0]} = {_fname('atan2', dtype)}({args[0]}, {args[1]});" +# HYPERBOLIC FUNCTIONS +class Sinh(Func): + def assign_code(self, outs: list[str], args: list[str], dtype: DType) -> str: + return f"{outs[0]} = {_fname('sinh', dtype)}({args[0]});" + + +class Cosh(Func): + def assign_code(self, outs: list[str], args: list[str], dtype: DType) -> str: + return f"{outs[0]} = {_fname('cosh', dtype)}({args[0]});" + + +class Tanh(Func): + def assign_code(self, outs: list[str], args: list[str], dtype: DType) -> str: + return f"{outs[0]} = {_fname('tanh', dtype)}({args[0]});" + + +class ASinh(Func): + def assign_code(self, outs: list[str], args: list[str], dtype: DType) -> str: + return f"{outs[0]} = {_fname('asinh', dtype)}({args[0]});" + + +class ACosh(Func): + def assign_code(self, outs: list[str], args: list[str], dtype: DType) -> str: + return f"{outs[0]} = {_fname('acosh', dtype)}({args[0]});" + + +class ATanh(Func): + def assign_code(self, outs: list[str], args: list[str], dtype: DType) -> str: + return f"{outs[0]} = {_fname('atanh', dtype)}({args[0]});" + + +# SPECIAL FUNCTIONS +class Erf(Func): + def assign_code(self, outs: list[str], args: list[str], dtype: DType) -> str: + return f"{outs[0]} = {_fname('erf', dtype)}({args[0]});" + + +class Erfc(Func): + def assign_code(self, outs: list[str], args: list[str], dtype: DType) -> str: + return f"{outs[0]} = {_fname('erfc', dtype)}({args[0]});" + + +class LGamma(Func): + def assign_code(self, outs: list[str], args: list[str], dtype: DType) -> str: + return f"{outs[0]} = {_fname('lgamma', dtype)}({args[0]});" + + +class TGamma(Func): + def assign_code(self, outs: list[str], args: list[str], dtype: DType) -> str: + return f"{outs[0]} = {_fname('tgamma', dtype)}({args[0]});" + + class SinCos(Func): n_outs = 2 @@ -447,6 +509,16 @@ def assign_code(self, outs: list[str], args: list[str], dtype: DType) -> str: return f"{outs[0]} = {_fname('pow', dtype)}({args[0]}, {args[1]});" +class Exp(Func): + def assign_code(self, outs: list[str], args: list[str], dtype: DType) -> str: + return f"{outs[0]} = {_fname('exp', dtype)}({args[0]});" + + +class Log(Func): + def assign_code(self, outs: list[str], args: list[str], dtype: DType) -> str: + return f"{outs[0]} = {_fname('log', dtype)}({args[0]});" + + class Square(Exponent): def assign_code(self, outs: list[str], args: list[str], dtype: DType) -> str: return f"{outs[0]} = {args[0]} * {args[0]};" @@ -533,4 +605,18 @@ def assign_code(self, outs: list[str], args: list[str], dtype: DType) -> str: sf.Min: Min, sf.Max: Max, sf.Abs: Abs, + symengine_wrapper.floor: Floor, + symengine_wrapper.ceiling: Ceil, + symengine_wrapper.log: Log, + symengine_wrapper.sinh: Sinh, + symengine_wrapper.cosh: Cosh, + symengine_wrapper.tanh: Tanh, + symengine_wrapper.asinh: ASinh, + symengine_wrapper.acosh: ACosh, + symengine_wrapper.atanh: ATanh, + symengine_wrapper.erf: Erf, + symengine_wrapper.erfc: Erfc, + symengine_wrapper.loggamma: LGamma, + # symengine_wrapper.gamma is a function that returns an instance of the class. + type(symengine_wrapper.gamma(symengine_wrapper.Symbol("x"))): TGamma, } diff --git a/test/caspar_backend_coverage_cuda_test.cc b/test/caspar_backend_coverage_cuda_test.cc new file mode 100644 index 00000000..71dfabe8 --- /dev/null +++ b/test/caspar_backend_coverage_cuda_test.cc @@ -0,0 +1,72 @@ +/* ---------------------------------------------------------------------------- + * SymForce - Copyright 2025, Skydio, Inc. + * This source code is under the Apache 2.0 license found in the LICENSE file. + * ---------------------------------------------------------------------------- */ + +#include +#include +#include +#include + +#include +#include + +#include "backend_test_function_expected.h" +#include "kernel_backend_test_function.h" + +namespace { + +bool HaveDevice() { + int count = 0; + return cudaGetDeviceCount(&count) == cudaSuccess && count > 0; +} + +double* CopyToDevice(const std::vector& host) { + double* device = nullptr; + cudaMalloc(&device, host.size() * sizeof(double)); + cudaMemcpy(device, host.data(), host.size() * sizeof(double), cudaMemcpyHostToDevice); + return device; +} + +} // namespace + +TEST_CASE("The Caspar backend test function matches SymPy at every point", + "[caspar_backend_coverage_cuda_test]") { + REQUIRE(HaveDevice()); + + using caspar_backend_coverage::kExpected; + using caspar_backend_coverage::kNumOutputs; + using caspar_backend_coverage::kNumPoints; + + double* const x = CopyToDevice( + {std::begin(caspar_backend_coverage::kX), std::end(caspar_backend_coverage::kX)}); + double* const y = CopyToDevice( + {std::begin(caspar_backend_coverage::kY), std::end(caspar_backend_coverage::kY)}); + // The caspar layout of doubles: chunks of two outputs, each holding both for every point. + static_assert(kNumOutputs % 2 == 0); + std::vector out_host(kNumOutputs * kNumPoints, NAN); + double* const out = CopyToDevice(out_host); + + caspar::BackendTestFunction(x, kNumPoints, y, kNumPoints, out, kNumPoints, kNumPoints); + REQUIRE(cudaDeviceSynchronize() == cudaSuccess); + cudaMemcpy(out_host.data(), out, out_host.size() * sizeof(double), cudaMemcpyDeviceToHost); + + cudaFree(x); + cudaFree(y); + cudaFree(out); + + for (int output = 0; output < kNumOutputs; output++) { + for (int point = 0; point < kNumPoints; point++) { + const int chunk_start = output - output % 2; + const double actual = out_host.at(chunk_start * kNumPoints + point * 2 + output % 2); + const double expected = kExpected[output][point]; + CAPTURE(output, point, caspar_backend_coverage::kX[point], caspar_backend_coverage::kY[point], + expected, actual); + if (std::isnan(expected)) { + CHECK(std::isnan(actual)); + } else { + CHECK(std::abs(actual - expected) <= 1e-12 * std::max(1.0, std::abs(expected))); + } + } + } +} diff --git a/test/symforce_caspar_codegen_test.py b/test/symforce_caspar_codegen_test.py index e37a1a13..b287eb5b 100644 --- a/test/symforce_caspar_codegen_test.py +++ b/test/symforce_caspar_codegen_test.py @@ -9,6 +9,8 @@ from pathlib import Path +import sympy + import symforce.symbolic as sf from symforce import caspar from symforce import path_util @@ -19,6 +21,7 @@ from symforce.codegen.format_util import format_cpp from symforce.test_util import TestCase from symforce.test_util import symengine_only +from symforce.test_util.backend_coverage_expressions import backend_test_function TEST_DATA_DIR = ( path_util.symforce_data_root(__file__) @@ -44,11 +47,42 @@ / "symforce_caspar_tridiagonal_test" ) +BACKEND_COVERAGE_TEST_DATA_DIR = ( + path_util.symforce_data_root(__file__) + / "test" + / "symforce_function_codegen_test_data" + / symforce.get_symbolic_api() + / "symforce_caspar_backend_coverage_test" +) + KERNEL_FILENAMES = ( "kernel_caspar_padding_lane_score.cu", "kernel_caspar_padding_lane_score.h", ) +BACKEND_COVERAGE_KERNEL_FILENAMES = ( + "kernel_backend_test_function.cu", + "kernel_backend_test_function.h", +) + +# Functions CUDA has that aren't in backend_test_function's default list, as for the CUDA backend. +BACKEND_COVERAGE_NON_STANDARD_UNARY_OPS = [ + sf.sympy.erfc, + sf.sympy.loggamma, + sf.sympy.erf, + sf.sympy.gamma, +] + +# x is positive: CUDA's lgamma is log|gamma(x)|, which SymEngine's loggamma is not for negative x. +# The points cover both sides of 1, where asin, acos and atanh or acosh are undefined. +BACKEND_COVERAGE_POINTS = ( + (0.3, 1.7), + (0.85, -0.6), + (1.6, 2.5), + (3.2, -1.1), + (7.3, 0.4), +) + def _make_padding_lane_library() -> CasparLibrary: """ @@ -80,6 +114,74 @@ def caspar_padding_lane( return caslib +def _backend_coverage_outputs(x: sf.Scalar, y: sf.Scalar) -> sf.Matrix: + return sf.Matrix(backend_test_function(BACKEND_COVERAGE_NON_STANDARD_UNARY_OPS, x, y)) + + +def _make_backend_coverage_library() -> CasparLibrary: + """ + A kernel computing every expression of ``backend_test_function`` from ``x`` and ``y``. + """ + caslib = CasparLibrary(dtype=DType.DOUBLE) + output_t = sf.matrix_type_from_shape( + _backend_coverage_outputs(sf.Symbol("x"), sf.Symbol("y")).shape + ) + + @caslib.add_kernel + def backend_test_function( + x: T.Annotated[sf.V1, mem.ReadSequential], + y: T.Annotated[sf.V1, mem.ReadSequential], + ) -> T.Annotated[output_t, mem.WriteSequential]: # type: ignore[valid-type] + return _backend_coverage_outputs(x[0], y[0]) + + return caslib + + +def _backend_coverage_expected_header() -> str: + """ + The inputs and outputs of ``backend_test_function`` at ``BACKEND_COVERAGE_POINTS``, evaluated + by SymPy, with NaN where the output isn't real. + """ + x, y = sf.symbols("x y") + outputs = _backend_coverage_outputs(x, y) + + def evaluate(expr: sf.Expr, x_value: float, y_value: float) -> str: + # SymEngine can't evalf every function here, so convert to SymPy. + value = complex(sympy.sympify(expr).subs({x: x_value, y: y_value}).evalf(30)) + if value.imag != 0: + return "kNaN" + return repr(value.real) + + rows = "\n".join( + "{" + + ", ".join( + evaluate(expr, x_value, y_value) for x_value, y_value in BACKEND_COVERAGE_POINTS + ) + + f"}}, // {expr}" + for expr in outputs + ) + return f"""\ +#pragma once + +#include + +// Generated by symforce_caspar_codegen_test.py. +namespace caspar_backend_coverage {{ + +constexpr double kNaN = std::numeric_limits::quiet_NaN(); +constexpr int kNumPoints = {len(BACKEND_COVERAGE_POINTS)}; +constexpr int kNumOutputs = {outputs.shape[0]}; +constexpr double kX[kNumPoints] = {{{", ".join(repr(p[0]) for p in BACKEND_COVERAGE_POINTS)}}}; +constexpr double kY[kNumPoints] = {{{", ".join(repr(p[1]) for p in BACKEND_COVERAGE_POINTS)}}}; +// Each output at each point. +constexpr double kExpected[kNumOutputs][kNumPoints] = {{ +{rows} +}}; + +}} // namespace caspar_backend_coverage +""" + + def _make_solver_library() -> CasparLibrary: """ Rosenbrock converges slowly, so a solve is still progressing after a few iterations. @@ -194,6 +296,31 @@ def test_generate_padding_lane_kernel(self) -> None: self.compare_or_update_directory(kernel_dir, TEST_DATA_DIR) + @symengine_only + def test_generate_backend_coverage_kernel(self) -> None: + """ + Keep the kernel and expected values caspar_backend_coverage_cuda_test.cc uses up to date. + """ + output_dir = self.make_output_dir("sf_caspar_backend_coverage_") + _make_backend_coverage_library().generate(output_dir, python_bindings=False) + + kernel_dir = output_dir / "kernel" + kernel_dir.mkdir() + for name in BACKEND_COVERAGE_KERNEL_FILENAMES: + content = (output_dir / name).read_text() + (kernel_dir / name).write_text( + format_cpp(content, str(BACKEND_COVERAGE_TEST_DATA_DIR / name)) + ) + expected_name = "backend_test_function_expected.h" + (kernel_dir / expected_name).write_text( + format_cpp( + _backend_coverage_expected_header(), + str(BACKEND_COVERAGE_TEST_DATA_DIR / expected_name), + ) + ) + + self.compare_or_update_directory(kernel_dir, BACKEND_COVERAGE_TEST_DATA_DIR) + @symengine_only def test_generate_solver(self) -> None: """ diff --git a/test/symforce_function_codegen_test_data/symengine/symforce_caspar_backend_coverage_test/backend_test_function_expected.h b/test/symforce_function_codegen_test_data/symengine/symforce_caspar_backend_coverage_test/backend_test_function_expected.h new file mode 100644 index 00000000..cd995e16 --- /dev/null +++ b/test/symforce_function_codegen_test_data/symengine/symforce_caspar_backend_coverage_test/backend_test_function_expected.h @@ -0,0 +1,110 @@ +#pragma once + +#include + +// Generated by symforce_caspar_codegen_test.py. +namespace caspar_backend_coverage { + +constexpr double kNaN = std::numeric_limits::quiet_NaN(); +constexpr int kNumPoints = 5; +constexpr int kNumOutputs = 60; +constexpr double kX[kNumPoints] = {0.3, 0.85, 1.6, 3.2, 7.3}; +constexpr double kY[kNumPoints] = {1.7, -0.6, 2.5, -1.1, 0.4}; +// Each output at each point. +constexpr double kExpected[kNumOutputs][kNumPoints] = { + {0.0, 0.0, 0.0, 0.0, 0.0}, // 0 + {1.0, 1.0, 1.0, 1.0, 1.0}, // 1 + {0.5, 0.5, 0.5, 0.5, 0.5}, // 1/2 + {1.6, 1.6, 1.6, 1.6, 1.6}, // 1.6 + {0.21153846153846154, 0.21153846153846154, 0.21153846153846154, 0.21153846153846154, + 0.21153846153846154}, // 11/52 + {2.718281828459045, 2.718281828459045, 2.718281828459045, 2.718281828459045, + 2.718281828459045}, // E + {1.4426950408889634, 1.4426950408889634, 1.4426950408889634, 1.4426950408889634, + 1.4426950408889634}, // log(2)**(-1) + {0.6931471805599453, 0.6931471805599453, 0.6931471805599453, 0.6931471805599453, + 0.6931471805599453}, // log(2) + {2.302585092994046, 2.302585092994046, 2.302585092994046, 2.302585092994046, + 2.302585092994046}, // log(10) + {3.141592653589793, 3.141592653589793, 3.141592653589793, 3.141592653589793, + 3.141592653589793}, // pi + {1.5707963267948966, 1.5707963267948966, 1.5707963267948966, 1.5707963267948966, + 1.5707963267948966}, // (1/2)*pi + {0.7853981633974483, 0.7853981633974483, 0.7853981633974483, 0.7853981633974483, + 0.7853981633974483}, // (1/4)*pi + {0.3183098861837907, 0.3183098861837907, 0.3183098861837907, 0.3183098861837907, + 0.3183098861837907}, // pi**(-1) + {0.6366197723675814, 0.6366197723675814, 0.6366197723675814, 0.6366197723675814, + 0.6366197723675814}, // 2/pi + {1.1283791670955126, 1.1283791670955126, 1.1283791670955126, 1.1283791670955126, + 1.1283791670955126}, // 2/sqrt(pi) + {1.4142135623730951, 1.4142135623730951, 1.4142135623730951, 1.4142135623730951, + 1.4142135623730951}, // sqrt(2) + {0.7071067811865476, 0.7071067811865476, 0.7071067811865476, 0.7071067811865476, + 0.7071067811865476}, // (1/2)*sqrt(2) + {0.3, 0.85, 1.6, 3.2, 7.3}, // abs(x) + {0.29552020666133955, 0.7512804051402927, 0.9995736030415051, -0.058374143427580086, + 0.8504366206285644}, // sin(x) + {0.955336489125606, 0.6599831458849822, -0.029199522301288815, -0.9982947757947531, + 0.5260775173811053}, // cos(x) + {0.30933624960962325, 1.1383327132284393, -34.232532735557314, 0.058473854459578645, + 1.6165614239934991}, // tan(x) + {0.30469265401539747, 1.015985293814825, kNaN, kNaN, kNaN}, // asin(x) + {1.2661036727794992, 0.5548110329800715, kNaN, kNaN, kNaN}, // acos(x) + {0.2914567944778671, 0.7044940642422177, 1.0121970114513341, 1.2679114584199251, + 1.4346573659417559}, // atan(x) + {1.3498588075760032, 2.3396468519259908, 4.953032424395115, 24.532530197109352, + 1480.299927584545}, // exp(x) + {-1.2039728043259361, -0.16251892949777494, 0.47000362924573563, 1.1631508098056809, + 1.9878743481543455}, // log(x) + {0.3045202934471426, 0.9561159599886321, 2.37556795320023, 12.245883996565494, + 740.1496260228848}, // sinh(x) + {1.0453385141288605, 1.3835308919373588, 2.5774644711948853, 12.28664620054386, + 740.1503015616601}, // cosh(x) + {0.2913126124515909, 0.6910694698329306, 0.9216685544064713, 0.9966823978396512, + 0.999999087295143}, // tanh(x) + {0.0, 0.0, 1.0, 3.0, 7.0}, // floor(x) + {1.0, 1.0, 2.0, 4.0, 8.0}, // ceiling(x) + {0.5477225575051661, 0.9219544457292888, 1.2649110640673518, 1.7888543819998317, + 2.701851217221259}, // sqrt(x) + {0.29567304756342244, 0.7712374333598078, 1.2489833279048763, 1.8798635843969098, + 2.685680167776152}, // asinh(x) + {kNaN, kNaN, 1.0469679150031885, 1.8309380069269214, 2.676296855958175}, // acosh(x) + {0.3095196042031117, 1.2561528119880574, kNaN, kNaN, kNaN}, // atanh(x) + {0.3, 0.85, 1.6, 3.2, 1.7999999999999998}, // x - 5.5*floor(0.181818181818182*x) + {1.3, 1.85, 2.6, 4.2, 8.3}, // 1 + x + {0.6, 1.7, 3.2, 6.4, 14.6}, // 2*x + {0.09, 0.7224999999999999, 2.5600000000000005, 10.240000000000002, 53.29}, // x**2 + {0.026999999999999996, 0.6141249999999999, 4.096000000000001, 32.76800000000001, + 389.017}, // x**3 + {0.0081, 0.5220062499999999, 6.553600000000001, 104.85760000000002, 2839.8241}, // x**4 + {0.0024299999999999994, 0.44370531249999995, 10.485760000000003, 335.5443200000001, + 20730.71593}, // x**5 + {0.5477225575051661, 0.9219544457292888, 1.2649110640673518, 1.7888543819998317, + 2.701851217221259}, // sqrt(x) + {0.1643167672515498, 0.7836612788698953, 2.023857702507763, 5.7243340223994625, + 19.723513885715192}, // x**(3/2) + {1.0, 1.0, 1.0, 1.0, 1.0}, // (1/2)*(1 + sign(x)) + {1.0, 1.0, 1.0, 1.0, 1.0}, // sign_no_zero(x) + {0.6713732405408726, 0.22933194239164748, 0.023651616655355985, 6.025761151762088e-06, + 5.502573750691923e-25}, // erfc(x) + {1.0957979948180756, 0.10659511647811766, -0.11259176569675577, 0.8854048271549091, + 7.147892523022248}, // loggamma(x) + {0.3286267594591274, 0.7706680576083526, 0.976348383344644, 0.9999939742388483, 1.0}, // erf(x) + {2.991568987687591, 1.1124837369484653, 0.8935153492876903, 2.4239654799353683, + 1271.4236336639087}, // gamma(x) + {0.17467219900823971, 2.185459278717062, 0.5693131911006619, 1.9018924034990288, + 1.516056546745016}, // atan2(x, y) + {1.7, 0.85, 2.5, 3.2, 7.3}, // max(x, y) + {0.3, -0.6, 1.6, -1.1, 0.4}, // min(x, y) + {0.3, -0.35, 1.6, -0.10000000000000009, 0.09999999999999964}, // x - y*floor(x/y) + {2.0, 0.25, 4.1, 2.1, 7.7}, // x + y + {0.51, -0.51, 4.0, -3.5200000000000005, 2.92}, // x*y + {0.12915348607498026, 1.1024239624913885, 3.238172324012421, 0.27818584240241323, + 2.214772610391266}, // x**y + {4.0, 0.0625, 16.810000000000002, 4.410000000000001, 59.28999999999999}, // (x + y)**2 + {8.0, 0.015625, 68.92100000000002, 9.261000000000003, 456.53299999999996}, // (x + y)**3 + {0.3, -0.85, 1.6, -3.2, 7.3}, // copysign_no_zero(x, y) +}; + +} // namespace caspar_backend_coverage diff --git a/test/symforce_function_codegen_test_data/symengine/symforce_caspar_backend_coverage_test/kernel_backend_test_function.cu b/test/symforce_function_codegen_test_data/symengine/symforce_caspar_backend_coverage_test/kernel_backend_test_function.cu new file mode 100644 index 00000000..7827509c --- /dev/null +++ b/test/symforce_function_codegen_test_data/symengine/symforce_caspar_backend_coverage_test/kernel_backend_test_function.cu @@ -0,0 +1,152 @@ +#include +#include + +#include +#include +#include +#include +#include + +#include "kernel_backend_test_function.h" +#include "memops.cuh" + +namespace cg = cooperative_groups; + +namespace caspar { + +__global__ void __launch_bounds__(1024, 1) + BackendTestFunctionKernel(double* x, unsigned int x_num_alloc, double* y, + unsigned int y_num_alloc, double* out, unsigned int out_num_alloc, + size_t problem_size) { + const int global_thread_idx = blockIdx.x * blockDim.x + threadIdx.x; + + double r0 = 0, r1 = 0, r2 = 0, r3 = 0, r4 = 0, r5 = 0, r6 = 0, r7 = 0; + + if (global_thread_idx < problem_size) { + r0 = 0.00000000000000000e+00; + r1 = 1.00000000000000000e+00; + WriteIdx2<1024, double, double, double2>(out, 0 * out_num_alloc, global_thread_idx, r0, r1); + r0 = 5.00000000000000000e-01; + r2 = 1.60000000000000009e+00; + WriteIdx2<1024, double, double, double2>(out, 2 * out_num_alloc, global_thread_idx, r0, r2); + r2 = 2.11538461538461536e-01; + r3 = 2.71828182845904509e+00; + WriteIdx2<1024, double, double, double2>(out, 4 * out_num_alloc, global_thread_idx, r2, r3); + r3 = 2.00000000000000000e+00; + r2 = log(r3); + r4 = 1.0 / r2; + WriteIdx2<1024, double, double, double2>(out, 6 * out_num_alloc, global_thread_idx, r4, r2); + r2 = 1.00000000000000000e+01; + r2 = log(r2); + r4 = 3.14159265358979312e+00; + WriteIdx2<1024, double, double, double2>(out, 8 * out_num_alloc, global_thread_idx, r2, r4); + r2 = r0 * r4; + r5 = 2.50000000000000000e-01; + r5 = r4 * r5; + WriteIdx2<1024, double, double, double2>(out, 10 * out_num_alloc, global_thread_idx, r2, r5); + r5 = 1.0 / r4; + r2 = r3 * r5; + WriteIdx2<1024, double, double, double2>(out, 12 * out_num_alloc, global_thread_idx, r5, r2); + r2 = sqrt(r3); + r4 = rsqrt(r4); + r4 = r3 * r4; + WriteIdx2<1024, double, double, double2>(out, 14 * out_num_alloc, global_thread_idx, r4, r2); + ReadIdx1<1024, double, double, double>(x, 0 * x_num_alloc, global_thread_idx, r4); + r5 = fabs(r4); + r2 = r0 * r2; + WriteIdx2<1024, double, double, double2>(out, 16 * out_num_alloc, global_thread_idx, r2, r5); + r5 = sin(r4); + r2 = cos(r4); + WriteIdx2<1024, double, double, double2>(out, 18 * out_num_alloc, global_thread_idx, r5, r2); + r2 = tan(r4); + r5 = asin(r4); + WriteIdx2<1024, double, double, double2>(out, 20 * out_num_alloc, global_thread_idx, r2, r5); + r5 = acos(r4); + r2 = atan(r4); + WriteIdx2<1024, double, double, double2>(out, 22 * out_num_alloc, global_thread_idx, r5, r2); + r2 = exp(r4); + r5 = log(r4); + WriteIdx2<1024, double, double, double2>(out, 24 * out_num_alloc, global_thread_idx, r2, r5); + r5 = sinh(r4); + r2 = cosh(r4); + WriteIdx2<1024, double, double, double2>(out, 26 * out_num_alloc, global_thread_idx, r5, r2); + r2 = tanh(r4); + r5 = floor(r4); + WriteIdx2<1024, double, double, double2>(out, 28 * out_num_alloc, global_thread_idx, r2, r5); + r5 = ceil(r4); + r2 = sqrt(r4); + WriteIdx2<1024, double, double, double2>(out, 30 * out_num_alloc, global_thread_idx, r5, r2); + r5 = asinh(r4); + r6 = acosh(r4); + WriteIdx2<1024, double, double, double2>(out, 32 * out_num_alloc, global_thread_idx, r5, r6); + r6 = atanh(r4); + r5 = -5.50000000000000000e+00; + r7 = 1.81818181818181823e-01; + r7 = r4 * r7; + r7 = floor(r7); + r7 = fma(r5, r7, r4); + WriteIdx2<1024, double, double, double2>(out, 34 * out_num_alloc, global_thread_idx, r6, r7); + r7 = r4 + r1; + r3 = r4 * r3; + WriteIdx2<1024, double, double, double2>(out, 36 * out_num_alloc, global_thread_idx, r7, r3); + r3 = r4 * r4; + r7 = r4 * r3; + WriteIdx2<1024, double, double, double2>(out, 38 * out_num_alloc, global_thread_idx, r3, r7); + r3 = r3 * r3; + r7 = r4 * r3; + WriteIdx2<1024, double, double, double2>(out, 40 * out_num_alloc, global_thread_idx, r3, r7); + r7 = r4 * r2; + WriteIdx2<1024, double, double, double2>(out, 42 * out_num_alloc, global_thread_idx, r2, r7); + r7 = copysign(1.0, r4); + r1 = r1 + r7; + r1 = r0 * r1; + WriteIdx2<1024, double, double, double2>(out, 44 * out_num_alloc, global_thread_idx, r1, r7); + r7 = erfc(r4); + r1 = lgamma(r4); + WriteIdx2<1024, double, double, double2>(out, 46 * out_num_alloc, global_thread_idx, r7, r1); + r1 = erf(r4); + r7 = tgamma(r4); + WriteIdx2<1024, double, double, double2>(out, 48 * out_num_alloc, global_thread_idx, r1, r7); + ReadIdx1<1024, double, double, double>(y, 0 * y_num_alloc, global_thread_idx, r7); + r1 = atan2(r4, r7); + r0 = fmax(r4, r7); + WriteIdx2<1024, double, double, double2>(out, 50 * out_num_alloc, global_thread_idx, r1, r0); + r0 = fmin(r4, r7); + r1 = -1.00000000000000000e+00; + r2 = r7 * r1; + r3 = 1.0 / r7; + r3 = r4 * r3; + r3 = floor(r3); + r2 = fma(r3, r2, r4); + WriteIdx2<1024, double, double, double2>(out, 52 * out_num_alloc, global_thread_idx, r0, r2); + r2 = r4 + r7; + r0 = r4 * r7; + WriteIdx2<1024, double, double, double2>(out, 54 * out_num_alloc, global_thread_idx, r2, r0); + r0 = pow(r4, r7); + r3 = r2 * r2; + WriteIdx2<1024, double, double, double2>(out, 56 * out_num_alloc, global_thread_idx, r0, r3); + r4 = copysign(r4, r7); + r3 = r2 * r3; + WriteIdx2<1024, double, double, double2>(out, 58 * out_num_alloc, global_thread_idx, r3, r4); + }; +} + +void BackendTestFunction(double* x, unsigned int x_num_alloc, double* y, unsigned int y_num_alloc, + double* out, unsigned int out_num_alloc, size_t problem_size) { + if (problem_size == 0) { + return; + } + + const int n_blocks = (problem_size + 1024 - 1) / 1024; + BackendTestFunctionKernel<<>>(x, x_num_alloc, y, y_num_alloc, out, + out_num_alloc, problem_size); + // A launch that fails (e.g. from exceeding shared memory or register limits) + // otherwise leaves its outputs untouched without any error. + const cudaError_t launch_error = cudaGetLastError(); + if (launch_error != cudaSuccess) { + throw std::runtime_error(std::string("BackendTestFunctionKernel launch failed: ") + + cudaGetErrorString(launch_error)); + } +} + +} // namespace caspar \ No newline at end of file diff --git a/test/symforce_function_codegen_test_data/symengine/symforce_caspar_backend_coverage_test/kernel_backend_test_function.h b/test/symforce_function_codegen_test_data/symengine/symforce_caspar_backend_coverage_test/kernel_backend_test_function.h new file mode 100644 index 00000000..7f37a3b3 --- /dev/null +++ b/test/symforce_function_codegen_test_data/symengine/symforce_caspar_backend_coverage_test/kernel_backend_test_function.h @@ -0,0 +1,12 @@ +#pragma once + +#include + +#include "shared_indices.h" + +namespace caspar { + +void BackendTestFunction(double* x, unsigned int x_num_alloc, double* y, unsigned int y_num_alloc, + double* out, unsigned int out_num_alloc, size_t problem_size); + +} // namespace caspar \ No newline at end of file From 1aab10972168fe8cb66e7d3614f2d6e448655435 Mon Sep 17 00:00:00 2001 From: Aaron Date: Fri, 23 Oct 2026 02:01:33 +0000 Subject: [PATCH 51/68] [Caspar] Type the generated ExitReason members as ExitReason The generated `.pyi` stub declared the `ExitReason` members as `int`, but `SolveResult.exit_reason` is an `ExitReason`, so comparing a result's exit reason to a member needed a cast to pass mypy. The stub now declares the members as class variables of type `ExitReason`, which is what the `py::enum_` binding defines. GitOrigin-RevId: dc5416986a415d82db913c5a10863e253a39d56c --- symforce/caspar/source/templates/lib.pyi.jinja | 6 +++--- 1 file changed, 3 insertions(+), 3 deletions(-) diff --git a/symforce/caspar/source/templates/lib.pyi.jinja b/symforce/caspar/source/templates/lib.pyi.jinja index a208c4de..51ee3fab 100644 --- a/symforce/caspar/source/templates/lib.pyi.jinja +++ b/symforce/caspar/source/templates/lib.pyi.jinja @@ -22,9 +22,9 @@ CudaArray = T.Any {% if solver is not none %} class ExitReason: - MAX_ITERATIONS: int - CONVERGED_SCORE_THRESHOLD: int - CONVERGED_DIAG_EXIT: int + MAX_ITERATIONS: T.ClassVar[ExitReason] + CONVERGED_SCORE_THRESHOLD: T.ClassVar[ExitReason] + CONVERGED_DIAG_EXIT: T.ClassVar[ExitReason] class IterationData: solver_iter: int From 16baf60ea54a8193a8858ce8a5d046db41ed18a2 Mon Sep 17 00:00:00 2001 From: Aaron Date: Sat, 24 Oct 2026 05:00:33 +0000 Subject: [PATCH 52/68] [SymForce] Integrate IMU preintegration step noise exactly The manifold IMU preintegration (`ImuManifoldPreintegrationUpdate`, used by `sym::ImuPreintegrator`) propagated the covariance of (DR, Dv, Dp) with a discrete noise model: each step's accelerometer noise entered as one vector n with Dv += R n dt and Dp += R n dt^2 / 2, so one step's (Dv, Dp) covariance per axis was sigma^2 dt [1, dt/2; dt/2, dt^2/4], which is rank 1. A window consisting of a single sample therefore had a rank 6 covariance, so the Cholesky factorization to convert to information form fails. Also a window of n equal steps had a per-axis (Dv, Dp) determinant of sigma^4 T^4 (1 - 1/n^2) / 12 instead of the continuous-time sigma^4 T^4 / 12. This change models the measurement noise as continuous-time white noise with the given spectral densities acting over the whole step (the meaning and units of `accel_cov` and `gyro_cov` are unchanged), and adds its covariance integrated exactly over the step. With the measurement and the rotation held over the step, the linearized error dynamics are d/dt (dR, dv, dp) = F (dR, dv, dp) + G (n_gyro, n_accel) with a nilpotent F (F^3 = 0), so the transition matrix is the exact polynomial I + F s + F^2 s^2 / 2 and the step noise covariance is a closed-form sum of nine terms. Per axis the accelerometer part of the (Dv, Dp) block becomes sigma^2 [dt, dt^2/2; dt^2/2, dt^3/3], which is positive definite for any dt > 0. The same integral also yields the cross terms by which the rotation noise accumulated during the step leaks into Dv and Dp within that step (A Sg dt^2 / 2, A Sg A^T dt^3 / 3, and so on, with A = -R [accel]x); without them a window of n steps carried only a fraction (1 - 3/(2n) + ...) of the continuous-time rotation-to-velocity covariance. With the exact step covariance the covariance of a window no longer depends on how the window is divided into steps, and it is full rank even for a single step. The derivation is documented in `step_noise_covariance` in `manifold_symbolic.py`. The generated update function grows from 1253 to 1301 ops. On an i7-14700K, with -O2 -march=haswell, one `IntegrateMeasurement` call goes from about 123 ns to about 133 ns. This is for the preintegration step, not inside the optimization, so this seems fine. This adds tests that one step's covariance equals the analytic closed form and is positive definite, and that a window's covariance does not depend on its subdivision into steps (to machine precision without rotation, and to 1e-6 with rotation against a 100x finer subdivision). The existing Monte Carlo covariance test still passes; it simulates the noise as a perturbation held over each step, which agrees with the white-noise model to the order of 1/n in the sub-dominant terms and is well within its 5% tolerance. GitOrigin-RevId: fd1b2967f93460587ebf3a6ec22470783099c4b8 --- .../imu_manifold_preintegration_update.h | 1114 +++++++-------- ...ld_preintegration_update_auto_derivative.h | 1234 ++++++++--------- .../imu_preintegration/imu_preintegrator.h | 16 +- .../imu_preintegration/manifold_symbolic.py | 107 +- test/slam_imu_preintegration_test.cc | 130 ++ 5 files changed, 1389 insertions(+), 1212 deletions(-) diff --git a/gen/cpp/sym/factors/internal/imu_manifold_preintegration_update.h b/gen/cpp/sym/factors/internal/imu_manifold_preintegration_update.h index 72ac45fb..15a68206 100644 --- a/gen/cpp/sym/factors/internal/imu_manifold_preintegration_update.h +++ b/gen/cpp/sym/factors/internal/imu_manifold_preintegration_update.h @@ -23,6 +23,13 @@ namespace sym { * When integrating the first measurement, DR should be the identity, Dv, Dp, covariance, and the * derivatives w.r.t. to bias should all be 0. * + * The measurement noise is modeled as continuous-time white noise acting over the whole step, + * and its contribution to the covariance is integrated in closed form over the step, holding + * the step's starting rotation fixed (see :func:`step_noise_covariance`). The covariance of a + * window of measurements is therefore full rank even when the window consists of a single step. + * It is exact, and does not depend on how the window is divided into steps, for a non-rotating + * body; with an angular rate it is accurate to first order in the rotation per step. + * * Args: * DR: Preintegrated change in orientation * Dv: Preintegrated change in velocity @@ -35,8 +42,10 @@ namespace sym { * Dp_D_gyro_bias: Derivative of Dp w.r.t. gyro_bias * accel_bias: Initial guess for the accelerometer measurement bias * gyro_bias: Initial guess for the gyroscope measurement bias - * accel_cov_diagonal: The diagonal of the covariance of the accelerometer measurement - * gyro_cov_diagonal: The diagonal of the covariance of the gyroscope measurement + * accel_cov_diagonal: The diagonal of the noise spectral density of the accelerometer + * measurement, i.e. the covariance of a measurement times the time it covers + * gyro_cov_diagonal: The diagonal of the noise spectral density of the gyroscope + * measurement, i.e. the covariance of a measurement times the time it covers * accel_measurement: The accelerometer measurement * gyro_measurement: The gyroscope measurement * dt: The time between the new measurements and the last @@ -76,12 +85,12 @@ void ImuManifoldPreintegrationUpdate( Eigen::Matrix* const new_Dv_D_gyro_bias = nullptr, Eigen::Matrix* const new_Dp_D_accel_bias = nullptr, Eigen::Matrix* const new_Dp_D_gyro_bias = nullptr) { - // Total ops: 1253 + // Total ops: 1301 // Input arrays const Eigen::Matrix& _DR = DR.Data(); - // Intermediate terms (340) + // Intermediate terms (332) const Scalar _tmp0 = std::pow(dt, Scalar(2)); const Scalar _tmp1 = -gyro_bias(2, 0) + gyro_measurement(2, 0); const Scalar _tmp2 = _tmp0 * std::pow(_tmp1, Scalar(2)); @@ -96,397 +105,395 @@ void ImuManifoldPreintegrationUpdate( const Scalar _tmp11 = std::cos(_tmp10); const Scalar _tmp12 = std::sin(_tmp10); const Scalar _tmp13 = _tmp12 / _tmp9; - const Scalar _tmp14 = _tmp13 * dt; - const Scalar _tmp15 = _tmp14 * _tmp5; - const Scalar _tmp16 = _tmp14 * _tmp3; - const Scalar _tmp17 = _tmp1 * dt; - const Scalar _tmp18 = _tmp13 * _tmp17; - const Scalar _tmp19 = -2 * std::pow(_DR[2], Scalar(2)); - const Scalar _tmp20 = 1 - 2 * std::pow(_DR[1], Scalar(2)); - const Scalar _tmp21 = _tmp19 + _tmp20; - const Scalar _tmp22 = -accel_bias(0, 0) + accel_measurement(0, 0); - const Scalar _tmp23 = 2 * _DR[1]; - const Scalar _tmp24 = _DR[3] * _tmp23; - const Scalar _tmp25 = 2 * _DR[0]; - const Scalar _tmp26 = _DR[2] * _tmp25; - const Scalar _tmp27 = _tmp24 + _tmp26; - const Scalar _tmp28 = -accel_bias(2, 0) + accel_measurement(2, 0); - const Scalar _tmp29 = _DR[0] * _tmp23; - const Scalar _tmp30 = 2 * _DR[2] * _DR[3]; - const Scalar _tmp31 = _tmp29 - _tmp30; - const Scalar _tmp32 = -accel_bias(1, 0) + accel_measurement(1, 0); - const Scalar _tmp33 = _tmp21 * _tmp22 + _tmp27 * _tmp28 + _tmp31 * _tmp32; - const Scalar _tmp34 = -2 * std::pow(_DR[0], Scalar(2)); - const Scalar _tmp35 = _tmp19 + _tmp34 + 1; - const Scalar _tmp36 = _tmp29 + _tmp30; - const Scalar _tmp37 = _DR[3] * _tmp25; - const Scalar _tmp38 = _DR[2] * _tmp23; - const Scalar _tmp39 = -_tmp37 + _tmp38; - const Scalar _tmp40 = _tmp22 * _tmp36 + _tmp28 * _tmp39 + _tmp32 * _tmp35; - const Scalar _tmp41 = _tmp20 + _tmp34; - const Scalar _tmp42 = -_tmp24 + _tmp26; - const Scalar _tmp43 = _tmp37 + _tmp38; - const Scalar _tmp44 = _tmp22 * _tmp42 + _tmp28 * _tmp41 + _tmp32 * _tmp43; - const Scalar _tmp45 = (Scalar(1) / Scalar(2)) * _tmp0; - const Scalar _tmp46 = 2 * _tmp11; - const Scalar _tmp47 = _tmp16 * _tmp46; - const Scalar _tmp48 = 2 * std::pow(_tmp12, Scalar(2)) / _tmp8; - const Scalar _tmp49 = _tmp0 * _tmp5; - const Scalar _tmp50 = _tmp48 * _tmp49; - const Scalar _tmp51 = _tmp1 * _tmp50; - const Scalar _tmp52 = -_tmp47 + _tmp51; - const Scalar _tmp53 = _tmp18 * _tmp46; - const Scalar _tmp54 = _tmp3 * _tmp50; - const Scalar _tmp55 = _tmp53 + _tmp54; - const Scalar _tmp56 = -_tmp2 * _tmp48; - const Scalar _tmp57 = -_tmp4 * _tmp48 + 1; - const Scalar _tmp58 = _tmp56 + _tmp57; - const Scalar _tmp59 = _tmp7 + std::sqrt(epsilon); - const Scalar _tmp60 = std::sqrt(_tmp59); - const Scalar _tmp61 = (1 - std::cos(_tmp60)) / _tmp59; - const Scalar _tmp62 = _tmp17 * _tmp61; - const Scalar _tmp63 = (_tmp60 - std::sin(_tmp60)) / (_tmp59 * std::sqrt(_tmp59)); - const Scalar _tmp64 = _tmp49 * _tmp63; - const Scalar _tmp65 = _tmp3 * _tmp64; - const Scalar _tmp66 = _tmp62 + _tmp65; - const Scalar _tmp67 = dt * gyro_cov_diagonal(1, 0); - const Scalar _tmp68 = _tmp61 * dt; - const Scalar _tmp69 = _tmp3 * _tmp68; - const Scalar _tmp70 = _tmp1 * _tmp64; - const Scalar _tmp71 = -_tmp69 + _tmp70; - const Scalar _tmp72 = dt * gyro_cov_diagonal(2, 0); - const Scalar _tmp73 = -_tmp2; - const Scalar _tmp74 = -_tmp4; - const Scalar _tmp75 = _tmp63 * (_tmp73 + _tmp74) + 1; - const Scalar _tmp76 = dt * gyro_cov_diagonal(0, 0); - const Scalar _tmp77 = -_tmp53 + _tmp54; - const Scalar _tmp78 = _tmp15 * _tmp46; - const Scalar _tmp79 = _tmp0 * _tmp1 * _tmp3; - const Scalar _tmp80 = _tmp48 * _tmp79; - const Scalar _tmp81 = _tmp78 + _tmp80; - const Scalar _tmp82 = -_tmp48 * _tmp6; - const Scalar _tmp83 = _tmp56 + _tmp82 + 1; - const Scalar _tmp84 = - _tmp77 * covariance(1, 0) + _tmp81 * covariance(2, 1) + _tmp83 * covariance(1, 1); - const Scalar _tmp85 = -_tmp6; - const Scalar _tmp86 = _tmp63 * (_tmp73 + _tmp85) + 1; - const Scalar _tmp87 = _tmp86 * dt; - const Scalar _tmp88 = _tmp66 * gyro_cov_diagonal(1, 0); - const Scalar _tmp89 = - _tmp77 * covariance(2, 0) + _tmp81 * covariance(2, 2) + _tmp83 * covariance(2, 1); - const Scalar _tmp90 = - _tmp77 * covariance(0, 0) + _tmp81 * covariance(2, 0) + _tmp83 * covariance(1, 0); - const Scalar _tmp91 = _tmp5 * _tmp68; - const Scalar _tmp92 = _tmp63 * _tmp79; - const Scalar _tmp93 = _tmp91 + _tmp92; - const Scalar _tmp94 = _tmp93 * dt; - const Scalar _tmp95 = _tmp94 * gyro_cov_diagonal(2, 0); - const Scalar _tmp96 = _tmp75 * dt; - const Scalar _tmp97 = -_tmp62 + _tmp65; - const Scalar _tmp98 = _tmp97 * gyro_cov_diagonal(0, 0); - const Scalar _tmp99 = _tmp52 * _tmp89 + _tmp55 * _tmp84 + _tmp58 * _tmp90 + _tmp71 * _tmp95 + - _tmp87 * _tmp88 + _tmp96 * _tmp98; - const Scalar _tmp100 = -_tmp78 + _tmp80; - const Scalar _tmp101 = _tmp47 + _tmp51; - const Scalar _tmp102 = _tmp57 + _tmp82; - const Scalar _tmp103 = - _tmp100 * covariance(2, 1) + _tmp101 * covariance(2, 0) + _tmp102 * covariance(2, 2); - const Scalar _tmp104 = -_tmp91 + _tmp92; - const Scalar _tmp105 = _tmp104 * dt; - const Scalar _tmp106 = _tmp69 + _tmp70; - const Scalar _tmp107 = - _tmp100 * covariance(1, 0) + _tmp101 * covariance(0, 0) + _tmp102 * covariance(2, 0); - const Scalar _tmp108 = - _tmp100 * covariance(1, 1) + _tmp101 * covariance(1, 0) + _tmp102 * covariance(2, 1); - const Scalar _tmp109 = _tmp63 * (_tmp74 + _tmp85) + 1; - const Scalar _tmp110 = _tmp109 * dt; - const Scalar _tmp111 = _tmp103 * _tmp52 + _tmp105 * _tmp88 + - _tmp106 * _tmp96 * gyro_cov_diagonal(0, 0) + _tmp107 * _tmp58 + - _tmp108 * _tmp55 + _tmp110 * _tmp71 * gyro_cov_diagonal(2, 0); - const Scalar _tmp112 = _tmp27 * dt; - const Scalar _tmp113 = _tmp21 * dt; - const Scalar _tmp114 = -_tmp112 * _tmp22 + _tmp113 * _tmp28; - const Scalar _tmp115 = _tmp114 * covariance(2, 1); - const Scalar _tmp116 = _tmp31 * dt; - const Scalar _tmp117 = _tmp112 * _tmp32 - _tmp116 * _tmp28; - const Scalar _tmp118 = _tmp117 * covariance(2, 0); - const Scalar _tmp119 = -_tmp113 * _tmp32 + _tmp116 * _tmp22; - const Scalar _tmp120 = _tmp119 * covariance(2, 2); - const Scalar _tmp121 = _tmp115 + _tmp118 + _tmp120 + covariance(3, 2); - const Scalar _tmp122 = _tmp114 * covariance(1, 1); - const Scalar _tmp123 = _tmp117 * covariance(1, 0); - const Scalar _tmp124 = _tmp119 * covariance(2, 1); - const Scalar _tmp125 = _tmp122 + _tmp123 + _tmp124 + covariance(3, 1); - const Scalar _tmp126 = _tmp114 * covariance(1, 0); - const Scalar _tmp127 = _tmp117 * covariance(0, 0); - const Scalar _tmp128 = _tmp119 * covariance(2, 0); - const Scalar _tmp129 = _tmp126 + _tmp127 + _tmp128 + covariance(3, 0); - const Scalar _tmp130 = _tmp121 * _tmp52 + _tmp125 * _tmp55 + _tmp129 * _tmp58; - const Scalar _tmp131 = _tmp36 * dt; - const Scalar _tmp132 = _tmp35 * dt; - const Scalar _tmp133 = -_tmp131 * _tmp32 + _tmp132 * _tmp22; - const Scalar _tmp134 = _tmp133 * covariance(2, 2); - const Scalar _tmp135 = _tmp39 * dt; - const Scalar _tmp136 = -_tmp132 * _tmp28 + _tmp135 * _tmp32; - const Scalar _tmp137 = _tmp136 * covariance(2, 0); - const Scalar _tmp138 = _tmp131 * _tmp28 - _tmp135 * _tmp22; - const Scalar _tmp139 = _tmp138 * covariance(2, 1); - const Scalar _tmp140 = _tmp134 + _tmp137 + _tmp139 + covariance(4, 2); - const Scalar _tmp141 = _tmp133 * covariance(2, 0); - const Scalar _tmp142 = _tmp136 * covariance(0, 0); - const Scalar _tmp143 = _tmp138 * covariance(1, 0); - const Scalar _tmp144 = _tmp141 + _tmp142 + _tmp143 + covariance(4, 0); + const Scalar _tmp14 = _DR[3] * _tmp13; + const Scalar _tmp15 = _tmp14 * dt; + const Scalar _tmp16 = _tmp3 * dt; + const Scalar _tmp17 = _DR[2] * _tmp13; + const Scalar _tmp18 = _DR[1] * _tmp13; + const Scalar _tmp19 = _tmp18 * dt; + const Scalar _tmp20 = _DR[0] * _tmp13; + const Scalar _tmp21 = _tmp20 * dt; + const Scalar _tmp22 = _tmp17 * dt; + const Scalar _tmp23 = -2 * std::pow(_DR[2], Scalar(2)); + const Scalar _tmp24 = 1 - 2 * std::pow(_DR[1], Scalar(2)); + const Scalar _tmp25 = _tmp23 + _tmp24; + const Scalar _tmp26 = -accel_bias(0, 0) + accel_measurement(0, 0); + const Scalar _tmp27 = 2 * _DR[3]; + const Scalar _tmp28 = _DR[1] * _tmp27; + const Scalar _tmp29 = 2 * _DR[0]; + const Scalar _tmp30 = _DR[2] * _tmp29; + const Scalar _tmp31 = _tmp28 + _tmp30; + const Scalar _tmp32 = -accel_bias(2, 0) + accel_measurement(2, 0); + const Scalar _tmp33 = _DR[1] * _tmp29; + const Scalar _tmp34 = _DR[2] * _tmp27; + const Scalar _tmp35 = _tmp33 - _tmp34; + const Scalar _tmp36 = -accel_bias(1, 0) + accel_measurement(1, 0); + const Scalar _tmp37 = _tmp25 * _tmp26 + _tmp31 * _tmp32 + _tmp35 * _tmp36; + const Scalar _tmp38 = -2 * std::pow(_DR[0], Scalar(2)); + const Scalar _tmp39 = _tmp23 + _tmp38 + 1; + const Scalar _tmp40 = _tmp33 + _tmp34; + const Scalar _tmp41 = _DR[0] * _tmp27; + const Scalar _tmp42 = 2 * _DR[1] * _DR[2]; + const Scalar _tmp43 = -_tmp41 + _tmp42; + const Scalar _tmp44 = _tmp26 * _tmp40 + _tmp32 * _tmp43 + _tmp36 * _tmp39; + const Scalar _tmp45 = _tmp24 + _tmp38; + const Scalar _tmp46 = -_tmp28 + _tmp30; + const Scalar _tmp47 = _tmp41 + _tmp42; + const Scalar _tmp48 = _tmp26 * _tmp46 + _tmp32 * _tmp45 + _tmp36 * _tmp47; + const Scalar _tmp49 = (Scalar(1) / Scalar(2)) * _tmp0; + const Scalar _tmp50 = 2 * _tmp11 * _tmp13; + const Scalar _tmp51 = _tmp16 * _tmp50; + const Scalar _tmp52 = _tmp0 * _tmp1; + const Scalar _tmp53 = 2 * std::pow(_tmp12, Scalar(2)) / _tmp8; + const Scalar _tmp54 = _tmp5 * _tmp53; + const Scalar _tmp55 = _tmp52 * _tmp54; + const Scalar _tmp56 = -_tmp51 + _tmp55; + const Scalar _tmp57 = _tmp50 * dt; + const Scalar _tmp58 = _tmp1 * _tmp57; + const Scalar _tmp59 = _tmp0 * _tmp3; + const Scalar _tmp60 = _tmp54 * _tmp59; + const Scalar _tmp61 = _tmp58 + _tmp60; + const Scalar _tmp62 = -_tmp2 * _tmp53; + const Scalar _tmp63 = -_tmp4 * _tmp53 + 1; + const Scalar _tmp64 = _tmp62 + _tmp63; + const Scalar _tmp65 = -_tmp58 + _tmp60; + const Scalar _tmp66 = _tmp5 * _tmp57; + const Scalar _tmp67 = _tmp3 * _tmp52; + const Scalar _tmp68 = _tmp53 * _tmp67; + const Scalar _tmp69 = _tmp66 + _tmp68; + const Scalar _tmp70 = -_tmp53 * _tmp6; + const Scalar _tmp71 = _tmp62 + _tmp70 + 1; + const Scalar _tmp72 = + _tmp65 * covariance(1, 0) + _tmp69 * covariance(2, 1) + _tmp71 * covariance(1, 1); + const Scalar _tmp73 = + _tmp65 * covariance(2, 0) + _tmp69 * covariance(2, 2) + _tmp71 * covariance(2, 1); + const Scalar _tmp74 = + _tmp65 * covariance(0, 0) + _tmp69 * covariance(2, 0) + _tmp71 * covariance(1, 0); + const Scalar _tmp75 = _tmp56 * _tmp73 + _tmp61 * _tmp72 + _tmp64 * _tmp74; + const Scalar _tmp76 = -_tmp66 + _tmp68; + const Scalar _tmp77 = _tmp51 + _tmp55; + const Scalar _tmp78 = _tmp63 + _tmp70; + const Scalar _tmp79 = + _tmp76 * covariance(2, 1) + _tmp77 * covariance(2, 0) + _tmp78 * covariance(2, 2); + const Scalar _tmp80 = + _tmp76 * covariance(1, 0) + _tmp77 * covariance(0, 0) + _tmp78 * covariance(2, 0); + const Scalar _tmp81 = + _tmp76 * covariance(1, 1) + _tmp77 * covariance(1, 0) + _tmp78 * covariance(2, 1); + const Scalar _tmp82 = _tmp56 * _tmp79 + _tmp61 * _tmp81 + _tmp64 * _tmp80; + const Scalar _tmp83 = _tmp31 * _tmp36; + const Scalar _tmp84 = _tmp32 * _tmp35; + const Scalar _tmp85 = _tmp83 - _tmp84; + const Scalar _tmp86 = _tmp85 * gyro_cov_diagonal(0, 0); + const Scalar _tmp87 = _tmp26 * _tmp31; + const Scalar _tmp88 = _tmp25 * _tmp32; + const Scalar _tmp89 = -_tmp87 * dt + _tmp88 * dt; + const Scalar _tmp90 = _tmp89 * covariance(2, 1); + const Scalar _tmp91 = _tmp83 * dt - _tmp84 * dt; + const Scalar _tmp92 = _tmp91 * covariance(2, 0); + const Scalar _tmp93 = _tmp26 * _tmp35; + const Scalar _tmp94 = _tmp25 * _tmp36; + const Scalar _tmp95 = _tmp93 * dt - _tmp94 * dt; + const Scalar _tmp96 = _tmp95 * covariance(2, 2); + const Scalar _tmp97 = _tmp90 + _tmp92 + _tmp96 + covariance(3, 2); + const Scalar _tmp98 = _tmp89 * covariance(1, 1); + const Scalar _tmp99 = _tmp91 * covariance(1, 0); + const Scalar _tmp100 = _tmp95 * covariance(2, 1); + const Scalar _tmp101 = _tmp100 + _tmp98 + _tmp99 + covariance(3, 1); + const Scalar _tmp102 = _tmp89 * covariance(1, 0); + const Scalar _tmp103 = _tmp91 * covariance(0, 0); + const Scalar _tmp104 = _tmp95 * covariance(2, 0); + const Scalar _tmp105 = _tmp102 + _tmp103 + _tmp104 + covariance(3, 0); + const Scalar _tmp106 = _tmp101 * _tmp61 + _tmp105 * _tmp64 + _tmp49 * _tmp86 + _tmp56 * _tmp97; + const Scalar _tmp107 = _tmp36 * _tmp40; + const Scalar _tmp108 = _tmp26 * _tmp39; + const Scalar _tmp109 = -_tmp107 * dt + _tmp108 * dt; + const Scalar _tmp110 = _tmp109 * covariance(2, 2); + const Scalar _tmp111 = _tmp36 * _tmp43; + const Scalar _tmp112 = _tmp32 * _tmp39; + const Scalar _tmp113 = _tmp111 * dt - _tmp112 * dt; + const Scalar _tmp114 = _tmp113 * covariance(2, 0); + const Scalar _tmp115 = _tmp26 * _tmp43; + const Scalar _tmp116 = _tmp32 * _tmp40; + const Scalar _tmp117 = -_tmp115 * dt + _tmp116 * dt; + const Scalar _tmp118 = _tmp117 * covariance(2, 1); + const Scalar _tmp119 = _tmp110 + _tmp114 + _tmp118 + covariance(4, 2); + const Scalar _tmp120 = _tmp111 - _tmp112; + const Scalar _tmp121 = _tmp120 * gyro_cov_diagonal(0, 0); + const Scalar _tmp122 = _tmp109 * covariance(2, 0); + const Scalar _tmp123 = _tmp113 * covariance(0, 0); + const Scalar _tmp124 = _tmp117 * covariance(1, 0); + const Scalar _tmp125 = _tmp122 + _tmp123 + _tmp124 + covariance(4, 0); + const Scalar _tmp126 = _tmp109 * covariance(2, 1); + const Scalar _tmp127 = _tmp113 * covariance(1, 0); + const Scalar _tmp128 = _tmp117 * covariance(1, 1); + const Scalar _tmp129 = _tmp126 + _tmp127 + _tmp128 + covariance(4, 1); + const Scalar _tmp130 = _tmp119 * _tmp56 + _tmp121 * _tmp49 + _tmp125 * _tmp64 + _tmp129 * _tmp61; + const Scalar _tmp131 = _tmp32 * _tmp46; + const Scalar _tmp132 = _tmp45 * dt; + const Scalar _tmp133 = _tmp131 * dt - _tmp132 * _tmp26; + const Scalar _tmp134 = _tmp133 * covariance(1, 0); + const Scalar _tmp135 = _tmp32 * _tmp47; + const Scalar _tmp136 = _tmp132 * _tmp36 - _tmp135 * dt; + const Scalar _tmp137 = _tmp136 * covariance(0, 0); + const Scalar _tmp138 = _tmp26 * _tmp47; + const Scalar _tmp139 = _tmp36 * _tmp46; + const Scalar _tmp140 = _tmp138 * dt - _tmp139 * dt; + const Scalar _tmp141 = _tmp140 * covariance(2, 0); + const Scalar _tmp142 = _tmp134 + _tmp137 + _tmp141 + covariance(5, 0); + const Scalar _tmp143 = -_tmp135 + _tmp36 * _tmp45; + const Scalar _tmp144 = _tmp143 * gyro_cov_diagonal(0, 0); const Scalar _tmp145 = _tmp133 * covariance(2, 1); - const Scalar _tmp146 = _tmp136 * covariance(1, 0); - const Scalar _tmp147 = _tmp138 * covariance(1, 1); - const Scalar _tmp148 = _tmp145 + _tmp146 + _tmp147 + covariance(4, 1); - const Scalar _tmp149 = _tmp140 * _tmp52 + _tmp144 * _tmp58 + _tmp148 * _tmp55; - const Scalar _tmp150 = _tmp42 * dt; - const Scalar _tmp151 = _tmp41 * dt; - const Scalar _tmp152 = _tmp150 * _tmp28 - _tmp151 * _tmp22; - const Scalar _tmp153 = _tmp152 * covariance(1, 0); - const Scalar _tmp154 = _tmp43 * dt; - const Scalar _tmp155 = _tmp151 * _tmp32 - _tmp154 * _tmp28; - const Scalar _tmp156 = _tmp155 * covariance(0, 0); - const Scalar _tmp157 = -_tmp150 * _tmp32 + _tmp154 * _tmp22; - const Scalar _tmp158 = _tmp157 * covariance(2, 0); - const Scalar _tmp159 = _tmp153 + _tmp156 + _tmp158 + covariance(5, 0); - const Scalar _tmp160 = _tmp152 * covariance(2, 1); - const Scalar _tmp161 = _tmp155 * covariance(2, 0); - const Scalar _tmp162 = _tmp157 * covariance(2, 2); - const Scalar _tmp163 = _tmp160 + _tmp161 + _tmp162 + covariance(5, 2); - const Scalar _tmp164 = _tmp152 * covariance(1, 1); - const Scalar _tmp165 = _tmp155 * covariance(1, 0); - const Scalar _tmp166 = _tmp157 * covariance(2, 1); - const Scalar _tmp167 = _tmp164 + _tmp165 + _tmp166 + covariance(5, 1); - const Scalar _tmp168 = _tmp159 * _tmp58 + _tmp163 * _tmp52 + _tmp167 * _tmp55; - const Scalar _tmp169 = (Scalar(1) / Scalar(2)) * dt; - const Scalar _tmp170 = _tmp122 * _tmp169 + _tmp123 * _tmp169 + _tmp124 * _tmp169 + + const Scalar _tmp146 = _tmp136 * covariance(2, 0); + const Scalar _tmp147 = _tmp140 * covariance(2, 2); + const Scalar _tmp148 = _tmp145 + _tmp146 + _tmp147 + covariance(5, 2); + const Scalar _tmp149 = _tmp133 * covariance(1, 1); + const Scalar _tmp150 = _tmp136 * covariance(1, 0); + const Scalar _tmp151 = _tmp140 * covariance(2, 1); + const Scalar _tmp152 = _tmp149 + _tmp150 + _tmp151 + covariance(5, 1); + const Scalar _tmp153 = _tmp142 * _tmp64 + _tmp144 * _tmp49 + _tmp148 * _tmp56 + _tmp152 * _tmp61; + const Scalar _tmp154 = [&]() { + const Scalar base = dt; + return base * base * base; + }(); + const Scalar _tmp155 = (Scalar(1) / Scalar(6)) * _tmp154; + const Scalar _tmp156 = (Scalar(1) / Scalar(2)) * dt; + const Scalar _tmp157 = _tmp100 * _tmp156 + _tmp156 * _tmp98 + _tmp156 * _tmp99 + covariance(3, 1) * dt + covariance(6, 1); - const Scalar _tmp171 = _tmp115 * _tmp169 + _tmp118 * _tmp169 + _tmp120 * _tmp169 + - covariance(3, 2) * dt + covariance(6, 2); - const Scalar _tmp172 = _tmp126 * _tmp169 + _tmp127 * _tmp169 + _tmp128 * _tmp169 + + const Scalar _tmp158 = covariance(3, 2) * dt; + const Scalar _tmp159 = + _tmp156 * _tmp90 + _tmp156 * _tmp92 + _tmp156 * _tmp96 + _tmp158 + covariance(6, 2); + const Scalar _tmp160 = _tmp102 * _tmp156 + _tmp103 * _tmp156 + _tmp104 * _tmp156 + covariance(3, 0) * dt + covariance(6, 0); - const Scalar _tmp173 = _tmp170 * _tmp55 + _tmp171 * _tmp52 + _tmp172 * _tmp58; - const Scalar _tmp174 = covariance(4, 0) * dt; - const Scalar _tmp175 = - _tmp141 * _tmp169 + _tmp142 * _tmp169 + _tmp143 * _tmp169 + _tmp174 + covariance(7, 0); - const Scalar _tmp176 = covariance(4, 1) * dt; - const Scalar _tmp177 = - _tmp145 * _tmp169 + _tmp146 * _tmp169 + _tmp147 * _tmp169 + _tmp176 + covariance(7, 1); - const Scalar _tmp178 = covariance(4, 2) * dt; - const Scalar _tmp179 = - _tmp134 * _tmp169 + _tmp137 * _tmp169 + _tmp139 * _tmp169 + _tmp178 + covariance(7, 2); - const Scalar _tmp180 = _tmp175 * _tmp58 + _tmp177 * _tmp55 + _tmp179 * _tmp52; - const Scalar _tmp181 = covariance(5, 0) * dt; - const Scalar _tmp182 = - _tmp153 * _tmp169 + _tmp156 * _tmp169 + _tmp158 * _tmp169 + _tmp181 + covariance(8, 0); - const Scalar _tmp183 = covariance(5, 1) * dt; - const Scalar _tmp184 = - _tmp164 * _tmp169 + _tmp165 * _tmp169 + _tmp166 * _tmp169 + _tmp183 + covariance(8, 1); - const Scalar _tmp185 = covariance(5, 2) * dt; - const Scalar _tmp186 = - _tmp160 * _tmp169 + _tmp161 * _tmp169 + _tmp162 * _tmp169 + _tmp185 + covariance(8, 2); - const Scalar _tmp187 = _tmp182 * _tmp58 + _tmp184 * _tmp55 + _tmp186 * _tmp52; - const Scalar _tmp188 = _tmp106 * dt; - const Scalar _tmp189 = _tmp103 * _tmp81 + _tmp105 * _tmp86 * gyro_cov_diagonal(1, 0) + - _tmp107 * _tmp77 + _tmp108 * _tmp83 + _tmp109 * _tmp95 + _tmp188 * _tmp98; - const Scalar _tmp190 = _tmp121 * _tmp81 + _tmp125 * _tmp83 + _tmp129 * _tmp77; - const Scalar _tmp191 = _tmp140 * _tmp81 + _tmp144 * _tmp77 + _tmp148 * _tmp83; - const Scalar _tmp192 = _tmp159 * _tmp77 + _tmp163 * _tmp81 + _tmp167 * _tmp83; - const Scalar _tmp193 = _tmp170 * _tmp83 + _tmp171 * _tmp81 + _tmp172 * _tmp77; - const Scalar _tmp194 = _tmp175 * _tmp77 + _tmp177 * _tmp83 + _tmp179 * _tmp81; - const Scalar _tmp195 = _tmp182 * _tmp77 + _tmp184 * _tmp83 + _tmp186 * _tmp81; - const Scalar _tmp196 = _tmp100 * _tmp125 + _tmp101 * _tmp129 + _tmp102 * _tmp121; - const Scalar _tmp197 = _tmp100 * _tmp148 + _tmp101 * _tmp144 + _tmp102 * _tmp140; - const Scalar _tmp198 = _tmp100 * _tmp167 + _tmp101 * _tmp159 + _tmp102 * _tmp163; - const Scalar _tmp199 = _tmp100 * _tmp170 + _tmp101 * _tmp172 + _tmp102 * _tmp171; - const Scalar _tmp200 = _tmp100 * _tmp177 + _tmp101 * _tmp175 + _tmp102 * _tmp179; - const Scalar _tmp201 = _tmp100 * _tmp184 + _tmp101 * _tmp182 + _tmp102 * _tmp186; - const Scalar _tmp202 = _tmp114 * covariance(3, 1); - const Scalar _tmp203 = std::pow(_tmp31, Scalar(2)); - const Scalar _tmp204 = accel_cov_diagonal(1, 0) * dt; - const Scalar _tmp205 = std::pow(_tmp27, Scalar(2)); - const Scalar _tmp206 = accel_cov_diagonal(2, 0) * dt; - const Scalar _tmp207 = std::pow(_tmp21, Scalar(2)); - const Scalar _tmp208 = accel_cov_diagonal(0, 0) * dt; - const Scalar _tmp209 = _tmp117 * covariance(3, 0); - const Scalar _tmp210 = _tmp119 * covariance(3, 2); - const Scalar _tmp211 = _tmp133 * covariance(3, 2); - const Scalar _tmp212 = _tmp27 * accel_cov_diagonal(2, 0); - const Scalar _tmp213 = _tmp136 * covariance(3, 0); - const Scalar _tmp214 = _tmp138 * covariance(3, 1); - const Scalar _tmp215 = _tmp35 * accel_cov_diagonal(1, 0); - const Scalar _tmp216 = _tmp131 * accel_cov_diagonal(0, 0); - const Scalar _tmp217 = _tmp114 * _tmp148 + _tmp116 * _tmp215 + _tmp117 * _tmp144 + - _tmp119 * _tmp140 + _tmp135 * _tmp212 + _tmp21 * _tmp216 + _tmp211 + - _tmp213 + _tmp214 + covariance(4, 3); - const Scalar _tmp218 = _tmp21 * accel_cov_diagonal(0, 0); - const Scalar _tmp219 = _tmp151 * accel_cov_diagonal(2, 0); - const Scalar _tmp220 = _tmp152 * covariance(3, 1); - const Scalar _tmp221 = _tmp155 * covariance(3, 0); - const Scalar _tmp222 = _tmp31 * accel_cov_diagonal(1, 0); - const Scalar _tmp223 = _tmp157 * covariance(3, 2); - const Scalar _tmp224 = _tmp114 * _tmp167 + _tmp117 * _tmp159 + _tmp119 * _tmp163 + - _tmp150 * _tmp218 + _tmp154 * _tmp222 + _tmp219 * _tmp27 + _tmp220 + - _tmp221 + _tmp223 + covariance(5, 3); - const Scalar _tmp225 = _tmp117 * _tmp172; - const Scalar _tmp226 = _tmp114 * _tmp170; - const Scalar _tmp227 = _tmp203 * accel_cov_diagonal(1, 0); - const Scalar _tmp228 = _tmp205 * accel_cov_diagonal(2, 0); - const Scalar _tmp229 = _tmp207 * accel_cov_diagonal(0, 0); - const Scalar _tmp230 = _tmp119 * _tmp171; - const Scalar _tmp231 = _tmp169 * _tmp202 + _tmp169 * _tmp209 + _tmp169 * _tmp210 + + const Scalar _tmp161 = _tmp155 * _tmp86 + _tmp157 * _tmp61 + _tmp159 * _tmp56 + _tmp160 * _tmp64; + const Scalar _tmp162 = covariance(4, 0) * dt; + const Scalar _tmp163 = + _tmp122 * _tmp156 + _tmp123 * _tmp156 + _tmp124 * _tmp156 + _tmp162 + covariance(7, 0); + const Scalar _tmp164 = covariance(4, 1) * dt; + const Scalar _tmp165 = + _tmp126 * _tmp156 + _tmp127 * _tmp156 + _tmp128 * _tmp156 + _tmp164 + covariance(7, 1); + const Scalar _tmp166 = covariance(4, 2) * dt; + const Scalar _tmp167 = + _tmp110 * _tmp156 + _tmp114 * _tmp156 + _tmp118 * _tmp156 + _tmp166 + covariance(7, 2); + const Scalar _tmp168 = _tmp121 * _tmp155 + _tmp163 * _tmp64 + _tmp165 * _tmp61 + _tmp167 * _tmp56; + const Scalar _tmp169 = covariance(5, 0) * dt; + const Scalar _tmp170 = + _tmp134 * _tmp156 + _tmp137 * _tmp156 + _tmp141 * _tmp156 + _tmp169 + covariance(8, 0); + const Scalar _tmp171 = covariance(5, 1) * dt; + const Scalar _tmp172 = + _tmp149 * _tmp156 + _tmp150 * _tmp156 + _tmp151 * _tmp156 + _tmp171 + covariance(8, 1); + const Scalar _tmp173 = covariance(5, 2) * dt; + const Scalar _tmp174 = + _tmp145 * _tmp156 + _tmp146 * _tmp156 + _tmp147 * _tmp156 + _tmp173 + covariance(8, 2); + const Scalar _tmp175 = _tmp144 * _tmp155 + _tmp170 * _tmp64 + _tmp172 * _tmp61 + _tmp174 * _tmp56; + const Scalar _tmp176 = _tmp65 * _tmp80 + _tmp69 * _tmp79 + _tmp71 * _tmp81; + const Scalar _tmp177 = -_tmp87 + _tmp88; + const Scalar _tmp178 = _tmp177 * gyro_cov_diagonal(1, 0); + const Scalar _tmp179 = _tmp101 * _tmp71 + _tmp105 * _tmp65 + _tmp178 * _tmp49 + _tmp69 * _tmp97; + const Scalar _tmp180 = -_tmp115 + _tmp116; + const Scalar _tmp181 = _tmp180 * gyro_cov_diagonal(1, 0); + const Scalar _tmp182 = _tmp119 * _tmp69 + _tmp125 * _tmp65 + _tmp129 * _tmp71 + _tmp181 * _tmp49; + const Scalar _tmp183 = _tmp131 - _tmp26 * _tmp45; + const Scalar _tmp184 = _tmp183 * gyro_cov_diagonal(1, 0); + const Scalar _tmp185 = _tmp142 * _tmp65 + _tmp148 * _tmp69 + _tmp152 * _tmp71 + _tmp184 * _tmp49; + const Scalar _tmp186 = _tmp155 * _tmp178 + _tmp157 * _tmp71 + _tmp159 * _tmp69 + _tmp160 * _tmp65; + const Scalar _tmp187 = _tmp155 * _tmp181 + _tmp163 * _tmp65 + _tmp165 * _tmp71 + _tmp167 * _tmp69; + const Scalar _tmp188 = _tmp155 * _tmp184 + _tmp170 * _tmp65 + _tmp172 * _tmp71 + _tmp174 * _tmp69; + const Scalar _tmp189 = _tmp93 - _tmp94; + const Scalar _tmp190 = _tmp189 * gyro_cov_diagonal(2, 0); + const Scalar _tmp191 = _tmp101 * _tmp76 + _tmp105 * _tmp77 + _tmp190 * _tmp49 + _tmp78 * _tmp97; + const Scalar _tmp192 = -_tmp107 + _tmp108; + const Scalar _tmp193 = _tmp192 * gyro_cov_diagonal(2, 0); + const Scalar _tmp194 = _tmp119 * _tmp78 + _tmp125 * _tmp77 + _tmp129 * _tmp76 + _tmp193 * _tmp49; + const Scalar _tmp195 = _tmp138 - _tmp139; + const Scalar _tmp196 = _tmp195 * gyro_cov_diagonal(2, 0); + const Scalar _tmp197 = _tmp142 * _tmp77 + _tmp148 * _tmp78 + _tmp152 * _tmp76 + _tmp196 * _tmp49; + const Scalar _tmp198 = _tmp155 * _tmp190 + _tmp157 * _tmp76 + _tmp159 * _tmp78 + _tmp160 * _tmp77; + const Scalar _tmp199 = _tmp155 * _tmp193 + _tmp163 * _tmp77 + _tmp165 * _tmp76 + _tmp167 * _tmp78; + const Scalar _tmp200 = _tmp155 * _tmp196 + _tmp170 * _tmp77 + _tmp172 * _tmp76 + _tmp174 * _tmp78; + const Scalar _tmp201 = std::pow(_tmp25, Scalar(2)) * accel_cov_diagonal(0, 0) + + std::pow(_tmp31, Scalar(2)) * accel_cov_diagonal(2, 0) + + std::pow(_tmp35, Scalar(2)) * accel_cov_diagonal(1, 0); + const Scalar _tmp202 = std::pow(_tmp177, Scalar(2)) * gyro_cov_diagonal(1, 0) + + std::pow(_tmp189, Scalar(2)) * gyro_cov_diagonal(2, 0) + + std::pow(_tmp85, Scalar(2)) * gyro_cov_diagonal(0, 0); + const Scalar _tmp203 = (Scalar(1) / Scalar(3)) * _tmp154; + const Scalar _tmp204 = _tmp89 * covariance(3, 1); + const Scalar _tmp205 = _tmp91 * covariance(3, 0); + const Scalar _tmp206 = _tmp95 * covariance(3, 2); + const Scalar _tmp207 = _tmp43 * accel_cov_diagonal(2, 0); + const Scalar _tmp208 = _tmp207 * _tmp31 + _tmp25 * _tmp40 * accel_cov_diagonal(0, 0) + + _tmp35 * _tmp39 * accel_cov_diagonal(1, 0); + const Scalar _tmp209 = _tmp113 * covariance(3, 0); + const Scalar _tmp210 = _tmp120 * _tmp86 + _tmp178 * _tmp180 + _tmp189 * _tmp193; + const Scalar _tmp211 = _tmp117 * covariance(3, 1); + const Scalar _tmp212 = _tmp109 * covariance(3, 2) + _tmp119 * _tmp95 + _tmp125 * _tmp91 + + _tmp129 * _tmp89 + _tmp203 * _tmp210 + _tmp208 * dt + _tmp209 + _tmp211 + + covariance(4, 3); + const Scalar _tmp213 = _tmp133 * covariance(3, 1); + const Scalar _tmp214 = _tmp136 * covariance(3, 0); + const Scalar _tmp215 = _tmp47 * accel_cov_diagonal(1, 0); + const Scalar _tmp216 = _tmp46 * accel_cov_diagonal(0, 0); + const Scalar _tmp217 = + _tmp215 * _tmp35 + _tmp216 * _tmp25 + _tmp31 * _tmp45 * accel_cov_diagonal(2, 0); + const Scalar _tmp218 = _tmp143 * _tmp86 + _tmp177 * _tmp184 + _tmp189 * _tmp196; + const Scalar _tmp219 = _tmp140 * covariance(3, 2); + const Scalar _tmp220 = _tmp142 * _tmp91 + _tmp148 * _tmp95 + _tmp152 * _tmp89 + + _tmp203 * _tmp218 + _tmp213 + _tmp214 + _tmp217 * dt + _tmp219 + + covariance(5, 3); + const Scalar _tmp221 = _tmp160 * _tmp91; + const Scalar _tmp222 = (Scalar(1) / Scalar(8)) * std::pow(dt, Scalar(4)); + const Scalar _tmp223 = _tmp157 * _tmp89; + const Scalar _tmp224 = _tmp159 * _tmp95; + const Scalar _tmp225 = _tmp156 * _tmp204 + _tmp156 * _tmp205 + _tmp156 * _tmp206 + covariance(3, 3) * dt + covariance(6, 3); - const Scalar _tmp232 = _tmp225 + _tmp226 + _tmp227 * _tmp45 + _tmp228 * _tmp45 + - _tmp229 * _tmp45 + _tmp230 + _tmp231; - const Scalar _tmp233 = _tmp117 * _tmp175; - const Scalar _tmp234 = _tmp119 * _tmp179; - const Scalar _tmp235 = _tmp114 * _tmp177; - const Scalar _tmp236 = covariance(4, 3) * dt; - const Scalar _tmp237 = - _tmp169 * _tmp211 + _tmp169 * _tmp213 + _tmp169 * _tmp214 + _tmp236 + covariance(7, 3); - const Scalar _tmp238 = _tmp39 * _tmp45; - const Scalar _tmp239 = _tmp31 * _tmp45; - const Scalar _tmp240 = _tmp21 * _tmp45; - const Scalar _tmp241 = _tmp36 * accel_cov_diagonal(0, 0); - const Scalar _tmp242 = _tmp212 * _tmp238 + _tmp215 * _tmp239 + _tmp240 * _tmp241; - const Scalar _tmp243 = _tmp233 + _tmp234 + _tmp235 + _tmp237 + _tmp242; - const Scalar _tmp244 = _tmp117 * _tmp182; - const Scalar _tmp245 = _tmp119 * _tmp186; - const Scalar _tmp246 = _tmp114 * _tmp184; - const Scalar _tmp247 = covariance(5, 3) * dt; - const Scalar _tmp248 = - _tmp169 * _tmp220 + _tmp169 * _tmp221 + _tmp169 * _tmp223 + _tmp247 + covariance(8, 3); - const Scalar _tmp249 = _tmp42 * _tmp45; - const Scalar _tmp250 = _tmp27 * _tmp45; - const Scalar _tmp251 = _tmp41 * accel_cov_diagonal(2, 0); - const Scalar _tmp252 = _tmp43 * _tmp45; - const Scalar _tmp253 = _tmp218 * _tmp249 + _tmp222 * _tmp252 + _tmp250 * _tmp251; - const Scalar _tmp254 = _tmp244 + _tmp245 + _tmp246 + _tmp248 + _tmp253; - const Scalar _tmp255 = _tmp133 * covariance(4, 2); - const Scalar _tmp256 = std::pow(_tmp39, Scalar(2)); - const Scalar _tmp257 = std::pow(_tmp36, Scalar(2)); - const Scalar _tmp258 = std::pow(_tmp35, Scalar(2)); - const Scalar _tmp259 = _tmp136 * covariance(4, 0); - const Scalar _tmp260 = _tmp138 * covariance(4, 1); - const Scalar _tmp261 = _tmp152 * covariance(4, 1); - const Scalar _tmp262 = _tmp155 * covariance(4, 0); - const Scalar _tmp263 = _tmp157 * covariance(4, 2); - const Scalar _tmp264 = _tmp133 * _tmp163 + _tmp136 * _tmp159 + _tmp138 * _tmp167 + - _tmp154 * _tmp215 + _tmp216 * _tmp42 + _tmp219 * _tmp39 + _tmp261 + - _tmp262 + _tmp263 + covariance(5, 4); - const Scalar _tmp265 = (Scalar(1) / Scalar(2)) * _tmp114; - const Scalar _tmp266 = (Scalar(1) / Scalar(2)) * _tmp117 * _tmp174 + - (Scalar(1) / Scalar(2)) * _tmp119 * _tmp178 + _tmp133 * _tmp171 + - _tmp136 * _tmp172 + _tmp138 * _tmp170 + _tmp176 * _tmp265 + _tmp236 + - _tmp242 + covariance(6, 4); - const Scalar _tmp267 = _tmp256 * accel_cov_diagonal(2, 0); - const Scalar _tmp268 = _tmp136 * _tmp175; - const Scalar _tmp269 = _tmp257 * accel_cov_diagonal(0, 0); - const Scalar _tmp270 = _tmp258 * accel_cov_diagonal(1, 0); - const Scalar _tmp271 = _tmp133 * _tmp179; - const Scalar _tmp272 = _tmp138 * _tmp177; - const Scalar _tmp273 = _tmp169 * _tmp255 + _tmp169 * _tmp259 + _tmp169 * _tmp260 + + const Scalar _tmp226 = + _tmp201 * _tmp49 + _tmp202 * _tmp222 + _tmp221 + _tmp223 + _tmp224 + _tmp225; + const Scalar _tmp227 = _tmp163 * _tmp91; + const Scalar _tmp228 = _tmp167 * _tmp95; + const Scalar _tmp229 = _tmp165 * _tmp89; + const Scalar _tmp230 = covariance(4, 3) * dt; + const Scalar _tmp231 = (Scalar(1) / Scalar(2)) * _tmp109; + const Scalar _tmp232 = + _tmp156 * _tmp209 + _tmp156 * _tmp211 + _tmp158 * _tmp231 + _tmp230 + covariance(7, 3); + const Scalar _tmp233 = _tmp208 * _tmp49 + _tmp210 * _tmp222; + const Scalar _tmp234 = _tmp227 + _tmp228 + _tmp229 + _tmp232 + _tmp233; + const Scalar _tmp235 = _tmp170 * _tmp91; + const Scalar _tmp236 = _tmp174 * _tmp95; + const Scalar _tmp237 = _tmp172 * _tmp89; + const Scalar _tmp238 = covariance(5, 3) * dt; + const Scalar _tmp239 = + _tmp156 * _tmp213 + _tmp156 * _tmp214 + _tmp156 * _tmp219 + _tmp238 + covariance(8, 3); + const Scalar _tmp240 = _tmp217 * _tmp49 + _tmp218 * _tmp222; + const Scalar _tmp241 = _tmp235 + _tmp236 + _tmp237 + _tmp239 + _tmp240; + const Scalar _tmp242 = std::pow(_tmp120, Scalar(2)) * gyro_cov_diagonal(0, 0) + + std::pow(_tmp180, Scalar(2)) * gyro_cov_diagonal(1, 0) + + std::pow(_tmp192, Scalar(2)) * gyro_cov_diagonal(2, 0); + const Scalar _tmp243 = std::pow(_tmp39, Scalar(2)) * accel_cov_diagonal(1, 0) + + std::pow(_tmp40, Scalar(2)) * accel_cov_diagonal(0, 0) + + std::pow(_tmp43, Scalar(2)) * accel_cov_diagonal(2, 0); + const Scalar _tmp244 = _tmp113 * covariance(4, 0); + const Scalar _tmp245 = _tmp117 * covariance(4, 1); + const Scalar _tmp246 = _tmp120 * _tmp144 + _tmp180 * _tmp184 + _tmp193 * _tmp195; + const Scalar _tmp247 = _tmp133 * covariance(4, 1); + const Scalar _tmp248 = _tmp207 * _tmp45 + _tmp215 * _tmp39 + _tmp216 * _tmp40; + const Scalar _tmp249 = _tmp136 * covariance(4, 0); + const Scalar _tmp250 = _tmp140 * covariance(4, 2); + const Scalar _tmp251 = _tmp109 * _tmp148 + _tmp113 * _tmp142 + _tmp117 * _tmp152 + + _tmp203 * _tmp246 + _tmp247 + _tmp248 * dt + _tmp249 + _tmp250 + + covariance(5, 4); + const Scalar _tmp252 = (Scalar(1) / Scalar(2)) * _tmp95; + const Scalar _tmp253 = (Scalar(1) / Scalar(2)) * _tmp89; + const Scalar _tmp254 = _tmp109 * _tmp159 + _tmp113 * _tmp160 + _tmp117 * _tmp157 + + (Scalar(1) / Scalar(2)) * _tmp162 * _tmp91 + _tmp164 * _tmp253 + + _tmp166 * _tmp252 + _tmp230 + _tmp233 + covariance(6, 4); + const Scalar _tmp255 = _tmp113 * _tmp163; + const Scalar _tmp256 = _tmp109 * _tmp167; + const Scalar _tmp257 = _tmp117 * _tmp165; + const Scalar _tmp258 = _tmp156 * _tmp244 + _tmp156 * _tmp245 + _tmp166 * _tmp231 + covariance(4, 4) * dt + covariance(7, 4); - const Scalar _tmp274 = _tmp267 * _tmp45 + _tmp268 + _tmp269 * _tmp45 + _tmp270 * _tmp45 + - _tmp271 + _tmp272 + _tmp273; - const Scalar _tmp275 = _tmp133 * _tmp186; - const Scalar _tmp276 = _tmp136 * _tmp182; - const Scalar _tmp277 = _tmp138 * _tmp184; - const Scalar _tmp278 = covariance(5, 4) * dt; - const Scalar _tmp279 = - _tmp169 * _tmp261 + _tmp169 * _tmp262 + _tmp169 * _tmp263 + _tmp278 + covariance(8, 4); - const Scalar _tmp280 = _tmp215 * _tmp252 + _tmp238 * _tmp251 + _tmp241 * _tmp249; - const Scalar _tmp281 = _tmp275 + _tmp276 + _tmp277 + _tmp279 + _tmp280; - const Scalar _tmp282 = std::pow(_tmp43, Scalar(2)); - const Scalar _tmp283 = _tmp152 * covariance(5, 1); - const Scalar _tmp284 = _tmp155 * covariance(5, 0); - const Scalar _tmp285 = std::pow(_tmp42, Scalar(2)); - const Scalar _tmp286 = std::pow(_tmp41, Scalar(2)); - const Scalar _tmp287 = _tmp157 * covariance(5, 2); - const Scalar _tmp288 = (Scalar(1) / Scalar(2)) * _tmp185; - const Scalar _tmp289 = (Scalar(1) / Scalar(2)) * _tmp181; - const Scalar _tmp290 = _tmp117 * _tmp289 + _tmp119 * _tmp288 + _tmp152 * _tmp170 + - _tmp155 * _tmp172 + _tmp157 * _tmp171 + _tmp183 * _tmp265 + _tmp247 + - _tmp253 + covariance(6, 5); - const Scalar _tmp291 = _tmp133 * _tmp288 + _tmp136 * _tmp289 + - (Scalar(1) / Scalar(2)) * _tmp138 * _tmp183 + _tmp152 * _tmp177 + - _tmp155 * _tmp175 + _tmp157 * _tmp179 + _tmp278 + _tmp280 + - covariance(7, 5); - const Scalar _tmp292 = _tmp282 * accel_cov_diagonal(1, 0); - const Scalar _tmp293 = _tmp285 * accel_cov_diagonal(0, 0); - const Scalar _tmp294 = _tmp286 * accel_cov_diagonal(2, 0); - const Scalar _tmp295 = _tmp157 * _tmp186; - const Scalar _tmp296 = _tmp155 * _tmp182; - const Scalar _tmp297 = _tmp152 * _tmp184; - const Scalar _tmp298 = _tmp169 * _tmp283 + _tmp169 * _tmp284 + _tmp169 * _tmp287 + + const Scalar _tmp259 = + _tmp222 * _tmp242 + _tmp243 * _tmp49 + _tmp255 + _tmp256 + _tmp257 + _tmp258; + const Scalar _tmp260 = _tmp109 * _tmp174; + const Scalar _tmp261 = _tmp113 * _tmp170; + const Scalar _tmp262 = _tmp117 * _tmp172; + const Scalar _tmp263 = covariance(5, 4) * dt; + const Scalar _tmp264 = + _tmp156 * _tmp247 + _tmp156 * _tmp249 + _tmp156 * _tmp250 + _tmp263 + covariance(8, 4); + const Scalar _tmp265 = _tmp222 * _tmp246 + _tmp248 * _tmp49; + const Scalar _tmp266 = _tmp260 + _tmp261 + _tmp262 + _tmp264 + _tmp265; + const Scalar _tmp267 = _tmp133 * covariance(5, 1); + const Scalar _tmp268 = std::pow(_tmp143, Scalar(2)) * gyro_cov_diagonal(0, 0) + + std::pow(_tmp183, Scalar(2)) * gyro_cov_diagonal(1, 0) + + std::pow(_tmp195, Scalar(2)) * gyro_cov_diagonal(2, 0); + const Scalar _tmp269 = _tmp136 * covariance(5, 0); + const Scalar _tmp270 = std::pow(_tmp45, Scalar(2)) * accel_cov_diagonal(2, 0) + + std::pow(_tmp46, Scalar(2)) * accel_cov_diagonal(0, 0) + + std::pow(_tmp47, Scalar(2)) * accel_cov_diagonal(1, 0); + const Scalar _tmp271 = _tmp140 * covariance(5, 2); + const Scalar _tmp272 = (Scalar(1) / Scalar(2)) * _tmp169; + const Scalar _tmp273 = _tmp133 * _tmp157 + _tmp136 * _tmp160 + _tmp140 * _tmp159 + + _tmp171 * _tmp253 + _tmp173 * _tmp252 + _tmp238 + _tmp240 + + _tmp272 * _tmp91 + covariance(6, 5); + const Scalar _tmp274 = _tmp113 * _tmp272 + (Scalar(1) / Scalar(2)) * _tmp117 * _tmp171 + + _tmp133 * _tmp165 + _tmp136 * _tmp163 + _tmp140 * _tmp167 + + _tmp173 * _tmp231 + _tmp263 + _tmp265 + covariance(7, 5); + const Scalar _tmp275 = _tmp140 * _tmp174; + const Scalar _tmp276 = _tmp136 * _tmp170; + const Scalar _tmp277 = _tmp133 * _tmp172; + const Scalar _tmp278 = _tmp156 * _tmp267 + _tmp156 * _tmp269 + _tmp156 * _tmp271 + covariance(5, 5) * dt + covariance(8, 5); - const Scalar _tmp299 = _tmp292 * _tmp45 + _tmp293 * _tmp45 + _tmp294 * _tmp45 + _tmp295 + - _tmp296 + _tmp297 + _tmp298; - const Scalar _tmp300 = (Scalar(1) / Scalar(4)) * [&]() { - const Scalar base = dt; - return base * base * base; - }(); - const Scalar _tmp301 = _tmp169 * covariance(6, 1); - const Scalar _tmp302 = _tmp133 * _tmp169; - const Scalar _tmp303 = _tmp136 * _tmp169; - const Scalar _tmp304 = _tmp212 * _tmp300; - const Scalar _tmp305 = _tmp218 * _tmp300; - const Scalar _tmp306 = _tmp138 * _tmp301 + _tmp169 * _tmp233 + _tmp169 * _tmp234 + - _tmp169 * _tmp235 + _tmp215 * _tmp300 * _tmp31 + _tmp237 * dt + - _tmp302 * covariance(6, 2) + _tmp303 * covariance(6, 0) + - _tmp304 * _tmp39 + _tmp305 * _tmp36 + covariance(6, 4) * dt + - covariance(7, 6); - const Scalar _tmp307 = _tmp157 * _tmp169; - const Scalar _tmp308 = _tmp300 * _tmp43; - const Scalar _tmp309 = _tmp155 * _tmp169; - const Scalar _tmp310 = _tmp152 * _tmp301 + _tmp169 * _tmp244 + _tmp169 * _tmp245 + - _tmp169 * _tmp246 + _tmp222 * _tmp308 + _tmp248 * dt + _tmp304 * _tmp41 + - _tmp305 * _tmp42 + _tmp307 * covariance(6, 2) + - _tmp309 * covariance(6, 0) + covariance(6, 5) * dt + covariance(8, 6); - const Scalar _tmp311 = _tmp152 * _tmp169; - const Scalar _tmp312 = _tmp169 * _tmp275 + _tmp169 * _tmp276 + _tmp169 * _tmp277 + - _tmp215 * _tmp308 + _tmp241 * _tmp300 * _tmp42 + - _tmp251 * _tmp300 * _tmp39 + _tmp279 * dt + _tmp307 * covariance(7, 2) + - _tmp309 * covariance(7, 0) + _tmp311 * covariance(7, 1) + - covariance(7, 5) * dt + covariance(8, 7); - const Scalar _tmp313 = DR_D_gyro_bias(0, 0) * _tmp117; - const Scalar _tmp314 = DR_D_gyro_bias(2, 0) * _tmp119; - const Scalar _tmp315 = DR_D_gyro_bias(1, 0) * _tmp114; - const Scalar _tmp316 = DR_D_gyro_bias(1, 0) * _tmp138; - const Scalar _tmp317 = DR_D_gyro_bias(2, 0) * _tmp133; - const Scalar _tmp318 = DR_D_gyro_bias(0, 0) * _tmp136; - const Scalar _tmp319 = DR_D_gyro_bias(0, 0) * _tmp155; - const Scalar _tmp320 = DR_D_gyro_bias(2, 0) * _tmp157; - const Scalar _tmp321 = DR_D_gyro_bias(1, 0) * _tmp152; - const Scalar _tmp322 = DR_D_gyro_bias(0, 1) * _tmp117; - const Scalar _tmp323 = DR_D_gyro_bias(2, 1) * _tmp119; - const Scalar _tmp324 = DR_D_gyro_bias(1, 1) * _tmp114; - const Scalar _tmp325 = DR_D_gyro_bias(1, 1) * _tmp138; - const Scalar _tmp326 = DR_D_gyro_bias(2, 1) * _tmp133; - const Scalar _tmp327 = DR_D_gyro_bias(0, 1) * _tmp136; - const Scalar _tmp328 = DR_D_gyro_bias(0, 1) * _tmp155; - const Scalar _tmp329 = DR_D_gyro_bias(2, 1) * _tmp157; - const Scalar _tmp330 = DR_D_gyro_bias(1, 1) * _tmp152; - const Scalar _tmp331 = DR_D_gyro_bias(0, 2) * _tmp117; - const Scalar _tmp332 = DR_D_gyro_bias(2, 2) * _tmp119; - const Scalar _tmp333 = DR_D_gyro_bias(1, 2) * _tmp114; - const Scalar _tmp334 = DR_D_gyro_bias(1, 2) * _tmp138; - const Scalar _tmp335 = DR_D_gyro_bias(2, 2) * _tmp133; - const Scalar _tmp336 = DR_D_gyro_bias(0, 2) * _tmp136; - const Scalar _tmp337 = DR_D_gyro_bias(0, 2) * _tmp155; - const Scalar _tmp338 = DR_D_gyro_bias(2, 2) * _tmp157; - const Scalar _tmp339 = DR_D_gyro_bias(1, 2) * _tmp152; + const Scalar _tmp279 = + _tmp222 * _tmp268 + _tmp270 * _tmp49 + _tmp275 + _tmp276 + _tmp277 + _tmp278; + const Scalar _tmp280 = (Scalar(1) / Scalar(20)) * std::pow(dt, Scalar(5)); + const Scalar _tmp281 = _tmp156 * covariance(6, 1); + const Scalar _tmp282 = _tmp109 * _tmp156; + const Scalar _tmp283 = _tmp113 * _tmp156; + const Scalar _tmp284 = _tmp117 * _tmp281 + _tmp156 * _tmp227 + _tmp156 * _tmp228 + + _tmp156 * _tmp229 + _tmp203 * _tmp208 + _tmp210 * _tmp280 + _tmp232 * dt + + _tmp282 * covariance(6, 2) + _tmp283 * covariance(6, 0) + + covariance(6, 4) * dt + covariance(7, 6); + const Scalar _tmp285 = _tmp140 * _tmp156; + const Scalar _tmp286 = _tmp136 * _tmp156; + const Scalar _tmp287 = _tmp133 * _tmp281 + _tmp156 * _tmp235 + _tmp156 * _tmp236 + + _tmp156 * _tmp237 + _tmp203 * _tmp217 + _tmp218 * _tmp280 + _tmp239 * dt + + _tmp285 * covariance(6, 2) + _tmp286 * covariance(6, 0) + + covariance(6, 5) * dt + covariance(8, 6); + const Scalar _tmp288 = _tmp133 * _tmp156; + const Scalar _tmp289 = _tmp156 * _tmp260 + _tmp156 * _tmp261 + _tmp156 * _tmp262 + + _tmp203 * _tmp248 + _tmp246 * _tmp280 + _tmp264 * dt + + _tmp285 * covariance(7, 2) + _tmp286 * covariance(7, 0) + + _tmp288 * covariance(7, 1) + covariance(7, 5) * dt + covariance(8, 7); + const Scalar _tmp290 = -_tmp2; + const Scalar _tmp291 = -_tmp4; + const Scalar _tmp292 = _tmp7 + std::sqrt(epsilon); + const Scalar _tmp293 = std::sqrt(_tmp292); + const Scalar _tmp294 = (_tmp293 - std::sin(_tmp293)) / (_tmp292 * std::sqrt(_tmp292)); + const Scalar _tmp295 = (1 - std::cos(_tmp293)) / _tmp292; + const Scalar _tmp296 = _tmp295 * dt; + const Scalar _tmp297 = _tmp1 * _tmp296; + const Scalar _tmp298 = _tmp294 * _tmp5; + const Scalar _tmp299 = _tmp298 * _tmp59; + const Scalar _tmp300 = _tmp16 * _tmp295; + const Scalar _tmp301 = _tmp298 * _tmp52; + const Scalar _tmp302 = -_tmp6; + const Scalar _tmp303 = _tmp296 * _tmp5; + const Scalar _tmp304 = _tmp294 * _tmp67; + const Scalar _tmp305 = DR_D_gyro_bias(0, 0) * _tmp91; + const Scalar _tmp306 = DR_D_gyro_bias(2, 0) * _tmp95; + const Scalar _tmp307 = DR_D_gyro_bias(1, 0) * _tmp89; + const Scalar _tmp308 = DR_D_gyro_bias(1, 0) * _tmp117; + const Scalar _tmp309 = DR_D_gyro_bias(2, 0) * _tmp109; + const Scalar _tmp310 = DR_D_gyro_bias(0, 0) * _tmp113; + const Scalar _tmp311 = DR_D_gyro_bias(0, 0) * _tmp136; + const Scalar _tmp312 = DR_D_gyro_bias(2, 0) * _tmp140; + const Scalar _tmp313 = DR_D_gyro_bias(1, 0) * _tmp133; + const Scalar _tmp314 = DR_D_gyro_bias(0, 1) * _tmp91; + const Scalar _tmp315 = DR_D_gyro_bias(2, 1) * _tmp95; + const Scalar _tmp316 = DR_D_gyro_bias(1, 1) * _tmp89; + const Scalar _tmp317 = DR_D_gyro_bias(1, 1) * _tmp117; + const Scalar _tmp318 = DR_D_gyro_bias(2, 1) * _tmp109; + const Scalar _tmp319 = DR_D_gyro_bias(0, 1) * _tmp113; + const Scalar _tmp320 = DR_D_gyro_bias(0, 1) * _tmp136; + const Scalar _tmp321 = DR_D_gyro_bias(2, 1) * _tmp140; + const Scalar _tmp322 = DR_D_gyro_bias(1, 1) * _tmp133; + const Scalar _tmp323 = DR_D_gyro_bias(0, 2) * _tmp91; + const Scalar _tmp324 = DR_D_gyro_bias(2, 2) * _tmp95; + const Scalar _tmp325 = DR_D_gyro_bias(1, 2) * _tmp89; + const Scalar _tmp326 = DR_D_gyro_bias(1, 2) * _tmp117; + const Scalar _tmp327 = DR_D_gyro_bias(2, 2) * _tmp109; + const Scalar _tmp328 = DR_D_gyro_bias(0, 2) * _tmp113; + const Scalar _tmp329 = DR_D_gyro_bias(0, 2) * _tmp136; + const Scalar _tmp330 = DR_D_gyro_bias(2, 2) * _tmp140; + const Scalar _tmp331 = DR_D_gyro_bias(1, 2) * _tmp133; // Output terms (9) if (new_DR != nullptr) { Eigen::Matrix _new_DR; - _new_DR[0] = _DR[0] * _tmp11 + _DR[1] * _tmp18 - _DR[2] * _tmp16 + _DR[3] * _tmp15; - _new_DR[1] = -_DR[0] * _tmp18 + _DR[1] * _tmp11 + _DR[2] * _tmp15 + _DR[3] * _tmp16; - _new_DR[2] = _DR[0] * _tmp16 - _DR[1] * _tmp15 + _DR[2] * _tmp11 + _DR[3] * _tmp18; - _new_DR[3] = -_DR[0] * _tmp15 - _DR[1] * _tmp16 - _DR[2] * _tmp18 + _DR[3] * _tmp11; + _new_DR[0] = _DR[0] * _tmp11 + _tmp1 * _tmp19 + _tmp15 * _tmp5 - _tmp16 * _tmp17; + _new_DR[1] = _DR[1] * _tmp11 - _tmp1 * _tmp21 + _tmp14 * _tmp16 + _tmp22 * _tmp5; + _new_DR[2] = _DR[2] * _tmp11 + _tmp1 * _tmp15 + _tmp16 * _tmp20 - _tmp19 * _tmp5; + _new_DR[3] = _DR[3] * _tmp11 - _tmp1 * _tmp22 - _tmp16 * _tmp18 - _tmp21 * _tmp5; *new_DR = sym::Rot3(_new_DR); } @@ -494,224 +501,227 @@ void ImuManifoldPreintegrationUpdate( if (new_Dv != nullptr) { Eigen::Matrix& _new_Dv = (*new_Dv); - _new_Dv(0, 0) = Dv(0, 0) + _tmp33 * dt; - _new_Dv(1, 0) = Dv(1, 0) + _tmp40 * dt; - _new_Dv(2, 0) = Dv(2, 0) + _tmp44 * dt; + _new_Dv(0, 0) = Dv(0, 0) + _tmp37 * dt; + _new_Dv(1, 0) = Dv(1, 0) + _tmp44 * dt; + _new_Dv(2, 0) = Dv(2, 0) + _tmp48 * dt; } if (new_Dp != nullptr) { Eigen::Matrix& _new_Dp = (*new_Dp); - _new_Dp(0, 0) = Dp(0, 0) + Dv(0, 0) * dt + _tmp33 * _tmp45; - _new_Dp(1, 0) = Dp(1, 0) + Dv(1, 0) * dt + _tmp40 * _tmp45; - _new_Dp(2, 0) = Dp(2, 0) + Dv(2, 0) * dt + _tmp44 * _tmp45; + _new_Dp(0, 0) = Dp(0, 0) + Dv(0, 0) * dt + _tmp37 * _tmp49; + _new_Dp(1, 0) = Dp(1, 0) + Dv(1, 0) * dt + _tmp44 * _tmp49; + _new_Dp(2, 0) = Dp(2, 0) + Dv(2, 0) * dt + _tmp48 * _tmp49; } if (new_covariance != nullptr) { Eigen::Matrix& _new_covariance = (*new_covariance); _new_covariance(0, 0) = - _tmp52 * - (_tmp52 * covariance(2, 2) + _tmp55 * covariance(2, 1) + _tmp58 * covariance(2, 0)) + - _tmp55 * - (_tmp52 * covariance(2, 1) + _tmp55 * covariance(1, 1) + _tmp58 * covariance(1, 0)) + - _tmp58 * - (_tmp52 * covariance(2, 0) + _tmp55 * covariance(1, 0) + _tmp58 * covariance(0, 0)) + - std::pow(_tmp66, Scalar(2)) * _tmp67 + std::pow(_tmp71, Scalar(2)) * _tmp72 + - std::pow(_tmp75, Scalar(2)) * _tmp76; - _new_covariance(1, 0) = _tmp99; - _new_covariance(2, 0) = _tmp111; - _new_covariance(3, 0) = _tmp130; - _new_covariance(4, 0) = _tmp149; - _new_covariance(5, 0) = _tmp168; - _new_covariance(6, 0) = _tmp173; - _new_covariance(7, 0) = _tmp180; - _new_covariance(8, 0) = _tmp187; - _new_covariance(0, 1) = _tmp99; + _tmp56 * + (_tmp56 * covariance(2, 2) + _tmp61 * covariance(2, 1) + _tmp64 * covariance(2, 0)) + + _tmp61 * + (_tmp56 * covariance(2, 1) + _tmp61 * covariance(1, 1) + _tmp64 * covariance(1, 0)) + + _tmp64 * + (_tmp56 * covariance(2, 0) + _tmp61 * covariance(1, 0) + _tmp64 * covariance(0, 0)) + + dt * gyro_cov_diagonal(0, 0); + _new_covariance(1, 0) = _tmp75; + _new_covariance(2, 0) = _tmp82; + _new_covariance(3, 0) = _tmp106; + _new_covariance(4, 0) = _tmp130; + _new_covariance(5, 0) = _tmp153; + _new_covariance(6, 0) = _tmp161; + _new_covariance(7, 0) = _tmp168; + _new_covariance(8, 0) = _tmp175; + _new_covariance(0, 1) = _tmp75; _new_covariance(1, 1) = - _tmp67 * std::pow(_tmp86, Scalar(2)) + _tmp72 * std::pow(_tmp93, Scalar(2)) + - _tmp76 * std::pow(_tmp97, Scalar(2)) + _tmp77 * _tmp90 + _tmp81 * _tmp89 + _tmp83 * _tmp84; - _new_covariance(2, 1) = _tmp189; - _new_covariance(3, 1) = _tmp190; - _new_covariance(4, 1) = _tmp191; - _new_covariance(5, 1) = _tmp192; - _new_covariance(6, 1) = _tmp193; - _new_covariance(7, 1) = _tmp194; - _new_covariance(8, 1) = _tmp195; - _new_covariance(0, 2) = _tmp111; - _new_covariance(1, 2) = _tmp189; - _new_covariance(2, 2) = _tmp100 * _tmp108 + _tmp101 * _tmp107 + _tmp102 * _tmp103 + - std::pow(_tmp104, Scalar(2)) * _tmp67 + - std::pow(_tmp106, Scalar(2)) * _tmp76 + - std::pow(_tmp109, Scalar(2)) * _tmp72; - _new_covariance(3, 2) = _tmp196; - _new_covariance(4, 2) = _tmp197; - _new_covariance(5, 2) = _tmp198; - _new_covariance(6, 2) = _tmp199; - _new_covariance(7, 2) = _tmp200; - _new_covariance(8, 2) = _tmp201; - _new_covariance(0, 3) = _tmp130; - _new_covariance(1, 3) = _tmp190; - _new_covariance(2, 3) = _tmp196; - _new_covariance(3, 3) = _tmp114 * _tmp125 + _tmp117 * _tmp129 + _tmp119 * _tmp121 + _tmp202 + - _tmp203 * _tmp204 + _tmp205 * _tmp206 + _tmp207 * _tmp208 + _tmp209 + - _tmp210 + covariance(3, 3); - _new_covariance(4, 3) = _tmp217; - _new_covariance(5, 3) = _tmp224; - _new_covariance(6, 3) = _tmp232; - _new_covariance(7, 3) = _tmp243; - _new_covariance(8, 3) = _tmp254; - _new_covariance(0, 4) = _tmp149; - _new_covariance(1, 4) = _tmp191; - _new_covariance(2, 4) = _tmp197; - _new_covariance(3, 4) = _tmp217; - _new_covariance(4, 4) = _tmp133 * _tmp140 + _tmp136 * _tmp144 + _tmp138 * _tmp148 + - _tmp204 * _tmp258 + _tmp206 * _tmp256 + _tmp208 * _tmp257 + _tmp255 + - _tmp259 + _tmp260 + covariance(4, 4); - _new_covariance(5, 4) = _tmp264; - _new_covariance(6, 4) = _tmp266; - _new_covariance(7, 4) = _tmp274; - _new_covariance(8, 4) = _tmp281; - _new_covariance(0, 5) = _tmp168; - _new_covariance(1, 5) = _tmp192; - _new_covariance(2, 5) = _tmp198; - _new_covariance(3, 5) = _tmp224; - _new_covariance(4, 5) = _tmp264; - _new_covariance(5, 5) = _tmp152 * _tmp167 + _tmp155 * _tmp159 + _tmp157 * _tmp163 + - _tmp204 * _tmp282 + _tmp206 * _tmp286 + _tmp208 * _tmp285 + _tmp283 + - _tmp284 + _tmp287 + covariance(5, 5); - _new_covariance(6, 5) = _tmp290; - _new_covariance(7, 5) = _tmp291; - _new_covariance(8, 5) = _tmp299; - _new_covariance(0, 6) = _tmp173; - _new_covariance(1, 6) = _tmp193; - _new_covariance(2, 6) = _tmp199; - _new_covariance(3, 6) = _tmp232; - _new_covariance(4, 6) = _tmp266; - _new_covariance(5, 6) = _tmp290; - _new_covariance(6, 6) = _tmp114 * _tmp301 + _tmp117 * _tmp169 * covariance(6, 0) + - _tmp119 * _tmp169 * covariance(6, 2) + _tmp169 * _tmp225 + - _tmp169 * _tmp226 + _tmp169 * _tmp230 + _tmp227 * _tmp300 + - _tmp228 * _tmp300 + _tmp229 * _tmp300 + _tmp231 * dt + + _tmp65 * _tmp74 + _tmp69 * _tmp73 + _tmp71 * _tmp72 + dt * gyro_cov_diagonal(1, 0); + _new_covariance(2, 1) = _tmp176; + _new_covariance(3, 1) = _tmp179; + _new_covariance(4, 1) = _tmp182; + _new_covariance(5, 1) = _tmp185; + _new_covariance(6, 1) = _tmp186; + _new_covariance(7, 1) = _tmp187; + _new_covariance(8, 1) = _tmp188; + _new_covariance(0, 2) = _tmp82; + _new_covariance(1, 2) = _tmp176; + _new_covariance(2, 2) = + _tmp76 * _tmp81 + _tmp77 * _tmp80 + _tmp78 * _tmp79 + dt * gyro_cov_diagonal(2, 0); + _new_covariance(3, 2) = _tmp191; + _new_covariance(4, 2) = _tmp194; + _new_covariance(5, 2) = _tmp197; + _new_covariance(6, 2) = _tmp198; + _new_covariance(7, 2) = _tmp199; + _new_covariance(8, 2) = _tmp200; + _new_covariance(0, 3) = _tmp106; + _new_covariance(1, 3) = _tmp179; + _new_covariance(2, 3) = _tmp191; + _new_covariance(3, 3) = _tmp101 * _tmp89 + _tmp105 * _tmp91 + _tmp201 * dt + _tmp202 * _tmp203 + + _tmp204 + _tmp205 + _tmp206 + _tmp95 * _tmp97 + covariance(3, 3); + _new_covariance(4, 3) = _tmp212; + _new_covariance(5, 3) = _tmp220; + _new_covariance(6, 3) = _tmp226; + _new_covariance(7, 3) = _tmp234; + _new_covariance(8, 3) = _tmp241; + _new_covariance(0, 4) = _tmp130; + _new_covariance(1, 4) = _tmp182; + _new_covariance(2, 4) = _tmp194; + _new_covariance(3, 4) = _tmp212; + _new_covariance(4, 4) = _tmp109 * _tmp119 + _tmp109 * covariance(4, 2) + _tmp113 * _tmp125 + + _tmp117 * _tmp129 + _tmp203 * _tmp242 + _tmp243 * dt + _tmp244 + + _tmp245 + covariance(4, 4); + _new_covariance(5, 4) = _tmp251; + _new_covariance(6, 4) = _tmp254; + _new_covariance(7, 4) = _tmp259; + _new_covariance(8, 4) = _tmp266; + _new_covariance(0, 5) = _tmp153; + _new_covariance(1, 5) = _tmp185; + _new_covariance(2, 5) = _tmp197; + _new_covariance(3, 5) = _tmp220; + _new_covariance(4, 5) = _tmp251; + _new_covariance(5, 5) = _tmp133 * _tmp152 + _tmp136 * _tmp142 + _tmp140 * _tmp148 + + _tmp203 * _tmp268 + _tmp267 + _tmp269 + _tmp270 * dt + _tmp271 + + covariance(5, 5); + _new_covariance(6, 5) = _tmp273; + _new_covariance(7, 5) = _tmp274; + _new_covariance(8, 5) = _tmp279; + _new_covariance(0, 6) = _tmp161; + _new_covariance(1, 6) = _tmp186; + _new_covariance(2, 6) = _tmp198; + _new_covariance(3, 6) = _tmp226; + _new_covariance(4, 6) = _tmp254; + _new_covariance(5, 6) = _tmp273; + _new_covariance(6, 6) = _tmp156 * _tmp221 + _tmp156 * _tmp223 + _tmp156 * _tmp224 + + _tmp156 * _tmp91 * covariance(6, 0) + + _tmp156 * _tmp95 * covariance(6, 2) + _tmp201 * _tmp203 + + _tmp202 * _tmp280 + _tmp225 * dt + _tmp281 * _tmp89 + covariance(6, 3) * dt + covariance(6, 6); - _new_covariance(7, 6) = _tmp306; - _new_covariance(8, 6) = _tmp310; - _new_covariance(0, 7) = _tmp180; - _new_covariance(1, 7) = _tmp194; - _new_covariance(2, 7) = _tmp200; - _new_covariance(3, 7) = _tmp243; - _new_covariance(4, 7) = _tmp274; - _new_covariance(5, 7) = _tmp291; - _new_covariance(6, 7) = _tmp306; - _new_covariance(7, 7) = _tmp138 * _tmp169 * covariance(7, 1) + _tmp169 * _tmp268 + - _tmp169 * _tmp271 + _tmp169 * _tmp272 + _tmp267 * _tmp300 + - _tmp269 * _tmp300 + _tmp270 * _tmp300 + _tmp273 * dt + - _tmp302 * covariance(7, 2) + _tmp303 * covariance(7, 0) + - covariance(7, 4) * dt + covariance(7, 7); - _new_covariance(8, 7) = _tmp312; - _new_covariance(0, 8) = _tmp187; - _new_covariance(1, 8) = _tmp195; - _new_covariance(2, 8) = _tmp201; - _new_covariance(3, 8) = _tmp254; - _new_covariance(4, 8) = _tmp281; - _new_covariance(5, 8) = _tmp299; - _new_covariance(6, 8) = _tmp310; - _new_covariance(7, 8) = _tmp312; - _new_covariance(8, 8) = _tmp169 * _tmp295 + _tmp169 * _tmp296 + _tmp169 * _tmp297 + - _tmp292 * _tmp300 + _tmp293 * _tmp300 + _tmp294 * _tmp300 + - _tmp298 * dt + _tmp307 * covariance(8, 2) + _tmp309 * covariance(8, 0) + - _tmp311 * covariance(8, 1) + covariance(8, 5) * dt + covariance(8, 8); + _new_covariance(7, 6) = _tmp284; + _new_covariance(8, 6) = _tmp287; + _new_covariance(0, 7) = _tmp168; + _new_covariance(1, 7) = _tmp187; + _new_covariance(2, 7) = _tmp199; + _new_covariance(3, 7) = _tmp234; + _new_covariance(4, 7) = _tmp259; + _new_covariance(5, 7) = _tmp274; + _new_covariance(6, 7) = _tmp284; + _new_covariance(7, 7) = _tmp117 * _tmp156 * covariance(7, 1) + _tmp156 * _tmp255 + + _tmp156 * _tmp256 + _tmp156 * _tmp257 + _tmp203 * _tmp243 + + _tmp242 * _tmp280 + _tmp258 * dt + _tmp282 * covariance(7, 2) + + _tmp283 * covariance(7, 0) + covariance(7, 4) * dt + covariance(7, 7); + _new_covariance(8, 7) = _tmp289; + _new_covariance(0, 8) = _tmp175; + _new_covariance(1, 8) = _tmp188; + _new_covariance(2, 8) = _tmp200; + _new_covariance(3, 8) = _tmp241; + _new_covariance(4, 8) = _tmp266; + _new_covariance(5, 8) = _tmp279; + _new_covariance(6, 8) = _tmp287; + _new_covariance(7, 8) = _tmp289; + _new_covariance(8, 8) = _tmp156 * _tmp275 + _tmp156 * _tmp276 + _tmp156 * _tmp277 + + _tmp203 * _tmp270 + _tmp268 * _tmp280 + _tmp278 * dt + + _tmp285 * covariance(8, 2) + _tmp286 * covariance(8, 0) + + _tmp288 * covariance(8, 1) + covariance(8, 5) * dt + covariance(8, 8); } if (new_DR_D_gyro_bias != nullptr) { Eigen::Matrix& _new_DR_D_gyro_bias = (*new_DR_D_gyro_bias); - _new_DR_D_gyro_bias(0, 0) = DR_D_gyro_bias(0, 0) * _tmp58 + DR_D_gyro_bias(1, 0) * _tmp55 + - DR_D_gyro_bias(2, 0) * _tmp52 - _tmp96; - _new_DR_D_gyro_bias(1, 0) = DR_D_gyro_bias(0, 0) * _tmp77 + DR_D_gyro_bias(1, 0) * _tmp83 + - DR_D_gyro_bias(2, 0) * _tmp81 - _tmp97 * dt; - _new_DR_D_gyro_bias(2, 0) = DR_D_gyro_bias(0, 0) * _tmp101 + DR_D_gyro_bias(1, 0) * _tmp100 + - DR_D_gyro_bias(2, 0) * _tmp102 - _tmp188; - _new_DR_D_gyro_bias(0, 1) = DR_D_gyro_bias(0, 1) * _tmp58 + DR_D_gyro_bias(1, 1) * _tmp55 + - DR_D_gyro_bias(2, 1) * _tmp52 - _tmp66 * dt; - _new_DR_D_gyro_bias(1, 1) = DR_D_gyro_bias(0, 1) * _tmp77 + DR_D_gyro_bias(1, 1) * _tmp83 + - DR_D_gyro_bias(2, 1) * _tmp81 - _tmp87; - _new_DR_D_gyro_bias(2, 1) = DR_D_gyro_bias(0, 1) * _tmp101 + DR_D_gyro_bias(1, 1) * _tmp100 + - DR_D_gyro_bias(2, 1) * _tmp102 - _tmp105; - _new_DR_D_gyro_bias(0, 2) = DR_D_gyro_bias(0, 2) * _tmp58 + DR_D_gyro_bias(1, 2) * _tmp55 + - DR_D_gyro_bias(2, 2) * _tmp52 - _tmp71 * dt; - _new_DR_D_gyro_bias(1, 2) = DR_D_gyro_bias(0, 2) * _tmp77 + DR_D_gyro_bias(1, 2) * _tmp83 + - DR_D_gyro_bias(2, 2) * _tmp81 - _tmp94; - _new_DR_D_gyro_bias(2, 2) = DR_D_gyro_bias(0, 2) * _tmp101 + DR_D_gyro_bias(1, 2) * _tmp100 + - DR_D_gyro_bias(2, 2) * _tmp102 - _tmp110; + _new_DR_D_gyro_bias(0, 0) = DR_D_gyro_bias(0, 0) * _tmp64 + DR_D_gyro_bias(1, 0) * _tmp61 + + DR_D_gyro_bias(2, 0) * _tmp56 - + dt * (_tmp294 * (_tmp290 + _tmp291) + 1); + _new_DR_D_gyro_bias(1, 0) = DR_D_gyro_bias(0, 0) * _tmp65 + DR_D_gyro_bias(1, 0) * _tmp71 + + DR_D_gyro_bias(2, 0) * _tmp69 - dt * (-_tmp297 + _tmp299); + _new_DR_D_gyro_bias(2, 0) = DR_D_gyro_bias(0, 0) * _tmp77 + DR_D_gyro_bias(1, 0) * _tmp76 + + DR_D_gyro_bias(2, 0) * _tmp78 - dt * (_tmp300 + _tmp301); + _new_DR_D_gyro_bias(0, 1) = DR_D_gyro_bias(0, 1) * _tmp64 + DR_D_gyro_bias(1, 1) * _tmp61 + + DR_D_gyro_bias(2, 1) * _tmp56 - dt * (_tmp297 + _tmp299); + _new_DR_D_gyro_bias(1, 1) = DR_D_gyro_bias(0, 1) * _tmp65 + DR_D_gyro_bias(1, 1) * _tmp71 + + DR_D_gyro_bias(2, 1) * _tmp69 - + dt * (_tmp294 * (_tmp290 + _tmp302) + 1); + _new_DR_D_gyro_bias(2, 1) = DR_D_gyro_bias(0, 1) * _tmp77 + DR_D_gyro_bias(1, 1) * _tmp76 + + DR_D_gyro_bias(2, 1) * _tmp78 - dt * (-_tmp303 + _tmp304); + _new_DR_D_gyro_bias(0, 2) = DR_D_gyro_bias(0, 2) * _tmp64 + DR_D_gyro_bias(1, 2) * _tmp61 + + DR_D_gyro_bias(2, 2) * _tmp56 - dt * (-_tmp300 + _tmp301); + _new_DR_D_gyro_bias(1, 2) = DR_D_gyro_bias(0, 2) * _tmp65 + DR_D_gyro_bias(1, 2) * _tmp71 + + DR_D_gyro_bias(2, 2) * _tmp69 - dt * (_tmp303 + _tmp304); + _new_DR_D_gyro_bias(2, 2) = DR_D_gyro_bias(0, 2) * _tmp77 + DR_D_gyro_bias(1, 2) * _tmp76 + + DR_D_gyro_bias(2, 2) * _tmp78 - + dt * (_tmp294 * (_tmp291 + _tmp302) + 1); } if (new_Dv_D_accel_bias != nullptr) { Eigen::Matrix& _new_Dv_D_accel_bias = (*new_Dv_D_accel_bias); - _new_Dv_D_accel_bias(0, 0) = Dv_D_accel_bias(0, 0) - _tmp113; - _new_Dv_D_accel_bias(1, 0) = Dv_D_accel_bias(1, 0) - _tmp131; - _new_Dv_D_accel_bias(2, 0) = Dv_D_accel_bias(2, 0) - _tmp150; - _new_Dv_D_accel_bias(0, 1) = Dv_D_accel_bias(0, 1) - _tmp116; - _new_Dv_D_accel_bias(1, 1) = Dv_D_accel_bias(1, 1) - _tmp132; - _new_Dv_D_accel_bias(2, 1) = Dv_D_accel_bias(2, 1) - _tmp154; - _new_Dv_D_accel_bias(0, 2) = Dv_D_accel_bias(0, 2) - _tmp112; - _new_Dv_D_accel_bias(1, 2) = Dv_D_accel_bias(1, 2) - _tmp135; - _new_Dv_D_accel_bias(2, 2) = Dv_D_accel_bias(2, 2) - _tmp151; + _new_Dv_D_accel_bias(0, 0) = Dv_D_accel_bias(0, 0) - _tmp25 * dt; + _new_Dv_D_accel_bias(1, 0) = Dv_D_accel_bias(1, 0) - _tmp40 * dt; + _new_Dv_D_accel_bias(2, 0) = Dv_D_accel_bias(2, 0) - _tmp46 * dt; + _new_Dv_D_accel_bias(0, 1) = Dv_D_accel_bias(0, 1) - _tmp35 * dt; + _new_Dv_D_accel_bias(1, 1) = Dv_D_accel_bias(1, 1) - _tmp39 * dt; + _new_Dv_D_accel_bias(2, 1) = Dv_D_accel_bias(2, 1) - _tmp47 * dt; + _new_Dv_D_accel_bias(0, 2) = Dv_D_accel_bias(0, 2) - _tmp31 * dt; + _new_Dv_D_accel_bias(1, 2) = Dv_D_accel_bias(1, 2) - _tmp43 * dt; + _new_Dv_D_accel_bias(2, 2) = Dv_D_accel_bias(2, 2) - _tmp132; } if (new_Dv_D_gyro_bias != nullptr) { Eigen::Matrix& _new_Dv_D_gyro_bias = (*new_Dv_D_gyro_bias); - _new_Dv_D_gyro_bias(0, 0) = Dv_D_gyro_bias(0, 0) + _tmp313 + _tmp314 + _tmp315; - _new_Dv_D_gyro_bias(1, 0) = Dv_D_gyro_bias(1, 0) + _tmp316 + _tmp317 + _tmp318; - _new_Dv_D_gyro_bias(2, 0) = Dv_D_gyro_bias(2, 0) + _tmp319 + _tmp320 + _tmp321; - _new_Dv_D_gyro_bias(0, 1) = Dv_D_gyro_bias(0, 1) + _tmp322 + _tmp323 + _tmp324; - _new_Dv_D_gyro_bias(1, 1) = Dv_D_gyro_bias(1, 1) + _tmp325 + _tmp326 + _tmp327; - _new_Dv_D_gyro_bias(2, 1) = Dv_D_gyro_bias(2, 1) + _tmp328 + _tmp329 + _tmp330; - _new_Dv_D_gyro_bias(0, 2) = Dv_D_gyro_bias(0, 2) + _tmp331 + _tmp332 + _tmp333; - _new_Dv_D_gyro_bias(1, 2) = Dv_D_gyro_bias(1, 2) + _tmp334 + _tmp335 + _tmp336; - _new_Dv_D_gyro_bias(2, 2) = Dv_D_gyro_bias(2, 2) + _tmp337 + _tmp338 + _tmp339; + _new_Dv_D_gyro_bias(0, 0) = Dv_D_gyro_bias(0, 0) + _tmp305 + _tmp306 + _tmp307; + _new_Dv_D_gyro_bias(1, 0) = Dv_D_gyro_bias(1, 0) + _tmp308 + _tmp309 + _tmp310; + _new_Dv_D_gyro_bias(2, 0) = Dv_D_gyro_bias(2, 0) + _tmp311 + _tmp312 + _tmp313; + _new_Dv_D_gyro_bias(0, 1) = Dv_D_gyro_bias(0, 1) + _tmp314 + _tmp315 + _tmp316; + _new_Dv_D_gyro_bias(1, 1) = Dv_D_gyro_bias(1, 1) + _tmp317 + _tmp318 + _tmp319; + _new_Dv_D_gyro_bias(2, 1) = Dv_D_gyro_bias(2, 1) + _tmp320 + _tmp321 + _tmp322; + _new_Dv_D_gyro_bias(0, 2) = Dv_D_gyro_bias(0, 2) + _tmp323 + _tmp324 + _tmp325; + _new_Dv_D_gyro_bias(1, 2) = Dv_D_gyro_bias(1, 2) + _tmp326 + _tmp327 + _tmp328; + _new_Dv_D_gyro_bias(2, 2) = Dv_D_gyro_bias(2, 2) + _tmp329 + _tmp330 + _tmp331; } if (new_Dp_D_accel_bias != nullptr) { Eigen::Matrix& _new_Dp_D_accel_bias = (*new_Dp_D_accel_bias); - _new_Dp_D_accel_bias(0, 0) = Dp_D_accel_bias(0, 0) + Dv_D_accel_bias(0, 0) * dt - _tmp240; + _new_Dp_D_accel_bias(0, 0) = + Dp_D_accel_bias(0, 0) + Dv_D_accel_bias(0, 0) * dt - _tmp25 * _tmp49; _new_Dp_D_accel_bias(1, 0) = - Dp_D_accel_bias(1, 0) + Dv_D_accel_bias(1, 0) * dt - _tmp36 * _tmp45; - _new_Dp_D_accel_bias(2, 0) = Dp_D_accel_bias(2, 0) + Dv_D_accel_bias(2, 0) * dt - _tmp249; - _new_Dp_D_accel_bias(0, 1) = Dp_D_accel_bias(0, 1) + Dv_D_accel_bias(0, 1) * dt - _tmp239; + Dp_D_accel_bias(1, 0) + Dv_D_accel_bias(1, 0) * dt - _tmp40 * _tmp49; + _new_Dp_D_accel_bias(2, 0) = + Dp_D_accel_bias(2, 0) + Dv_D_accel_bias(2, 0) * dt - _tmp46 * _tmp49; + _new_Dp_D_accel_bias(0, 1) = + Dp_D_accel_bias(0, 1) + Dv_D_accel_bias(0, 1) * dt - _tmp35 * _tmp49; _new_Dp_D_accel_bias(1, 1) = - Dp_D_accel_bias(1, 1) + Dv_D_accel_bias(1, 1) * dt - _tmp35 * _tmp45; - _new_Dp_D_accel_bias(2, 1) = Dp_D_accel_bias(2, 1) + Dv_D_accel_bias(2, 1) * dt - _tmp252; - _new_Dp_D_accel_bias(0, 2) = Dp_D_accel_bias(0, 2) + Dv_D_accel_bias(0, 2) * dt - _tmp250; - _new_Dp_D_accel_bias(1, 2) = Dp_D_accel_bias(1, 2) + Dv_D_accel_bias(1, 2) * dt - _tmp238; + Dp_D_accel_bias(1, 1) + Dv_D_accel_bias(1, 1) * dt - _tmp39 * _tmp49; + _new_Dp_D_accel_bias(2, 1) = + Dp_D_accel_bias(2, 1) + Dv_D_accel_bias(2, 1) * dt - _tmp47 * _tmp49; + _new_Dp_D_accel_bias(0, 2) = + Dp_D_accel_bias(0, 2) + Dv_D_accel_bias(0, 2) * dt - _tmp31 * _tmp49; + _new_Dp_D_accel_bias(1, 2) = + Dp_D_accel_bias(1, 2) + Dv_D_accel_bias(1, 2) * dt - _tmp43 * _tmp49; _new_Dp_D_accel_bias(2, 2) = - Dp_D_accel_bias(2, 2) + Dv_D_accel_bias(2, 2) * dt - _tmp41 * _tmp45; + Dp_D_accel_bias(2, 2) + Dv_D_accel_bias(2, 2) * dt - _tmp45 * _tmp49; } if (new_Dp_D_gyro_bias != nullptr) { Eigen::Matrix& _new_Dp_D_gyro_bias = (*new_Dp_D_gyro_bias); _new_Dp_D_gyro_bias(0, 0) = Dp_D_gyro_bias(0, 0) + Dv_D_gyro_bias(0, 0) * dt + - _tmp169 * _tmp313 + _tmp169 * _tmp314 + _tmp169 * _tmp315; + _tmp156 * _tmp305 + _tmp156 * _tmp306 + _tmp156 * _tmp307; _new_Dp_D_gyro_bias(1, 0) = Dp_D_gyro_bias(1, 0) + Dv_D_gyro_bias(1, 0) * dt + - _tmp169 * _tmp316 + _tmp169 * _tmp317 + _tmp169 * _tmp318; + _tmp156 * _tmp308 + _tmp156 * _tmp309 + _tmp156 * _tmp310; _new_Dp_D_gyro_bias(2, 0) = Dp_D_gyro_bias(2, 0) + Dv_D_gyro_bias(2, 0) * dt + - _tmp169 * _tmp319 + _tmp169 * _tmp320 + _tmp169 * _tmp321; + _tmp156 * _tmp311 + _tmp156 * _tmp312 + _tmp156 * _tmp313; _new_Dp_D_gyro_bias(0, 1) = Dp_D_gyro_bias(0, 1) + Dv_D_gyro_bias(0, 1) * dt + - _tmp169 * _tmp322 + _tmp169 * _tmp323 + _tmp169 * _tmp324; + _tmp156 * _tmp314 + _tmp156 * _tmp315 + _tmp156 * _tmp316; _new_Dp_D_gyro_bias(1, 1) = Dp_D_gyro_bias(1, 1) + Dv_D_gyro_bias(1, 1) * dt + - _tmp169 * _tmp325 + _tmp169 * _tmp326 + _tmp169 * _tmp327; + _tmp156 * _tmp317 + _tmp156 * _tmp318 + _tmp156 * _tmp319; _new_Dp_D_gyro_bias(2, 1) = Dp_D_gyro_bias(2, 1) + Dv_D_gyro_bias(2, 1) * dt + - _tmp169 * _tmp328 + _tmp169 * _tmp329 + _tmp169 * _tmp330; + _tmp156 * _tmp320 + _tmp156 * _tmp321 + _tmp156 * _tmp322; _new_Dp_D_gyro_bias(0, 2) = Dp_D_gyro_bias(0, 2) + Dv_D_gyro_bias(0, 2) * dt + - _tmp169 * _tmp331 + _tmp169 * _tmp332 + _tmp169 * _tmp333; + _tmp156 * _tmp323 + _tmp156 * _tmp324 + _tmp156 * _tmp325; _new_Dp_D_gyro_bias(1, 2) = Dp_D_gyro_bias(1, 2) + Dv_D_gyro_bias(1, 2) * dt + - _tmp169 * _tmp334 + _tmp169 * _tmp335 + _tmp169 * _tmp336; + _tmp156 * _tmp326 + _tmp156 * _tmp327 + _tmp156 * _tmp328; _new_Dp_D_gyro_bias(2, 2) = Dp_D_gyro_bias(2, 2) + Dv_D_gyro_bias(2, 2) * dt + - _tmp169 * _tmp337 + _tmp169 * _tmp338 + _tmp169 * _tmp339; + _tmp156 * _tmp329 + _tmp156 * _tmp330 + _tmp156 * _tmp331; } } // NOLINT(readability/fn_size) diff --git a/gen/cpp/sym/factors/internal/imu_manifold_preintegration_update_auto_derivative.h b/gen/cpp/sym/factors/internal/imu_manifold_preintegration_update_auto_derivative.h index 429be20b..c63e203b 100644 --- a/gen/cpp/sym/factors/internal/imu_manifold_preintegration_update_auto_derivative.h +++ b/gen/cpp/sym/factors/internal/imu_manifold_preintegration_update_auto_derivative.h @@ -27,6 +27,13 @@ namespace sym { * When integrating the first measurement, DR should be the identity, Dv, Dp, covariance, and the * derivatives w.r.t. to bias should all be 0. * + * The measurement noise is modeled as continuous-time white noise acting over the whole step, + * and its contribution to the covariance is integrated in closed form over the step, holding + * the step's starting rotation fixed (see :func:`step_noise_covariance`). The covariance of a + * window of measurements is therefore full rank even when the window consists of a single step. + * It is exact, and does not depend on how the window is divided into steps, for a non-rotating + * body; with an angular rate it is accurate to first order in the rotation per step. + * * Args: * DR: Preintegrated change in orientation * Dv: Preintegrated change in velocity @@ -39,8 +46,10 @@ namespace sym { * Dp_D_gyro_bias: Derivative of Dp w.r.t. gyro_bias * accel_bias: Initial guess for the accelerometer measurement bias * gyro_bias: Initial guess for the gyroscope measurement bias - * accel_cov_diagonal: The diagonal of the covariance of the accelerometer measurement - * gyro_cov_diagonal: The diagonal of the covariance of the gyroscope measurement + * accel_cov_diagonal: The diagonal of the noise spectral density of the accelerometer + * measurement, i.e. the covariance of a measurement times the time it covers + * gyro_cov_diagonal: The diagonal of the noise spectral density of the gyroscope + * measurement, i.e. the covariance of a measurement times the time it covers * accel_measurement: The accelerometer measurement * gyro_measurement: The gyroscope measurement * dt: The time between the new measurements and the last @@ -80,12 +89,12 @@ void ImuManifoldPreintegrationUpdateAutoDerivative( Eigen::Matrix* const new_Dv_D_gyro_bias = nullptr, Eigen::Matrix* const new_Dp_D_accel_bias = nullptr, Eigen::Matrix* const new_Dp_D_gyro_bias = nullptr) { - // Total ops: 1701 + // Total ops: 1607 // Input arrays const Eigen::Matrix& _DR = DR.Data(); - // Intermediate terms (446) + // Intermediate terms (350) const Scalar _tmp0 = std::pow(dt, Scalar(2)); const Scalar _tmp1 = -gyro_bias(2, 0) + gyro_measurement(2, 0); const Scalar _tmp2 = std::pow(_tmp1, Scalar(2)); @@ -126,9 +135,9 @@ void ImuManifoldPreintegrationUpdateAutoDerivative( const Scalar _tmp37 = _tmp21 * _tmp3; const Scalar _tmp38 = _DR[3] * _tmp10; const Scalar _tmp39 = -_tmp35 - _tmp36 - _tmp37 + _tmp38; - const Scalar _tmp40 = std::pow(_DR[1], Scalar(2)); + const Scalar _tmp40 = std::pow(_DR[2], Scalar(2)); const Scalar _tmp41 = -2 * _tmp40; - const Scalar _tmp42 = std::pow(_DR[2], Scalar(2)); + const Scalar _tmp42 = std::pow(_DR[1], Scalar(2)); const Scalar _tmp43 = 1 - 2 * _tmp42; const Scalar _tmp44 = _tmp41 + _tmp43; const Scalar _tmp45 = -accel_bias(0, 0) + accel_measurement(0, 0); @@ -146,479 +155,405 @@ void ImuManifoldPreintegrationUpdateAutoDerivative( const Scalar _tmp57 = _tmp44 * _tmp45 + _tmp50 * _tmp51 + _tmp55 * _tmp56; const Scalar _tmp58 = std::pow(_DR[0], Scalar(2)); const Scalar _tmp59 = -2 * _tmp58; - const Scalar _tmp60 = _tmp43 + _tmp59; + const Scalar _tmp60 = _tmp41 + _tmp59 + 1; const Scalar _tmp61 = _tmp52 + _tmp53; const Scalar _tmp62 = _DR[3] * _tmp48; const Scalar _tmp63 = -_tmp62; const Scalar _tmp64 = _DR[2] * _tmp46; const Scalar _tmp65 = _tmp63 + _tmp64; const Scalar _tmp66 = _tmp45 * _tmp61 + _tmp51 * _tmp65 + _tmp56 * _tmp60; - const Scalar _tmp67 = _tmp41 + _tmp59 + 1; + const Scalar _tmp67 = _tmp43 + _tmp59; const Scalar _tmp68 = -_tmp47; const Scalar _tmp69 = _tmp49 + _tmp68; const Scalar _tmp70 = _tmp62 + _tmp64; const Scalar _tmp71 = _tmp45 * _tmp69 + _tmp51 * _tmp67 + _tmp56 * _tmp70; const Scalar _tmp72 = (Scalar(1) / Scalar(2)) * _tmp0; - const Scalar _tmp73 = -_tmp25; - const Scalar _tmp74 = (Scalar(1) / Scalar(2)) * _tmp11; - const Scalar _tmp75 = [&]() { + const Scalar _tmp73 = (Scalar(1) / Scalar(2)) * _tmp24; + const Scalar _tmp74 = -_tmp73; + const Scalar _tmp75 = (Scalar(1) / Scalar(2)) * _tmp27; + const Scalar _tmp76 = -Scalar(1) / Scalar(2) * _tmp26; + const Scalar _tmp77 = (Scalar(1) / Scalar(2)) * _tmp28; + const Scalar _tmp78 = _tmp76 - _tmp77; + const Scalar _tmp79 = _tmp74 + _tmp75 + _tmp78; + const Scalar _tmp80 = 2 * _tmp29; + const Scalar _tmp81 = (Scalar(1) / Scalar(2)) * _tmp30; + const Scalar _tmp82 = (Scalar(1) / Scalar(2)) * _tmp31; + const Scalar _tmp83 = -_tmp82; + const Scalar _tmp84 = (Scalar(1) / Scalar(2)) * _tmp32; + const Scalar _tmp85 = -_tmp84; + const Scalar _tmp86 = -Scalar(1) / Scalar(2) * _tmp33; + const Scalar _tmp87 = _tmp81 + _tmp83 + _tmp85 + _tmp86; + const Scalar _tmp88 = 2 * _tmp34; + const Scalar _tmp89 = (Scalar(1) / Scalar(2)) * _tmp38; + const Scalar _tmp90 = (Scalar(1) / Scalar(2)) * _tmp35; + const Scalar _tmp91 = (Scalar(1) / Scalar(2)) * _tmp36; + const Scalar _tmp92 = (Scalar(1) / Scalar(2)) * _tmp37; + const Scalar _tmp93 = _tmp89 - _tmp90 + _tmp91 + _tmp92; + const Scalar _tmp94 = 2 * _tmp39; + const Scalar _tmp95 = (Scalar(1) / Scalar(2)) * _tmp11; + const Scalar _tmp96 = -_tmp95; + const Scalar _tmp97 = (Scalar(1) / Scalar(2)) * _tmp17; + const Scalar _tmp98 = -_tmp97; + const Scalar _tmp99 = -Scalar(1) / Scalar(2) * _tmp20; + const Scalar _tmp100 = (Scalar(1) / Scalar(2)) * _tmp22; + const Scalar _tmp101 = _tmp100 + _tmp96 + _tmp98 + _tmp99; + const Scalar _tmp102 = 2 * _tmp23; + const Scalar _tmp103 = -_tmp101 * _tmp102 - _tmp79 * _tmp80 + _tmp87 * _tmp88 + _tmp93 * _tmp94; + const Scalar _tmp104 = -_tmp81 + _tmp86; + const Scalar _tmp105 = _tmp104 + _tmp82 + _tmp85; + const Scalar _tmp106 = -_tmp100 + _tmp99; + const Scalar _tmp107 = _tmp106 + _tmp96 + _tmp97; + const Scalar _tmp108 = _tmp89 + _tmp90; + const Scalar _tmp109 = _tmp108 - _tmp91 + _tmp92; + const Scalar _tmp110 = -_tmp75; + const Scalar _tmp111 = _tmp110 + _tmp73 + _tmp78; + const Scalar _tmp112 = + -_tmp102 * _tmp105 + _tmp107 * _tmp88 - _tmp109 * _tmp80 + _tmp111 * _tmp94; + const Scalar _tmp113 = _tmp108 + _tmp91 - _tmp92; + const Scalar _tmp114 = _tmp104 + _tmp83 + _tmp84; + const Scalar _tmp115 = _tmp110 + _tmp74 + _tmp76 + _tmp77; + const Scalar _tmp116 = _tmp106 + _tmp95 + _tmp98; + const Scalar _tmp117 = + -_tmp102 * _tmp115 + _tmp113 * _tmp88 + _tmp114 * _tmp94 - _tmp116 * _tmp80; + const Scalar _tmp118 = _tmp102 * _tmp116 + _tmp113 * _tmp94 - _tmp114 * _tmp88 - _tmp115 * _tmp80; + const Scalar _tmp119 = -_tmp101 * _tmp80 + _tmp102 * _tmp79 + _tmp87 * _tmp94 - _tmp88 * _tmp93; + const Scalar _tmp120 = _tmp102 * _tmp109 - _tmp105 * _tmp80 + _tmp107 * _tmp94 - _tmp111 * _tmp88; + const Scalar _tmp121 = + _tmp118 * covariance(1, 0) + _tmp119 * covariance(0, 0) + _tmp120 * covariance(2, 0); + const Scalar _tmp122 = + _tmp118 * covariance(2, 1) + _tmp119 * covariance(2, 0) + _tmp120 * covariance(2, 2); + const Scalar _tmp123 = + _tmp118 * covariance(1, 1) + _tmp119 * covariance(1, 0) + _tmp120 * covariance(2, 1); + const Scalar _tmp124 = _tmp103 * _tmp121 + _tmp112 * _tmp122 + _tmp117 * _tmp123; + const Scalar _tmp125 = + -_tmp102 * _tmp107 - _tmp105 * _tmp88 + _tmp109 * _tmp94 + _tmp111 * _tmp80; + const Scalar _tmp126 = -_tmp101 * _tmp88 - _tmp102 * _tmp87 + _tmp79 * _tmp94 + _tmp80 * _tmp93; + const Scalar _tmp127 = + -_tmp102 * _tmp113 + _tmp114 * _tmp80 - _tmp115 * _tmp88 + _tmp116 * _tmp94; + const Scalar _tmp128 = + _tmp125 * covariance(2, 0) + _tmp126 * covariance(0, 0) + _tmp127 * covariance(1, 0); + const Scalar _tmp129 = + _tmp125 * covariance(2, 2) + _tmp126 * covariance(2, 0) + _tmp127 * covariance(2, 1); + const Scalar _tmp130 = + _tmp125 * covariance(2, 1) + _tmp126 * covariance(1, 0) + _tmp127 * covariance(1, 1); + const Scalar _tmp131 = _tmp103 * _tmp128 + _tmp112 * _tmp129 + _tmp117 * _tmp130; + const Scalar _tmp132 = _tmp50 * _tmp56; + const Scalar _tmp133 = _tmp132 - _tmp51 * _tmp55; + const Scalar _tmp134 = _tmp133 * gyro_cov_diagonal(0, 0); + const Scalar _tmp135 = -_tmp42; + const Scalar _tmp136 = _tmp135 + _tmp58; + const Scalar _tmp137 = -_tmp40; + const Scalar _tmp138 = std::pow(_DR[3], Scalar(2)); + const Scalar _tmp139 = _tmp137 + _tmp138; + const Scalar _tmp140 = -_tmp49; + const Scalar _tmp141 = _tmp45 * (_tmp140 + _tmp68) + _tmp51 * (_tmp136 + _tmp139); + const Scalar _tmp142 = _tmp141 * dt; + const Scalar _tmp143 = -_tmp138; + const Scalar _tmp144 = _tmp143 + _tmp40; + const Scalar _tmp145 = -_tmp58; + const Scalar _tmp146 = _tmp145 + _tmp42; + const Scalar _tmp147 = _tmp45 * _tmp55; + const Scalar _tmp148 = _tmp147 + _tmp56 * (_tmp144 + _tmp146); + const Scalar _tmp149 = _tmp148 * dt; + const Scalar _tmp150 = -_tmp52; + const Scalar _tmp151 = _tmp132 + _tmp51 * (_tmp150 + _tmp53); + const Scalar _tmp152 = _tmp151 * dt; + const Scalar _tmp153 = _tmp142 * covariance(2, 1) + _tmp149 * covariance(2, 2) + + _tmp152 * covariance(2, 0) + covariance(3, 2); + const Scalar _tmp154 = _tmp142 * covariance(1, 0) + _tmp149 * covariance(2, 0) + + _tmp152 * covariance(0, 0) + covariance(3, 0); + const Scalar _tmp155 = _tmp142 * covariance(1, 1) + _tmp149 * covariance(2, 1) + + _tmp152 * covariance(1, 0) + covariance(3, 1); + const Scalar _tmp156 = + _tmp103 * _tmp154 + _tmp112 * _tmp153 + _tmp117 * _tmp155 + _tmp134 * _tmp72; + const Scalar _tmp157 = _tmp56 * _tmp65; + const Scalar _tmp158 = _tmp157 - _tmp51 * _tmp60; + const Scalar _tmp159 = _tmp158 * gyro_cov_diagonal(0, 0); + const Scalar _tmp160 = _tmp51 * _tmp61; + const Scalar _tmp161 = -_tmp64; + const Scalar _tmp162 = _tmp160 + _tmp45 * (_tmp161 + _tmp62); + const Scalar _tmp163 = _tmp162 * dt; + const Scalar _tmp164 = _tmp45 * (_tmp139 + _tmp146) + _tmp56 * (_tmp150 + _tmp54); + const Scalar _tmp165 = _tmp164 * dt; + const Scalar _tmp166 = _tmp157 + _tmp51 * (_tmp136 + _tmp144); + const Scalar _tmp167 = _tmp166 * dt; + const Scalar _tmp168 = _tmp163 * covariance(1, 1) + _tmp165 * covariance(2, 1) + + _tmp167 * covariance(1, 0) + covariance(4, 1); + const Scalar _tmp169 = _tmp163 * covariance(2, 1) + _tmp165 * covariance(2, 2) + + _tmp167 * covariance(2, 0) + covariance(4, 2); + const Scalar _tmp170 = _tmp163 * covariance(1, 0) + _tmp165 * covariance(2, 0) + + _tmp167 * covariance(0, 0) + covariance(4, 0); + const Scalar _tmp171 = + _tmp103 * _tmp170 + _tmp112 * _tmp169 + _tmp117 * _tmp168 + _tmp159 * _tmp72; + const Scalar _tmp172 = -_tmp51 * _tmp70 + _tmp56 * _tmp67; + const Scalar _tmp173 = _tmp172 * gyro_cov_diagonal(0, 0); + const Scalar _tmp174 = _tmp45 * _tmp70; + const Scalar _tmp175 = _tmp174 + _tmp56 * (_tmp140 + _tmp47); + const Scalar _tmp176 = _tmp175 * dt; + const Scalar _tmp177 = _tmp51 * _tmp69; + const Scalar _tmp178 = _tmp177 + _tmp45 * (_tmp137 + _tmp143 + _tmp42 + _tmp58); + const Scalar _tmp179 = _tmp178 * dt; + const Scalar _tmp180 = + _tmp51 * (_tmp161 + _tmp63) + _tmp56 * (_tmp135 + _tmp138 + _tmp145 + _tmp40); + const Scalar _tmp181 = _tmp180 * dt; + const Scalar _tmp182 = _tmp176 * covariance(2, 2) + _tmp179 * covariance(2, 1) + + _tmp181 * covariance(2, 0) + covariance(5, 2); + const Scalar _tmp183 = _tmp176 * covariance(2, 0) + _tmp179 * covariance(1, 0) + + _tmp181 * covariance(0, 0) + covariance(5, 0); + const Scalar _tmp184 = _tmp176 * covariance(2, 1) + _tmp179 * covariance(1, 1) + + _tmp181 * covariance(1, 0) + covariance(5, 1); + const Scalar _tmp185 = + _tmp103 * _tmp183 + _tmp112 * _tmp182 + _tmp117 * _tmp184 + _tmp173 * _tmp72; + const Scalar _tmp186 = [&]() { const Scalar base = dt; return base * base * base; }(); - const Scalar _tmp76 = _tmp75 / _tmp7; - const Scalar _tmp77 = _tmp6 * _tmp76; - const Scalar _tmp78 = _tmp74 * _tmp77; - const Scalar _tmp79 = _DR[0] * _tmp12; - const Scalar _tmp80 = _tmp75 / (_tmp7 * std::sqrt(_tmp7)); - const Scalar _tmp81 = _tmp6 * _tmp80; - const Scalar _tmp82 = _tmp79 * _tmp81; - const Scalar _tmp83 = _tmp14 * _tmp72; - const Scalar _tmp84 = _tmp13 * _tmp83; - const Scalar _tmp85 = _tmp5 * _tmp84; - const Scalar _tmp86 = _tmp3 * _tmp5; - const Scalar _tmp87 = _DR[1] * _tmp12; - const Scalar _tmp88 = _tmp80 * _tmp87; - const Scalar _tmp89 = _tmp86 * _tmp88; - const Scalar _tmp90 = (Scalar(1) / Scalar(2)) * _tmp24; - const Scalar _tmp91 = _tmp76 * _tmp90; - const Scalar _tmp92 = _tmp86 * _tmp91; - const Scalar _tmp93 = _tmp89 - _tmp92; - const Scalar _tmp94 = _DR[2] * _tmp12; - const Scalar _tmp95 = _tmp80 * _tmp94; - const Scalar _tmp96 = _tmp1 * _tmp5; - const Scalar _tmp97 = _tmp95 * _tmp96; - const Scalar _tmp98 = (Scalar(1) / Scalar(2)) * _tmp30; - const Scalar _tmp99 = _tmp76 * _tmp98; - const Scalar _tmp100 = _tmp96 * _tmp99; - const Scalar _tmp101 = -_tmp100 + _tmp97; - const Scalar _tmp102 = _tmp101 + _tmp73 - _tmp78 + _tmp82 - _tmp85 + _tmp93; - const Scalar _tmp103 = 2 * _tmp23; - const Scalar _tmp104 = _tmp13 * _tmp81; - const Scalar _tmp105 = (Scalar(1) / Scalar(2)) * _tmp38; - const Scalar _tmp106 = _tmp105 * _tmp77; - const Scalar _tmp107 = _tmp79 * _tmp83; - const Scalar _tmp108 = _tmp107 * _tmp5; - const Scalar _tmp109 = _tmp86 * _tmp95; - const Scalar _tmp110 = _tmp86 * _tmp99; - const Scalar _tmp111 = _tmp109 - _tmp110; - const Scalar _tmp112 = _tmp91 * _tmp96; - const Scalar _tmp113 = _tmp88 * _tmp96; - const Scalar _tmp114 = _tmp112 - _tmp113; - const Scalar _tmp115 = -_tmp104 + _tmp106 - _tmp108 + _tmp111 + _tmp114 + _tmp16; - const Scalar _tmp116 = 2 * _tmp39; - const Scalar _tmp117 = _tmp6 * _tmp95; - const Scalar _tmp118 = _tmp77 * _tmp98; - const Scalar _tmp119 = _tmp83 * _tmp87; - const Scalar _tmp120 = _tmp119 * _tmp5; - const Scalar _tmp121 = _tmp13 * _tmp3; - const Scalar _tmp122 = _tmp121 * _tmp80; - const Scalar _tmp123 = _tmp122 * _tmp5; - const Scalar _tmp124 = _tmp105 * _tmp76; - const Scalar _tmp125 = _tmp124 * _tmp86; - const Scalar _tmp126 = -_tmp123 + _tmp125; - const Scalar _tmp127 = _tmp80 * _tmp96; - const Scalar _tmp128 = _tmp127 * _tmp79; - const Scalar _tmp129 = _tmp74 * _tmp76; - const Scalar _tmp130 = _tmp129 * _tmp96; - const Scalar _tmp131 = _tmp128 - _tmp130; - const Scalar _tmp132 = -_tmp117 + _tmp118 - _tmp120 + _tmp126 + _tmp131 + _tmp19; - const Scalar _tmp133 = 2 * _tmp34; - const Scalar _tmp134 = -_tmp21; - const Scalar _tmp135 = _tmp77 * _tmp90; - const Scalar _tmp136 = _tmp81 * _tmp87; - const Scalar _tmp137 = _tmp83 * _tmp94; - const Scalar _tmp138 = _tmp137 * _tmp5; - const Scalar _tmp139 = _tmp127 * _tmp13; - const Scalar _tmp140 = _tmp124 * _tmp96; - const Scalar _tmp141 = -_tmp139 + _tmp140; - const Scalar _tmp142 = _tmp79 * _tmp80; - const Scalar _tmp143 = _tmp142 * _tmp86; - const Scalar _tmp144 = _tmp129 * _tmp86; - const Scalar _tmp145 = -_tmp143 + _tmp144; - const Scalar _tmp146 = _tmp134 - _tmp135 + _tmp136 - _tmp138 + _tmp141 + _tmp145; - const Scalar _tmp147 = 2 * _tmp29; - const Scalar _tmp148 = - -_tmp102 * _tmp103 + _tmp115 * _tmp116 + _tmp132 * _tmp133 - _tmp146 * _tmp147; - const Scalar _tmp149 = Scalar(1.0) / (dt); - const Scalar _tmp150 = _tmp149 * gyro_cov_diagonal(0, 0); - const Scalar _tmp151 = -_tmp90; - const Scalar _tmp152 = (Scalar(1) / Scalar(2)) * _tmp27; - const Scalar _tmp153 = -Scalar(1) / Scalar(2) * _tmp26; - const Scalar _tmp154 = (Scalar(1) / Scalar(2)) * _tmp28; - const Scalar _tmp155 = _tmp153 - _tmp154; - const Scalar _tmp156 = _tmp151 + _tmp152 + _tmp155; - const Scalar _tmp157 = (Scalar(1) / Scalar(2)) * _tmp31; - const Scalar _tmp158 = -_tmp157; - const Scalar _tmp159 = (Scalar(1) / Scalar(2)) * _tmp32; - const Scalar _tmp160 = -_tmp159; - const Scalar _tmp161 = -Scalar(1) / Scalar(2) * _tmp33; - const Scalar _tmp162 = _tmp158 + _tmp160 + _tmp161 + _tmp98; - const Scalar _tmp163 = (Scalar(1) / Scalar(2)) * _tmp35; - const Scalar _tmp164 = (Scalar(1) / Scalar(2)) * _tmp36; - const Scalar _tmp165 = (Scalar(1) / Scalar(2)) * _tmp37; - const Scalar _tmp166 = _tmp105 - _tmp163 + _tmp164 + _tmp165; - const Scalar _tmp167 = -_tmp74; - const Scalar _tmp168 = (Scalar(1) / Scalar(2)) * _tmp17; - const Scalar _tmp169 = -_tmp168; - const Scalar _tmp170 = -Scalar(1) / Scalar(2) * _tmp20; - const Scalar _tmp171 = (Scalar(1) / Scalar(2)) * _tmp22; - const Scalar _tmp172 = _tmp167 + _tmp169 + _tmp170 + _tmp171; - const Scalar _tmp173 = - -_tmp103 * _tmp172 + _tmp116 * _tmp166 + _tmp133 * _tmp162 - _tmp147 * _tmp156; - const Scalar _tmp174 = _tmp161 - _tmp98; - const Scalar _tmp175 = _tmp157 + _tmp160 + _tmp174; - const Scalar _tmp176 = _tmp170 - _tmp171; - const Scalar _tmp177 = _tmp167 + _tmp168 + _tmp176; - const Scalar _tmp178 = _tmp105 + _tmp163; - const Scalar _tmp179 = -_tmp164 + _tmp165 + _tmp178; - const Scalar _tmp180 = -_tmp152; - const Scalar _tmp181 = _tmp155 + _tmp180 + _tmp90; - const Scalar _tmp182 = - -_tmp103 * _tmp175 + _tmp116 * _tmp181 + _tmp133 * _tmp177 - _tmp147 * _tmp179; - const Scalar _tmp183 = _tmp164 - _tmp165 + _tmp178; - const Scalar _tmp184 = _tmp158 + _tmp159 + _tmp174; - const Scalar _tmp185 = _tmp151 + _tmp153 + _tmp154 + _tmp180; - const Scalar _tmp186 = _tmp169 + _tmp176 + _tmp74; - const Scalar _tmp187 = - -_tmp103 * _tmp185 + _tmp116 * _tmp184 + _tmp133 * _tmp183 - _tmp147 * _tmp186; - const Scalar _tmp188 = _tmp2 * _tmp80; - const Scalar _tmp189 = _tmp13 * _tmp188; - const Scalar _tmp190 = _tmp124 * _tmp2; - const Scalar _tmp191 = _tmp1 * _tmp137; - const Scalar _tmp192 = _tmp1 * _tmp3; - const Scalar _tmp193 = _tmp142 * _tmp192; - const Scalar _tmp194 = _tmp129 * _tmp192; - const Scalar _tmp195 = -_tmp193 + _tmp194; - const Scalar _tmp196 = -_tmp112 + _tmp113; - const Scalar _tmp197 = _tmp16 - _tmp189 + _tmp190 - _tmp191 + _tmp195 + _tmp196; - const Scalar _tmp198 = -_tmp19; - const Scalar _tmp199 = _tmp2 * _tmp95; - const Scalar _tmp200 = _tmp2 * _tmp99; - const Scalar _tmp201 = _tmp1 * _tmp84; - const Scalar _tmp202 = _tmp192 * _tmp88; - const Scalar _tmp203 = _tmp192 * _tmp91; - const Scalar _tmp204 = _tmp202 - _tmp203; - const Scalar _tmp205 = _tmp131 + _tmp198 + _tmp199 - _tmp200 - _tmp201 + _tmp204; - const Scalar _tmp206 = _tmp129 * _tmp2; - const Scalar _tmp207 = _tmp188 * _tmp79; - const Scalar _tmp208 = _tmp1 * _tmp119; - const Scalar _tmp209 = _tmp1 * _tmp122; - const Scalar _tmp210 = _tmp124 * _tmp192; - const Scalar _tmp211 = -_tmp209 + _tmp210; - const Scalar _tmp212 = _tmp100 - _tmp97; - const Scalar _tmp213 = -_tmp206 + _tmp207 - _tmp208 + _tmp211 + _tmp212 + _tmp73; - const Scalar _tmp214 = _tmp188 * _tmp87; - const Scalar _tmp215 = _tmp2 * _tmp91; - const Scalar _tmp216 = _tmp1 * _tmp107; - const Scalar _tmp217 = _tmp192 * _tmp95; - const Scalar _tmp218 = _tmp192 * _tmp99; - const Scalar _tmp219 = _tmp217 - _tmp218; - const Scalar _tmp220 = _tmp141 + _tmp21 - _tmp214 + _tmp215 - _tmp216 + _tmp219; + const Scalar _tmp187 = (Scalar(1) / Scalar(6)) * _tmp186; + const Scalar _tmp188 = _tmp141 * _tmp72; + const Scalar _tmp189 = _tmp148 * _tmp72; + const Scalar _tmp190 = covariance(3, 2) * dt; + const Scalar _tmp191 = _tmp151 * _tmp72; + const Scalar _tmp192 = _tmp188 * covariance(2, 1) + _tmp189 * covariance(2, 2) + _tmp190 + + _tmp191 * covariance(2, 0) + covariance(6, 2); + const Scalar _tmp193 = covariance(3, 1) * dt; + const Scalar _tmp194 = _tmp188 * covariance(1, 1) + _tmp189 * covariance(2, 1) + + _tmp191 * covariance(1, 0) + _tmp193 + covariance(6, 1); + const Scalar _tmp195 = covariance(3, 0) * dt; + const Scalar _tmp196 = _tmp188 * covariance(1, 0) + _tmp189 * covariance(2, 0) + + _tmp191 * covariance(0, 0) + _tmp195 + covariance(6, 0); + const Scalar _tmp197 = + _tmp103 * _tmp196 + _tmp112 * _tmp192 + _tmp117 * _tmp194 + _tmp134 * _tmp187; + const Scalar _tmp198 = _tmp162 * _tmp72; + const Scalar _tmp199 = covariance(4, 2) * dt; + const Scalar _tmp200 = _tmp164 * _tmp72; + const Scalar _tmp201 = _tmp166 * _tmp72; + const Scalar _tmp202 = _tmp198 * covariance(2, 1) + _tmp199 + _tmp200 * covariance(2, 2) + + _tmp201 * covariance(2, 0) + covariance(7, 2); + const Scalar _tmp203 = covariance(4, 1) * dt; + const Scalar _tmp204 = _tmp198 * covariance(1, 1) + _tmp200 * covariance(2, 1) + + _tmp201 * covariance(1, 0) + _tmp203 + covariance(7, 1); + const Scalar _tmp205 = covariance(4, 0) * dt; + const Scalar _tmp206 = _tmp198 * covariance(1, 0) + _tmp200 * covariance(2, 0) + + _tmp201 * covariance(0, 0) + _tmp205 + covariance(7, 0); + const Scalar _tmp207 = + _tmp103 * _tmp206 + _tmp112 * _tmp202 + _tmp117 * _tmp204 + _tmp159 * _tmp187; + const Scalar _tmp208 = _tmp175 * _tmp72; + const Scalar _tmp209 = _tmp178 * _tmp72; + const Scalar _tmp210 = covariance(5, 0) * dt; + const Scalar _tmp211 = _tmp180 * _tmp72; + const Scalar _tmp212 = _tmp208 * covariance(2, 0) + _tmp209 * covariance(1, 0) + _tmp210 + + _tmp211 * covariance(0, 0) + covariance(8, 0); + const Scalar _tmp213 = covariance(5, 1) * dt; + const Scalar _tmp214 = _tmp208 * covariance(2, 1) + _tmp209 * covariance(1, 1) + + _tmp211 * covariance(1, 0) + _tmp213 + covariance(8, 1); + const Scalar _tmp215 = covariance(5, 2) * dt; + const Scalar _tmp216 = _tmp208 * covariance(2, 2) + _tmp209 * covariance(2, 1) + + _tmp211 * covariance(2, 0) + _tmp215 + covariance(8, 2); + const Scalar _tmp217 = + _tmp103 * _tmp212 + _tmp112 * _tmp216 + _tmp117 * _tmp214 + _tmp173 * _tmp187; + const Scalar _tmp218 = _tmp118 * _tmp130 + _tmp119 * _tmp128 + _tmp120 * _tmp129; + const Scalar _tmp219 = _tmp44 * _tmp51 - _tmp45 * _tmp50; + const Scalar _tmp220 = _tmp219 * gyro_cov_diagonal(1, 0); const Scalar _tmp221 = - -_tmp103 * _tmp205 + _tmp116 * _tmp220 + _tmp133 * _tmp213 - _tmp147 * _tmp197; - const Scalar _tmp222 = _tmp149 * gyro_cov_diagonal(2, 0); - const Scalar _tmp223 = _tmp4 * _tmp80; - const Scalar _tmp224 = _tmp13 * _tmp223; - const Scalar _tmp225 = _tmp124 * _tmp4; - const Scalar _tmp226 = _tmp119 * _tmp3; - const Scalar _tmp227 = -_tmp109 + _tmp110; - const Scalar _tmp228 = _tmp193 - _tmp194; - const Scalar _tmp229 = _tmp16 - _tmp224 + _tmp225 - _tmp226 + _tmp227 + _tmp228; - const Scalar _tmp230 = _tmp223 * _tmp87; - const Scalar _tmp231 = _tmp4 * _tmp91; - const Scalar _tmp232 = _tmp121 * _tmp83; - const Scalar _tmp233 = _tmp143 - _tmp144; - const Scalar _tmp234 = _tmp134 + _tmp219 + _tmp230 - _tmp231 - _tmp232 + _tmp233; - const Scalar _tmp235 = _tmp223 * _tmp94; - const Scalar _tmp236 = _tmp4 * _tmp99; - const Scalar _tmp237 = _tmp107 * _tmp3; - const Scalar _tmp238 = -_tmp202 + _tmp203; - const Scalar _tmp239 = _tmp126 + _tmp198 + _tmp235 - _tmp236 - _tmp237 + _tmp238; - const Scalar _tmp240 = _tmp129 * _tmp4; - const Scalar _tmp241 = _tmp223 * _tmp79; - const Scalar _tmp242 = _tmp137 * _tmp3; - const Scalar _tmp243 = _tmp211 + _tmp240 - _tmp241 - _tmp242 + _tmp25 + _tmp93; - const Scalar _tmp244 = - -_tmp103 * _tmp234 + _tmp116 * _tmp239 + _tmp133 * _tmp229 - _tmp147 * _tmp243; - const Scalar _tmp245 = _tmp149 * gyro_cov_diagonal(1, 0); - const Scalar _tmp246 = - _tmp103 * _tmp197 + _tmp116 * _tmp213 - _tmp133 * _tmp220 - _tmp147 * _tmp205; - const Scalar _tmp247 = _tmp222 * _tmp246; - const Scalar _tmp248 = - -_tmp102 * _tmp147 + _tmp103 * _tmp146 - _tmp115 * _tmp133 + _tmp116 * _tmp132; - const Scalar _tmp249 = - _tmp103 * _tmp186 + _tmp116 * _tmp183 - _tmp133 * _tmp184 - _tmp147 * _tmp185; - const Scalar _tmp250 = - _tmp103 * _tmp156 + _tmp116 * _tmp162 - _tmp133 * _tmp166 - _tmp147 * _tmp172; - const Scalar _tmp251 = - _tmp103 * _tmp179 + _tmp116 * _tmp177 - _tmp133 * _tmp181 - _tmp147 * _tmp175; - const Scalar _tmp252 = - _tmp249 * covariance(1, 0) + _tmp250 * covariance(0, 0) + _tmp251 * covariance(2, 0); - const Scalar _tmp253 = - _tmp249 * covariance(2, 1) + _tmp250 * covariance(2, 0) + _tmp251 * covariance(2, 2); - const Scalar _tmp254 = - _tmp103 * _tmp243 + _tmp116 * _tmp229 - _tmp133 * _tmp239 - _tmp147 * _tmp234; - const Scalar _tmp255 = _tmp244 * _tmp245; - const Scalar _tmp256 = - _tmp249 * covariance(1, 1) + _tmp250 * covariance(1, 0) + _tmp251 * covariance(2, 1); - const Scalar _tmp257 = _tmp148 * _tmp150 * _tmp248 + _tmp173 * _tmp252 + _tmp182 * _tmp253 + - _tmp187 * _tmp256 + _tmp221 * _tmp247 + _tmp254 * _tmp255; - const Scalar _tmp258 = - -_tmp102 * _tmp133 - _tmp103 * _tmp132 + _tmp115 * _tmp147 + _tmp116 * _tmp146; - const Scalar _tmp259 = _tmp150 * _tmp258; - const Scalar _tmp260 = - -_tmp103 * _tmp229 + _tmp116 * _tmp243 - _tmp133 * _tmp234 + _tmp147 * _tmp239; + _tmp118 * _tmp155 + _tmp119 * _tmp154 + _tmp120 * _tmp153 + _tmp220 * _tmp72; + const Scalar _tmp222 = _tmp160 - _tmp45 * _tmp65; + const Scalar _tmp223 = _tmp222 * gyro_cov_diagonal(1, 0); + const Scalar _tmp224 = + _tmp118 * _tmp168 + _tmp119 * _tmp170 + _tmp120 * _tmp169 + _tmp223 * _tmp72; + const Scalar _tmp225 = _tmp177 - _tmp45 * _tmp67; + const Scalar _tmp226 = _tmp225 * gyro_cov_diagonal(1, 0); + const Scalar _tmp227 = + _tmp118 * _tmp184 + _tmp119 * _tmp183 + _tmp120 * _tmp182 + _tmp226 * _tmp72; + const Scalar _tmp228 = + _tmp118 * _tmp194 + _tmp119 * _tmp196 + _tmp120 * _tmp192 + _tmp187 * _tmp220; + const Scalar _tmp229 = + _tmp118 * _tmp204 + _tmp119 * _tmp206 + _tmp120 * _tmp202 + _tmp187 * _tmp223; + const Scalar _tmp230 = + _tmp118 * _tmp214 + _tmp119 * _tmp212 + _tmp120 * _tmp216 + _tmp187 * _tmp226; + const Scalar _tmp231 = _tmp147 - _tmp44 * _tmp56; + const Scalar _tmp232 = _tmp231 * gyro_cov_diagonal(2, 0); + const Scalar _tmp233 = + _tmp125 * _tmp153 + _tmp126 * _tmp154 + _tmp127 * _tmp155 + _tmp232 * _tmp72; + const Scalar _tmp234 = _tmp45 * _tmp60 - _tmp56 * _tmp61; + const Scalar _tmp235 = _tmp234 * gyro_cov_diagonal(2, 0); + const Scalar _tmp236 = + _tmp125 * _tmp169 + _tmp126 * _tmp170 + _tmp127 * _tmp168 + _tmp235 * _tmp72; + const Scalar _tmp237 = _tmp174 - _tmp56 * _tmp69; + const Scalar _tmp238 = _tmp237 * gyro_cov_diagonal(2, 0); + const Scalar _tmp239 = + _tmp125 * _tmp182 + _tmp126 * _tmp183 + _tmp127 * _tmp184 + _tmp238 * _tmp72; + const Scalar _tmp240 = + _tmp125 * _tmp192 + _tmp126 * _tmp196 + _tmp127 * _tmp194 + _tmp187 * _tmp232; + const Scalar _tmp241 = + _tmp125 * _tmp202 + _tmp126 * _tmp206 + _tmp127 * _tmp204 + _tmp187 * _tmp235; + const Scalar _tmp242 = + _tmp125 * _tmp216 + _tmp126 * _tmp212 + _tmp127 * _tmp214 + _tmp187 * _tmp238; + const Scalar _tmp243 = std::pow(_tmp44, Scalar(2)) * accel_cov_diagonal(0, 0) + + std::pow(_tmp50, Scalar(2)) * accel_cov_diagonal(2, 0) + + std::pow(_tmp55, Scalar(2)) * accel_cov_diagonal(1, 0); + const Scalar _tmp244 = std::pow(_tmp133, Scalar(2)) * gyro_cov_diagonal(0, 0) + + std::pow(_tmp219, Scalar(2)) * gyro_cov_diagonal(1, 0) + + std::pow(_tmp231, Scalar(2)) * gyro_cov_diagonal(2, 0); + const Scalar _tmp245 = (Scalar(1) / Scalar(3)) * _tmp186; + const Scalar _tmp246 = _tmp50 * accel_cov_diagonal(2, 0); + const Scalar _tmp247 = _tmp44 * accel_cov_diagonal(0, 0); + const Scalar _tmp248 = _tmp55 * accel_cov_diagonal(1, 0); + const Scalar _tmp249 = _tmp246 * _tmp65 + _tmp247 * _tmp61 + _tmp248 * _tmp60; + const Scalar _tmp250 = _tmp134 * _tmp158 + _tmp220 * _tmp222 + _tmp231 * _tmp235; + const Scalar _tmp251 = _tmp142 * _tmp168 + _tmp149 * _tmp169 + _tmp152 * _tmp170 + + _tmp162 * _tmp193 + _tmp164 * _tmp190 + _tmp166 * _tmp195 + + _tmp245 * _tmp250 + _tmp249 * dt + covariance(4, 3); + const Scalar _tmp252 = _tmp246 * _tmp67 + _tmp247 * _tmp69 + _tmp248 * _tmp70; + const Scalar _tmp253 = _tmp134 * _tmp172 + _tmp220 * _tmp225 + _tmp231 * _tmp238; + const Scalar _tmp254 = _tmp142 * _tmp184 + _tmp149 * _tmp182 + _tmp152 * _tmp183 + + _tmp175 * _tmp190 + _tmp178 * _tmp193 + _tmp180 * _tmp195 + + _tmp245 * _tmp253 + _tmp252 * dt + covariance(5, 3); + const Scalar _tmp255 = (Scalar(1) / Scalar(8)) * std::pow(dt, Scalar(4)); + const Scalar _tmp256 = _tmp188 * covariance(3, 1) + _tmp189 * covariance(3, 2) + + _tmp191 * covariance(3, 0) + covariance(3, 3) * dt + covariance(6, 3); + const Scalar _tmp257 = _tmp142 * _tmp194 + _tmp149 * _tmp192 + _tmp152 * _tmp196 + + _tmp243 * _tmp72 + _tmp244 * _tmp255 + _tmp256; + const Scalar _tmp258 = covariance(4, 3) * dt; + const Scalar _tmp259 = _tmp198 * covariance(3, 1) + _tmp200 * covariance(3, 2) + + _tmp201 * covariance(3, 0) + _tmp258 + covariance(7, 3); + const Scalar _tmp260 = _tmp249 * _tmp72 + _tmp250 * _tmp255; const Scalar _tmp261 = - -_tmp103 * _tmp213 + _tmp116 * _tmp197 - _tmp133 * _tmp205 + _tmp147 * _tmp220; - const Scalar _tmp262 = - -_tmp103 * _tmp177 + _tmp116 * _tmp179 - _tmp133 * _tmp175 + _tmp147 * _tmp181; - const Scalar _tmp263 = - -_tmp103 * _tmp162 + _tmp116 * _tmp156 - _tmp133 * _tmp172 + _tmp147 * _tmp166; - const Scalar _tmp264 = - -_tmp103 * _tmp183 + _tmp116 * _tmp186 - _tmp133 * _tmp185 + _tmp147 * _tmp184; - const Scalar _tmp265 = - _tmp262 * covariance(2, 0) + _tmp263 * covariance(0, 0) + _tmp264 * covariance(1, 0); + _tmp142 * _tmp204 + _tmp149 * _tmp202 + _tmp152 * _tmp206 + _tmp259 + _tmp260; + const Scalar _tmp262 = _tmp216 * dt; + const Scalar _tmp263 = covariance(5, 3) * dt; + const Scalar _tmp264 = _tmp208 * covariance(3, 2) + _tmp209 * covariance(3, 1) + + _tmp211 * covariance(3, 0) + _tmp263 + covariance(8, 3); + const Scalar _tmp265 = _tmp252 * _tmp72 + _tmp253 * _tmp255; const Scalar _tmp266 = - _tmp262 * covariance(2, 2) + _tmp263 * covariance(2, 0) + _tmp264 * covariance(2, 1); - const Scalar _tmp267 = - _tmp262 * covariance(2, 1) + _tmp263 * covariance(1, 0) + _tmp264 * covariance(1, 1); - const Scalar _tmp268 = _tmp148 * _tmp259 + _tmp173 * _tmp265 + _tmp182 * _tmp266 + - _tmp187 * _tmp267 + _tmp221 * _tmp222 * _tmp261 + _tmp255 * _tmp260; - const Scalar _tmp269 = -_tmp40; - const Scalar _tmp270 = _tmp269 + _tmp58; - const Scalar _tmp271 = -_tmp42; - const Scalar _tmp272 = std::pow(_DR[3], Scalar(2)); - const Scalar _tmp273 = _tmp271 + _tmp272; - const Scalar _tmp274 = -_tmp49; - const Scalar _tmp275 = _tmp45 * (_tmp274 + _tmp68) + _tmp51 * (_tmp270 + _tmp273); - const Scalar _tmp276 = _tmp275 * dt; - const Scalar _tmp277 = -_tmp272; - const Scalar _tmp278 = _tmp277 + _tmp42; - const Scalar _tmp279 = -_tmp58; - const Scalar _tmp280 = _tmp279 + _tmp40; - const Scalar _tmp281 = _tmp45 * _tmp55 + _tmp56 * (_tmp278 + _tmp280); - const Scalar _tmp282 = _tmp281 * dt; - const Scalar _tmp283 = -_tmp52; - const Scalar _tmp284 = _tmp50 * _tmp56 + _tmp51 * (_tmp283 + _tmp53); - const Scalar _tmp285 = _tmp284 * dt; - const Scalar _tmp286 = _tmp276 * covariance(2, 1) + _tmp282 * covariance(2, 2) + - _tmp285 * covariance(2, 0) + covariance(3, 2); - const Scalar _tmp287 = _tmp276 * covariance(1, 0) + _tmp282 * covariance(2, 0) + - _tmp285 * covariance(0, 0) + covariance(3, 0); - const Scalar _tmp288 = _tmp276 * covariance(1, 1) + _tmp282 * covariance(2, 1) + - _tmp285 * covariance(1, 0) + covariance(3, 1); - const Scalar _tmp289 = _tmp173 * _tmp287 + _tmp182 * _tmp286 + _tmp187 * _tmp288; - const Scalar _tmp290 = -_tmp64; - const Scalar _tmp291 = _tmp45 * (_tmp290 + _tmp62) + _tmp51 * _tmp61; - const Scalar _tmp292 = _tmp291 * dt; - const Scalar _tmp293 = _tmp45 * (_tmp273 + _tmp280) + _tmp56 * (_tmp283 + _tmp54); - const Scalar _tmp294 = _tmp293 * dt; - const Scalar _tmp295 = _tmp51 * (_tmp270 + _tmp278) + _tmp56 * _tmp65; - const Scalar _tmp296 = _tmp295 * dt; - const Scalar _tmp297 = _tmp292 * covariance(1, 1) + _tmp294 * covariance(2, 1) + - _tmp296 * covariance(1, 0) + covariance(4, 1); - const Scalar _tmp298 = _tmp292 * covariance(2, 1) + _tmp294 * covariance(2, 2) + - _tmp296 * covariance(2, 0) + covariance(4, 2); - const Scalar _tmp299 = _tmp292 * covariance(1, 0) + _tmp294 * covariance(2, 0) + - _tmp296 * covariance(0, 0) + covariance(4, 0); - const Scalar _tmp300 = _tmp173 * _tmp299 + _tmp182 * _tmp298 + _tmp187 * _tmp297; - const Scalar _tmp301 = _tmp45 * _tmp70 + _tmp56 * (_tmp274 + _tmp47); - const Scalar _tmp302 = _tmp301 * dt; - const Scalar _tmp303 = _tmp45 * (_tmp271 + _tmp277 + _tmp40 + _tmp58) + _tmp51 * _tmp69; - const Scalar _tmp304 = _tmp303 * dt; - const Scalar _tmp305 = - _tmp51 * (_tmp290 + _tmp63) + _tmp56 * (_tmp269 + _tmp272 + _tmp279 + _tmp42); - const Scalar _tmp306 = _tmp305 * dt; - const Scalar _tmp307 = _tmp302 * covariance(2, 2) + _tmp304 * covariance(2, 1) + - _tmp306 * covariance(2, 0) + covariance(5, 2); - const Scalar _tmp308 = _tmp302 * covariance(2, 0) + _tmp304 * covariance(1, 0) + - _tmp306 * covariance(0, 0) + covariance(5, 0); - const Scalar _tmp309 = _tmp302 * covariance(2, 1) + _tmp304 * covariance(1, 1) + - _tmp306 * covariance(1, 0) + covariance(5, 1); - const Scalar _tmp310 = _tmp173 * _tmp308 + _tmp182 * _tmp307 + _tmp187 * _tmp309; - const Scalar _tmp311 = _tmp275 * _tmp72; - const Scalar _tmp312 = _tmp281 * _tmp72; - const Scalar _tmp313 = covariance(3, 2) * dt; - const Scalar _tmp314 = _tmp284 * _tmp72; - const Scalar _tmp315 = _tmp311 * covariance(2, 1) + _tmp312 * covariance(2, 2) + _tmp313 + - _tmp314 * covariance(2, 0) + covariance(6, 2); - const Scalar _tmp316 = covariance(3, 1) * dt; - const Scalar _tmp317 = _tmp311 * covariance(1, 1) + _tmp312 * covariance(2, 1) + - _tmp314 * covariance(1, 0) + _tmp316 + covariance(6, 1); - const Scalar _tmp318 = covariance(3, 0) * dt; - const Scalar _tmp319 = _tmp311 * covariance(1, 0) + _tmp312 * covariance(2, 0) + - _tmp314 * covariance(0, 0) + _tmp318 + covariance(6, 0); - const Scalar _tmp320 = _tmp173 * _tmp319 + _tmp182 * _tmp315 + _tmp187 * _tmp317; - const Scalar _tmp321 = _tmp291 * _tmp72; - const Scalar _tmp322 = covariance(4, 2) * dt; - const Scalar _tmp323 = _tmp293 * _tmp72; - const Scalar _tmp324 = _tmp295 * _tmp72; - const Scalar _tmp325 = _tmp321 * covariance(2, 1) + _tmp322 + _tmp323 * covariance(2, 2) + - _tmp324 * covariance(2, 0) + covariance(7, 2); - const Scalar _tmp326 = covariance(4, 1) * dt; - const Scalar _tmp327 = _tmp321 * covariance(1, 1) + _tmp323 * covariance(2, 1) + - _tmp324 * covariance(1, 0) + _tmp326 + covariance(7, 1); - const Scalar _tmp328 = covariance(4, 0) * dt; - const Scalar _tmp329 = _tmp321 * covariance(1, 0) + _tmp323 * covariance(2, 0) + - _tmp324 * covariance(0, 0) + _tmp328 + covariance(7, 0); - const Scalar _tmp330 = _tmp173 * _tmp329 + _tmp182 * _tmp325 + _tmp187 * _tmp327; - const Scalar _tmp331 = _tmp301 * _tmp72; - const Scalar _tmp332 = _tmp303 * _tmp72; - const Scalar _tmp333 = covariance(5, 0) * dt; - const Scalar _tmp334 = _tmp305 * _tmp72; - const Scalar _tmp335 = _tmp331 * covariance(2, 0) + _tmp332 * covariance(1, 0) + _tmp333 + - _tmp334 * covariance(0, 0) + covariance(8, 0); - const Scalar _tmp336 = covariance(5, 1) * dt; - const Scalar _tmp337 = _tmp331 * covariance(2, 1) + _tmp332 * covariance(1, 1) + - _tmp334 * covariance(1, 0) + _tmp336 + covariance(8, 1); - const Scalar _tmp338 = covariance(5, 2) * dt; - const Scalar _tmp339 = _tmp331 * covariance(2, 2) + _tmp332 * covariance(2, 1) + - _tmp334 * covariance(2, 0) + _tmp338 + covariance(8, 2); - const Scalar _tmp340 = _tmp173 * _tmp335 + _tmp182 * _tmp339 + _tmp187 * _tmp337; - const Scalar _tmp341 = _tmp245 * _tmp254 * _tmp260 + _tmp247 * _tmp261 + _tmp248 * _tmp259 + - _tmp249 * _tmp267 + _tmp250 * _tmp265 + _tmp251 * _tmp266; - const Scalar _tmp342 = _tmp249 * _tmp288 + _tmp250 * _tmp287 + _tmp251 * _tmp286; - const Scalar _tmp343 = _tmp249 * _tmp297 + _tmp250 * _tmp299 + _tmp251 * _tmp298; - const Scalar _tmp344 = _tmp249 * _tmp309 + _tmp250 * _tmp308 + _tmp251 * _tmp307; - const Scalar _tmp345 = _tmp249 * _tmp317 + _tmp250 * _tmp319 + _tmp251 * _tmp315; - const Scalar _tmp346 = _tmp249 * _tmp327 + _tmp250 * _tmp329 + _tmp251 * _tmp325; - const Scalar _tmp347 = _tmp249 * _tmp337 + _tmp250 * _tmp335 + _tmp251 * _tmp339; - const Scalar _tmp348 = _tmp262 * _tmp286 + _tmp263 * _tmp287 + _tmp264 * _tmp288; - const Scalar _tmp349 = _tmp262 * _tmp298 + _tmp263 * _tmp299 + _tmp264 * _tmp297; - const Scalar _tmp350 = _tmp262 * _tmp307 + _tmp263 * _tmp308 + _tmp264 * _tmp309; - const Scalar _tmp351 = _tmp262 * _tmp315 + _tmp263 * _tmp319 + _tmp264 * _tmp317; - const Scalar _tmp352 = _tmp262 * _tmp325 + _tmp263 * _tmp329 + _tmp264 * _tmp327; - const Scalar _tmp353 = _tmp262 * _tmp339 + _tmp263 * _tmp335 + _tmp264 * _tmp337; - const Scalar _tmp354 = std::pow(_tmp55, Scalar(2)); - const Scalar _tmp355 = accel_cov_diagonal(1, 0) * dt; - const Scalar _tmp356 = std::pow(_tmp50, Scalar(2)); - const Scalar _tmp357 = accel_cov_diagonal(2, 0) * dt; - const Scalar _tmp358 = std::pow(_tmp44, Scalar(2)); - const Scalar _tmp359 = accel_cov_diagonal(0, 0) * dt; - const Scalar _tmp360 = _tmp50 * dt; - const Scalar _tmp361 = _tmp65 * accel_cov_diagonal(2, 0); - const Scalar _tmp362 = _tmp60 * dt; - const Scalar _tmp363 = _tmp362 * accel_cov_diagonal(1, 0); - const Scalar _tmp364 = _tmp61 * dt; - const Scalar _tmp365 = _tmp44 * accel_cov_diagonal(0, 0); - const Scalar _tmp366 = _tmp276 * _tmp297 + _tmp282 * _tmp298 + _tmp285 * _tmp299 + - _tmp291 * _tmp316 + _tmp293 * _tmp313 + _tmp295 * _tmp318 + - _tmp360 * _tmp361 + _tmp363 * _tmp55 + _tmp364 * _tmp365 + - covariance(4, 3); - const Scalar _tmp367 = _tmp69 * dt; - const Scalar _tmp368 = _tmp67 * dt; - const Scalar _tmp369 = _tmp368 * accel_cov_diagonal(2, 0); - const Scalar _tmp370 = _tmp55 * dt; - const Scalar _tmp371 = _tmp70 * accel_cov_diagonal(1, 0); - const Scalar _tmp372 = _tmp276 * _tmp309 + _tmp282 * _tmp307 + _tmp285 * _tmp308 + - _tmp301 * _tmp313 + _tmp303 * _tmp316 + _tmp305 * _tmp318 + - _tmp365 * _tmp367 + _tmp369 * _tmp50 + _tmp370 * _tmp371 + - covariance(5, 3); - const Scalar _tmp373 = _tmp354 * accel_cov_diagonal(1, 0); - const Scalar _tmp374 = _tmp356 * accel_cov_diagonal(2, 0); - const Scalar _tmp375 = _tmp72 * accel_cov_diagonal(0, 0); - const Scalar _tmp376 = _tmp317 * dt; - const Scalar _tmp377 = _tmp311 * covariance(3, 1) + _tmp312 * covariance(3, 2) + - _tmp314 * covariance(3, 0) + covariance(3, 3) * dt + covariance(6, 3); - const Scalar _tmp378 = _tmp275 * _tmp376 + _tmp282 * _tmp315 + _tmp285 * _tmp319 + - _tmp358 * _tmp375 + _tmp373 * _tmp72 + _tmp374 * _tmp72 + _tmp377; - const Scalar _tmp379 = covariance(4, 3) * dt; - const Scalar _tmp380 = _tmp321 * covariance(3, 1) + _tmp323 * covariance(3, 2) + - _tmp324 * covariance(3, 0) + _tmp379 + covariance(7, 3); - const Scalar _tmp381 = _tmp50 * _tmp72; - const Scalar _tmp382 = _tmp60 * _tmp72; - const Scalar _tmp383 = _tmp55 * accel_cov_diagonal(1, 0); - const Scalar _tmp384 = _tmp44 * _tmp72; - const Scalar _tmp385 = _tmp61 * accel_cov_diagonal(0, 0); - const Scalar _tmp386 = _tmp361 * _tmp381 + _tmp382 * _tmp383 + _tmp384 * _tmp385; - const Scalar _tmp387 = - _tmp276 * _tmp327 + _tmp282 * _tmp325 + _tmp285 * _tmp329 + _tmp380 + _tmp386; - const Scalar _tmp388 = covariance(5, 3) * dt; - const Scalar _tmp389 = _tmp331 * covariance(3, 2) + _tmp332 * covariance(3, 1) + - _tmp334 * covariance(3, 0) + _tmp388 + covariance(8, 3); - const Scalar _tmp390 = _tmp69 * accel_cov_diagonal(0, 0); - const Scalar _tmp391 = _tmp67 * _tmp72; - const Scalar _tmp392 = _tmp50 * accel_cov_diagonal(2, 0); - const Scalar _tmp393 = _tmp55 * _tmp72; - const Scalar _tmp394 = _tmp371 * _tmp393 + _tmp384 * _tmp390 + _tmp391 * _tmp392; - const Scalar _tmp395 = - _tmp276 * _tmp337 + _tmp282 * _tmp339 + _tmp285 * _tmp335 + _tmp389 + _tmp394; - const Scalar _tmp396 = std::pow(_tmp65, Scalar(2)); - const Scalar _tmp397 = std::pow(_tmp61, Scalar(2)); - const Scalar _tmp398 = std::pow(_tmp60, Scalar(2)); - const Scalar _tmp399 = _tmp292 * _tmp309 + _tmp294 * _tmp307 + _tmp296 * _tmp308 + - _tmp301 * _tmp322 + _tmp303 * _tmp326 + _tmp305 * _tmp328 + - _tmp363 * _tmp70 + _tmp367 * _tmp385 + _tmp369 * _tmp65 + covariance(5, 4); - const Scalar _tmp400 = _tmp292 * _tmp317 + _tmp294 * _tmp315 + _tmp296 * _tmp319 + - _tmp311 * covariance(4, 1) + _tmp312 * covariance(4, 2) + - _tmp314 * covariance(4, 0) + _tmp379 + _tmp386 + covariance(6, 4); - const Scalar _tmp401 = _tmp396 * accel_cov_diagonal(2, 0); - const Scalar _tmp402 = _tmp398 * accel_cov_diagonal(1, 0); - const Scalar _tmp403 = _tmp321 * covariance(4, 1) + _tmp323 * covariance(4, 2) + - _tmp324 * covariance(4, 0) + covariance(4, 4) * dt + covariance(7, 4); - const Scalar _tmp404 = _tmp292 * _tmp327 + _tmp294 * _tmp325 + _tmp296 * _tmp329 + - _tmp375 * _tmp397 + _tmp401 * _tmp72 + _tmp402 * _tmp72 + _tmp403; - const Scalar _tmp405 = covariance(5, 4) * dt; - const Scalar _tmp406 = _tmp331 * covariance(4, 2) + _tmp332 * covariance(4, 1) + - _tmp334 * covariance(4, 0) + _tmp405 + covariance(8, 4); - const Scalar _tmp407 = _tmp61 * _tmp72; - const Scalar _tmp408 = _tmp361 * _tmp391 + _tmp371 * _tmp382 + _tmp390 * _tmp407; - const Scalar _tmp409 = - _tmp292 * _tmp337 + _tmp294 * _tmp339 + _tmp296 * _tmp335 + _tmp406 + _tmp408; - const Scalar _tmp410 = std::pow(_tmp70, Scalar(2)); - const Scalar _tmp411 = std::pow(_tmp69, Scalar(2)); - const Scalar _tmp412 = std::pow(_tmp67, Scalar(2)); - const Scalar _tmp413 = _tmp302 * _tmp315 + _tmp303 * _tmp376 + _tmp306 * _tmp319 + - _tmp311 * covariance(5, 1) + _tmp312 * covariance(5, 2) + - _tmp314 * covariance(5, 0) + _tmp388 + _tmp394 + covariance(6, 5); - const Scalar _tmp414 = _tmp302 * _tmp325 + _tmp304 * _tmp327 + _tmp306 * _tmp329 + - _tmp321 * covariance(5, 1) + _tmp323 * covariance(5, 2) + - _tmp324 * covariance(5, 0) + _tmp405 + _tmp408 + covariance(7, 5); - const Scalar _tmp415 = _tmp410 * accel_cov_diagonal(1, 0); - const Scalar _tmp416 = _tmp412 * accel_cov_diagonal(2, 0); - const Scalar _tmp417 = _tmp331 * covariance(5, 2) + _tmp332 * covariance(5, 1) + - _tmp334 * covariance(5, 0) + covariance(5, 5) * dt + covariance(8, 5); - const Scalar _tmp418 = _tmp302 * _tmp339 + _tmp304 * _tmp337 + _tmp306 * _tmp335 + - _tmp375 * _tmp411 + _tmp415 * _tmp72 + _tmp416 * _tmp72 + _tmp417; - const Scalar _tmp419 = (Scalar(1) / Scalar(4)) * _tmp75; - const Scalar _tmp420 = _tmp419 * accel_cov_diagonal(0, 0); - const Scalar _tmp421 = _tmp361 * _tmp419; - const Scalar _tmp422 = _tmp365 * _tmp419; - const Scalar _tmp423 = _tmp311 * _tmp327 + _tmp312 * _tmp325 + _tmp314 * _tmp329 + - _tmp321 * covariance(6, 1) + _tmp323 * covariance(6, 2) + - _tmp324 * covariance(6, 0) + _tmp380 * dt + _tmp383 * _tmp419 * _tmp60 + - _tmp421 * _tmp50 + _tmp422 * _tmp61 + covariance(6, 4) * dt + - covariance(7, 6); - const Scalar _tmp424 = _tmp371 * _tmp419; - const Scalar _tmp425 = _tmp311 * _tmp337 + _tmp312 * _tmp339 + _tmp314 * _tmp335 + - _tmp331 * covariance(6, 2) + _tmp332 * covariance(6, 1) + - _tmp334 * covariance(6, 0) + _tmp389 * dt + _tmp392 * _tmp419 * _tmp67 + - _tmp422 * _tmp69 + _tmp424 * _tmp55 + covariance(6, 5) * dt + - covariance(8, 6); - const Scalar _tmp426 = _tmp321 * _tmp337 + _tmp323 * _tmp339 + _tmp324 * _tmp335 + - _tmp331 * covariance(7, 2) + _tmp332 * covariance(7, 1) + - _tmp334 * covariance(7, 0) + _tmp406 * dt + _tmp420 * _tmp61 * _tmp69 + - _tmp421 * _tmp67 + _tmp424 * _tmp60 + covariance(7, 5) * dt + - covariance(8, 7); - const Scalar _tmp427 = -_tmp89 + _tmp92; - const Scalar _tmp428 = _tmp212 + _tmp25 + _tmp427 + _tmp78 - _tmp82 + _tmp85; - const Scalar _tmp429 = -_tmp16; - const Scalar _tmp430 = _tmp104 - _tmp106 + _tmp108 + _tmp196 + _tmp227 + _tmp429; - const Scalar _tmp431 = _tmp123 - _tmp125; - const Scalar _tmp432 = -_tmp128 + _tmp130; - const Scalar _tmp433 = _tmp117 - _tmp118 + _tmp120 + _tmp198 + _tmp431 + _tmp432; - const Scalar _tmp434 = _tmp139 - _tmp140; - const Scalar _tmp435 = _tmp135 - _tmp136 + _tmp138 + _tmp21 + _tmp233 + _tmp434; - const Scalar _tmp436 = _tmp111 + _tmp195 + _tmp224 - _tmp225 + _tmp226 + _tmp429; - const Scalar _tmp437 = -_tmp217 + _tmp218; - const Scalar _tmp438 = _tmp145 + _tmp21 - _tmp230 + _tmp231 + _tmp232 + _tmp437; - const Scalar _tmp439 = _tmp19 + _tmp204 - _tmp235 + _tmp236 + _tmp237 + _tmp431; - const Scalar _tmp440 = _tmp209 - _tmp210; - const Scalar _tmp441 = -_tmp240 + _tmp241 + _tmp242 + _tmp427 + _tmp440 + _tmp73; - const Scalar _tmp442 = _tmp114 + _tmp189 - _tmp190 + _tmp191 + _tmp228 + _tmp429; - const Scalar _tmp443 = _tmp19 - _tmp199 + _tmp200 + _tmp201 + _tmp238 + _tmp432; - const Scalar _tmp444 = _tmp101 + _tmp206 - _tmp207 + _tmp208 + _tmp25 + _tmp440; - const Scalar _tmp445 = _tmp134 + _tmp214 - _tmp215 + _tmp216 + _tmp434 + _tmp437; + _tmp142 * _tmp214 + _tmp148 * _tmp262 + _tmp152 * _tmp212 + _tmp264 + _tmp265; + const Scalar _tmp267 = std::pow(_tmp158, Scalar(2)) * gyro_cov_diagonal(0, 0) + + std::pow(_tmp222, Scalar(2)) * gyro_cov_diagonal(1, 0) + + std::pow(_tmp234, Scalar(2)) * gyro_cov_diagonal(2, 0); + const Scalar _tmp268 = std::pow(_tmp60, Scalar(2)) * accel_cov_diagonal(1, 0) + + std::pow(_tmp61, Scalar(2)) * accel_cov_diagonal(0, 0) + + std::pow(_tmp65, Scalar(2)) * accel_cov_diagonal(2, 0); + const Scalar _tmp269 = _tmp158 * _tmp173 + _tmp223 * _tmp225 + _tmp235 * _tmp237; + const Scalar _tmp270 = _tmp60 * _tmp70 * accel_cov_diagonal(1, 0) + + _tmp61 * _tmp69 * accel_cov_diagonal(0, 0) + + _tmp65 * _tmp67 * accel_cov_diagonal(2, 0); + const Scalar _tmp271 = _tmp163 * _tmp184 + _tmp165 * _tmp182 + _tmp167 * _tmp183 + + _tmp175 * _tmp199 + _tmp178 * _tmp203 + _tmp180 * _tmp205 + + _tmp245 * _tmp269 + _tmp270 * dt + covariance(5, 4); + const Scalar _tmp272 = _tmp163 * _tmp194 + _tmp165 * _tmp192 + _tmp167 * _tmp196 + + _tmp188 * covariance(4, 1) + _tmp189 * covariance(4, 2) + + _tmp191 * covariance(4, 0) + _tmp258 + _tmp260 + covariance(6, 4); + const Scalar _tmp273 = _tmp198 * covariance(4, 1) + _tmp200 * covariance(4, 2) + + _tmp201 * covariance(4, 0) + covariance(4, 4) * dt + covariance(7, 4); + const Scalar _tmp274 = _tmp163 * _tmp204 + _tmp165 * _tmp202 + _tmp167 * _tmp206 + + _tmp255 * _tmp267 + _tmp268 * _tmp72 + _tmp273; + const Scalar _tmp275 = covariance(5, 4) * dt; + const Scalar _tmp276 = _tmp208 * covariance(4, 2) + _tmp209 * covariance(4, 1) + + _tmp211 * covariance(4, 0) + _tmp275 + covariance(8, 4); + const Scalar _tmp277 = _tmp255 * _tmp269 + _tmp270 * _tmp72; + const Scalar _tmp278 = + _tmp163 * _tmp214 + _tmp164 * _tmp262 + _tmp167 * _tmp212 + _tmp276 + _tmp277; + const Scalar _tmp279 = std::pow(_tmp172, Scalar(2)) * gyro_cov_diagonal(0, 0) + + std::pow(_tmp225, Scalar(2)) * gyro_cov_diagonal(1, 0) + + std::pow(_tmp237, Scalar(2)) * gyro_cov_diagonal(2, 0); + const Scalar _tmp280 = std::pow(_tmp67, Scalar(2)) * accel_cov_diagonal(2, 0) + + std::pow(_tmp69, Scalar(2)) * accel_cov_diagonal(0, 0) + + std::pow(_tmp70, Scalar(2)) * accel_cov_diagonal(1, 0); + const Scalar _tmp281 = _tmp72 * covariance(5, 0); + const Scalar _tmp282 = _tmp151 * _tmp281 + _tmp176 * _tmp192 + _tmp179 * _tmp194 + + _tmp181 * _tmp196 + _tmp188 * covariance(5, 1) + + _tmp189 * covariance(5, 2) + _tmp263 + _tmp265 + covariance(6, 5); + const Scalar _tmp283 = _tmp166 * _tmp281 + _tmp176 * _tmp202 + _tmp179 * _tmp204 + + _tmp181 * _tmp206 + _tmp198 * covariance(5, 1) + + _tmp200 * covariance(5, 2) + _tmp275 + _tmp277 + covariance(7, 5); + const Scalar _tmp284 = _tmp208 * covariance(5, 2) + _tmp209 * covariance(5, 1) + + _tmp211 * covariance(5, 0) + covariance(5, 5) * dt + covariance(8, 5); + const Scalar _tmp285 = _tmp175 * _tmp262 + _tmp179 * _tmp214 + _tmp181 * _tmp212 + + _tmp255 * _tmp279 + _tmp280 * _tmp72 + _tmp284; + const Scalar _tmp286 = (Scalar(1) / Scalar(20)) * std::pow(dt, Scalar(5)); + const Scalar _tmp287 = _tmp188 * _tmp204 + _tmp189 * _tmp202 + _tmp191 * _tmp206 + + _tmp198 * covariance(6, 1) + _tmp200 * covariance(6, 2) + + _tmp201 * covariance(6, 0) + _tmp245 * _tmp249 + _tmp250 * _tmp286 + + _tmp259 * dt + covariance(6, 4) * dt + covariance(7, 6); + const Scalar _tmp288 = _tmp188 * _tmp214 + _tmp189 * _tmp216 + _tmp191 * _tmp212 + + _tmp208 * covariance(6, 2) + _tmp209 * covariance(6, 1) + + _tmp211 * covariance(6, 0) + _tmp245 * _tmp252 + _tmp253 * _tmp286 + + _tmp264 * dt + covariance(6, 5) * dt + covariance(8, 6); + const Scalar _tmp289 = _tmp198 * _tmp214 + _tmp200 * _tmp216 + _tmp201 * _tmp212 + + _tmp208 * covariance(7, 2) + _tmp209 * covariance(7, 1) + + _tmp211 * covariance(7, 0) + _tmp245 * _tmp270 + _tmp269 * _tmp286 + + _tmp276 * dt + covariance(7, 5) * dt + covariance(8, 7); + const Scalar _tmp290 = _tmp186 / _tmp7; + const Scalar _tmp291 = _tmp290 * _tmp6; + const Scalar _tmp292 = _tmp186 / (_tmp7 * std::sqrt(_tmp7)); + const Scalar _tmp293 = _DR[0] * _tmp12; + const Scalar _tmp294 = _tmp292 * _tmp293; + const Scalar _tmp295 = _tmp1 * _tmp5; + const Scalar _tmp296 = _DR[2] * _tmp12; + const Scalar _tmp297 = _tmp292 * _tmp296; + const Scalar _tmp298 = _tmp295 * _tmp297; + const Scalar _tmp299 = _tmp290 * _tmp81; + const Scalar _tmp300 = _tmp295 * _tmp299; + const Scalar _tmp301 = _tmp14 * _tmp72; + const Scalar _tmp302 = _tmp13 * _tmp301; + const Scalar _tmp303 = _tmp3 * _tmp5; + const Scalar _tmp304 = _DR[1] * _tmp12; + const Scalar _tmp305 = _tmp292 * _tmp304; + const Scalar _tmp306 = _tmp290 * _tmp73; + const Scalar _tmp307 = -_tmp303 * _tmp305 + _tmp303 * _tmp306; + const Scalar _tmp308 = + _tmp25 + _tmp291 * _tmp95 - _tmp294 * _tmp6 - _tmp298 + _tmp300 + _tmp302 * _tmp5 + _tmp307; + const Scalar _tmp309 = _tmp292 * _tmp6; + const Scalar _tmp310 = _tmp297 * _tmp3; + const Scalar _tmp311 = _tmp310 * _tmp5; + const Scalar _tmp312 = _tmp295 * _tmp306; + const Scalar _tmp313 = _tmp295 * _tmp305; + const Scalar _tmp314 = _tmp299 * _tmp303; + const Scalar _tmp315 = _tmp293 * _tmp301; + const Scalar _tmp316 = -_tmp16; + const Scalar _tmp317 = _tmp13 * _tmp309 - _tmp291 * _tmp89 - _tmp311 - _tmp312 + _tmp313 + + _tmp314 + _tmp315 * _tmp5 + _tmp316; + const Scalar _tmp318 = _tmp301 * _tmp304; + const Scalar _tmp319 = _tmp290 * _tmp95; + const Scalar _tmp320 = -_tmp294 * _tmp295 + _tmp295 * _tmp319; + const Scalar _tmp321 = _tmp13 * _tmp292; + const Scalar _tmp322 = _tmp290 * _tmp89; + const Scalar _tmp323 = _tmp303 * _tmp321 - _tmp303 * _tmp322; + const Scalar _tmp324 = + -_tmp19 - _tmp291 * _tmp81 + _tmp296 * _tmp309 + _tmp318 * _tmp5 + _tmp320 + _tmp323; + const Scalar _tmp325 = _tmp296 * _tmp301; + const Scalar _tmp326 = _tmp294 * _tmp3; + const Scalar _tmp327 = _tmp326 * _tmp5; + const Scalar _tmp328 = _tmp303 * _tmp319; + const Scalar _tmp329 = _tmp295 * _tmp321 - _tmp295 * _tmp322; + const Scalar _tmp330 = + _tmp21 + _tmp291 * _tmp73 - _tmp304 * _tmp309 + _tmp325 * _tmp5 + _tmp327 - _tmp328 + _tmp329; + const Scalar _tmp331 = _tmp292 * _tmp4; + const Scalar _tmp332 = _tmp290 * _tmp4; + const Scalar _tmp333 = _tmp1 * _tmp326; + const Scalar _tmp334 = _tmp1 * _tmp3; + const Scalar _tmp335 = _tmp319 * _tmp334; + const Scalar _tmp336 = _tmp13 * _tmp331 + _tmp3 * _tmp318 + _tmp311 - _tmp314 + _tmp316 - + _tmp332 * _tmp89 - _tmp333 + _tmp335; + const Scalar _tmp337 = -_tmp1 * _tmp310 + _tmp299 * _tmp334; + const Scalar _tmp338 = + _tmp21 + _tmp3 * _tmp302 - _tmp304 * _tmp331 - _tmp327 + _tmp328 + _tmp332 * _tmp73 + _tmp337; + const Scalar _tmp339 = _tmp305 * _tmp334; + const Scalar _tmp340 = _tmp306 * _tmp334; + const Scalar _tmp341 = + _tmp19 - _tmp296 * _tmp331 + _tmp3 * _tmp315 + _tmp323 + _tmp332 * _tmp81 + _tmp339 - _tmp340; + const Scalar _tmp342 = _tmp321 * _tmp334 - _tmp322 * _tmp334; + const Scalar _tmp343 = + -_tmp25 + _tmp294 * _tmp4 + _tmp3 * _tmp325 + _tmp307 - _tmp332 * _tmp95 + _tmp342; + const Scalar _tmp344 = _tmp2 * _tmp292; + const Scalar _tmp345 = _tmp2 * _tmp290; + const Scalar _tmp346 = _tmp1 * _tmp325 + _tmp13 * _tmp344 + _tmp312 - _tmp313 + _tmp316 + + _tmp333 - _tmp335 - _tmp345 * _tmp89; + const Scalar _tmp347 = + _tmp1 * _tmp302 + _tmp19 - _tmp296 * _tmp344 + _tmp320 - _tmp339 + _tmp340 + _tmp345 * _tmp81; + const Scalar _tmp348 = + _tmp1 * _tmp318 + _tmp25 - _tmp293 * _tmp344 + _tmp298 - _tmp300 + _tmp342 + _tmp345 * _tmp95; + const Scalar _tmp349 = + _tmp1 * _tmp315 - _tmp21 + _tmp304 * _tmp344 + _tmp329 + _tmp337 - _tmp345 * _tmp73; // Output terms (9) if (new_DR != nullptr) { @@ -652,238 +587,233 @@ void ImuManifoldPreintegrationUpdateAutoDerivative( Eigen::Matrix& _new_covariance = (*new_covariance); _new_covariance(0, 0) = - std::pow(_tmp148, Scalar(2)) * _tmp150 + - _tmp173 * - (_tmp173 * covariance(0, 0) + _tmp182 * covariance(2, 0) + _tmp187 * covariance(1, 0)) + - _tmp182 * - (_tmp173 * covariance(2, 0) + _tmp182 * covariance(2, 2) + _tmp187 * covariance(2, 1)) + - _tmp187 * - (_tmp173 * covariance(1, 0) + _tmp182 * covariance(2, 1) + _tmp187 * covariance(1, 1)) + - std::pow(_tmp221, Scalar(2)) * _tmp222 + std::pow(_tmp244, Scalar(2)) * _tmp245; - _new_covariance(1, 0) = _tmp257; - _new_covariance(2, 0) = _tmp268; - _new_covariance(3, 0) = _tmp289; - _new_covariance(4, 0) = _tmp300; - _new_covariance(5, 0) = _tmp310; - _new_covariance(6, 0) = _tmp320; - _new_covariance(7, 0) = _tmp330; - _new_covariance(8, 0) = _tmp340; - _new_covariance(0, 1) = _tmp257; - _new_covariance(1, 1) = _tmp150 * std::pow(_tmp248, Scalar(2)) + - _tmp222 * std::pow(_tmp246, Scalar(2)) + - _tmp245 * std::pow(_tmp254, Scalar(2)) + _tmp249 * _tmp256 + - _tmp250 * _tmp252 + _tmp251 * _tmp253; - _new_covariance(2, 1) = _tmp341; - _new_covariance(3, 1) = _tmp342; - _new_covariance(4, 1) = _tmp343; - _new_covariance(5, 1) = _tmp344; - _new_covariance(6, 1) = _tmp345; - _new_covariance(7, 1) = _tmp346; - _new_covariance(8, 1) = _tmp347; - _new_covariance(0, 2) = _tmp268; - _new_covariance(1, 2) = _tmp341; - _new_covariance(2, 2) = _tmp150 * std::pow(_tmp258, Scalar(2)) + - _tmp222 * std::pow(_tmp261, Scalar(2)) + - _tmp245 * std::pow(_tmp260, Scalar(2)) + _tmp262 * _tmp266 + - _tmp263 * _tmp265 + _tmp264 * _tmp267; - _new_covariance(3, 2) = _tmp348; - _new_covariance(4, 2) = _tmp349; - _new_covariance(5, 2) = _tmp350; - _new_covariance(6, 2) = _tmp351; - _new_covariance(7, 2) = _tmp352; - _new_covariance(8, 2) = _tmp353; - _new_covariance(0, 3) = _tmp289; - _new_covariance(1, 3) = _tmp342; - _new_covariance(2, 3) = _tmp348; - _new_covariance(3, 3) = _tmp275 * _tmp316 + _tmp276 * _tmp288 + _tmp281 * _tmp313 + - _tmp282 * _tmp286 + _tmp284 * _tmp318 + _tmp285 * _tmp287 + - _tmp354 * _tmp355 + _tmp356 * _tmp357 + _tmp358 * _tmp359 + - covariance(3, 3); - _new_covariance(4, 3) = _tmp366; - _new_covariance(5, 3) = _tmp372; - _new_covariance(6, 3) = _tmp378; - _new_covariance(7, 3) = _tmp387; - _new_covariance(8, 3) = _tmp395; - _new_covariance(0, 4) = _tmp300; - _new_covariance(1, 4) = _tmp343; - _new_covariance(2, 4) = _tmp349; - _new_covariance(3, 4) = _tmp366; - _new_covariance(4, 4) = _tmp291 * _tmp326 + _tmp292 * _tmp297 + _tmp293 * _tmp322 + - _tmp294 * _tmp298 + _tmp295 * _tmp328 + _tmp296 * _tmp299 + - _tmp355 * _tmp398 + _tmp357 * _tmp396 + _tmp359 * _tmp397 + - covariance(4, 4); - _new_covariance(5, 4) = _tmp399; - _new_covariance(6, 4) = _tmp400; - _new_covariance(7, 4) = _tmp404; - _new_covariance(8, 4) = _tmp409; - _new_covariance(0, 5) = _tmp310; - _new_covariance(1, 5) = _tmp344; - _new_covariance(2, 5) = _tmp350; - _new_covariance(3, 5) = _tmp372; - _new_covariance(4, 5) = _tmp399; - _new_covariance(5, 5) = _tmp301 * _tmp338 + _tmp302 * _tmp307 + _tmp303 * _tmp336 + - _tmp304 * _tmp309 + _tmp305 * _tmp333 + _tmp306 * _tmp308 + - _tmp355 * _tmp410 + _tmp357 * _tmp412 + _tmp359 * _tmp411 + - covariance(5, 5); - _new_covariance(6, 5) = _tmp413; - _new_covariance(7, 5) = _tmp414; - _new_covariance(8, 5) = _tmp418; - _new_covariance(0, 6) = _tmp320; - _new_covariance(1, 6) = _tmp345; - _new_covariance(2, 6) = _tmp351; - _new_covariance(3, 6) = _tmp378; - _new_covariance(4, 6) = _tmp400; - _new_covariance(5, 6) = _tmp413; - _new_covariance(6, 6) = _tmp311 * _tmp317 + _tmp311 * covariance(6, 1) + _tmp312 * _tmp315 + - _tmp312 * covariance(6, 2) + _tmp314 * _tmp319 + - _tmp314 * covariance(6, 0) + _tmp358 * _tmp420 + _tmp373 * _tmp419 + - _tmp374 * _tmp419 + _tmp377 * dt + covariance(6, 3) * dt + - covariance(6, 6); - _new_covariance(7, 6) = _tmp423; - _new_covariance(8, 6) = _tmp425; - _new_covariance(0, 7) = _tmp330; - _new_covariance(1, 7) = _tmp346; - _new_covariance(2, 7) = _tmp352; - _new_covariance(3, 7) = _tmp387; - _new_covariance(4, 7) = _tmp404; - _new_covariance(5, 7) = _tmp414; - _new_covariance(6, 7) = _tmp423; - _new_covariance(7, 7) = _tmp321 * _tmp327 + _tmp321 * covariance(7, 1) + _tmp323 * _tmp325 + - _tmp323 * covariance(7, 2) + _tmp324 * _tmp329 + - _tmp324 * covariance(7, 0) + _tmp397 * _tmp420 + _tmp401 * _tmp419 + - _tmp402 * _tmp419 + _tmp403 * dt + covariance(7, 4) * dt + - covariance(7, 7); - _new_covariance(8, 7) = _tmp426; - _new_covariance(0, 8) = _tmp340; - _new_covariance(1, 8) = _tmp347; - _new_covariance(2, 8) = _tmp353; - _new_covariance(3, 8) = _tmp395; - _new_covariance(4, 8) = _tmp409; - _new_covariance(5, 8) = _tmp418; - _new_covariance(6, 8) = _tmp425; - _new_covariance(7, 8) = _tmp426; - _new_covariance(8, 8) = _tmp331 * _tmp339 + _tmp331 * covariance(8, 2) + _tmp332 * _tmp337 + - _tmp332 * covariance(8, 1) + _tmp334 * _tmp335 + - _tmp334 * covariance(8, 0) + _tmp411 * _tmp420 + _tmp415 * _tmp419 + - _tmp416 * _tmp419 + _tmp417 * dt + covariance(8, 5) * dt + - covariance(8, 8); + _tmp103 * + (_tmp103 * covariance(0, 0) + _tmp112 * covariance(2, 0) + _tmp117 * covariance(1, 0)) + + _tmp112 * + (_tmp103 * covariance(2, 0) + _tmp112 * covariance(2, 2) + _tmp117 * covariance(2, 1)) + + _tmp117 * + (_tmp103 * covariance(1, 0) + _tmp112 * covariance(2, 1) + _tmp117 * covariance(1, 1)) + + dt * gyro_cov_diagonal(0, 0); + _new_covariance(1, 0) = _tmp124; + _new_covariance(2, 0) = _tmp131; + _new_covariance(3, 0) = _tmp156; + _new_covariance(4, 0) = _tmp171; + _new_covariance(5, 0) = _tmp185; + _new_covariance(6, 0) = _tmp197; + _new_covariance(7, 0) = _tmp207; + _new_covariance(8, 0) = _tmp217; + _new_covariance(0, 1) = _tmp124; + _new_covariance(1, 1) = + _tmp118 * _tmp123 + _tmp119 * _tmp121 + _tmp120 * _tmp122 + dt * gyro_cov_diagonal(1, 0); + _new_covariance(2, 1) = _tmp218; + _new_covariance(3, 1) = _tmp221; + _new_covariance(4, 1) = _tmp224; + _new_covariance(5, 1) = _tmp227; + _new_covariance(6, 1) = _tmp228; + _new_covariance(7, 1) = _tmp229; + _new_covariance(8, 1) = _tmp230; + _new_covariance(0, 2) = _tmp131; + _new_covariance(1, 2) = _tmp218; + _new_covariance(2, 2) = + _tmp125 * _tmp129 + _tmp126 * _tmp128 + _tmp127 * _tmp130 + dt * gyro_cov_diagonal(2, 0); + _new_covariance(3, 2) = _tmp233; + _new_covariance(4, 2) = _tmp236; + _new_covariance(5, 2) = _tmp239; + _new_covariance(6, 2) = _tmp240; + _new_covariance(7, 2) = _tmp241; + _new_covariance(8, 2) = _tmp242; + _new_covariance(0, 3) = _tmp156; + _new_covariance(1, 3) = _tmp221; + _new_covariance(2, 3) = _tmp233; + _new_covariance(3, 3) = _tmp141 * _tmp193 + _tmp142 * _tmp155 + _tmp148 * _tmp190 + + _tmp149 * _tmp153 + _tmp151 * _tmp195 + _tmp152 * _tmp154 + + _tmp243 * dt + _tmp244 * _tmp245 + covariance(3, 3); + _new_covariance(4, 3) = _tmp251; + _new_covariance(5, 3) = _tmp254; + _new_covariance(6, 3) = _tmp257; + _new_covariance(7, 3) = _tmp261; + _new_covariance(8, 3) = _tmp266; + _new_covariance(0, 4) = _tmp171; + _new_covariance(1, 4) = _tmp224; + _new_covariance(2, 4) = _tmp236; + _new_covariance(3, 4) = _tmp251; + _new_covariance(4, 4) = _tmp162 * _tmp203 + _tmp163 * _tmp168 + _tmp164 * _tmp199 + + _tmp165 * _tmp169 + _tmp166 * _tmp205 + _tmp167 * _tmp170 + + _tmp245 * _tmp267 + _tmp268 * dt + covariance(4, 4); + _new_covariance(5, 4) = _tmp271; + _new_covariance(6, 4) = _tmp272; + _new_covariance(7, 4) = _tmp274; + _new_covariance(8, 4) = _tmp278; + _new_covariance(0, 5) = _tmp185; + _new_covariance(1, 5) = _tmp227; + _new_covariance(2, 5) = _tmp239; + _new_covariance(3, 5) = _tmp254; + _new_covariance(4, 5) = _tmp271; + _new_covariance(5, 5) = _tmp175 * _tmp215 + _tmp176 * _tmp182 + _tmp178 * _tmp213 + + _tmp179 * _tmp184 + _tmp180 * _tmp210 + _tmp181 * _tmp183 + + _tmp245 * _tmp279 + _tmp280 * dt + covariance(5, 5); + _new_covariance(6, 5) = _tmp282; + _new_covariance(7, 5) = _tmp283; + _new_covariance(8, 5) = _tmp285; + _new_covariance(0, 6) = _tmp197; + _new_covariance(1, 6) = _tmp228; + _new_covariance(2, 6) = _tmp240; + _new_covariance(3, 6) = _tmp257; + _new_covariance(4, 6) = _tmp272; + _new_covariance(5, 6) = _tmp282; + _new_covariance(6, 6) = _tmp188 * _tmp194 + _tmp188 * covariance(6, 1) + _tmp189 * _tmp192 + + _tmp189 * covariance(6, 2) + _tmp191 * _tmp196 + + _tmp191 * covariance(6, 0) + _tmp243 * _tmp245 + _tmp244 * _tmp286 + + _tmp256 * dt + covariance(6, 3) * dt + covariance(6, 6); + _new_covariance(7, 6) = _tmp287; + _new_covariance(8, 6) = _tmp288; + _new_covariance(0, 7) = _tmp207; + _new_covariance(1, 7) = _tmp229; + _new_covariance(2, 7) = _tmp241; + _new_covariance(3, 7) = _tmp261; + _new_covariance(4, 7) = _tmp274; + _new_covariance(5, 7) = _tmp283; + _new_covariance(6, 7) = _tmp287; + _new_covariance(7, 7) = _tmp198 * _tmp204 + _tmp198 * covariance(7, 1) + _tmp200 * _tmp202 + + _tmp200 * covariance(7, 2) + _tmp201 * _tmp206 + + _tmp201 * covariance(7, 0) + _tmp245 * _tmp268 + _tmp267 * _tmp286 + + _tmp273 * dt + covariance(7, 4) * dt + covariance(7, 7); + _new_covariance(8, 7) = _tmp289; + _new_covariance(0, 8) = _tmp217; + _new_covariance(1, 8) = _tmp230; + _new_covariance(2, 8) = _tmp242; + _new_covariance(3, 8) = _tmp266; + _new_covariance(4, 8) = _tmp278; + _new_covariance(5, 8) = _tmp285; + _new_covariance(6, 8) = _tmp288; + _new_covariance(7, 8) = _tmp289; + _new_covariance(8, 8) = _tmp208 * _tmp216 + _tmp208 * covariance(8, 2) + _tmp209 * _tmp214 + + _tmp209 * covariance(8, 1) + _tmp211 * _tmp212 + + _tmp211 * covariance(8, 0) + _tmp245 * _tmp280 + _tmp279 * _tmp286 + + _tmp284 * dt + covariance(8, 5) * dt + covariance(8, 8); } if (new_DR_D_gyro_bias != nullptr) { Eigen::Matrix& _new_DR_D_gyro_bias = (*new_DR_D_gyro_bias); - _new_DR_D_gyro_bias(0, 0) = DR_D_gyro_bias(0, 0) * _tmp173 + DR_D_gyro_bias(1, 0) * _tmp187 + - DR_D_gyro_bias(2, 0) * _tmp182 - _tmp103 * _tmp428 + - _tmp116 * _tmp430 + _tmp133 * _tmp433 - _tmp147 * _tmp435; - _new_DR_D_gyro_bias(1, 0) = DR_D_gyro_bias(0, 0) * _tmp250 + DR_D_gyro_bias(1, 0) * _tmp249 + - DR_D_gyro_bias(2, 0) * _tmp251 + _tmp103 * _tmp435 + - _tmp116 * _tmp433 - _tmp133 * _tmp430 - _tmp147 * _tmp428; - _new_DR_D_gyro_bias(2, 0) = DR_D_gyro_bias(0, 0) * _tmp263 + DR_D_gyro_bias(1, 0) * _tmp264 + - DR_D_gyro_bias(2, 0) * _tmp262 - _tmp103 * _tmp433 + - _tmp116 * _tmp435 - _tmp133 * _tmp428 + _tmp147 * _tmp430; - _new_DR_D_gyro_bias(0, 1) = DR_D_gyro_bias(0, 1) * _tmp173 + DR_D_gyro_bias(1, 1) * _tmp187 + - DR_D_gyro_bias(2, 1) * _tmp182 - _tmp103 * _tmp438 + - _tmp116 * _tmp439 + _tmp133 * _tmp436 - _tmp147 * _tmp441; - _new_DR_D_gyro_bias(1, 1) = DR_D_gyro_bias(0, 1) * _tmp250 + DR_D_gyro_bias(1, 1) * _tmp249 + - DR_D_gyro_bias(2, 1) * _tmp251 + _tmp103 * _tmp441 + - _tmp116 * _tmp436 - _tmp133 * _tmp439 - _tmp147 * _tmp438; - _new_DR_D_gyro_bias(2, 1) = DR_D_gyro_bias(0, 1) * _tmp263 + DR_D_gyro_bias(1, 1) * _tmp264 + - DR_D_gyro_bias(2, 1) * _tmp262 - _tmp103 * _tmp436 + - _tmp116 * _tmp441 - _tmp133 * _tmp438 + _tmp147 * _tmp439; - _new_DR_D_gyro_bias(0, 2) = DR_D_gyro_bias(0, 2) * _tmp173 + DR_D_gyro_bias(1, 2) * _tmp187 + - DR_D_gyro_bias(2, 2) * _tmp182 - _tmp103 * _tmp443 + - _tmp116 * _tmp445 + _tmp133 * _tmp444 - _tmp147 * _tmp442; - _new_DR_D_gyro_bias(1, 2) = DR_D_gyro_bias(0, 2) * _tmp250 + DR_D_gyro_bias(1, 2) * _tmp249 + - DR_D_gyro_bias(2, 2) * _tmp251 + _tmp103 * _tmp442 + - _tmp116 * _tmp444 - _tmp133 * _tmp445 - _tmp147 * _tmp443; - _new_DR_D_gyro_bias(2, 2) = DR_D_gyro_bias(0, 2) * _tmp263 + DR_D_gyro_bias(1, 2) * _tmp264 + - DR_D_gyro_bias(2, 2) * _tmp262 - _tmp103 * _tmp444 + - _tmp116 * _tmp442 - _tmp133 * _tmp443 + _tmp147 * _tmp445; + _new_DR_D_gyro_bias(0, 0) = DR_D_gyro_bias(0, 0) * _tmp103 + DR_D_gyro_bias(1, 0) * _tmp117 + + DR_D_gyro_bias(2, 0) * _tmp112 - _tmp102 * _tmp308 + + _tmp317 * _tmp94 + _tmp324 * _tmp88 - _tmp330 * _tmp80; + _new_DR_D_gyro_bias(1, 0) = DR_D_gyro_bias(0, 0) * _tmp119 + DR_D_gyro_bias(1, 0) * _tmp118 + + DR_D_gyro_bias(2, 0) * _tmp120 + _tmp102 * _tmp330 - + _tmp308 * _tmp80 - _tmp317 * _tmp88 + _tmp324 * _tmp94; + _new_DR_D_gyro_bias(2, 0) = DR_D_gyro_bias(0, 0) * _tmp126 + DR_D_gyro_bias(1, 0) * _tmp127 + + DR_D_gyro_bias(2, 0) * _tmp125 - _tmp102 * _tmp324 - + _tmp308 * _tmp88 + _tmp317 * _tmp80 + _tmp330 * _tmp94; + _new_DR_D_gyro_bias(0, 1) = DR_D_gyro_bias(0, 1) * _tmp103 + DR_D_gyro_bias(1, 1) * _tmp117 + + DR_D_gyro_bias(2, 1) * _tmp112 - _tmp102 * _tmp338 + + _tmp336 * _tmp88 + _tmp341 * _tmp94 - _tmp343 * _tmp80; + _new_DR_D_gyro_bias(1, 1) = DR_D_gyro_bias(0, 1) * _tmp119 + DR_D_gyro_bias(1, 1) * _tmp118 + + DR_D_gyro_bias(2, 1) * _tmp120 + _tmp102 * _tmp343 + + _tmp336 * _tmp94 - _tmp338 * _tmp80 - _tmp341 * _tmp88; + _new_DR_D_gyro_bias(2, 1) = DR_D_gyro_bias(0, 1) * _tmp126 + DR_D_gyro_bias(1, 1) * _tmp127 + + DR_D_gyro_bias(2, 1) * _tmp125 - _tmp102 * _tmp336 - + _tmp338 * _tmp88 + _tmp341 * _tmp80 + _tmp343 * _tmp94; + _new_DR_D_gyro_bias(0, 2) = DR_D_gyro_bias(0, 2) * _tmp103 + DR_D_gyro_bias(1, 2) * _tmp117 + + DR_D_gyro_bias(2, 2) * _tmp112 - _tmp102 * _tmp347 - + _tmp346 * _tmp80 + _tmp348 * _tmp88 + _tmp349 * _tmp94; + _new_DR_D_gyro_bias(1, 2) = DR_D_gyro_bias(0, 2) * _tmp119 + DR_D_gyro_bias(1, 2) * _tmp118 + + DR_D_gyro_bias(2, 2) * _tmp120 + _tmp102 * _tmp346 - + _tmp347 * _tmp80 + _tmp348 * _tmp94 - _tmp349 * _tmp88; + _new_DR_D_gyro_bias(2, 2) = DR_D_gyro_bias(0, 2) * _tmp126 + DR_D_gyro_bias(1, 2) * _tmp127 + + DR_D_gyro_bias(2, 2) * _tmp125 - _tmp102 * _tmp348 + + _tmp346 * _tmp94 - _tmp347 * _tmp88 + _tmp349 * _tmp80; } if (new_Dv_D_accel_bias != nullptr) { Eigen::Matrix& _new_Dv_D_accel_bias = (*new_Dv_D_accel_bias); _new_Dv_D_accel_bias(0, 0) = Dv_D_accel_bias(0, 0) - _tmp44 * dt; - _new_Dv_D_accel_bias(1, 0) = Dv_D_accel_bias(1, 0) - _tmp364; - _new_Dv_D_accel_bias(2, 0) = Dv_D_accel_bias(2, 0) - _tmp367; - _new_Dv_D_accel_bias(0, 1) = Dv_D_accel_bias(0, 1) - _tmp370; - _new_Dv_D_accel_bias(1, 1) = Dv_D_accel_bias(1, 1) - _tmp362; + _new_Dv_D_accel_bias(1, 0) = Dv_D_accel_bias(1, 0) - _tmp61 * dt; + _new_Dv_D_accel_bias(2, 0) = Dv_D_accel_bias(2, 0) - _tmp69 * dt; + _new_Dv_D_accel_bias(0, 1) = Dv_D_accel_bias(0, 1) - _tmp55 * dt; + _new_Dv_D_accel_bias(1, 1) = Dv_D_accel_bias(1, 1) - _tmp60 * dt; _new_Dv_D_accel_bias(2, 1) = Dv_D_accel_bias(2, 1) - _tmp70 * dt; - _new_Dv_D_accel_bias(0, 2) = Dv_D_accel_bias(0, 2) - _tmp360; + _new_Dv_D_accel_bias(0, 2) = Dv_D_accel_bias(0, 2) - _tmp50 * dt; _new_Dv_D_accel_bias(1, 2) = Dv_D_accel_bias(1, 2) - _tmp65 * dt; - _new_Dv_D_accel_bias(2, 2) = Dv_D_accel_bias(2, 2) - _tmp368; + _new_Dv_D_accel_bias(2, 2) = Dv_D_accel_bias(2, 2) - _tmp67 * dt; } if (new_Dv_D_gyro_bias != nullptr) { Eigen::Matrix& _new_Dv_D_gyro_bias = (*new_Dv_D_gyro_bias); - _new_Dv_D_gyro_bias(0, 0) = DR_D_gyro_bias(0, 0) * _tmp285 + DR_D_gyro_bias(1, 0) * _tmp276 + - DR_D_gyro_bias(2, 0) * _tmp282 + Dv_D_gyro_bias(0, 0); - _new_Dv_D_gyro_bias(1, 0) = DR_D_gyro_bias(0, 0) * _tmp296 + DR_D_gyro_bias(1, 0) * _tmp292 + - DR_D_gyro_bias(2, 0) * _tmp294 + Dv_D_gyro_bias(1, 0); - _new_Dv_D_gyro_bias(2, 0) = DR_D_gyro_bias(0, 0) * _tmp306 + DR_D_gyro_bias(1, 0) * _tmp304 + - DR_D_gyro_bias(2, 0) * _tmp302 + Dv_D_gyro_bias(2, 0); - _new_Dv_D_gyro_bias(0, 1) = DR_D_gyro_bias(0, 1) * _tmp285 + DR_D_gyro_bias(1, 1) * _tmp276 + - DR_D_gyro_bias(2, 1) * _tmp282 + Dv_D_gyro_bias(0, 1); - _new_Dv_D_gyro_bias(1, 1) = DR_D_gyro_bias(0, 1) * _tmp296 + DR_D_gyro_bias(1, 1) * _tmp292 + - DR_D_gyro_bias(2, 1) * _tmp294 + Dv_D_gyro_bias(1, 1); - _new_Dv_D_gyro_bias(2, 1) = DR_D_gyro_bias(0, 1) * _tmp306 + DR_D_gyro_bias(1, 1) * _tmp304 + - DR_D_gyro_bias(2, 1) * _tmp302 + Dv_D_gyro_bias(2, 1); - _new_Dv_D_gyro_bias(0, 2) = DR_D_gyro_bias(0, 2) * _tmp285 + DR_D_gyro_bias(1, 2) * _tmp276 + - DR_D_gyro_bias(2, 2) * _tmp282 + Dv_D_gyro_bias(0, 2); - _new_Dv_D_gyro_bias(1, 2) = DR_D_gyro_bias(0, 2) * _tmp296 + DR_D_gyro_bias(1, 2) * _tmp292 + - DR_D_gyro_bias(2, 2) * _tmp294 + Dv_D_gyro_bias(1, 2); - _new_Dv_D_gyro_bias(2, 2) = DR_D_gyro_bias(0, 2) * _tmp306 + DR_D_gyro_bias(1, 2) * _tmp304 + - DR_D_gyro_bias(2, 2) * _tmp302 + Dv_D_gyro_bias(2, 2); + _new_Dv_D_gyro_bias(0, 0) = DR_D_gyro_bias(0, 0) * _tmp152 + DR_D_gyro_bias(1, 0) * _tmp142 + + DR_D_gyro_bias(2, 0) * _tmp149 + Dv_D_gyro_bias(0, 0); + _new_Dv_D_gyro_bias(1, 0) = DR_D_gyro_bias(0, 0) * _tmp167 + DR_D_gyro_bias(1, 0) * _tmp163 + + DR_D_gyro_bias(2, 0) * _tmp165 + Dv_D_gyro_bias(1, 0); + _new_Dv_D_gyro_bias(2, 0) = DR_D_gyro_bias(0, 0) * _tmp181 + DR_D_gyro_bias(1, 0) * _tmp179 + + DR_D_gyro_bias(2, 0) * _tmp176 + Dv_D_gyro_bias(2, 0); + _new_Dv_D_gyro_bias(0, 1) = DR_D_gyro_bias(0, 1) * _tmp152 + DR_D_gyro_bias(1, 1) * _tmp142 + + DR_D_gyro_bias(2, 1) * _tmp149 + Dv_D_gyro_bias(0, 1); + _new_Dv_D_gyro_bias(1, 1) = DR_D_gyro_bias(0, 1) * _tmp167 + DR_D_gyro_bias(1, 1) * _tmp163 + + DR_D_gyro_bias(2, 1) * _tmp165 + Dv_D_gyro_bias(1, 1); + _new_Dv_D_gyro_bias(2, 1) = DR_D_gyro_bias(0, 1) * _tmp181 + DR_D_gyro_bias(1, 1) * _tmp179 + + DR_D_gyro_bias(2, 1) * _tmp176 + Dv_D_gyro_bias(2, 1); + _new_Dv_D_gyro_bias(0, 2) = DR_D_gyro_bias(0, 2) * _tmp152 + DR_D_gyro_bias(1, 2) * _tmp142 + + DR_D_gyro_bias(2, 2) * _tmp149 + Dv_D_gyro_bias(0, 2); + _new_Dv_D_gyro_bias(1, 2) = DR_D_gyro_bias(0, 2) * _tmp167 + DR_D_gyro_bias(1, 2) * _tmp163 + + DR_D_gyro_bias(2, 2) * _tmp165 + Dv_D_gyro_bias(1, 2); + _new_Dv_D_gyro_bias(2, 2) = DR_D_gyro_bias(0, 2) * _tmp181 + DR_D_gyro_bias(1, 2) * _tmp179 + + DR_D_gyro_bias(2, 2) * _tmp176 + Dv_D_gyro_bias(2, 2); } if (new_Dp_D_accel_bias != nullptr) { Eigen::Matrix& _new_Dp_D_accel_bias = (*new_Dp_D_accel_bias); - _new_Dp_D_accel_bias(0, 0) = Dp_D_accel_bias(0, 0) + Dv_D_accel_bias(0, 0) * dt - _tmp384; - _new_Dp_D_accel_bias(1, 0) = Dp_D_accel_bias(1, 0) + Dv_D_accel_bias(1, 0) * dt - _tmp407; + _new_Dp_D_accel_bias(0, 0) = + Dp_D_accel_bias(0, 0) + Dv_D_accel_bias(0, 0) * dt - _tmp44 * _tmp72; + _new_Dp_D_accel_bias(1, 0) = + Dp_D_accel_bias(1, 0) + Dv_D_accel_bias(1, 0) * dt - _tmp61 * _tmp72; _new_Dp_D_accel_bias(2, 0) = Dp_D_accel_bias(2, 0) + Dv_D_accel_bias(2, 0) * dt - _tmp69 * _tmp72; - _new_Dp_D_accel_bias(0, 1) = Dp_D_accel_bias(0, 1) + Dv_D_accel_bias(0, 1) * dt - _tmp393; - _new_Dp_D_accel_bias(1, 1) = Dp_D_accel_bias(1, 1) + Dv_D_accel_bias(1, 1) * dt - _tmp382; + _new_Dp_D_accel_bias(0, 1) = + Dp_D_accel_bias(0, 1) + Dv_D_accel_bias(0, 1) * dt - _tmp55 * _tmp72; + _new_Dp_D_accel_bias(1, 1) = + Dp_D_accel_bias(1, 1) + Dv_D_accel_bias(1, 1) * dt - _tmp60 * _tmp72; _new_Dp_D_accel_bias(2, 1) = Dp_D_accel_bias(2, 1) + Dv_D_accel_bias(2, 1) * dt - _tmp70 * _tmp72; - _new_Dp_D_accel_bias(0, 2) = Dp_D_accel_bias(0, 2) + Dv_D_accel_bias(0, 2) * dt - _tmp381; + _new_Dp_D_accel_bias(0, 2) = + Dp_D_accel_bias(0, 2) + Dv_D_accel_bias(0, 2) * dt - _tmp50 * _tmp72; _new_Dp_D_accel_bias(1, 2) = Dp_D_accel_bias(1, 2) + Dv_D_accel_bias(1, 2) * dt - _tmp65 * _tmp72; - _new_Dp_D_accel_bias(2, 2) = Dp_D_accel_bias(2, 2) + Dv_D_accel_bias(2, 2) * dt - _tmp391; + _new_Dp_D_accel_bias(2, 2) = + Dp_D_accel_bias(2, 2) + Dv_D_accel_bias(2, 2) * dt - _tmp67 * _tmp72; } if (new_Dp_D_gyro_bias != nullptr) { Eigen::Matrix& _new_Dp_D_gyro_bias = (*new_Dp_D_gyro_bias); - _new_Dp_D_gyro_bias(0, 0) = DR_D_gyro_bias(0, 0) * _tmp314 + DR_D_gyro_bias(1, 0) * _tmp311 + - DR_D_gyro_bias(2, 0) * _tmp312 + Dp_D_gyro_bias(0, 0) + + _new_Dp_D_gyro_bias(0, 0) = DR_D_gyro_bias(0, 0) * _tmp191 + DR_D_gyro_bias(1, 0) * _tmp188 + + DR_D_gyro_bias(2, 0) * _tmp189 + Dp_D_gyro_bias(0, 0) + Dv_D_gyro_bias(0, 0) * dt; - _new_Dp_D_gyro_bias(1, 0) = DR_D_gyro_bias(0, 0) * _tmp324 + DR_D_gyro_bias(1, 0) * _tmp321 + - DR_D_gyro_bias(2, 0) * _tmp323 + Dp_D_gyro_bias(1, 0) + + _new_Dp_D_gyro_bias(1, 0) = DR_D_gyro_bias(0, 0) * _tmp201 + DR_D_gyro_bias(1, 0) * _tmp198 + + DR_D_gyro_bias(2, 0) * _tmp200 + Dp_D_gyro_bias(1, 0) + Dv_D_gyro_bias(1, 0) * dt; - _new_Dp_D_gyro_bias(2, 0) = DR_D_gyro_bias(0, 0) * _tmp334 + DR_D_gyro_bias(1, 0) * _tmp332 + - DR_D_gyro_bias(2, 0) * _tmp331 + Dp_D_gyro_bias(2, 0) + + _new_Dp_D_gyro_bias(2, 0) = DR_D_gyro_bias(0, 0) * _tmp211 + DR_D_gyro_bias(1, 0) * _tmp209 + + DR_D_gyro_bias(2, 0) * _tmp208 + Dp_D_gyro_bias(2, 0) + Dv_D_gyro_bias(2, 0) * dt; - _new_Dp_D_gyro_bias(0, 1) = DR_D_gyro_bias(0, 1) * _tmp314 + DR_D_gyro_bias(1, 1) * _tmp311 + - DR_D_gyro_bias(2, 1) * _tmp312 + Dp_D_gyro_bias(0, 1) + + _new_Dp_D_gyro_bias(0, 1) = DR_D_gyro_bias(0, 1) * _tmp191 + DR_D_gyro_bias(1, 1) * _tmp188 + + DR_D_gyro_bias(2, 1) * _tmp189 + Dp_D_gyro_bias(0, 1) + Dv_D_gyro_bias(0, 1) * dt; - _new_Dp_D_gyro_bias(1, 1) = DR_D_gyro_bias(0, 1) * _tmp324 + DR_D_gyro_bias(1, 1) * _tmp321 + - DR_D_gyro_bias(2, 1) * _tmp323 + Dp_D_gyro_bias(1, 1) + + _new_Dp_D_gyro_bias(1, 1) = DR_D_gyro_bias(0, 1) * _tmp201 + DR_D_gyro_bias(1, 1) * _tmp198 + + DR_D_gyro_bias(2, 1) * _tmp200 + Dp_D_gyro_bias(1, 1) + Dv_D_gyro_bias(1, 1) * dt; - _new_Dp_D_gyro_bias(2, 1) = DR_D_gyro_bias(0, 1) * _tmp334 + DR_D_gyro_bias(1, 1) * _tmp332 + - DR_D_gyro_bias(2, 1) * _tmp331 + Dp_D_gyro_bias(2, 1) + + _new_Dp_D_gyro_bias(2, 1) = DR_D_gyro_bias(0, 1) * _tmp211 + DR_D_gyro_bias(1, 1) * _tmp209 + + DR_D_gyro_bias(2, 1) * _tmp208 + Dp_D_gyro_bias(2, 1) + Dv_D_gyro_bias(2, 1) * dt; - _new_Dp_D_gyro_bias(0, 2) = DR_D_gyro_bias(0, 2) * _tmp314 + DR_D_gyro_bias(1, 2) * _tmp311 + - DR_D_gyro_bias(2, 2) * _tmp312 + Dp_D_gyro_bias(0, 2) + + _new_Dp_D_gyro_bias(0, 2) = DR_D_gyro_bias(0, 2) * _tmp191 + DR_D_gyro_bias(1, 2) * _tmp188 + + DR_D_gyro_bias(2, 2) * _tmp189 + Dp_D_gyro_bias(0, 2) + Dv_D_gyro_bias(0, 2) * dt; - _new_Dp_D_gyro_bias(1, 2) = DR_D_gyro_bias(0, 2) * _tmp324 + DR_D_gyro_bias(1, 2) * _tmp321 + - DR_D_gyro_bias(2, 2) * _tmp323 + Dp_D_gyro_bias(1, 2) + + _new_Dp_D_gyro_bias(1, 2) = DR_D_gyro_bias(0, 2) * _tmp201 + DR_D_gyro_bias(1, 2) * _tmp198 + + DR_D_gyro_bias(2, 2) * _tmp200 + Dp_D_gyro_bias(1, 2) + Dv_D_gyro_bias(1, 2) * dt; - _new_Dp_D_gyro_bias(2, 2) = DR_D_gyro_bias(0, 2) * _tmp334 + DR_D_gyro_bias(1, 2) * _tmp332 + - DR_D_gyro_bias(2, 2) * _tmp331 + Dp_D_gyro_bias(2, 2) + + _new_Dp_D_gyro_bias(2, 2) = DR_D_gyro_bias(0, 2) * _tmp211 + DR_D_gyro_bias(1, 2) * _tmp209 + + DR_D_gyro_bias(2, 2) * _tmp208 + Dp_D_gyro_bias(2, 2) + Dv_D_gyro_bias(2, 2) * dt; } } // NOLINT(readability/fn_size) diff --git a/symforce/slam/imu_preintegration/imu_preintegrator.h b/symforce/slam/imu_preintegration/imu_preintegrator.h index da9f6bfc..bfe261fc 100644 --- a/symforce/slam/imu_preintegration/imu_preintegrator.h +++ b/symforce/slam/imu_preintegration/imu_preintegrator.h @@ -42,12 +42,20 @@ class ImuPreintegrator { * @param measured_accel the next accelerometer measurement after the last integrated * measurement * @param measured_gyro the next gyroscope measurement after the last integrated measurement - * @param accel_cov the covariance of the accelerometer measurement (represented by its diagonal - * entries) `[(meters / time^2)^2 * time]` - * @param gyro_cov the covariance of the gyroscope measurement (represented by its diagonal - * entries) `[(radians / time)^2 * time]` + * @param accel_cov the noise spectral density of the accelerometer measurement (represented by + * its diagonal entries) `[(meters / time^2)^2 * time]`, i.e. the covariance of the + * measurement times dt + * @param gyro_cov the noise spectral density of the gyroscope measurement (represented by its + * diagonal entries) `[(radians / time)^2 * time]`, i.e. the covariance of the measurement + * times dt * @param dt the time span over which these measurements were made * + * The measurement noise is modeled as white noise acting over the whole time span dt, and its + * effect on the covariance is integrated in closed form over the span, holding the rotation at + * the start of the span fixed. The covariance is therefore positive definite after a single + * measurement. It is exact, and independent of how a window is divided into measurements, for a + * non-rotating body; with an angular rate omega it is accurate to first order in |omega| dt. + * * Postcondition: * * If the orientation, velocity, and position were R0, v0, and p0 at the start of the first diff --git a/symforce/slam/imu_preintegration/manifold_symbolic.py b/symforce/slam/imu_preintegration/manifold_symbolic.py index 0608887a..6f69e9e1 100644 --- a/symforce/slam/imu_preintegration/manifold_symbolic.py +++ b/symforce/slam/imu_preintegration/manifold_symbolic.py @@ -224,6 +224,92 @@ def handwritten_new_state_D_state_gyro_accel( return sf.M99(new_state_D_old_state), sf.M93(new_state_D_gyro), sf.M93(new_state_D_accel) +def step_noise_covariance( + DR: sf.Rot3, + corrected_accel: sf.V3, + accel_cov_diagonal: sf.V3, + gyro_cov_diagonal: sf.V3, + dt: T.Scalar, +) -> sf.M99: + """ + Calculates the covariance of the error that the gyroscope and accelerometer noise of a single + integration step adds to the new state (DR, Dv, Dp), in local coordinates of the new state. + + The noise is modeled as continuous-time white noise with the given spectral densities, acting + over the whole step, while the integrator holds the measurements and the rotation DR of the + start of the step constant (see :func:`integrate_state`). The linearized error state + ``(dR, dv, dp)`` then evolves within the step as:: + + d/dt [dR, dv, dp] = F [dR, dv, dp] + G [gyro_noise, accel_noise] + + F = [[0, 0, 0], G = [[I, 0], A = -R [corrected_accel]_x + [A, 0, 0], [0, R], + [0, I, 0]] [0, 0]] + + where ``R`` is the rotation matrix of DR. ``F`` is nilpotent (``F^3 = 0``), so the state + transition matrix over a time ``s`` is exactly ``Phi(s) = I + F s + F^2 s^2 / 2``, and the + covariance of the noise integrated over the step is, exactly:: + + Q = int_0^dt Phi(dt - tau) G Sigma G^T Phi(dt - tau)^T dtau + = sum_{i, j in 0..2} F^i (G Sigma G^T) (F^T)^j dt^(i + j + 1) / (i! j! (i + j + 1)) + + Written out by blocks, with ``Sg = diag(gyro_cov_diagonal)`` and + ``Sa = R diag(accel_cov_diagonal) R^T``:: + + Q_RR = Sg dt + Q_vR = A Sg dt^2 / 2 + Q_pR = A Sg dt^3 / 6 + Q_vv = Sa dt + A Sg A^T dt^3 / 3 + Q_pv = Sa dt^2 / 2 + A Sg A^T dt^4 / 8 + Q_pp = Sa dt^3 / 3 + A Sg A^T dt^5 / 20 + + The ``Sa`` terms are the familiar covariance of doubly integrated white noise, which is + positive definite for any ``dt > 0``. The ``A Sg`` terms are the rotation noise accumulated + during the step leaking into the velocity and position through the integrated acceleration. + + This is exact for a non-rotating body. Holding DR fixed within the step drops the + ``-[omega]_x dR`` term of the rotation-error dynamics (and the right Jacobian ``J_r(omega dt)`` + the discrete model applied to the gyro noise), so with an angular rate ``omega`` the step + covariance is accurate to first order in ``|omega| dt``. Likewise, the covariance of a window + does not depend on how it is divided into steps when the body does not rotate, and depends on + it only to that order otherwise. + + Args: + DR: Preintegrated DR at the start of the step + corrected_accel: Accelerometer measurement corrected for IMU bias + accel_cov_diagonal: Diagonal of the accelerometer noise spectral density + gyro_cov_diagonal: Diagonal of the gyroscope noise spectral density + dt: Duration of the step + + Returns: + sf.M99: The noise covariance to add to the propagated covariance of the new state + """ + R = DR.to_rotation_matrix() + A = -R * sf.Matrix.skew_symmetric(corrected_accel) + + gyro_cov = sf.M33.diag(gyro_cov_diagonal.to_flat_list()) + rotated_accel_cov = R * sf.M33.diag(accel_cov_diagonal.to_flat_list()) * R.T + A_gyro_cov = A * gyro_cov + A_gyro_cov_AT = A_gyro_cov * A.T + + Q_RR = gyro_cov * dt + Q_vR = A_gyro_cov * (dt**2 / 2) + Q_pR = A_gyro_cov * (dt**3 / 6) + Q_vv = rotated_accel_cov * dt + A_gyro_cov_AT * (dt**3 / 3) + Q_pv = rotated_accel_cov * (dt**2 / 2) + A_gyro_cov_AT * (dt**4 / 8) + Q_pp = rotated_accel_cov * (dt**3 / 3) + A_gyro_cov_AT * (dt**5 / 20) + + return sf.M99( + sf.Matrix.block_matrix( + [ + [Q_RR, Q_vR.T, Q_pR.T], + [Q_vR, Q_vv, Q_pv.T], + [Q_pR, Q_pv, Q_pp], + ] + ) + ) + + def imu_manifold_preintegration_update( # noqa: PLR0913, PLR0917 # Initial state DR: sf.Rot3, @@ -260,6 +346,13 @@ def imu_manifold_preintegration_update( # noqa: PLR0913, PLR0917 When integrating the first measurement, DR should be the identity, Dv, Dp, covariance, and the derivatives w.r.t. to bias should all be 0. + The measurement noise is modeled as continuous-time white noise acting over the whole step, + and its contribution to the covariance is integrated in closed form over the step, holding + the step's starting rotation fixed (see :func:`step_noise_covariance`). The covariance of a + window of measurements is therefore full rank even when the window consists of a single step. + It is exact, and does not depend on how the window is divided into steps, for a non-rotating + body; with an angular rate it is accurate to first order in the rotation per step. + Args: DR: Preintegrated change in orientation Dv: Preintegrated change in velocity @@ -272,8 +365,10 @@ def imu_manifold_preintegration_update( # noqa: PLR0913, PLR0917 Dp_D_gyro_bias: Derivative of Dp w.r.t. gyro_bias accel_bias: Initial guess for the accelerometer measurement bias gyro_bias: Initial guess for the gyroscope measurement bias - accel_cov_diagonal: The diagonal of the covariance of the accelerometer measurement - gyro_cov_diagonal: The diagonal of the covariance of the gyroscope measurement + accel_cov_diagonal: The diagonal of the noise spectral density of the accelerometer + measurement, i.e. the covariance of a measurement times the time it covers + gyro_cov_diagonal: The diagonal of the noise spectral density of the gyroscope + measurement, i.e. the covariance of a measurement times the time it covers accel_measurement: The accelerometer measurement gyro_measurement: The gyroscope measurement dt: The time between the new measurements and the last @@ -338,9 +433,13 @@ def new_state_D(wrt_variables: T.List[T.Any]) -> sf.Matrix: covariance = covariance.symmetric_copy(sf.Matrix.Triangle.LOWER) + # The noise of the step is modeled as white noise acting over the whole step, rather than as a + # perturbation of the held measurement, so its covariance is not expressible through + # new_state_D_gyro and new_state_D_accel; see step_noise_covariance for the derivation. new_covariance = new_state_D_state * covariance * new_state_D_state.T - new_covariance += new_state_D_gyro * sf.M.diag(gyro_cov_diagonal / dt) * new_state_D_gyro.T - new_covariance += new_state_D_accel * sf.M.diag(accel_cov_diagonal / dt) * new_state_D_accel.T + new_covariance += step_noise_covariance( + DR, corrected_accel, accel_cov_diagonal, gyro_cov_diagonal, dt + ) new_covariance = new_covariance.symmetric_copy(sf.Matrix.Triangle.LOWER) diff --git a/test/slam_imu_preintegration_test.cc b/test/slam_imu_preintegration_test.cc index 2dd1c784..6e113ad8 100644 --- a/test/slam_imu_preintegration_test.cc +++ b/test/slam_imu_preintegration_test.cc @@ -8,7 +8,9 @@ #include #include +#include #include +#include #include #include @@ -246,6 +248,134 @@ TEST_CASE("Test ImuPreintegrator.covariance", "[slam]") { CHECK(weighted_relative_error.maxCoeff() < 0.05); } +Eigen::Matrix3d SkewSymmetric(const Ref& v) { + Eigen::Matrix3d m; + m << 0, -v.z(), v.y(), v.z(), 0, -v.x(), -v.y(), v.x(), 0; + return m; +} + +/** + * The covariance that one integration step of duration dt adds to [DR, Dv, Dp], for white noise + * with the given spectral densities, held measurements, and the rotation held at DR over the step. + * This is the closed form documented in manifold_symbolic.py, written out block by block. + */ +Eigen::Matrix AnalyticStepNoiseCovariance(const Rot3d& DR, + const Ref& corrected_accel, + const Ref& accel_cov, + const Ref& gyro_cov, + const double dt) { + const Eigen::Matrix3d R = DR.ToRotationMatrix(); + const Eigen::Matrix3d A = -R * SkewSymmetric(corrected_accel); + const Eigen::Matrix3d Sg = gyro_cov.asDiagonal(); + const Eigen::Matrix3d Sa = R * accel_cov.asDiagonal() * R.transpose(); + const Eigen::Matrix3d ASg = A * Sg; + const Eigen::Matrix3d ASgAT = ASg * A.transpose(); + + Eigen::Matrix Q; + Q.block<3, 3>(0, 0) = Sg * dt; + Q.block<3, 3>(3, 0) = ASg * (dt * dt / 2); + Q.block<3, 3>(6, 0) = ASg * (dt * dt * dt / 6); + Q.block<3, 3>(3, 3) = Sa * dt + ASgAT * (dt * dt * dt / 3); + Q.block<3, 3>(6, 3) = Sa * (dt * dt / 2) + ASgAT * (dt * dt * dt * dt / 8); + Q.block<3, 3>(6, 6) = Sa * (dt * dt * dt / 3) + ASgAT * (dt * dt * dt * dt * dt / 20); + Q.block<3, 3>(0, 3) = Q.block<3, 3>(3, 0).transpose(); + Q.block<3, 3>(0, 6) = Q.block<3, 3>(6, 0).transpose(); + Q.block<3, 3>(3, 6) = Q.block<3, 3>(6, 3).transpose(); + return Q; +} + +TEST_CASE("Test ImuManifoldPreintegrationUpdate adds the analytic step noise covariance", + "[slam]") { + using M99 = Eigen::Matrix; + std::mt19937 gen(2718); + + for (int i_ = 0; i_ < 10; i_++) { + const sym::Rot3d DR = sym::Rot3d::Random(gen); + const Eigen::Vector3d Dv = sym::Random(gen); + const Eigen::Vector3d Dp = sym::Random(gen); + const Eigen::Vector3d accel = sym::Random(gen); + const Eigen::Vector3d gyro = sym::Random(gen); + const Eigen::Vector3d accel_bias = sym::Random(gen); + const Eigen::Vector3d gyro_bias = sym::Random(gen); + const Eigen::Vector3d accel_cov = sym::Random(gen).cwiseAbs(); + const Eigen::Vector3d gyro_cov = sym::Random(gen).cwiseAbs(); + const double dt = 0.37; + + // With zero input covariance, the output covariance is exactly the step's noise covariance + M99 new_covariance; + sym::ImuManifoldPreintegrationUpdate( + DR, Dv, Dp, M99::Zero(), Eigen::Matrix3d::Zero(), Eigen::Matrix3d::Zero(), + Eigen::Matrix3d::Zero(), Eigen::Matrix3d::Zero(), Eigen::Matrix3d::Zero(), accel_bias, + gyro_bias, accel_cov, gyro_cov, accel, gyro, dt, sym::kDefaultEpsilond, nullptr, nullptr, + nullptr, &new_covariance, nullptr, nullptr, nullptr, nullptr, nullptr); + + const M99 expected = + AnalyticStepNoiseCovariance(DR, accel - accel_bias, accel_cov, gyro_cov, dt); + const M99 symmetric_new_covariance = new_covariance.selfadjointView(); + CHECK(sym::IsClose(symmetric_new_covariance, expected, 1e-12 * expected.norm())); + } +} + +TEST_CASE("Test ImuPreintegrator covariance is positive definite after one measurement", "[slam]") { + using M99 = Eigen::Matrix; + const double dt = 5e-4; + + sym::ImuPreintegrator integrator(example::kAccelBias, example::kGyroBias); + integrator.IntegrateMeasurement(example::kAccelBias + example::kTrueAccel, + example::kGyroBias + example::kTrueGyro, example::kAccelCov, + example::kGyroCov, dt, sym::kDefaultEpsilond); + + const M99 covariance = integrator.Covariance().selfadjointView(); + const Eigen::LLT llt(covariance); + CHECK(llt.info() == Eigen::Success); + const Eigen::SelfAdjointEigenSolver eigensolver(covariance); + CHECK(eigensolver.eigenvalues().minCoeff() > 0.0); + + const M99 expected = AnalyticStepNoiseCovariance(sym::Rot3d::Identity(), example::kTrueAccel, + example::kAccelCov, example::kGyroCov, dt); + CHECK(sym::IsClose(covariance, expected, 1e-12 * expected.norm())); +} + +TEST_CASE("Test ImuPreintegrator covariance does not depend on the step subdivision", "[slam]") { + // With a held measurement, the integrated noise covariance of a window is the exact solution of + // the linearized continuous-time model, so it is the same whether the window is integrated as + // one step or as many. With no rotation rate this holds to machine precision; with rotation, + // the step's rotation is held at its start, so the results agree to O(|gyro| dt). + using M99 = Eigen::Matrix; + const double window = 0.2; + const Eigen::Vector3d accel_cov(0.06 * 0.06, 0.06 * 0.06, 0.06 * 0.06); + const Eigen::Vector3d gyro_cov(5e-4 * 5e-4, 5e-4 * 5e-4, 5e-4 * 5e-4); + const Eigen::Vector3d accel(0.4, -0.7, 9.81); + + const auto integrate = [&](const Eigen::Vector3d& gyro, const int steps) -> M99 { + sym::ImuPreintegrator integrator(Eigen::Vector3d::Zero(), Eigen::Vector3d::Zero()); + for (int k = 0; k < steps; k++) { + integrator.IntegrateMeasurement(accel, gyro, accel_cov, gyro_cov, window / steps, + sym::kDefaultEpsilond); + } + return integrator.Covariance().selfadjointView(); + }; + + { + const M99 one_step = integrate(Eigen::Vector3d::Zero(), 1); + const M99 expected = + AnalyticStepNoiseCovariance(sym::Rot3d::Identity(), accel, accel_cov, gyro_cov, window); + CHECK(sym::IsClose(one_step, expected, 1e-12 * expected.norm())); + for (const int steps : {2, 7, 40, 400}) { + const M99 many_steps = integrate(Eigen::Vector3d::Zero(), steps); + CAPTURE(steps); + CHECK(sym::IsClose(many_steps, one_step, 1e-10 * one_step.norm())); + } + } + + { + const Eigen::Vector3d gyro(0.3, -0.5, 0.4); + const M99 coarse = integrate(gyro, 40); + const M99 fine = integrate(gyro, 4000); + CHECK(sym::IsClose(coarse, fine, 1e-6 * fine.norm())); + } +} + TEST_CASE("Test preintegrated derivatives wrt IMU biases", "[slam]") { using M33 = Eigen::Matrix; using M96 = Eigen::Matrix; From c2c0632d72f9c5d1f5a56aa0048583a4aab49cd0 Mon Sep 17 00:00:00 2001 From: Philipp Foehn Date: Mon, 26 Oct 2026 08:31:55 +0000 Subject: [PATCH 53/68] [SkyMarshal] Support for precompiling Python LCM Types GitOrigin-RevId: baaeb152430a873c3ac1f70c94315ed4179eab7b --- .../skymarshal/skymarshal/emit_python.py | 54 +++++++++++++++++++ 1 file changed, 54 insertions(+) diff --git a/third_party/skymarshal/skymarshal/emit_python.py b/third_party/skymarshal/skymarshal/emit_python.py index a16667b7..5116b2d7 100644 --- a/third_party/skymarshal/skymarshal/emit_python.py +++ b/third_party/skymarshal/skymarshal/emit_python.py @@ -3,7 +3,10 @@ import argparse import copy +import importlib.util +import marshal import os +import sys import typing as T import zipfile from io import BytesIO @@ -23,6 +26,9 @@ ], ) +# PEP 552 flags of a hash-based pyc whose source hash the interpreter does not check. +PYC_FLAGS_UNCHECKED_HASH = 0b01 + TYPE_MAP = { "byte": TypeInfo("int", 0, "B", "B", 1), "boolean": TypeInfo("bool", False, "b", "b", 1), @@ -646,6 +652,11 @@ def add_args(cls, parser: argparse.ArgumentParser) -> None: parser.add_argument( "--python-zip-path", default=None, help="Zip all Python outputs and put them here" ) + parser.add_argument( + "--python-pyc", + action="store_true", + help="Also write the bytecode of each package module into the __pycache__ next to it", + ) @classmethod def create_module( @@ -709,6 +720,11 @@ def create_files( namespace_package=args.python_namespace_packages, ) + # The master package init is left out: it is usually a separately declared output, whose + # __pycache__ would land outside the declared output directories. + if args.python_pyc: + file_map.update(compile_pycs(file_map, args.python_path or os.curdir)) + if args.package_prefix: # Create an init for the master package init_path = os.path.join(args.python_path or "", "__init__.py") @@ -732,3 +748,41 @@ def create_files( file_map = {args.python_zip_path: data.getvalue()} return file_map + + +def compile_pycs(file_map: T.Mapping[str, str | bytes], python_path: str) -> dict[str, bytes]: + """ + Compile each Python source in file_map to the `__pycache__` path the interpreter loads it from. + + The bytecode is unchecked-hash based (PEP 552), so it stays valid regardless of the timestamps + the sources get once staged into runfiles. It matches the running interpreter's version, so it + is only picked up by an interpreter with the same cache tag. + + The filename recorded in the bytecode is relative to python_path, so identical sources compile + to identical bytecode wherever they are generated. The interpreter replaces it with the real + source path on import. + + Args: + file_map: Map from path to source of each Python module + python_path: Root directory of the Python outputs + + Returns: + Map from path to bytecode of each module's pyc + """ + pycs = {} + for path, source in file_map.items(): + source_bytes = source.encode("utf-8") if isinstance(source, str) else source + code = compile( + source_bytes, os.path.relpath(path, python_path), "exec", dont_inherit=True + ) + stem = os.path.splitext(os.path.basename(path))[0] + pyc_path = os.path.join( + os.path.dirname(path), "__pycache__", f"{stem}.{sys.implementation.cache_tag}.pyc" + ) + pycs[pyc_path] = ( + importlib.util.MAGIC_NUMBER + + PYC_FLAGS_UNCHECKED_HASH.to_bytes(4, "little") + + importlib.util.source_hash(source_bytes) + + marshal.dumps(code) + ) + return pycs From 6734d0c0609a8eafa4a8bef9c4031a64d5b862ee Mon Sep 17 00:00:00 2001 From: David Taylor Date: Tue, 27 Oct 2026 20:43:22 +0000 Subject: [PATCH 54/68] [SymForce] Update pinned dependencies GitOrigin-RevId: c2e7a8e5054391e66caca727bb173a1d404d1808 --- requirements/dev_py311.txt | 2 +- requirements/dev_py312.txt | 2 +- requirements/dev_py313.txt | 2 +- requirements/dev_py314.txt | 2 +- 4 files changed, 4 insertions(+), 4 deletions(-) diff --git a/requirements/dev_py311.txt b/requirements/dev_py311.txt index b1a90ce7..57d1f3c5 100644 --- a/requirements/dev_py311.txt +++ b/requirements/dev_py311.txt @@ -185,7 +185,7 @@ pathspec==1.0.4 # via mypy pexpect==4.9.0 # via ipython -pillow==12.3.0 +pillow==13.0.0 # via matplotlib pip==26.2 # via symforce (pyproject.toml) diff --git a/requirements/dev_py312.txt b/requirements/dev_py312.txt index 29b18698..8d80a746 100644 --- a/requirements/dev_py312.txt +++ b/requirements/dev_py312.txt @@ -185,7 +185,7 @@ pathspec==1.0.4 # via mypy pexpect==4.9.0 # via ipython -pillow==12.3.0 +pillow==13.0.0 # via matplotlib pip==26.2 # via symforce (pyproject.toml) diff --git a/requirements/dev_py313.txt b/requirements/dev_py313.txt index 875c3680..66e727dc 100644 --- a/requirements/dev_py313.txt +++ b/requirements/dev_py313.txt @@ -185,7 +185,7 @@ pathspec==1.0.4 # via mypy pexpect==4.9.0 # via ipython -pillow==12.3.0 +pillow==13.0.0 # via matplotlib pip==26.2 # via symforce (pyproject.toml) diff --git a/requirements/dev_py314.txt b/requirements/dev_py314.txt index e8c6c59d..b33983dd 100644 --- a/requirements/dev_py314.txt +++ b/requirements/dev_py314.txt @@ -185,7 +185,7 @@ pathspec==1.0.4 # via mypy pexpect==4.9.0 # via ipython -pillow==12.3.0 +pillow==13.0.0 # via matplotlib pip==26.2 # via symforce (pyproject.toml) From f54828d834a1ee12672a88555dc001d5c05a827c Mon Sep 17 00:00:00 2001 From: Jerry Date: Tue, 27 Oct 2026 22:51:47 +0000 Subject: [PATCH 55/68] skymarshal: Emit constexpr enum operators and struct constructors Generated LCM enums compared through plain inline operators and generated structs had a plain inline member constructor, so neither could take part in a constant expression. The enum comparison operators are now constexpr. The member constructor of a struct is constexpr when every member is a number, boolean, byte, enum or fixed-size array of those, including arrays stored inline with a capacity. Structs holding strings, dynamic arrays or other structs keep the inline constructor, because clang rejects a constexpr constructor that can never produce a constant expression. GitOrigin-RevId: 467f5c6531e64150914b3871eaef93beaa341390 --- .../lcmtypes/codegen_cpp_test/constants_t.hpp | 4 +-- .../constants_t.hpp | 4 +-- .../inputs_constants_t.hpp | 4 +-- .../outputs_2_t.hpp | 4 +-- .../codegen_python_test/constants_t.hpp | 4 +-- .../cpp/lcmtypes/sym/d_out_t.hpp | 4 +-- .../cpp/lcmtypes/sym/d_out_t.hpp | 4 +-- third_party/skymarshal/skymarshal/emit_cpp.py | 3 ++ .../skymarshal/skymarshal/skymarshal.py | 8 ++--- .../skymarshal/skymarshal/syntax_tree.py | 34 ++++++++++++++++++- .../templates/enumtype.hpp.template | 6 ++-- .../skymarshal/templates/lcmtype.hpp.template | 4 +-- 12 files changed, 57 insertions(+), 26 deletions(-) diff --git a/test/symforce_function_codegen_test_data/symengine/codegen_cpp_test_data/cpp/lcmtypes/codegen_cpp_test/constants_t.hpp b/test/symforce_function_codegen_test_data/symengine/codegen_cpp_test_data/cpp/lcmtypes/codegen_cpp_test/constants_t.hpp index b0dadd36..7677750f 100644 --- a/test/symforce_function_codegen_test_data/symengine/codegen_cpp_test_data/cpp/lcmtypes/codegen_cpp_test/constants_t.hpp +++ b/test/symforce_function_codegen_test_data/symengine/codegen_cpp_test_data/cpp/lcmtypes/codegen_cpp_test/constants_t.hpp @@ -32,7 +32,7 @@ class constants_t /** * Member constructor */ - inline constants_t( + constexpr constants_t( const double& epsilon_arg ); @@ -191,7 +191,7 @@ class constants_t #endif }; -constants_t::constants_t( +constexpr constants_t::constants_t( const double& epsilon_arg ) : epsilon(epsilon_arg) {} diff --git a/test/symforce_function_codegen_test_data/symengine/codegen_explicit_template_instantiation_test_data/cpp/lcmtypes/codegen_explicit_template_instantiation_test/constants_t.hpp b/test/symforce_function_codegen_test_data/symengine/codegen_explicit_template_instantiation_test_data/cpp/lcmtypes/codegen_explicit_template_instantiation_test/constants_t.hpp index 3f09315e..83913c99 100644 --- a/test/symforce_function_codegen_test_data/symengine/codegen_explicit_template_instantiation_test_data/cpp/lcmtypes/codegen_explicit_template_instantiation_test/constants_t.hpp +++ b/test/symforce_function_codegen_test_data/symengine/codegen_explicit_template_instantiation_test_data/cpp/lcmtypes/codegen_explicit_template_instantiation_test/constants_t.hpp @@ -32,7 +32,7 @@ class constants_t /** * Member constructor */ - inline constants_t( + constexpr constants_t( const double& epsilon_arg ); @@ -191,7 +191,7 @@ class constants_t #endif }; -constants_t::constants_t( +constexpr constants_t::constants_t( const double& epsilon_arg ) : epsilon(epsilon_arg) {} diff --git a/test/symforce_function_codegen_test_data/symengine/codegen_multi_function_test_data/cpp/lcmtypes/codegen_multi_function_test/inputs_constants_t.hpp b/test/symforce_function_codegen_test_data/symengine/codegen_multi_function_test_data/cpp/lcmtypes/codegen_multi_function_test/inputs_constants_t.hpp index 1274058c..c2baf398 100644 --- a/test/symforce_function_codegen_test_data/symengine/codegen_multi_function_test_data/cpp/lcmtypes/codegen_multi_function_test/inputs_constants_t.hpp +++ b/test/symforce_function_codegen_test_data/symengine/codegen_multi_function_test_data/cpp/lcmtypes/codegen_multi_function_test/inputs_constants_t.hpp @@ -32,7 +32,7 @@ class inputs_constants_t /** * Member constructor */ - inline inputs_constants_t( + constexpr inputs_constants_t( const double& epsilon_arg ); @@ -191,7 +191,7 @@ class inputs_constants_t #endif }; -inputs_constants_t::inputs_constants_t( +constexpr inputs_constants_t::inputs_constants_t( const double& epsilon_arg ) : epsilon(epsilon_arg) {} diff --git a/test/symforce_function_codegen_test_data/symengine/codegen_multi_function_test_data/cpp/lcmtypes/codegen_multi_function_test/outputs_2_t.hpp b/test/symforce_function_codegen_test_data/symengine/codegen_multi_function_test_data/cpp/lcmtypes/codegen_multi_function_test/outputs_2_t.hpp index 0bd32c96..e50c9b39 100644 --- a/test/symforce_function_codegen_test_data/symengine/codegen_multi_function_test_data/cpp/lcmtypes/codegen_multi_function_test/outputs_2_t.hpp +++ b/test/symforce_function_codegen_test_data/symengine/codegen_multi_function_test_data/cpp/lcmtypes/codegen_multi_function_test/outputs_2_t.hpp @@ -32,7 +32,7 @@ class outputs_2_t /** * Member constructor */ - inline outputs_2_t( + constexpr outputs_2_t( const double& foo_arg ); @@ -191,7 +191,7 @@ class outputs_2_t #endif }; -outputs_2_t::outputs_2_t( +constexpr outputs_2_t::outputs_2_t( const double& foo_arg ) : foo(foo_arg) {} diff --git a/test/symforce_function_codegen_test_data/symengine/codegen_python_test_data/cpp/lcmtypes/codegen_python_test/constants_t.hpp b/test/symforce_function_codegen_test_data/symengine/codegen_python_test_data/cpp/lcmtypes/codegen_python_test/constants_t.hpp index fcc7667c..eea5341e 100644 --- a/test/symforce_function_codegen_test_data/symengine/codegen_python_test_data/cpp/lcmtypes/codegen_python_test/constants_t.hpp +++ b/test/symforce_function_codegen_test_data/symengine/codegen_python_test_data/cpp/lcmtypes/codegen_python_test/constants_t.hpp @@ -32,7 +32,7 @@ class constants_t /** * Member constructor */ - inline constants_t( + constexpr constants_t( const double& epsilon_arg ); @@ -191,7 +191,7 @@ class constants_t #endif }; -constants_t::constants_t( +constexpr constants_t::constants_t( const double& epsilon_arg ) : epsilon(epsilon_arg) {} diff --git a/test/symforce_function_codegen_test_data/symengine/with_jacobians_values/cpp/lcmtypes/sym/d_out_t.hpp b/test/symforce_function_codegen_test_data/symengine/with_jacobians_values/cpp/lcmtypes/sym/d_out_t.hpp index 7b601a24..f2d8b373 100644 --- a/test/symforce_function_codegen_test_data/symengine/with_jacobians_values/cpp/lcmtypes/sym/d_out_t.hpp +++ b/test/symforce_function_codegen_test_data/symengine/with_jacobians_values/cpp/lcmtypes/sym/d_out_t.hpp @@ -34,7 +34,7 @@ class d_out_t /** * Member constructor */ - inline d_out_t( + constexpr d_out_t( const double& x_arg, const double& y_arg ); @@ -207,7 +207,7 @@ class d_out_t #endif }; -d_out_t::d_out_t( +constexpr d_out_t::d_out_t( const double& x_arg, const double& y_arg ) : x(x_arg), diff --git a/test/symforce_function_codegen_test_data/sympy/with_jacobians_values/cpp/lcmtypes/sym/d_out_t.hpp b/test/symforce_function_codegen_test_data/sympy/with_jacobians_values/cpp/lcmtypes/sym/d_out_t.hpp index 7b601a24..f2d8b373 100644 --- a/test/symforce_function_codegen_test_data/sympy/with_jacobians_values/cpp/lcmtypes/sym/d_out_t.hpp +++ b/test/symforce_function_codegen_test_data/sympy/with_jacobians_values/cpp/lcmtypes/sym/d_out_t.hpp @@ -34,7 +34,7 @@ class d_out_t /** * Member constructor */ - inline d_out_t( + constexpr d_out_t( const double& x_arg, const double& y_arg ); @@ -207,7 +207,7 @@ class d_out_t #endif }; -d_out_t::d_out_t( +constexpr d_out_t::d_out_t( const double& x_arg, const double& y_arg ) : x(x_arg), diff --git a/third_party/skymarshal/skymarshal/emit_cpp.py b/third_party/skymarshal/skymarshal/emit_cpp.py index 25592df6..60e035b3 100644 --- a/third_party/skymarshal/skymarshal/emit_cpp.py +++ b/third_party/skymarshal/skymarshal/emit_cpp.py @@ -333,6 +333,9 @@ def define_constants(self): def constructor_args(self): return ",\n".join(declare_member(member, "_arg", const_ref=True) for member in self.members) + def constructor_specifier(self): + return "constexpr" if self.struct.literal_type else "inline" + def initializers(self): return ",\n".join("{0}({0}_arg)".format(member.name) for member in self.members) diff --git a/third_party/skymarshal/skymarshal/skymarshal.py b/third_party/skymarshal/skymarshal/skymarshal.py index 424ecbb9..f16e3711 100644 --- a/third_party/skymarshal/skymarshal/skymarshal.py +++ b/third_party/skymarshal/skymarshal/skymarshal.py @@ -12,6 +12,7 @@ import sys import typing as T +from skymarshal import syntax_tree from skymarshal.language_plugin import SkymarshalLanguage from skymarshal.package_map import parse_lcmtypes @@ -115,12 +116,7 @@ def main( for full_name, hex_hash in json.load(f).items(): dep_hashes[full_name] = int(hex_hash, 16) - for t in type_map.values(): - t.recursive_hash = t.compute_recursive_hash(type_map, dep_hashes) - # Enum emitters operate on enum.equivalent_struct; mirror the hash there. - equivalent_struct = getattr(t, "equivalent_struct", None) - if equivalent_struct is not None: - equivalent_struct.recursive_hash = t.recursive_hash + syntax_tree.annotate_types(type_map, dep_hashes) files = {} diff --git a/third_party/skymarshal/skymarshal/syntax_tree.py b/third_party/skymarshal/skymarshal/syntax_tree.py index d3f71af6..f106583f 100644 --- a/third_party/skymarshal/skymarshal/syntax_tree.py +++ b/third_party/skymarshal/skymarshal/syntax_tree.py @@ -535,8 +535,9 @@ def __init__( self.type_ref = TypeRef(name) self.notations = list(notations) self.source_file: T.Optional[str] = None - # Populated by skymarshal.main after cross-package hashes are loaded. + # Populated by annotate_types after cross-package hashes are loaded. self.recursive_hash: int = 0 + self.literal_type: bool = False def set_source_file(self, source_file: str) -> None: self.source_file = source_file @@ -758,6 +759,37 @@ def compute_recursive_hash( h = (h + sub_hash) & 0xFFFFFFFFFFFFFFFF return ((h << 1) & 0xFFFFFFFFFFFFFFFF) | (h >> 63) + def is_literal_type(self, type_map: T.Mapping[str, T.Union[Struct, Enum]]) -> bool: + """Whether every member is a number, boolean, byte, enum or fixed-size array of those.""" + for member in self.members: + if isinstance(member, ConstMember): + continue + if isinstance(member, ArrayMember) and not ( + member.is_constant_size() or member.get_inline_capacity() is not None + ): + return False + type_ref = member.type_ref + if type_ref.is_primitive_type(): + if type_ref.name == "string": + return False + elif not isinstance(type_map.get(type_ref.full_name), Enum): + return False + return True + + +def annotate_types( + type_map: T.Mapping[str, T.Union[Struct, Enum]], dep_hashes: T.Mapping[str, int] +) -> None: + """Precomputes what emitters render as literals: recursive hashes and constexpr eligibility.""" + for t in type_map.values(): + t.recursive_hash = t.compute_recursive_hash(type_map, dep_hashes) + if isinstance(t, Struct): + t.literal_type = t.is_literal_type(type_map) + # Enum emitters operate on enum.equivalent_struct; mirror the hash there. + equivalent_struct = getattr(t, "equivalent_struct", None) + if equivalent_struct is not None: + equivalent_struct.recursive_hash = t.recursive_hash + class ReservedFieldGroup(AstNode): """A group of reserved field ids""" diff --git a/third_party/skymarshal/skymarshal/templates/enumtype.hpp.template b/third_party/skymarshal/skymarshal/templates/enumtype.hpp.template index 28482fc4..25b9691c 100644 --- a/third_party/skymarshal/skymarshal/templates/enumtype.hpp.template +++ b/third_party/skymarshal/skymarshal/templates/enumtype.hpp.template @@ -220,17 +220,17 @@ constexpr uint64_t {{enumtype.name}}::_computeHash(const __lcm_hash_ptr *) return {{ "0x%xULL" % enumtype.recursive_hash }}; } -inline bool operator==(const {{enumtype.name}}& a, const {{enumtype.name}}& b) +inline constexpr bool operator==(const {{enumtype.name}}& a, const {{enumtype.name}}& b) { return a.value == b.value; } -inline bool operator!=(const {{enumtype.name}}& a, const {{enumtype.name}}& b) +inline constexpr bool operator!=(const {{enumtype.name}}& a, const {{enumtype.name}}& b) { return !(a == b); } -inline bool operator<(const {{enumtype.name}}& a, const {{enumtype.name}}& b) +inline constexpr bool operator<(const {{enumtype.name}}& a, const {{enumtype.name}}& b) { return a.value < b.value; } diff --git a/third_party/skymarshal/skymarshal/templates/lcmtype.hpp.template b/third_party/skymarshal/skymarshal/templates/lcmtype.hpp.template index 96393e80..98ca5655 100644 --- a/third_party/skymarshal/skymarshal/templates/lcmtype.hpp.template +++ b/third_party/skymarshal/skymarshal/templates/lcmtype.hpp.template @@ -54,7 +54,7 @@ class {{lcmtype.name}} /** * Member constructor */ - inline {{lcmtype.name}}( + {{lcmtype.constructor_specifier()}} {{lcmtype.name}}( {{lcmtype.constructor_args()|indent(12)}} ); {% endif %} @@ -257,7 +257,7 @@ class {{lcmtype.name}} }; {% if lcmtype.members and not lcmtype.args.cpp_no_operators %} -{{lcmtype.name}}::{{lcmtype.name}}( +{% if lcmtype.constructor_specifier() == "constexpr" %}constexpr {% endif %}{{lcmtype.name}}::{{lcmtype.name}}( {{lcmtype.constructor_args()|indent(4)}} ) : {{lcmtype.initializers()|indent(4)}} {} {% endif %} From c693256f593b83366c104f0dc61df1d6559a310f Mon Sep 17 00:00:00 2001 From: Ankit Agarwal Date: Tue, 27 Oct 2026 22:53:03 +0000 Subject: [PATCH 56/68] [SymForce] Update pinned dependencies GitOrigin-RevId: cbbac47dbd097780d8660038c9690fb5ef504230 --- requirements/dev_py310.txt | 4 ++-- requirements/dev_py311.txt | 4 ++-- requirements/dev_py312.txt | 4 ++-- requirements/dev_py313.txt | 4 ++-- requirements/dev_py314.txt | 4 ++-- 5 files changed, 10 insertions(+), 10 deletions(-) diff --git a/requirements/dev_py310.txt b/requirements/dev_py310.txt index 96728e6e..e23995cf 100644 --- a/requirements/dev_py310.txt +++ b/requirements/dev_py310.txt @@ -24,7 +24,7 @@ bleach==6.4.0 # via nbconvert breathe==4.36.0 # via symforce (pyproject.toml) -certifi==2026.1.4 +certifi==2026.10.23 # via requests charset-normalizer==3.4.4 # via requests @@ -342,7 +342,7 @@ urllib3==2.8.0 # via # requests # types-requests -uv==0.11.15 +uv==0.13.6 # via symforce (pyproject.toml) wcwidth==0.6.0 # via prompt-toolkit diff --git a/requirements/dev_py311.txt b/requirements/dev_py311.txt index 57d1f3c5..d1c2cfa5 100644 --- a/requirements/dev_py311.txt +++ b/requirements/dev_py311.txt @@ -24,7 +24,7 @@ bleach==6.4.0 # via nbconvert breathe==4.36.0 # via symforce (pyproject.toml) -certifi==2026.1.4 +certifi==2026.10.23 # via requests charset-normalizer==3.4.4 # via requests @@ -334,7 +334,7 @@ urllib3==2.8.0 # via # requests # types-requests -uv==0.11.15 +uv==0.13.6 # via symforce (pyproject.toml) wcwidth==0.6.0 # via prompt-toolkit diff --git a/requirements/dev_py312.txt b/requirements/dev_py312.txt index 8d80a746..2ada67a4 100644 --- a/requirements/dev_py312.txt +++ b/requirements/dev_py312.txt @@ -24,7 +24,7 @@ bleach==6.4.0 # via nbconvert breathe==4.36.0 # via symforce (pyproject.toml) -certifi==2026.1.4 +certifi==2026.10.23 # via requests charset-normalizer==3.4.4 # via requests @@ -333,7 +333,7 @@ urllib3==2.8.0 # via # requests # types-requests -uv==0.11.15 +uv==0.13.6 # via symforce (pyproject.toml) wcwidth==0.6.0 # via prompt-toolkit diff --git a/requirements/dev_py313.txt b/requirements/dev_py313.txt index 66e727dc..390943ac 100644 --- a/requirements/dev_py313.txt +++ b/requirements/dev_py313.txt @@ -24,7 +24,7 @@ bleach==6.4.0 # via nbconvert breathe==4.36.0 # via symforce (pyproject.toml) -certifi==2026.1.4 +certifi==2026.10.23 # via requests charset-normalizer==3.4.4 # via requests @@ -332,7 +332,7 @@ urllib3==2.8.0 # via # requests # types-requests -uv==0.11.15 +uv==0.13.6 # via symforce (pyproject.toml) wcwidth==0.6.0 # via prompt-toolkit diff --git a/requirements/dev_py314.txt b/requirements/dev_py314.txt index b33983dd..7e7228d1 100644 --- a/requirements/dev_py314.txt +++ b/requirements/dev_py314.txt @@ -24,7 +24,7 @@ bleach==6.4.0 # via nbconvert breathe==4.36.0 # via symforce (pyproject.toml) -certifi==2026.1.4 +certifi==2026.10.23 # via requests charset-normalizer==3.4.4 # via requests @@ -336,7 +336,7 @@ urllib3==2.8.0 # via # requests # types-requests -uv==0.11.15 +uv==0.13.6 # via symforce (pyproject.toml) wcwidth==0.6.0 # via prompt-toolkit From db5c9f3e68bb0db4ded29464b66e83f3d4d5e644 Mon Sep 17 00:00:00 2001 From: Ankit Agarwal Date: Wed, 28 Oct 2026 22:17:41 +0000 Subject: [PATCH 57/68] [SymForce] Update pinned dependencies GitOrigin-RevId: f486c59314156fc43e8886a74f6d3e5a80182b5c --- requirements/dev_py310.txt | 2 +- requirements/dev_py311.txt | 2 +- requirements/dev_py312.txt | 2 +- requirements/dev_py313.txt | 2 +- requirements/dev_py314.txt | 2 +- 5 files changed, 5 insertions(+), 5 deletions(-) diff --git a/requirements/dev_py310.txt b/requirements/dev_py310.txt index e23995cf..52efdbbd 100644 --- a/requirements/dev_py310.txt +++ b/requirements/dev_py310.txt @@ -140,7 +140,7 @@ narwhals==2.16.0 # via plotly nbclient==0.10.4 # via nbconvert -nbconvert==7.17.1 +nbconvert==7.17.2 # via nbsphinx nbformat==5.10.4 # via diff --git a/requirements/dev_py311.txt b/requirements/dev_py311.txt index d1c2cfa5..ffc1102e 100644 --- a/requirements/dev_py311.txt +++ b/requirements/dev_py311.txt @@ -140,7 +140,7 @@ narwhals==2.16.0 # via plotly nbclient==0.10.4 # via nbconvert -nbconvert==7.17.1 +nbconvert==7.17.2 # via nbsphinx nbformat==5.10.4 # via diff --git a/requirements/dev_py312.txt b/requirements/dev_py312.txt index 2ada67a4..cade3d76 100644 --- a/requirements/dev_py312.txt +++ b/requirements/dev_py312.txt @@ -140,7 +140,7 @@ narwhals==2.16.0 # via plotly nbclient==0.10.4 # via nbconvert -nbconvert==7.17.1 +nbconvert==7.17.2 # via nbsphinx nbformat==5.10.4 # via diff --git a/requirements/dev_py313.txt b/requirements/dev_py313.txt index 390943ac..860ad314 100644 --- a/requirements/dev_py313.txt +++ b/requirements/dev_py313.txt @@ -140,7 +140,7 @@ narwhals==2.16.0 # via plotly nbclient==0.10.4 # via nbconvert -nbconvert==7.17.1 +nbconvert==7.17.2 # via nbsphinx nbformat==5.10.4 # via diff --git a/requirements/dev_py314.txt b/requirements/dev_py314.txt index 7e7228d1..054070ab 100644 --- a/requirements/dev_py314.txt +++ b/requirements/dev_py314.txt @@ -140,7 +140,7 @@ narwhals==2.16.0 # via plotly nbclient==0.10.4 # via nbconvert -nbconvert==7.17.1 +nbconvert==7.17.2 # via nbsphinx nbformat==5.10.4 # via From acdedd0bcfea11ee88e89908dd6499024dd9f89a Mon Sep 17 00:00:00 2001 From: Aaron Date: Thu, 29 Oct 2026 00:05:43 +0000 Subject: [PATCH 58/68] [SymForce] Make caspar expected values SymPy-version independent The expected values for the caspar backend coverage test were computed by substituting Python floats into SymPy expressions and calling `evalf(30)`. SymPy 1.14 rounds float arguments differently from 1.13, so the generated header differed in the last digit for several outputs, e.g. `(x + y)**2` at (1.6, 2.5) came out as 16.81 instead of 16.810000000000002. The pip wheel CI installs an unpinned SymPy and picked up 1.14, failing `symforce_caspar_codegen_test`. Substitute the exact values of the input doubles as rationals instead, so the result is the correctly rounded value at the double inputs regardless of SymPy version. This shifts eight expected values by about one ulp, well inside the 1e-12 relative tolerance of `caspar_backend_coverage_cuda_test`. This was tested by evaluating the new expressions under SymPy 1.13.3 and 1.14.0 and confirming identical output, and running `caspar_backend_coverage_cuda_test` (on a local GPU) and `symforce_caspar_codegen_test`, which passed. GitOrigin-RevId: e3e5ed95c5b84d5fc21dd53a640c4b1fca3ac34c --- test/symforce_caspar_codegen_test.py | 9 +++++++-- .../backend_test_function_expected.h | 14 +++++++------- 2 files changed, 14 insertions(+), 9 deletions(-) diff --git a/test/symforce_caspar_codegen_test.py b/test/symforce_caspar_codegen_test.py index b287eb5b..e7824349 100644 --- a/test/symforce_caspar_codegen_test.py +++ b/test/symforce_caspar_codegen_test.py @@ -146,8 +146,13 @@ def _backend_coverage_expected_header() -> str: outputs = _backend_coverage_outputs(x, y) def evaluate(expr: sf.Expr, x_value: float, y_value: float) -> str: - # SymEngine can't evalf every function here, so convert to SymPy. - value = complex(sympy.sympify(expr).subs({x: x_value, y: y_value}).evalf(30)) + # SymEngine can't evalf every function here, so convert to SymPy. Substitute the exact + # values of the doubles, since how SymPy rounds float arguments varies between versions. + value = complex( + sympy.sympify(expr) + .subs({x: sympy.Rational(x_value), y: sympy.Rational(y_value)}) + .evalf(30) + ) if value.imag != 0: return "kNaN" return repr(value.real) diff --git a/test/symforce_function_codegen_test_data/symengine/symforce_caspar_backend_coverage_test/backend_test_function_expected.h b/test/symforce_function_codegen_test_data/symengine/symforce_caspar_backend_coverage_test/backend_test_function_expected.h index cd995e16..934cb77d 100644 --- a/test/symforce_function_codegen_test_data/symengine/symforce_caspar_backend_coverage_test/backend_test_function_expected.h +++ b/test/symforce_function_codegen_test_data/symengine/symforce_caspar_backend_coverage_test/backend_test_function_expected.h @@ -49,7 +49,7 @@ constexpr double kExpected[kNumOutputs][kNumPoints] = { 0.5260775173811053}, // cos(x) {0.30933624960962325, 1.1383327132284393, -34.232532735557314, 0.058473854459578645, 1.6165614239934991}, // tan(x) - {0.30469265401539747, 1.015985293814825, kNaN, kNaN, kNaN}, // asin(x) + {0.3046926540153975, 1.015985293814825, kNaN, kNaN, kNaN}, // asin(x) {1.2661036727794992, 0.5548110329800715, kNaN, kNaN, kNaN}, // acos(x) {0.2914567944778671, 0.7044940642422177, 1.0121970114513341, 1.2679114584199251, 1.4346573659417559}, // atan(x) @@ -69,7 +69,7 @@ constexpr double kExpected[kNumOutputs][kNumPoints] = { 2.701851217221259}, // sqrt(x) {0.29567304756342244, 0.7712374333598078, 1.2489833279048763, 1.8798635843969098, 2.685680167776152}, // asinh(x) - {kNaN, kNaN, 1.0469679150031885, 1.8309380069269214, 2.676296855958175}, // acosh(x) + {kNaN, kNaN, 1.0469679150031885, 1.8309380069269217, 2.676296855958175}, // acosh(x) {0.3095196042031117, 1.2561528119880574, kNaN, kNaN, kNaN}, // atanh(x) {0.3, 0.85, 1.6, 3.2, 1.7999999999999998}, // x - 5.5*floor(0.181818181818182*x) {1.3, 1.85, 2.6, 4.2, 8.3}, // 1 + x @@ -93,17 +93,17 @@ constexpr double kExpected[kNumOutputs][kNumPoints] = { {0.3286267594591274, 0.7706680576083526, 0.976348383344644, 0.9999939742388483, 1.0}, // erf(x) {2.991568987687591, 1.1124837369484653, 0.8935153492876903, 2.4239654799353683, 1271.4236336639087}, // gamma(x) - {0.17467219900823971, 2.185459278717062, 0.5693131911006619, 1.9018924034990288, + {0.1746721990082397, 2.185459278717062, 0.5693131911006619, 1.9018924034990288, 1.516056546745016}, // atan2(x, y) {1.7, 0.85, 2.5, 3.2, 7.3}, // max(x, y) {0.3, -0.6, 1.6, -1.1, 0.4}, // min(x, y) - {0.3, -0.35, 1.6, -0.10000000000000009, 0.09999999999999964}, // x - y*floor(x/y) + {0.3, -0.35, 1.6, -0.10000000000000009, 0.09999999999999942}, // x - y*floor(x/y) {2.0, 0.25, 4.1, 2.1, 7.7}, // x + y {0.51, -0.51, 4.0, -3.5200000000000005, 2.92}, // x*y {0.12915348607498026, 1.1024239624913885, 3.238172324012421, 0.27818584240241323, - 2.214772610391266}, // x**y - {4.0, 0.0625, 16.810000000000002, 4.410000000000001, 59.28999999999999}, // (x + y)**2 - {8.0, 0.015625, 68.92100000000002, 9.261000000000003, 456.53299999999996}, // (x + y)**3 + 2.214772610391266}, // x**y + {4.0, 0.0625, 16.810000000000002, 4.41, 59.29}, // (x + y)**2 + {7.999999999999999, 0.015625, 68.921, 9.261000000000001, 456.53299999999996}, // (x + y)**3 {0.3, -0.85, 1.6, -3.2, 7.3}, // copysign_no_zero(x, y) }; From 38f16ea39b5e30daca70bb9da4d05cb3d01ce453 Mon Sep 17 00:00:00 2001 From: Jeff Daily Date: Wed, 4 Nov 2026 19:47:51 +0000 Subject: [PATCH 59/68] [ROCm] Map the CUDA calls used by the generated kernel launches Upstream now launches generated kernels with dynamic shared memory, opting in with cudaFuncSetAttribute(..., cudaFuncAttributeMaxDynamicSharedMemorySize, ...) when a kernel needs more than 48 KB, and the generated solver checks cudaGetDeviceCount. The HIP compatibility header did not map these, so generated code no longer compiled for ROCm. hipFuncSetAttribute only takes the kernel as const void*, while the CUDA runtime also accepts the kernel function itself, so the header adds a small template overload that casts it. Authored with Claude. Test Plan: Build the Caspar GPU tests (generated kernels and solvers checked into test/) for gfx90a and run them on an MI250X: ``` cmake -B build -DCMAKE_HIP_ARCHITECTURES=gfx90a -DCMAKE_PREFIX_PATH= cmake --build build --target bin.tests.caspar_padding_lane_cuda_test bin.tests.caspar_solver_cuda_test bin.tests.caspar_backend_coverage_cuda_test ./build/bin/tests/caspar_padding_lane_cuda_test ./build/bin/tests/caspar_solver_cuda_test ./build/bin/tests/caspar_backend_coverage_cuda_test ``` --- symforce/caspar/source/runtime/cuda_to_hip.h | 8 ++++++++ 1 file changed, 8 insertions(+) diff --git a/symforce/caspar/source/runtime/cuda_to_hip.h b/symforce/caspar/source/runtime/cuda_to_hip.h index 5fa7148f..e9141b2c 100644 --- a/symforce/caspar/source/runtime/cuda_to_hip.h +++ b/symforce/caspar/source/runtime/cuda_to_hip.h @@ -35,6 +35,14 @@ #define cudaGetDevice hipGetDevice #define cudaPointerGetAttributes hipPointerGetAttributes #define cudaPointerAttributes hipPointerAttribute_t +#define cudaGetDeviceCount hipGetDeviceCount +#define cudaFuncAttributeMaxDynamicSharedMemorySize hipFuncAttributeMaxDynamicSharedMemorySize + +// hipFuncSetAttribute takes the kernel as const void*; CUDA also accepts the kernel itself. +template +inline hipError_t cudaFuncSetAttribute(T* func, hipFuncAttribute attr, int value) { + return hipFuncSetAttribute(reinterpret_cast(func), attr, value); +} // HIP shared-memory atomics are block-scoped by definition (no inter-block visibility), // so atomicAdd_block is equivalent to atomicAdd on shared memory. From 1a984fc098e5992b5f6b05e047f04b2fbf97793e Mon Sep 17 00:00:00 2001 From: Jeff Daily Date: Wed, 4 Nov 2026 19:47:51 +0000 Subject: [PATCH 60/68] [ROCm] Drop the trailing SumStore barrier This reverts the trailing __syncthreads() added to SumStore in "[ROCm] Harden SumStore's shared scratch buffer reuse contract". That barrier was added for a gfx1151 report of NaN scores and run-to-run nondeterminism in solves, without a root-caused race. Upstream has since fixed the mechanism behind that symptom family in "[Caspar] Zero initialize caspar kernel registers" (#469): lanes past problem_size passed uninitialized registers to SumStore, and LLVM can drop the valid-lane mask. Uninitialized registers explain both the NaN and the run-to-run variation. With register zeroing in place, the barrier is not needed: - SumStore and SumFlushFinal open with a block-wide barrier, and every other store into the scratch buffer below element 32 comes from a lane of the tile that reads it. - On an MI250X (gfx90a), the padding-lane score kernel and the solver's alpha numerator/denominator kernel (two SumStore calls back to back into one buffer) give bit-identical per-block partial sums over 200 runs at sizes from 1000 to 1000003, with and without the barrier. With integer inputs, the alpha kernel's per-block sums equal an exact host reference in every run. - Without register zeroing, the padding-lane score is NaN at every size that leaves padding lanes, whether or not the barrier is present. So the barrier does not fix that defect either. Authored with Claude. Test Plan: Build upstream's checked-in kernels against memops.cuh with and without the barrier, with SumFlushFinal's atomicAdd replaced by a per-block store so cross-block float atomic ordering does not mask anything, and run each 200 times: ``` hipcc -x hip -std=c++17 -O3 -DUSE_HIP --offload-arch=gfx90a -I. -Iruntime main.cc kernel_caspar_padding_lane_score.cu runtime/shared_indices.cu -o padding_lane hipcc -x hip -std=c++17 -O3 -DUSE_HIP --offload-arch=gfx90a -I. -Iruntime main_alpha.cc kernel_Matrix21_alpha_numerator_denominator.cu -o alpha ./padding_lane 200 ./alpha 200 ``` --- symforce/caspar/source/runtime/memops.cuh | 4 ---- 1 file changed, 4 deletions(-) diff --git a/symforce/caspar/source/runtime/memops.cuh b/symforce/caspar/source/runtime/memops.cuh index 63d89de0..dcdd31f6 100644 --- a/symforce/caspar/source/runtime/memops.cuh +++ b/symforce/caspar/source/runtime/memops.cuh @@ -406,10 +406,6 @@ __forceinline__ __device__ void SumStore(StorageT* const shared_tmp, StorageT* c shared_tmp[offset] = tot; } } - // The second-stage tile reads inout_shared above; without a trailing barrier the - // buffer is not safe to reuse until the next block-wide sync, which callers were - // implicitly relied on to provide. - __syncthreads(); } template From 5256d2ada46e5244cd6b3fd0b2b7f43a435ef550 Mon Sep 17 00:00:00 2001 From: Jeff Daily Date: Wed, 4 Nov 2026 19:48:02 +0000 Subject: [PATCH 61/68] [ROCm] Regenerate the Caspar codegen test data for the HIP header The generated kernels and solvers include cuda_to_hip.h instead of the CUDA runtime and cooperative groups headers, so the code symforce_caspar_codegen_test checks in no longer matched what the templates generate. This regenerates it with the test's own --update; nothing was edited by hand. With USE_HIP unset, cuda_to_hip.h includes the same CUDA headers as before, so the CUDA build of this code is unchanged. Authored with Claude. Test Plan: ``` python test/symforce_caspar_codegen_test.py --update python test/symforce_caspar_codegen_test.py ``` --- .../kernel_backend_test_function.cu | 9 +-------- .../kernel_backend_test_function.h | 3 +-- .../kernel_caspar_padding_lane_score.cu | 9 +-------- .../kernel_caspar_padding_lane_score.h | 3 +-- .../symforce_caspar_solver_test/caspar_mappings.cu | 6 +----- .../symforce_caspar_solver_test/caspar_mappings.h | 2 +- ...ernel_Matrix21_alpha_denominator_or_beta_numerator.cu | 9 +-------- ...kernel_Matrix21_alpha_denominator_or_beta_numerator.h | 3 +-- .../kernel_Matrix21_alpha_numerator_denominator.cu | 9 +-------- .../kernel_Matrix21_alpha_numerator_denominator.h | 3 +-- .../kernel_Matrix21_normalize.cu | 9 +-------- .../kernel_Matrix21_normalize.h | 3 +-- .../kernel_Matrix21_pred_decrease_times_two.cu | 9 +-------- .../kernel_Matrix21_pred_decrease_times_two.h | 3 +-- .../kernel_Matrix21_retract.cu | 9 +-------- .../kernel_Matrix21_retract.h | 3 +-- .../kernel_Matrix21_start_w.cu | 9 +-------- .../kernel_Matrix21_start_w.h | 3 +-- .../kernel_Matrix21_start_w_contribute.cu | 9 +-------- .../kernel_Matrix21_start_w_contribute.h | 3 +-- .../kernel_Matrix21_update_Mp.cu | 9 +-------- .../kernel_Matrix21_update_Mp.h | 3 +-- .../kernel_Matrix21_update_p.cu | 9 +-------- .../kernel_Matrix21_update_p.h | 3 +-- .../kernel_Matrix21_update_r.cu | 9 +-------- .../kernel_Matrix21_update_r.h | 3 +-- .../kernel_Matrix21_update_r_first.cu | 9 +-------- .../kernel_Matrix21_update_r_first.h | 3 +-- .../kernel_Matrix21_update_step.cu | 9 +-------- .../kernel_Matrix21_update_step.h | 3 +-- .../kernel_Matrix21_update_step_first.cu | 9 +-------- .../kernel_Matrix21_update_step_first.h | 3 +-- .../kernel_rosenbrock_jtjnjtr_direct.cu | 9 +-------- .../kernel_rosenbrock_jtjnjtr_direct.h | 3 +-- .../kernel_rosenbrock_res_jac.cu | 9 +-------- .../kernel_rosenbrock_res_jac.h | 3 +-- .../kernel_rosenbrock_res_jac_first.cu | 9 +-------- .../kernel_rosenbrock_res_jac_first.h | 3 +-- .../kernel_rosenbrock_score.cu | 9 +-------- .../kernel_rosenbrock_score.h | 3 +-- .../symengine/symforce_caspar_solver_test/solver.h | 3 +-- .../symforce_caspar_tridiagonal_test/caspar_mappings.cu | 6 +----- .../symforce_caspar_tridiagonal_test/caspar_mappings.h | 2 +- .../kernel_ChainA_alpha_denominator_or_beta_numerator.cu | 9 +-------- .../kernel_ChainA_alpha_denominator_or_beta_numerator.h | 3 +-- .../kernel_ChainA_alpha_numerator_denominator.cu | 9 +-------- .../kernel_ChainA_alpha_numerator_denominator.h | 3 +-- .../kernel_ChainA_cyclic_reduction_down.cu | 9 +-------- .../kernel_ChainA_cyclic_reduction_down.h | 3 +-- .../kernel_ChainA_cyclic_reduction_solve_two.cu | 9 +-------- .../kernel_ChainA_cyclic_reduction_solve_two.h | 3 +-- .../kernel_ChainA_cyclic_reduction_up.cu | 9 +-------- .../kernel_ChainA_cyclic_reduction_up.h | 3 +-- .../kernel_ChainA_normalize.cu | 9 +-------- .../kernel_ChainA_normalize.h | 3 +-- .../kernel_ChainA_pred_decrease_times_two.cu | 9 +-------- .../kernel_ChainA_pred_decrease_times_two.h | 3 +-- .../kernel_ChainA_retract.cu | 9 +-------- .../kernel_ChainA_retract.h | 3 +-- .../kernel_ChainA_start_w.cu | 9 +-------- .../kernel_ChainA_start_w.h | 3 +-- .../kernel_ChainA_start_w_contribute.cu | 9 +-------- .../kernel_ChainA_start_w_contribute.h | 3 +-- .../kernel_ChainA_tridig_make_eq.cu | 9 +-------- .../kernel_ChainA_tridig_make_eq.h | 3 +-- .../kernel_ChainA_update_Mp.cu | 9 +-------- .../kernel_ChainA_update_Mp.h | 3 +-- .../kernel_ChainA_update_p.cu | 9 +-------- .../kernel_ChainA_update_p.h | 3 +-- .../kernel_ChainA_update_r.cu | 9 +-------- .../kernel_ChainA_update_r.h | 3 +-- .../kernel_ChainA_update_r_first.cu | 9 +-------- .../kernel_ChainA_update_r_first.h | 3 +-- .../kernel_ChainA_update_step.cu | 9 +-------- .../kernel_ChainA_update_step.h | 3 +-- .../kernel_ChainA_update_step_first.cu | 9 +-------- .../kernel_ChainA_update_step_first.h | 3 +-- .../kernel_ChainB_alpha_denominator_or_beta_numerator.cu | 9 +-------- .../kernel_ChainB_alpha_denominator_or_beta_numerator.h | 3 +-- .../kernel_ChainB_alpha_numerator_denominator.cu | 9 +-------- .../kernel_ChainB_alpha_numerator_denominator.h | 3 +-- .../kernel_ChainB_cyclic_reduction_down.cu | 9 +-------- .../kernel_ChainB_cyclic_reduction_down.h | 3 +-- .../kernel_ChainB_cyclic_reduction_solve_two.cu | 9 +-------- .../kernel_ChainB_cyclic_reduction_solve_two.h | 3 +-- .../kernel_ChainB_cyclic_reduction_up.cu | 9 +-------- .../kernel_ChainB_cyclic_reduction_up.h | 3 +-- .../kernel_ChainB_normalize.cu | 9 +-------- .../kernel_ChainB_normalize.h | 3 +-- .../kernel_ChainB_pred_decrease_times_two.cu | 9 +-------- .../kernel_ChainB_pred_decrease_times_two.h | 3 +-- .../kernel_ChainB_retract.cu | 9 +-------- .../kernel_ChainB_retract.h | 3 +-- .../kernel_ChainB_start_w.cu | 9 +-------- .../kernel_ChainB_start_w.h | 3 +-- .../kernel_ChainB_start_w_contribute.cu | 9 +-------- .../kernel_ChainB_start_w_contribute.h | 3 +-- .../kernel_ChainB_tridig_make_eq.cu | 9 +-------- .../kernel_ChainB_tridig_make_eq.h | 3 +-- .../kernel_ChainB_update_Mp.cu | 9 +-------- .../kernel_ChainB_update_Mp.h | 3 +-- .../kernel_ChainB_update_p.cu | 9 +-------- .../kernel_ChainB_update_p.h | 3 +-- .../kernel_ChainB_update_r.cu | 9 +-------- .../kernel_ChainB_update_r.h | 3 +-- .../kernel_ChainB_update_r_first.cu | 9 +-------- .../kernel_ChainB_update_r_first.h | 3 +-- .../kernel_ChainB_update_step.cu | 9 +-------- .../kernel_ChainB_update_step.h | 3 +-- .../kernel_ChainB_update_step_first.cu | 9 +-------- .../kernel_ChainB_update_step_first.h | 3 +-- .../kernel_chain_a_link_jtjnjtr_direct.cu | 9 +-------- .../kernel_chain_a_link_jtjnjtr_direct.h | 3 +-- .../kernel_chain_a_link_res_jac.cu | 9 +-------- .../kernel_chain_a_link_res_jac.h | 3 +-- .../kernel_chain_a_link_res_jac_first.cu | 9 +-------- .../kernel_chain_a_link_res_jac_first.h | 3 +-- .../kernel_chain_a_link_score.cu | 9 +-------- .../kernel_chain_a_link_score.h | 3 +-- .../kernel_chain_a_prior_jtjnjtr_direct.cu | 9 +-------- .../kernel_chain_a_prior_jtjnjtr_direct.h | 3 +-- .../kernel_chain_a_prior_res_jac.cu | 9 +-------- .../kernel_chain_a_prior_res_jac.h | 3 +-- .../kernel_chain_a_prior_res_jac_first.cu | 9 +-------- .../kernel_chain_a_prior_res_jac_first.h | 3 +-- .../kernel_chain_a_prior_score.cu | 9 +-------- .../kernel_chain_a_prior_score.h | 3 +-- .../kernel_chain_b_link_jtjnjtr_direct.cu | 9 +-------- .../kernel_chain_b_link_jtjnjtr_direct.h | 3 +-- .../kernel_chain_b_link_res_jac.cu | 9 +-------- .../kernel_chain_b_link_res_jac.h | 3 +-- .../kernel_chain_b_link_res_jac_first.cu | 9 +-------- .../kernel_chain_b_link_res_jac_first.h | 3 +-- .../kernel_chain_b_link_score.cu | 9 +-------- .../kernel_chain_b_link_score.h | 3 +-- .../kernel_chain_b_prior_jtjnjtr_direct.cu | 9 +-------- .../kernel_chain_b_prior_jtjnjtr_direct.h | 3 +-- .../kernel_chain_b_prior_res_jac.cu | 9 +-------- .../kernel_chain_b_prior_res_jac.h | 3 +-- .../kernel_chain_b_prior_res_jac_first.cu | 9 +-------- .../kernel_chain_b_prior_res_jac_first.h | 3 +-- .../kernel_chain_b_prior_score.cu | 9 +-------- .../kernel_chain_b_prior_score.h | 3 +-- .../kernel_chain_coupling_jtjnjtr_direct.cu | 9 +-------- .../kernel_chain_coupling_jtjnjtr_direct.h | 3 +-- .../kernel_chain_coupling_res_jac.cu | 9 +-------- .../kernel_chain_coupling_res_jac.h | 3 +-- .../kernel_chain_coupling_res_jac_first.cu | 9 +-------- .../kernel_chain_coupling_res_jac_first.h | 3 +-- .../kernel_chain_coupling_score.cu | 9 +-------- .../kernel_chain_coupling_score.h | 3 +-- .../symengine/symforce_caspar_tridiagonal_test/solver.h | 3 +-- 152 files changed, 152 insertions(+), 746 deletions(-) diff --git a/test/symforce_function_codegen_test_data/symengine/symforce_caspar_backend_coverage_test/kernel_backend_test_function.cu b/test/symforce_function_codegen_test_data/symengine/symforce_caspar_backend_coverage_test/kernel_backend_test_function.cu index 7827509c..6224331e 100644 --- a/test/symforce_function_codegen_test_data/symengine/symforce_caspar_backend_coverage_test/kernel_backend_test_function.cu +++ b/test/symforce_function_codegen_test_data/symengine/symforce_caspar_backend_coverage_test/kernel_backend_test_function.cu @@ -1,17 +1,10 @@ #include #include -#include -#include -#include -#include -#include - +#include "cuda_to_hip.h" #include "kernel_backend_test_function.h" #include "memops.cuh" -namespace cg = cooperative_groups; - namespace caspar { __global__ void __launch_bounds__(1024, 1) diff --git a/test/symforce_function_codegen_test_data/symengine/symforce_caspar_backend_coverage_test/kernel_backend_test_function.h b/test/symforce_function_codegen_test_data/symengine/symforce_caspar_backend_coverage_test/kernel_backend_test_function.h index 7f37a3b3..82ce6477 100644 --- a/test/symforce_function_codegen_test_data/symengine/symforce_caspar_backend_coverage_test/kernel_backend_test_function.h +++ b/test/symforce_function_codegen_test_data/symengine/symforce_caspar_backend_coverage_test/kernel_backend_test_function.h @@ -1,7 +1,6 @@ #pragma once -#include - +#include "cuda_to_hip.h" #include "shared_indices.h" namespace caspar { diff --git a/test/symforce_function_codegen_test_data/symengine/symforce_caspar_codegen_test/kernel_caspar_padding_lane_score.cu b/test/symforce_function_codegen_test_data/symengine/symforce_caspar_codegen_test/kernel_caspar_padding_lane_score.cu index 82e4d136..4ee6d7d5 100644 --- a/test/symforce_function_codegen_test_data/symengine/symforce_caspar_codegen_test/kernel_caspar_padding_lane_score.cu +++ b/test/symforce_function_codegen_test_data/symengine/symforce_caspar_codegen_test/kernel_caspar_padding_lane_score.cu @@ -1,17 +1,10 @@ #include #include -#include -#include -#include -#include -#include - +#include "cuda_to_hip.h" #include "kernel_caspar_padding_lane_score.h" #include "memops.cuh" -namespace cg = cooperative_groups; - namespace caspar { __global__ void __launch_bounds__(1024, 1) CasparPaddingLaneScoreKernel( diff --git a/test/symforce_function_codegen_test_data/symengine/symforce_caspar_codegen_test/kernel_caspar_padding_lane_score.h b/test/symforce_function_codegen_test_data/symengine/symforce_caspar_codegen_test/kernel_caspar_padding_lane_score.h index a78f744a..1c779f24 100644 --- a/test/symforce_function_codegen_test_data/symengine/symforce_caspar_codegen_test/kernel_caspar_padding_lane_score.h +++ b/test/symforce_function_codegen_test_data/symengine/symforce_caspar_codegen_test/kernel_caspar_padding_lane_score.h @@ -1,7 +1,6 @@ #pragma once -#include - +#include "cuda_to_hip.h" #include "shared_indices.h" namespace caspar { diff --git a/test/symforce_function_codegen_test_data/symengine/symforce_caspar_solver_test/caspar_mappings.cu b/test/symforce_function_codegen_test_data/symengine/symforce_caspar_solver_test/caspar_mappings.cu index 7edd0f2b..9c68da60 100644 --- a/test/symforce_function_codegen_test_data/symengine/symforce_caspar_solver_test/caspar_mappings.cu +++ b/test/symforce_function_codegen_test_data/symengine/symforce_caspar_solver_test/caspar_mappings.cu @@ -1,11 +1,7 @@ #include -#include -#include - #include "caspar_mappings.h" - -namespace cg = cooperative_groups; +#include "cuda_to_hip.h" // We use shared memory to improve the memory access. // A smaller block size of 32 allows for larger nodetypes. diff --git a/test/symforce_function_codegen_test_data/symengine/symforce_caspar_solver_test/caspar_mappings.h b/test/symforce_function_codegen_test_data/symengine/symforce_caspar_solver_test/caspar_mappings.h index 4b4c2719..ebe55ef9 100644 --- a/test/symforce_function_codegen_test_data/symengine/symforce_caspar_solver_test/caspar_mappings.h +++ b/test/symforce_function_codegen_test_data/symengine/symforce_caspar_solver_test/caspar_mappings.h @@ -1,6 +1,6 @@ #pragma once -#include +#include "cuda_to_hip.h" namespace caspar { diff --git a/test/symforce_function_codegen_test_data/symengine/symforce_caspar_solver_test/kernel_Matrix21_alpha_denominator_or_beta_numerator.cu b/test/symforce_function_codegen_test_data/symengine/symforce_caspar_solver_test/kernel_Matrix21_alpha_denominator_or_beta_numerator.cu index 1331046a..95c8344a 100644 --- a/test/symforce_function_codegen_test_data/symengine/symforce_caspar_solver_test/kernel_Matrix21_alpha_denominator_or_beta_numerator.cu +++ b/test/symforce_function_codegen_test_data/symengine/symforce_caspar_solver_test/kernel_Matrix21_alpha_denominator_or_beta_numerator.cu @@ -1,17 +1,10 @@ #include #include -#include -#include -#include -#include -#include - +#include "cuda_to_hip.h" #include "kernel_Matrix21_alpha_denominator_or_beta_numerator.h" #include "memops.cuh" -namespace cg = cooperative_groups; - namespace caspar { __global__ void __launch_bounds__(1024, 1) Matrix21AlphaDenominatorOrBetaNumeratorKernel( diff --git a/test/symforce_function_codegen_test_data/symengine/symforce_caspar_solver_test/kernel_Matrix21_alpha_denominator_or_beta_numerator.h b/test/symforce_function_codegen_test_data/symengine/symforce_caspar_solver_test/kernel_Matrix21_alpha_denominator_or_beta_numerator.h index fe955dba..7a3bbf55 100644 --- a/test/symforce_function_codegen_test_data/symengine/symforce_caspar_solver_test/kernel_Matrix21_alpha_denominator_or_beta_numerator.h +++ b/test/symforce_function_codegen_test_data/symengine/symforce_caspar_solver_test/kernel_Matrix21_alpha_denominator_or_beta_numerator.h @@ -1,7 +1,6 @@ #pragma once -#include - +#include "cuda_to_hip.h" #include "shared_indices.h" namespace caspar { diff --git a/test/symforce_function_codegen_test_data/symengine/symforce_caspar_solver_test/kernel_Matrix21_alpha_numerator_denominator.cu b/test/symforce_function_codegen_test_data/symengine/symforce_caspar_solver_test/kernel_Matrix21_alpha_numerator_denominator.cu index f90df48a..ea6c5e3c 100644 --- a/test/symforce_function_codegen_test_data/symengine/symforce_caspar_solver_test/kernel_Matrix21_alpha_numerator_denominator.cu +++ b/test/symforce_function_codegen_test_data/symengine/symforce_caspar_solver_test/kernel_Matrix21_alpha_numerator_denominator.cu @@ -1,17 +1,10 @@ #include #include -#include -#include -#include -#include -#include - +#include "cuda_to_hip.h" #include "kernel_Matrix21_alpha_numerator_denominator.h" #include "memops.cuh" -namespace cg = cooperative_groups; - namespace caspar { __global__ void __launch_bounds__(1024, 1) Matrix21AlphaNumeratorDenominatorKernel( diff --git a/test/symforce_function_codegen_test_data/symengine/symforce_caspar_solver_test/kernel_Matrix21_alpha_numerator_denominator.h b/test/symforce_function_codegen_test_data/symengine/symforce_caspar_solver_test/kernel_Matrix21_alpha_numerator_denominator.h index 863a162c..7e9a4fb2 100644 --- a/test/symforce_function_codegen_test_data/symengine/symforce_caspar_solver_test/kernel_Matrix21_alpha_numerator_denominator.h +++ b/test/symforce_function_codegen_test_data/symengine/symforce_caspar_solver_test/kernel_Matrix21_alpha_numerator_denominator.h @@ -1,7 +1,6 @@ #pragma once -#include - +#include "cuda_to_hip.h" #include "shared_indices.h" namespace caspar { diff --git a/test/symforce_function_codegen_test_data/symengine/symforce_caspar_solver_test/kernel_Matrix21_normalize.cu b/test/symforce_function_codegen_test_data/symengine/symforce_caspar_solver_test/kernel_Matrix21_normalize.cu index 65302139..7ff9c296 100644 --- a/test/symforce_function_codegen_test_data/symengine/symforce_caspar_solver_test/kernel_Matrix21_normalize.cu +++ b/test/symforce_function_codegen_test_data/symengine/symforce_caspar_solver_test/kernel_Matrix21_normalize.cu @@ -1,17 +1,10 @@ #include #include -#include -#include -#include -#include -#include - +#include "cuda_to_hip.h" #include "kernel_Matrix21_normalize.h" #include "memops.cuh" -namespace cg = cooperative_groups; - namespace caspar { __global__ void __launch_bounds__(1024, 1) diff --git a/test/symforce_function_codegen_test_data/symengine/symforce_caspar_solver_test/kernel_Matrix21_normalize.h b/test/symforce_function_codegen_test_data/symengine/symforce_caspar_solver_test/kernel_Matrix21_normalize.h index c6db2e2f..7b39f71c 100644 --- a/test/symforce_function_codegen_test_data/symengine/symforce_caspar_solver_test/kernel_Matrix21_normalize.h +++ b/test/symforce_function_codegen_test_data/symengine/symforce_caspar_solver_test/kernel_Matrix21_normalize.h @@ -1,7 +1,6 @@ #pragma once -#include - +#include "cuda_to_hip.h" #include "shared_indices.h" namespace caspar { diff --git a/test/symforce_function_codegen_test_data/symengine/symforce_caspar_solver_test/kernel_Matrix21_pred_decrease_times_two.cu b/test/symforce_function_codegen_test_data/symengine/symforce_caspar_solver_test/kernel_Matrix21_pred_decrease_times_two.cu index 44488925..fc96efd7 100644 --- a/test/symforce_function_codegen_test_data/symengine/symforce_caspar_solver_test/kernel_Matrix21_pred_decrease_times_two.cu +++ b/test/symforce_function_codegen_test_data/symengine/symforce_caspar_solver_test/kernel_Matrix21_pred_decrease_times_two.cu @@ -1,17 +1,10 @@ #include #include -#include -#include -#include -#include -#include - +#include "cuda_to_hip.h" #include "kernel_Matrix21_pred_decrease_times_two.h" #include "memops.cuh" -namespace cg = cooperative_groups; - namespace caspar { __global__ void __launch_bounds__(1024, 1) diff --git a/test/symforce_function_codegen_test_data/symengine/symforce_caspar_solver_test/kernel_Matrix21_pred_decrease_times_two.h b/test/symforce_function_codegen_test_data/symengine/symforce_caspar_solver_test/kernel_Matrix21_pred_decrease_times_two.h index 4e8ad4e1..1ee881bc 100644 --- a/test/symforce_function_codegen_test_data/symengine/symforce_caspar_solver_test/kernel_Matrix21_pred_decrease_times_two.h +++ b/test/symforce_function_codegen_test_data/symengine/symforce_caspar_solver_test/kernel_Matrix21_pred_decrease_times_two.h @@ -1,7 +1,6 @@ #pragma once -#include - +#include "cuda_to_hip.h" #include "shared_indices.h" namespace caspar { diff --git a/test/symforce_function_codegen_test_data/symengine/symforce_caspar_solver_test/kernel_Matrix21_retract.cu b/test/symforce_function_codegen_test_data/symengine/symforce_caspar_solver_test/kernel_Matrix21_retract.cu index 14e7d572..318990d6 100644 --- a/test/symforce_function_codegen_test_data/symengine/symforce_caspar_solver_test/kernel_Matrix21_retract.cu +++ b/test/symforce_function_codegen_test_data/symengine/symforce_caspar_solver_test/kernel_Matrix21_retract.cu @@ -1,17 +1,10 @@ #include #include -#include -#include -#include -#include -#include - +#include "cuda_to_hip.h" #include "kernel_Matrix21_retract.h" #include "memops.cuh" -namespace cg = cooperative_groups; - namespace caspar { __global__ void __launch_bounds__(1024, 1) diff --git a/test/symforce_function_codegen_test_data/symengine/symforce_caspar_solver_test/kernel_Matrix21_retract.h b/test/symforce_function_codegen_test_data/symengine/symforce_caspar_solver_test/kernel_Matrix21_retract.h index 1219c59d..5c0eb51a 100644 --- a/test/symforce_function_codegen_test_data/symengine/symforce_caspar_solver_test/kernel_Matrix21_retract.h +++ b/test/symforce_function_codegen_test_data/symengine/symforce_caspar_solver_test/kernel_Matrix21_retract.h @@ -1,7 +1,6 @@ #pragma once -#include - +#include "cuda_to_hip.h" #include "shared_indices.h" namespace caspar { diff --git a/test/symforce_function_codegen_test_data/symengine/symforce_caspar_solver_test/kernel_Matrix21_start_w.cu b/test/symforce_function_codegen_test_data/symengine/symforce_caspar_solver_test/kernel_Matrix21_start_w.cu index 1a370cb0..f0cfdd0a 100644 --- a/test/symforce_function_codegen_test_data/symengine/symforce_caspar_solver_test/kernel_Matrix21_start_w.cu +++ b/test/symforce_function_codegen_test_data/symengine/symforce_caspar_solver_test/kernel_Matrix21_start_w.cu @@ -1,17 +1,10 @@ #include #include -#include -#include -#include -#include -#include - +#include "cuda_to_hip.h" #include "kernel_Matrix21_start_w.h" #include "memops.cuh" -namespace cg = cooperative_groups; - namespace caspar { __global__ void __launch_bounds__(1024, 1) diff --git a/test/symforce_function_codegen_test_data/symengine/symforce_caspar_solver_test/kernel_Matrix21_start_w.h b/test/symforce_function_codegen_test_data/symengine/symforce_caspar_solver_test/kernel_Matrix21_start_w.h index fa1e7963..f34294fc 100644 --- a/test/symforce_function_codegen_test_data/symengine/symforce_caspar_solver_test/kernel_Matrix21_start_w.h +++ b/test/symforce_function_codegen_test_data/symengine/symforce_caspar_solver_test/kernel_Matrix21_start_w.h @@ -1,7 +1,6 @@ #pragma once -#include - +#include "cuda_to_hip.h" #include "shared_indices.h" namespace caspar { diff --git a/test/symforce_function_codegen_test_data/symengine/symforce_caspar_solver_test/kernel_Matrix21_start_w_contribute.cu b/test/symforce_function_codegen_test_data/symengine/symforce_caspar_solver_test/kernel_Matrix21_start_w_contribute.cu index 95c95c4c..ce0d8a0d 100644 --- a/test/symforce_function_codegen_test_data/symengine/symforce_caspar_solver_test/kernel_Matrix21_start_w_contribute.cu +++ b/test/symforce_function_codegen_test_data/symengine/symforce_caspar_solver_test/kernel_Matrix21_start_w_contribute.cu @@ -1,17 +1,10 @@ #include #include -#include -#include -#include -#include -#include - +#include "cuda_to_hip.h" #include "kernel_Matrix21_start_w_contribute.h" #include "memops.cuh" -namespace cg = cooperative_groups; - namespace caspar { __global__ void __launch_bounds__(1024, 1) diff --git a/test/symforce_function_codegen_test_data/symengine/symforce_caspar_solver_test/kernel_Matrix21_start_w_contribute.h b/test/symforce_function_codegen_test_data/symengine/symforce_caspar_solver_test/kernel_Matrix21_start_w_contribute.h index 67a41b95..f5de02be 100644 --- a/test/symforce_function_codegen_test_data/symengine/symforce_caspar_solver_test/kernel_Matrix21_start_w_contribute.h +++ b/test/symforce_function_codegen_test_data/symengine/symforce_caspar_solver_test/kernel_Matrix21_start_w_contribute.h @@ -1,7 +1,6 @@ #pragma once -#include - +#include "cuda_to_hip.h" #include "shared_indices.h" namespace caspar { diff --git a/test/symforce_function_codegen_test_data/symengine/symforce_caspar_solver_test/kernel_Matrix21_update_Mp.cu b/test/symforce_function_codegen_test_data/symengine/symforce_caspar_solver_test/kernel_Matrix21_update_Mp.cu index 49611002..dcb0c2ca 100644 --- a/test/symforce_function_codegen_test_data/symengine/symforce_caspar_solver_test/kernel_Matrix21_update_Mp.cu +++ b/test/symforce_function_codegen_test_data/symengine/symforce_caspar_solver_test/kernel_Matrix21_update_Mp.cu @@ -1,17 +1,10 @@ #include #include -#include -#include -#include -#include -#include - +#include "cuda_to_hip.h" #include "kernel_Matrix21_update_Mp.h" #include "memops.cuh" -namespace cg = cooperative_groups; - namespace caspar { __global__ void __launch_bounds__(1024, 1) diff --git a/test/symforce_function_codegen_test_data/symengine/symforce_caspar_solver_test/kernel_Matrix21_update_Mp.h b/test/symforce_function_codegen_test_data/symengine/symforce_caspar_solver_test/kernel_Matrix21_update_Mp.h index 4e3352d5..28a45178 100644 --- a/test/symforce_function_codegen_test_data/symengine/symforce_caspar_solver_test/kernel_Matrix21_update_Mp.h +++ b/test/symforce_function_codegen_test_data/symengine/symforce_caspar_solver_test/kernel_Matrix21_update_Mp.h @@ -1,7 +1,6 @@ #pragma once -#include - +#include "cuda_to_hip.h" #include "shared_indices.h" namespace caspar { diff --git a/test/symforce_function_codegen_test_data/symengine/symforce_caspar_solver_test/kernel_Matrix21_update_p.cu b/test/symforce_function_codegen_test_data/symengine/symforce_caspar_solver_test/kernel_Matrix21_update_p.cu index eee35a76..4b7ca93b 100644 --- a/test/symforce_function_codegen_test_data/symengine/symforce_caspar_solver_test/kernel_Matrix21_update_p.cu +++ b/test/symforce_function_codegen_test_data/symengine/symforce_caspar_solver_test/kernel_Matrix21_update_p.cu @@ -1,17 +1,10 @@ #include #include -#include -#include -#include -#include -#include - +#include "cuda_to_hip.h" #include "kernel_Matrix21_update_p.h" #include "memops.cuh" -namespace cg = cooperative_groups; - namespace caspar { __global__ void __launch_bounds__(1024, 1) diff --git a/test/symforce_function_codegen_test_data/symengine/symforce_caspar_solver_test/kernel_Matrix21_update_p.h b/test/symforce_function_codegen_test_data/symengine/symforce_caspar_solver_test/kernel_Matrix21_update_p.h index a6ea4824..847f2b40 100644 --- a/test/symforce_function_codegen_test_data/symengine/symforce_caspar_solver_test/kernel_Matrix21_update_p.h +++ b/test/symforce_function_codegen_test_data/symengine/symforce_caspar_solver_test/kernel_Matrix21_update_p.h @@ -1,7 +1,6 @@ #pragma once -#include - +#include "cuda_to_hip.h" #include "shared_indices.h" namespace caspar { diff --git a/test/symforce_function_codegen_test_data/symengine/symforce_caspar_solver_test/kernel_Matrix21_update_r.cu b/test/symforce_function_codegen_test_data/symengine/symforce_caspar_solver_test/kernel_Matrix21_update_r.cu index 2dca6a4e..83b4dd6c 100644 --- a/test/symforce_function_codegen_test_data/symengine/symforce_caspar_solver_test/kernel_Matrix21_update_r.cu +++ b/test/symforce_function_codegen_test_data/symengine/symforce_caspar_solver_test/kernel_Matrix21_update_r.cu @@ -1,17 +1,10 @@ #include #include -#include -#include -#include -#include -#include - +#include "cuda_to_hip.h" #include "kernel_Matrix21_update_r.h" #include "memops.cuh" -namespace cg = cooperative_groups; - namespace caspar { __global__ void __launch_bounds__(1024, 1) diff --git a/test/symforce_function_codegen_test_data/symengine/symforce_caspar_solver_test/kernel_Matrix21_update_r.h b/test/symforce_function_codegen_test_data/symengine/symforce_caspar_solver_test/kernel_Matrix21_update_r.h index 33ce7fea..2ae46944 100644 --- a/test/symforce_function_codegen_test_data/symengine/symforce_caspar_solver_test/kernel_Matrix21_update_r.h +++ b/test/symforce_function_codegen_test_data/symengine/symforce_caspar_solver_test/kernel_Matrix21_update_r.h @@ -1,7 +1,6 @@ #pragma once -#include - +#include "cuda_to_hip.h" #include "shared_indices.h" namespace caspar { diff --git a/test/symforce_function_codegen_test_data/symengine/symforce_caspar_solver_test/kernel_Matrix21_update_r_first.cu b/test/symforce_function_codegen_test_data/symengine/symforce_caspar_solver_test/kernel_Matrix21_update_r_first.cu index 9519aa50..2908c211 100644 --- a/test/symforce_function_codegen_test_data/symengine/symforce_caspar_solver_test/kernel_Matrix21_update_r_first.cu +++ b/test/symforce_function_codegen_test_data/symengine/symforce_caspar_solver_test/kernel_Matrix21_update_r_first.cu @@ -1,17 +1,10 @@ #include #include -#include -#include -#include -#include -#include - +#include "cuda_to_hip.h" #include "kernel_Matrix21_update_r_first.h" #include "memops.cuh" -namespace cg = cooperative_groups; - namespace caspar { __global__ void __launch_bounds__(1024, 1) diff --git a/test/symforce_function_codegen_test_data/symengine/symforce_caspar_solver_test/kernel_Matrix21_update_r_first.h b/test/symforce_function_codegen_test_data/symengine/symforce_caspar_solver_test/kernel_Matrix21_update_r_first.h index 24f801d0..1e869640 100644 --- a/test/symforce_function_codegen_test_data/symengine/symforce_caspar_solver_test/kernel_Matrix21_update_r_first.h +++ b/test/symforce_function_codegen_test_data/symengine/symforce_caspar_solver_test/kernel_Matrix21_update_r_first.h @@ -1,7 +1,6 @@ #pragma once -#include - +#include "cuda_to_hip.h" #include "shared_indices.h" namespace caspar { diff --git a/test/symforce_function_codegen_test_data/symengine/symforce_caspar_solver_test/kernel_Matrix21_update_step.cu b/test/symforce_function_codegen_test_data/symengine/symforce_caspar_solver_test/kernel_Matrix21_update_step.cu index fdcbc605..b0387b24 100644 --- a/test/symforce_function_codegen_test_data/symengine/symforce_caspar_solver_test/kernel_Matrix21_update_step.cu +++ b/test/symforce_function_codegen_test_data/symengine/symforce_caspar_solver_test/kernel_Matrix21_update_step.cu @@ -1,17 +1,10 @@ #include #include -#include -#include -#include -#include -#include - +#include "cuda_to_hip.h" #include "kernel_Matrix21_update_step.h" #include "memops.cuh" -namespace cg = cooperative_groups; - namespace caspar { __global__ void __launch_bounds__(1024, 1) diff --git a/test/symforce_function_codegen_test_data/symengine/symforce_caspar_solver_test/kernel_Matrix21_update_step.h b/test/symforce_function_codegen_test_data/symengine/symforce_caspar_solver_test/kernel_Matrix21_update_step.h index e1709af9..b0a2ceb5 100644 --- a/test/symforce_function_codegen_test_data/symengine/symforce_caspar_solver_test/kernel_Matrix21_update_step.h +++ b/test/symforce_function_codegen_test_data/symengine/symforce_caspar_solver_test/kernel_Matrix21_update_step.h @@ -1,7 +1,6 @@ #pragma once -#include - +#include "cuda_to_hip.h" #include "shared_indices.h" namespace caspar { diff --git a/test/symforce_function_codegen_test_data/symengine/symforce_caspar_solver_test/kernel_Matrix21_update_step_first.cu b/test/symforce_function_codegen_test_data/symengine/symforce_caspar_solver_test/kernel_Matrix21_update_step_first.cu index 7bf44110..498da5b0 100644 --- a/test/symforce_function_codegen_test_data/symengine/symforce_caspar_solver_test/kernel_Matrix21_update_step_first.cu +++ b/test/symforce_function_codegen_test_data/symengine/symforce_caspar_solver_test/kernel_Matrix21_update_step_first.cu @@ -1,17 +1,10 @@ #include #include -#include -#include -#include -#include -#include - +#include "cuda_to_hip.h" #include "kernel_Matrix21_update_step_first.h" #include "memops.cuh" -namespace cg = cooperative_groups; - namespace caspar { __global__ void __launch_bounds__(1024, 1) diff --git a/test/symforce_function_codegen_test_data/symengine/symforce_caspar_solver_test/kernel_Matrix21_update_step_first.h b/test/symforce_function_codegen_test_data/symengine/symforce_caspar_solver_test/kernel_Matrix21_update_step_first.h index bbf51fa9..4f1ae077 100644 --- a/test/symforce_function_codegen_test_data/symengine/symforce_caspar_solver_test/kernel_Matrix21_update_step_first.h +++ b/test/symforce_function_codegen_test_data/symengine/symforce_caspar_solver_test/kernel_Matrix21_update_step_first.h @@ -1,7 +1,6 @@ #pragma once -#include - +#include "cuda_to_hip.h" #include "shared_indices.h" namespace caspar { diff --git a/test/symforce_function_codegen_test_data/symengine/symforce_caspar_solver_test/kernel_rosenbrock_jtjnjtr_direct.cu b/test/symforce_function_codegen_test_data/symengine/symforce_caspar_solver_test/kernel_rosenbrock_jtjnjtr_direct.cu index 956e7b88..df820641 100644 --- a/test/symforce_function_codegen_test_data/symengine/symforce_caspar_solver_test/kernel_rosenbrock_jtjnjtr_direct.cu +++ b/test/symforce_function_codegen_test_data/symengine/symforce_caspar_solver_test/kernel_rosenbrock_jtjnjtr_direct.cu @@ -1,17 +1,10 @@ #include #include -#include -#include -#include -#include -#include - +#include "cuda_to_hip.h" #include "kernel_rosenbrock_jtjnjtr_direct.h" #include "memops.cuh" -namespace cg = cooperative_groups; - namespace caspar { __global__ void __launch_bounds__(1024, 1) diff --git a/test/symforce_function_codegen_test_data/symengine/symforce_caspar_solver_test/kernel_rosenbrock_jtjnjtr_direct.h b/test/symforce_function_codegen_test_data/symengine/symforce_caspar_solver_test/kernel_rosenbrock_jtjnjtr_direct.h index f0556d5f..1af63135 100644 --- a/test/symforce_function_codegen_test_data/symengine/symforce_caspar_solver_test/kernel_rosenbrock_jtjnjtr_direct.h +++ b/test/symforce_function_codegen_test_data/symengine/symforce_caspar_solver_test/kernel_rosenbrock_jtjnjtr_direct.h @@ -1,7 +1,6 @@ #pragma once -#include - +#include "cuda_to_hip.h" #include "shared_indices.h" namespace caspar { diff --git a/test/symforce_function_codegen_test_data/symengine/symforce_caspar_solver_test/kernel_rosenbrock_res_jac.cu b/test/symforce_function_codegen_test_data/symengine/symforce_caspar_solver_test/kernel_rosenbrock_res_jac.cu index 8c17c53f..e237c533 100644 --- a/test/symforce_function_codegen_test_data/symengine/symforce_caspar_solver_test/kernel_rosenbrock_res_jac.cu +++ b/test/symforce_function_codegen_test_data/symengine/symforce_caspar_solver_test/kernel_rosenbrock_res_jac.cu @@ -1,17 +1,10 @@ #include #include -#include -#include -#include -#include -#include - +#include "cuda_to_hip.h" #include "kernel_rosenbrock_res_jac.h" #include "memops.cuh" -namespace cg = cooperative_groups; - namespace caspar { __global__ void __launch_bounds__(1024, 1) diff --git a/test/symforce_function_codegen_test_data/symengine/symforce_caspar_solver_test/kernel_rosenbrock_res_jac.h b/test/symforce_function_codegen_test_data/symengine/symforce_caspar_solver_test/kernel_rosenbrock_res_jac.h index 84617734..ad7a2e6c 100644 --- a/test/symforce_function_codegen_test_data/symengine/symforce_caspar_solver_test/kernel_rosenbrock_res_jac.h +++ b/test/symforce_function_codegen_test_data/symengine/symforce_caspar_solver_test/kernel_rosenbrock_res_jac.h @@ -1,7 +1,6 @@ #pragma once -#include - +#include "cuda_to_hip.h" #include "shared_indices.h" namespace caspar { diff --git a/test/symforce_function_codegen_test_data/symengine/symforce_caspar_solver_test/kernel_rosenbrock_res_jac_first.cu b/test/symforce_function_codegen_test_data/symengine/symforce_caspar_solver_test/kernel_rosenbrock_res_jac_first.cu index 94cdbac1..3c67e39d 100644 --- a/test/symforce_function_codegen_test_data/symengine/symforce_caspar_solver_test/kernel_rosenbrock_res_jac_first.cu +++ b/test/symforce_function_codegen_test_data/symengine/symforce_caspar_solver_test/kernel_rosenbrock_res_jac_first.cu @@ -1,17 +1,10 @@ #include #include -#include -#include -#include -#include -#include - +#include "cuda_to_hip.h" #include "kernel_rosenbrock_res_jac_first.h" #include "memops.cuh" -namespace cg = cooperative_groups; - namespace caspar { __global__ void __launch_bounds__(1024, 1) diff --git a/test/symforce_function_codegen_test_data/symengine/symforce_caspar_solver_test/kernel_rosenbrock_res_jac_first.h b/test/symforce_function_codegen_test_data/symengine/symforce_caspar_solver_test/kernel_rosenbrock_res_jac_first.h index c2186b6e..44c70fe1 100644 --- a/test/symforce_function_codegen_test_data/symengine/symforce_caspar_solver_test/kernel_rosenbrock_res_jac_first.h +++ b/test/symforce_function_codegen_test_data/symengine/symforce_caspar_solver_test/kernel_rosenbrock_res_jac_first.h @@ -1,7 +1,6 @@ #pragma once -#include - +#include "cuda_to_hip.h" #include "shared_indices.h" namespace caspar { diff --git a/test/symforce_function_codegen_test_data/symengine/symforce_caspar_solver_test/kernel_rosenbrock_score.cu b/test/symforce_function_codegen_test_data/symengine/symforce_caspar_solver_test/kernel_rosenbrock_score.cu index 0932d18e..dd4afec3 100644 --- a/test/symforce_function_codegen_test_data/symengine/symforce_caspar_solver_test/kernel_rosenbrock_score.cu +++ b/test/symforce_function_codegen_test_data/symengine/symforce_caspar_solver_test/kernel_rosenbrock_score.cu @@ -1,17 +1,10 @@ #include #include -#include -#include -#include -#include -#include - +#include "cuda_to_hip.h" #include "kernel_rosenbrock_score.h" #include "memops.cuh" -namespace cg = cooperative_groups; - namespace caspar { __global__ void __launch_bounds__(1024, 1) diff --git a/test/symforce_function_codegen_test_data/symengine/symforce_caspar_solver_test/kernel_rosenbrock_score.h b/test/symforce_function_codegen_test_data/symengine/symforce_caspar_solver_test/kernel_rosenbrock_score.h index aee00b4e..43f4b867 100644 --- a/test/symforce_function_codegen_test_data/symengine/symforce_caspar_solver_test/kernel_rosenbrock_score.h +++ b/test/symforce_function_codegen_test_data/symengine/symforce_caspar_solver_test/kernel_rosenbrock_score.h @@ -1,7 +1,6 @@ #pragma once -#include - +#include "cuda_to_hip.h" #include "shared_indices.h" namespace caspar { diff --git a/test/symforce_function_codegen_test_data/symengine/symforce_caspar_solver_test/solver.h b/test/symforce_function_codegen_test_data/symengine/symforce_caspar_solver_test/solver.h index 247055a1..6b3f0b1d 100644 --- a/test/symforce_function_codegen_test_data/symengine/symforce_caspar_solver_test/solver.h +++ b/test/symforce_function_codegen_test_data/symengine/symforce_caspar_solver_test/solver.h @@ -3,8 +3,7 @@ #include #include -#include - +#include "cuda_to_hip.h" #include "shared_indices.h" #include "solver_params.h" diff --git a/test/symforce_function_codegen_test_data/symengine/symforce_caspar_tridiagonal_test/caspar_mappings.cu b/test/symforce_function_codegen_test_data/symengine/symforce_caspar_tridiagonal_test/caspar_mappings.cu index 0b2a5761..3a525387 100644 --- a/test/symforce_function_codegen_test_data/symengine/symforce_caspar_tridiagonal_test/caspar_mappings.cu +++ b/test/symforce_function_codegen_test_data/symengine/symforce_caspar_tridiagonal_test/caspar_mappings.cu @@ -1,11 +1,7 @@ #include -#include -#include - #include "caspar_mappings.h" - -namespace cg = cooperative_groups; +#include "cuda_to_hip.h" // We use shared memory to improve the memory access. // A smaller block size of 32 allows for larger nodetypes. diff --git a/test/symforce_function_codegen_test_data/symengine/symforce_caspar_tridiagonal_test/caspar_mappings.h b/test/symforce_function_codegen_test_data/symengine/symforce_caspar_tridiagonal_test/caspar_mappings.h index 6d656e85..08b042c4 100644 --- a/test/symforce_function_codegen_test_data/symengine/symforce_caspar_tridiagonal_test/caspar_mappings.h +++ b/test/symforce_function_codegen_test_data/symengine/symforce_caspar_tridiagonal_test/caspar_mappings.h @@ -1,6 +1,6 @@ #pragma once -#include +#include "cuda_to_hip.h" namespace caspar { diff --git a/test/symforce_function_codegen_test_data/symengine/symforce_caspar_tridiagonal_test/kernel_ChainA_alpha_denominator_or_beta_numerator.cu b/test/symforce_function_codegen_test_data/symengine/symforce_caspar_tridiagonal_test/kernel_ChainA_alpha_denominator_or_beta_numerator.cu index 495c7be2..c33a2eab 100644 --- a/test/symforce_function_codegen_test_data/symengine/symforce_caspar_tridiagonal_test/kernel_ChainA_alpha_denominator_or_beta_numerator.cu +++ b/test/symforce_function_codegen_test_data/symengine/symforce_caspar_tridiagonal_test/kernel_ChainA_alpha_denominator_or_beta_numerator.cu @@ -1,17 +1,10 @@ #include #include -#include -#include -#include -#include -#include - +#include "cuda_to_hip.h" #include "kernel_ChainA_alpha_denominator_or_beta_numerator.h" #include "memops.cuh" -namespace cg = cooperative_groups; - namespace caspar { __global__ void __launch_bounds__(1024, 1) diff --git a/test/symforce_function_codegen_test_data/symengine/symforce_caspar_tridiagonal_test/kernel_ChainA_alpha_denominator_or_beta_numerator.h b/test/symforce_function_codegen_test_data/symengine/symforce_caspar_tridiagonal_test/kernel_ChainA_alpha_denominator_or_beta_numerator.h index b02b452a..4247df5d 100644 --- a/test/symforce_function_codegen_test_data/symengine/symforce_caspar_tridiagonal_test/kernel_ChainA_alpha_denominator_or_beta_numerator.h +++ b/test/symforce_function_codegen_test_data/symengine/symforce_caspar_tridiagonal_test/kernel_ChainA_alpha_denominator_or_beta_numerator.h @@ -1,7 +1,6 @@ #pragma once -#include - +#include "cuda_to_hip.h" #include "shared_indices.h" namespace caspar { diff --git a/test/symforce_function_codegen_test_data/symengine/symforce_caspar_tridiagonal_test/kernel_ChainA_alpha_numerator_denominator.cu b/test/symforce_function_codegen_test_data/symengine/symforce_caspar_tridiagonal_test/kernel_ChainA_alpha_numerator_denominator.cu index 20c3096e..83f2f2dd 100644 --- a/test/symforce_function_codegen_test_data/symengine/symforce_caspar_tridiagonal_test/kernel_ChainA_alpha_numerator_denominator.cu +++ b/test/symforce_function_codegen_test_data/symengine/symforce_caspar_tridiagonal_test/kernel_ChainA_alpha_numerator_denominator.cu @@ -1,17 +1,10 @@ #include #include -#include -#include -#include -#include -#include - +#include "cuda_to_hip.h" #include "kernel_ChainA_alpha_numerator_denominator.h" #include "memops.cuh" -namespace cg = cooperative_groups; - namespace caspar { __global__ void __launch_bounds__(1024, 1) diff --git a/test/symforce_function_codegen_test_data/symengine/symforce_caspar_tridiagonal_test/kernel_ChainA_alpha_numerator_denominator.h b/test/symforce_function_codegen_test_data/symengine/symforce_caspar_tridiagonal_test/kernel_ChainA_alpha_numerator_denominator.h index 94a7d660..b6a13e5b 100644 --- a/test/symforce_function_codegen_test_data/symengine/symforce_caspar_tridiagonal_test/kernel_ChainA_alpha_numerator_denominator.h +++ b/test/symforce_function_codegen_test_data/symengine/symforce_caspar_tridiagonal_test/kernel_ChainA_alpha_numerator_denominator.h @@ -1,7 +1,6 @@ #pragma once -#include - +#include "cuda_to_hip.h" #include "shared_indices.h" namespace caspar { diff --git a/test/symforce_function_codegen_test_data/symengine/symforce_caspar_tridiagonal_test/kernel_ChainA_cyclic_reduction_down.cu b/test/symforce_function_codegen_test_data/symengine/symforce_caspar_tridiagonal_test/kernel_ChainA_cyclic_reduction_down.cu index 5a945d07..a2efd490 100644 --- a/test/symforce_function_codegen_test_data/symengine/symforce_caspar_tridiagonal_test/kernel_ChainA_cyclic_reduction_down.cu +++ b/test/symforce_function_codegen_test_data/symengine/symforce_caspar_tridiagonal_test/kernel_ChainA_cyclic_reduction_down.cu @@ -1,17 +1,10 @@ #include #include -#include -#include -#include -#include -#include - +#include "cuda_to_hip.h" #include "kernel_ChainA_cyclic_reduction_down.h" #include "memops.cuh" -namespace cg = cooperative_groups; - namespace caspar { __global__ void __launch_bounds__(64, 1) diff --git a/test/symforce_function_codegen_test_data/symengine/symforce_caspar_tridiagonal_test/kernel_ChainA_cyclic_reduction_down.h b/test/symforce_function_codegen_test_data/symengine/symforce_caspar_tridiagonal_test/kernel_ChainA_cyclic_reduction_down.h index ce406fc6..2cb52fd8 100644 --- a/test/symforce_function_codegen_test_data/symengine/symforce_caspar_tridiagonal_test/kernel_ChainA_cyclic_reduction_down.h +++ b/test/symforce_function_codegen_test_data/symengine/symforce_caspar_tridiagonal_test/kernel_ChainA_cyclic_reduction_down.h @@ -1,7 +1,6 @@ #pragma once -#include - +#include "cuda_to_hip.h" #include "shared_indices.h" namespace caspar { diff --git a/test/symforce_function_codegen_test_data/symengine/symforce_caspar_tridiagonal_test/kernel_ChainA_cyclic_reduction_solve_two.cu b/test/symforce_function_codegen_test_data/symengine/symforce_caspar_tridiagonal_test/kernel_ChainA_cyclic_reduction_solve_two.cu index b3cca154..2bcd3719 100644 --- a/test/symforce_function_codegen_test_data/symengine/symforce_caspar_tridiagonal_test/kernel_ChainA_cyclic_reduction_solve_two.cu +++ b/test/symforce_function_codegen_test_data/symengine/symforce_caspar_tridiagonal_test/kernel_ChainA_cyclic_reduction_solve_two.cu @@ -1,17 +1,10 @@ #include #include -#include -#include -#include -#include -#include - +#include "cuda_to_hip.h" #include "kernel_ChainA_cyclic_reduction_solve_two.h" #include "memops.cuh" -namespace cg = cooperative_groups; - namespace caspar { __global__ void __launch_bounds__(32, 1) ChainACyclicReductionSolveTwoKernel( diff --git a/test/symforce_function_codegen_test_data/symengine/symforce_caspar_tridiagonal_test/kernel_ChainA_cyclic_reduction_solve_two.h b/test/symforce_function_codegen_test_data/symengine/symforce_caspar_tridiagonal_test/kernel_ChainA_cyclic_reduction_solve_two.h index 06a5d1c6..7ec47c94 100644 --- a/test/symforce_function_codegen_test_data/symengine/symforce_caspar_tridiagonal_test/kernel_ChainA_cyclic_reduction_solve_two.h +++ b/test/symforce_function_codegen_test_data/symengine/symforce_caspar_tridiagonal_test/kernel_ChainA_cyclic_reduction_solve_two.h @@ -1,7 +1,6 @@ #pragma once -#include - +#include "cuda_to_hip.h" #include "shared_indices.h" namespace caspar { diff --git a/test/symforce_function_codegen_test_data/symengine/symforce_caspar_tridiagonal_test/kernel_ChainA_cyclic_reduction_up.cu b/test/symforce_function_codegen_test_data/symengine/symforce_caspar_tridiagonal_test/kernel_ChainA_cyclic_reduction_up.cu index 4528c2a3..dd839d7b 100644 --- a/test/symforce_function_codegen_test_data/symengine/symforce_caspar_tridiagonal_test/kernel_ChainA_cyclic_reduction_up.cu +++ b/test/symforce_function_codegen_test_data/symengine/symforce_caspar_tridiagonal_test/kernel_ChainA_cyclic_reduction_up.cu @@ -1,17 +1,10 @@ #include #include -#include -#include -#include -#include -#include - +#include "cuda_to_hip.h" #include "kernel_ChainA_cyclic_reduction_up.h" #include "memops.cuh" -namespace cg = cooperative_groups; - namespace caspar { __global__ void __launch_bounds__(32, 1) diff --git a/test/symforce_function_codegen_test_data/symengine/symforce_caspar_tridiagonal_test/kernel_ChainA_cyclic_reduction_up.h b/test/symforce_function_codegen_test_data/symengine/symforce_caspar_tridiagonal_test/kernel_ChainA_cyclic_reduction_up.h index 39ef29d7..3147af1e 100644 --- a/test/symforce_function_codegen_test_data/symengine/symforce_caspar_tridiagonal_test/kernel_ChainA_cyclic_reduction_up.h +++ b/test/symforce_function_codegen_test_data/symengine/symforce_caspar_tridiagonal_test/kernel_ChainA_cyclic_reduction_up.h @@ -1,7 +1,6 @@ #pragma once -#include - +#include "cuda_to_hip.h" #include "shared_indices.h" namespace caspar { diff --git a/test/symforce_function_codegen_test_data/symengine/symforce_caspar_tridiagonal_test/kernel_ChainA_normalize.cu b/test/symforce_function_codegen_test_data/symengine/symforce_caspar_tridiagonal_test/kernel_ChainA_normalize.cu index 79c73bb1..f10a72e5 100644 --- a/test/symforce_function_codegen_test_data/symengine/symforce_caspar_tridiagonal_test/kernel_ChainA_normalize.cu +++ b/test/symforce_function_codegen_test_data/symengine/symforce_caspar_tridiagonal_test/kernel_ChainA_normalize.cu @@ -1,17 +1,10 @@ #include #include -#include -#include -#include -#include -#include - +#include "cuda_to_hip.h" #include "kernel_ChainA_normalize.h" #include "memops.cuh" -namespace cg = cooperative_groups; - namespace caspar { __global__ void __launch_bounds__(1024, 1) diff --git a/test/symforce_function_codegen_test_data/symengine/symforce_caspar_tridiagonal_test/kernel_ChainA_normalize.h b/test/symforce_function_codegen_test_data/symengine/symforce_caspar_tridiagonal_test/kernel_ChainA_normalize.h index 89f4215b..3c133ee6 100644 --- a/test/symforce_function_codegen_test_data/symengine/symforce_caspar_tridiagonal_test/kernel_ChainA_normalize.h +++ b/test/symforce_function_codegen_test_data/symengine/symforce_caspar_tridiagonal_test/kernel_ChainA_normalize.h @@ -1,7 +1,6 @@ #pragma once -#include - +#include "cuda_to_hip.h" #include "shared_indices.h" namespace caspar { diff --git a/test/symforce_function_codegen_test_data/symengine/symforce_caspar_tridiagonal_test/kernel_ChainA_pred_decrease_times_two.cu b/test/symforce_function_codegen_test_data/symengine/symforce_caspar_tridiagonal_test/kernel_ChainA_pred_decrease_times_two.cu index f65466e3..9e043786 100644 --- a/test/symforce_function_codegen_test_data/symengine/symforce_caspar_tridiagonal_test/kernel_ChainA_pred_decrease_times_two.cu +++ b/test/symforce_function_codegen_test_data/symengine/symforce_caspar_tridiagonal_test/kernel_ChainA_pred_decrease_times_two.cu @@ -1,17 +1,10 @@ #include #include -#include -#include -#include -#include -#include - +#include "cuda_to_hip.h" #include "kernel_ChainA_pred_decrease_times_two.h" #include "memops.cuh" -namespace cg = cooperative_groups; - namespace caspar { __global__ void __launch_bounds__(1024, 1) ChainAPredDecreaseTimesTwoKernel( diff --git a/test/symforce_function_codegen_test_data/symengine/symforce_caspar_tridiagonal_test/kernel_ChainA_pred_decrease_times_two.h b/test/symforce_function_codegen_test_data/symengine/symforce_caspar_tridiagonal_test/kernel_ChainA_pred_decrease_times_two.h index e4dce58f..3aa94f50 100644 --- a/test/symforce_function_codegen_test_data/symengine/symforce_caspar_tridiagonal_test/kernel_ChainA_pred_decrease_times_two.h +++ b/test/symforce_function_codegen_test_data/symengine/symforce_caspar_tridiagonal_test/kernel_ChainA_pred_decrease_times_two.h @@ -1,7 +1,6 @@ #pragma once -#include - +#include "cuda_to_hip.h" #include "shared_indices.h" namespace caspar { diff --git a/test/symforce_function_codegen_test_data/symengine/symforce_caspar_tridiagonal_test/kernel_ChainA_retract.cu b/test/symforce_function_codegen_test_data/symengine/symforce_caspar_tridiagonal_test/kernel_ChainA_retract.cu index 840f1547..23af59fd 100644 --- a/test/symforce_function_codegen_test_data/symengine/symforce_caspar_tridiagonal_test/kernel_ChainA_retract.cu +++ b/test/symforce_function_codegen_test_data/symengine/symforce_caspar_tridiagonal_test/kernel_ChainA_retract.cu @@ -1,17 +1,10 @@ #include #include -#include -#include -#include -#include -#include - +#include "cuda_to_hip.h" #include "kernel_ChainA_retract.h" #include "memops.cuh" -namespace cg = cooperative_groups; - namespace caspar { __global__ void __launch_bounds__(1024, 1) diff --git a/test/symforce_function_codegen_test_data/symengine/symforce_caspar_tridiagonal_test/kernel_ChainA_retract.h b/test/symforce_function_codegen_test_data/symengine/symforce_caspar_tridiagonal_test/kernel_ChainA_retract.h index ed36ee7e..69f2cbdf 100644 --- a/test/symforce_function_codegen_test_data/symengine/symforce_caspar_tridiagonal_test/kernel_ChainA_retract.h +++ b/test/symforce_function_codegen_test_data/symengine/symforce_caspar_tridiagonal_test/kernel_ChainA_retract.h @@ -1,7 +1,6 @@ #pragma once -#include - +#include "cuda_to_hip.h" #include "shared_indices.h" namespace caspar { diff --git a/test/symforce_function_codegen_test_data/symengine/symforce_caspar_tridiagonal_test/kernel_ChainA_start_w.cu b/test/symforce_function_codegen_test_data/symengine/symforce_caspar_tridiagonal_test/kernel_ChainA_start_w.cu index 8e5a69c0..9c2acfc4 100644 --- a/test/symforce_function_codegen_test_data/symengine/symforce_caspar_tridiagonal_test/kernel_ChainA_start_w.cu +++ b/test/symforce_function_codegen_test_data/symengine/symforce_caspar_tridiagonal_test/kernel_ChainA_start_w.cu @@ -1,17 +1,10 @@ #include #include -#include -#include -#include -#include -#include - +#include "cuda_to_hip.h" #include "kernel_ChainA_start_w.h" #include "memops.cuh" -namespace cg = cooperative_groups; - namespace caspar { __global__ void __launch_bounds__(1024, 1) diff --git a/test/symforce_function_codegen_test_data/symengine/symforce_caspar_tridiagonal_test/kernel_ChainA_start_w.h b/test/symforce_function_codegen_test_data/symengine/symforce_caspar_tridiagonal_test/kernel_ChainA_start_w.h index e64ad145..e2b2b853 100644 --- a/test/symforce_function_codegen_test_data/symengine/symforce_caspar_tridiagonal_test/kernel_ChainA_start_w.h +++ b/test/symforce_function_codegen_test_data/symengine/symforce_caspar_tridiagonal_test/kernel_ChainA_start_w.h @@ -1,7 +1,6 @@ #pragma once -#include - +#include "cuda_to_hip.h" #include "shared_indices.h" namespace caspar { diff --git a/test/symforce_function_codegen_test_data/symengine/symforce_caspar_tridiagonal_test/kernel_ChainA_start_w_contribute.cu b/test/symforce_function_codegen_test_data/symengine/symforce_caspar_tridiagonal_test/kernel_ChainA_start_w_contribute.cu index a6b6817b..c9a00429 100644 --- a/test/symforce_function_codegen_test_data/symengine/symforce_caspar_tridiagonal_test/kernel_ChainA_start_w_contribute.cu +++ b/test/symforce_function_codegen_test_data/symengine/symforce_caspar_tridiagonal_test/kernel_ChainA_start_w_contribute.cu @@ -1,17 +1,10 @@ #include #include -#include -#include -#include -#include -#include - +#include "cuda_to_hip.h" #include "kernel_ChainA_start_w_contribute.h" #include "memops.cuh" -namespace cg = cooperative_groups; - namespace caspar { __global__ void __launch_bounds__(1024, 1) diff --git a/test/symforce_function_codegen_test_data/symengine/symforce_caspar_tridiagonal_test/kernel_ChainA_start_w_contribute.h b/test/symforce_function_codegen_test_data/symengine/symforce_caspar_tridiagonal_test/kernel_ChainA_start_w_contribute.h index 31df0106..74a7b12d 100644 --- a/test/symforce_function_codegen_test_data/symengine/symforce_caspar_tridiagonal_test/kernel_ChainA_start_w_contribute.h +++ b/test/symforce_function_codegen_test_data/symengine/symforce_caspar_tridiagonal_test/kernel_ChainA_start_w_contribute.h @@ -1,7 +1,6 @@ #pragma once -#include - +#include "cuda_to_hip.h" #include "shared_indices.h" namespace caspar { diff --git a/test/symforce_function_codegen_test_data/symengine/symforce_caspar_tridiagonal_test/kernel_ChainA_tridig_make_eq.cu b/test/symforce_function_codegen_test_data/symengine/symforce_caspar_tridiagonal_test/kernel_ChainA_tridig_make_eq.cu index a0781406..436e8edc 100644 --- a/test/symforce_function_codegen_test_data/symengine/symforce_caspar_tridiagonal_test/kernel_ChainA_tridig_make_eq.cu +++ b/test/symforce_function_codegen_test_data/symengine/symforce_caspar_tridiagonal_test/kernel_ChainA_tridig_make_eq.cu @@ -1,17 +1,10 @@ #include #include -#include -#include -#include -#include -#include - +#include "cuda_to_hip.h" #include "kernel_ChainA_tridig_make_eq.h" #include "memops.cuh" -namespace cg = cooperative_groups; - namespace caspar { __global__ void __launch_bounds__(1024, 1) diff --git a/test/symforce_function_codegen_test_data/symengine/symforce_caspar_tridiagonal_test/kernel_ChainA_tridig_make_eq.h b/test/symforce_function_codegen_test_data/symengine/symforce_caspar_tridiagonal_test/kernel_ChainA_tridig_make_eq.h index 9052869a..449052fa 100644 --- a/test/symforce_function_codegen_test_data/symengine/symforce_caspar_tridiagonal_test/kernel_ChainA_tridig_make_eq.h +++ b/test/symforce_function_codegen_test_data/symengine/symforce_caspar_tridiagonal_test/kernel_ChainA_tridig_make_eq.h @@ -1,7 +1,6 @@ #pragma once -#include - +#include "cuda_to_hip.h" #include "shared_indices.h" namespace caspar { diff --git a/test/symforce_function_codegen_test_data/symengine/symforce_caspar_tridiagonal_test/kernel_ChainA_update_Mp.cu b/test/symforce_function_codegen_test_data/symengine/symforce_caspar_tridiagonal_test/kernel_ChainA_update_Mp.cu index 48d5d026..b7f41bef 100644 --- a/test/symforce_function_codegen_test_data/symengine/symforce_caspar_tridiagonal_test/kernel_ChainA_update_Mp.cu +++ b/test/symforce_function_codegen_test_data/symengine/symforce_caspar_tridiagonal_test/kernel_ChainA_update_Mp.cu @@ -1,17 +1,10 @@ #include #include -#include -#include -#include -#include -#include - +#include "cuda_to_hip.h" #include "kernel_ChainA_update_Mp.h" #include "memops.cuh" -namespace cg = cooperative_groups; - namespace caspar { __global__ void __launch_bounds__(1024, 1) diff --git a/test/symforce_function_codegen_test_data/symengine/symforce_caspar_tridiagonal_test/kernel_ChainA_update_Mp.h b/test/symforce_function_codegen_test_data/symengine/symforce_caspar_tridiagonal_test/kernel_ChainA_update_Mp.h index 12f1567d..f1d9753a 100644 --- a/test/symforce_function_codegen_test_data/symengine/symforce_caspar_tridiagonal_test/kernel_ChainA_update_Mp.h +++ b/test/symforce_function_codegen_test_data/symengine/symforce_caspar_tridiagonal_test/kernel_ChainA_update_Mp.h @@ -1,7 +1,6 @@ #pragma once -#include - +#include "cuda_to_hip.h" #include "shared_indices.h" namespace caspar { diff --git a/test/symforce_function_codegen_test_data/symengine/symforce_caspar_tridiagonal_test/kernel_ChainA_update_p.cu b/test/symforce_function_codegen_test_data/symengine/symforce_caspar_tridiagonal_test/kernel_ChainA_update_p.cu index c2116156..dc900ffb 100644 --- a/test/symforce_function_codegen_test_data/symengine/symforce_caspar_tridiagonal_test/kernel_ChainA_update_p.cu +++ b/test/symforce_function_codegen_test_data/symengine/symforce_caspar_tridiagonal_test/kernel_ChainA_update_p.cu @@ -1,17 +1,10 @@ #include #include -#include -#include -#include -#include -#include - +#include "cuda_to_hip.h" #include "kernel_ChainA_update_p.h" #include "memops.cuh" -namespace cg = cooperative_groups; - namespace caspar { __global__ void __launch_bounds__(1024, 1) diff --git a/test/symforce_function_codegen_test_data/symengine/symforce_caspar_tridiagonal_test/kernel_ChainA_update_p.h b/test/symforce_function_codegen_test_data/symengine/symforce_caspar_tridiagonal_test/kernel_ChainA_update_p.h index ffce655a..0a420698 100644 --- a/test/symforce_function_codegen_test_data/symengine/symforce_caspar_tridiagonal_test/kernel_ChainA_update_p.h +++ b/test/symforce_function_codegen_test_data/symengine/symforce_caspar_tridiagonal_test/kernel_ChainA_update_p.h @@ -1,7 +1,6 @@ #pragma once -#include - +#include "cuda_to_hip.h" #include "shared_indices.h" namespace caspar { diff --git a/test/symforce_function_codegen_test_data/symengine/symforce_caspar_tridiagonal_test/kernel_ChainA_update_r.cu b/test/symforce_function_codegen_test_data/symengine/symforce_caspar_tridiagonal_test/kernel_ChainA_update_r.cu index ff725db8..ed16ba53 100644 --- a/test/symforce_function_codegen_test_data/symengine/symforce_caspar_tridiagonal_test/kernel_ChainA_update_r.cu +++ b/test/symforce_function_codegen_test_data/symengine/symforce_caspar_tridiagonal_test/kernel_ChainA_update_r.cu @@ -1,17 +1,10 @@ #include #include -#include -#include -#include -#include -#include - +#include "cuda_to_hip.h" #include "kernel_ChainA_update_r.h" #include "memops.cuh" -namespace cg = cooperative_groups; - namespace caspar { __global__ void __launch_bounds__(1024, 1) diff --git a/test/symforce_function_codegen_test_data/symengine/symforce_caspar_tridiagonal_test/kernel_ChainA_update_r.h b/test/symforce_function_codegen_test_data/symengine/symforce_caspar_tridiagonal_test/kernel_ChainA_update_r.h index c5caa08e..9fe69710 100644 --- a/test/symforce_function_codegen_test_data/symengine/symforce_caspar_tridiagonal_test/kernel_ChainA_update_r.h +++ b/test/symforce_function_codegen_test_data/symengine/symforce_caspar_tridiagonal_test/kernel_ChainA_update_r.h @@ -1,7 +1,6 @@ #pragma once -#include - +#include "cuda_to_hip.h" #include "shared_indices.h" namespace caspar { diff --git a/test/symforce_function_codegen_test_data/symengine/symforce_caspar_tridiagonal_test/kernel_ChainA_update_r_first.cu b/test/symforce_function_codegen_test_data/symengine/symforce_caspar_tridiagonal_test/kernel_ChainA_update_r_first.cu index e35670ca..c1ede4bf 100644 --- a/test/symforce_function_codegen_test_data/symengine/symforce_caspar_tridiagonal_test/kernel_ChainA_update_r_first.cu +++ b/test/symforce_function_codegen_test_data/symengine/symforce_caspar_tridiagonal_test/kernel_ChainA_update_r_first.cu @@ -1,17 +1,10 @@ #include #include -#include -#include -#include -#include -#include - +#include "cuda_to_hip.h" #include "kernel_ChainA_update_r_first.h" #include "memops.cuh" -namespace cg = cooperative_groups; - namespace caspar { __global__ void __launch_bounds__(1024, 1) diff --git a/test/symforce_function_codegen_test_data/symengine/symforce_caspar_tridiagonal_test/kernel_ChainA_update_r_first.h b/test/symforce_function_codegen_test_data/symengine/symforce_caspar_tridiagonal_test/kernel_ChainA_update_r_first.h index 270fdda1..b17dd0d5 100644 --- a/test/symforce_function_codegen_test_data/symengine/symforce_caspar_tridiagonal_test/kernel_ChainA_update_r_first.h +++ b/test/symforce_function_codegen_test_data/symengine/symforce_caspar_tridiagonal_test/kernel_ChainA_update_r_first.h @@ -1,7 +1,6 @@ #pragma once -#include - +#include "cuda_to_hip.h" #include "shared_indices.h" namespace caspar { diff --git a/test/symforce_function_codegen_test_data/symengine/symforce_caspar_tridiagonal_test/kernel_ChainA_update_step.cu b/test/symforce_function_codegen_test_data/symengine/symforce_caspar_tridiagonal_test/kernel_ChainA_update_step.cu index 187263ef..3fcb94cc 100644 --- a/test/symforce_function_codegen_test_data/symengine/symforce_caspar_tridiagonal_test/kernel_ChainA_update_step.cu +++ b/test/symforce_function_codegen_test_data/symengine/symforce_caspar_tridiagonal_test/kernel_ChainA_update_step.cu @@ -1,17 +1,10 @@ #include #include -#include -#include -#include -#include -#include - +#include "cuda_to_hip.h" #include "kernel_ChainA_update_step.h" #include "memops.cuh" -namespace cg = cooperative_groups; - namespace caspar { __global__ void __launch_bounds__(1024, 1) diff --git a/test/symforce_function_codegen_test_data/symengine/symforce_caspar_tridiagonal_test/kernel_ChainA_update_step.h b/test/symforce_function_codegen_test_data/symengine/symforce_caspar_tridiagonal_test/kernel_ChainA_update_step.h index 1e4a1968..b109de03 100644 --- a/test/symforce_function_codegen_test_data/symengine/symforce_caspar_tridiagonal_test/kernel_ChainA_update_step.h +++ b/test/symforce_function_codegen_test_data/symengine/symforce_caspar_tridiagonal_test/kernel_ChainA_update_step.h @@ -1,7 +1,6 @@ #pragma once -#include - +#include "cuda_to_hip.h" #include "shared_indices.h" namespace caspar { diff --git a/test/symforce_function_codegen_test_data/symengine/symforce_caspar_tridiagonal_test/kernel_ChainA_update_step_first.cu b/test/symforce_function_codegen_test_data/symengine/symforce_caspar_tridiagonal_test/kernel_ChainA_update_step_first.cu index 6ce1c156..ad116a77 100644 --- a/test/symforce_function_codegen_test_data/symengine/symforce_caspar_tridiagonal_test/kernel_ChainA_update_step_first.cu +++ b/test/symforce_function_codegen_test_data/symengine/symforce_caspar_tridiagonal_test/kernel_ChainA_update_step_first.cu @@ -1,17 +1,10 @@ #include #include -#include -#include -#include -#include -#include - +#include "cuda_to_hip.h" #include "kernel_ChainA_update_step_first.h" #include "memops.cuh" -namespace cg = cooperative_groups; - namespace caspar { __global__ void __launch_bounds__(1024, 1) diff --git a/test/symforce_function_codegen_test_data/symengine/symforce_caspar_tridiagonal_test/kernel_ChainA_update_step_first.h b/test/symforce_function_codegen_test_data/symengine/symforce_caspar_tridiagonal_test/kernel_ChainA_update_step_first.h index 461de55f..0385d1ff 100644 --- a/test/symforce_function_codegen_test_data/symengine/symforce_caspar_tridiagonal_test/kernel_ChainA_update_step_first.h +++ b/test/symforce_function_codegen_test_data/symengine/symforce_caspar_tridiagonal_test/kernel_ChainA_update_step_first.h @@ -1,7 +1,6 @@ #pragma once -#include - +#include "cuda_to_hip.h" #include "shared_indices.h" namespace caspar { diff --git a/test/symforce_function_codegen_test_data/symengine/symforce_caspar_tridiagonal_test/kernel_ChainB_alpha_denominator_or_beta_numerator.cu b/test/symforce_function_codegen_test_data/symengine/symforce_caspar_tridiagonal_test/kernel_ChainB_alpha_denominator_or_beta_numerator.cu index c5e4aa53..cd4445c4 100644 --- a/test/symforce_function_codegen_test_data/symengine/symforce_caspar_tridiagonal_test/kernel_ChainB_alpha_denominator_or_beta_numerator.cu +++ b/test/symforce_function_codegen_test_data/symengine/symforce_caspar_tridiagonal_test/kernel_ChainB_alpha_denominator_or_beta_numerator.cu @@ -1,17 +1,10 @@ #include #include -#include -#include -#include -#include -#include - +#include "cuda_to_hip.h" #include "kernel_ChainB_alpha_denominator_or_beta_numerator.h" #include "memops.cuh" -namespace cg = cooperative_groups; - namespace caspar { __global__ void __launch_bounds__(1024, 1) diff --git a/test/symforce_function_codegen_test_data/symengine/symforce_caspar_tridiagonal_test/kernel_ChainB_alpha_denominator_or_beta_numerator.h b/test/symforce_function_codegen_test_data/symengine/symforce_caspar_tridiagonal_test/kernel_ChainB_alpha_denominator_or_beta_numerator.h index 5089b1c7..0ac4db49 100644 --- a/test/symforce_function_codegen_test_data/symengine/symforce_caspar_tridiagonal_test/kernel_ChainB_alpha_denominator_or_beta_numerator.h +++ b/test/symforce_function_codegen_test_data/symengine/symforce_caspar_tridiagonal_test/kernel_ChainB_alpha_denominator_or_beta_numerator.h @@ -1,7 +1,6 @@ #pragma once -#include - +#include "cuda_to_hip.h" #include "shared_indices.h" namespace caspar { diff --git a/test/symforce_function_codegen_test_data/symengine/symforce_caspar_tridiagonal_test/kernel_ChainB_alpha_numerator_denominator.cu b/test/symforce_function_codegen_test_data/symengine/symforce_caspar_tridiagonal_test/kernel_ChainB_alpha_numerator_denominator.cu index 4c8b49e2..b9502b30 100644 --- a/test/symforce_function_codegen_test_data/symengine/symforce_caspar_tridiagonal_test/kernel_ChainB_alpha_numerator_denominator.cu +++ b/test/symforce_function_codegen_test_data/symengine/symforce_caspar_tridiagonal_test/kernel_ChainB_alpha_numerator_denominator.cu @@ -1,17 +1,10 @@ #include #include -#include -#include -#include -#include -#include - +#include "cuda_to_hip.h" #include "kernel_ChainB_alpha_numerator_denominator.h" #include "memops.cuh" -namespace cg = cooperative_groups; - namespace caspar { __global__ void __launch_bounds__(1024, 1) diff --git a/test/symforce_function_codegen_test_data/symengine/symforce_caspar_tridiagonal_test/kernel_ChainB_alpha_numerator_denominator.h b/test/symforce_function_codegen_test_data/symengine/symforce_caspar_tridiagonal_test/kernel_ChainB_alpha_numerator_denominator.h index 613341f5..19dff844 100644 --- a/test/symforce_function_codegen_test_data/symengine/symforce_caspar_tridiagonal_test/kernel_ChainB_alpha_numerator_denominator.h +++ b/test/symforce_function_codegen_test_data/symengine/symforce_caspar_tridiagonal_test/kernel_ChainB_alpha_numerator_denominator.h @@ -1,7 +1,6 @@ #pragma once -#include - +#include "cuda_to_hip.h" #include "shared_indices.h" namespace caspar { diff --git a/test/symforce_function_codegen_test_data/symengine/symforce_caspar_tridiagonal_test/kernel_ChainB_cyclic_reduction_down.cu b/test/symforce_function_codegen_test_data/symengine/symforce_caspar_tridiagonal_test/kernel_ChainB_cyclic_reduction_down.cu index d1485291..8947c3fe 100644 --- a/test/symforce_function_codegen_test_data/symengine/symforce_caspar_tridiagonal_test/kernel_ChainB_cyclic_reduction_down.cu +++ b/test/symforce_function_codegen_test_data/symengine/symforce_caspar_tridiagonal_test/kernel_ChainB_cyclic_reduction_down.cu @@ -1,17 +1,10 @@ #include #include -#include -#include -#include -#include -#include - +#include "cuda_to_hip.h" #include "kernel_ChainB_cyclic_reduction_down.h" #include "memops.cuh" -namespace cg = cooperative_groups; - namespace caspar { __global__ void __launch_bounds__(64, 1) diff --git a/test/symforce_function_codegen_test_data/symengine/symforce_caspar_tridiagonal_test/kernel_ChainB_cyclic_reduction_down.h b/test/symforce_function_codegen_test_data/symengine/symforce_caspar_tridiagonal_test/kernel_ChainB_cyclic_reduction_down.h index 8ceb4040..977263fc 100644 --- a/test/symforce_function_codegen_test_data/symengine/symforce_caspar_tridiagonal_test/kernel_ChainB_cyclic_reduction_down.h +++ b/test/symforce_function_codegen_test_data/symengine/symforce_caspar_tridiagonal_test/kernel_ChainB_cyclic_reduction_down.h @@ -1,7 +1,6 @@ #pragma once -#include - +#include "cuda_to_hip.h" #include "shared_indices.h" namespace caspar { diff --git a/test/symforce_function_codegen_test_data/symengine/symforce_caspar_tridiagonal_test/kernel_ChainB_cyclic_reduction_solve_two.cu b/test/symforce_function_codegen_test_data/symengine/symforce_caspar_tridiagonal_test/kernel_ChainB_cyclic_reduction_solve_two.cu index aee9c96d..5cd6fe7e 100644 --- a/test/symforce_function_codegen_test_data/symengine/symforce_caspar_tridiagonal_test/kernel_ChainB_cyclic_reduction_solve_two.cu +++ b/test/symforce_function_codegen_test_data/symengine/symforce_caspar_tridiagonal_test/kernel_ChainB_cyclic_reduction_solve_two.cu @@ -1,17 +1,10 @@ #include #include -#include -#include -#include -#include -#include - +#include "cuda_to_hip.h" #include "kernel_ChainB_cyclic_reduction_solve_two.h" #include "memops.cuh" -namespace cg = cooperative_groups; - namespace caspar { __global__ void __launch_bounds__(32, 1) ChainBCyclicReductionSolveTwoKernel( diff --git a/test/symforce_function_codegen_test_data/symengine/symforce_caspar_tridiagonal_test/kernel_ChainB_cyclic_reduction_solve_two.h b/test/symforce_function_codegen_test_data/symengine/symforce_caspar_tridiagonal_test/kernel_ChainB_cyclic_reduction_solve_two.h index 9fae819f..45685b8d 100644 --- a/test/symforce_function_codegen_test_data/symengine/symforce_caspar_tridiagonal_test/kernel_ChainB_cyclic_reduction_solve_two.h +++ b/test/symforce_function_codegen_test_data/symengine/symforce_caspar_tridiagonal_test/kernel_ChainB_cyclic_reduction_solve_two.h @@ -1,7 +1,6 @@ #pragma once -#include - +#include "cuda_to_hip.h" #include "shared_indices.h" namespace caspar { diff --git a/test/symforce_function_codegen_test_data/symengine/symforce_caspar_tridiagonal_test/kernel_ChainB_cyclic_reduction_up.cu b/test/symforce_function_codegen_test_data/symengine/symforce_caspar_tridiagonal_test/kernel_ChainB_cyclic_reduction_up.cu index 66441e66..d5c75540 100644 --- a/test/symforce_function_codegen_test_data/symengine/symforce_caspar_tridiagonal_test/kernel_ChainB_cyclic_reduction_up.cu +++ b/test/symforce_function_codegen_test_data/symengine/symforce_caspar_tridiagonal_test/kernel_ChainB_cyclic_reduction_up.cu @@ -1,17 +1,10 @@ #include #include -#include -#include -#include -#include -#include - +#include "cuda_to_hip.h" #include "kernel_ChainB_cyclic_reduction_up.h" #include "memops.cuh" -namespace cg = cooperative_groups; - namespace caspar { __global__ void __launch_bounds__(32, 1) diff --git a/test/symforce_function_codegen_test_data/symengine/symforce_caspar_tridiagonal_test/kernel_ChainB_cyclic_reduction_up.h b/test/symforce_function_codegen_test_data/symengine/symforce_caspar_tridiagonal_test/kernel_ChainB_cyclic_reduction_up.h index 01c1a58a..7d294b91 100644 --- a/test/symforce_function_codegen_test_data/symengine/symforce_caspar_tridiagonal_test/kernel_ChainB_cyclic_reduction_up.h +++ b/test/symforce_function_codegen_test_data/symengine/symforce_caspar_tridiagonal_test/kernel_ChainB_cyclic_reduction_up.h @@ -1,7 +1,6 @@ #pragma once -#include - +#include "cuda_to_hip.h" #include "shared_indices.h" namespace caspar { diff --git a/test/symforce_function_codegen_test_data/symengine/symforce_caspar_tridiagonal_test/kernel_ChainB_normalize.cu b/test/symforce_function_codegen_test_data/symengine/symforce_caspar_tridiagonal_test/kernel_ChainB_normalize.cu index 15e36382..e330dc79 100644 --- a/test/symforce_function_codegen_test_data/symengine/symforce_caspar_tridiagonal_test/kernel_ChainB_normalize.cu +++ b/test/symforce_function_codegen_test_data/symengine/symforce_caspar_tridiagonal_test/kernel_ChainB_normalize.cu @@ -1,17 +1,10 @@ #include #include -#include -#include -#include -#include -#include - +#include "cuda_to_hip.h" #include "kernel_ChainB_normalize.h" #include "memops.cuh" -namespace cg = cooperative_groups; - namespace caspar { __global__ void __launch_bounds__(1024, 1) diff --git a/test/symforce_function_codegen_test_data/symengine/symforce_caspar_tridiagonal_test/kernel_ChainB_normalize.h b/test/symforce_function_codegen_test_data/symengine/symforce_caspar_tridiagonal_test/kernel_ChainB_normalize.h index de57b746..4f55d267 100644 --- a/test/symforce_function_codegen_test_data/symengine/symforce_caspar_tridiagonal_test/kernel_ChainB_normalize.h +++ b/test/symforce_function_codegen_test_data/symengine/symforce_caspar_tridiagonal_test/kernel_ChainB_normalize.h @@ -1,7 +1,6 @@ #pragma once -#include - +#include "cuda_to_hip.h" #include "shared_indices.h" namespace caspar { diff --git a/test/symforce_function_codegen_test_data/symengine/symforce_caspar_tridiagonal_test/kernel_ChainB_pred_decrease_times_two.cu b/test/symforce_function_codegen_test_data/symengine/symforce_caspar_tridiagonal_test/kernel_ChainB_pred_decrease_times_two.cu index f2e5ad81..9c905759 100644 --- a/test/symforce_function_codegen_test_data/symengine/symforce_caspar_tridiagonal_test/kernel_ChainB_pred_decrease_times_two.cu +++ b/test/symforce_function_codegen_test_data/symengine/symforce_caspar_tridiagonal_test/kernel_ChainB_pred_decrease_times_two.cu @@ -1,17 +1,10 @@ #include #include -#include -#include -#include -#include -#include - +#include "cuda_to_hip.h" #include "kernel_ChainB_pred_decrease_times_two.h" #include "memops.cuh" -namespace cg = cooperative_groups; - namespace caspar { __global__ void __launch_bounds__(1024, 1) ChainBPredDecreaseTimesTwoKernel( diff --git a/test/symforce_function_codegen_test_data/symengine/symforce_caspar_tridiagonal_test/kernel_ChainB_pred_decrease_times_two.h b/test/symforce_function_codegen_test_data/symengine/symforce_caspar_tridiagonal_test/kernel_ChainB_pred_decrease_times_two.h index 88b292b1..67d42837 100644 --- a/test/symforce_function_codegen_test_data/symengine/symforce_caspar_tridiagonal_test/kernel_ChainB_pred_decrease_times_two.h +++ b/test/symforce_function_codegen_test_data/symengine/symforce_caspar_tridiagonal_test/kernel_ChainB_pred_decrease_times_two.h @@ -1,7 +1,6 @@ #pragma once -#include - +#include "cuda_to_hip.h" #include "shared_indices.h" namespace caspar { diff --git a/test/symforce_function_codegen_test_data/symengine/symforce_caspar_tridiagonal_test/kernel_ChainB_retract.cu b/test/symforce_function_codegen_test_data/symengine/symforce_caspar_tridiagonal_test/kernel_ChainB_retract.cu index a70477ad..9aed0485 100644 --- a/test/symforce_function_codegen_test_data/symengine/symforce_caspar_tridiagonal_test/kernel_ChainB_retract.cu +++ b/test/symforce_function_codegen_test_data/symengine/symforce_caspar_tridiagonal_test/kernel_ChainB_retract.cu @@ -1,17 +1,10 @@ #include #include -#include -#include -#include -#include -#include - +#include "cuda_to_hip.h" #include "kernel_ChainB_retract.h" #include "memops.cuh" -namespace cg = cooperative_groups; - namespace caspar { __global__ void __launch_bounds__(1024, 1) diff --git a/test/symforce_function_codegen_test_data/symengine/symforce_caspar_tridiagonal_test/kernel_ChainB_retract.h b/test/symforce_function_codegen_test_data/symengine/symforce_caspar_tridiagonal_test/kernel_ChainB_retract.h index 4b7699ee..16aded79 100644 --- a/test/symforce_function_codegen_test_data/symengine/symforce_caspar_tridiagonal_test/kernel_ChainB_retract.h +++ b/test/symforce_function_codegen_test_data/symengine/symforce_caspar_tridiagonal_test/kernel_ChainB_retract.h @@ -1,7 +1,6 @@ #pragma once -#include - +#include "cuda_to_hip.h" #include "shared_indices.h" namespace caspar { diff --git a/test/symforce_function_codegen_test_data/symengine/symforce_caspar_tridiagonal_test/kernel_ChainB_start_w.cu b/test/symforce_function_codegen_test_data/symengine/symforce_caspar_tridiagonal_test/kernel_ChainB_start_w.cu index b704e6e7..e398255b 100644 --- a/test/symforce_function_codegen_test_data/symengine/symforce_caspar_tridiagonal_test/kernel_ChainB_start_w.cu +++ b/test/symforce_function_codegen_test_data/symengine/symforce_caspar_tridiagonal_test/kernel_ChainB_start_w.cu @@ -1,17 +1,10 @@ #include #include -#include -#include -#include -#include -#include - +#include "cuda_to_hip.h" #include "kernel_ChainB_start_w.h" #include "memops.cuh" -namespace cg = cooperative_groups; - namespace caspar { __global__ void __launch_bounds__(1024, 1) diff --git a/test/symforce_function_codegen_test_data/symengine/symforce_caspar_tridiagonal_test/kernel_ChainB_start_w.h b/test/symforce_function_codegen_test_data/symengine/symforce_caspar_tridiagonal_test/kernel_ChainB_start_w.h index 537d1853..6163eb68 100644 --- a/test/symforce_function_codegen_test_data/symengine/symforce_caspar_tridiagonal_test/kernel_ChainB_start_w.h +++ b/test/symforce_function_codegen_test_data/symengine/symforce_caspar_tridiagonal_test/kernel_ChainB_start_w.h @@ -1,7 +1,6 @@ #pragma once -#include - +#include "cuda_to_hip.h" #include "shared_indices.h" namespace caspar { diff --git a/test/symforce_function_codegen_test_data/symengine/symforce_caspar_tridiagonal_test/kernel_ChainB_start_w_contribute.cu b/test/symforce_function_codegen_test_data/symengine/symforce_caspar_tridiagonal_test/kernel_ChainB_start_w_contribute.cu index e1dbea27..5b527170 100644 --- a/test/symforce_function_codegen_test_data/symengine/symforce_caspar_tridiagonal_test/kernel_ChainB_start_w_contribute.cu +++ b/test/symforce_function_codegen_test_data/symengine/symforce_caspar_tridiagonal_test/kernel_ChainB_start_w_contribute.cu @@ -1,17 +1,10 @@ #include #include -#include -#include -#include -#include -#include - +#include "cuda_to_hip.h" #include "kernel_ChainB_start_w_contribute.h" #include "memops.cuh" -namespace cg = cooperative_groups; - namespace caspar { __global__ void __launch_bounds__(1024, 1) diff --git a/test/symforce_function_codegen_test_data/symengine/symforce_caspar_tridiagonal_test/kernel_ChainB_start_w_contribute.h b/test/symforce_function_codegen_test_data/symengine/symforce_caspar_tridiagonal_test/kernel_ChainB_start_w_contribute.h index 5ccd0fd1..a7fd62c0 100644 --- a/test/symforce_function_codegen_test_data/symengine/symforce_caspar_tridiagonal_test/kernel_ChainB_start_w_contribute.h +++ b/test/symforce_function_codegen_test_data/symengine/symforce_caspar_tridiagonal_test/kernel_ChainB_start_w_contribute.h @@ -1,7 +1,6 @@ #pragma once -#include - +#include "cuda_to_hip.h" #include "shared_indices.h" namespace caspar { diff --git a/test/symforce_function_codegen_test_data/symengine/symforce_caspar_tridiagonal_test/kernel_ChainB_tridig_make_eq.cu b/test/symforce_function_codegen_test_data/symengine/symforce_caspar_tridiagonal_test/kernel_ChainB_tridig_make_eq.cu index d6d1fb4b..8a566df8 100644 --- a/test/symforce_function_codegen_test_data/symengine/symforce_caspar_tridiagonal_test/kernel_ChainB_tridig_make_eq.cu +++ b/test/symforce_function_codegen_test_data/symengine/symforce_caspar_tridiagonal_test/kernel_ChainB_tridig_make_eq.cu @@ -1,17 +1,10 @@ #include #include -#include -#include -#include -#include -#include - +#include "cuda_to_hip.h" #include "kernel_ChainB_tridig_make_eq.h" #include "memops.cuh" -namespace cg = cooperative_groups; - namespace caspar { __global__ void __launch_bounds__(1024, 1) diff --git a/test/symforce_function_codegen_test_data/symengine/symforce_caspar_tridiagonal_test/kernel_ChainB_tridig_make_eq.h b/test/symforce_function_codegen_test_data/symengine/symforce_caspar_tridiagonal_test/kernel_ChainB_tridig_make_eq.h index 8872219e..56daa017 100644 --- a/test/symforce_function_codegen_test_data/symengine/symforce_caspar_tridiagonal_test/kernel_ChainB_tridig_make_eq.h +++ b/test/symforce_function_codegen_test_data/symengine/symforce_caspar_tridiagonal_test/kernel_ChainB_tridig_make_eq.h @@ -1,7 +1,6 @@ #pragma once -#include - +#include "cuda_to_hip.h" #include "shared_indices.h" namespace caspar { diff --git a/test/symforce_function_codegen_test_data/symengine/symforce_caspar_tridiagonal_test/kernel_ChainB_update_Mp.cu b/test/symforce_function_codegen_test_data/symengine/symforce_caspar_tridiagonal_test/kernel_ChainB_update_Mp.cu index 479a3026..033982da 100644 --- a/test/symforce_function_codegen_test_data/symengine/symforce_caspar_tridiagonal_test/kernel_ChainB_update_Mp.cu +++ b/test/symforce_function_codegen_test_data/symengine/symforce_caspar_tridiagonal_test/kernel_ChainB_update_Mp.cu @@ -1,17 +1,10 @@ #include #include -#include -#include -#include -#include -#include - +#include "cuda_to_hip.h" #include "kernel_ChainB_update_Mp.h" #include "memops.cuh" -namespace cg = cooperative_groups; - namespace caspar { __global__ void __launch_bounds__(1024, 1) diff --git a/test/symforce_function_codegen_test_data/symengine/symforce_caspar_tridiagonal_test/kernel_ChainB_update_Mp.h b/test/symforce_function_codegen_test_data/symengine/symforce_caspar_tridiagonal_test/kernel_ChainB_update_Mp.h index 13c7935f..21c02603 100644 --- a/test/symforce_function_codegen_test_data/symengine/symforce_caspar_tridiagonal_test/kernel_ChainB_update_Mp.h +++ b/test/symforce_function_codegen_test_data/symengine/symforce_caspar_tridiagonal_test/kernel_ChainB_update_Mp.h @@ -1,7 +1,6 @@ #pragma once -#include - +#include "cuda_to_hip.h" #include "shared_indices.h" namespace caspar { diff --git a/test/symforce_function_codegen_test_data/symengine/symforce_caspar_tridiagonal_test/kernel_ChainB_update_p.cu b/test/symforce_function_codegen_test_data/symengine/symforce_caspar_tridiagonal_test/kernel_ChainB_update_p.cu index e2a6843d..cdaec3d8 100644 --- a/test/symforce_function_codegen_test_data/symengine/symforce_caspar_tridiagonal_test/kernel_ChainB_update_p.cu +++ b/test/symforce_function_codegen_test_data/symengine/symforce_caspar_tridiagonal_test/kernel_ChainB_update_p.cu @@ -1,17 +1,10 @@ #include #include -#include -#include -#include -#include -#include - +#include "cuda_to_hip.h" #include "kernel_ChainB_update_p.h" #include "memops.cuh" -namespace cg = cooperative_groups; - namespace caspar { __global__ void __launch_bounds__(1024, 1) diff --git a/test/symforce_function_codegen_test_data/symengine/symforce_caspar_tridiagonal_test/kernel_ChainB_update_p.h b/test/symforce_function_codegen_test_data/symengine/symforce_caspar_tridiagonal_test/kernel_ChainB_update_p.h index 3c6125d5..4dd63968 100644 --- a/test/symforce_function_codegen_test_data/symengine/symforce_caspar_tridiagonal_test/kernel_ChainB_update_p.h +++ b/test/symforce_function_codegen_test_data/symengine/symforce_caspar_tridiagonal_test/kernel_ChainB_update_p.h @@ -1,7 +1,6 @@ #pragma once -#include - +#include "cuda_to_hip.h" #include "shared_indices.h" namespace caspar { diff --git a/test/symforce_function_codegen_test_data/symengine/symforce_caspar_tridiagonal_test/kernel_ChainB_update_r.cu b/test/symforce_function_codegen_test_data/symengine/symforce_caspar_tridiagonal_test/kernel_ChainB_update_r.cu index 355656ca..fb60a073 100644 --- a/test/symforce_function_codegen_test_data/symengine/symforce_caspar_tridiagonal_test/kernel_ChainB_update_r.cu +++ b/test/symforce_function_codegen_test_data/symengine/symforce_caspar_tridiagonal_test/kernel_ChainB_update_r.cu @@ -1,17 +1,10 @@ #include #include -#include -#include -#include -#include -#include - +#include "cuda_to_hip.h" #include "kernel_ChainB_update_r.h" #include "memops.cuh" -namespace cg = cooperative_groups; - namespace caspar { __global__ void __launch_bounds__(1024, 1) diff --git a/test/symforce_function_codegen_test_data/symengine/symforce_caspar_tridiagonal_test/kernel_ChainB_update_r.h b/test/symforce_function_codegen_test_data/symengine/symforce_caspar_tridiagonal_test/kernel_ChainB_update_r.h index c8eb9f28..2268a65b 100644 --- a/test/symforce_function_codegen_test_data/symengine/symforce_caspar_tridiagonal_test/kernel_ChainB_update_r.h +++ b/test/symforce_function_codegen_test_data/symengine/symforce_caspar_tridiagonal_test/kernel_ChainB_update_r.h @@ -1,7 +1,6 @@ #pragma once -#include - +#include "cuda_to_hip.h" #include "shared_indices.h" namespace caspar { diff --git a/test/symforce_function_codegen_test_data/symengine/symforce_caspar_tridiagonal_test/kernel_ChainB_update_r_first.cu b/test/symforce_function_codegen_test_data/symengine/symforce_caspar_tridiagonal_test/kernel_ChainB_update_r_first.cu index 9f7c746f..2426e9a5 100644 --- a/test/symforce_function_codegen_test_data/symengine/symforce_caspar_tridiagonal_test/kernel_ChainB_update_r_first.cu +++ b/test/symforce_function_codegen_test_data/symengine/symforce_caspar_tridiagonal_test/kernel_ChainB_update_r_first.cu @@ -1,17 +1,10 @@ #include #include -#include -#include -#include -#include -#include - +#include "cuda_to_hip.h" #include "kernel_ChainB_update_r_first.h" #include "memops.cuh" -namespace cg = cooperative_groups; - namespace caspar { __global__ void __launch_bounds__(1024, 1) diff --git a/test/symforce_function_codegen_test_data/symengine/symforce_caspar_tridiagonal_test/kernel_ChainB_update_r_first.h b/test/symforce_function_codegen_test_data/symengine/symforce_caspar_tridiagonal_test/kernel_ChainB_update_r_first.h index 1ff22f75..27bc58a9 100644 --- a/test/symforce_function_codegen_test_data/symengine/symforce_caspar_tridiagonal_test/kernel_ChainB_update_r_first.h +++ b/test/symforce_function_codegen_test_data/symengine/symforce_caspar_tridiagonal_test/kernel_ChainB_update_r_first.h @@ -1,7 +1,6 @@ #pragma once -#include - +#include "cuda_to_hip.h" #include "shared_indices.h" namespace caspar { diff --git a/test/symforce_function_codegen_test_data/symengine/symforce_caspar_tridiagonal_test/kernel_ChainB_update_step.cu b/test/symforce_function_codegen_test_data/symengine/symforce_caspar_tridiagonal_test/kernel_ChainB_update_step.cu index 9cd0cc24..bd0cac85 100644 --- a/test/symforce_function_codegen_test_data/symengine/symforce_caspar_tridiagonal_test/kernel_ChainB_update_step.cu +++ b/test/symforce_function_codegen_test_data/symengine/symforce_caspar_tridiagonal_test/kernel_ChainB_update_step.cu @@ -1,17 +1,10 @@ #include #include -#include -#include -#include -#include -#include - +#include "cuda_to_hip.h" #include "kernel_ChainB_update_step.h" #include "memops.cuh" -namespace cg = cooperative_groups; - namespace caspar { __global__ void __launch_bounds__(1024, 1) diff --git a/test/symforce_function_codegen_test_data/symengine/symforce_caspar_tridiagonal_test/kernel_ChainB_update_step.h b/test/symforce_function_codegen_test_data/symengine/symforce_caspar_tridiagonal_test/kernel_ChainB_update_step.h index 006779e7..eeb880b1 100644 --- a/test/symforce_function_codegen_test_data/symengine/symforce_caspar_tridiagonal_test/kernel_ChainB_update_step.h +++ b/test/symforce_function_codegen_test_data/symengine/symforce_caspar_tridiagonal_test/kernel_ChainB_update_step.h @@ -1,7 +1,6 @@ #pragma once -#include - +#include "cuda_to_hip.h" #include "shared_indices.h" namespace caspar { diff --git a/test/symforce_function_codegen_test_data/symengine/symforce_caspar_tridiagonal_test/kernel_ChainB_update_step_first.cu b/test/symforce_function_codegen_test_data/symengine/symforce_caspar_tridiagonal_test/kernel_ChainB_update_step_first.cu index e3f1301d..c332c87b 100644 --- a/test/symforce_function_codegen_test_data/symengine/symforce_caspar_tridiagonal_test/kernel_ChainB_update_step_first.cu +++ b/test/symforce_function_codegen_test_data/symengine/symforce_caspar_tridiagonal_test/kernel_ChainB_update_step_first.cu @@ -1,17 +1,10 @@ #include #include -#include -#include -#include -#include -#include - +#include "cuda_to_hip.h" #include "kernel_ChainB_update_step_first.h" #include "memops.cuh" -namespace cg = cooperative_groups; - namespace caspar { __global__ void __launch_bounds__(1024, 1) diff --git a/test/symforce_function_codegen_test_data/symengine/symforce_caspar_tridiagonal_test/kernel_ChainB_update_step_first.h b/test/symforce_function_codegen_test_data/symengine/symforce_caspar_tridiagonal_test/kernel_ChainB_update_step_first.h index 1036592e..caf242c5 100644 --- a/test/symforce_function_codegen_test_data/symengine/symforce_caspar_tridiagonal_test/kernel_ChainB_update_step_first.h +++ b/test/symforce_function_codegen_test_data/symengine/symforce_caspar_tridiagonal_test/kernel_ChainB_update_step_first.h @@ -1,7 +1,6 @@ #pragma once -#include - +#include "cuda_to_hip.h" #include "shared_indices.h" namespace caspar { diff --git a/test/symforce_function_codegen_test_data/symengine/symforce_caspar_tridiagonal_test/kernel_chain_a_link_jtjnjtr_direct.cu b/test/symforce_function_codegen_test_data/symengine/symforce_caspar_tridiagonal_test/kernel_chain_a_link_jtjnjtr_direct.cu index 369a87ed..f7d98995 100644 --- a/test/symforce_function_codegen_test_data/symengine/symforce_caspar_tridiagonal_test/kernel_chain_a_link_jtjnjtr_direct.cu +++ b/test/symforce_function_codegen_test_data/symengine/symforce_caspar_tridiagonal_test/kernel_chain_a_link_jtjnjtr_direct.cu @@ -1,17 +1,10 @@ #include #include -#include -#include -#include -#include -#include - +#include "cuda_to_hip.h" #include "kernel_chain_a_link_jtjnjtr_direct.h" #include "memops.cuh" -namespace cg = cooperative_groups; - namespace caspar { __global__ void __launch_bounds__(1024, 1) diff --git a/test/symforce_function_codegen_test_data/symengine/symforce_caspar_tridiagonal_test/kernel_chain_a_link_jtjnjtr_direct.h b/test/symforce_function_codegen_test_data/symengine/symforce_caspar_tridiagonal_test/kernel_chain_a_link_jtjnjtr_direct.h index ed6ae6d4..02d71b44 100644 --- a/test/symforce_function_codegen_test_data/symengine/symforce_caspar_tridiagonal_test/kernel_chain_a_link_jtjnjtr_direct.h +++ b/test/symforce_function_codegen_test_data/symengine/symforce_caspar_tridiagonal_test/kernel_chain_a_link_jtjnjtr_direct.h @@ -1,7 +1,6 @@ #pragma once -#include - +#include "cuda_to_hip.h" #include "shared_indices.h" namespace caspar { diff --git a/test/symforce_function_codegen_test_data/symengine/symforce_caspar_tridiagonal_test/kernel_chain_a_link_res_jac.cu b/test/symforce_function_codegen_test_data/symengine/symforce_caspar_tridiagonal_test/kernel_chain_a_link_res_jac.cu index 7495787b..9545daf0 100644 --- a/test/symforce_function_codegen_test_data/symengine/symforce_caspar_tridiagonal_test/kernel_chain_a_link_res_jac.cu +++ b/test/symforce_function_codegen_test_data/symengine/symforce_caspar_tridiagonal_test/kernel_chain_a_link_res_jac.cu @@ -1,17 +1,10 @@ #include #include -#include -#include -#include -#include -#include - +#include "cuda_to_hip.h" #include "kernel_chain_a_link_res_jac.h" #include "memops.cuh" -namespace cg = cooperative_groups; - namespace caspar { __global__ void __launch_bounds__(1024, 1) ChainALinkResJacKernel( diff --git a/test/symforce_function_codegen_test_data/symengine/symforce_caspar_tridiagonal_test/kernel_chain_a_link_res_jac.h b/test/symforce_function_codegen_test_data/symengine/symforce_caspar_tridiagonal_test/kernel_chain_a_link_res_jac.h index 28cff54b..b91e80a3 100644 --- a/test/symforce_function_codegen_test_data/symengine/symforce_caspar_tridiagonal_test/kernel_chain_a_link_res_jac.h +++ b/test/symforce_function_codegen_test_data/symengine/symforce_caspar_tridiagonal_test/kernel_chain_a_link_res_jac.h @@ -1,7 +1,6 @@ #pragma once -#include - +#include "cuda_to_hip.h" #include "shared_indices.h" namespace caspar { diff --git a/test/symforce_function_codegen_test_data/symengine/symforce_caspar_tridiagonal_test/kernel_chain_a_link_res_jac_first.cu b/test/symforce_function_codegen_test_data/symengine/symforce_caspar_tridiagonal_test/kernel_chain_a_link_res_jac_first.cu index df421ac3..cc6e6e35 100644 --- a/test/symforce_function_codegen_test_data/symengine/symforce_caspar_tridiagonal_test/kernel_chain_a_link_res_jac_first.cu +++ b/test/symforce_function_codegen_test_data/symengine/symforce_caspar_tridiagonal_test/kernel_chain_a_link_res_jac_first.cu @@ -1,17 +1,10 @@ #include #include -#include -#include -#include -#include -#include - +#include "cuda_to_hip.h" #include "kernel_chain_a_link_res_jac_first.h" #include "memops.cuh" -namespace cg = cooperative_groups; - namespace caspar { __global__ void __launch_bounds__(1024, 1) ChainALinkResJacFirstKernel( diff --git a/test/symforce_function_codegen_test_data/symengine/symforce_caspar_tridiagonal_test/kernel_chain_a_link_res_jac_first.h b/test/symforce_function_codegen_test_data/symengine/symforce_caspar_tridiagonal_test/kernel_chain_a_link_res_jac_first.h index b757536c..64422a63 100644 --- a/test/symforce_function_codegen_test_data/symengine/symforce_caspar_tridiagonal_test/kernel_chain_a_link_res_jac_first.h +++ b/test/symforce_function_codegen_test_data/symengine/symforce_caspar_tridiagonal_test/kernel_chain_a_link_res_jac_first.h @@ -1,7 +1,6 @@ #pragma once -#include - +#include "cuda_to_hip.h" #include "shared_indices.h" namespace caspar { diff --git a/test/symforce_function_codegen_test_data/symengine/symforce_caspar_tridiagonal_test/kernel_chain_a_link_score.cu b/test/symforce_function_codegen_test_data/symengine/symforce_caspar_tridiagonal_test/kernel_chain_a_link_score.cu index 50df9650..969b30f8 100644 --- a/test/symforce_function_codegen_test_data/symengine/symforce_caspar_tridiagonal_test/kernel_chain_a_link_score.cu +++ b/test/symforce_function_codegen_test_data/symengine/symforce_caspar_tridiagonal_test/kernel_chain_a_link_score.cu @@ -1,17 +1,10 @@ #include #include -#include -#include -#include -#include -#include - +#include "cuda_to_hip.h" #include "kernel_chain_a_link_score.h" #include "memops.cuh" -namespace cg = cooperative_groups; - namespace caspar { __global__ void __launch_bounds__(1024, 1) diff --git a/test/symforce_function_codegen_test_data/symengine/symforce_caspar_tridiagonal_test/kernel_chain_a_link_score.h b/test/symforce_function_codegen_test_data/symengine/symforce_caspar_tridiagonal_test/kernel_chain_a_link_score.h index 633032eb..35749c52 100644 --- a/test/symforce_function_codegen_test_data/symengine/symforce_caspar_tridiagonal_test/kernel_chain_a_link_score.h +++ b/test/symforce_function_codegen_test_data/symengine/symforce_caspar_tridiagonal_test/kernel_chain_a_link_score.h @@ -1,7 +1,6 @@ #pragma once -#include - +#include "cuda_to_hip.h" #include "shared_indices.h" namespace caspar { diff --git a/test/symforce_function_codegen_test_data/symengine/symforce_caspar_tridiagonal_test/kernel_chain_a_prior_jtjnjtr_direct.cu b/test/symforce_function_codegen_test_data/symengine/symforce_caspar_tridiagonal_test/kernel_chain_a_prior_jtjnjtr_direct.cu index 4f00ae2b..372cb17d 100644 --- a/test/symforce_function_codegen_test_data/symengine/symforce_caspar_tridiagonal_test/kernel_chain_a_prior_jtjnjtr_direct.cu +++ b/test/symforce_function_codegen_test_data/symengine/symforce_caspar_tridiagonal_test/kernel_chain_a_prior_jtjnjtr_direct.cu @@ -1,17 +1,10 @@ #include #include -#include -#include -#include -#include -#include - +#include "cuda_to_hip.h" #include "kernel_chain_a_prior_jtjnjtr_direct.h" #include "memops.cuh" -namespace cg = cooperative_groups; - namespace caspar { __global__ void __launch_bounds__(1024, 1) diff --git a/test/symforce_function_codegen_test_data/symengine/symforce_caspar_tridiagonal_test/kernel_chain_a_prior_jtjnjtr_direct.h b/test/symforce_function_codegen_test_data/symengine/symforce_caspar_tridiagonal_test/kernel_chain_a_prior_jtjnjtr_direct.h index 1f456876..f2c87bf4 100644 --- a/test/symforce_function_codegen_test_data/symengine/symforce_caspar_tridiagonal_test/kernel_chain_a_prior_jtjnjtr_direct.h +++ b/test/symforce_function_codegen_test_data/symengine/symforce_caspar_tridiagonal_test/kernel_chain_a_prior_jtjnjtr_direct.h @@ -1,7 +1,6 @@ #pragma once -#include - +#include "cuda_to_hip.h" #include "shared_indices.h" namespace caspar { diff --git a/test/symforce_function_codegen_test_data/symengine/symforce_caspar_tridiagonal_test/kernel_chain_a_prior_res_jac.cu b/test/symforce_function_codegen_test_data/symengine/symforce_caspar_tridiagonal_test/kernel_chain_a_prior_res_jac.cu index 7da8cd8d..c38f5fe9 100644 --- a/test/symforce_function_codegen_test_data/symengine/symforce_caspar_tridiagonal_test/kernel_chain_a_prior_res_jac.cu +++ b/test/symforce_function_codegen_test_data/symengine/symforce_caspar_tridiagonal_test/kernel_chain_a_prior_res_jac.cu @@ -1,17 +1,10 @@ #include #include -#include -#include -#include -#include -#include - +#include "cuda_to_hip.h" #include "kernel_chain_a_prior_res_jac.h" #include "memops.cuh" -namespace cg = cooperative_groups; - namespace caspar { __global__ void __launch_bounds__(1024, 1) diff --git a/test/symforce_function_codegen_test_data/symengine/symforce_caspar_tridiagonal_test/kernel_chain_a_prior_res_jac.h b/test/symforce_function_codegen_test_data/symengine/symforce_caspar_tridiagonal_test/kernel_chain_a_prior_res_jac.h index 5ca63a90..c23d38b9 100644 --- a/test/symforce_function_codegen_test_data/symengine/symforce_caspar_tridiagonal_test/kernel_chain_a_prior_res_jac.h +++ b/test/symforce_function_codegen_test_data/symengine/symforce_caspar_tridiagonal_test/kernel_chain_a_prior_res_jac.h @@ -1,7 +1,6 @@ #pragma once -#include - +#include "cuda_to_hip.h" #include "shared_indices.h" namespace caspar { diff --git a/test/symforce_function_codegen_test_data/symengine/symforce_caspar_tridiagonal_test/kernel_chain_a_prior_res_jac_first.cu b/test/symforce_function_codegen_test_data/symengine/symforce_caspar_tridiagonal_test/kernel_chain_a_prior_res_jac_first.cu index ddbab613..b2e6a226 100644 --- a/test/symforce_function_codegen_test_data/symengine/symforce_caspar_tridiagonal_test/kernel_chain_a_prior_res_jac_first.cu +++ b/test/symforce_function_codegen_test_data/symengine/symforce_caspar_tridiagonal_test/kernel_chain_a_prior_res_jac_first.cu @@ -1,17 +1,10 @@ #include #include -#include -#include -#include -#include -#include - +#include "cuda_to_hip.h" #include "kernel_chain_a_prior_res_jac_first.h" #include "memops.cuh" -namespace cg = cooperative_groups; - namespace caspar { __global__ void __launch_bounds__(1024, 1) diff --git a/test/symforce_function_codegen_test_data/symengine/symforce_caspar_tridiagonal_test/kernel_chain_a_prior_res_jac_first.h b/test/symforce_function_codegen_test_data/symengine/symforce_caspar_tridiagonal_test/kernel_chain_a_prior_res_jac_first.h index 3cdceb88..f678cda1 100644 --- a/test/symforce_function_codegen_test_data/symengine/symforce_caspar_tridiagonal_test/kernel_chain_a_prior_res_jac_first.h +++ b/test/symforce_function_codegen_test_data/symengine/symforce_caspar_tridiagonal_test/kernel_chain_a_prior_res_jac_first.h @@ -1,7 +1,6 @@ #pragma once -#include - +#include "cuda_to_hip.h" #include "shared_indices.h" namespace caspar { diff --git a/test/symforce_function_codegen_test_data/symengine/symforce_caspar_tridiagonal_test/kernel_chain_a_prior_score.cu b/test/symforce_function_codegen_test_data/symengine/symforce_caspar_tridiagonal_test/kernel_chain_a_prior_score.cu index 6335d83c..90275926 100644 --- a/test/symforce_function_codegen_test_data/symengine/symforce_caspar_tridiagonal_test/kernel_chain_a_prior_score.cu +++ b/test/symforce_function_codegen_test_data/symengine/symforce_caspar_tridiagonal_test/kernel_chain_a_prior_score.cu @@ -1,17 +1,10 @@ #include #include -#include -#include -#include -#include -#include - +#include "cuda_to_hip.h" #include "kernel_chain_a_prior_score.h" #include "memops.cuh" -namespace cg = cooperative_groups; - namespace caspar { __global__ void __launch_bounds__(1024, 1) diff --git a/test/symforce_function_codegen_test_data/symengine/symforce_caspar_tridiagonal_test/kernel_chain_a_prior_score.h b/test/symforce_function_codegen_test_data/symengine/symforce_caspar_tridiagonal_test/kernel_chain_a_prior_score.h index f380ace1..10b0b6b9 100644 --- a/test/symforce_function_codegen_test_data/symengine/symforce_caspar_tridiagonal_test/kernel_chain_a_prior_score.h +++ b/test/symforce_function_codegen_test_data/symengine/symforce_caspar_tridiagonal_test/kernel_chain_a_prior_score.h @@ -1,7 +1,6 @@ #pragma once -#include - +#include "cuda_to_hip.h" #include "shared_indices.h" namespace caspar { diff --git a/test/symforce_function_codegen_test_data/symengine/symforce_caspar_tridiagonal_test/kernel_chain_b_link_jtjnjtr_direct.cu b/test/symforce_function_codegen_test_data/symengine/symforce_caspar_tridiagonal_test/kernel_chain_b_link_jtjnjtr_direct.cu index 3b336af2..61df87a9 100644 --- a/test/symforce_function_codegen_test_data/symengine/symforce_caspar_tridiagonal_test/kernel_chain_b_link_jtjnjtr_direct.cu +++ b/test/symforce_function_codegen_test_data/symengine/symforce_caspar_tridiagonal_test/kernel_chain_b_link_jtjnjtr_direct.cu @@ -1,17 +1,10 @@ #include #include -#include -#include -#include -#include -#include - +#include "cuda_to_hip.h" #include "kernel_chain_b_link_jtjnjtr_direct.h" #include "memops.cuh" -namespace cg = cooperative_groups; - namespace caspar { __global__ void __launch_bounds__(1024, 1) diff --git a/test/symforce_function_codegen_test_data/symengine/symforce_caspar_tridiagonal_test/kernel_chain_b_link_jtjnjtr_direct.h b/test/symforce_function_codegen_test_data/symengine/symforce_caspar_tridiagonal_test/kernel_chain_b_link_jtjnjtr_direct.h index de1461c2..5721bcce 100644 --- a/test/symforce_function_codegen_test_data/symengine/symforce_caspar_tridiagonal_test/kernel_chain_b_link_jtjnjtr_direct.h +++ b/test/symforce_function_codegen_test_data/symengine/symforce_caspar_tridiagonal_test/kernel_chain_b_link_jtjnjtr_direct.h @@ -1,7 +1,6 @@ #pragma once -#include - +#include "cuda_to_hip.h" #include "shared_indices.h" namespace caspar { diff --git a/test/symforce_function_codegen_test_data/symengine/symforce_caspar_tridiagonal_test/kernel_chain_b_link_res_jac.cu b/test/symforce_function_codegen_test_data/symengine/symforce_caspar_tridiagonal_test/kernel_chain_b_link_res_jac.cu index 4642b781..30281b27 100644 --- a/test/symforce_function_codegen_test_data/symengine/symforce_caspar_tridiagonal_test/kernel_chain_b_link_res_jac.cu +++ b/test/symforce_function_codegen_test_data/symengine/symforce_caspar_tridiagonal_test/kernel_chain_b_link_res_jac.cu @@ -1,17 +1,10 @@ #include #include -#include -#include -#include -#include -#include - +#include "cuda_to_hip.h" #include "kernel_chain_b_link_res_jac.h" #include "memops.cuh" -namespace cg = cooperative_groups; - namespace caspar { __global__ void __launch_bounds__(1024, 1) ChainBLinkResJacKernel( diff --git a/test/symforce_function_codegen_test_data/symengine/symforce_caspar_tridiagonal_test/kernel_chain_b_link_res_jac.h b/test/symforce_function_codegen_test_data/symengine/symforce_caspar_tridiagonal_test/kernel_chain_b_link_res_jac.h index d3ca19d4..6355e2b6 100644 --- a/test/symforce_function_codegen_test_data/symengine/symforce_caspar_tridiagonal_test/kernel_chain_b_link_res_jac.h +++ b/test/symforce_function_codegen_test_data/symengine/symforce_caspar_tridiagonal_test/kernel_chain_b_link_res_jac.h @@ -1,7 +1,6 @@ #pragma once -#include - +#include "cuda_to_hip.h" #include "shared_indices.h" namespace caspar { diff --git a/test/symforce_function_codegen_test_data/symengine/symforce_caspar_tridiagonal_test/kernel_chain_b_link_res_jac_first.cu b/test/symforce_function_codegen_test_data/symengine/symforce_caspar_tridiagonal_test/kernel_chain_b_link_res_jac_first.cu index 22ff48f3..ac1d68cf 100644 --- a/test/symforce_function_codegen_test_data/symengine/symforce_caspar_tridiagonal_test/kernel_chain_b_link_res_jac_first.cu +++ b/test/symforce_function_codegen_test_data/symengine/symforce_caspar_tridiagonal_test/kernel_chain_b_link_res_jac_first.cu @@ -1,17 +1,10 @@ #include #include -#include -#include -#include -#include -#include - +#include "cuda_to_hip.h" #include "kernel_chain_b_link_res_jac_first.h" #include "memops.cuh" -namespace cg = cooperative_groups; - namespace caspar { __global__ void __launch_bounds__(1024, 1) ChainBLinkResJacFirstKernel( diff --git a/test/symforce_function_codegen_test_data/symengine/symforce_caspar_tridiagonal_test/kernel_chain_b_link_res_jac_first.h b/test/symforce_function_codegen_test_data/symengine/symforce_caspar_tridiagonal_test/kernel_chain_b_link_res_jac_first.h index 748c5f8e..3278e5ab 100644 --- a/test/symforce_function_codegen_test_data/symengine/symforce_caspar_tridiagonal_test/kernel_chain_b_link_res_jac_first.h +++ b/test/symforce_function_codegen_test_data/symengine/symforce_caspar_tridiagonal_test/kernel_chain_b_link_res_jac_first.h @@ -1,7 +1,6 @@ #pragma once -#include - +#include "cuda_to_hip.h" #include "shared_indices.h" namespace caspar { diff --git a/test/symforce_function_codegen_test_data/symengine/symforce_caspar_tridiagonal_test/kernel_chain_b_link_score.cu b/test/symforce_function_codegen_test_data/symengine/symforce_caspar_tridiagonal_test/kernel_chain_b_link_score.cu index 5fb16e3b..24aba18a 100644 --- a/test/symforce_function_codegen_test_data/symengine/symforce_caspar_tridiagonal_test/kernel_chain_b_link_score.cu +++ b/test/symforce_function_codegen_test_data/symengine/symforce_caspar_tridiagonal_test/kernel_chain_b_link_score.cu @@ -1,17 +1,10 @@ #include #include -#include -#include -#include -#include -#include - +#include "cuda_to_hip.h" #include "kernel_chain_b_link_score.h" #include "memops.cuh" -namespace cg = cooperative_groups; - namespace caspar { __global__ void __launch_bounds__(1024, 1) diff --git a/test/symforce_function_codegen_test_data/symengine/symforce_caspar_tridiagonal_test/kernel_chain_b_link_score.h b/test/symforce_function_codegen_test_data/symengine/symforce_caspar_tridiagonal_test/kernel_chain_b_link_score.h index c7986d12..2ba36574 100644 --- a/test/symforce_function_codegen_test_data/symengine/symforce_caspar_tridiagonal_test/kernel_chain_b_link_score.h +++ b/test/symforce_function_codegen_test_data/symengine/symforce_caspar_tridiagonal_test/kernel_chain_b_link_score.h @@ -1,7 +1,6 @@ #pragma once -#include - +#include "cuda_to_hip.h" #include "shared_indices.h" namespace caspar { diff --git a/test/symforce_function_codegen_test_data/symengine/symforce_caspar_tridiagonal_test/kernel_chain_b_prior_jtjnjtr_direct.cu b/test/symforce_function_codegen_test_data/symengine/symforce_caspar_tridiagonal_test/kernel_chain_b_prior_jtjnjtr_direct.cu index fad4fa17..6b67dae7 100644 --- a/test/symforce_function_codegen_test_data/symengine/symforce_caspar_tridiagonal_test/kernel_chain_b_prior_jtjnjtr_direct.cu +++ b/test/symforce_function_codegen_test_data/symengine/symforce_caspar_tridiagonal_test/kernel_chain_b_prior_jtjnjtr_direct.cu @@ -1,17 +1,10 @@ #include #include -#include -#include -#include -#include -#include - +#include "cuda_to_hip.h" #include "kernel_chain_b_prior_jtjnjtr_direct.h" #include "memops.cuh" -namespace cg = cooperative_groups; - namespace caspar { __global__ void __launch_bounds__(1024, 1) diff --git a/test/symforce_function_codegen_test_data/symengine/symforce_caspar_tridiagonal_test/kernel_chain_b_prior_jtjnjtr_direct.h b/test/symforce_function_codegen_test_data/symengine/symforce_caspar_tridiagonal_test/kernel_chain_b_prior_jtjnjtr_direct.h index 34f3b745..16c36b08 100644 --- a/test/symforce_function_codegen_test_data/symengine/symforce_caspar_tridiagonal_test/kernel_chain_b_prior_jtjnjtr_direct.h +++ b/test/symforce_function_codegen_test_data/symengine/symforce_caspar_tridiagonal_test/kernel_chain_b_prior_jtjnjtr_direct.h @@ -1,7 +1,6 @@ #pragma once -#include - +#include "cuda_to_hip.h" #include "shared_indices.h" namespace caspar { diff --git a/test/symforce_function_codegen_test_data/symengine/symforce_caspar_tridiagonal_test/kernel_chain_b_prior_res_jac.cu b/test/symforce_function_codegen_test_data/symengine/symforce_caspar_tridiagonal_test/kernel_chain_b_prior_res_jac.cu index 1d01a9ea..d66f18b7 100644 --- a/test/symforce_function_codegen_test_data/symengine/symforce_caspar_tridiagonal_test/kernel_chain_b_prior_res_jac.cu +++ b/test/symforce_function_codegen_test_data/symengine/symforce_caspar_tridiagonal_test/kernel_chain_b_prior_res_jac.cu @@ -1,17 +1,10 @@ #include #include -#include -#include -#include -#include -#include - +#include "cuda_to_hip.h" #include "kernel_chain_b_prior_res_jac.h" #include "memops.cuh" -namespace cg = cooperative_groups; - namespace caspar { __global__ void __launch_bounds__(1024, 1) diff --git a/test/symforce_function_codegen_test_data/symengine/symforce_caspar_tridiagonal_test/kernel_chain_b_prior_res_jac.h b/test/symforce_function_codegen_test_data/symengine/symforce_caspar_tridiagonal_test/kernel_chain_b_prior_res_jac.h index 434b6f81..8f7ae36d 100644 --- a/test/symforce_function_codegen_test_data/symengine/symforce_caspar_tridiagonal_test/kernel_chain_b_prior_res_jac.h +++ b/test/symforce_function_codegen_test_data/symengine/symforce_caspar_tridiagonal_test/kernel_chain_b_prior_res_jac.h @@ -1,7 +1,6 @@ #pragma once -#include - +#include "cuda_to_hip.h" #include "shared_indices.h" namespace caspar { diff --git a/test/symforce_function_codegen_test_data/symengine/symforce_caspar_tridiagonal_test/kernel_chain_b_prior_res_jac_first.cu b/test/symforce_function_codegen_test_data/symengine/symforce_caspar_tridiagonal_test/kernel_chain_b_prior_res_jac_first.cu index a7df9eb8..244f3fce 100644 --- a/test/symforce_function_codegen_test_data/symengine/symforce_caspar_tridiagonal_test/kernel_chain_b_prior_res_jac_first.cu +++ b/test/symforce_function_codegen_test_data/symengine/symforce_caspar_tridiagonal_test/kernel_chain_b_prior_res_jac_first.cu @@ -1,17 +1,10 @@ #include #include -#include -#include -#include -#include -#include - +#include "cuda_to_hip.h" #include "kernel_chain_b_prior_res_jac_first.h" #include "memops.cuh" -namespace cg = cooperative_groups; - namespace caspar { __global__ void __launch_bounds__(1024, 1) diff --git a/test/symforce_function_codegen_test_data/symengine/symforce_caspar_tridiagonal_test/kernel_chain_b_prior_res_jac_first.h b/test/symforce_function_codegen_test_data/symengine/symforce_caspar_tridiagonal_test/kernel_chain_b_prior_res_jac_first.h index 47af0a26..84f2cef8 100644 --- a/test/symforce_function_codegen_test_data/symengine/symforce_caspar_tridiagonal_test/kernel_chain_b_prior_res_jac_first.h +++ b/test/symforce_function_codegen_test_data/symengine/symforce_caspar_tridiagonal_test/kernel_chain_b_prior_res_jac_first.h @@ -1,7 +1,6 @@ #pragma once -#include - +#include "cuda_to_hip.h" #include "shared_indices.h" namespace caspar { diff --git a/test/symforce_function_codegen_test_data/symengine/symforce_caspar_tridiagonal_test/kernel_chain_b_prior_score.cu b/test/symforce_function_codegen_test_data/symengine/symforce_caspar_tridiagonal_test/kernel_chain_b_prior_score.cu index cb476e7f..db6534c9 100644 --- a/test/symforce_function_codegen_test_data/symengine/symforce_caspar_tridiagonal_test/kernel_chain_b_prior_score.cu +++ b/test/symforce_function_codegen_test_data/symengine/symforce_caspar_tridiagonal_test/kernel_chain_b_prior_score.cu @@ -1,17 +1,10 @@ #include #include -#include -#include -#include -#include -#include - +#include "cuda_to_hip.h" #include "kernel_chain_b_prior_score.h" #include "memops.cuh" -namespace cg = cooperative_groups; - namespace caspar { __global__ void __launch_bounds__(1024, 1) diff --git a/test/symforce_function_codegen_test_data/symengine/symforce_caspar_tridiagonal_test/kernel_chain_b_prior_score.h b/test/symforce_function_codegen_test_data/symengine/symforce_caspar_tridiagonal_test/kernel_chain_b_prior_score.h index 239ad096..2d39b16d 100644 --- a/test/symforce_function_codegen_test_data/symengine/symforce_caspar_tridiagonal_test/kernel_chain_b_prior_score.h +++ b/test/symforce_function_codegen_test_data/symengine/symforce_caspar_tridiagonal_test/kernel_chain_b_prior_score.h @@ -1,7 +1,6 @@ #pragma once -#include - +#include "cuda_to_hip.h" #include "shared_indices.h" namespace caspar { diff --git a/test/symforce_function_codegen_test_data/symengine/symforce_caspar_tridiagonal_test/kernel_chain_coupling_jtjnjtr_direct.cu b/test/symforce_function_codegen_test_data/symengine/symforce_caspar_tridiagonal_test/kernel_chain_coupling_jtjnjtr_direct.cu index 5836bbfc..e315f870 100644 --- a/test/symforce_function_codegen_test_data/symengine/symforce_caspar_tridiagonal_test/kernel_chain_coupling_jtjnjtr_direct.cu +++ b/test/symforce_function_codegen_test_data/symengine/symforce_caspar_tridiagonal_test/kernel_chain_coupling_jtjnjtr_direct.cu @@ -1,17 +1,10 @@ #include #include -#include -#include -#include -#include -#include - +#include "cuda_to_hip.h" #include "kernel_chain_coupling_jtjnjtr_direct.h" #include "memops.cuh" -namespace cg = cooperative_groups; - namespace caspar { __global__ void __launch_bounds__(1024, 1) ChainCouplingJtjnjtrDirectKernel( diff --git a/test/symforce_function_codegen_test_data/symengine/symforce_caspar_tridiagonal_test/kernel_chain_coupling_jtjnjtr_direct.h b/test/symforce_function_codegen_test_data/symengine/symforce_caspar_tridiagonal_test/kernel_chain_coupling_jtjnjtr_direct.h index 0f76b031..2369c40f 100644 --- a/test/symforce_function_codegen_test_data/symengine/symforce_caspar_tridiagonal_test/kernel_chain_coupling_jtjnjtr_direct.h +++ b/test/symforce_function_codegen_test_data/symengine/symforce_caspar_tridiagonal_test/kernel_chain_coupling_jtjnjtr_direct.h @@ -1,7 +1,6 @@ #pragma once -#include - +#include "cuda_to_hip.h" #include "shared_indices.h" namespace caspar { diff --git a/test/symforce_function_codegen_test_data/symengine/symforce_caspar_tridiagonal_test/kernel_chain_coupling_res_jac.cu b/test/symforce_function_codegen_test_data/symengine/symforce_caspar_tridiagonal_test/kernel_chain_coupling_res_jac.cu index 44138dfc..a8770378 100644 --- a/test/symforce_function_codegen_test_data/symengine/symforce_caspar_tridiagonal_test/kernel_chain_coupling_res_jac.cu +++ b/test/symforce_function_codegen_test_data/symengine/symforce_caspar_tridiagonal_test/kernel_chain_coupling_res_jac.cu @@ -1,17 +1,10 @@ #include #include -#include -#include -#include -#include -#include - +#include "cuda_to_hip.h" #include "kernel_chain_coupling_res_jac.h" #include "memops.cuh" -namespace cg = cooperative_groups; - namespace caspar { __global__ void __launch_bounds__(1024, 1) ChainCouplingResJacKernel( diff --git a/test/symforce_function_codegen_test_data/symengine/symforce_caspar_tridiagonal_test/kernel_chain_coupling_res_jac.h b/test/symforce_function_codegen_test_data/symengine/symforce_caspar_tridiagonal_test/kernel_chain_coupling_res_jac.h index 234789c6..857df690 100644 --- a/test/symforce_function_codegen_test_data/symengine/symforce_caspar_tridiagonal_test/kernel_chain_coupling_res_jac.h +++ b/test/symforce_function_codegen_test_data/symengine/symforce_caspar_tridiagonal_test/kernel_chain_coupling_res_jac.h @@ -1,7 +1,6 @@ #pragma once -#include - +#include "cuda_to_hip.h" #include "shared_indices.h" namespace caspar { diff --git a/test/symforce_function_codegen_test_data/symengine/symforce_caspar_tridiagonal_test/kernel_chain_coupling_res_jac_first.cu b/test/symforce_function_codegen_test_data/symengine/symforce_caspar_tridiagonal_test/kernel_chain_coupling_res_jac_first.cu index 38f5df97..30a89d9c 100644 --- a/test/symforce_function_codegen_test_data/symengine/symforce_caspar_tridiagonal_test/kernel_chain_coupling_res_jac_first.cu +++ b/test/symforce_function_codegen_test_data/symengine/symforce_caspar_tridiagonal_test/kernel_chain_coupling_res_jac_first.cu @@ -1,17 +1,10 @@ #include #include -#include -#include -#include -#include -#include - +#include "cuda_to_hip.h" #include "kernel_chain_coupling_res_jac_first.h" #include "memops.cuh" -namespace cg = cooperative_groups; - namespace caspar { __global__ void __launch_bounds__(1024, 1) ChainCouplingResJacFirstKernel( diff --git a/test/symforce_function_codegen_test_data/symengine/symforce_caspar_tridiagonal_test/kernel_chain_coupling_res_jac_first.h b/test/symforce_function_codegen_test_data/symengine/symforce_caspar_tridiagonal_test/kernel_chain_coupling_res_jac_first.h index 6ab04b67..b72d524d 100644 --- a/test/symforce_function_codegen_test_data/symengine/symforce_caspar_tridiagonal_test/kernel_chain_coupling_res_jac_first.h +++ b/test/symforce_function_codegen_test_data/symengine/symforce_caspar_tridiagonal_test/kernel_chain_coupling_res_jac_first.h @@ -1,7 +1,6 @@ #pragma once -#include - +#include "cuda_to_hip.h" #include "shared_indices.h" namespace caspar { diff --git a/test/symforce_function_codegen_test_data/symengine/symforce_caspar_tridiagonal_test/kernel_chain_coupling_score.cu b/test/symforce_function_codegen_test_data/symengine/symforce_caspar_tridiagonal_test/kernel_chain_coupling_score.cu index ef2a7945..c953cb96 100644 --- a/test/symforce_function_codegen_test_data/symengine/symforce_caspar_tridiagonal_test/kernel_chain_coupling_score.cu +++ b/test/symforce_function_codegen_test_data/symengine/symforce_caspar_tridiagonal_test/kernel_chain_coupling_score.cu @@ -1,17 +1,10 @@ #include #include -#include -#include -#include -#include -#include - +#include "cuda_to_hip.h" #include "kernel_chain_coupling_score.h" #include "memops.cuh" -namespace cg = cooperative_groups; - namespace caspar { __global__ void __launch_bounds__(1024, 1) diff --git a/test/symforce_function_codegen_test_data/symengine/symforce_caspar_tridiagonal_test/kernel_chain_coupling_score.h b/test/symforce_function_codegen_test_data/symengine/symforce_caspar_tridiagonal_test/kernel_chain_coupling_score.h index a073d176..138c5066 100644 --- a/test/symforce_function_codegen_test_data/symengine/symforce_caspar_tridiagonal_test/kernel_chain_coupling_score.h +++ b/test/symforce_function_codegen_test_data/symengine/symforce_caspar_tridiagonal_test/kernel_chain_coupling_score.h @@ -1,7 +1,6 @@ #pragma once -#include - +#include "cuda_to_hip.h" #include "shared_indices.h" namespace caspar { diff --git a/test/symforce_function_codegen_test_data/symengine/symforce_caspar_tridiagonal_test/solver.h b/test/symforce_function_codegen_test_data/symengine/symforce_caspar_tridiagonal_test/solver.h index 5a2242d3..e1757944 100644 --- a/test/symforce_function_codegen_test_data/symengine/symforce_caspar_tridiagonal_test/solver.h +++ b/test/symforce_function_codegen_test_data/symengine/symforce_caspar_tridiagonal_test/solver.h @@ -3,8 +3,7 @@ #include #include -#include - +#include "cuda_to_hip.h" #include "shared_indices.h" #include "solver_params.h" From daa1a7bf632d81c76e88814428aa534d2570e9e7 Mon Sep 17 00:00:00 2001 From: Jeff Daily Date: Wed, 4 Nov 2026 19:48:25 +0000 Subject: [PATCH 62/68] [ROCm] Zero r_kp1_norm2 before the first PCG residual update DoUpdateRFirst() zeroes r_0_norm2_tot and then accumulates into both r_0_norm2_tot and r_kp1_norm2_tot, but only DoUpdateR() zeroes r_kp1_norm2_tot. The first PCG iteration therefore adds the new residual norm onto whatever the solver's allocation held. The bad value feeds the PCG exit test and beta, so the result depends on uninitialized device memory. Freshly allocated device memory is usually zero, which hides this. On ROCm, a second solver in the same process gets memory freed by the first, and caspar_tridiagonal_cuda_test failed a varying 5 to 7 of its 20 uncoupled cases on an MI250X: step rejected, 199 PCG iterations. Filling the allocation with 0xFF makes the failures deterministic, and zero-filling it makes them disappear. That narrowed the read to the solver's scalar accumulators. The same defect is reachable on CUDA, so the fix is not gated on HIP. Authored with Claude. Test Plan: ``` python test/symforce_caspar_codegen_test.py --update python test/symforce_caspar_codegen_test.py cmake --build build --target bin.tests.caspar_tridiagonal_cuda_test bin.tests.caspar_solver_cuda_test ./build/bin/tests/caspar_tridiagonal_cuda_test # 5/5 runs pass, also with the allocation filled with 0xFF ./build/bin/tests/caspar_solver_cuda_test ``` --- symforce/caspar/source/templates/solver.cc.jinja | 1 + .../symengine/symforce_caspar_solver_test/solver.cc | 1 + .../symengine/symforce_caspar_tridiagonal_test/solver.cc | 1 + 3 files changed, 3 insertions(+) diff --git a/symforce/caspar/source/templates/solver.cc.jinja b/symforce/caspar/source/templates/solver.cc.jinja index 9d15f5c5..866a31ef 100644 --- a/symforce/caspar/source/templates/solver.cc.jinja +++ b/symforce/caspar/source/templates/solver.cc.jinja @@ -535,6 +535,7 @@ void {{ solver.struct_name }}::DoUpdateStep() { void {{ solver.struct_name }}::DoUpdateRFirst() { Zero({{solver_key("r_0_norm2_tot")}}, {{solver_key("r_0_norm2_tot")}}+1); + Zero({{solver_key("r_kp1_norm2_tot")}}, {{solver_key("r_kp1_norm2_tot")}}+1); {% for nodetype in solver.node_types %} {{nodetype.__name__}}UpdateRFirst( diff --git a/test/symforce_function_codegen_test_data/symengine/symforce_caspar_solver_test/solver.cc b/test/symforce_function_codegen_test_data/symengine/symforce_caspar_solver_test/solver.cc index 1bfb4c03..e910f2c6 100644 --- a/test/symforce_function_codegen_test_data/symengine/symforce_caspar_solver_test/solver.cc +++ b/test/symforce_function_codegen_test_data/symengine/symforce_caspar_solver_test/solver.cc @@ -369,6 +369,7 @@ void GraphSolver::DoUpdateStep() { void GraphSolver::DoUpdateRFirst() { Zero(solver__r_0_norm2_tot_, solver__r_0_norm2_tot_ + 1); + Zero(solver__r_kp1_norm2_tot_, solver__r_kp1_norm2_tot_ + 1); Matrix21UpdateRFirst(nodes__Matrix21__r_k_, Matrix21_num_, nodes__Matrix21__w_, Matrix21_num_, solver__neg_alpha_, nodes__Matrix21__r_k_, Matrix21_num_, diff --git a/test/symforce_function_codegen_test_data/symengine/symforce_caspar_tridiagonal_test/solver.cc b/test/symforce_function_codegen_test_data/symengine/symforce_caspar_tridiagonal_test/solver.cc index 098befc3..e82e6cd0 100644 --- a/test/symforce_function_codegen_test_data/symengine/symforce_caspar_tridiagonal_test/solver.cc +++ b/test/symforce_function_codegen_test_data/symengine/symforce_caspar_tridiagonal_test/solver.cc @@ -683,6 +683,7 @@ void GraphSolver::DoUpdateStep() { void GraphSolver::DoUpdateRFirst() { Zero(solver__r_0_norm2_tot_, solver__r_0_norm2_tot_ + 1); + Zero(solver__r_kp1_norm2_tot_, solver__r_kp1_norm2_tot_ + 1); ChainAUpdateRFirst(nodes__ChainA__r_k_, ChainA_num_, nodes__ChainA__w_, ChainA_num_, solver__neg_alpha_, nodes__ChainA__r_k_, ChainA_num_, solver__r_0_norm2_tot_, From 9ef7a6a3142f2d186ab75517a6ce38dc187844b2 Mon Sep 17 00:00:00 2001 From: Jeff Daily Date: Wed, 4 Nov 2026 19:48:25 +0000 Subject: [PATCH 63/68] [ROCm] Build the Caspar GPU tests with HIP when CUDA is absent The *_cuda_test.cc tests run code checked in by symforce_caspar_codegen_test and are built only when CMake finds a CUDA compiler. When it finds no CUDA compiler but finds a HIP compiler, this builds the same tests for AMD GPUs instead. The runtime, the generated .cu/.cc files and the test sources are compiled as HIP, with USE_HIP defined and hip::host and hip::hipcub linked. The tests include cuda_to_hip.h, which includes the CUDA runtime when USE_HIP is unset, so the CUDA build is unchanged. The build itself needs no AMD GPU: with -DCMAKE_HIP_ARCHITECTURES set, CMake does not query the device, so a ROCm-only machine or container compiles every checked-in kernel and solver with the HIP toolchain. That catches HIP compile breaks from template or runtime changes. Running the tests needs an AMD GPU, as the CUDA tests need an NVIDIA one. HIP language support needs CMake 3.21, so the HIP check is skipped on older CMake. Authored with Claude. Test Plan: On an MI250X (gfx90a), ROCm 7.x: ``` cmake -S . -B build -DCMAKE_HIP_ARCHITECTURES=gfx90a -DCMAKE_PREFIX_PATH= cmake --build build --target bin.tests.caspar_padding_lane_cuda_test bin.tests.caspar_solver_cuda_test bin.tests.caspar_tridiagonal_cuda_test bin.tests.caspar_backend_coverage_cuda_test cd build && ctest -R caspar_ --output-on-failure ``` --- test/CMakeLists.txt | 39 ++++++++++++++++++----- test/caspar_backend_coverage_cuda_test.cc | 2 +- test/caspar_padding_lane_cuda_test.cc | 2 +- test/caspar_solver_cuda_test.cc | 2 +- test/caspar_tridiagonal_cuda_test.cc | 2 +- 5 files changed, 35 insertions(+), 12 deletions(-) diff --git a/test/CMakeLists.txt b/test/CMakeLists.txt index 8a34770d..ce003cdd 100644 --- a/test/CMakeLists.txt +++ b/test/CMakeLists.txt @@ -47,7 +47,7 @@ target_compile_definitions( file(GLOB SYMFORCE_TEST_CC_SOURCES CONFIGURE_DEPENDS *_test.cc) -# *_cuda_test.cc tests are built below, only when a CUDA compiler is available. +# *_cuda_test.cc tests are built below, only when a CUDA or HIP compiler is available. file(GLOB SYMFORCE_CUDA_TEST_CC_SOURCES CONFIGURE_DEPENDS *_cuda_test.cc) list(REMOVE_ITEM SYMFORCE_TEST_CC_SOURCES ${SYMFORCE_CUDA_TEST_CC_SOURCES}) @@ -80,9 +80,21 @@ endforeach() include(CheckLanguage) check_language(CUDA) -if(CMAKE_CUDA_COMPILER) - enable_language(CUDA) - find_package(CUDAToolkit REQUIRED) +if(NOT CMAKE_CUDA_COMPILER AND CMAKE_VERSION VERSION_GREATER_EQUAL 3.21) + # Without CUDA, build the same tests for AMD GPUs with HIP. With no AMD GPU on the build host, + # pass -DCMAKE_HIP_ARCHITECTURES (e.g. gfx90a) to build them anyway. + check_language(HIP) +endif() + +if(CMAKE_CUDA_COMPILER OR CMAKE_HIP_COMPILER) + if(CMAKE_CUDA_COMPILER) + enable_language(CUDA) + find_package(CUDAToolkit REQUIRED) + else() + enable_language(HIP) + find_package(hip REQUIRED) + find_package(hipcub REQUIRED) + endif() set(CASPAR_RUNTIME_DIR ${CMAKE_CURRENT_SOURCE_DIR}/../symforce/caspar/source/runtime) set(CASPAR_TEST_DATA_DIR ${CMAKE_CURRENT_SOURCE_DIR}/symforce_function_codegen_test_data/symengine) @@ -92,11 +104,18 @@ if(CMAKE_CUDA_COMPILER) ${CASPAR_RUNTIME_DIR}/sort_indices.cu ${CASPAR_RUNTIME_DIR}/solver_tools.cu ) - set_target_properties(caspar_test_runtime PROPERTIES - CUDA_ARCHITECTURES 75 # Minimum for cooperative_groups::reduce - ) target_include_directories(caspar_test_runtime PUBLIC ${CASPAR_RUNTIME_DIR}) - target_link_libraries(caspar_test_runtime PUBLIC CUDA::cudart) + if(CMAKE_CUDA_COMPILER) + set_target_properties(caspar_test_runtime PROPERTIES + CUDA_ARCHITECTURES 75 # Minimum for cooperative_groups::reduce + ) + target_link_libraries(caspar_test_runtime PUBLIC CUDA::cudart) + else() + get_target_property(CASPAR_RUNTIME_SOURCES caspar_test_runtime SOURCES) + set_source_files_properties(${CASPAR_RUNTIME_SOURCES} PROPERTIES LANGUAGE HIP) + target_compile_definitions(caspar_test_runtime PUBLIC USE_HIP) + target_link_libraries(caspar_test_runtime PUBLIC hip::host hip::hipcub) + endif() # Each caspar__cuda_test.cc runs the code generated into symforce_caspar__test, # except caspar_padding_lane_cuda_test, whose kernel symforce_caspar_codegen_test generates @@ -117,6 +136,10 @@ if(CMAKE_CUDA_COMPILER) file(GLOB DATA_SOURCES CONFIGURE_DEPENDS ${DATA_DIR}/*.cu ${DATA_DIR}/*.cc) add_executable(${TARGET_NAME} ${SOURCE_FILE} ${DATA_SOURCES}) + if(CMAKE_HIP_COMPILER) + # The test and generated .cc files include the HIP runtime too. + set_source_files_properties(${SOURCE_FILE} ${DATA_SOURCES} PROPERTIES LANGUAGE HIP) + endif() set_target_properties(${TARGET_NAME} PROPERTIES CUDA_ARCHITECTURES 75 OUTPUT_NAME ${BINARY_NAME} diff --git a/test/caspar_backend_coverage_cuda_test.cc b/test/caspar_backend_coverage_cuda_test.cc index 71dfabe8..47c2fc7a 100644 --- a/test/caspar_backend_coverage_cuda_test.cc +++ b/test/caspar_backend_coverage_cuda_test.cc @@ -9,9 +9,9 @@ #include #include -#include #include "backend_test_function_expected.h" +#include "cuda_to_hip.h" #include "kernel_backend_test_function.h" namespace { diff --git a/test/caspar_padding_lane_cuda_test.cc b/test/caspar_padding_lane_cuda_test.cc index a7e2ea9a..4848b63a 100644 --- a/test/caspar_padding_lane_cuda_test.cc +++ b/test/caspar_padding_lane_cuda_test.cc @@ -8,8 +8,8 @@ #include #include -#include +#include "cuda_to_hip.h" #include "kernel_caspar_padding_lane_score.h" #include "shared_indices.h" diff --git a/test/caspar_solver_cuda_test.cc b/test/caspar_solver_cuda_test.cc index bce016fe..259b6d9c 100644 --- a/test/caspar_solver_cuda_test.cc +++ b/test/caspar_solver_cuda_test.cc @@ -9,8 +9,8 @@ #include #include -#include +#include "cuda_to_hip.h" #include "solver.h" namespace { diff --git a/test/caspar_tridiagonal_cuda_test.cc b/test/caspar_tridiagonal_cuda_test.cc index 0f303918..0a04c2df 100644 --- a/test/caspar_tridiagonal_cuda_test.cc +++ b/test/caspar_tridiagonal_cuda_test.cc @@ -10,8 +10,8 @@ #include #include #include -#include +#include "cuda_to_hip.h" #include "symforce_caspar_tridiagonal_test/solver.h" namespace { From 92ec5462e1bcf17f42a682a8f9f9bbbdf67b0c5a Mon Sep 17 00:00:00 2001 From: Jeff Daily Date: Wed, 4 Nov 2026 19:50:07 +0000 Subject: [PATCH 64/68] [ROCm] Check the generated Caspar build files in the codegen test symforce_caspar_codegen_test checks in the kernels and solvers caspar generates, but not the CMakeLists.txt it generates next to them. That file holds the only generated code that differs between the CUDA and HIP builds: the USE_HIP branch, which selects the HIP language, finds hip and hipcub, compiles the .cu sources (and, with Python bindings, the pybind sources) as HIP, and sets the HIP math flags. A change to that branch, or to the CUDA one, went unnoticed until someone built a generated library on that backend. test_generate_build_files generates the build files for the padding-lane library with and without Python bindings and compares them with checked-in copies, like the other codegen tests. The copies were written with the test's own --update. Changing the HIP compile flags in CMakeLists.txt.jinja makes the test fail. Authored with Claude. Test Plan: ``` python test/symforce_caspar_codegen_test.py --update python test/symforce_caspar_codegen_test.py SYMFORCE_SYMBOLIC_API=sympy python test/symforce_caspar_codegen_test.py ``` --- test/symforce_caspar_codegen_test.py | 29 +++++ .../CMakeLists.txt | 67 ++++++++++++ .../CMakeLists_python_bindings.txt | 103 ++++++++++++++++++ 3 files changed, 199 insertions(+) create mode 100644 test/symforce_function_codegen_test_data/symengine/symforce_caspar_build_files_test/CMakeLists.txt create mode 100644 test/symforce_function_codegen_test_data/symengine/symforce_caspar_build_files_test/CMakeLists_python_bindings.txt diff --git a/test/symforce_caspar_codegen_test.py b/test/symforce_caspar_codegen_test.py index e7824349..33843535 100644 --- a/test/symforce_caspar_codegen_test.py +++ b/test/symforce_caspar_codegen_test.py @@ -55,6 +55,14 @@ / "symforce_caspar_backend_coverage_test" ) +BUILD_FILES_TEST_DATA_DIR = ( + path_util.symforce_data_root(__file__) + / "test" + / "symforce_function_codegen_test_data" + / symforce.get_symbolic_api() + / "symforce_caspar_build_files_test" +) + KERNEL_FILENAMES = ( "kernel_caspar_padding_lane_score.cu", "kernel_caspar_padding_lane_score.h", @@ -326,6 +334,27 @@ def test_generate_backend_coverage_kernel(self) -> None: self.compare_or_update_directory(kernel_dir, BACKEND_COVERAGE_TEST_DATA_DIR) + @symengine_only + def test_generate_build_files(self) -> None: + """ + Keep the generated CMakeLists.txt up to date, with and without Python bindings. It holds + the only generated code that differs between the CUDA and HIP builds. + """ + output_dir = self.make_output_dir("sf_caspar_build_files_") + caslib = _make_padding_lane_library() + + build_files_dir = output_dir / "build_files" + build_files_dir.mkdir() + for python_bindings in (False, True): + generated_dir = output_dir / f"python_bindings_{python_bindings}" + generated_dir.mkdir() + caslib.generate_buildfiles(generated_dir, python_bindings=python_bindings) + for path in generated_dir.iterdir(): + suffix = "_python_bindings" if python_bindings else "" + (build_files_dir / f"{path.stem}{suffix}{path.suffix}").write_text(path.read_text()) + + self.compare_or_update_directory(build_files_dir, BUILD_FILES_TEST_DATA_DIR) + @symengine_only def test_generate_solver(self) -> None: """ diff --git a/test/symforce_function_codegen_test_data/symengine/symforce_caspar_build_files_test/CMakeLists.txt b/test/symforce_function_codegen_test_data/symengine/symforce_caspar_build_files_test/CMakeLists.txt new file mode 100644 index 00000000..c4d72201 --- /dev/null +++ b/test/symforce_function_codegen_test_data/symengine/symforce_caspar_build_files_test/CMakeLists.txt @@ -0,0 +1,67 @@ +cmake_minimum_required(VERSION 3.18) + +set(CMAKE_CXX_STANDARD 17) +set(CMAKE_CXX_STANDARD_REQUIRED ON) + +option(USE_HIP "Build with HIP for AMD GPUs" OFF) + +if(USE_HIP) + # project(... LANGUAGES ... HIP) honors -DCMAKE_HIP_ARCHITECTURES, otherwise + # auto-detects the host GPU and errors on a no-GPU build host. + project(caspar_library LANGUAGES CXX HIP) + + find_package(hip REQUIRED) + find_package(hipcub REQUIRED) +else() + if(NOT DEFINED CMAKE_CUDA_COMPILER AND DEFINED ENV{CUDACXX}) + set(CMAKE_CUDA_COMPILER "$ENV{CUDACXX}" CACHE FILEPATH "CUDA compiler") + endif() + + project(caspar_library LANGUAGES CXX CUDA) + + set(CASPAR_MIN_ARCH 75 CACHE INTERNAL "Minimum CUDA arch required by Caspar") + + # SASS for Turing/Ampere/Ada (sm_75–89) + PTX fallback for forward JIT-compatibility. sm_75 minimum required by cooperative_groups::reduce. + if(NOT DEFINED CMAKE_CUDA_ARCHITECTURES) + set(CMAKE_CUDA_ARCHITECTURES ${CASPAR_MIN_ARCH} 80-real 86-real 89-real) + endif() + + find_package(CUDAToolkit REQUIRED) +endif() + +file(GLOB CUDA_SOURCES RELATIVE ${CMAKE_CURRENT_SOURCE_DIR} "*.cu" "*.cc") +list(FILTER CUDA_SOURCES EXCLUDE REGEX "pybind.*") +file(GLOB CUDA_HEADERS RELATIVE ${CMAKE_CURRENT_SOURCE_DIR} "*.cuh" "*.h") +list(FILTER CUDA_HEADERS EXCLUDE REGEX "pybind.*") + +add_library(caspar_lib_core STATIC ${CUDA_SOURCES} ${CUDA_HEADERS}) +target_include_directories(caspar_lib_core PUBLIC ${CMAKE_CURRENT_SOURCE_DIR}) + +if(USE_HIP) + # Mark .cu files as HIP language + set_source_files_properties(${CUDA_SOURCES} PROPERTIES LANGUAGE HIP) + target_compile_definitions(caspar_lib_core PUBLIC USE_HIP) + # Link hip targets PRIVATE to avoid propagating HIP compile options to pure-CXX consumers. + # The static library has the HIP code linked in; pybind consumers only need the includes. + target_link_libraries(caspar_lib_core PRIVATE hip::host hip::hipcub) + # Expose ROCm include directory for consumers that need hipError_t etc + target_include_directories(caspar_lib_core PUBLIC ${hip_INCLUDE_DIRS}) + # Use -ffp-contract=fast -fno-math-errno instead of -ffast-math. + # clang's -ffast-math enables -fassociative-math which can NaN backward passes. + target_compile_options(caspar_lib_core PRIVATE + $<$:-ffp-contract=fast -fno-math-errno> + ) + set_target_properties(caspar_lib_core PROPERTIES + HIP_ARCHITECTURES "${CMAKE_HIP_ARCHITECTURES}" + ) +else() + target_link_libraries(caspar_lib_core PUBLIC CUDA::cudart) + target_compile_options(caspar_lib_core PRIVATE + $<$:--use_fast_math> + ) +endif() + +set_target_properties(caspar_lib_core PROPERTIES + POSITION_INDEPENDENT_CODE ON +) + diff --git a/test/symforce_function_codegen_test_data/symengine/symforce_caspar_build_files_test/CMakeLists_python_bindings.txt b/test/symforce_function_codegen_test_data/symengine/symforce_caspar_build_files_test/CMakeLists_python_bindings.txt new file mode 100644 index 00000000..6bb71efd --- /dev/null +++ b/test/symforce_function_codegen_test_data/symengine/symforce_caspar_build_files_test/CMakeLists_python_bindings.txt @@ -0,0 +1,103 @@ +cmake_minimum_required(VERSION 3.18) + +set(CMAKE_CXX_STANDARD 17) +set(CMAKE_CXX_STANDARD_REQUIRED ON) + +option(USE_HIP "Build with HIP for AMD GPUs" OFF) + +if(USE_HIP) + # project(... LANGUAGES ... HIP) honors -DCMAKE_HIP_ARCHITECTURES, otherwise + # auto-detects the host GPU and errors on a no-GPU build host. + project(caspar_library LANGUAGES CXX HIP) + + find_package(hip REQUIRED) + find_package(hipcub REQUIRED) +else() + if(NOT DEFINED CMAKE_CUDA_COMPILER AND DEFINED ENV{CUDACXX}) + set(CMAKE_CUDA_COMPILER "$ENV{CUDACXX}" CACHE FILEPATH "CUDA compiler") + endif() + + project(caspar_library LANGUAGES CXX CUDA) + + set(CASPAR_MIN_ARCH 75 CACHE INTERNAL "Minimum CUDA arch required by Caspar") + + # SASS for Turing/Ampere/Ada (sm_75–89) + PTX fallback for forward JIT-compatibility. sm_75 minimum required by cooperative_groups::reduce. + if(NOT DEFINED CMAKE_CUDA_ARCHITECTURES) + set(CMAKE_CUDA_ARCHITECTURES ${CASPAR_MIN_ARCH} 80-real 86-real 89-real) + endif() + + find_package(CUDAToolkit REQUIRED) +endif() + +option(CASPAR_BUILD_PYTHON_BINDINGS "Build Python bindings via pybind11" ON) + +if(CASPAR_BUILD_PYTHON_BINDINGS) + include(FetchContent) + find_package(pybind11 2.13.6 QUIET) + if(NOT pybind11_FOUND) + message(STATUS "pybind11 not found, adding with FetchContent") + FetchContent_Declare( + pybind11 + URL https://github.com/pybind/pybind11/archive/v2.13.6.zip + URL_HASH SHA256=d0a116e91f64a4a2d8fb7590c34242df92258a61ec644b79127951e821b47be6 + DOWNLOAD_EXTRACT_TIMESTAMP TRUE + ) + FetchContent_MakeAvailable(pybind11) + else() + message(STATUS "pybind11 found") + endif() +endif() + +file(GLOB CUDA_SOURCES RELATIVE ${CMAKE_CURRENT_SOURCE_DIR} "*.cu" "*.cc") +list(FILTER CUDA_SOURCES EXCLUDE REGEX "pybind.*") +file(GLOB CUDA_HEADERS RELATIVE ${CMAKE_CURRENT_SOURCE_DIR} "*.cuh" "*.h") +list(FILTER CUDA_HEADERS EXCLUDE REGEX "pybind.*") + +add_library(caspar_lib_core STATIC ${CUDA_SOURCES} ${CUDA_HEADERS}) +target_include_directories(caspar_lib_core PUBLIC ${CMAKE_CURRENT_SOURCE_DIR}) + +if(USE_HIP) + # Mark .cu files as HIP language + set_source_files_properties(${CUDA_SOURCES} PROPERTIES LANGUAGE HIP) + target_compile_definitions(caspar_lib_core PUBLIC USE_HIP) + # Link hip targets PRIVATE to avoid propagating HIP compile options to pure-CXX consumers. + # The static library has the HIP code linked in; pybind consumers only need the includes. + target_link_libraries(caspar_lib_core PRIVATE hip::host hip::hipcub) + # Expose ROCm include directory for consumers that need hipError_t etc + target_include_directories(caspar_lib_core PUBLIC ${hip_INCLUDE_DIRS}) + # Use -ffp-contract=fast -fno-math-errno instead of -ffast-math. + # clang's -ffast-math enables -fassociative-math which can NaN backward passes. + target_compile_options(caspar_lib_core PRIVATE + $<$:-ffp-contract=fast -fno-math-errno> + ) + set_target_properties(caspar_lib_core PROPERTIES + HIP_ARCHITECTURES "${CMAKE_HIP_ARCHITECTURES}" + ) +else() + target_link_libraries(caspar_lib_core PUBLIC CUDA::cudart) + target_compile_options(caspar_lib_core PRIVATE + $<$:--use_fast_math> + ) +endif() + +set_target_properties(caspar_lib_core PROPERTIES + POSITION_INDEPENDENT_CODE ON +) + +if(CASPAR_BUILD_PYTHON_BINDINGS) + file(GLOB CPP_SOURCES "pybind*.cc") + + pybind11_add_module(caspar_lib ${CPP_SOURCES} ${CPP_HEADERS}) + target_link_libraries(caspar_lib PRIVATE caspar_lib_core) + + if(USE_HIP) + # Compile pybind sources as HIP (so HIP headers work) but they have no device code. + # The HIP compiler handles them as host-only code. + set_source_files_properties(${CPP_SOURCES} PROPERTIES LANGUAGE HIP) + endif() + + set_target_properties(caspar_lib PROPERTIES + LIBRARY_OUTPUT_DIRECTORY ${CMAKE_CURRENT_SOURCE_DIR} + RUNTIME_OUTPUT_DIRECTORY ${CMAKE_CURRENT_SOURCE_DIR} + ) +endif() From 1ee93b2ccc1145a5d1076db8edff0061f97c4aa5 Mon Sep 17 00:00:00 2001 From: Jeff Daily Date: Wed, 4 Nov 2026 19:55:05 +0000 Subject: [PATCH 65/68] [ROCm] Keep device-only CUDA headers out of host compiles The generated kernel and solver headers include cuda_to_hip.h, and so does host C++ that uses them: the generated solver.cc, the Python bindings, and the Caspar GPU tests, all compiled by the host compiler in a CUDA build. On the CUDA path the header also included cooperative_groups and CUB, which only compile under nvcc. A g++ build of caspar_padding_lane_cuda_test failed in cooperative_groups/details/sync.h ('threadIdx' was not declared). Those includes, the cg alias and CG_REDUCE_SUM are only used by device code, so they are now included only when __CUDACC__ is defined. Host-only translation units get just the CUDA runtime API, which is what they included before the HIP port. The HIP path is unchanged: every file that includes the header is compiled as HIP there. Authored with Claude. Test Plan: CUDA 12.8 (no NVIDIA GPU on this machine, so compile and link only): ``` cmake -S . -B build_cuda -DCMAKE_CUDA_COMPILER=/path/to/cuda-12.8/bin/nvcc cmake --build build_cuda --target bin.tests.caspar_padding_lane_cuda_test bin.tests.caspar_solver_cuda_test bin.tests.caspar_tridiagonal_cuda_test bin.tests.caspar_backend_coverage_cuda_test ``` HIP, on an MI250X (gfx90a): ``` cmake --build build --target bin.tests.caspar_padding_lane_cuda_test bin.tests.caspar_solver_cuda_test bin.tests.caspar_tridiagonal_cuda_test bin.tests.caspar_backend_coverage_cuda_test ctest --test-dir build -R caspar_ ``` --- symforce/caspar/source/runtime/cuda_to_hip.h | 4 ++++ 1 file changed, 4 insertions(+) diff --git a/symforce/caspar/source/runtime/cuda_to_hip.h b/symforce/caspar/source/runtime/cuda_to_hip.h index e9141b2c..2058cfd3 100644 --- a/symforce/caspar/source/runtime/cuda_to_hip.h +++ b/symforce/caspar/source/runtime/cuda_to_hip.h @@ -128,6 +128,9 @@ __device__ __forceinline__ T labeled_reduce_sum(GroupT group, T val, LabelT labe #else // CUDA path #include + +// Host-only translation units (e.g. code using the generated headers) get just the runtime API. +#if defined(__CUDACC__) #include #include #include @@ -138,5 +141,6 @@ namespace cg = cooperative_groups; // On CUDA, cg::reduce is available #define CG_REDUCE_SUM(group, val) cg::reduce(group, val, cg::plus()) +#endif #endif From d5eb335dbe09b2f83de75fd0aa5e437d8acbacc0 Mon Sep 17 00:00:00 2001 From: Jeff Daily Date: Wed, 4 Nov 2026 20:02:17 +0000 Subject: [PATCH 66/68] [ROCm] Apply clang-format to cuda_to_hip.h make lint runs clang-format --dry-run -Werror over the tree, and the HIP compatibility header was not formatted with the repository's .clang-format. Formatting only; no code change. Authored with Claude. Test Plan: ``` make lint ``` --- symforce/caspar/source/runtime/cuda_to_hip.h | 41 ++++++++++---------- 1 file changed, 21 insertions(+), 20 deletions(-) diff --git a/symforce/caspar/source/runtime/cuda_to_hip.h b/symforce/caspar/source/runtime/cuda_to_hip.h index 2058cfd3..c9c763bf 100644 --- a/symforce/caspar/source/runtime/cuda_to_hip.h +++ b/symforce/caspar/source/runtime/cuda_to_hip.h @@ -13,29 +13,29 @@ #if defined(USE_HIP) || defined(__HIP_PLATFORM_AMD__) -#include #include +#include #include // CUDA runtime API -> HIP runtime API -#define cudaMalloc hipMalloc -#define cudaFree hipFree -#define cudaMemset hipMemset -#define cudaMemcpy hipMemcpy +#define cudaMalloc hipMalloc +#define cudaFree hipFree +#define cudaMemset hipMemset +#define cudaMemcpy hipMemcpy #define cudaMemcpyDeviceToDevice hipMemcpyDeviceToDevice -#define cudaMemcpyDeviceToHost hipMemcpyDeviceToHost -#define cudaMemcpyHostToDevice hipMemcpyHostToDevice -#define cudaError_t hipError_t -#define cudaSuccess hipSuccess -#define cudaStream_t hipStream_t -#define cudaDeviceSynchronize hipDeviceSynchronize -#define cudaGetLastError hipGetLastError -#define cudaGetErrorString hipGetErrorString -#define cudaSetDevice hipSetDevice -#define cudaGetDevice hipGetDevice +#define cudaMemcpyDeviceToHost hipMemcpyDeviceToHost +#define cudaMemcpyHostToDevice hipMemcpyHostToDevice +#define cudaError_t hipError_t +#define cudaSuccess hipSuccess +#define cudaStream_t hipStream_t +#define cudaDeviceSynchronize hipDeviceSynchronize +#define cudaGetLastError hipGetLastError +#define cudaGetErrorString hipGetErrorString +#define cudaSetDevice hipSetDevice +#define cudaGetDevice hipGetDevice #define cudaPointerGetAttributes hipPointerGetAttributes -#define cudaPointerAttributes hipPointerAttribute_t -#define cudaGetDeviceCount hipGetDeviceCount +#define cudaPointerAttributes hipPointerAttribute_t +#define cudaGetDeviceCount hipGetDeviceCount #define cudaFuncAttributeMaxDynamicSharedMemorySize hipFuncAttributeMaxDynamicSharedMemorySize // hipFuncSetAttribute takes the kernel as const void*; CUDA also accepts the kernel itself. @@ -88,7 +88,8 @@ __device__ __forceinline__ unsigned long long match_any_mask(GroupT group, Label // and have exactly one lane per unique label perform the atomic. // Returns the reduced value and sets is_leader=true for exactly one lane per label. template -__device__ __forceinline__ T labeled_reduce_sum(GroupT group, T val, LabelT label, bool& is_leader) { +__device__ __forceinline__ T labeled_reduce_sum(GroupT group, T val, LabelT label, + bool& is_leader) { // Get mask of lanes with same label unsigned long long same_label_mask = group.match_any(label); @@ -123,7 +124,7 @@ __device__ __forceinline__ T labeled_reduce_sum(GroupT group, T val, LabelT labe // Macros to replace cg::reduce calls (used in device code) #define CG_REDUCE_SUM(group, val) caspar_hip::reduce_sum(group, val) #define CG_LABELED_REDUCE_SUM(group, val, label, is_leader) \ - caspar_hip::labeled_reduce_sum(group, val, label, is_leader) + caspar_hip::labeled_reduce_sum(group, val, label, is_leader) #else // CUDA path @@ -133,8 +134,8 @@ __device__ __forceinline__ T labeled_reduce_sum(GroupT group, T val, LabelT labe #if defined(__CUDACC__) #include #include -#include #include +#include #include namespace cg = cooperative_groups; From f82e4abfac7f1081254dfa781b0a692d47e2a0cf Mon Sep 17 00:00:00 2001 From: Jeff Daily Date: Wed, 4 Nov 2026 20:39:59 +0000 Subject: [PATCH 67/68] [ROCm] Remove unused reduction helpers from cuda_to_hip.h The ROCm branch of cuda_to_hip.h defined caspar_hip::reduce_sum, reduce_max, match_any_mask and labeled_reduce_sum, plus the CG_REDUCE_SUM and CG_LABELED_REDUCE_SUM macros, and the CUDA branch defined its own CG_REDUCE_SUM. Nothing in the tree calls any of them: memops.cuh and shared_indices.cu do their HIP reductions and copies inline. labeled_reduce_sum was also wrong when lanes with the same label are not contiguous, because its xor butterfly only adds a partner with the same label, so lanes 0 and 3 sharing a label never combine. Remove them so the header carries only the runtime API mapping. The cg namespace alias stays on the CUDA path. Templates and macros that are never instantiated emit no code, so the device code objects of the Caspar test binaries are unchanged. Authored with Claude. Test Plan: ``` grep -rn 'caspar_hip\|CG_REDUCE_SUM\|CG_LABELED_REDUCE_SUM' symforce test cmake -S . -B build -DCMAKE_BUILD_TYPE=Release -DCMAKE_HIP_ARCHITECTURES=gfx90a cmake --build build ctest --test-dir build -R caspar cmake -S . -B build-cuda -DCMAKE_CUDA_COMPILER=nvcc cmake --build build-cuda --target bin.tests.caspar_padding_lane_cuda_test bin.tests.caspar_solver_cuda_test bin.tests.caspar_tridiagonal_cuda_test bin.tests.caspar_backend_coverage_cuda_test ``` --- symforce/caspar/source/runtime/cuda_to_hip.h | 78 -------------------- 1 file changed, 78 deletions(-) diff --git a/symforce/caspar/source/runtime/cuda_to_hip.h b/symforce/caspar/source/runtime/cuda_to_hip.h index c9c763bf..a8d959f8 100644 --- a/symforce/caspar/source/runtime/cuda_to_hip.h +++ b/symforce/caspar/source/runtime/cuda_to_hip.h @@ -51,81 +51,6 @@ inline hipError_t cudaFuncSetAttribute(T* func, hipFuncAttribute attr, int value // CUB -> hipCUB namespace namespace cub = hipcub; -// Cooperative groups: HIP has cg basics but lacks cg::reduce, cg::labeled_partition, memcpy_async. -// Provide manual implementations where needed. - -namespace caspar_hip { - -// Butterfly reduction within a cooperative group (thread_block_tile or coalesced_group). -// Replaces cg::reduce(group, val, cg::plus()). -template -__device__ __forceinline__ T reduce_sum(GroupT group, T val) { - for (unsigned int offset = group.size() / 2; offset > 0; offset >>= 1) { - val += group.shfl_xor(val, offset); - } - return val; -} - -// Butterfly reduction for max (cg::greater). -template -__device__ __forceinline__ T reduce_max(GroupT group, T val) { - for (unsigned int offset = group.size() / 2; offset > 0; offset >>= 1) { - T other = group.shfl_xor(val, offset); - val = (val > other) ? val : other; - } - return val; -} - -// Match_any: return a mask of lanes in the tile that have the same label. -// HIP CG has match_any() for coalesced groups. -template -__device__ __forceinline__ unsigned long long match_any_mask(GroupT group, LabelT label) { - // HIP cooperative_groups::coalesced_group has match_any - return group.match_any(label); -} - -// Labeled partition emulation: reduce values within lanes sharing the same label, -// and have exactly one lane per unique label perform the atomic. -// Returns the reduced value and sets is_leader=true for exactly one lane per label. -template -__device__ __forceinline__ T labeled_reduce_sum(GroupT group, T val, LabelT label, - bool& is_leader) { - // Get mask of lanes with same label - unsigned long long same_label_mask = group.match_any(label); - - // Find my position within the matching lanes - unsigned int my_lane = group.thread_rank(); - unsigned long long lower_mask = (1ULL << my_lane) - 1; - unsigned int rank_in_label = __popcll(same_label_mask & lower_mask); - - // Leader is the lowest-numbered lane in the group - is_leader = (rank_in_label == 0); - - // Count total lanes with this label - unsigned int label_size = __popcll(same_label_mask); - - // Butterfly reduction over the masked lanes - // For each reduction step, exchange with lane at offset if both are in same_label_mask - T result = val; - for (unsigned int offset = 1; offset < group.size(); offset <<= 1) { - unsigned int partner_lane = my_lane ^ offset; - bool partner_has_same_label = (same_label_mask >> partner_lane) & 1ULL; - T partner_val = group.shfl_xor(result, offset); - if (partner_has_same_label && partner_lane < group.size()) { - result += partner_val; - } - } - - return result; -} - -} // namespace caspar_hip - -// Macros to replace cg::reduce calls (used in device code) -#define CG_REDUCE_SUM(group, val) caspar_hip::reduce_sum(group, val) -#define CG_LABELED_REDUCE_SUM(group, val, label, is_leader) \ - caspar_hip::labeled_reduce_sum(group, val, label, is_leader) - #else // CUDA path #include @@ -139,9 +64,6 @@ __device__ __forceinline__ T labeled_reduce_sum(GroupT group, T val, LabelT labe #include namespace cg = cooperative_groups; - -// On CUDA, cg::reduce is available -#define CG_REDUCE_SUM(group, val) cg::reduce(group, val, cg::plus()) #endif #endif From e7e0b00c5e343e57724226aca38b92438868cc6b Mon Sep 17 00:00:00 2001 From: Jeff Daily Date: Wed, 4 Nov 2026 21:04:07 +0000 Subject: [PATCH 68/68] [ROCm] Fix the Caspar README HIP example and a stale comment The README's AMD GPU section called a compile_caspar_library() function that does not exist. The API is the CasparLibrary.compile() static method, so the example now calls caslib.compile(out_dir, use_hip=True, hip_arch=...) after caslib.generate(out_dir), as the examples do. The same section also described the compatibility header wrongly. It does not map __syncthreads or any cooperative groups spelling; it maps the CUDA runtime calls Caspar emits and the cub namespace. It also said hipcc works as the compiler, but the generated build uses CMake's HIP language support, which rejects the hipcc wrapper and needs the ROCm Clang compiler. The text now says so, and notes that without hip_arch CMake builds for the GPU it detects. The comment above the HIP branch of GetDeviceId() in pybind_array_tools.cc still mentioned __device__ helpers in cuda_to_hip.h, which were removed, and local aliases the code never defines. It now says what the code does. No code change outside the comment. Authored with Claude. Test Plan: ``` cmake -S . -B build -DCMAKE_BUILD_TYPE=Release -DCMAKE_HIP_ARCHITECTURES=gfx90a cmake --build build ctest --test-dir build -R caspar --output-on-failure ctest --test-dir build python symforce/caspar/examples/kernel_example/gen_and_run.py # with caslib.compile(out_dir, use_hip=True, hip_arch="gfx90a") ``` --- symforce/caspar/README.md | 7 ++++--- symforce/caspar/source/runtime/pybind_array_tools.cc | 5 ++--- 2 files changed, 6 insertions(+), 6 deletions(-) diff --git a/symforce/caspar/README.md b/symforce/caspar/README.md index 58c50f2d..e96c850c 100644 --- a/symforce/caspar/README.md +++ b/symforce/caspar/README.md @@ -112,15 +112,16 @@ The following access patterns are currently supported: ### AMD GPUs (ROCm/HIP) -Caspar also runs on AMD GPUs through ROCm/HIP. The same generated kernels and runtime compile against the HIP toolchain via a small `cuda_to_hip.h` compatibility header that maps the CUDA spellings Caspar emits (`cudaMalloc`, `__syncthreads`, cooperative groups, CUB primitives, and friends) onto their HIP equivalents, so the symbolic kernel definitions are unchanged. +Caspar also runs on AMD GPUs through ROCm/HIP. The generated kernels and runtime compile with HIP through a small `cuda_to_hip.h` compatibility header that maps the CUDA runtime calls Caspar emits (`cudaMalloc`, `cudaMemcpy`, `cudaFuncSetAttribute`, and friends) and the `cub` namespace onto their HIP equivalents, so the symbolic kernel definitions are unchanged. To build a generated library for AMD GPUs, enable the HIP path when compiling: ```python -compile_caspar_library(caslib, output_dir, use_hip=True, hip_arch="gfx90a") +caslib.generate(out_dir) +caslib.compile(out_dir, use_hip=True, hip_arch="gfx90a") ``` -Set the target AMD GPU via the `hip_arch` argument, for example `gfx90a` for CDNA2 (MI200) or `gfx1100` for RDNA3. The ROCm build needs a HIP-enabled compiler (`hipcc`/`amdclang++`) and the `hip` and `hipcub` packages from a ROCm installation. When `use_hip` is off the build is unchanged and continues to use CUDA. +Set the target AMD GPU via the `hip_arch` argument, for example `gfx90a` for CDNA2 (MI200) or `gfx1100` for RDNA3. Without it, CMake builds for the GPU it detects on the build machine. The build uses CMake's HIP language support, so it needs the ROCm Clang compiler (`amdclang++`; CMake does not accept the `hipcc` wrapper) and the `hip` and `hipcub` packages from a ROCm installation. When `use_hip` is off the build is unchanged and continues to use CUDA. ### Etymology Caspar, an acronym for **C**UDA **A**ccelerator for **S**ymbolic **P**rogramming with **A**daptive **R**eordering, is named after the Danish–Norwegian mathematician [Caspar Wessel](https://en.wikipedia.org/wiki/Caspar_Wessel). Wessel was the first to describe the geometrical interpretation of complex numbers as points in the complex plane and as vectors. However, since his thesis was written in Danish, it initially received little recognition. When his work was rediscovered later, the mathematician Sophus Lie, known for his discovery of Lie algebra, wrote the following in the newspaper: diff --git a/symforce/caspar/source/runtime/pybind_array_tools.cc b/symforce/caspar/source/runtime/pybind_array_tools.cc index 7f057905..db221163 100644 --- a/symforce/caspar/source/runtime/pybind_array_tools.cc +++ b/symforce/caspar/source/runtime/pybind_array_tools.cc @@ -174,9 +174,8 @@ int GetDeviceId(const py::object& obj) { auto interface = obj.attr("__cuda_array_interface__").cast(); auto data = interface["data"].cast(); void* ptr = reinterpret_cast(data[0].cast()); - // This is a host translation unit, so it uses local cuda*->hip* aliases here - // rather than the device-side cuda_to_hip.h (which pulls in hipcub and - // __device__ helpers intended for the .cu sources). + // This host translation unit calls the HIP runtime directly rather than + // including cuda_to_hip.h, which also pulls in hipcub. #if defined(USE_HIP) || defined(__HIP_PLATFORM_AMD__) hipPointerAttribute_t attrs; hipError_t err = hipPointerGetAttributes(&attrs, ptr);