Kim Youngsik / Mbed 2 deprecated 0ROBOFRIEN_FCC_v1_12

Dependencies:   mbed BufferedSerial ConfigFile

Committer:
skyyoungsik
Date:
Wed Nov 28 13:06:23 2018 +0000
Revision:
1:9530746906b6
test1

Who changed what in which revision?

UserRevisionLine numberNew contents of line
skyyoungsik 1:9530746906b6 1 #pragma once
skyyoungsik 1:9530746906b6 2
skyyoungsik 1:9530746906b6 3 #define MODEL_INFO "ROBOFRIEN FCC "
skyyoungsik 1:9530746906b6 4 #define FIRMWARE_INFO 1.01
skyyoungsik 1:9530746906b6 5
skyyoungsik 1:9530746906b6 6 #define interrupts() sei()
skyyoungsik 1:9530746906b6 7 #define noInterrupts() cli()
skyyoungsik 1:9530746906b6 8 #define TO_GCS 255
skyyoungsik 1:9530746906b6 9 #define FROM_FCS 0
skyyoungsik 1:9530746906b6 10
skyyoungsik 1:9530746906b6 11 #define PIN_ULTRA_TRIG A8
skyyoungsik 1:9530746906b6 12 #define PIN_ULTRA_ECHO A9
skyyoungsik 1:9530746906b6 13 #define AHRS_INTERRUPT_PIN A10 // use pin A10 on Arduino Uno & most boards
skyyoungsik 1:9530746906b6 14
skyyoungsik 1:9530746906b6 15
skyyoungsik 1:9530746906b6 16 //// EEPROM //////
skyyoungsik 1:9530746906b6 17 // DPN1 //
skyyoungsik 1:9530746906b6 18 #define EEPROM_MODEL_TYPE1 0
skyyoungsik 1:9530746906b6 19 #define EEPROM_MODEL_TYPE2_UP 1
skyyoungsik 1:9530746906b6 20 #define EEPROM_MODEL_TYPE2_DOWN 2
skyyoungsik 1:9530746906b6 21
skyyoungsik 1:9530746906b6 22 // DPN3 //
skyyoungsik 1:9530746906b6 23 #define EEPROM_RECV_MIN_1 30
skyyoungsik 1:9530746906b6 24 #define EEPROM_RECV_MIN_2 31
skyyoungsik 1:9530746906b6 25 #define EEPROM_RECV_MIN_3 32
skyyoungsik 1:9530746906b6 26 #define EEPROM_RECV_MIN_4 33
skyyoungsik 1:9530746906b6 27 #define EEPROM_RECV_MIN_5 34
skyyoungsik 1:9530746906b6 28 #define EEPROM_RECV_MIN_6 35
skyyoungsik 1:9530746906b6 29 #define EEPROM_RECV_MIN_7 36
skyyoungsik 1:9530746906b6 30 #define EEPROM_RECV_MIN_8 37
skyyoungsik 1:9530746906b6 31
skyyoungsik 1:9530746906b6 32 #define EEPROM_RECV_NEU_1 38
skyyoungsik 1:9530746906b6 33 #define EEPROM_RECV_NEU_2 39
skyyoungsik 1:9530746906b6 34 #define EEPROM_RECV_NEU_3 40
skyyoungsik 1:9530746906b6 35 #define EEPROM_RECV_NEU_4 41
skyyoungsik 1:9530746906b6 36 #define EEPROM_RECV_NEU_5 42
skyyoungsik 1:9530746906b6 37 #define EEPROM_RECV_NEU_6 43
skyyoungsik 1:9530746906b6 38 #define EEPROM_RECV_NEU_7 44
skyyoungsik 1:9530746906b6 39 #define EEPROM_RECV_NEU_8 45
skyyoungsik 1:9530746906b6 40
skyyoungsik 1:9530746906b6 41 #define EEPROM_RECV_MAX_1 46
skyyoungsik 1:9530746906b6 42 #define EEPROM_RECV_MAX_2 47
skyyoungsik 1:9530746906b6 43 #define EEPROM_RECV_MAX_3 48
skyyoungsik 1:9530746906b6 44 #define EEPROM_RECV_MAX_4 49
skyyoungsik 1:9530746906b6 45 #define EEPROM_RECV_MAX_5 50
skyyoungsik 1:9530746906b6 46 #define EEPROM_RECV_MAX_6 51
skyyoungsik 1:9530746906b6 47 #define EEPROM_RECV_MAX_7 52
skyyoungsik 1:9530746906b6 48 #define EEPROM_RECV_MAX_8 53
skyyoungsik 1:9530746906b6 49
skyyoungsik 1:9530746906b6 50 // DPN 4 //
skyyoungsik 1:9530746906b6 51 #define EEPROM_MOTOR_MIN_1_UP 54
skyyoungsik 1:9530746906b6 52 #define EEPROM_MOTOR_MIN_1_DOWN 55
skyyoungsik 1:9530746906b6 53 #define EEPROM_MOTOR_MIN_2_UP 56
skyyoungsik 1:9530746906b6 54 #define EEPROM_MOTOR_MIN_2_DOWN 57
skyyoungsik 1:9530746906b6 55 #define EEPROM_MOTOR_MIN_3_UP 58
skyyoungsik 1:9530746906b6 56 #define EEPROM_MOTOR_MIN_3_DOWN 59
skyyoungsik 1:9530746906b6 57 #define EEPROM_MOTOR_MIN_4_UP 60
skyyoungsik 1:9530746906b6 58 #define EEPROM_MOTOR_MIN_4_DOWN 61
skyyoungsik 1:9530746906b6 59 #define EEPROM_MOTOR_MIN_5_UP 62
skyyoungsik 1:9530746906b6 60 #define EEPROM_MOTOR_MIN_5_DOWN 63
skyyoungsik 1:9530746906b6 61 #define EEPROM_MOTOR_MIN_6_UP 64
skyyoungsik 1:9530746906b6 62 #define EEPROM_MOTOR_MIN_6_DOWN 65
skyyoungsik 1:9530746906b6 63 #define EEPROM_MOTOR_MIN_7_UP 66
skyyoungsik 1:9530746906b6 64 #define EEPROM_MOTOR_MIN_7_DOWN 67
skyyoungsik 1:9530746906b6 65 #define EEPROM_MOTOR_MIN_8_UP 68
skyyoungsik 1:9530746906b6 66 #define EEPROM_MOTOR_MIN_8_DOWN 69
skyyoungsik 1:9530746906b6 67
skyyoungsik 1:9530746906b6 68 // DPN 5 //
skyyoungsik 1:9530746906b6 69 #define EEPROM_HEADLIGHT_PERIOD 70
skyyoungsik 1:9530746906b6 70 #define EEPROM_HEADLIGHT_DUTYRATE 71
skyyoungsik 1:9530746906b6 71 #define EEPROM_SIDELIGHT_PERIOD 72
skyyoungsik 1:9530746906b6 72 #define EEPROM_SIDELIGHT_DUTYRATE 73
skyyoungsik 1:9530746906b6 73
skyyoungsik 1:9530746906b6 74 // DPN 6 //
skyyoungsik 1:9530746906b6 75 #define EEPROM_AHRS_ROLL_GAP_UP 74
skyyoungsik 1:9530746906b6 76 #define EEPROM_AHRS_ROLL_GAP_DOWN 75
skyyoungsik 1:9530746906b6 77 #define EEPROM_AHRS_PITCH_GAP_UP 76
skyyoungsik 1:9530746906b6 78 #define EEPROM_AHRS_PITCH_GAP_DOWN 77
skyyoungsik 1:9530746906b6 79 #define EEPROM_AHRS_YAW_GAP_UP 78
skyyoungsik 1:9530746906b6 80 #define EEPROM_AHRS_YAW_GAP_DOWN 79
skyyoungsik 1:9530746906b6 81
skyyoungsik 1:9530746906b6 82
skyyoungsik 1:9530746906b6 83 #define EEPROM_AHRS_YAW_X_GAP_1 80
skyyoungsik 1:9530746906b6 84 #define EEPROM_AHRS_YAW_X_GAP_2 81
skyyoungsik 1:9530746906b6 85 #define EEPROM_AHRS_YAW_Y_GAP_1 82
skyyoungsik 1:9530746906b6 86 #define EEPROM_AHRS_YAW_Y_GAP_2 83
skyyoungsik 1:9530746906b6 87 #define EEPROM_AHRS_YAW_Z_GAP_1 84
skyyoungsik 1:9530746906b6 88 #define EEPROM_AHRS_YAW_Z_GAP_2 85
skyyoungsik 1:9530746906b6 89
skyyoungsik 1:9530746906b6 90 #define EEPROM_AHRS_DECLINATION_ANGLE_UP 86
skyyoungsik 1:9530746906b6 91 #define EEPROM_AHRS_DECLINATION_ANGLE_DOWN 87
skyyoungsik 1:9530746906b6 92
skyyoungsik 1:9530746906b6 93 // DPN 7 //
skyyoungsik 1:9530746906b6 94 #define EEPROM_LIMIT_ANGLE_ROLL_UP 88
skyyoungsik 1:9530746906b6 95 #define EEPROM_LIMIT_ANGLE_ROLL_DOWN 89
skyyoungsik 1:9530746906b6 96 #define EEPROM_LIMIT_ANGLE_PITCH_UP 90
skyyoungsik 1:9530746906b6 97 #define EEPROM_LIMIT_ANGLE_PITCH_DOWN 91
skyyoungsik 1:9530746906b6 98 #define EEPROM_LIMIT_RATE_ROLL_UP 92
skyyoungsik 1:9530746906b6 99 #define EEPROM_LIMIT_RATE_ROLL_DOWN 93
skyyoungsik 1:9530746906b6 100 #define EEPROM_LIMIT_RATE_PITCH_UP 94
skyyoungsik 1:9530746906b6 101 #define EEPROM_LIMIT_RATE_PITCH_DOWN 95
skyyoungsik 1:9530746906b6 102 #define EEPROM_LIMIT_RATE_YAW_UP 96
skyyoungsik 1:9530746906b6 103 #define EEPROM_LIMIT_RATE_YAW_DOWN 97
skyyoungsik 1:9530746906b6 104
skyyoungsik 1:9530746906b6 105 // DPN 8 //
skyyoungsik 1:9530746906b6 106 // --Gain 1 //
skyyoungsik 1:9530746906b6 107 int EEPROM_GAIN_P_UP[20] = {100,101,102,103,104,105,106,107,108,109,110,111,112,113,114,115,116,117,118,119};
skyyoungsik 1:9530746906b6 108 int EEPROM_GAIN_P_DOWN[20] = {120,121,122,123,124,125,126,127,128,129,130,131,132,133,134,135,136,137,138,139};
skyyoungsik 1:9530746906b6 109 int EEPROM_GAIN_D_UP[20] = {140,141,142,143,144,145,146,147,148,149,150,151,152,153,154,155,156,157,158,159};
skyyoungsik 1:9530746906b6 110 int EEPROM_GAIN_D_DOWN[20] = {160,161,162,163,164,165,166,167,168,169,170,171,172,173,174,175,176,177,178,179};
skyyoungsik 1:9530746906b6 111 int EEPROM_GAIN_I_UP[20] = {180,181,182,183,184,185,186,187,188,189,190,191,192,193,194,195,196,197,198,199};
skyyoungsik 1:9530746906b6 112 int EEPROM_GAIN_I_DOWN[20] = {200,201,202,203,204,205,206,207,208,209,210,211,212,213,214,215,216,217,218,219};
skyyoungsik 1:9530746906b6 113
skyyoungsik 1:9530746906b6 114