Vivek Aithal
94d59314e2
Revert ecef std until real fix ( #22982 )
...
* too low
* update refs
Co-authored-by: Harald Schafer <harald.the.engineer@gmail.com>
3 years ago
Vivek Aithal
534bf697ee
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
4 years ago
Vivek Aithal
c7be73b826
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>
4 years ago
Vivek Aithal
5c810a45b0
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
4 years ago
Mayfield
5246f0231e
enable wshadow ( #22756 )
...
* enable wshadow (#22714 )
* fix replay
* more build fixes
Co-authored-by: Willem Melching <willem.melching@gmail.com>
4 years ago
Vivek Aithal
2006aa412e
locationd: Gyro bias initial covariance ( #22622 )
...
* reduce cam odo std multiplier
* increase gyro obs noise
* increase initial cov for gyro bias
4 years ago
Vivek Aithal
f1546e6552
expose filter internal states and stds ( #22564 )
4 years ago
Vivek Aithal
d22f57e36d
remove confusing logic in live_kf, move to locationd ( #22558 )
4 years ago
Vivek Aithal
83a53618b3
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>
4 years ago
Vivek Aithal
244fbde56e
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
4 years ago
Vivek Aithal
3778592f50
locationd: modify factor for measurement STDEV in gps update ( #22262 )
...
* modify factor for measurement STDEV in gps update
* add new ref_commit
4 years ago
HaraldSchafer
e0087fc313
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
4 years ago
arfy slowy
d74def61f8
fix: spelling typos ( #21861 )
...
* fix: typo spelling grammar
* revert
* Update selfdrive/locationd/calibrationd.py
* more revert
Co-authored-by: Adeeb Shihadeh <adeebshihadeh@gmail.com>
4 years ago
Harald Schafer
e63d94d8d2
Revert "nav: use calibrated orientation ( #21853 )"
...
This reverts commit 4b209f31a1
.
4 years ago
HaraldSchafer
4b209f31a1
nav: use calibrated orientation ( #21853 )
...
* calibrate map
* msg added
4 years ago
HaraldSchafer
049a1bca34
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>
4 years ago
Willem Melching
6feafc0042
tici: use LSM6DS3 ( #21496 )
4 years ago
HaraldSchafer
a3071bf15b
Update car_kf.py
4 years ago
Adeeb Shihadeh
f01ebc5680
make locationd and paramsd RT ( #21264 )
4 years ago
HaraldSchafer
9a2306e008
gps can be bad in cities ( #21270 )
4 years ago
Dean Lee
e4e669bb0f
add space after function name and if statement ( #21225 )
4 years ago
Dean Lee
ee46672d3c
Passing arguments by reference ( #21205 )
4 years ago
Adeeb Shihadeh
9e94fb17cf
fix qcom and qcom2 builds
4 years ago
Dean Lee
c53cb5d570
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
4 years ago
HaraldSchafer
1c926d23da
Many localizer resets alert ( #21116 )
...
* add excessive reset
* add alert
* add event
4 years ago
Dean Lee
65e0b1e699
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
4 years ago
Adeeb Shihadeh
f7cf66867b
remove test too
4 years ago
Adeeb Shihadeh
95380969ea
calibrationd: remove support for json params
4 years ago
Willem Melching
ea5141d909
Store almanac on ublox poweroff ( #20967 )
...
* Store almanac on ublox poweroff
* send current UTC time
* move message building to ublox_msg.h
4 years ago
Adeeb Shihadeh
6b4e49af0e
fix linter
4 years ago
Comma Device
bffba1a91e
little helper script
4 years ago
HaraldSchafer
2f80775b50
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>
4 years ago
Willem Melching
17c3220322
Rate limit paramsd angleOffset output ( #20946 )
...
* rate limit paramsd angle offset
* update ref
4 years ago
Dean Lee
0495426535
Cleanup includes ( #20925 )
...
* remove #include <pthread.h>
* remove #include<stdbool.h> for cc files
* remove #include<iostream>
4 years ago
HaraldSchafer
e5f93ef142
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 b04b92ac2d
.
* add hw status flags
4 years ago
Willem Melching
65ab98a6c8
locationd: ignore empty sensorEvents ( #20887 )
4 years ago
HaraldSchafer
62e22e7eac
time checks in locationd ( #20880 )
...
* time checks
* no debug print
* correct timestamps in test
* non nan
4 years ago
Dean Lee
7222d0f20d
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>
4 years ago
Willem Melching
c62bb10640
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>
4 years ago
Willem Melching
fc3da5eaf9
Use standstill flag in locationd ( #20838 )
4 years ago
Willem Melching
e9db5723ef
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>
4 years ago
Willem Melching
b768729755
paramsd: nan checks are implicit now
4 years ago
Willem Melching
d6a575a860
paramsd: stricter checks on locationd yaw rate outputs
4 years ago
Willem Melching
d96edb6817
C++ Process replay improvements - Part 1 ( #20828 )
...
* C++ Process replay improvements
* revert that change
* create publisher before subscribers
* dont block forever, print warning
* add comment
* create sockets after process init
* try once more to receive the message
* SIMULATION env variable
* print message num when no response
4 years ago
Adeeb Shihadeh
ec414e2eb1
set nice values for non RT processes ( #20812 )
...
* set nice values for non RT processes
* builds
* fix qcom build
Co-authored-by: Comma Device <device@comma.ai>
4 years ago
Willem Melching
9fb79024ef
Add more sanity checks to paramsd ( #20820 )
...
* add more sanity checks to paramsd
* Update selfdrive/locationd/paramsd.py
4 years ago
Adeeb Shihadeh
8a280fbb8e
bump cereal
4 years ago
Willem Melching
0b4d28b9d6
paramsd: check NaN in inputs and outputs ( #20804 )
4 years ago
Dean Lee
81491dc57f
c++ cleanup: standardize file extensions to .cc and .h ( #20800 )
...
* c++ cleanup: standardize file extensions to .cc and .h
* cleanup files_common
4 years ago
HaraldSchafer
daecf4247b
Revert "Locationd 100hz ( #20759 )" ( #20797 )
...
* Revert "Locationd 100hz (#20759 )"
This reverts commit 333313cf0e
.
* new ref
4 years ago