a599890fed
Lateral Planner: Calibrate model speed with vEgo ( #28049 )
...
* calibrate speed in the lateral planner
* make speed err helper fn
* check if trans has values
* clip the vel_err
* update refs
3 years ago
3ab8645d3a
uiPlan: add planned acceleration field ( #27484 )
...
* add accel
* bump cereal
* Update ref_commit
---------
Co-authored-by: Bruce Wayne <harald.the.engineer@gmail.com>
3 years ago
eb8bdc0026
MPC path in UI ( #27380 )
...
* 10s lat
* Full length MPC
* redfine N
* Leave controls the same for now
* Updates
* use long plan in lat plan
* interp plan
* simplergit add selfdrive/controls/plannerd.py selfdrive/controls/
* expand to 10s
* revert this
* fix linter
* vizualize
* fix long test
* typo
* cleanup
* compiles
* unused
* unused
* bump cereal
* bump cereal
* use model if no uiplanm
* update replay
* update ref commit
* bump cereal to master
3 years ago
b45dda2d0a
Longitudinal tests: test forceDecel ( #26765 )
...
* test with forceDecel
* test all combos
* fix
* fix
* fix
* ...
* remove print
* clean up
* just set cruise to 0
* update ref commit
Co-authored-by: Bruce Wayne <harald.the.engineer@gmail.com>
3 years ago
e6fcc2d6aa
planner: read experimental mode from controlsState ( #26553 )
...
read from controlsState
3 years ago
9f80a97eee
longitudinal tests: add disabled maneuver ( #26470 )
...
* undeclared variable
* run first second disabled
* only test
* test disabled as a new maneuver
* bottom
3 years ago
98206fb92e
planner: fix undeclared variable ( #26468 )
...
* undeclared variable
* run first second disabled
* revert test
* rev
3 years ago
f23296bc87
Add force decel to e2e long ( #26448 )
...
* add force decel to e2e
* Update longitudinal_planner.py
3 years ago
9a3f468051
experimental mode ( #26416 )
...
* experimental mode
* rename param
* red lights
3 years ago
f63f0de80a
E2e long model: calibrate model speed to wheel speed ( #26395 )
...
* calibrate!
* Fix test
* Fix proc replay
* check len
* get v_ego from model 8501d20-bb59-4193-aa82-82b2737dedd6/449 609d90f3-65e6-4617-a60c-d6d99eead408/700
* bump cereal
* initialize v_model_error
* typo
* better names
* cleanup
* bump cereal
* update model replay ref commit
* bump to cereal master
Co-authored-by: Yassine Yousfi <yyousfi1@binghamton.edu>
3 years ago
253e5d7f9d
FCW: less false positives ( #26366 )
...
* Less FP for FCW
* enable fcw for e2e long
3 years ago
b80f2efdf2
No fcw when standstill ( #26252 )
3 years ago
cb0b7375b7
Rocket Launcher Model ( #25963 )
...
* 1456d261-d232-4654-8885-4d9fde883894/440 6b7d7cec-ead8-40f3-86cc-86d52c9b03fe/300
* compute only 9 tokens: 1456d261-d232-4654-8885-4d9fde883894/440 6b7d7cec-ead8-40f3-86cc-86d52c9b03fe/300
* tinygrad: cleanup gather
* 1456d261-d232-4654-8885-4d9fde883894/440 6b7d7cec-ead8-40f3-86cc-86d52c9b03fe/700
* empty commit for tests
* bump tinygrad
* dont use tinygrad matmul for now
* bump tinygrad
* 1456d261-d232-4654-8885-4d9fde883894/440 e63ab895-2222-4abd-a9a5-af86bb70e260/700
* float16 1456d261-d232-4654-8885-4d9fde883894/440 e63ab895-2222-4abd-a9a5-af86bb70e260/700
* increase steer rate cost
* Revert "increase steer rate cost"
This reverts commit 74ce9ab9be7ef17ecfec931f96851b12f37f2336.
* fork tinygrad
* empty commit for tests
* basics
* Kinda works
* new lat
* new tuning
* Move LATMPCN so scons compiles
* Update long weights
* Add tinygrad optim
* Update model ref
* update weights
* Update ref
* Try
* Error message for field ignore
* update model regf
* ref commit
* Fix onnx test
Co-authored-by: Yassine Yousfi <yyousfi1@binghamton.edu>
3 years ago
e5d2c3ce7a
Planner cleanup ( #25969 )
3 years ago
4bd146ee7a
Longitudinal planner: clip a_desired to cruise limits ( #25928 )
...
* Clip a_desired to cruise limits
* Update selfdrive/controls/lib/longitudinal_planner.py
* fix
* update refs
* explicit
3 years ago
1007df874f
Minor ACC fixes ( #25911 )
...
* Change cruise accel limits
* Long tuning script looks good
* Cap cruise slowdown aggression in e2e mode
* Revert atau change
* Cleanup
* Update ref
* fix ref
3 years ago
3ef37fe2e8
split out experimental long toggle ( #25698 )
...
* split out experimental long toggle
* clean up
* update translations
3 years ago
8857e02dd4
Live e2e long toggling ( #25685 )
...
Live toggling
3 years ago
7899fb79c1
More conservative lead policy in e2e long mode ( #25684 )
...
* Add params for lead and danger
* fix long params
* E2e passes simple maneuver tests
* Make tests run with e2e long mode
* Slightly more error allowed in e2e mode
* FCW back and populate long source field
* Fix planner name
* FCW still doesnt work
* Slightly less aggressive
* Doesn't need to simulate from stop
3 years ago
faff2b8950
Add e2e long toggle ( #25638 )
...
* Add toggle
* Misc fixes
* Update translations
* pre alpha not great
3 years ago
e1b7a37a1f
Support e2e long in longitudinal planner ( #25636 )
...
* refactor
* Add planer modes to support offline, acc, and blended
* add acceleration
* Fix index
* Update model ref
* Read in model outputs
* Add model msg
* Add e2e logic
* Add source
3 years ago
f797567ef8
long planner: run when using stock longitudinal ( #25017 )
...
* Squashed commit of the following:
commit e27a5b4e2bfeab4e6a47440b1d4eb180ee4acf49
Author: Shane Smiskol <shane@smiskol.com>
Date: Fri Jul 1 14:10:06 2022 -0700
remove this test
remove this test
commit c3c10af82222ea4641d94c53a3a07b486cca8452
Author: Shane Smiskol <shane@smiskol.com>
Date: Fri Jul 1 14:08:15 2022 -0700
only planner changes
commit 50e0f1d8704c15acfce8987faf3515c99e8af4f4
Merge: e088fde67fcc5b3d70e088fde67eb7b425e530f8634266bc49f997bef8634266b4c9e446ad21e6c4106ea879a7c320e6c4106ea10520c7f21604db5f80bfe23b37d3fd8bfe2f00e23b37d3fee7dc3960daff0597ec9213997c5527d2f51ee5595d8517a8d2f51ee55f6a63bd60f05771cdecab6c1fe0606f00b1df652f325ea9bbd52c9061042b3dc51f663d5f32cd1fcb
3 years ago
0fce5d9045
Move a bunch of stuff to system/ part 3 ( #24829 )
...
* move swaglog.py
* timezoned
* logmessaged
* version.py
* fix linter
3 years ago
eaa5819211
commIssueAvgFreq: separate alert for avg freq check ( #24150 )
...
* commIssueAvgFreq: separate alert for avg freq check
* bump cereal
* bump cereal
* bump cereal
* freq_ok separate from alive
* bump cereal to master
* update_ref
* fix profiler
4 years ago
f1f40c117a
Add Disengage on Accelerator Toggle ( #23977 )
...
* Squashed commit of the following:
commit 953bcf0ecf8d03f0fec9ce0d5442cc660ae2347d
Merge: b4198608d 333257bad0b9790dd281862fce7d60c44e03⛽ ➡️ 🔋
bump
commit d2b64b89cf8d7265bc90848b4e3a2276c9a4cb78
Author: Shane Smiskol <shane@smiskol.com>
Date: Thu Mar 24 16:19:34 2022 -0700
these changes will be in border PR
these changes will be border PR
commit bed31e63de2244c161729773978fef8a9246ddb5
Merge: 491417640 e91613bc6c88ced1f199c02bdd2db7b49c71820b198945fe00fb77820b19894991763f9ffd7c758d4b91763f9ff4🔥
commit 1885c9e2ba1f591736a9c70e8bca1f591736a2465811f0b7410160d0465811f0b40344363a53700efcb3f3e915cf62700efcb3f4220ce272fed273bb78ac1a85afd60ce3be32afc2f27203af3a04c0ad1a5499cf13caeb2230254ca787475e02cb
4 years ago
5a8b4bbcaa
LongitudinaPlanner: add comment about lateral accel calculation ( #24096 )
...
* space
* if
4 years ago
5c3f3e44bc
break up selfdrive.config ( #23959 )
...
* break up selfdrive.config
* add to release files
* fix import order
4 years ago
ab371f888a
Longitudinal MPC set qp tolerance to 1e-3 ( #23899 )
...
* initialize solverExecutionTime longitudinal_planner
* test_onroad: improve timing evaluation
* longitudinal MPC: set qp_tol to 1e-3
* update ref
Co-authored-by: Harald Schafer <harald.the.engineer@gmail.com>
4 years ago
428d412c1f
longitudinal planner: disable change cost when stopped. not engaged or gas pressed ( #23639 )
...
* disable change cost completely on standstill and gas press
* cleanup
* set accel to zero
* clean up logic around standstill
* update ref
4 years ago
f76328b426
Log MPC solver time ( #23566 )
...
* add solve time to plan output
* add to process replay ignore list
* print in CI
4 years ago
35ec6ac1cb
use ndarray.tolist to convert numpy array to float ( #23485 )
4 years ago
9f88ba188a
Longitudinal planner: make v_desired a FirstOrderFilter ( #23341 )
...
* make v_desired a FirstOrderFilter
* forgot one
* one more ref
* Add a new object for the filter
* fix
* fix tests
* update ref
Co-authored-by: Willem Melching <willem.melching@gmail.com>
4 years ago
77a99e7d6d
long planner: no reset when starting ( #23149 )
...
* long planner: no reset when starting
* let go to 2m/s
* update ref
4 years ago
68015f75ed
Set accel trajectory to a_ego when not engaged ( #23100 )
...
* Set accel trajectory to a_ego when not engaged
* update ref
4 years ago
93fd662adf
Clean up planner files ( #23031 )
...
* clean up planner files
clean up planner files
* fix plant instance
4 years ago
04cf12cb00
ACADOS fix non-convergence when long_plan changes ( #22495 )
...
* debug commit
* cleanup
* some indexing bugs
* need more its
* BALANCE is way better it seems
* fix test
* this converges in 2000segs
* new ref
* less cpu
4 years ago
9ab09f5ae9
Retune long mpc ( #22445 )
...
* first try
* looks decent
* finalize retune
* back to 3 its
* may need 4 still
* misc cleanup
* new ref
* SPEEEED
* new ref
4 years ago
a8b4249ebc
Change radar-based FCW to model-based FCW ( #22379 )
...
* just use MPC for fcw checking
* thats already bad
* model FCW is always good
* better fcw
* should be good for now
* comment
* linting
* cleaner
* unused
4 years ago
fe983a7b8c
acados long merged ( #22224 )
...
* rebased
* cleaner, seems to drive better?
* more stable
* wrong import
* new way of thinking
* reports look nice
* start move back
* works at leas
* good timestamps
* step by step
* somewhat work
* tests pass
* ALL CARS STOPPED
* should work
* fake a cruise obstacle
* cleaner costs
* pretty good except cruise braking
* works pretty well now!
* cleanup
* add source
* add source
* that is needed for unit tests
* nan recovery
* little cleaner
* stop wasting arrays
* unreasonable without unfair init
* this isnt needed without the exponential
* that works too
* unused
* uses less
* new ref
* long enough
* e2e long api
* DONT PUT IN A VIEW INTO ACADOS
* new ref for outside weights
* remove debug prints
4 years ago
f0be9a57ac
Dont run plannerd for long tests ( #22260 )
4 years ago
66c275b711
Acados long fast ( #22233 )
...
* acados long
* new ref
* SPPEEEEEDDD
* less iterations
* this shouldn't be so high
* reset only essentials
* minimal reset for long mpc
* more cpu usage plannerd
* Use lead mpc even when going to crash
* reset to current state
* Use open loop speed for lead mpc
* 1 iteration is too little for cruise mpc
* add whitespace
* update refs
4 years ago
737a79e556
longitudinal comments ( #21898 )
...
* cmt
* Update longcontrol.py
4 years ago
ef0b120a9a
add jerk to longitudinal plan ( #21598 )
...
* add jerk output, so its like lateral
* typo
* add to packet
* update cereal and ref
4 years ago
5d07819084
Taper off high speed accel ( #21599 )
...
* max 0.2 diff from before to preserve bad tuned cars
* update ref
4 years ago
fd41e9f01b
Lower speed for lowest planned acceleration ( #21578 )
...
* 55mph sounds about right
* update refs
4 years ago
a42d8f3a14
less accel ( #21565 )
...
* less accel
* new refs
* Update longitudinal_planner.py
* update refs
4 years ago
148c202bc4
less np ( #21536 )
4 years ago
be5ddd25cd
Refactor long ( #21433 )
...
* refactor
* needs casting
* tests pass
* fix that test
* refactor in controls
* lets not go crazy
* change of names
* use constants
* better naming
* renamed
* soft constraints
* compile slack variables
* rm git conflict
* add slack variables
* unused
* new edition
* fcw
* fix tests
* dividing causes problems
* was way too slow
* take a step back
* byeeee
* for another time
* bad idxs
* little more cpu for cruise mpc
* update refs
* these limits seem fine
* rename
* test model timings fails sometimes
* add default
* save some cpu
* Revert "little more cpu for cruise mpc"
This reverts commit f0a8163ec90e8dc1eabb3c4a4268ad330d23374d.
* Revert "test model timings fails sometimes"
This reverts commit d259d845710ed2cbeb28b383e2600476527d4838.
* update refs
* less cpu
* Revert "Revert "test model timings fails sometimes""
This reverts commit e0263050d9929bfc7ee70c9788234541a4a8461c.
* Revert "less cpu"
This reverts commit 679007472bc2013e7fafb7b17de7a43d6f82359a.
* cleanup
* not too much until we clean up mpc
* more cost on jerk
* change ref
* add todo
* new ref
* indentation
4 years ago
c23ec9f753
LateralPlanner should only compute curvature ( #20289 )
...
* get curvature from planner
* no need to check active
* remove that
* remove self
* liveParams not needed
* cast
* fix test bug
* fixes
* fix ui.py
* fix radians
* update refs
* update refs
* bump cereal
* bump cereal
Co-authored-by: Adeeb Shihadeh <adeebshihadeh@gmail.com>
5 years ago
312b681a46
cereal cleanup part 2 ( #20092 )
...
* car stuff
* thermal
* Revert "car stuff"
This reverts commit 77fd1c65eb
5 years ago
Vivek Aithal
Shane Smiskol
Harald Schäfer
Adeeb Shihadeh
Willem Melching
Jonathan Frey
Dean Lee