Commit Graph

230 Commits

Author SHA1 Message Date
HaraldSchafer 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
Willem Melching c8e4dfafe8 locationd: ignore empty sensorEvents (#20887)
old-commit-hash: 65ab98a6c83cc81fe5916bac964ffafe34bfc47c
2021-05-12 16:47:52 +02:00
HaraldSchafer 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
Dean Lee 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
Willem Melching 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
Willem Melching 9cfda07c9e Use standstill flag in locationd (#20838)
old-commit-hash: fc3da5eaf9e9448825115e19dd59e1a2657ab249
2021-05-06 13:13:13 -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
Willem Melching ab886b9599 paramsd: nan checks are implicit now
old-commit-hash: b768729755d1a749fcf36b20ae7690df8091a1b8
2021-05-05 17:44:28 +02:00
Willem Melching 2901659fe2 paramsd: stricter checks on locationd yaw rate outputs
old-commit-hash: d6a575a8605130a59575ec7668e0d0eb90626595
2021-05-05 17:42:11 +02:00
Willem Melching fa3cd32780 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
old-commit-hash: d96edb68177ccbcf60a21b81ed1c0815f306efbc
2021-05-05 17:14:29 +02:00
Adeeb Shihadeh 55a9ec8a93 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>
old-commit-hash: ec414e2eb1e27eac04582ffbdc88f8022bfb34cc
2021-05-04 22:00:11 -07:00
Willem Melching b9fa4e5696 Add more sanity checks to paramsd (#20820)
* add more sanity checks to paramsd

* Update selfdrive/locationd/paramsd.py
old-commit-hash: 9fb79024ef34206e127a30a408b7bac970387c08
2021-05-04 09:50:45 -07:00
Adeeb Shihadeh 532d19427c bump cereal
old-commit-hash: 8a280fbb8eb433fbfe0fc43254c9cbdaceedbab6
2021-05-03 20:47:11 -07:00
Willem Melching 8bd3b9a7b8 paramsd: check NaN in inputs and outputs (#20804)
old-commit-hash: 0b4d28b9d697ad7b55495993bd4a7d2800c4e79b
2021-05-03 14:13:31 +02:00
Dean Lee 9a827fea20 c++ cleanup: standardize file extensions to .cc and .h (#20800)
* c++ cleanup: standardize file extensions to .cc and .h

* cleanup files_common
old-commit-hash: 81491dc57f5080c602a0be58dd5f9feba2fa31b9
2021-05-03 11:53:11 +02:00
HaraldSchafer fd28911282 Revert "Locationd 100hz (#20759)" (#20797)
* Revert "Locationd 100hz (#20759)"

This reverts commit 995b89e6424a7b717fb2c725a64d617fb24a1a85.

* new ref
old-commit-hash: daecf4247be74fbe56ae84b4c6585c4c8cbc49b5
2021-05-02 15:06:34 -07:00
HaraldSchafer cbc2cb24b7 Locationd 100hz (#20759)
* 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
old-commit-hash: 333313cf0e6819767d8dcc4a55bea70f0354579f
2021-04-28 15:29:14 -07:00
Joost Wooning 5b31cc281c compare carspeed float to epsilon instead of zero (#20714)
* compare carspeed float to epsilon instead of zero

* update ref

* add ref commit again

Co-authored-by: Harald Schafer <harald.the.engineer@gmail.com>
old-commit-hash: d2a2ccfee45fdf94425354efbfd17fabce4cb5e7
2021-04-22 17:55:41 -07:00
Joost Wooning ac03b730a4 unittests for locationd uncommon events (#20715)
* unittests for locationd uncommon events

* params test using process

* test for posenet spike

* fix library path

* move random seed to setup
old-commit-hash: 5fdcce2551e5cb7477d9646e449469399d6576fa
2021-04-22 15:31:18 +02:00
Joost Wooning e07740c35c create library for using locationd in python using ffi (#20711)
* create library for using locationd in python using ffi

* lib is not required in release

* cleanup

* dont build liblocationd on release

* add check on buffer size
old-commit-hash: e08a570a138915b8d115dbcf21612deb53b7e666
2021-04-20 17:50:40 +02:00
Joost Wooning 2803d26b14 params put in locationd async (#20713)
* params put in locationd async

* remove reference in thread call
old-commit-hash: ed8acfa28447472c282c1c94c929ababb4632305
2021-04-20 16:02:57 +02:00
Willem Melching 41901d2204 Remove sympy import from paramsd at runtime (#20710)
old-commit-hash: b27bad8776ff055af69cd8c8763fe2e12934fb6a
2021-04-20 14:29:37 +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
Willem Melching 07f89b2838 Improve robustness of ublox init procedure (#20685)
* improve ublox init robustness

* cleanup

* only log if running at 1hz

* not needed
old-commit-hash: a163daf5e024867d7301f4e20bea20fba4bb59ae
2021-04-15 14:11:53 +02:00
Willem Melching 7483953935 disable GC for locationd and paramsd (#20680)
old-commit-hash: fc478ff92080b747c0965047522b8f3876da4e6f
2021-04-14 23:59:29 -07:00
Willem Melching fb5c269833 Cleanup ubloxd message parsing (#20664)
* use kaitai to generate parsers

* add scons flag to generate parsers

* add outer layer ephemeris parsing

* create ephemeris packet at the right time

* parse subframe 1 and 2

* add more fields

* add generated files to release

* fix signs

* no cast

* add unordered map include

* add exception handling

* small cleanup

* parse iono data

* cleanup
old-commit-hash: eacacb8fba8a58f32132c06e16012f99c2ee5f26
2021-04-14 16:17:30 +02:00
Willem Melching f4335a7dfe Fix typo in ephemeris parsing (#20677)
* fix typo in ephemeris parsing

* update ref
old-commit-hash: 343fea2bf9f68e78e21f0dc13912e2accb4d958d
2021-04-14 11:25:43 +02:00
HaraldSchafer a5fff75b5e Loosen ecamera calib checks (#20629)
* relax thresholds for widecamera

* cleaner
old-commit-hash: c92f171866dfe4f6c6cf8cdb900073f32c81b160
2021-04-09 20:38:09 -07:00
Willem Melching 2d6d92402a Ubloxd cleanup (#20637)
* clean out locationd/test

* get rid of ubloxd_main

* remove ubloxd_test.cc

* less includes
old-commit-hash: 4dd4b1214061ebade872e7de73fce1800a9b74ca
2021-04-09 18:01:24 +02:00
Willem Melching 99a8e9222e Add list for average frequency ignore (#20624)
* add list for averge frequency ignore

* typo
old-commit-hash: c1075037ba3cbef9814e3bc2930e5c6eea6c46ed
2021-04-08 18:04:16 +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
Dean Lee d33538e5f3 Qt: show current calibration values (#20455)
* show current calibration

* read calibration from capnp

* use CalStatus

* cleanup calibrationd.py

* remove import capnp

* keep json writing,remove comment

* fix test error

* cleanup

* remove test_read_saved_params

* cleanup

* write out capnp

* restore test

* clean up

* get calibration from CalibrationParams

* cleanup

* update calibration when the description is visible

* cleanup

Co-authored-by: Adeeb Shihadeh <adeebshihadeh@gmail.com>
Co-authored-by: Comma Device <device@comma.ai>
old-commit-hash: 57fe8488ac8bf02ea7f2eb61be2e256ece773cd6
2021-04-06 15:02:40 -07: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 c64d818341 use class AlignedBuffer (#20388)
* use class AlignedBuffer from cereal (#20343)

* AlignedBuffer

* move AlignedBuffer to cereal/messaging.hpp

* rename function aligned to get

* use overloaded function AlignedBuffer:: get(Message *)

* use AlignedBuffer

Co-authored-by: Dean Lee <deanlee3@gmail.com>
old-commit-hash: 0a88304e8d51ef8dac881ac9bb16d5de11f184a3
2021-03-17 14:43:23 +01:00
Willem Melching d61654abc3 Revert "use class AlignedBuffer from cereal (#20343)"
This reverts commit df9e836779af0c145efc933b88bbc94f59f2b378.

old-commit-hash: e3ad952902ed38530b56b10f39dc67d7232fd28c
2021-03-16 20:21:03 +01:00
Dean Lee 4c02da3f0a use class AlignedBuffer from cereal (#20343)
* AlignedBuffer

* move AlignedBuffer to cereal/messaging.hpp

* rename function aligned to get

* use overloaded function AlignedBuffer:: get(Message *)
old-commit-hash: 7aa379e123aba70a4c36f95e69786a558892dc2d
2021-03-16 11:13:15 +01:00
Willem Melching 9616a0f245 pass cloudlog to EKF_sym
old-commit-hash: d9c1561d3722c067b0dec5e4c63d09b00399a133
2021-03-15 13:27:12 +01:00
Dean Lee 2654277bc3 use cached buffer for FlatArrayMessageReader (#20233)
old-commit-hash: 12928cdae2e21f59211b19cfe40e432506576212
2021-03-08 11:02:21 +01:00
grekiki fb1ae13b0e Fix ubloxd test compilation (#20101)
old-commit-hash: 82fb638a4761e92859d633e2a6e3e11f93c39a20
2021-02-17 16:07:20 +01:00
Adeeb Shihadeh 05eb44115e cereal cleanup part 2 (#20092)
* car stuff

* thermal

* Revert "car stuff"

This reverts commit 77fd1c65ebd01abfa8493ae12c9e6b14f7ada976.

* panda state

* camera stuff

* start deg

* most is building

* builds

* planner + controls run

* fix up paramsd

* cleanup

* process replay passes

* fix webcam build

* camerad

* no more frame

* thermald

* ui

* paramsd

* camera replay

* fix long tests

* fix camerad tests

* maxSteeringAngle

* bump cereal

* more frame

* cereal master
old-commit-hash: 312b681a46b8153314a8420611b6479dd6f70dfc
2021-02-16 21:39:32 -08:00
HaraldSchafer a1d6e4f9f0 Locationd process noise typo (#20085)
old-commit-hash: 9e746c6dd8aa5d282e3eaf9c896f0282981af102
2021-02-16 11:41:21 +01:00
HaraldSchafer 0e6e652521 fix timestamps (#20029)
* fix timestamps

* nanoseconds

* update refs
old-commit-hash: b3a868103a479aad2d4f787e16ba6f1828897104
2021-02-08 22:15:05 -08:00
Willem Melching 17d5446650 Timezoned (#19960)
* untested code

* add to manager

* whitespace

* only save on fix

* cleanup

* fix typo

* add to ignored processes

* import tici

* fix param name

* cleanup

* only run offroad

* use itertools

* wait for thermald

* simpler

* fall back to api call

* add param to override timezone

Co-authored-by: Comma Device <device@comma.ai>
old-commit-hash: 4c04e220a15c013c86d2d1695764fc339b82c2bc
2021-02-06 11:07:37 +01:00
robbederks 8156542312 implement ublox MON_HW2 message (#19962)
* implement MON_HW2 message

* didn't mean to remove this
old-commit-hash: 99d58193e497385b925a215f42b8bc470e328da4
2021-02-03 13:09:44 +01:00
Dean Lee 165022f035 ublox_msg.h: remove #define min (#19718)
old-commit-hash: d34a6901369cb424ab8e460b3426f5633ff1a9ac
2021-01-11 11:59:14 +01:00
Dean Lee 4c1919f41e merge utilpp.h into util.h (#19710)
old-commit-hash: 595830135bb79c8b23eb8339ae768ca7b6a822f8
2021-01-10 14:57:32 -08:00
Dean Lee 5e557ed96d common exit handler (#19661)
* common signal handle

* fix typo

* rename to ExitHandler

* remove include signal.h

* remove include csignal

* rename variable exit to v

* rebase master
old-commit-hash: 86fe2d1697531bebdf5d0d83609e91ed4006f54b
2021-01-05 20:19:53 -08:00
Adeeb Shihadeh c55926c7b8 lgtm fixes (#19610)
* pass matrices by reference

* suppress that

* destructor

* that's wrong, suppress it
old-commit-hash: 4096f86e210e7caa94e7be2edfd1eb2c247175e8
2020-12-28 20:36:23 -08:00
Adeeb Shihadeh 0f22f60170 small ubloxd cleanup
old-commit-hash: c131f9db57ba92bdf69481757203a6ac72fac986
2020-12-19 15:05:40 -08:00
Dean Lee 1e477f95a6 ublox_msg.cc: simplify map operations in gen_nav_data (#2004)
* simplify map operations in gen_nav_data

* same as before

* rebase master
old-commit-hash: 3bf43bd7e357fae0502a98dbca1af88893a0b892
2020-12-19 14:13:31 -08:00