* 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
* 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>
* 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>
* 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>
* 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>
* 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
* 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>
* 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
* 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>
Adeeb Shihadeh
ClockeNessMnstr
HaraldSchafer
Willem Melching
Lukas Petersson
Shane Smiskol
Jonathan Frey
Dean Lee
Jason Young
Vivek Aithal
Mitchell Goff
Igor