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.
Changes to add LUT use
Use of Clamp, MIN, MAX to reduce code space
Some minor logic changes to reduce code use and (IMO) make it easier to read
NOTE: Changed the pid calculation routine to return int32_t. It was using float, but no float types are used so it was a waste. Since int32_t is used for internal variables, it makes sense to use it, and you can then at least down-cast it to smaller types.