Kim Youngsik / Mbed 2 deprecated 0ROBOFRIEN_FCC_v1_12

Dependencies:   mbed BufferedSerial ConfigFile

Committer:
skyyoungsik
Date:
Tue Jun 12 01:05:50 2018 +0000
Revision:
0:3473b92e991e
lkj;

Who changed what in which revision?

UserRevisionLine numberNew contents of line
skyyoungsik 0:3473b92e991e 1 #pragma once
skyyoungsik 0:3473b92e991e 2
skyyoungsik 0:3473b92e991e 3 #define MODEL_INFO "ROBOFRIEN FCC "
skyyoungsik 0:3473b92e991e 4 #define FIRMWARE_INFO 1.01
skyyoungsik 0:3473b92e991e 5
skyyoungsik 0:3473b92e991e 6 #define interrupts() sei()
skyyoungsik 0:3473b92e991e 7 #define noInterrupts() cli()
skyyoungsik 0:3473b92e991e 8 #define TO_GCS 255
skyyoungsik 0:3473b92e991e 9 #define FROM_FCS 0
skyyoungsik 0:3473b92e991e 10
skyyoungsik 0:3473b92e991e 11 #define PIN_ULTRA_TRIG A8
skyyoungsik 0:3473b92e991e 12 #define PIN_ULTRA_ECHO A9
skyyoungsik 0:3473b92e991e 13 #define AHRS_INTERRUPT_PIN A10 // use pin A10 on Arduino Uno & most boards
skyyoungsik 0:3473b92e991e 14
skyyoungsik 0:3473b92e991e 15
skyyoungsik 0:3473b92e991e 16 //// EEPROM //////
skyyoungsik 0:3473b92e991e 17 // DPN1 //
skyyoungsik 0:3473b92e991e 18 #define EEPROM_MODEL_TYPE1 0
skyyoungsik 0:3473b92e991e 19 #define EEPROM_MODEL_TYPE2_UP 1
skyyoungsik 0:3473b92e991e 20 #define EEPROM_MODEL_TYPE2_DOWN 2
skyyoungsik 0:3473b92e991e 21
skyyoungsik 0:3473b92e991e 22 // DPN3 //
skyyoungsik 0:3473b92e991e 23 #define EEPROM_RECV_MIN_1 30
skyyoungsik 0:3473b92e991e 24 #define EEPROM_RECV_MIN_2 31
skyyoungsik 0:3473b92e991e 25 #define EEPROM_RECV_MIN_3 32
skyyoungsik 0:3473b92e991e 26 #define EEPROM_RECV_MIN_4 33
skyyoungsik 0:3473b92e991e 27 #define EEPROM_RECV_MIN_5 34
skyyoungsik 0:3473b92e991e 28 #define EEPROM_RECV_MIN_6 35
skyyoungsik 0:3473b92e991e 29 #define EEPROM_RECV_MIN_7 36
skyyoungsik 0:3473b92e991e 30 #define EEPROM_RECV_MIN_8 37
skyyoungsik 0:3473b92e991e 31
skyyoungsik 0:3473b92e991e 32 #define EEPROM_RECV_NEU_1 38
skyyoungsik 0:3473b92e991e 33 #define EEPROM_RECV_NEU_2 39
skyyoungsik 0:3473b92e991e 34 #define EEPROM_RECV_NEU_3 40
skyyoungsik 0:3473b92e991e 35 #define EEPROM_RECV_NEU_4 41
skyyoungsik 0:3473b92e991e 36 #define EEPROM_RECV_NEU_5 42
skyyoungsik 0:3473b92e991e 37 #define EEPROM_RECV_NEU_6 43
skyyoungsik 0:3473b92e991e 38 #define EEPROM_RECV_NEU_7 44
skyyoungsik 0:3473b92e991e 39 #define EEPROM_RECV_NEU_8 45
skyyoungsik 0:3473b92e991e 40
skyyoungsik 0:3473b92e991e 41 #define EEPROM_RECV_MAX_1 46
skyyoungsik 0:3473b92e991e 42 #define EEPROM_RECV_MAX_2 47
skyyoungsik 0:3473b92e991e 43 #define EEPROM_RECV_MAX_3 48
skyyoungsik 0:3473b92e991e 44 #define EEPROM_RECV_MAX_4 49
skyyoungsik 0:3473b92e991e 45 #define EEPROM_RECV_MAX_5 50
skyyoungsik 0:3473b92e991e 46 #define EEPROM_RECV_MAX_6 51
skyyoungsik 0:3473b92e991e 47 #define EEPROM_RECV_MAX_7 52
skyyoungsik 0:3473b92e991e 48 #define EEPROM_RECV_MAX_8 53
skyyoungsik 0:3473b92e991e 49
skyyoungsik 0:3473b92e991e 50 // DPN 4 //
skyyoungsik 0:3473b92e991e 51 #define EEPROM_MOTOR_MIN_1_UP 54
skyyoungsik 0:3473b92e991e 52 #define EEPROM_MOTOR_MIN_1_DOWN 55
skyyoungsik 0:3473b92e991e 53 #define EEPROM_MOTOR_MIN_2_UP 56
skyyoungsik 0:3473b92e991e 54 #define EEPROM_MOTOR_MIN_2_DOWN 57
skyyoungsik 0:3473b92e991e 55 #define EEPROM_MOTOR_MIN_3_UP 58
skyyoungsik 0:3473b92e991e 56 #define EEPROM_MOTOR_MIN_3_DOWN 59
skyyoungsik 0:3473b92e991e 57 #define EEPROM_MOTOR_MIN_4_UP 60
skyyoungsik 0:3473b92e991e 58 #define EEPROM_MOTOR_MIN_4_DOWN 61
skyyoungsik 0:3473b92e991e 59 #define EEPROM_MOTOR_MIN_5_UP 62
skyyoungsik 0:3473b92e991e 60 #define EEPROM_MOTOR_MIN_5_DOWN 63
skyyoungsik 0:3473b92e991e 61 #define EEPROM_MOTOR_MIN_6_UP 64
skyyoungsik 0:3473b92e991e 62 #define EEPROM_MOTOR_MIN_6_DOWN 65
skyyoungsik 0:3473b92e991e 63 #define EEPROM_MOTOR_MIN_7_UP 66
skyyoungsik 0:3473b92e991e 64 #define EEPROM_MOTOR_MIN_7_DOWN 67
skyyoungsik 0:3473b92e991e 65 #define EEPROM_MOTOR_MIN_8_UP 68
skyyoungsik 0:3473b92e991e 66 #define EEPROM_MOTOR_MIN_8_DOWN 69
skyyoungsik 0:3473b92e991e 67
skyyoungsik 0:3473b92e991e 68 // DPN 5 //
skyyoungsik 0:3473b92e991e 69 #define EEPROM_HEADLIGHT_PERIOD 70
skyyoungsik 0:3473b92e991e 70 #define EEPROM_HEADLIGHT_DUTYRATE 71
skyyoungsik 0:3473b92e991e 71 #define EEPROM_SIDELIGHT_PERIOD 72
skyyoungsik 0:3473b92e991e 72 #define EEPROM_SIDELIGHT_DUTYRATE 73
skyyoungsik 0:3473b92e991e 73
skyyoungsik 0:3473b92e991e 74 // DPN 6 //
skyyoungsik 0:3473b92e991e 75 #define EEPROM_AHRS_ROLL_GAP_UP 74
skyyoungsik 0:3473b92e991e 76 #define EEPROM_AHRS_ROLL_GAP_DOWN 75
skyyoungsik 0:3473b92e991e 77 #define EEPROM_AHRS_PITCH_GAP_UP 76
skyyoungsik 0:3473b92e991e 78 #define EEPROM_AHRS_PITCH_GAP_DOWN 77
skyyoungsik 0:3473b92e991e 79 #define EEPROM_AHRS_YAW_GAP_UP 78
skyyoungsik 0:3473b92e991e 80 #define EEPROM_AHRS_YAW_GAP_DOWN 79
skyyoungsik 0:3473b92e991e 81
skyyoungsik 0:3473b92e991e 82
skyyoungsik 0:3473b92e991e 83 #define EEPROM_AHRS_YAW_X_GAP_1 80
skyyoungsik 0:3473b92e991e 84 #define EEPROM_AHRS_YAW_X_GAP_2 81
skyyoungsik 0:3473b92e991e 85 #define EEPROM_AHRS_YAW_Y_GAP_1 82
skyyoungsik 0:3473b92e991e 86 #define EEPROM_AHRS_YAW_Y_GAP_2 83
skyyoungsik 0:3473b92e991e 87 #define EEPROM_AHRS_YAW_Z_GAP_1 84
skyyoungsik 0:3473b92e991e 88 #define EEPROM_AHRS_YAW_Z_GAP_2 85
skyyoungsik 0:3473b92e991e 89
skyyoungsik 0:3473b92e991e 90 #define EEPROM_AHRS_DECLINATION_ANGLE_UP 86
skyyoungsik 0:3473b92e991e 91 #define EEPROM_AHRS_DECLINATION_ANGLE_DOWN 87
skyyoungsik 0:3473b92e991e 92
skyyoungsik 0:3473b92e991e 93 // DPN 7 //
skyyoungsik 0:3473b92e991e 94 #define EEPROM_LIMIT_ANGLE_ROLL_UP 88
skyyoungsik 0:3473b92e991e 95 #define EEPROM_LIMIT_ANGLE_ROLL_DOWN 89
skyyoungsik 0:3473b92e991e 96 #define EEPROM_LIMIT_ANGLE_PITCH_UP 90
skyyoungsik 0:3473b92e991e 97 #define EEPROM_LIMIT_ANGLE_PITCH_DOWN 91
skyyoungsik 0:3473b92e991e 98 #define EEPROM_LIMIT_RATE_ROLL_UP 92
skyyoungsik 0:3473b92e991e 99 #define EEPROM_LIMIT_RATE_ROLL_DOWN 93
skyyoungsik 0:3473b92e991e 100 #define EEPROM_LIMIT_RATE_PITCH_UP 94
skyyoungsik 0:3473b92e991e 101 #define EEPROM_LIMIT_RATE_PITCH_DOWN 95
skyyoungsik 0:3473b92e991e 102 #define EEPROM_LIMIT_RATE_YAW_UP 96
skyyoungsik 0:3473b92e991e 103 #define EEPROM_LIMIT_RATE_YAW_DOWN 97
skyyoungsik 0:3473b92e991e 104
skyyoungsik 0:3473b92e991e 105 // DPN 8 //
skyyoungsik 0:3473b92e991e 106 // --Gain 1 //
skyyoungsik 0:3473b92e991e 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 0:3473b92e991e 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 0:3473b92e991e 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 0:3473b92e991e 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 0:3473b92e991e 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 0:3473b92e991e 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 0:3473b92e991e 113
skyyoungsik 0:3473b92e991e 114
skyyoungsik 0:3473b92e991e 115 const int PIN_BLDC_PWM1 = 46; // PL3 //
skyyoungsik 0:3473b92e991e 116 const int PIN_BLDC_PWM2 = 45; // PL4 //
skyyoungsik 0:3473b92e991e 117 const int PIN_BLDC_PWM3 = 44; // PL5 //
skyyoungsik 0:3473b92e991e 118 const int PIN_BLDC_PWM4 = 10; // PB4 //
skyyoungsik 0:3473b92e991e 119 const int PIN_BLDC_PWM5 = 9; // PH6 //