Files
Florian Sansou 33ebce980a
Doxygen / build (push) Waiting to run
Add betafpv AIO and tmotor AIO (#3413)
---------

Co-authored-by: Florian Sansou <florian.sansou@enac.fr>
2025-04-01 12:53:08 +02:00

190 lines
6.7 KiB
XML

<!DOCTYPE airframe SYSTEM "../airframe.dtd">
<airframe name="AIO F7 Test File">
<firmware name="rotorcraft">
<configure name="PERIODIC_FREQUENCY" value="500"/>
<configure name="RTOS_DEBUG" value="TRUE" />
<target name="ap" board="betafpv_aiof7">
<module name="radio_control" type="sbus"/>
<define name="RADIO_KILL_SWITCH" value="RADIO_GAIN1"/>
<configure name="USE_MAGNETOMETER" value="FALSE"/>
<define name="USE_GPS"/>
<define name="AHRS_USE_GPS_HEADING" value="TRUE" />
</target>
<target name="nps" board="pc">
<module name="fdm" type="jsbsim"/>
<module name="radio_control" type="ppm"/>
</target>
<module name="telemetry" type="xbee_api">
<configure name="MODEM_PORT" value="UART2" />
</module>
<module name="actuators" type="dshot">
<define name="DSHOT_SPEED" value="600"/>
</module>
<module name="board" type="betafpv_aiof7">
</module>
<module name="gps" type="optitrack"/>
<module name="stabilization" type="indi"/>
<module name="guidance" type="indi"/>
<module name="ahrs" type="int_cmpl_quat"/>
<module name="ins" type="gps_passthrough"/>
<module name="sys_mon"></module>
<module name="shell">
<configure name="SHELL_PORT" value="usb_serial_debug"/>
</module>
</firmware>
<servos driver="DShot">
<servo name="BR" no="1" min="0" neutral="100" max="2000"/>
<servo name="BL" no="2" min="0" neutral="100" max="2000"/>
<servo name="FR" no="3" min="0" neutral="100" max="2000"/>
<servo name="FL" no="4" min="0" neutral="100" max="2000"/>
</servos>
<commands>
<axis name="ROLL" failsafe_value="0"/>
<axis name="PITCH" failsafe_value="0"/>
<axis name="YAW" failsafe_value="0"/>
<axis name="THRUST" failsafe_value="0"/>
</commands>
<command_laws>
<set servo="FR" value="autopilot_get_motors_on() ? actuators_pprz[0] : -MAX_PPRZ"/>
<set servo="BR" value="autopilot_get_motors_on() ? actuators_pprz[1] : -MAX_PPRZ"/>
<set servo="BL" value="autopilot_get_motors_on() ? actuators_pprz[2] : -MAX_PPRZ"/>
<set servo="FL" value="autopilot_get_motors_on() ? actuators_pprz[3] : -MAX_PPRZ"/>
</command_laws>
<section name="IMU" prefix="IMU_">
<define name="IMU_ACCEL_CALIB" type="array">
<field type="struct">
<field name="abi_id" value="24"/>
<field name="calibrated" type="struct">
<field name="neutral" value="true"/>
<field name="scale" value="true"/>
</field>
<field name="neutral" value="-9,1,75" type="int[]"/>
<field name="scale" value="{{23855,47132,18064},{9728,19217,7339}}"/>
</field>
</define>
<define name="BODY_TO_IMU_PHI" value="0." unit="deg"/>
<define name="BODY_TO_IMU_THETA" value="0." unit="deg"/>
<define name="BODY_TO_IMU_PSI" value="0." unit="deg"/>
</section>
<section name="STABILIZATION_ATTITUDE" prefix="STABILIZATION_ATTITUDE_">
<!-- setpoint limits for attitude stabilization rc flight -->
<define name="SP_MAX_PHI" value="45" unit="deg"/>
<define name="SP_MAX_THETA" value="45" unit="deg"/>
<define name="SP_MAX_R" value="60" unit="deg/s"/>
<define name="DEADBAND_A" value="0"/>
<define name="DEADBAND_E" value="0"/>
<define name="DEADBAND_R" value="50"/>
</section>
<section name="STABILIZATION_ATTITUDE_INDI" prefix="STABILIZATION_INDI_">
<define name="NUM_ACT" value="4"/>
<!-- reference acceleration for attitude control -->
<define name="REF_ERR_P" value="120"/>
<define name="REF_ERR_Q" value="130"/>
<define name="REF_ERR_R" value="120"/>
<define name="REF_RATE_P" value="15"/>
<define name="REF_RATE_Q" value="15"/>
<define name="REF_RATE_R" value="10"/>
<define name="MAX_R" value="60" unit="deg/s"/>
<!-- second order filter parameters -->
<define name="FILT_CUTOFF" value="4.0"/>
<define name="FILT_CUTOFF_R" value="4.0"/>
<!-- Adaptive Learning Rate -->
<define name="USE_ADAPTIVE" value="FALSE"/>
<define name="ADAPTIVE_MU" value="0.0001"/>
<!-- Full INDI -->
<!-- control effectiveness -->
<define name="G1" type="matrix">
<field value="{ -20.0, -20.0, 20.0, 20.0 }"/>
<field value="{ 20.0, -20.0, -20.0, 20.0 }"/>
<field value="{ -3.0, 3.0, -3.0, 3.0 }"/>
<field value="{ -1.0, -1.0, -1.0, -1.0 }"/>
</define>
<!--Counter torque effect of spinning up a rotor-->
<define name="G2" value="{ -80, 80, -80, 80.0 }"/>
<!-- first order actuator dynamics -->
<define name="ACT_FREQ" value="{10.10, 10.10, 10.10, 10.10}"/>
<define name="ESTIMATION_FILT_CUTOFF" value="4.0"/>
<!--Priority for each axis (roll, pitch, yaw and thrust)-->
<define name="ALLOCATION_PSEUDO_INVERSE" value="TRUE"/>
</section>
<section name="GUIDANCE_V" prefix="GUIDANCE_V_">
<define name="REF_MIN_ZDD" value="-0.4*9.81"/>
<define name="REF_MAX_ZDD" value=" 0.4*9.81"/>
<define name="REF_MIN_ZD" value="-2."/>
<define name="REF_MAX_ZD" value=" 2."/>
<define name="NOMINAL_HOVER_THROTTLE" value="0.35"/>
</section>
<section name="GUIDANCE_H" prefix="GUIDANCE_H_">
<define name="MAX_BANK" value="30" unit="deg"/>
<define name="REF_MAX_SPEED" value="0.5"/>
<define name="REF_MAX_ACCEL" value="2."/>
</section>
<section name="GUIDANCE_INDI" prefix="GUIDANCE_INDI_">
<define name="SPECIFIC_FORCE_GAIN" value="-500.0"/>
<define name="THRUST_DYNAMICS_FREQ" value="25.64"/>
<define name="RC_DEBUG" value="FALSE"/>
<define name="SPEED_GAINZ" value="2.5"/>
</section>
<section name="NAV">
<define name="ARRIVED_AT_WAYPOINT" value="0.25"/>
<define name="NAV_CLIMB_VSPEED" value="0.8"/>
<define name="NAV_DESCEND_VSPEED" value="-0.5"/>
</section>
<section name="BAT">
<define name="CRITIC_BAT_LEVEL" value="7.45" unit="V"/>
<define name="CATASTROPHIC_BAT_LEVEL" value="7.37" unit="V"/>
<define name="BAT_NB_CELLS" value="2"/>
</section>
<section name="AUTOPILOT">
<define name="MODE_STARTUP" value="AP_MODE_NAV"/>
<define name="MODE_MANUAL" value="AP_MODE_ATTITUDE_DIRECT"/>
<define name="MODE_AUTO1" value="AP_MODE_ATTITUDE_Z_HOLD"/>
<define name="MODE_AUTO2" value="AP_MODE_NAV"/>
<define name="FAILSAFE_FIXED_THROTTLE" value="0.4"/>
</section>
<section name="GCS">
<define name="ALT_SHIFT_PLUS_PLUS" value="2"/>
<define name="ALT_SHIFT_PLUS" value="1"/>
<define name="ALT_SHIFT_MINUS" value="-0.5"/>
</section>
<section name="SIMULATOR" prefix="NPS_">
<define name="ACTUATOR_NAMES" value="ne_motor, se_motor, sw_motor, nw_motor" type="string[]"/>
<define name="JSBSIM_MODEL" value="simple_x_quad_ccw" type="string"/>
<define name="COMMANDS_NB" value="4"/>
<define name="NO_MOTOR_MIXING" value="TRUE"/>
</section>
</airframe>