MPC: initialize hover thrust with parameter even if using HTE #14715
Add this suggestion to a batch that can be applied as a single commit.
This suggestion is invalid because no changes were made to the code.
Suggestions cannot be applied while the pull request is closed.
Suggestions cannot be applied while viewing a subset of changes.
Only one suggestion per line can be applied in a batch.
Add this suggestion to a batch that can be applied as a single commit.
Applying suggestions on deleted lines is not supported.
You must change the existing code in this line in order to create a valid suggestion.
Outdated suggestions cannot be applied.
This suggestion has been applied or marked resolved.
Suggestions cannot be applied from pending reviews.
Suggestions cannot be applied on multi-line comments.
Suggestions cannot be applied while the pull request is queued to merge.
Suggestion cannot be applied right now. Please check back later.
fixes #14704
The hover thrust estimator (HTE) starts to run after the first thrust setpoint is published. Until then, the feedforward of the vertical velocity controller was unitialized (= 0). This is now set to hover thrust parameter until the estimate is available.
Tested in SITL:
![2020-04-20_14-07-01_01_plot](https://user-images.githubusercontent.com/14822839/79749810-20217380-8310-11ea-8e95-5538676d87d4.png)
Before
After
![2020-04-20_14-06-40_01_plot](https://user-images.githubusercontent.com/14822839/79749817-2283cd80-8310-11ea-8484-3a139af7286f.png)