a

Dependencies:   HCSR04_2 MPU6050_2 mbed SDFileSystem3

Fork of Autoflight2018_4 by 航空研究会

config/falfalla.h

Committer:
HARUKIDELTA
Date:
2018-09-12
Revision:
3:954228fd64b3
Parent:
1:f383708a5a52

File content as of revision 3:954228fd64b3:

#ifndef FALFALLA_H
#define FALFALLA_H

#define SWITCH_CHECK 1400
#define NUMBER_FALFALLA 2 //何号機かを入れるとそれに応じて#if以下が変わって設定が変わる

static float g_kpELE=2.0;
static float g_kiELE=0.0;
static float g_kdELE=0.0;
static float g_kpRUD=3.0;
static float g_kiRUD=0.0;
static float g_kdRUD=0.0;
static float g_kpAIL=3.0;
static float g_kiAIL=0.0;
static float g_kdAIL=0.0;

static float g_rightloopROLL=0.0;
static float g_rightloopPITCH=-6.3;
static float g_leftloopROLL=16.0;
static float g_leftloopPITCH=-6.0;
static float g_gostraightROLL=2.0;
static float g_gostraightPITCH=-3.0;
static float g_takeoffTHR=1.0;
static float g_loopTHR=0.58;

static float g_rightloopROLLshort=-20.0;
static float g_rightloopPITCHshort=-7.0;
static float g_leftloopROLLshort=22.0;
static float g_leftloopPITCHshort=-6.0;

static float g_glideloopROLL = -5.0;      //rewrite
static float g_glideloopPITCH = 0.0;

#if NUMBER_FALFALLA == 1    //1号機

const int16_t Trim_Falfalla[4] = {-155,120,0,-240};//{0,14,-100,-10};
const float ExpMax_Falfalla[4] = {100,115,100,89};
const float ExpMin_Falfalla[4] = {100,47,100,110};
const int8_t Reverce_falfalla[4] = {-1,-1,1,1};   //Nutral:1 , Reverce:-1

#elif NUMBER_FALFALLA == 2  //2号機

const int16_t Trim_Falfalla[6] = {135,240,0,-240,240,-130};//{0,12,0,2};    
const float ExpMax_Falfalla[4] = {100,115,100,103};
const float ExpMin_Falfalla[4] = {100,97,100,97};
const int16_t Reverce_falfalla[4] = {1,-1,1,-1};   //Nutral:1 , Reverce:-1


#endif


#endif /* ESTRELA_H_ */

/*
x軸回り    ロール
y軸回り    ピッチ
z軸回り    ヨー
*/