Commit Graph

25 Commits

Author SHA1 Message Date
Adeeb Shihadeh 16ec56398c add openpilot prefix to imports (#29498)
* add openpilot prefix to imports

* more

* more

* fix docs

* fix linter

* bump submodules

* fix patched tests

* update dynamic imports

* debug

* Revert "debug"

This reverts commit db5e13b9911cc74438bee123bc3430da6c31b24b.

* fix pm test
old-commit-hash: a9626f95b69af19306143fc4def02fb5769405d2
2023-08-20 20:49:55 -07:00
Adeeb Shihadeh e33973cdd4 pre-commit: autoupdate hooks (#29198)
* Update pre-commit hook versions

* fix

* bump submodules

* one more

---------

Co-authored-by: adeebshihadeh <adeebshihadeh@users.noreply.github.com>
old-commit-hash: 39ce23420c34d74256e6bda07ffb4016541b3d19
2023-08-01 12:32:21 -07:00
Ewout ter Hoeven f206ebd054 Pyupgrade 3.6: Update syntax with Python 3.6+ features (#23305)
Updated Python code with Python 3.6+ features:
- utf-8 encoding is now the default (PEP 3120)
- Replace list comprehensions by Generator Expressions (PEP 289)
- Replace yield loop by yield from (PEP 380)
- Remove the (object) subclass when defining a class
- Replace the IOError alias by OSError (PEP 3151)
- Define sets with curly braces {} instead of set()
- Remove "r" parameter from open function, which is default

Co-Authored-By: Adeeb Shihadeh <8762862+adeebshihadeh@users.noreply.github.com>
Co-Authored-By: GregorKikelj <96022003+GregorKikelj@users.noreply.github.com>

Co-authored-by: Adeeb Shihadeh <8762862+adeebshihadeh@users.noreply.github.com>
Co-authored-by: GregorKikelj <96022003+GregorKikelj@users.noreply.github.com>
old-commit-hash: 332f568a8241fba9459cb70c76840b9670e6993a
2021-12-24 11:18:39 -08:00
Vivek Aithal 37ccdd8127 locationd: cleanup (#23088)
* remove dead code, avoid indexing by value in locationd

* remove dead states in live_kf
old-commit-hash: 64eb5b0da4d624ecc03f8a45b73296871ae726ff
2021-12-01 00:09:00 -08:00
Vivek Aithal d537897e9a locationd: Fix Nav localization reliability (#22959)
* modify reset logic

* remove debug statements

* use ecef pos and vel covariances during reset

* reset orientations initialized to 0,0,GPSbearing

* refactor nav fix

* add fake gps observations to control ecef pos and ecef vel std

* replace fake_P with individual fake cov

* set gps mode flag

* add gps invalid flag names

* update refs

* more accurate gps accuracy check + update refs
old-commit-hash: 8b6a14758329eb977beb5cba73403dd113495aeb
2021-11-24 15:24:25 -08:00
Vivek Aithal 16d9fcbd80 Revert ecef std until real fix (#22982)
* too low

* update refs

Co-authored-by: Harald Schafer <harald.the.engineer@gmail.com>
old-commit-hash: 94d59314e28c484c8a4a9fb36c8ab659ea79da57
2021-11-19 12:49:32 -08:00
Vivek Aithal 27a6dc0c08 locationd : Acceleration Bias in locationd (#22879)
* add accel bias to filter for offline calculation

* bugfix acc bias in live_kf

* add no_accel obsertvation

* increase initial certainty of acc-bias and reduce PN

* increase initial certainty of acc-bias and reduce PN

* increase accel bias PN

* increase obs noise for no_accel observation

* style fixes

* update refs
old-commit-hash: 534bf697eeb3b72643abc713649ce2eef5f75820
2021-11-12 15:55:16 -08:00
Vivek Aithal 6bc1c7b502 locationd: Make live_kf robust to no GPS (#22774)
* add no gps observations

* use correct ecef_location, orientation vals and stds for nogps states

* remove earth radius obs

* move initial loc to the ocean

* remove unnecessary changes

* update refs
old-commit-hash: 5c810a45b0e7614bfbd7a1b6898547df499964e0
2021-11-09 14:45:47 -08:00
Vivek Aithal b150ceffa4 locationd: Gyro bias initial covariance (#22622)
* reduce cam odo std multiplier

* increase gyro obs noise

* increase initial cov for gyro bias
old-commit-hash: 2006aa412e9eeac59036805dee1dde65d4e9522e
2021-10-22 21:00:01 -07:00
Willem Melching b4263a43fc Locationd 100 Hz (#20816)
* fix std transform

* 100Hz

* new ref

* no more decimation

* clean up confusing maths

* static typing

* Revert "static typing"

This reverts commit 23d87337de648e629fbd35dd8c04a740bbefca47.

* 100Hz costs more

* move normalization into core

* add quat idxs

* add big eps

* this is not safe in the filter

* more sensible

* updates to rednose

* not tested

* normalize in python too

* update rednose

* nan check

* check for infs too

* all should be finite

* update ref

* rednose pr now in master

Co-authored-by: Harald Schafer <harald.the.engineer@gmail.com>
old-commit-hash: e9db5723ef348954118643501a92cf0715402fea
2021-05-06 11:01:58 +02:00
Joost Wooning c0ac9bb63c convert locationd to c++ (#20622)
* live_kf to c++

* first locationd code

* Running in process_replay

* locationd handle cam_odo and live_calib

* log event handlers

* working message receiving

* compiling message sending

* correctly sending some messages

* correct receiving and sending

* update ref_commit with some all_alive_and_valid being false, minor fixes

* fix std abs

* linking on device fix

* fix cpu usage test

* generate kf constants and defines

* fix replay test

* replay without acks, cleanup

* operate on bytearray messages

* cleanup

* send msg fix

* small sleep, less flaky test

* remove python locationd

* review feedback

* bump rednose
old-commit-hash: 3420707ad58b060333246eb43db09474bb336d39
2021-04-20 11:56:43 +02:00
Joost Wooning ff9840c53f locationd and paramsd using cython version of ekfsym (#20610)
* Locationd live_kf using c++ kalman filter

* use both cpp and python live_kf to compare

* Locationd using ekfsym cpp

* Paramsd using c++ ekf_sym

* Other building method

* Cleanup

* cleanup

* Single sconscript for rednose and locationd/models

* CI

* CI

* CI fix

* renamed scons config

* Fix lib loading

* bump rednose

* update cpu usage test
old-commit-hash: e6a8157916e9f8365f3f4ac70e49a552e40a8511
2021-04-08 13:09:11 +02:00
HaraldSchafer cf6c7cb2b8 Update locationd (#20410)
* this was too extreme

* unused import

* capnp wants bools

* update refs
old-commit-hash: 8bddaa7607e659c1cb247b448684d716257a3158
2021-03-19 17:12:34 -07:00
Willem Melching 9616a0f245 pass cloudlog to EKF_sym
old-commit-hash: d9c1561d3722c067b0dec5e4c63d09b00399a133
2021-03-15 13:27:12 +01:00
HaraldSchafer a1d6e4f9f0 Locationd process noise typo (#20085)
old-commit-hash: 9e746c6dd8aa5d282e3eaf9c896f0282981af102
2021-02-16 11:41:21 +01:00
HaraldSchafer bc3b340694 Misc locationd improvements (#1714)
* I like this more

* rewind less

* bump rednose

* falling off windshield detectopr

* adjust thresholds

* this is a soft disable now

* move that

* process replay fixes

* update refs

Co-authored-by: Comma Device <device@comma.ai>
Co-authored-by: Adeeb Shihadeh <adeebshihadeh@gmail.com>
old-commit-hash: 8e2d344135b9a1102503432d651e6bf599d9fa42
2020-07-30 15:33:22 -07:00
Adeeb Shihadeh be0b43f339 enable flake8 E231: missing whitespace after comma
old-commit-hash: efd5dffb1e727c70065fdbe7499ec9e009dfd282
2020-05-31 12:49:11 -07:00
HaraldSchafer 9dae9d6910 pure init (#1569)
old-commit-hash: 7c8d6cbdeff7b6c7ea5af9c4ed8843fea97c58a1
2020-05-26 20:49:14 -07:00
Harald Schafer 818695cfe7 needed for stability
old-commit-hash: 00e05bc7d881feaf82529b4066789e41ee555c42
2020-05-21 17:47:05 -07:00
HaraldSchafer e21bbf8bbd Locationd cleanup (#1517)
* way cleaner take 2

* cleanup

* be more relaxed

* just let it be

* don't drive backwards or upside down

* do this more

* vNED sometyimes invalid

* use reasonble stds

* stability in nonlinear zone

* previous metrics were without publishing
old-commit-hash: 81686547cc10dc129fb921f938dc496455613e33
2020-05-17 20:59:53 -07:00
Harald Schafer 99d9c3651c xRevert "way cleaner"
This reverts commit b8d13b1b44c6d33cb8209aac7fa65a269d8892b9.

old-commit-hash: 273e81715a045b9aac07796973493aad86f7a3e6
2020-05-15 14:29:34 -07:00
Harald Schafer 696fd01f9d way cleaner
old-commit-hash: a4ffd8c226ab1f286334c1cee9a90a03cbaec91a
2020-05-15 14:24:11 -07:00
Bruce Wayne 157c671a60 make linter happy
old-commit-hash: f8a0eb0f7a9a63404b82b3f131436dcd5d9958c8
2020-05-14 17:38:52 -07:00
Harald Schafer 777e183af3 too complex
old-commit-hash: 013e49bf907539d119fbebcf02f4ce3749849065
2020-05-14 16:30:00 -07:00
Willem Melching 8f71de0dbe Rednose (#1503)
* add rednose

* update rednose

* This compiles

* Add rednose to release

* cleanup

* Extract generated dir as argument

* Add constants.py to release

* Add rednose to dockerfile

* Fix that
old-commit-hash: 28bf5d1dd8d08cd8998d2ee9d813b7e573858cf9
2020-05-14 15:36:56 -07:00