• Ewoud Smeur's avatar
    update INDI tu use full control effecitvens matrix (#1916) · 6dcabb3a
    Ewoud Smeur authored
    * update INDI tu use full control effecitvens matrix
    
    Instead of using commands (roll, pitch, yaw, thrust), give the
    controller direct control over all actuators.
    This allows for online individual actuator control effectiveness
    estimation and inversion, as well as better saturation handling.
    The INDI controller as it was previous is renamed to 'simple'.
    
    * Made INDI more flexible wrt number of actuators
    
    - 4x4 matrix inverse to accomodate the thrust axis as well
    - support for more actuators
    - cleanup of code
    
    * Change filters guidance indi to butterworth
    
    * Added body acceleration to state interface
    
    * Better adaptation and guidance thrust increment
    
    - Adaptation flexible wrt. number of actuators.
    - Added adaptation of the specific force effectiveness of the actuators.
    - Added connection to guidance INDI through ABI. The thrust increment is
      caclulated in guidance INDI and sent to the stabilization.
    
    * lower case variables
    
    * change filter of indi to butterworth
    
    * INDI fix array index & no declarations in for loop
    
    - Also added doxygen comments
    
    * Added actuators_pprz
    
    the array actuators is used to drive the servos, so a new array to store
    the command to the actuators in pprz scale is needed
    
    * Removed hardcoded scaling
    6dcabb3a