* update names + notes for MPC outputs
"current_curvature" is not the correct description of what the MPC is outputting in it's curvature_ego state.
The MPC is integrating it's free variable, curvature_rate, such that curvature[0] is actually the desired_curvature before any delay.
inversely: the curvature_rate_desired is the desired rate of change to the setpoint and not the actual curvature rate.
If we were to set the initial curvature = measured curvature in the MPC initiation these names would be correct.
This was possibly how it was initially set up but the nomenclature here is now confusing.
* more notes
* match
* Clarify #1
old-commit-hash: b215d611b1adf5ea2b93e6628936f2e73539f34f
* should work
* Revert "should work"
This reverts commit dabc2ea17a072a6c835e4bd1c75a2c1e2d10623d.
* move lane change logic to DesireHelper class
* clean up desires
clean up desires
* comments
* Revert "clean up desires"
This reverts commit 7301c921e305fcbd4746b19040631d935d50dfd9.
* Update selfdrive/controls/lib/desire_helper.py
Co-authored-by: Adeeb Shihadeh <adeebshihadeh@gmail.com>
* add to files_common
Co-authored-by: Adeeb Shihadeh <adeebshihadeh@gmail.com>
Co-authored-by: Willem Melching <willem.melching@gmail.com>
old-commit-hash: 6be70a063dfc96b9e9f097f439bdc2e0be54d6d9
* lat_mpc: make v_ego, rotation_radius parameters instead of states
* lat_mpc: remove rotation_radius argument, since it is part of the parameters
* lat_mpc: use qp_solver_cond_N = 1
slightly faster and in line with case study in Fig. 2/ 3 in Frison2016 - https://cdn.syscop.de/publications/Frison2016.pdf
An Efficient Implementation of Partial Condensing for Nonlinear Model Predictive Control
* adapt test_lateral_mpc to formulation with parameters
* lat_mpc: set parameters in reset() and copy values
* acados_ocp_solver_pyx: make options_set useable
* update ref
Co-authored-by: Willem Melching <willem.melching@gmail.com>
old-commit-hash: 06814748409bd8538edca1b2bcef66f15e1c3ab6
* Revert "New desire model (#21729)"
This reverts commit 709932b3bfb4c3b4f33711b8d07615469e762832.
* Updated process replay ref and reverted release notes
old-commit-hash: 15d6bbb47c3a33f98d33377d95bf7e69c46565fa
* New model: b822ee32-917c-4639-99f8-25be3e6aabad/900
* Enable keeps
* use new packet
* Send keep pulses once per second
* Updated model_replay_ref_commit
* New model: 0f160bf9-1bce-43e6-9785-564b2453eeac
* Bump model_replay_ref_commit
* Bump submodules
* New model: fd904bf9-5dd8-4619-8997-c5668400e078/550
* New model: fd904bf9-5dd8-4619-8997-c5668400e078/950
* No keeps
* Bumped model replay ref
Co-authored-by: Harald Schafer <harald.the.engineer@gmail.com>
old-commit-hash: e83973b9b31199c1594b9be2371a7af0c589c2d9
* New model: b822ee32-917c-4639-99f8-25be3e6aabad/900
* Enable keeps
* use new packet
* Send keep pulses once per second
* Updated model_replay_ref_commit
* New model: 0f160bf9-1bce-43e6-9785-564b2453eeac
* Bump model_replay_ref_commit
Co-authored-by: mitchell <mitchellgoffpc@gmail.com>
old-commit-hash: 4230d5d2124577b86e69b136d846ca9cc3ecd746
* 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
old-commit-hash: be5ddd25cd3f4c8b7e46cdeecf303e2c73301003
* Determine lane chane direction in preLaneChange state
* cleanup
* update refs
Co-authored-by: Adeeb Shihadeh <adeebshihadeh@gmail.com>
old-commit-hash: de34d1a527799acd8dde755bdb6dba2d0625b096
* was making wrong policy more aggresive
* allow to be set from simulator
* update refs
* put params together
old-commit-hash: 0e10b74a61a8e06e7a27b414b21bfe85be827698
* use ecam in ui
* needs reboot
* use in modeld
* typo
* effective FL is longer in center
* normalize zoom by focal dist
* read param before init
* make 2x as wide
* review comments
* more explicit
* fix camera offset
Co-authored-by: ZwX1616 <zwx1616@gmail.com>
old-commit-hash: 1fc7bcca43e9ef75d95ae8689e3b1cd8c4f8041e
* add putBool/getBool wrappers to cython class
* use new API
* some more puts
* fix mockparams arguments
* add get_bool to MockParams
* typo
old-commit-hash: ae094042ade44815fdba50196c15ba552bbf33d7
* no heading cost
* live mpc weight config
* need to add stds
* make work on empty data
* no divide by 0
* update refs
* update model replay
* update proc replat
* new model replay ref
old-commit-hash: d72d433ec7a3c9f0bb2f90d196b3826d48d9b1a0
* New model: 0bf38240-6b55-42b0-bcfb-da08ff5cd0b9/650
* laneless baby
* hardcode model difference for now
* kale toggle
* kale emoji
* sensible description
* make clear it is not just for ui
* emojis dont work yet
* 9671a8fe-539f-4a04-a163-54571df21139/650
* new model
* only read param on rising edge of ignition
* update toggle text
* fix that
* update refs
Co-authored-by: mitchell <mitchellgoffpc@gmail.com>
Co-authored-by: Adeeb Shihadeh <adeebshihadeh@gmail.com>
old-commit-hash: 7ee79c99236f749d02a6779b006ee1ab187e0612