s

Dependencies:   HCSR04_2 MPU6050_2 mbed SDFileSystem3

Fork of AutoFlight2017_now_copy by Bot Furukawa

Committer:
TUATBM
Date:
Sat Sep 08 09:21:46 2018 +0000
Revision:
2:e7025f2cf0e1
Parent:
1:f31e17341659
a

Who changed what in which revision?

UserRevisionLine numberNew contents of line
TUATBM 1:f31e17341659 1 #ifndef FALFALLA_H
TUATBM 1:f31e17341659 2 #define FALFALLA_H
TUATBM 0:92024886c0be 3
TUATBM 1:f31e17341659 4 #define SWITCH_CHECK 1400
TUATBM 1:f31e17341659 5 #define NUMBER_FALFALLA 2 //何号機かを入れるとそれに応じて#if以下が変わって設定が変わる
TUATBM 0:92024886c0be 6
TUATBM 1:f31e17341659 7 static float g_kpELE=2.0;
TUATBM 1:f31e17341659 8 static float g_kiELE=0.0;
TUATBM 1:f31e17341659 9 static float g_kdELE=0.0;
TUATBM 1:f31e17341659 10 static float g_kpRUD=3.0;
TUATBM 1:f31e17341659 11 static float g_kiRUD=0.0;
TUATBM 1:f31e17341659 12 static float g_kdRUD=0.0;
TUATBM 0:92024886c0be 13
TUATBM 1:f31e17341659 14 static float g_rightloopROLL=-17.0;
TUATBM 1:f31e17341659 15 static float g_rightloopPITCH=-6.3;
TUATBM 1:f31e17341659 16 static float g_leftloopROLL=16.0;
TUATBM 1:f31e17341659 17 static float g_leftloopPITCH=-6.0;
TUATBM 1:f31e17341659 18 static float g_gostraightROLL=2.0;
TUATBM 1:f31e17341659 19 static float g_gostraightPITCH=-3.0;
TUATBM 1:f31e17341659 20 static float g_takeoffTHR=1.0;
TUATBM 1:f31e17341659 21 static float g_loopTHR=0.58;
TUATBM 0:92024886c0be 22
TUATBM 1:f31e17341659 23 static float g_rightloopROLLshort=-20.0;
TUATBM 1:f31e17341659 24 static float g_rightloopPITCHshort=-7.0;
TUATBM 1:f31e17341659 25 static float g_leftloopROLLshort=22.0;
TUATBM 1:f31e17341659 26 static float g_leftloopPITCHshort=-6.0;
TUATBM 1:f31e17341659 27
TUATBM 2:e7025f2cf0e1 28 static float g_glideloopROLL = -5.0;
TUATBM 1:f31e17341659 29 static float g_glideloopPITCH = 0.0;
TUATBM 1:f31e17341659 30
TUATBM 1:f31e17341659 31 #if NUMBER_FALFALLA == 1 //1号機
TUATBM 0:92024886c0be 32
TUATBM 1:f31e17341659 33 const int16_t Trim_Falfalla[4] = {0,14,-100,-10};
TUATBM 1:f31e17341659 34 const float ExpMax_Falfalla[4] = {100,115,100,89};
TUATBM 1:f31e17341659 35 const float ExpMin_Falfalla[4] = {100,47,100,110};
TUATBM 1:f31e17341659 36 const int8_t Reverce_falfalla[4] = {1,-1,1,1}; //Nutral:1 , Reverce:-1
TUATBM 0:92024886c0be 37
TUATBM 1:f31e17341659 38 #elif NUMBER_FALFALLA == 2 //2号機
TUATBM 1:f31e17341659 39
TUATBM 1:f31e17341659 40 const int16_t Trim_Falfalla[4] = {0,12,-100,2};
TUATBM 1:f31e17341659 41 const float ExpMax_Falfalla[4] = {100,115,100,103};
TUATBM 1:f31e17341659 42 const float ExpMin_Falfalla[4] = {100,97,100,97};
TUATBM 1:f31e17341659 43 const int16_t Reverce_falfalla[4] = {1,-1,1,-1}; //Nutral:1 , Reverce:-1
TUATBM 0:92024886c0be 44
TUATBM 0:92024886c0be 45
TUATBM 1:f31e17341659 46 #endif
TUATBM 0:92024886c0be 47
TUATBM 0:92024886c0be 48
TUATBM 0:92024886c0be 49 #endif /* ESTRELA_H_ */
TUATBM 0:92024886c0be 50
TUATBM 0:92024886c0be 51 /*
TUATBM 0:92024886c0be 52 x軸回り ロール
TUATBM 0:92024886c0be 53 y軸回り ピッチ
TUATBM 0:92024886c0be 54 z軸回り ヨー
TUATBM 0:92024886c0be 55 */