Important changes to repositories hosted on mbed.com
Mbed hosted mercurial repositories are deprecated and are due to be permanently deleted in July 2026.
To keep a copy of this software download the repository Zip archive or clone locally using Mercurial.
It is also possible to export all your personal repositories from the account settings page.
Dependencies: mbed BufferedSerial ConfigFile
ROBOFRIEN_SUB_FUNC/Config.h@0:3473b92e991e, 2018-06-12 (annotated)
- Committer:
- skyyoungsik
- Date:
- Tue Jun 12 01:05:50 2018 +0000
- Revision:
- 0:3473b92e991e
lkj;
Who changed what in which revision?
User | Revision | Line number | New 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 // |