Commit Graph

405 Commits

Author SHA1 Message Date
Adeeb Shihadeh 5128ca0dd9 locationd: adjust GPS alive check for QCOM GPS (#27339)
* locationd: adjust GPS alive check for QCOM GPS

* update refs

* update refs
old-commit-hash: 00513f10011ad6ad693fbbc9b4b5dc7df36f9a79
2023-02-15 11:28:47 -08:00
Kurt Nistelberger c524e5d29c readd slot number logging
old-commit-hash: fe64e853639e00d6d2cc8910d66b9b8c6f56c808
2023-02-07 21:25:46 -08:00
Kurt Nistelberger 6320c05541 Ubloxd: glonass ephem parsing (#27248)
temp fix

Co-authored-by: Kurt Nistelberger <kurt.nistelberger@gmail.com>
old-commit-hash: 5a0cbc35a544f448e8db1e1578de7607b39a3e76
2023-02-07 17:49:51 -08:00
Kurt Nistelberger 466f83cba5 GPS: add tow to gps ephemeris (#27246)
* add tow to gps ephemeris

* bump cereal

* update refs

---------

Co-authored-by: Kurt Nistelberger <kurt.nistelberger@gmail.com>
old-commit-hash: 6330cdd88513d9dad3e5ab00811c4a5223924423
2023-02-07 17:49:06 -08:00
Kurt Nistelberger 2a64606eb0 Revert "ublox_day_fix"
This reverts commit de1b9576fa1b309469cc0bb0dde2945453fd9490.

old-commit-hash: 4f6fbdf590fdcd9e1327cb42905fa17542d64f73
2023-02-07 15:02:21 -08:00
Kurt Nistelberger 5cf9b71792 ublox_day_fix
old-commit-hash: 9af82c090e1bcb0d76b4c2468d538c75b6e9c650
2023-02-07 15:01:47 -08:00
Kurt Nistelberger d0d606176a glonass support laikad (#27173)
* add glonass kaitai parsing

* add kaita generated files

* remove glonass from build

* add string non immediate type

* fix kaitai bug

* cleanUp

* add patch file

* fix scons order

* make lookup const

* remove comments

* add to release files

* init

* add laika

* remove printf

* laikad add glonass ephem parsing

* add signs

* final ublox parsing

* rev gps

* bump subs

* address comments

* disable internet for laikad

---------

Co-authored-by: Kurt Nistelberger <kurt.nistelberger@gmail.com>
old-commit-hash: 04a7808590ac55a5e3dea6080b6a24aae78d9277
2023-02-02 20:16:28 -08:00
Kurt Nistelberger 0c8cd2c07e Glonass support, ubloxd add ephemeris parsing (#27119)
* add glonass kaitai parsing

* add kaita generated files

* remove glonass from build

* add string non immediate type

* fix kaitai bug

* cleanUp

* add patch file

* fix scons order

* make lookup const

* remove comments

* rename

* add to release files

* add signs

* final ublox parsing

* bump cereal

* update ref

---------

Co-authored-by: Kurt Nistelberger <kurt.nistelberger@gmail.com>
old-commit-hash: 4e27a7f22a94ee5d8afc0476a6781f7e19b6fcf0
2023-02-02 19:29:45 -08:00
Kurt Nistelberger 5ab2a359df Ubloxd: gps add iodc check (#27162)
* gps add iodc check

* add test

* simplify

* update ref

---------

Co-authored-by: Kurt Nistelberger <kurt.nistelberger@gmail.com>
old-commit-hash: 3d98cb72c08ec5d9b9ac5645ea9effecadd6bc38
2023-02-01 14:19:40 -08:00
Vivek Aithal b6eae6f146 paramsd: Check if roll from the localizer is actually valid (#27105)
* add roll_valid check, use localizer roll when it is valid

* increase std to 1.5

* btter check

* avoid numpy

* update refs

* update refs
old-commit-hash: 519b3c8847d5c054b130667977e181cc7e54e7fa
2023-02-01 11:21:51 -08:00
Kurt Nistelberger 2e62b4f08c Ubloxd: move gps parsing to function (#27122)
move ublox gps parsing to function

Co-authored-by: Kurt Nistelberger <kurt.nistelberger@gmail.com>
old-commit-hash: 549e4d9636036af228d3d930d69e8dfd1f67dba6
2023-01-30 16:40:37 -08:00
Kurt Nistelberger 0135d85a6d Ubloxd: glonass parsing tests (#27125)
* add glonass kaitai parsing

* add kaita generated files

* remove glonass from build

* add string non immediate type

* fix kaitai bug

* cleanUp

* add patch file

* fix scons order

* make lookup const

* remove comments

* rename

* add to release files

* remove printf

* add signs

* add glonass parsing test

* finish up glonass kaitai tests

* move cereal back to master

* ignore test_runner

* sign is not two complement

* address comments
---------

Co-authored-by: Kurt Nistelberger <kurt.nistelberger@gmail.com>
old-commit-hash: e2f5b164bd3dcffc5a11ef552f83296c34991949
2023-01-30 16:34:07 -08:00
Kurt Nistelberger 427223c4f7 Revert "add signs to glonass ksy"
This reverts commit 6b2185244559f734cbd5756b3371de101b31b1c7.

old-commit-hash: 53ccec7697247a06ad64fe056dcf07e026a011af
2023-01-28 16:48:26 -08:00
Kurt Nistelberger 54951d95e9 add signs to glonass ksy
old-commit-hash: aa71947ebc9c286a13f86458ea0e970ca0d7a0c7
2023-01-28 16:47:26 -08:00
Vivek Aithal 39e10d3ae3 [RAM 1500 5TH GEN] Disable Live Torque (#27121)
* revert ram on live torque

* update refs

* update refs
old-commit-hash: 8d447e8a081e878a55707cc2840a6d08d88102ca
2023-01-27 15:20:59 -08:00
Kurt Nistelberger e35b2e6e4f Glonass ephemeris support (#27088)
* add glonass kaitai parsing

* add kaita generated files

* remove glonass from build

* add string non immediate type

* fix kaitai bug

* add patch file

* fix scons order

* Update selfdrive/locationd/SConscript

Co-authored-by: Adeeb Shihadeh <adeebshihadeh@gmail.com>

Co-authored-by: Kurt Nistelberger <kurt.nistelberger@gmail.com>
Co-authored-by: Adeeb Shihadeh <adeebshihadeh@gmail.com>
old-commit-hash: 6f0d35a09f54866ff2c7a76993c2f11e96fdf869
2023-01-26 17:25:15 -08:00
Vivek Aithal 905cd786f1 torqued: Update reset logic (#27103)
* update reset logic

* bugfix
old-commit-hash: 9201267fb7ba0080a3c508a6a258f76cbc265079
2023-01-26 14:48:46 -08:00
Vivek Aithal f549106466 [RAM 1500 5TH GEN] Update offline torque parameters and enable torqued (#27072)
* make run torque learnable

* update ram offline values

* add ram 1500 to torqued

* update refs
old-commit-hash: 7ba8e56e877e8d0332def1fb4fedc09945776132
2023-01-24 19:22:13 -08:00
Kurt Nistelberger c517e76764 Laikad: add test (#27028)
* add laikad tropo test

Co-authored-by: Kurt Nistelberger <kurt.nistelberger@gmail.com>
old-commit-hash: 027c27cd690120d8ff8823f0b53cc2c9d6af7df3
2023-01-20 22:19:01 -08:00
Kurt Nistelberger 1cd22ead91 Revert "Add low Gnss laikad test (#26987)"
This reverts commit 453c31b007237ae5009c4a9e0bb3afa04aa12f84.

old-commit-hash: 9131da9103718d6ae113ad7b3519037e2b4ffa70
2023-01-19 11:46:22 -08:00
Kurt Nistelberger 84a95cdc89 Add low Gnss laikad test (#26987)
* add low gnss test

* enable laikad

* temp fix for cache

* update replay

* save LaikadEphemeris for testing

* rem

* update refs

* add comment

Co-authored-by: Kurt Nistelberger <kurt.nistelberger@gmail.com>
old-commit-hash: b7ce77b3aa48c3605554f63068a13860023eff86
2023-01-18 22:29:12 -08:00
Kurt Nistelberger 6509690ac3 Ublox tow continuity check (#27001)
* add continuity check

* simplify

* remove pair

* update refs

* bump laika update refs

Co-authored-by: Kurt Nistelberger <kurt.nistelberger@gmail.com>
old-commit-hash: 669becadde77d79443d933364234212c10d56151
2023-01-18 18:57:54 -08:00
Harald Schäfer f1f5f15f12 Add lane ekf (#26986)
* change lane_kf pos

* add lane back here
old-commit-hash: af97a96080428976abf2f65aa7deec109a015032
2023-01-16 19:43:34 -08:00
Harald Schäfer 63efb985cd Revert locationd to gpsLocation (#26963)
* revert locationd laika change

* switch msg

* change proc replay

* back to gpslocation

* update ref

* no np floats in msg

* Ignore empty laikad messages in mapos

* more tolerance

* c++ doesnt work like that
old-commit-hash: 4c33d94d3f088c6f1fc88a0f40f3a828968c1c52
2023-01-14 16:56:14 -08:00
Bruce Wayne 29d4e1645e Revert "temporary revert laikad as main gps"
This reverts commit a4b9a7fec9c07a42dcb1bb990471a92aa4476855.

old-commit-hash: c44b6225592c070d87d2b3e77018a623d344f054
2023-01-14 10:34:59 -08:00
Kurt Nistelberger 9bbc5bdfb1 temporary revert laikad as main gps
old-commit-hash: 1e8e4f7ede35d9a95c97ccfbb0bf8d7c5df46e39
2023-01-13 22:24:16 -08:00
Vivek Aithal f28fb581f1 paramsd: Remove one active condition (#26922)
* remove one active condition

* update refs

* remove unused vars

* update refs

* update refs
old-commit-hash: 2e36d07106c7e4e8e12afe0c33762abbf217a416
2023-01-13 13:23:06 -08:00
Kurt Nistelberger 9570336e6c Laikad: set active (#26850)
* laikad update, renaming

* update locationd

* fix naming

* address PR comments

* upsi

* .

* draft to fix replay

* fix process relay to allow no response for messages

* final fix for process replay

* .

* bump cereal

* update process replay ref commit

* reduce wait time

* .

* last ref change

* move laikad helpers to laika

* .

* fix ublox test

* update refs

* add proper qcom replay support

* fix gnss support if both is available

* update refs

* remove left over

* revert laikad msg

* move laika back to master

* init

* fix gps valid flag

* change time

* add gnss to ignore

* remove gps_valid flag

* .

* adopt orientation reset threshold

* .

* update laikad

* .

* fix stanstill KF resets

* test orienation reset count

* update laika

* bump cereal

* fix process replay

* update laika repo

* remove handle gps

* add extra logging for cache

* .

* add more log

* .

* .

* update laika

* dont remove gps code

* inc min satellite count

* update magic vals and add acc drop

* update laika

* upsi

* rem

* bump laika

* use nav and correct

* more fixes

* use sftp

* No more glonass

* Revert "No more glonass"

This reverts commit a76124da50a1e25f423ad1137c7a046e1d57811d.

* nump laika

* back support old ephemeris cache

* add health to ephemeris message

* bump laika

* remove print

* fix laikad tests

* clean

* remove extra log

* bump laika

* inc timeout for plotjuggler build

* rem cache clear

* .

* enable gps after checks

Co-authored-by: Kurt Nistelberger <kurt.nistelberger@gmail.com>
Co-authored-by: Bruce Wayne <harald.the.engineer@gmail.com>
Co-authored-by: Shane Smiskol <shane@smiskol.com>
old-commit-hash: 88423e25df8bfbd8e6a3275eb086f468cf9a59f1
2023-01-13 11:37:38 -08:00
Kurt Nistelberger c469ee2f6c Laikad preperation (#26800)
* laikad update, renaming

* update locationd

* address PR comments

* draft to fix replay

* fix process relay to allow no response for messages

* bump cereal

* update process replay ref commit

* move laikad helpers to laika

* fix ublox test

* update refs

* add proper qcom replay support

* fix gnss support if both is available

* update refs

* move laika back to master

* move cereal back to master

Co-authored-by: Kurt Nistelberger <kurt.nistelberger@gmail.com>
old-commit-hash: 981532f0c32f58e0ba4675fe3b066d7c6d0d9a8e
2022-12-29 16:56:35 -08:00
Vivek Aithal 71696403fb [torqued] Make torqued work on Hyundai Tucson (#26511)
* changes to get offline values

* set tucon values

* move to params.yaml
old-commit-hash: d4fd0c3c8798317e4af87642af30ddbcd39fc4d6
2022-11-15 18:41:43 -08:00
Kurt Nistelberger bc00819b3f add laikad comment
old-commit-hash: 4eda53cef2adb949709166c2e5d204565376ce2e
2022-11-15 16:41:27 -08:00
Vivek Aithal dd16344a1b [locationd] Add input checks (#26460)
* add input checks with same decay as reset_tracker

* add observation timings check

* typo

* bugfix

* improve offline locationd visibility

* sbugfix offline lld

Co-authored-by: Adeeb Shihadeh <adeebshihadeh@gmail.com>
old-commit-hash: fbf2f3816b18321ed921cf03042327134be68edb
2022-11-14 15:02:26 -08:00
Vivek Aithal 8f6f406237 [paramsd] Prevent low speed drifting (#26360)
* lower active speed for paramsd observations

* update refs
old-commit-hash: 81f6ebebaaeda467fd7a4552711cc1109b33ddd5
2022-11-04 01:32:29 -07:00
Kurt Nistelberger 890f7ffd80 locationd: add gps sanity check for quectel gps (#26352)
* update check

* .

* .

* remove gps kf time check for gps ok

* upsi

* dont use gps_mode

* update refs

* Update selfdrive/locationd/locationd.cc

Co-authored-by: Shane Smiskol <shane@smiskol.com>

Co-authored-by: Kurt Nistelberger <kurt.nistelberger@gmail.com>
Co-authored-by: Cameron Clough <cameronjclough@gmail.com>
Co-authored-by: Shane Smiskol <shane@smiskol.com>
old-commit-hash: aebb08e10542758c458c3abb219f8b57485e0b61
2022-11-03 23:43:30 -07:00
HaraldSchafer ed91648949 UI: fade into wide camera (#26203)
* UI: fade into wide camera

* handle routes with no wide calib

* more cleanup

Co-authored-by: Adeeb Shihadeh <adeebshihadeh@gmail.com>
old-commit-hash: dbc30c053caacc689e1fafb5e92ff0fcac57db1d
2022-10-27 17:27:31 -07:00
Vivek Aithal d843347126 [torqued] Update offline values (#26261)
* add qlog mode to torqued

* update offline valujes from qlogs

* resollve comments

* update refs

* resolve comments
old-commit-hash: b158c016cbd58a84e57124f49c657dbba8beb19e
2022-10-27 16:34:11 -07:00
HaraldSchafer 89e6b69f05 Calibrationd: Calibrate wide from device (#26204)
* Use calibrator to stabilize wide transform

* Need array

* Needs init

* Needs to be arr

* publish mshg

* Check size

* Update ref

* fix calibration param read when no wide calib

* need self!
old-commit-hash: 15595fc8599f0ddf1e72ed02422e9f6d266db1f6
2022-10-24 20:17:05 -07:00
Bruce Wayne 21bcfad5a7 Revert "Use calibrator to stabilize wide transform (#26201)"
This reverts commit 1827b3c9e2942240f65d03ec0f790c91aa9c00ee.

old-commit-hash: 75b7fd0a7d9728dbf84e4cff209cbc44799dbdeb
2022-10-21 21:44:47 -07:00
HaraldSchafer dfbb291ef2 Use calibrator to stabilize wide transform (#26201)
* Use calibrator to stabilize wide transform

* Need array

* Needs init

* Bump to master

* Needs to be arr

* publish mshg

* Check size

* Update ref
old-commit-hash: 42ef62e39102ca5ad03982232ebadc37928a6ca2
2022-10-21 20:30:48 -07:00
HaraldSchafer eac9ec1570 locationd: Fix GPS sensor times with fixed offsets (#25920)
* Rewind to qcom time

* Fix test

* Typo

* init unix_time fix

* add gps sensor_time_offsets

* remove all clocks code and add todo

* :emove clocks in unit test

* update refs

* update refs

Co-authored-by: nuwandavek <vivekaithal44@gmail.com>
old-commit-hash: b3324418034fcf09123b614ee2429a4e5bc9d7a5
2022-10-12 17:47:30 -07:00
HaraldSchafer 549a65d51e rawgpsd: publish ephemerides (#25931)
* add svpoly parsing

* Publish poly

* add source check

* add safety check for invalid gpsWeek values

* address PR comments

* add qcom ephemeris source type

* bump cereal and laika

Co-authored-by: Kurt Nistelberger <kurt.nistelberger@gmail.com>
old-commit-hash: 57a82ced285518cad129ec61814aab48bf51910e
2022-10-07 17:27:09 -07:00
Adeeb Shihadeh 3e2f436d4c auto-detect pigeon or quectel (#25991)
* auto-detect pigeon or quectel

* persistent

* fix sim

* fix process replay

* fix locationd unit tests

* fix that

Co-authored-by: Comma Device <device@comma.ai>
old-commit-hash: 01d05f66fe5a189209538650dce319b2f7e192ee
2022-10-06 16:46:15 -07:00
Vivek Aithal a03192a8d7 Extend torqued (#25961)
* extend live torque to all hyundai and toyota cars

* update refs
old-commit-hash: ca746b0a18eebc9b0fa7a6810dba0b28a60548c2
2022-10-04 13:34:31 -07:00
Adeeb Shihadeh 1cb4cdab24 sim: fix sensor freq and timestamps (#25937)
* sim: fix sensor freq and timestamps

* 100hz

* fix that too
old-commit-hash: 5d33199905cbf9d9b45ef722a40530b08d5cecf4
2022-09-29 22:36:09 -07:00
Vivek Aithal 911f4f9ea3 Live torque fix (#25868)
* fix np empty array quirk

* reset to offline values if saved values were not valid live

* edit cloudlog text
old-commit-hash: 4bc175bb9c9dd5976d1dba40abae716bb4a207ba
2022-09-29 16:36:43 -07:00
Kurt Nistelberger fb06d2769f Sensor events splitup (#25714)
* PoC of reading sensors via interrupts instead of polling

* add Gyro and draft for magn

* add more functionality to gpio.cc

* change LSM gyro to interrupt

* resolve rebase conflict

* update BMX accel interrupt impl

* add interrupt collector thread to fetch in parallel

* change get_event interface to return true on successful read

* update BMX gyro interrupt impl

* update gpio.h/.cc according to comments

* address comments, rename Edgetype enum

* Edgetype to EdgeType

* update sensor interrupt interface

* add error handling, and read fd on trigger

* avoid sending empty messages

* fix build

* use gpiochip

* less diff

* gpiochip on both edges, but skip falling edge if rising edge is detected

* init last_ts with 0

* update sensord testcases

* update sensord testsweet

* test for pipeline

* readd with_process

* add null check

* move tests update to seperate PR

* sensord: improve test coverage (#25683)

* update sensord-interrupt testsweet

* address review comments

* inc stddev threshold

* fix format string

* add version 0 check again

* relax strictness after c3 with bmx tests

* relax strictness after tests

Co-authored-by: Kurt Nistelberger <kurt.nistelberger@gmail.com>

* address PR comments

* fix typo

* remove 4ms limit, and skip first 0.5sec of data

* revert disable_interuppt change to destructor

* fix and remove timing skip

* make gpiochip generic

* sensord port

* change from sensorEvents to separated events

* fix gyro usage

* add splitted sensor tests

* modify debug script sensor_data_to_hist.py

* refactor get_event interface to remove sensorEvent message type

* update locationd to non sensorEvent usage

* tmp commit

* fix replay

* fix accelerometer type

* fix sensor to hist debug script

* update sensord tests to split events

* remove rebase artifacts

* port test_sensord.py

* small clean up

* change cereal to sensorEvents-splitup branch

* upate sensorEvents in regen

* fix route generation for splitted sensor events

* regen cleanUp from sensorEvents change

* .

* remove light and temp from locationd

* add generic init delay per sensor

* .

* update routes

* move bmx gyro/accel to its own channel

* adopt sensor tests to bmx channel

* remove rebase artifacts

* fix sensord test

* handle bmx not present

* add bmx sockets to regen

* .

* .

* code cleanUp

* .

* address PR comments

* address PR comments

* address PR comments

* lsm clean up

* readd sensorEvents

* rever regen.py

* .

* update replay refs

* move channels

* fix artifact

* bump cereal

* update refs

* fix timing issue

Co-authored-by: Bruce Wayne <batman@workstation-eu-intern2.eu.local>
Co-authored-by: gast04 <kurt.nistelberger@gmail.com>
Co-authored-by: Willem Melching <willem.melching@gmail.com>
Co-authored-by: Adeeb Shihadeh <adeebshihadeh@gmail.com>
old-commit-hash: 29d3ed2ce63a65f793dc0ecb553180a0d0fba03e
2022-09-29 14:31:54 -07:00
Dean Lee 4b50c653d6 locationd: remove redundant break statements (#25873)
old-commit-hash: cdbb06d45d5c6819319f5b6c2ba8b6f4261e9178
2022-09-22 10:41:47 -07:00
Vivek Aithal 51d25b2011 Live torque (#25456)
* wip torqued

* add basic logic

* setup in manager

* check sanity and publish msg

* add first order filter to outputs

* wire up controlsd, and update gains

* rename intercept to offset

* add cloudlog, live values are not updated

* fix bugs, do not reset points for now

* fix crashes

* rename to main

* fix bugs, works offline

* fix float in cereal bug

* add latacc filter

* randomly choose points, approx for iid

* add variable decay

* local param to capnp instead of dict

* verify works in replay

* use torqued output in controlsd

* use in controlsd; use points from past routes

* controlsd bugfix

* filter before updating gains, needs to be replaced

* save all points to ensure smooth transition across routes, revert friction factor to 1.5

* add filters to prevent noisy low-speed data points; improve fit sanity

* add engaged buffer

* revert lat_acc thresh

* use paramsd realtime process config

* make latacc-to-torque generic, and overrideable

* move freq to 4Hz, avoid storing in np.array, don't publish points in the message

* float instead of np

* remove constant while storing pts

* rename slope, offset to lat_accet_factor, offset

* resolve issues

* use camelcase in all capnp params

* use camelcase everywhere

* reduce latacc threshold or sanity, add car_sane todo, save points properly

* add and check tag

* write param to disk at end of route

* remove args

* rebase op, cereal

* save on exit

* restore default handler

* cpu usage check

* add to process replay

* handle reset better, reduce unnecessary computation

* always publish raw values - useful for debug

* regen routes

* update refs

* checks on cache restore

* check tuning vals too

* clean that up

* reduce cpu usage

* reduce cpu usage by 75%

* cleanup

* optimize further

* handle reset condition better, don't put points in init, use only in corolla

* bump cereal after rebasing

* update refs

* Update common/params.cc

Co-authored-by: Adeeb Shihadeh <adeebshihadeh@gmail.com>

* remove unnecessary checks

* Update RELEASES.md

Co-authored-by: Adeeb Shihadeh <adeebshihadeh@gmail.com>
old-commit-hash: 4fa62f146426f76c9c1c2867d9729b33ec612b59
2022-09-19 15:19:26 -07:00
Adeeb Shihadeh 35ff65121e pre-commit: add codespell (#25571)
old-commit-hash: 6590fb2b93baedb2e1c5267b4f191f8e20fcd1d2
2022-08-30 11:20:55 -07:00
Adeeb Shihadeh 49e2a4708d laikad: fix cache path
old-commit-hash: 63349809498ffdb1678cbd2aa399a67fc59c66b2
2022-08-29 14:08:21 -07:00