Feature/state estimation #30
Open
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.
This branch encorporates 2 primary changes include the addition of a new
State
struct to encapsulate the quadrotor's state and modifications to the main simulation loop to utilize this new state structure. Additionally, a configuration option to add noise to the IMU control has been added.State Management Improvements:
State
struct insrc/lib.rs
with methods to create, modify, and retrieve state components such as position, velocity, orientation, and angular velocity. Please provide feedback on whether this implementation needs to be modified.src/main.rs
to use the newState
struct for managing the quadrotor's state. This includes initializing the state and updating it based on IMU readings and control inputs. [1] [2] [3] [4]Configuration Enhancements:
add_noise_to_control
inconfig/quad.yaml
andsrc/config.rs
to control whether IMU noise is added to the state estimation for control purposes. [1] [2]Codebase Adjustments:
src/main.rs
to includeUnitQuaternion
from thenalgebra
crate, which is used in the newState
struct methods.These changes enhance the simulation's accuracy and flexibility by providing a more structured approach to state management and allowing for configurable noise in the control logic.