航空研究会 / Mbed 2 deprecated Autoflight2018_54

フェイルセーフ完成版

Dependencies:   HCSR04_2 MPU6050_2 mbed SDFileSystem3

Fork of Autoflight2018_53 by 航空研究会

config/falfalla.h@13:77b13d5f4d78, 2018-09-16 (annotated)

Committer:
HARUKIDELTA
Date:
Sun Sep 16 07:59:29 2018 +0000
Revision:
13:77b13d5f4d78
Parent:
1:f383708a5a52
Child:
15:43427b0241d9
16:59;

Who changed what in which revision?

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