System Identification
Last updated
Last updated
We will need to record the commanded attitude and the estimated attitude for angular motion estimate. When using mav_control_rw and PX4 this is done as follows.
Use one of the provided example launchfiles to start mavros and mav_nonlinear_mpc
On the RC remote put the system into offboard mode. This will put the mpc infrastructure in the loop making any commanded attitude sent to the system visible to ROS on the topic mavros/setpoint_raw/roll_pitch_yawrate_thrust.
Put the MPC into RC manual mode (usually done through the RC remote). This is done as we can't use the MPC before the sysid is done (and also lets us fly without a position estimate). In this mode the MPC just scales and passes through RC stick commands.
Record the commanded attitude as well as the PX4 estimated attitude from the topicsmavros/setpoint_raw/roll_pitch_yawrate_thrust and mavros/imu/data
they may be in a namespace
Fly the system (try aggressive flying) for a few minutes recording the data, try to fly a range of roll and pitches so that all normal flight characteristics can be observed. Yaw is not explicitly modeled in the MPC so does not need identification in the same way. So yaw can be ignored during system identification.
We use a standard Matlab toolbox for model fitting. This is done by the mav_sysid.m from the ETH-ASL mav_system_identification repository.
Once run it should produce a series of graphs as well as a print out of the needed parameters. An example of the roll response is shown below.
and an example of the script output is as follows
The estimated response should closely match the actual. As a rule of thumb if the given fit percentage isn't at least 70% something has gone wrong. If everything looks good just copy the given parameters to the specified files, overwriting the old values.
mav_control_rw loads the MPC default values from the nonlinear_mpc.yaml file and the default disturbance observer values from the disturbance_observer.yaml file. Note that the MPC outputs a desired thrust in Newtons, to send this to the PX4 it must first be converted to the range 0 to 1. This is done in mavros using the thrust_scaling_factor given in px4_config.yaml.
The best values for the MPC and disturbance observer will depend a lot on your system and your goal (for example finding the balance between twitchiness and position holding). Because of this the system is best tuned by putting the system into position hold mode, starting rqt and tweaking the parameters while giving new position commands. It is usually easiest to start by disabling the disturbance observer (set offset and integrator parameters to false in the nonlinear_mpc.yaml file) when tuning so the effects of the different parts are not mixed together.
If your thrust constant is wrong by a very large amount, your system will power into the ceiling as soon as you enable the MPC.
