4708268c7d
Revert "Dont use erratic current block ( #23211 )" ( #23221 )
...
This reverts commit 5c76900f565c8e55f5738efb8fdf5d6a846dbe0e.
old-commit-hash: 837823ff58b57d49bc079a5d7f9ea8db55dc7d76
2021-12-14 13:59:39 -08:00
6a7849aea3
Dont use erratic current block ( #23211 )
...
old-commit-hash: 19335bb6a48f0e3558c837557a1ae7c66b8b8587
2021-12-14 13:58:42 -08:00
3e72a81dac
Use std::unique_ptr to manage memory ( #23168 )
...
* use unique_ptr
* trigger ci
* move down loggerdstate
old-commit-hash: 4aa291c406752169f4d836e952708eeccbb36c5d
2021-12-13 14:16:53 +01:00
dd7c226097
util: move all functions into util namespace ( #23203 )
...
old-commit-hash: 9decd3d8a20167de684322a458e28c8d1f746f83
2021-12-12 14:42:23 -08:00
c7b1ac57d8
locationd_thread: fix possible dangling reference to params ( #23156 )
...
old-commit-hash: 48963d4b24223aa7e87f257558bf7caa48761868
2021-12-08 17:46:18 +01:00
c9ef5b176e
add check for restoring almanac, and clear like suggested in the datasheet ( #23153 )
...
Co-authored-by: Comma Device <device@comma.ai >
old-commit-hash: bb7208f4c34fe70682f24a3e637b03aeaa4f719c
2021-12-08 14:13:56 +01:00
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
b2ddfb3719
add a note in loc_kf ( #23082 )
...
old-commit-hash: b57f55088e4a4054ba4b86d7cce9b2a20704db61
2021-11-30 10:51:32 -08:00
87f37d73a3
Mesh3D: Add accelerometer bias to loc_kf ( #22880 )
...
* add accel-bias to mesh3d
* remove acc scale
old-commit-hash: 5040427cb739fad364319070a0f87ab03031cd99
2021-11-29 19:30:14 -08:00
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
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
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
d49fbbfbed
locationd: Set ECEF_POS valid flag to false if in no-gps mode ( #22857 )
...
* set ECEF_POS valid flag to false if in no-gps mode
* modify valid flag for all ecef states before gps
* add calibrated valid when no gps
* update refs
* remove extra whitespace
* add invalid flag to all NED values pre gps
* update refs
* update correct refs
Co-authored-by: Adeeb Shihadeh <adeebshihadeh@gmail.com >
old-commit-hash: c7be73b826b21947197f24c6a60fc5a7098e42af
2021-11-11 21:34:17 -08:00
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
43e1903073
enable wshadow ( #22756 )
...
* enable wshadow (#22714 )
* fix replay
* more build fixes
Co-authored-by: Willem Melching <willem.melching@gmail.com >
old-commit-hash: 5246f0231e6bfa572c0dd89c60e538910817faa2
2021-11-02 17:08:53 +01:00
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
80600a77dc
expose filter internal states and stds ( #22564 )
...
old-commit-hash: f1546e6552fdf51b99cb44eafff5f88b1de536f1
2021-10-14 19:44:31 -07:00
0bc7ccfbaa
remove confusing logic in live_kf, move to locationd ( #22558 )
...
old-commit-hash: d22f57e36db00f1e6873e3a50f22b8ab2fa94232
2021-10-14 11:57:50 -07:00
9f96d63520
paramsd: Sort messages in each update iteration before processing ( #22403 )
...
* sort livelocationKalman and carState messages in each update iteration before processing
* update refs
* update refs
* update refs
* update again
Co-authored-by: Adeeb Shihadeh <adeebshihadeh@gmail.com >
old-commit-hash: 83a53618b3a04377ee55561da7460a6f5da7d8d1
2021-10-07 18:21:11 -07:00
c0ff654602
Add paramsd Stdev to message ( #22443 )
...
* add STD to message
* use modified names for car_kf state stdev atttributes
* update refs
* add modofied cereal
* update refs
old-commit-hash: 244fbde56e90a937c887b3a24edce7da2ee5c699
2021-10-06 16:22:18 -07:00
5359f183aa
locationd: modify factor for measurement STDEV in gps update ( #22262 )
...
* modify factor for measurement STDEV in gps update
* add new ref_commit
old-commit-hash: 3778592f5049e53b06d1fd6b11e08f59c6fee42a
2021-09-17 22:33:46 -07:00
3eb667e29d
Fix orientation in map ( #21863 )
...
* fix calibrated orientation
* update ref
* cleaner
* update ref
* master
* update again
* update ref again again
* actually compiled this tim,e
old-commit-hash: e0087fc313b4032532e3736a4be2b07510a0c9bf
2021-08-05 21:06:46 -07:00
63b3d6024b
fix: spelling typos ( #21861 )
...
* fix: typo spelling grammar
* revert
* Update selfdrive/locationd/calibrationd.py
* more revert
Co-authored-by: Adeeb Shihadeh <adeebshihadeh@gmail.com >
old-commit-hash: d74def61f88937302f7423eea67895d5f4c596b5
2021-08-05 12:05:49 -07:00
acd45c486b
Revert "nav: use calibrated orientation ( #21853 )"
...
This reverts commit cd19b37a6b187e0c26cdfe7c42e975abb1dc0155.
old-commit-hash: e63d94d8d24975d308e17b7ce71fdb6b5529dac4
2021-08-04 10:41:49 -07:00
1c35dc951d
nav: use calibrated orientation ( #21853 )
...
* calibrate map
* msg added
old-commit-hash: 4b209f31a11546a3a56032558c656c2aa0b3175f
2021-08-04 09:58:04 -07:00
d1c5e054d0
Better localizer unstable alert ( #21660 )
...
* use canonical language
* filter out when gps signal is flaky
* Update selfdrive/locationd/locationd.cc
Co-authored-by: Willem Melching <willem.melching@gmail.com >
Co-authored-by: Willem Melching <willem.melching@gmail.com >
old-commit-hash: 049a1bca34c74ea1fae473386e8bea62f1b3041c
2021-07-20 19:20:00 -07:00
5c1ba7502f
tici: use LSM6DS3 ( #21496 )
...
old-commit-hash: 6feafc0042b72a8699d2a613b0505acbd99b57f0
2021-07-06 23:02:54 +02:00
eff53180ca
Update car_kf.py
...
old-commit-hash: a3071bf15b27907fe28e054b64ad45cdab38c25f
2021-06-18 17:57:42 -07:00
e75dc5718c
make locationd and paramsd RT ( #21264 )
...
old-commit-hash: f01ebc56807a9946ae06a9e6b1bf366bf5a124e0
2021-06-17 14:19:24 -07:00
1cbda7bac0
gps can be bad in cities ( #21270 )
...
old-commit-hash: 9a2306e00875b227ff13b0bf88b80b14d387df56
2021-06-15 10:17:20 -07:00
147b355dde
add space after function name and if statement ( #21225 )
...
old-commit-hash: e4e669bb0fc1a919dfb38800099f8e3ad52346f1
2021-06-11 10:17:52 +02:00
51cf285c31
Passing arguments by reference ( #21205 )
...
old-commit-hash: ee46672d3c8c86b41fd8ae2fce9120e050b8e628
2021-06-09 14:09:02 +02:00
edd2f1c1a6
fix qcom and qcom2 builds
...
old-commit-hash: 9e94fb17cfd95dfc5ad85534e50748d5e4225dac
2021-06-08 16:44:05 -07:00
f70a79b838
Use C++ header files instead of C header files. ( #21192 )
...
* use cstring instead of string.h
* use cstdio instead of stdio.h
* remove inttypes.h
* use cstdlib instead of stdlib.h
* use cstdint instead of stdint.h
* #include <cstddef>
* cstdlib
* use cmath
* remove stddef.h
* use cassert
* use csignal
* use ctime
* use cerror
* rebase master
old-commit-hash: c53cb5d570adb82bc454fcabab458d7e7f09738c
2021-06-08 13:46:22 -07:00
f0f36a0a06
Many localizer resets alert ( #21116 )
...
* add excessive reset
* add alert
* add event
old-commit-hash: 1c926d23da0c73ceb246ca6d61db6ed1c48a1ab9
2021-06-03 09:26:53 -07:00
497472932a
Cleanup util.h ( #20849 )
...
* cleanup util.h
* fix build error:omx_encoder.cc:408: undefined reference to do_exit
* fix build error
* rebase master
* move helper functions back to util
* ExitHandleHelper->ExitHandlerHelper
* std::clamp
* struct ExitHandlerHelper to class
* rebase master
* cleanup
* restore ExitHandler
* prefer cassert
old-commit-hash: 65e0b1e699092355bfcb1f588a5a2ec949a34b77
2021-06-01 16:53:12 +02:00
82a82ce9b6
remove test too
...
old-commit-hash: f7cf66867bff75f5b53b6d0a2919a67e6e22242f
2021-05-27 12:37:52 -07:00
e35b30c9dd
calibrationd: remove support for json params
...
old-commit-hash: 95380969ea640c42968546a12133a6ebb8ca03fa
2021-05-27 12:36:42 -07:00
4d874a90ea
Store almanac on ublox poweroff ( #20967 )
...
* Store almanac on ublox poweroff
* send current UTC time
* move message building to ublox_msg.h
old-commit-hash: ea5141d9096d64890a23a806612eb4edf58ea548
2021-05-20 11:43:03 +02:00
5a9504b59a
fix linter
...
old-commit-hash: 6b4e49af0ea9ea29493a7f4006a5c0cb5c92ad78
2021-05-18 19:35:32 -07:00
262a059933
little helper script
...
old-commit-hash: bffba1a91ef37a19a65bc8d7a1546fe0bf326f1a
2021-05-18 18:56:58 -07:00
c0c009bba9
Filter only initialized if up for 1sec ( #20940 )
...
* add time since reset check
* fix time since reset
* update ref
Co-authored-by: Willem Melching <willem.melching@gmail.com >
old-commit-hash: 2f80775b50174070ab463896e73bfef827d00516
2021-05-18 11:12:02 -07:00
26f9d28532
Rate limit paramsd angleOffset output ( #20946 )
...
* rate limit paramsd angle offset
* update ref
old-commit-hash: 17c322032236a09eefc4224417ba0b163591da60
2021-05-18 12:59:42 +02:00
5609f32cee
Cleanup includes ( #20925 )
...
* remove #include <pthread.h>
* remove #include<stdbool.h> for cc files
* remove #include<iostream>
old-commit-hash: 0495426535490e7d8d503af35ace7a20dc70a7bb
2021-05-17 10:31:31 +02:00
8559ab5ebd
Add ublox interference monitor ( #20911 )
...
* add interference monitor
* new thresholds
* correct labels
* always run for test
* new msg
* add flag
* Revert "always run for test"
This reverts commit b04b92ac2d73d996d1526509e26c4e1a4338cbbb.
* add hw status flags
old-commit-hash: e5f93ef142af706eed05f1d015e1436efa29d1de
2021-05-14 15:23:27 -07:00
c8e4dfafe8
locationd: ignore empty sensorEvents ( #20887 )
...
old-commit-hash: 65ab98a6c83cc81fe5916bac964ffafe34bfc47c
2021-05-12 16:47:52 +02:00
420090ffea
time checks in locationd ( #20880 )
...
* time checks
* no debug print
* correct timestamps in test
* non nan
old-commit-hash: 62e22e7eac898216b11fc0ae364a3a9905df6699
2021-05-11 15:57:13 -07:00
e333e4f189
Cleanup selfdrive/ includes ( #20822 )
...
* cleanup include path
* continue
* format includes
* fix testraw.cc
* remove include path from SConstruct
* regroup
* rebase master
* almost done
* apply review
* rename FileReader.xx to filereader.xx
* rename Unlogger.x->unlogger.x
* rename FrameReader.xx -> framereader.xx
* apply reviews
* ui.h
* continue
* fix framebuffer.cc build error:mv util.h up
* full path to msm_media_info
* fix qcom2 camerad
Co-authored-by: Comma Device <device@comma.ai >
old-commit-hash: 7222d0f20dc8edfe0d2f3417d1ce7c84fbd32805
2021-05-08 22:15:17 -07:00
4707416cdd
Locationd input sanity checks ( #20845 )
...
* Add first sanity checks on inputs
* more gps checks
* make sure test values pass sanity checks
* this localizer supports cannonball runs
Co-authored-by: Harald Schafer <harald.the.engineer@gmail.com >
old-commit-hash: c62bb106407f50b785570f6b01736839e2b42514
2021-05-06 13:39:50 -07:00
9cfda07c9e
Use standstill flag in locationd ( #20838 )
...
old-commit-hash: fc3da5eaf9e9448825115e19dd59e1a2657ab249
2021-05-06 13:13:13 -07:00
HaraldSchafer