Advertisement
Guest User

Untitled

a guest
Aug 7th, 2012
101
0
Never
Not a member of Pastebin yet? Sign Up, it unlocks many cool features!
C++ 52.05 KB | None | 0 0
  1. /*************************************************************************************************/
  2. /****           CONFIGURABLE PARAMETERS                                                       ****/
  3. /*************************************************************************************************/
  4.  
  5. /* this file consists of several sections
  6.  * to create a working combination you must at least make your choices in section 1.
  7.  * 1 - BASIC SETUP - you must select an option in every block.
  8.  *      this assumes you have 4 channels connected to your board with standard ESCs and servos.
  9.  * 2 - COPTER TYPE SPECIFIC OPTIONS - you likely want to check for options for your copter type
  10.  * 3 - RC SYSTEM SETUP
  11.  * 4 - ALTERNATE CPUs & BOARDS - if you have
  12.  * 5 - ALTERNATE SETUP - select alternate RX (SBUS, PPM, etc.), alternate ESC-range, etc. here
  13.  * 6 - OPTIONAL FEATURES - enable nice to have features here (LCD, telemetry, battery monitor etc.)
  14.  * 7 - TUNING & DEVELOPER - if you know what you are doing; you have been warned
  15.  */
  16.  
  17.  
  18.  
  19.  
  20. /*************************************************************************************************/
  21. /*****************                                                                 ***************/
  22. /****************  SECTION  1 - BASIC SETUP                                                *******/
  23. /*****************                                                                 ***************/
  24. /*************************************************************************************************/
  25.  
  26.   /**************************    The type of multicopter    ****************************/
  27.     //#define GIMBAL
  28.     //#define BI
  29.     //#define TRI
  30.     //#define QUADP
  31.     #define QUADX
  32.     //#define Y4
  33.     //#define Y6
  34.     //#define HEX6
  35.     //#define HEX6X
  36.     //#define OCTOX8
  37.     //#define OCTOFLATP
  38.     //#define OCTOFLATX
  39.     //#define FLYING_WING
  40.     //#define VTAIL4
  41.     //#define AIRPLANE
  42.     //#define SINGLECOPTER
  43.     //#define DUALCOPTER
  44.     //#define HELI_120_CCPM
  45.     //#define HELI_90_DEG
  46.  
  47.   /****************************    Motor minthrottle    *******************************/
  48.     /* Set the minimum throttle command sent to the ESC (Electronic Speed Controller)
  49.        This is the minimum value that allow motors to run at a idle speed  */
  50.     //#define MINTHROTTLE 1300 // for Turnigy Plush ESCs 10A
  51.     //#define MINTHROTTLE 1120 // for Super Simple ESCs 10A
  52.     //#define MINTHROTTLE 1064 // special ESC (simonk)
  53.     #define MINTHROTTLE 1100
  54.  
  55.   /****************************    Motor maxthrottle    *******************************/
  56.     /* this is the maximum value for the ESCs at full power, this value can be increased up to 2000 */
  57.       #define MAXTHROTTLE 1980
  58.  
  59.   /****************************    Mincommand          *******************************/
  60.     /* this is the value for the ESCs when they are not armed
  61.        in some cases, this value must be lowered down to 900 for some specific ESCs, otherwise they failed to initiate */
  62.       #define MINCOMMAND  1000
  63.  
  64.   /**********************************    I2C speed   ************************************/
  65.     #define I2C_SPEED 100000L     //100kHz normal mode, this value must be used for a genuine WMP
  66.     //#define I2C_SPEED 400000L   //400kHz fast mode, it works only with some WMP clones
  67.  
  68.   /***************************    Internal i2c Pullups   ********************************/
  69.     /* enable internal I2C pull ups (in most cases it is better to use external pullups) */
  70.     //#define INTERNAL_I2C_PULLUPS
  71.  
  72.   /**************************************************************************************/
  73.   /*****************          boards and sensor definitions            ******************/
  74.   /**************************************************************************************/
  75.  
  76.     /***************************    Combined IMU Boards    ********************************/
  77.       /* if you use a specific sensor board:
  78.          please submit any correction to this list.
  79.            Note from Alex: I only own some boards, for other boards, I'm not sure, the info was gathered via rc forums, be cautious */
  80.       //#define FFIMUv1         // first 9DOF+baro board from Jussi, with HMC5843                   <- confirmed by Alex
  81.       //#define FFIMUv2         // second version of 9DOF+baro board from Jussi, with HMC5883       <- confirmed by Alex
  82.       //#define FREEIMUv1       // v0.1 & v0.2 & v0.3 version of 9DOF board from Fabio
  83.       //#define FREEIMUv03      // FreeIMU v0.3 and v0.3.1
  84.       //#define FREEIMUv035     // FreeIMU v0.3.5 no baro
  85.       //#define FREEIMUv035_MS  // FreeIMU v0.3.5_MS                                                <- confirmed by Alex
  86.       //#define FREEIMUv035_BMP // FreeIMU v0.3.5_BMP
  87.       //#define FREEIMUv04      // FreeIMU v0.4 with MPU6050, HMC5883L, MS561101BA                  <- confirmed by Alex
  88.       //#define FREEIMUv043     // same as FREEIMUv04 with final MPU6050 (with the right ACC scale)
  89.       //#define NANOWII         // the smallest multiwii FC based on MPU6050 + pro micro based proc <- confirmed by Alex
  90.       //#define PIPO            // 9DOF board from erazz
  91.       //#define QUADRINO        // full FC board 9DOF+baro board from witespy  with BMP085 baro     <- confirmed by Alex
  92.       //#define QUADRINO_ZOOM   // full FC board 9DOF+baro board from witespy  second edition
  93.       //#define QUADRINO_ZOOM_MS// full FC board 9DOF+baro board from witespy  second edition       <- confirmed by Alex
  94.       //#define ALLINONE        // full FC board or standalone 9DOF+baro board from CSG_EU
  95.       //#define AEROQUADSHIELDv2
  96.       //#define ATAVRSBIN1      // Atmel 9DOF (Contribution by EOSBandi). requires 3.3V power.
  97.       //#define SIRIUS          // Sirius Navigator IMU                                             <- confirmed by Alex
  98.       //#define SIRIUS600       // Sirius Navigator IMU  using the WMP for the gyro
  99.       //#define MINIWII         // Jussi's MiniWii Flight Controller                                <- confirmed by Alex
  100.       //#define CITRUSv2_1      // CITRUS from qcrc.ca
  101.       //#define CHERRY6DOFv1_0
  102.       //#define DROTEK_10DOF    // Drotek 10DOF with ITG3200, BMA180, HMC5883, BMP085, w or w/o LLC
  103.       //#define DROTEK_10DOF_MS // Drotek 10DOF with ITG3200, BMA180, HMC5883, MS5611, LLC
  104.       //#define DROTEK_6DOFv2   // Drotek 6DOF v2
  105.       //#define DROTEK_6DOF_MPU // Drotek 6DOF with MPU6050
  106.       //#define DROTEK_10DOF_MPU//
  107.       //#define MONGOOSE1_0     // mongoose 1.0    http://store.ckdevices.com/
  108.       //#define CRIUS_LITE      // Crius MultiWii Lite
  109.         #define CRIUS_SE        // Crius MultiWii SE
  110.       //#define OPENLRSv2MULTI  // OpenLRS v2 Multi Rc Receiver board including ITG3205 and ADXL345
  111.       //#define BOARD_PROTO_1   // with MPU6050 + HMC5883L + MS baro
  112.       //#define BOARD_PROTO_2   // with MPU6050 + slave  MAG3110 + MS baro
  113.       //#define GY_80           // Chinese 10 DOF with  L3G4200D ADXL345 HMC5883L BMP085, LLC
  114.       //#define GY_85           // Chinese 9 DOF with  ITG3205 ADXL345 HMC5883L LLC
  115.       //#define GY_86           // Chinese 10 DOF with  MPU6050 HMC5883L MS5611, LLC
  116.       //#define INNOVWORKS_10DOF // with ITG3200, BMA180, HMC5883, BMP085 available here http://www.diymulticopter.com
  117.       //#define INNOVWORKS_6DOF // with ITG3200, BMA180 available here http://www.diymulticopter.com
  118.       //#define PROTO_DIY       // 10DOF mega board
  119.       //#define IOI_MINI_MULTIWII// www.bambucopter.com
  120.       //#define Bobs_6DOF_V1     // BobsQuads 6DOF V1 with ITG3200 & BMA180
  121.       //#define Bobs_9DOF_V1     // BobsQuads 9DOF V1 with ITG3200, BMA180 & HMC5883L
  122.       //#define Bobs_10DOF_BMP_V1 // BobsQuads 10DOF V1 with ITG3200, BMA180, HMC5883L & BMP180 - BMP180 is software compatible with BMP085
  123.       //#define FLYDUINO_MPU
  124.      
  125.     /***************************    independent sensors    ********************************/
  126.       /* leave it commented if you already checked a specific board above */
  127.       /* I2C gyroscope */
  128.       //#define WMP
  129.       //#define ITG3200
  130.       //#define L3G4200D
  131.       //#define MPU6050       //combo + ACC
  132.  
  133.       /* I2C accelerometer */
  134.       //#define NUNCHUCK  // if you want to use the nunckuk connected to a WMP
  135.       //#define MMA745
  136.       //#define ADXL345
  137.       //#define BMA020
  138.       //#define BMA180
  139.       //#define NUNCHACK  // if you want to use the nunckuk as a standalone I2C ACC without WMP
  140.       //#define LIS3LV02
  141.       //#define LSM303DLx_ACC
  142.  
  143.       /* I2C barometer */
  144.       //#define BMP085
  145.       //#define MS561101BA
  146.  
  147.       /* I2C magnetometer */
  148.       //#define HMC5843
  149.       //#define HMC5883
  150.       //#define AK8975
  151.       //#define MAG3110
  152.  
  153.       /* Sonar */ // for visualization purpose currently - no control code behind
  154.       //#define SRF02 // use the Devantech SRF i2c sensors
  155.       //#define SRF08
  156.       //#define SRF10
  157.       //#define SRF23
  158.  
  159.       /* ADC accelerometer */ // for 5DOF from sparkfun, uses analog PIN A1/A2/A3
  160.       //#define ADCACC
  161.  
  162.       /* individual sensor orientation */
  163.       //#define ACC_ORIENTATION(X, Y, Z)  {accADC[ROLL]  =  Y; accADC[PITCH]  = -X; accADC[YAW]  = Z;}
  164.       //#define GYRO_ORIENTATION(X, Y, Z) {gyroADC[ROLL] = -Y; gyroADC[PITCH] =  X; gyroADC[YAW] = Z;}
  165.       //#define MAG_ORIENTATION(X, Y, Z)  {magADC[ROLL]  = X; magADC[PITCH]  = Y; magADC[YAW]  = Z;}
  166.  
  167.  
  168.  
  169.  
  170. /*************************************************************************************************/
  171. /*****************                                                                 ***************/
  172. /****************  SECTION  2 - COPTER TYPE SPECIFIC OPTIONS                               *******/
  173. /*****************                                                                 ***************/
  174. /*************************************************************************************************/
  175.  
  176.   /********************************    TRI    *********************************/
  177.     #define YAW_DIRECTION 1
  178.     //#define YAW_DIRECTION -1 // if you want to reverse the yaw correction direction
  179.     /* you can change the tricopter servo travel here */
  180.       #define TRI_YAW_CONSTRAINT_MIN 1020
  181.       #define TRI_YAW_CONSTRAINT_MAX 2000
  182.       #define TRI_YAW_MIDDLE 1500 // tail servo center pos. - use this for initial trim; later trim midpoint via LCD
  183.  
  184.    /********************************    ARM/DISARM    *********************************/
  185.    /* optionally disable stick combinations to arm/disarm the motors.
  186.      * In most cases one of the two options to arm/disarm via TX stick is sufficient */
  187.     #define ALLOW_ARM_DISARM_VIA_TX_YAW
  188.     #define ALLOW_ARM_DISARM_VIA_TX_ROLL
  189.  
  190.   /***********************          Cam Stabilisation             ***********************/
  191.     /* The following lines apply only for a pitch/roll tilt stabilization system. Uncomment the first or second line to activate it */
  192.     //#define SERVO_MIX_TILT
  193.     //#define SERVO_TILT
  194.     #define TILT_PITCH_MIN    1020    //servo travel min, don't set it below 1020
  195.     #define TILT_PITCH_MAX    2000    //servo travel max, max value=2000
  196.     #define TILT_PITCH_MIDDLE 1500    //servo neutral value
  197.     #define TILT_PITCH_PROP   10      //servo proportional (tied to angle) ; can be negative to invert movement
  198.     #define TILT_ROLL_MIN     1020
  199.     #define TILT_ROLL_MAX     2000
  200.     #define TILT_ROLL_MIDDLE  1500
  201.     #define TILT_ROLL_PROP    10
  202.  
  203.     /* camera trigger function : activated via Rc Options in the GUI, servo output=A2 on promini */
  204.     //#define CAMTRIG
  205.     #define CAM_SERVO_HIGH 2000  // the position of HIGH state servo
  206.     #define CAM_SERVO_LOW 1020   // the position of LOW state servo
  207.     #define CAM_TIME_HIGH 1000   // the duration of HIGH state servo expressed in ms
  208.     #define CAM_TIME_LOW 1000    // the duration of LOW state servo expressed in ms
  209.  
  210.   /***********************          Flying Wing                   ***********************/
  211.     /* you can change change servo orientation and servo min/max values here
  212.        valid for all flight modes, even passThrough mode
  213.        need to setup servo directions here; no need to swap servos amongst channels at rx */
  214.     #define PITCH_DIRECTION_L 1 // left servo - pitch orientation
  215.     #define PITCH_DIRECTION_R -1  // right servo - pitch orientation (opposite sign to PITCH_DIRECTION_L, if servos are mounted in mirrored orientation)
  216.     #define ROLL_DIRECTION_L 1 // left servo - roll orientation
  217.     #define ROLL_DIRECTION_R 1  // right servo - roll orientation  (same sign as ROLL_DIRECTION_L, if servos are mounted in mirrored orientation)
  218.     #define WING_LEFT_MID  1500 // left servo center pos. - use this for initial trim; later trim midpoint via LCD
  219.     #define WING_RIGHT_MID 1500 // right servo center pos. - use this for initial trim; later trim midpoint via LCD
  220.     #define WING_LEFT_MIN  1020 // limit servo travel range must be inside [1020;2000]
  221.     #define WING_LEFT_MAX  2000 // limit servo travel range must be inside [1020;2000]
  222.     #define WING_RIGHT_MIN 1020 // limit servo travel range must be inside [1020;2000]
  223.     #define WING_RIGHT_MAX 2000 // limit servo travel range must be inside [1020;2000]
  224.  
  225.   /***********************          Airplane                       ***********************/
  226.     #define SERVO_RATES      {100, 100, 100, 100, 100, 100, 100, 100} // Rates in 0-100%
  227.     #define SERVO_DIRECTION  { -1,   1,   1,   -1,  1,   1,   1,   1 } // Invert servos by setting -1
  228.  
  229.     //#define FLAPPERONS    AUX4          // Mix Flaps with Aileroins.
  230.     #define FLAPPERON_EP   { 1500, 1700 } // Endpooints for flaps on a 2 way switch else set {1020,2000} and program in radio.
  231.     //#define FLAPPERON_EP   { 1200, 1500 } // Or Flapperons up for CrowMix
  232.     #define FLAPPERON_INVERT { 1, -1 }    // Change direction om flapperons { Wing1, Wing2 }
  233.    
  234.     //#define FLAPS         AUX4          // Traditional Flaps on A2 invert with SERVO_DIRECTION servo[2).
  235.     #define FLAP_EP      { 1500, 1900 }   // Endpooints for flaps on a 2 way switch else set {1020,2000} and program in radio.
  236.  
  237.     //#define FLAPSPEED     3             // Make flaps move slowm Higher value is Higher Speed.
  238.  
  239.   /***********************      Common for Heli & Airplane         ***********************/
  240.     //#define D12_POWER      // Use D12 on PROMINI to power sensors. Will disable servo[4] on D12
  241.     #define SERVO_OFFSET     {  0,   0,   0,  0,   0,   0,  0,   0 } // Adjust Servo MID Offset & Swash angles
  242.     // Selectable channels:=    ROLL,PITCH,THROTTLE,YAW,AUX1,AUX2,AUX3,AUX4
  243.  
  244.   /***********************          Heli                           ***********************/
  245.     /* Channel to control CollectivePitch */
  246.     #define COLLECTIVE_PITCH      THROTTLE
  247.     /* Set Maximum available movement for the servos. Depending on model */
  248.     #define SERVO_ENDPOINT_HIGH {2000,2000,2000,2000,2000,2000,2000,2000};
  249.     #define SERVO_ENDPOINT_LOW  {1020,1020,1020,1020,1020,1020,1020,1020};
  250.  
  251.     /* Limit the range of Collective Pitch. 100% is Full Range each way and position for Zero Pitch */
  252.     #define COLLECTIVE_RANGE { 80, 1500, 80 }// {Min%, ZeroPitch, Max%}.
  253.     #define YAW_CENTER             1500      // Use servo[5] SERVO_ENDPOINT_HIGH/LOW for the endpoits.
  254.     #define YAWMOTOR                0       // If a motor is useed as YAW Set to 1 else set to 0.
  255.  
  256.     /* Servo mixing for heli 120 Use 1/10 fractions (ex.5 = 5/10 = 1/2)
  257.                          {Coll,Nick,Roll} */
  258.     #define SERVO_NICK   { +10, -10, -0 }
  259.     #define SERVO_LEFT   { +10, +5, +10 }
  260.     #define SERVO_RIGHT  { +10, +5, -10 }
  261.  
  262.     /* Servo mixing for heli 90
  263.                             {Coll,Nick,Roll} */
  264.     #define SERVO_DIRECTIONS { +1, -1, -1 } // -1 will invert servo
  265.    
  266.     /* Limit Maximum controll for Roll & Nick  in 0-100% */
  267.     #define CONTROLL_RANGE   { 100, 100 }      //  { ROLL,PITCH }
  268.  
  269.     /* use servo code to drive the throttle output. You want this for analog servo driving the throttle on IC engines.
  270.        if inactive, throttle output will be treated as a motor output, so it can drive an ESC */
  271.     //#define HELI_USE_SERVO_FOR_THROTTLE
  272.  
  273.   /***********************      Single and DualCopter Settings     ***********************/
  274.     /* Change to -1 to reverse servomovement per axis
  275.        Servosettings for SingleCopter */
  276.     #define SINGLECOPTRER_YAW   {1, 1, 1, 1} // Left, Right,Front,Rear
  277.     #define SINGLECOPTRER_SERVO {1,-1, 1,-1} // Pitch,Pitch,Roll, Roll    
  278.  
  279.     /* Servosettings for DualCopter */
  280.      #define DUALCOPTER_SERVO {1,1} //Pitch,Roll
  281.     /* Use  SERVO_OFFSET and SERVO_RATES in Heli and Airplane section for centering and endpoints */
  282.  
  283.  
  284.  
  285.  
  286. /*************************************************************************************************/
  287. /*****************                                                                 ***************/
  288. /****************  SECTION  3 - RC SYSTEM SETUP                                            *******/
  289. /*****************                                                                 ***************/
  290. /*************************************************************************************************/
  291.  
  292.   /* note: no need to uncomment something in this section if you use a standard receiver */
  293.  
  294.   /**************************************************************************************/
  295.   /********                       special receiver types             ********************/
  296.   /**************************************************************************************/
  297.  
  298.     /****************************    PPM Sum Reciver    ***********************************/
  299.       /* The following lines apply only for specific receiver with only one PPM sum signal, on digital PIN 2
  300.          Select the right line depending on your radio brand. Feel free to modify the order in your PPM order is different */
  301.       //#define SERIAL_SUM_PPM         PITCH,YAW,THROTTLE,ROLL,AUX1,AUX2,AUX3,AUX4 //For Graupner/Spektrum
  302.         #define SERIAL_SUM_PPM         ROLL,PITCH,THROTTLE,YAW,AUX1,AUX2,AUX3,AUX4 //For Robe/Hitec/Futaba
  303.       //#define SERIAL_SUM_PPM         PITCH,ROLL,THROTTLE,YAW,AUX1,AUX2,AUX3,AUX4 //For some Hitec/Sanwa/Others
  304.  
  305.     /**********************    Spektrum Satellite Reciver    *******************************/
  306.       /* The following lines apply only for Spektrum Satellite Receiver
  307.          Spektrum Satellites are 3V devices.  DO NOT connect to 5V!
  308.          For MEGA boards, attach sat grey wire to RX1, pin 19. Sat black wire to ground. Sat orange wire to Mega board's 3.3V (or any other 3V to 3.3V source).
  309.          For PROMINI, attach sat grey to RX0.  Attach sat black to ground. */
  310.       //#define SPEKTRUM 1024
  311.       //#define SPEKTRUM 2048
  312.  
  313.     /*******************************    SBUS RECIVER    ************************************/
  314.       /* The following line apply only for Futaba S-Bus Receiver on MEGA boards at RX1 only (Serial 1).
  315.          You have to invert the S-Bus-Serial Signal e.g. with a Hex-Inverter like IC SN74 LS 04 */
  316.       //#define SBUS
  317.  
  318.     /******************* RC signal from the serial port via Multiwii Serial Protocol *********/
  319.       //#define RCSERIAL
  320.  
  321.  
  322.  
  323.  
  324. /*************************************************************************************************/
  325. /*****************                                                                 ***************/
  326. /****************  SECTION  4 - ALTERNATE CPUs & BOARDS                                    *******/
  327. /*****************                                                                 ***************/
  328. /*************************************************************************************************/
  329.  
  330.   /**************************************************************************************/
  331.   /********                      Promini Specifig Settings           ********************/
  332.   /**************************************************************************************/
  333.  
  334.     /**************************    Hexa Motor 5 & 6 Pins    *******************************/
  335.       /* PIN A0 and A1 instead of PIN D5 & D6 for 6 motors config and promini config
  336.          This mod allow the use of a standard receiver on a pro mini
  337.          (no need to use a PPM sum receiver) */
  338.       //#define A0_A1_PIN_HEX
  339.  
  340.     /*********************************    Aux 2 Pin     ***********************************/
  341.       /* possibility to use PIN8 or PIN12 as the AUX2 RC input (only one, not both)
  342.          it deactivates in this case the POWER PIN (pin 12) or the BUZZER PIN (pin 8) */
  343.       //#define RCAUXPIN8
  344.       //#define RCAUXPIN12
  345.  
  346.  
  347.   /**************************************************************************************/
  348.   /*****************             Teensy 2.0 Support                    ******************/
  349.   /**************************************************************************************/
  350.     /* uncomment this if you use a teensy 2.0 with teensyduino
  351.        it needs to run at 16MHz */
  352.     //#define TEENSY20
  353.  
  354.  
  355.   /**************************************************************************************/
  356.   /********   Settings for ProMicro, Leonardo and other Atmega32u4 Boards     ***********/
  357.   /**************************************************************************************/
  358.  
  359.     /*********************************    pin Layout     **********************************/
  360.       /* activate this for a better pinlayout if all pins can be used => not possible on ProMicro */
  361.       //#define A32U4ALLPINS
  362.  
  363.     /**********************************    PWM Setup     **********************************/
  364.       /* activate all 6 hardware PWM outputs Motor 5 = D11 and 6 = D13.
  365.          note: not possible on the sparkfun promicro (pin 11 & 13 are not broken out there)
  366.          if activated:
  367.          Motor 1-6 = 10-bit hardware PWM
  368.          Motor 7-8 = 8-bit Software PWM
  369.          Servos    = 8-bit Software PWM
  370.          if deactivated:
  371.          Motor 1-4 = 10-bit hardware PWM
  372.          Motor 5-8 = 10-bit Software PWM
  373.          Servos    = 10-bit Software PWM */
  374.       //#define HWPWM6
  375.  
  376.     /**********************************    Aux 2 Pin     **********************************/
  377.       /* AUX2 pin on pin RXO */
  378.       //#define RCAUX2PINRXO
  379.  
  380.       /* aux2 pin on pin D17 (RXLED) */
  381.       //#define RCAUX2PIND17
  382.  
  383.     /**********************************    Buzzer Pin    **********************************/
  384.       /* this moves the Buzzer pin from TXO to D8 for use with ppm sum or spectrum sat. RX (not needed if A32U4ALLPINS is active) */
  385.       //#define D8BUZZER
  386.  
  387.     /***********************      Promicro version related     ****************************/
  388.       /* Inverted status LED for Promicro ver 10 */
  389.       //#define PROMICRO10
  390.  
  391.  
  392.  
  393.  
  394. /*************************************************************************************************/
  395. /*****************                                                                 ***************/
  396. /****************  SECTION  5 - ALTERNATE SETUP                                            *******/
  397. /*****************                                                                 ***************/
  398. /*************************************************************************************************/
  399.  
  400.   /******                Serial com speed    *********************************/
  401.     /* This is the speed of the serial interface */
  402.     #define SERIAL_COM_SPEED 115200
  403.  
  404.     /* interleaving delay in micro seconds between 2 readings WMP/NK in a WMP+NK config
  405.        if the ACC calibration time is very long (20 or 30s), try to increase this delay up to 4000
  406.        it is relevent only for a conf with NK */
  407.     #define INTERLEAVING_DELAY 3000
  408.  
  409.     /* when there is an error on I2C bus, we neutralize the values during a short time. expressed in microseconds
  410.        it is relevent only for a conf with at least a WMP */
  411.     #define NEUTRALIZE_DELAY 100000
  412.  
  413.  
  414.   /**************************************************************************************/
  415.   /********                              Gyro filters                ********************/
  416.   /**************************************************************************************/
  417.  
  418.     /*********************    Lowpass filter for some gyros    ****************************/
  419.       /* ITG3200 & ITG3205 Low pass filter setting. In case you cannot eliminate all vibrations to the Gyro, you can try
  420.          to decrease the LPF frequency, only one step per try. As soon as twitching gone, stick with that setting.
  421.          It will not help on feedback wobbles, so change only when copter is randomly twiching and all dampening and
  422.          balancing options ran out. Uncomment only one option!
  423.          IMPORTANT! Change low pass filter setting changes PID behaviour, so retune your PID's after changing LPF.*/
  424.       //#define ITG3200_LPF_256HZ     // This is the default setting, no need to uncomment, just for reference
  425.       //#define ITG3200_LPF_188HZ
  426.       //#define ITG3200_LPF_98HZ
  427.       //#define ITG3200_LPF_42HZ
  428.       //#define ITG3200_LPF_20HZ
  429.       //#define ITG3200_LPF_10HZ      // Use this only in extreme cases, rather change motors and/or props
  430.  
  431.       /* MPU6050 Low pass filter setting. In case you cannot eliminate all vibrations to the Gyro, you can try
  432.          to decrease the LPF frequency, only one step per try. As soon as twitching gone, stick with that setting.
  433.          It will not help on feedback wobbles, so change only when copter is randomly twiching and all dampening and
  434.          balancing options ran out. Uncomment only one option!
  435.          IMPORTANT! Change low pass filter setting changes PID behaviour, so retune your PID's after changing LPF.*/
  436.       //#define MPU6050_LPF_256HZ     // This is the default setting, no need to uncomment, just for reference
  437.       //#define MPU6050_LPF_188HZ
  438.       //#define MPU6050_LPF_98HZ
  439.       //#define MPU6050_LPF_42HZ
  440.       //#define MPU6050_LPF_20HZ
  441.       //#define MPU6050_LPF_10HZ
  442.       //#define MPU6050_LPF_5HZ       // Use this only in extreme cases, rather change motors and/or props
  443.  
  444.     /******                Gyro smoothing    **********************************/
  445.       /* GYRO_SMOOTHING. In case you cannot reduce vibrations _and_ _after_ you have tried the low pass filter options, you
  446.          may try this gyro smoothing via averaging. Not suitable for multicopters!
  447.          Good results for helicopter, airplanes and flying wings (foamies) with lots of vibrations.*/
  448.       //#define GYRO_SMOOTHING {20, 20, 3}    // separate averaging ranges for roll, pitch, yaw
  449.  
  450.     /************************    Moving Average Gyros    **********************************/
  451.       //#define MMGYRO                         // Active Moving Average Function for Gyros
  452.       //#define MMGYROVECTORLENGHT 10          // Lenght of Moving Average Vector
  453.       /* Moving Average ServoGimbal Signal Output */
  454.       //#define MMSERVOGIMBAL                  // Active Output Moving Average Function for Servos Gimbal
  455.       //#define MMSERVOGIMBALVECTORLENGHT 32   // Lenght of Moving Average Vector
  456.  
  457.  
  458.  
  459.  
  460. /*************************************************************************************************/
  461. /*****************                                                                 ***************/
  462. /****************  SECTION  6 - OPTIONAL FEATURES                                          *******/
  463. /*****************                                                                 ***************/
  464. /*************************************************************************************************/
  465.  
  466.   /* Pseudo-derivative conrtroller for level mode (experimental)
  467.      Additional information: http://www.multiwii.com/forum/viewtopic.php?f=8&t=503 */
  468.     //#define LEVEL_PDF
  469.  
  470.  
  471.   /********                          Failsave settings                 ********************/
  472.     /* Failsafe check pulse on THROTTLE channel. If the pulse is OFF (on only THROTTLE or on all channels) the failsafe procedure is initiated.
  473.        After FAILSAVE_DELAY time of pulse absence, the level mode is on (if ACC or nunchuk is avaliable), PITCH, ROLL and YAW is centered
  474.        and THROTTLE is set to FAILSAVE_THR0TTLE value. You must set this value to descending about 1m/s or so for best results.
  475.        This value is depended from your configuration, AUW and some other params.
  476.        Next, afrer FAILSAVE_OFF_DELAY the copter is disarmed, and motors is stopped.
  477.        If RC pulse coming back before reached FAILSAVE_OFF_DELAY time, after the small quard time the RC control is returned to normal.
  478.        If you use serial sum PPM, the sum converter must completly turn off the PPM SUM pusles for this FailSafe functionality.*/
  479.     //#define FAILSAFE                                  // uncomment  to activate the failsafe function
  480.     #define FAILSAVE_DELAY     10                     // Guard time for failsafe activation after signal lost. 1 step = 0.1sec - 1sec in example
  481.     #define FAILSAVE_OFF_DELAY 200                    // Time for Landing before motors stop in 0.1sec. 1 step = 0.1sec - 20sec in example
  482.     #define FAILSAVE_THROTTLE  (MINTHROTTLE + 200)    // Throttle level used for landing - may be relative to MINTHROTTLE - as in this case
  483.  
  484.  
  485.   /*****************                DFRobot LED RING    *********************************/
  486.     /* I2C DFRobot LED RING communication */
  487.     //#define LED_RING
  488.  
  489.   /********************************    LED FLASHER    ***********************************/
  490.     //#define LED_FLASHER
  491.     //#define LED_FLASHER_DDR DDRB
  492.     //#define LED_FLASHER_PORT PORTB
  493.     //#define LED_FLASHER_BIT PORTB4
  494.     //#define LED_FLASHER_SEQUENCE ( (uint8_t) 0 )
  495.     // create double flashes
  496.     //#define LED_FLASHER_SEQUENCE_ARMED ( (uint8_t) (1<<0 | 1<<2) )
  497.     // full illumination
  498.     //#define LED_FLASHER_SEQUENCE_MAX 0xFF
  499.  
  500.  
  501.   /*******************************    Landing lights    *********************************/
  502.   /* Landing lights
  503.      Use an output pin to control landing lights.
  504.      They can be switched automatically when used in conjunction
  505.      with altitude data from a sonar unit. */
  506.     //#define LANDING_LIGHTS_DDR DDRC
  507.     //#define LANDING_LIGHTS_PORT PORTC
  508.     //#define LANDING_LIGHTS_BIT PORTC0
  509.  
  510.     /* altitude above ground (in cm) as reported by sonar */
  511.     //#define LANDING_LIGHTS_AUTO_ALTITUDE 50
  512.  
  513.  
  514.   /*************************    INFLIGHT ACC Calibration    *****************************/
  515.     /* This will activate the ACC-Inflight calibration if unchecked */
  516.     #define INFLIGHT_ACC_CALIBRATION
  517.  
  518.   /**************************    Disable WMP power pin     *******************************/
  519.     /* disable use of the POWER PIN
  520.        (allready done if the option RCAUXPIN12 is selected) */
  521.     //#define DISABLE_POWER_PIN
  522.  
  523.  
  524.   /**************************************************************************************/
  525.   /***********************                  TX-related         **************************/
  526.   /**************************************************************************************/
  527.  
  528.     /* introduce a deadband around the stick center
  529.        Must be greater than zero, comment if you dont want a deadband on roll, pitch and yaw */
  530.     //#define DEADBAND 6
  531.  
  532.  
  533.   /**************************************************************************************/
  534.   /***********************                  GPS                **************************/
  535.   /**************************************************************************************/
  536.  
  537.     /* GPS using a SERIAL port
  538.        only available on MEGA boards (this might be possible on 328 based boards in the future)
  539.        if enabled, define here the Arduino Serial port number and the UART speed
  540.        note: only the RX PIN is used, the GPS is not configured by multiwii
  541.        the GPS must be configured to output NMEA sentences (which is generally the default conf for most GPS devices)
  542.        uncomment the first line to select the GPS serial port of the arduino */
  543.     //#define GPS_SERIAL 2 // should be 2 for flyduino v2. It's the serial port number on arduino MEGA
  544.     #define GPS_BAUD   115200
  545.    
  546.     //#define GPS_PROMINI_SERIAL    57600 // Will Autosense if GPS is connected when ardu boots
  547.    
  548.     /* I2C GPS device made with an independant arduino + GPS device
  549.        including some navigation functions
  550.        contribution from EOSBandi   http://code.google.com/p/i2c-gps-nav/ */
  551.     //#define I2C_GPS
  552.  
  553.     /* I2C GPS device made with an indeedent ATTiny[24]313 + GPS device and
  554.        optional sonar device.    https://github.com/wertarbyte/tiny-gps/ */
  555.     /* get GPS data from Tiny-GPS */
  556.     //#define TINY_GPS
  557.     /* get sonar data from Tiny-GPS */
  558.     //#define TINY_GPS_SONAR
  559.  
  560.     /* indicate a valid GPS fix with at least 5 satellites by flashing the LED? */
  561.     #define GPS_LED_INDICATOR
  562.  
  563.     /* GPS data readed from OSD -- still need some more code to work */
  564.     //#define GPS_FROM_OSD
  565.  
  566.     //#define USE_MSP_WP           //Enables the MSP_WP command, which is used by WinGUI to display and log Home and Poshold positions
  567.                                    //Uncomment it if you are planning to use WinGUI - Will cost +208 bytes of Flash
  568.    
  569.     /* GPS navigation can control the heading */
  570.    
  571.     #define NAV_CONTROLS_HEADING       true      // copter faces toward the navigation point, maghold must be enabled for it
  572.     #define NAV_TAIL_FIRST             false     // true - copter comes in with tail first
  573.     #define NAV_SET_TAKEOFF_HEADING    true      // true - when copter arrives to home position it rotates it's head to takeoff direction
  574.    
  575.    
  576.     /* Get your magnetic decliniation from here : http://magnetic-declination.com/
  577.        Convert the degree+minutes into decimal degree by ==> degree+minutes*(1/60)
  578.        Note the sign on declination it could be negative or positive (WEST or EAST) */
  579.     //#define MAG_DECLINIATION  3.96f              //For Budapest Hungary.
  580.     #define MAG_DECLINIATION  0.0f
  581.    
  582.     #define GPS_FILTERING                    // add a 5 element moving average filter to GPS coordinates, helps eliminate gps noise but adds latency comment out to disable
  583.     #define GPS_LOW_SPEED_D_FILTER           // below .5m/s speed ignore D term for POSHOLD_RATE, theoretically this also removed D term induced noise commnent out to disable
  584.     #define GPS_WP_RADIUS              200       // if we are within this distance to a waypoint then we consider it reached (distance is in cm)
  585.     #define NAV_SLEW_RATE              30        // Adds a rate control to nav output, will smoothen out nav angle spikes
  586.  
  587.  
  588.   /**************************************************************************************/
  589.   /***********************        LCD/OLED - display settings       *********************/
  590.   /**************************************************************************************/
  591.  
  592.     /* uncomment this line if you plan to use a LCD or OLED */
  593.       //#define LCD_CONF
  594.  
  595.     /* to include setting the aux switches for AUX1 -> AUX4 via LCD */ //to review (activate[] is now 16 bit long)
  596.       //#define LCD_CONF_AUX
  597.  
  598.     /* if program gets too large (>32k), need to exclude some functionality */
  599.       /* uncomment to suppress some unwanted aux3 aux4 items in config menu (only useful if LCD_CONF_AUX is enabled) */
  600.       //#define SUPPRESS_LCD_CONF_AUX34
  601.  
  602.     /*****************************   The type of LCD     **********************************/
  603.       /* choice of LCD attached for configuration and telemetry, see notes below */
  604.       //#define LCD_SERIAL3W    // Alex' initial variant with 3 wires, using rx-pin for transmission @9600 baud fixed
  605.       //#define LCD_TEXTSTAR    // SERIAL LCD: Cat's Whisker LCD_TEXTSTAR Module CW-LCD-02 (Which has 4 input keys for selecting menus)
  606.       //#define LCD_VT100       // SERIAL LCD: vt100 compatible terminal emulation (blueterm, putty, etc.)
  607.       //#define LCD_ETPP        // I2C LCD: Eagle Tree Power Panel LCD, which is i2c (not serial)
  608.       //#define LCD_LCD03       // I2C LCD: LCD03, which is i2c
  609.       //#define OLED_I2C_128x64 // I2C LCD: OLED http://www.multiwii.com/forum/viewtopic.php?f=7&t=1350
  610.  
  611.     /******************************   Logo settings     ***********************************/
  612.       //#define SUPPRESS_OLED_I2C_128x64LOGO  // suppress display of OLED logo to save memory
  613.  
  614.     /* style of display - AUTODETECTED via LCD_ setting - only activate to overwrite defaults */
  615.       //#define DISPLAY_2LINES
  616.       //#define DISPLAY_MULTILINE
  617.       //#define MULTILINE_PRE 2  // multiline configMenu # pref lines
  618.       //#define MULTILINE_POST 6 // multiline configMenu # post lines
  619.     /********************************    Navigation     ***********************************/
  620.     /* keys to navigate the LCD menu (preset to LCD_TEXTSTAR key-depress codes)*/
  621.       #define LCD_MENU_PREV 'a'
  622.       #define LCD_MENU_NEXT 'c'
  623.       #define LCD_VALUE_UP 'd'
  624.       #define LCD_VALUE_DOWN 'b'
  625.  
  626.       #define LCD_MENU_SAVE_EXIT 's'
  627.       #define LCD_MENU_ABORT 'x'
  628.  
  629.     /* To use an LCD03 for configuration:
  630.        http://www.robot-electronics.co.uk/htm/Lcd03tech.htm
  631.        Remove the jumper on its back to set i2c control.
  632.        VCC to +5V VCC (pin1 from top)
  633.        SDA - Pin A4 Mini Pro - Pin 20 Mega (pin2 from top)
  634.        SCL - Pin A5 Mini Pro - Pin 21 Mega (pin3 from top)
  635.        GND to Ground (pin4 from top)*/
  636.  
  637.     /* To use an Eagle Tree Power Panel LCD for configuration:
  638.        White wire  to Ground
  639.        Red wire    to +5V VCC (or to the WMP power pin, if you prefer to reset everything on the bus when WMP resets)
  640.        Yellow wire to SDA - Pin A4 Mini Pro - Pin 20 Mega
  641.        Brown wire  to SCL - Pin A5 Mini Pro - Pin 21 Mega */
  642.  
  643.     /* Cat's whisker LCD_TEXTSTAR LCD
  644.        Pleae note this display needs a full 4 wire connection to (+5V, Gnd, RXD, TXD )
  645.        Configure display as follows: 115K baud, and TTL levels for RXD and TXD, terminal mode
  646.        NO rx / tx line reconfiguration, use natural pins.
  647.        The four buttons sending 'A', 'B', 'C', 'D' are supported for configuration navigation and request of telemetry pages 1-4 */
  648.  
  649.  
  650.   /**************************************************************************************/
  651.   /***********************                telemetry            **************************/
  652.   /**************************************************************************************/
  653.  
  654.     /* to monitor system values (battery level, loop time etc. with LCD enable this
  655.        note: for now you must send single characters to request  different pages
  656.        Buttons toggle request for page on/off
  657.        The active page on the LCD does get updated automatically
  658.        Easy to use with Terminal application or display like LCD - if available uses the 4 preconfigured buttons  to send 'A', 'B', 'C', 'D' */
  659.     /********************************    Activation     ***********************************/
  660.     //#define LCD_TELEMETRY
  661.  
  662.     /* to enable automatic hopping between a choice of telemetry pages uncomment this.
  663.        This may be useful if your LCD has no buttons or the sending is broken
  664.        hopping is activated and deactivated in unarmed mode with throttle=low & roll=left & pitch=forward
  665.        set it to the sequence of telemetry pages you want to see
  666.        2 line displays support pages 1-9
  667.        multiline displays support pages 1-5 */
  668.     //#define LCD_TELEMETRY_AUTO "123452679" // pages 1 to 7 in ascending order
  669.     //#define LCD_TELEMETRY_AUTO  "212232425262729" // strong emphasis on page 2
  670.  
  671.     /* same as above, but manual stepping sequence; requires stick input for each stepping */
  672.     //#define LCD_TELEMETRY_STEP "0123456789" // must begin with 0
  673.  
  674.  
  675.     /* on telemetry page B (2) it gives a bar graph which shows how much voltage battery has left. Range from 0 to 12 Volt is not very informative
  676.        so we try do define a meaningful range. For a 3S battery we define full=12,6V and calculate how much it is above first warning level
  677.        Example: 12.6V - VBATLEVEL1_3S  (for me = 126 - 102 = 24) */
  678.     #define VBATREF 24
  679.  
  680.     /* if program gets too large (>32k), need to exclude some functionality
  681.        uncomment to suppress some unwanted telemetry pages (only useful if telemetry is enabled) */
  682.     //#define SUPPRESS_TELEMETRY_PAGE_1
  683.     //#define SUPPRESS_TELEMETRY_PAGE_2
  684.     //#define SUPPRESS_TELEMETRY_PAGE_3
  685.     //#define SUPPRESS_TELEMETRY_PAGE_4
  686.     //#define SUPPRESS_TELEMETRY_PAGE_5
  687.     //#define SUPPRESS_TELEMETRY_PAGE_6
  688.     //#define SUPPRESS_TELEMETRY_PAGE_7
  689.     //#define SUPPRESS_TELEMETRY_PAGE_8
  690.     //#define SUPPRESS_TELEMETRY_PAGE_9
  691.  
  692.   /********************************************************************/
  693.   /****                             Buzzer                         ****/
  694.   /********************************************************************/
  695.     //#define BUZZER
  696.     //#define RCOPTIONSBEEP        //uncomment this if you want the buzzer to beep at any rcOptions change on channel Aux1 to Aux4
  697.  
  698.   /********************************************************************/
  699.   /****           battery voltage monitoring                       ****/
  700.   /********************************************************************/
  701.     /* for V BAT monitoring
  702.        after the resistor divisor we should get [0V;5V]->[0;1023] on analog V_BATPIN
  703.        with R1=33k and R2=51k
  704.        vbat = [0;1023]*16/VBATSCALE
  705.        must be associated with #define BUZZER ! */
  706.     //#define VBAT              // uncomment this line to activate the vbat code
  707.     #define VBATSCALE     131 // change this value if readed Battery voltage is different than real voltage
  708.     #define VBATLEVEL1_3S 107 // 10,7V
  709.     #define VBATLEVEL2_3S 103 // 10,3V
  710.     #define VBATLEVEL3_3S 99  // 9.9V
  711.     #define NO_VBAT       16 // Avoid beeping without any battery
  712.  
  713.  
  714.   /********************************************************************/
  715.   /****           powermeter (battery capacity monitoring)         ****/
  716.   /********************************************************************/
  717.  
  718.     /* enable monitoring of the power consumption from battery (think of mAh)
  719.        allows to set alarm value in GUI or via LCD
  720.        Two options:
  721.        1 - soft: - (good results +-5% for plush and mystery ESCs @ 2S and 3S, not good with SuperSimple ESC
  722.             00. relies on your combo of battery type (Voltage, cpacity), ESC, ESC settings, motors, props and multiwii cycle time
  723.             01. set POWERMETER soft. Uses PLEVELSCALE = 50, PLEVELDIV = PLEVELDIVSOFT = 5000
  724.             0. output is a value that linearily scales to power (mAh)
  725.             1. get voltage reading right first
  726.             2. start with freshly charged battery
  727.             3. go fly your typical flight (routine and duration)
  728.             4. at end connect to GUI or LCD and read the power value; write it down (example 4711)
  729.             5. charge battery, write down amount of energy needed (example 722 mAh)
  730.             6. compute alarm value for desired power threshold (example 750 mAh : alarm = 4711 / 722 * 750)
  731.             7. set alarm value in GUI or LCD
  732.             8. enjoy your new battery alarm - possibly repeat steps 2 .. 7
  733.             9. if you want the numbers to represent your mAh value, you must change PLEVELDIV
  734.        2 - hard: - (uses hardware sensor, after configuration gives reasonable results
  735.             00. uses analog pin 2 to read voltage output from sensor.
  736.             01. set POWERMETER hard. Uses PLEVELSCALE = 50
  737.             02. install low path filter for 25 Hz to sensor input
  738.             03. check your average cycle time. If not close to 3ms, then you must change PLEVELDIV accordingly
  739.             1. compute PLEVELDIV for your sensor (see below for insturctions)
  740.             2. set PLEVELDIVSOFT to 5000 ( to use LOG_VALUES for individual motor comparison)
  741.             3. attach, set PSENSORNULL and  PINT2mA
  742.             4. configure, compile, upload, set alarm value in GUI or LCD
  743.             3. enjoy true readings of mAh consumed
  744.        set POWERMETER to "soft" (1) or "hard" (2) depending on sensor you want to utilize */
  745.     //#define POWERMETER_SOFT
  746.     //#define POWERMETER_HARD
  747.     /* the sum of all powermeters ranges from [0:60000 e4] theoretically.
  748.        the alarm level from eeprom is out of [0:255], so we multipy alarm level with PLEVELSCALE and with 1e4 before comparing
  749.        PLEVELSCALE is the step size you can use to set alarm */
  750.     #define PLEVELSCALE 50 // if you change this value for other granularity, you must search for comments in code to change accordingly
  751.     /* larger PLEVELDIV will get you smaller value for power (mAh equivalent) */
  752.     #define PLEVELDIV 5000 // default for soft - if you lower PLEVELDIV, beware of overrun in uint32 pMeter
  753.     #define PLEVELDIVSOFT PLEVELDIV // for soft always equal to PLEVELDIV; for hard set to 5000
  754.     //#define PLEVELDIV 1361L // to convert the sum into mAh divide by this value
  755.     /* amploc 25A sensor has 37mV/A
  756.        arduino analog resolution is 4.9mV per unit; units from [0..1023]
  757.        sampling rate 20ms, approx 19977 micro seconds
  758.        PLEVELDIV = 37 / 4.9  * 10e6 / 18000  * 3600 / 1000  = 1361L
  759.        set to analogRead() value for zero current */
  760.     #define PSENSORNULL 510 // for I=0A my sensor gives 1/2 Vss; that is approx 2.49Volt
  761.     #define PINT2mA 13 // for telemtry display: one integer step on arduino analog translates to mA (example 4.9 / 37 * 100
  762.  
  763.  
  764.  
  765.  
  766. /*************************************************************************************************/
  767. /*****************                                                                 ***************/
  768. /****************  SECTION  7 - TUNING & DEVELOPER                                  **************/
  769. /*****************                                                                 ***************/
  770. /*************************************************************************************************/
  771.  
  772.   /**************************************************************************************/
  773.   /********   special ESC with extended range [0-2000] microseconds  ********************/
  774.   /**************************************************************************************/
  775.     //#define EXT_MOTOR_RANGE
  776.  
  777.   /**************************************************************************************/
  778.   /***********************     motor, servo and other presets     ***********************/
  779.   /**************************************************************************************/
  780.     /* motors will not spin when the throttle command is in low position
  781.        this is an alternative method to stop immediately the motors */
  782.     //#define MOTOR_STOP
  783.  
  784.     /* some radios have not a neutral point centered on 1500. can be changed here */
  785.     #define MIDRC 1500
  786.  
  787.   /***********************         Servo Refreshrates            ***********************/
  788.     /* Default 50Hz Servo refresh rate*/
  789.     #define SERVO_RFR_50HZ
  790.  
  791.     /* up to 160Hz servo refreshrate .. works with the most analog servos*/
  792.     //#define SERVO_RFR_160HZ
  793.  
  794.     /* up to 300Hz refreshrate it is as fast as possible (100-300Hz depending on the cound of used servos and the servos state).
  795.        for use with digital servos
  796.        dont use it with analog servos! thay may get damage. (some will work but be careful) */
  797.     //#define SERVO_RFR_300HZ
  798.    
  799.   /***********************             HW PWM Servos             ***********************/
  800.     /* HW PWM Gimbal for Arduino Mega.. moves:
  801.       Pitch = pin 44
  802.       Roll  = pin 45
  803.       this reduces the PWM resolution for all other servos to 8 bit */
  804.     //#define MEGA_HW_GIMBAL
  805.  
  806.   /********************************************************************/
  807.   /****           IMU complimentary filter tuning                  ****/
  808.   /********************************************************************/
  809.  
  810.     /* Set the Low Pass Filter factor for ACC
  811.        Increasing this value would reduce ACC noise (visible in GUI), but would increase ACC lag time
  812.        Comment this if  you do not want filter at all.*/
  813.     //#define ACC_LPF_FACTOR 100
  814.  
  815.     /* Set the Low Pass Filter factor for Magnetometer
  816.        Increasing this value would reduce Magnetometer noise (not visible in GUI), but would increase Magnetometer lag time
  817.        Comment this if  you do not want filter at all.
  818.        Default WMC value: n/a */
  819.     //#define MG_LPF_FACTOR 4
  820.  
  821.     /* Set the Gyro Weight for Gyro/Acc complementary filter
  822.        Increasing this value would reduce and delay Acc influence on the output of the filter
  823.        Default WMC value: 300 */
  824.     //#define GYR_CMPF_FACTOR 400.0f
  825.  
  826.     /* Set the Gyro Weight for Gyro/Magnetometer complementary filter
  827.        Increasing this value would reduce and delay Magnetometer influence on the output of the filter
  828.        Default WMC value: n/a */
  829.     //#define GYR_CMPFM_FACTOR 200.0f
  830.  
  831.  
  832.   /********************************************************************/
  833.   /****           diagnostics                                      ****/
  834.   /********************************************************************/
  835.  
  836.     /* to log values like max loop time and others to come
  837.        logging values are visible via LCD config
  838.        set to 2, if you want powerconsumption on a per motor basis (this uses the big array and is a memory hog, if POWERMETER <> PM_SOFT) */
  839.     //#define LOG_VALUES 1
  840.  
  841.     /* to add debugging code
  842.        not needed and not recommended for normal operation
  843.        will add extra code that may slow down the main loop or make copter non-flyable */
  844.     //#define DEBUG
  845.  
  846.     /* Use this to trigger LCD configuration without a TX - only for debugging - do NOT fly with this activated */
  847.     //#define LCD_CONF_DEBUG
  848.  
  849.     /* Use this to trigger telemetry without a TX - only for debugging - do NOT fly with this activated */
  850.     //#define LCD_TELEMETRY_DEBUG    //This form rolls between all screens, LCD_TELEMETRY_AUTO must also be defined.
  851.     //#define LCD_TELEMETRY_DEBUG 6  //This form stays on the screen specified.
  852.  
  853.  
  854.   /********************************************************************/
  855.   /****           ESCs calibration                                 ****/
  856.   /********************************************************************/
  857.  
  858.     /* to calibrate all ESCs connected to MWii at the same time (useful to avoid unplugging/re-plugging each ESC)
  859.        Warning: this creates a special version of MultiWii Code
  860.        You cannot fly with this special version. It is only to be used for calibrating ESCs
  861.        Read How To at http://code.google.com/p/multiwii/wiki/ESCsCalibration */
  862.     #define ESC_CALIB_LOW  MINCOMMAND
  863.     #define ESC_CALIB_HIGH 2000
  864.     //#define ESC_CALIB_CANNOT_FLY  // uncomment to activate
  865.  
  866.   /****           internal frequencies                             ****/
  867.     /* frequenies for rare cyclic actions in the main loop, depend on cycle time
  868.        time base is main loop cycle time - a value of 6 means to trigger the action every 6th run through the main loop
  869.        example: with cycle time of approx 3ms, do action every 6*3ms=18ms
  870.        value must be [1; 65535] */
  871.     #define LCD_TELEMETRY_FREQ 23       // to send telemetry data over serial 23 <=> 60ms <=> 16Hz (only sending interlaced, so 8Hz update rate)
  872.     #define LCD_TELEMETRY_AUTO_FREQ 667 // to step to next telemetry page 667 <=> 2s
  873.     #define PSENSORFREQ 6               // to read hardware powermeter sensor 6 <=> 18ms
  874.     #define VBATFREQ PSENSORFREQ        // to read battery voltage - keep equal to PSENSORFREQ unless you know what you are doing
  875.  
  876.   /********************************************************************/
  877.   /****           Regression testing                               ****/
  878.   /********************************************************************/
  879.  
  880.     /* for development only:
  881.        to allow for easier and reproducable config sets for test compiling, different sets of config parameters are kept
  882.        together. This is meant to help detecting compile time errors for various features in a coordinated way.
  883.        It is not meant to produce your flying firmware
  884.        To use:
  885.        - do not set any options in config.h,
  886.        - enable with #define COPTERTEST 1, then compile
  887.        - if possible, check for the size
  888.        - repeat with other values of 2, 3, 4 etc.
  889.         */
  890.     //#define COPTERTEST 4
  891.  
  892. /*************************************************************************************************/
  893. /****           END OF CONFIGURABLE PARAMETERS                                                ****/
  894. /*************************************************************************************************/
Advertisement
Add Comment
Please, Sign In to add comment
Advertisement