<!DOCTYPE airframe SYSTEM "../airframe.dtd">
<!-- This is the UA_Mothra airframe file. The plane is equipped with a lisa MX, two spectrum satteilte receivers, ubox neo gps, xbee pro telemetry link, a current sensor(.6V at 0 A and 40mV/A scale, a vbat in with an external resistor of 2kohm. Firmware is flashed via black magic probe.-->

<airframe name="Mothra">
  <firmware name="fixedwing">
    <target name="ap" board="lisa_mx_2.1">
      <subsystem name="radio_control" type="spektrum">
        <define name="RADIO_MODE" value="RADIO_AUX2"/>
        <configure name="USE_SECONDARY_SPEKTRUM_RECEIVER" value="1"/>
      </subsystem>

     <subsystem name="ins" type="alt_float">
       <define name="USE_BAROMETER" value="TRUE"/>
     </subsystem>

      <define name="USE_ADC"/>
      <define name="USE_ADC_2"/>
      <define name="USE_I2C2" />
      <define name="MEASURE_AIRSPEED"/> <!-- change from MEASURE <=> USE -->

    </target>

    <target name="sim" board="pc">
      <subsystem name="radio_control" type="ppm"/>
      <subsystem name="ins" type="alt_float"/>

    </target>

    <subsystem name="actuators"     type="pwm">

      <define name="USE_SERVOS_7AND8"/>
    </subsystem>

    <define name="RC_LOST_MODE" value="PPRZ_MODE_AUTO2"/>



    <subsystem name="gps" type="ublox">
      <configure name="GPS_BAUD" value="B57600"/>
    </subsystem>
    <subsystem name="telemetry" type="transparent">
      <configure name="MODEM_BAUD" value="B57600"/>
    </subsystem>
    <subsystem name="imu" type="lisa_mx_v2.1"/>
    <subsystem name="navigation" />
    <subsystem name="control"/>
    <subsystem name="ahrs" type="float_cmpl_quat">
      <configure name="USE_MAGNETOMETER" value="TRUE"/>
      <define name="F_PROPAGATE_QUAT"/>
    </subsystem>



    <configure name="NO_LUFTBOOT" value="1"/>
    <configure name="FLASH_MODE" value="SWD"/>
    <!--- <configure name="BMP_PORT" value="/dev/ttyACM0"/> -->



  </firmware>









<!--The following is the commands sections. This deals with how the control surface relate to movement and rc input-->
  <commands> <!--The commands the autopilot board outputs-->
    <axis name="THROTTLE" failsafe_value="0"/>
    <axis name="ROLL" failsafe_value="9600"/>
    <axis name="PITCH" failsafe_value="-9600"/>
    <axis name="BRAKE" failsafe_value="0"/>
    <axis name="YAW" failsafe_value="0"/>
    <axis name="GEAR" failsafe_value="0"/>
  </commands>


  <servos><!--the servos the outpilot autoputs commands output to-->
    <servo name="THROTTLE" max="2000" neutral="1000" min="1000" no="5"/>
    <servo name="DROP" max="2000" neutral="1500" min="1000" no="0"/>
    <servo name="ELEVATOR" max="1000" neutral="1359" min="2000" no="3"/>
    <servo name="AILERON_RIGHT" max="1800" neutral="1396" min="1200" no="2"/>
    <servo name="AILERON_LEFT" max="1800" neutral="1400" min="1200" no="1"/>
    <servo name="RUDDER" max="2000" neutral="1444" min="1000" no="4"/>
  </servos>


  <command_laws> <!--How the commands relate to servo movement-->
    <set value="@ROLL-.6*(@BRAKE)" servo="AILERON_LEFT"/>
    <set value="@ROLL+.6*(@BRAKE)" servo="AILERON_RIGHT"/>
    <set value="@THROTTLE" servo="THROTTLE"/>
    <set value="@PITCH" servo="ELEVATOR"/>
    <set value="@YAW" servo="RUDDER"/>
    <set value="@GEAR" servo="DROP"/>
  </command_laws>


  <rc_commands> <!--controls available to pilot in full RC-->
    <set value="@THROTTLE" command="THROTTLE"/>
    <set value="@ROLL" command="ROLL"/>
    <set value="@PITCH" command="PITCH"/>
    <set value="@YAW" command="YAW"/>
    <set value="@GEAR" command="GEAR"/>
    <set value="@AUX1" command="BRAKE"/>
  </rc_commands>


  <auto_rc_commands> <!--controls available to pilot in AUTO2-->
    <set value="@YAW" command="YAW"/>
    <set command="GEAR" value="@GEAR"/>
    <set value="@AUX1" command="BRAKE"/>
  </auto_rc_commands>








  <!--The following are sensor calibrations that need to be performed-->
  <!--Note some calibrations are location specific. These need to be modified when flying at different fields-->

  <section name="IMU" prefix="IMU_">

    <define name="BODY_TO_IMU_PHI" value="90." unit="deg"/>
    <define name="BODY_TO_IMU_THETA" value="-90." unit="deg"/>
    <define name="BODY_TO_IMU_PSI" value="180." unit="deg"/>



    <!--See http://wiki.paparazziuav.org/wiki/ImuCalibration -->

<!-- Calibrate via sw/tools/calibration/calibrate.py-->


<define name="MAG_X_NEUTRAL" value="-415"/>
<define name="MAG_Y_NEUTRAL" value="814"/>
<define name="MAG_Z_NEUTRAL" value="223"/>
<define name="MAG_X_SENS" value="2.76789774165" integer="16"/>
<define name="MAG_Y_SENS" value="3.15959835097" integer="16"/>
<define name="MAG_Z_SENS" value="2.63119798642" integer="16"/>




    <!-- Current draw magnetic field calibration-->
    <!--Please note that you must enable a module for current calibration. look below at modules and uncomment the module.-->

<define name= "MAG_X_CURRENT_COEF" value="0.00320590964876"/>
<define name= "MAG_Y_CURRENT_COEF" value="-0.00177605577317"/>
<define name= "MAG_Z_CURRENT_COEF" value="0.000959756979821"/>



  </section>









  <section name="AHRS" prefix="AHRS_"> <!--This is local magnetic field data. Needs to be changed for different fields-->
    <!--CHANGE THIS FOR DIFFERENT LOCATIONS!!-->
    <!--See http://wiki.paparazziuav.org/wiki/Subsystem/ahrs#Local_Magnetic_Field For more details-->
    <!--Note a module that automatically updates this value has been added, see below. (geo_mag.xml)-->

<!-- Local magnetic field vector Bremner Field-->

    <define name="H_X" value="0.244216"/>
    <define name="H_Y" value="0.0640397"/>
    <define name="H_Z" value="0.967604"/>


  </section>




  <section name="BAT">
    <!--<define name="MILLIAMP_AT_FULL_THROTTLE" value="3000"/> not needed due to current sensor-->
    <define name="CATASTROPHIC_BAT_LEVEL" value="12.7" unit="V"/>
    <define name="CRITIC_BAT_LEVEL" value="14.7" unit="V"/>
    <define name="LOW_BAT_LEVEL" value="15.1" unit="V"/>
    <define name="MAX_BAT_LEVEL" value="16.8" unit="V"/>
    <define name="VOLTAGE_ADC_SCALE" value="0.0052047"/>
    <define name="VOLTAGE_ADC_OFFSET" value="-0.011815"/>
    <define name="VoltageOfAdc(adc)" value="(VOLTAGE_ADC_SCALE * adc + VOLTAGE_ADC_OFFSET)"/>

    <define name="ADC_CHANNEL_CURRENT" value="ADC_2" />
    <define name="CURRENT_ADC_SCALE" value="1"/>
    <define name="CURRENT_ADC_OFFSET" value="0"/>
    <define name="MilliAmpereOfAdc(adc)" value="0.2489*(80.55*(adc-185))-11232"/>
  </section>




  <section name="FAILSAFE" prefix="FAILSAFE_">
    <define name="DELAY_WITHOUT_GPS" value="2" unit="s"/>
    <define name="DEFAULT_THROTTLE" value="0" unit="%"/>
    <define name="DEFAULT_ROLL" value="17.2" unit="deg"/>
    <define name="DEFAULT_PITCH" value="28.6" unit="deg"/>
  </section>



  <section name="MISC">
    <define name="NOMINAL_AIRSPEED" value="15." unit="m/s"/>
    <define name="CARROT" value="4." unit="s"/> <!-- when carrot time away from waypoint in go and path, Paparazzi determines it has reached the waypoint-->
    <define name="KILL_MODE_DISTANCE" value="(2.0*MAX_DIST_FROM_HOME)"/>
    <define name="DEFAULT_CIRCLE_RADIUS" value="100."/>
  </section>






<!--AUTOPILOT TUNING SECTION-->

<!--These are the angles which are output when the plane is flying in 'level' flight -->
  <section name="INS" prefix="INS_">
    <define name="ROLL_NEUTRAL" value="-2.6" unit="deg"/>
    <define name="PITCH_NEUTRAL" value="0" unit="deg"/>
  </section>


  <section name="AUTO1" prefix="AUTO1_"><!-- roll and pitch in auto1-->
    <define name="MAX_ROLL" value="40." unit="deg"/>
    <define name="MAX_PITCH" value="35." unit="deg"/>
  </section>





  <section name="HORIZONTAL CONTROL" prefix="H_CTL_">

    <!--<define name="AILERON_OF_THROTTLE" value="0.0"/> --> <!-- as RPM of Prop increases more aileron may be need to obtain steady flight. Use this gain to adjust that--> >

    <define name="COURSE_PGAIN" value="1.37"/> <!-- used to be 57.3 deg. when a new heading is given to paparazzi the change the roll by this much-->
    <define name="COURSE_DGAIN" value="17.1" unit="deg"/>



    <define name="ROLL_MAX_SETPOINT" value="34.4920593063" unit="deg"/> <!-- these are the max and min values the plane can roll and pitch when in auto -->
    <define name="PITCH_MAX_SETPOINT" value="30" unit="deg"/>
    <define name="PITCH_MIN_SETPOINT" value="-10" unit="deg"/>



    <define name="PITCH_PGAIN" value="18513"/><!-- the rate at which paparazzi will change the pitch  -->
    <define name="PITCH_DGAIN" value="1.5"/> <!-- the rate at which paparazzi couteracts pgain -->

    <define name="ROLL_ATTITUDE_GAIN" value="21698"/> <!--same idea as pitch pgain but for roll.--> <!--ROLL_PGAIN is still valid but paparazzi recommends using this one-->
    <define name="ROLL_RATE_GAIN" value="1500"/> <!-- thinking this is probably some sort of gain that maintains flight with no Roll. So for example when flying straight and level and the wind rolls the plane, this will correct it. Maybe.-->
<!--most likely doesn't work as it uses a gyro and we have not defined one-->

  <define name="ELEVATOR_OF_ROLL" value="3409"/><!--Adjust to maintain altitude on turns-->

  <define name="ROLL_SLEW" value="0.1"/> <!-- not too sure trying playing around with it. -->

  </section>






  <section name="VERTICAL CONTROL" prefix="V_CTL_">
    <define name="POWER_CTL_BAT_NOMINAL" value="14.9" unit="V"/>

    <define name="THROTTLE_SLEW_LIMITER" value="1.5" unit="s"/><!-- time it takes to go from 0% throttle to 100% throttle-->



    <define name="AUTO_THROTTLE_NOMINAL_CRUISE_THROTTLE" value="0.48"/> <!-- nominal cruise throttle %-->
    <define name="AUTO_THROTTLE_MIN_CRUISE_THROTTLE" value="0.33"/> <!-- minimum cruise throttle setting-->
    <define name="AUTO_THROTTLE_MAX_CRUISE_THROTTLE" value="0.85"/> <!-- maximum cruise throttle setting-->



    <define name="AUTO_THROTTLE_LOITER_TRIM" value="3248"/> <!--elevator trim when on min cruise throttle setting to maintain altitude-->
    <define name="AUTO_THROTTLE_DASH_TRIM" value="2492"/> <!--elevator trim when on max cruise throttle setting to maintain altitude-->


     <define name="ALTITUDE_PGAIN" value="0.06"/><!--the rate at which paparazzi will change the altitude-->

    <define name="ALTITUDE_MAX_CLIMB" value="2." unit="m/s"/> <!-- max climb setting -->


    <define name="AUTO_THROTTLE_CLIMB_THROTTLE_INCREMENT" value="0.10" unit="%/(m/s)"/> <!-- rate at which to increase throttle on climb error-->

    <define name="AUTO_THROTTLE_PGAIN" value="0.01"/> <!-- rate at which to change speed based on climb-->
    <define name="AUTO_THROTTLE_IGAIN" value="0.10"/> <!-- additional increase in rate dependant on time that speed is not ideal. Example if the speed required is 15m/s and the current speed is 12m/s and has been for 3s. then throttle setting = value+(15-12)(Pgain)+3*igain.-->

    <define name="AUTO_THROTTLE_PITCH_OF_VZ_PGAIN" value="0.09"/><!-- how much to change pitch based on climb error -->


    <!--airspeed tuning
    <define name="AUTO_AIRSPEED_SETPOINT" value="13.0"  unit="m/s" /> SETPOINT values may need to be adjusted to suit your aircraft
    <define name="AUTO_AIRSPEED_PGAIN"    value="0.060" />
    <define name="AUTO_AIRSPEED_IGAIN"    value="0.050" />

    <define name="AUTO_GROUNDSPEED_SETPOINT" value="7.0"  unit="m/s" /> SeTPOINT values may need to be adjusted to suit your aircraft
    <define name="AUTO_GROUNDSPEED_PGAIN"    value="0.75" />
    <define name="AUTO_GROUNDSPEED_IGAIN"    value="0.25" />

    <define name="AUTO_PITCH_MAX_PITCH" value="RadOfDeg(25)"/>
    <define name="AUTO_PITCH_MIN_PITCH" value="RadOfDeg(-20)"/>
--->

  </section>



  <section name="NAV">
    <define name="DEFAULT_CIRCLE_RADIUS" value="60."/>
  </section>






  <section name="AGGRESSIVE" prefix="AGR_">
    <define name="BLEND_START" value="75"/><!--set really high to prevent agressive mode-->
    <!-- Altitude Error to Initiate Aggressive Climb CANNOT BE ZERO!!-->
    <define name="BLEND_END" value="15"/>
    <!-- Altitude Error to Blend Aggressive to Regular Climb Modes CANNOT BE ZERO!!-->
    <define name="CLIMB_THROTTLE" value=".85"/>
    <!-- Gaz for Aggressive Climb -->
    <define name="CLIMB_PITCH" value="0.6"/>
    <!-- Pitch for Aggressive Climb -->
    <define name="DESCENT_THROTTLE" value="0.1"/>
    <!-- Gaz for Aggressive Decent -->
    <define name="DESCENT_PITCH" value="-0.2" />
    <!-- Pitch for Aggressive Decent -->
    <define name="CLIMB_NAV_RATIO" value="0.8"/>
    <!-- Percent Navigation for Altitude Error Equal to Start Altitude -->
    <define name="DESCENT_NAV_RATIO" value="1.0"/>

  </section>


  <modules>
    <load name="geo_mag.xml"/>

    <load name="airspeed_ets.xml">
      <define name="AIRSPEED_ETS_SYNC_SEND"/>
      <define name="AIRSPEED_ETS_I2C_DEV" value="i2c2"/>

    </load>
    <!--load name="send_imu_mag_current.xml"/--> <!-- uncomment this line to measure IMU current Calibration-->
 </modules>

</airframe>