Sungwoo Kim / Mbed 2 deprecated HydraulicControlBoard_Rainbow_v1_2_copy

2011

Dependencies:   mbed FastPWM

setting.h@228:fb5b57e3f157, 2022-04-05 (annotated)

Committer:
Lightvalve
Date:
Tue Apr 05 05:12:12 2022 +0000
Revision:
228:fb5b57e3f157
Parent:
227:8ac5c6162bc1
Child:
229:27eca07c9591
220405

Who changed what in which revision?

UserRevisionLine numberNew contents of line
GiJeongKim 0:51c43836c1d7 1 #include "mbed.h"
GiJeongKim 0:51c43836c1d7 2 #include "FastPWM.h"
GiJeongKim 0:51c43836c1d7 3
GiJeongKim 0:51c43836c1d7 4 // pwm
jobuuu 2:a1c0a37df760 5 #define PIN_V PB_7
jobuuu 2:a1c0a37df760 6 #define PIN_W PB_6
Lightvalve 212:985dba42f261 7 //#define PWM_ARR 0x465 // loop 80k, pwm 40k
jobuuu 2:a1c0a37df760 8 //#define PWM_ARR 0x8CA // loop 40k, pwm 20k
Lightvalve 228:fb5b57e3f157 9 #define PWM_ARR 0x1194 // loop 20k, pwm 10k 원래이거
Lightvalve 212:985dba42f261 10 //#define PWM_ARR 0x2328 // loop 10k, pwm 5k
Lightvalve 228:fb5b57e3f157 11 //#define PWM_ARR 0xAFC8 // loop 2 k, pwm 1k
Lightvalve 228:fb5b57e3f157 12
Lightvalve 228:fb5b57e3f157 13 #define TMR3_COUNT 0xAFC8 // loop 2 k, pwm 1k
Lightvalve 228:fb5b57e3f157 14 //#define TMR2_COUNT 0x2710 // loop 500hz with prescale 18
Lightvalve 228:fb5b57e3f157 15 #define TMR2_COUNT 0x4650 // loop 5 k
jobuuu 2:a1c0a37df760 16
Lightvalve 30:8d561f16383b 17 #define FREQ_500 500.0f
Lightvalve 30:8d561f16383b 18 #define FREQ_1k 1000.0f
Lightvalve 30:8d561f16383b 19 #define FREQ_5k 5000.0f
Lightvalve 30:8d561f16383b 20 #define FREQ_10k 10000.0f
Lightvalve 30:8d561f16383b 21 #define FREQ_20k 20000.0f
Lightvalve 30:8d561f16383b 22 #define FREQ_40k 40000.0f
Lightvalve 30:8d561f16383b 23 #define DT_500 0.002f
jobuuu 218:2c3e5ecbe7e1 24 #define DT_1k 0.001f
Lightvalve 30:8d561f16383b 25 #define DT_5k 0.0002f
Lightvalve 30:8d561f16383b 26 #define DT_10k 0.0001f
Lightvalve 30:8d561f16383b 27 #define DT_20k 0.00005f
Lightvalve 30:8d561f16383b 28 #define DT_40k 0.000025f
jobuuu 5:a4319f79457b 29
jobuuu 218:2c3e5ecbe7e1 30 //#define TMR_FREQ_10k 10000
jobuuu 218:2c3e5ecbe7e1 31 #define TMR_FREQ_5k 5000
jobuuu 218:2c3e5ecbe7e1 32
jobuuu 7:e9086c72bb22 33 extern DigitalOut check;
jobuuu 7:e9086c72bb22 34 extern DigitalOut check_2;
jobuuu 7:e9086c72bb22 35 extern AnalogOut dac_1;
jobuuu 7:e9086c72bb22 36 extern AnalogOut dac_2;
jobuuu 7:e9086c72bb22 37
Lightvalve 30:8d561f16383b 38 extern float dtc_v;
Lightvalve 30:8d561f16383b 39 extern float dtc_w;
GiJeongKim 0:51c43836c1d7 40
GiJeongKim 0:51c43836c1d7 41 // I2C
GiJeongKim 0:51c43836c1d7 42 extern I2C i2c; // SDA, SCL (for K22F)
GiJeongKim 0:51c43836c1d7 43 extern const int i2c_slave_addr1;
GiJeongKim 0:51c43836c1d7 44 extern unsigned int value; // 10bit output of reading sensor AS5510
GiJeongKim 0:51c43836c1d7 45
GiJeongKim 0:51c43836c1d7 46 // SPI
Lightvalve 165:42c938a40313 47 extern SPI eeprom; //(SPI_MOSI, SPI_MISO, SPI_SCK);
Lightvalve 165:42c938a40313 48 extern DigitalOut eeprom_cs;
GiJeongKim 0:51c43836c1d7 49 extern SPI enc;
GiJeongKim 0:51c43836c1d7 50 extern DigitalOut enc_cs;
GiJeongKim 0:51c43836c1d7 51
GiJeongKim 0:51c43836c1d7 52 // UART
jobuuu 7:e9086c72bb22 53 extern Serial pc; //Serial pc(PA_9,PA_10); _ UART
jobuuu 7:e9086c72bb22 54
jobuuu 7:e9086c72bb22 55 // CAN
jobuuu 7:e9086c72bb22 56 extern CAN can;
jobuuu 7:e9086c72bb22 57 extern CANMessage msg;
jobuuu 7:e9086c72bb22 58
jobuuu 7:e9086c72bb22 59 // Board Information
jobuuu 7:e9086c72bb22 60
jobuuu 7:e9086c72bb22 61
jobuuu 7:e9086c72bb22 62 // User Function
jobuuu 7:e9086c72bb22 63 void CurrentControl();
jobuuu 7:e9086c72bb22 64 void ValveControl(unsigned int ControlMode);
Lightvalve 11:82d8768d7351 65
Lightvalve 11:82d8768d7351 66
Lightvalve 11:82d8768d7351 67 /*******************************************************************************
Lightvalve 11:82d8768d7351 68 * COMMON Settings
Lightvalve 11:82d8768d7351 69 ******************************************************************************/
Lightvalve 11:82d8768d7351 70 #define LATEST_VERSION 19032
Lightvalve 11:82d8768d7351 71
Lightvalve 11:82d8768d7351 72
Lightvalve 11:82d8768d7351 73 /*******************************************************************************
Lightvalve 11:82d8768d7351 74 * COMMON CONSTANTS
Lightvalve 11:82d8768d7351 75 ******************************************************************************/
Lightvalve 30:8d561f16383b 76 #define RAD_30 0.523598775598299f
Lightvalve 30:8d561f16383b 77 #define RAD_60 1.047197551196598f
Lightvalve 30:8d561f16383b 78 #define RAD_120 2.094395102393195f
Lightvalve 30:8d561f16383b 79 #define RAD_180 3.141592653589793f
Lightvalve 30:8d561f16383b 80 #define RAD_240 4.188790204786391f
Lightvalve 30:8d561f16383b 81 #define RAD_300 5.235987755982989f
Lightvalve 30:8d561f16383b 82 #define RAD_360 6.283185307179586f
Lightvalve 11:82d8768d7351 83
Lightvalve 11:82d8768d7351 84 #define SYSFREQ 200000000
Lightvalve 11:82d8768d7351 85 #define PBCLK 100000000
Lightvalve 11:82d8768d7351 86
Lightvalve 11:82d8768d7351 87 #define FALSE 0
Lightvalve 11:82d8768d7351 88 #define TRUE 1
Lightvalve 11:82d8768d7351 89 #define OUTPUT 0
Lightvalve 11:82d8768d7351 90 #define INPUT 1
Lightvalve 11:82d8768d7351 91 #define LOW 0
Lightvalve 11:82d8768d7351 92 #define HIGH 1
Lightvalve 11:82d8768d7351 93 #define DIGITAL 0
Lightvalve 11:82d8768d7351 94 #define ANALOG 1
Lightvalve 11:82d8768d7351 95
Lightvalve 30:8d561f16383b 96 #define PI 3.141592653589793f
Lightvalve 30:8d561f16383b 97 #define D2R 0.017453292519943f
Lightvalve 30:8d561f16383b 98 #define R2D 57.295779513082323f
Lightvalve 11:82d8768d7351 99
Lightvalve 11:82d8768d7351 100
Lightvalve 11:82d8768d7351 101 /*******************************************************************************
Lightvalve 11:82d8768d7351 102 * HEADER INCLUDE
Lightvalve 11:82d8768d7351 103 ******************************************************************************/
Lightvalve 11:82d8768d7351 104
Lightvalve 11:82d8768d7351 105 /*******************************************************************************
Lightvalve 11:82d8768d7351 106 * VARIABLE
Lightvalve 11:82d8768d7351 107 ******************************************************************************/
Lightvalve 11:82d8768d7351 108
Lightvalve 11:82d8768d7351 109 // Board Information
Lightvalve 11:82d8768d7351 110 extern uint8_t BNO;
Lightvalve 11:82d8768d7351 111 extern uint8_t CONTROL_MODE;
Lightvalve 11:82d8768d7351 112 extern uint8_t OPERATING_MODE;
Lightvalve 51:8ea76864368a 113 extern uint8_t SENSING_MODE;
jobuuu 218:2c3e5ecbe7e1 114 extern uint8_t SUPPLY_PRESSURE_UPDATE;
jobuuu 218:2c3e5ecbe7e1 115
Lightvalve 55:f4819de54e7a 116 extern uint8_t CONTROL_UTILITY_MODE;
Lightvalve 51:8ea76864368a 117 extern uint8_t CURRENT_CONTROL_MODE;
Lightvalve 51:8ea76864368a 118 extern uint8_t FLAG_VALVE_DEADZONE;
Lightvalve 11:82d8768d7351 119 extern uint8_t REFERENCE_MODE;
Lightvalve 52:647072f5307a 120 extern int16_t CAN_FREQ;
Lightvalve 17:1865016ca2e7 121 extern int16_t DIR_JOINT_ENC;
Lightvalve 17:1865016ca2e7 122 extern int16_t DIR_VALVE;
Lightvalve 17:1865016ca2e7 123 extern int16_t DIR_VALVE_ENC;
Lightvalve 11:82d8768d7351 124
Lightvalve 30:8d561f16383b 125 extern float SUPPLY_VOLTAGE;
Lightvalve 30:8d561f16383b 126 extern float VALVE_VOLTAGE_LIMIT;
Lightvalve 11:82d8768d7351 127
Lightvalve 30:8d561f16383b 128 extern float P_GAIN_VALVE_POSITION;
Lightvalve 30:8d561f16383b 129 extern float I_GAIN_VALVE_POSITION;
Lightvalve 30:8d561f16383b 130 extern float D_GAIN_VALVE_POSITION;
Lightvalve 30:8d561f16383b 131 extern float P_GAIN_JOINT_POSITION;
Lightvalve 30:8d561f16383b 132 extern float I_GAIN_JOINT_POSITION;
Lightvalve 30:8d561f16383b 133 extern float D_GAIN_JOINT_POSITION;
Lightvalve 30:8d561f16383b 134 extern float P_GAIN_JOINT_TORQUE;
Lightvalve 30:8d561f16383b 135 extern float I_GAIN_JOINT_TORQUE;
Lightvalve 30:8d561f16383b 136 extern float D_GAIN_JOINT_TORQUE;
Lightvalve 70:3436ce769b1e 137 extern float P_GAIN_JOINT_TORQUE_FF;
Lightvalve 70:3436ce769b1e 138 extern float I_GAIN_JOINT_TORQUE_FF;
Lightvalve 70:3436ce769b1e 139 extern float D_GAIN_JOINT_TORQUE_FF;
Lightvalve 11:82d8768d7351 140
Lightvalve 45:2694daea349b 141 extern int16_t K_SPRING;
Lightvalve 45:2694daea349b 142 extern int16_t D_DAMPER;
Lightvalve 45:2694daea349b 143
Lightvalve 52:647072f5307a 144 extern int16_t flag_delay_test;
Lightvalve 52:647072f5307a 145
Lightvalve 36:a46e63505ed8 146 //extern float P_GAIN_VALVE_POSITION_OPP;
Lightvalve 36:a46e63505ed8 147 //extern float I_GAIN_VALVE_POSITION_OPP;
Lightvalve 36:a46e63505ed8 148 //extern float D_GAIN_VALVE_POSITION_OPP;
Lightvalve 36:a46e63505ed8 149 //extern float P_GAIN_JOINT_POSITION_OPP;
Lightvalve 36:a46e63505ed8 150 //extern float I_GAIN_JOINT_POSITION_OPP;
Lightvalve 36:a46e63505ed8 151 //extern float D_GAIN_JOINT_POSITION_OPP;
Lightvalve 36:a46e63505ed8 152 //extern float P_GAIN_JOINT_TORQUE_OPP;
Lightvalve 36:a46e63505ed8 153 //extern float I_GAIN_JOINT_TORQUE_OPP;
Lightvalve 36:a46e63505ed8 154 //extern float D_GAIN_JOINT_TORQUE_OPP;
Lightvalve 36:a46e63505ed8 155
hyhoon 214:82a3ca333004 156 extern int16_t VALVE_DEADZONE_PLUS;
hyhoon 214:82a3ca333004 157 extern int16_t VALVE_DEADZONE_MINUS;
Lightvalve 11:82d8768d7351 158
Lightvalve 11:82d8768d7351 159 extern int16_t VELOCITY_COMP_GAIN;
Lightvalve 226:4e660aa77eb7 160 //extern int16_t COMPLIANCE_GAIN;
Lightvalve 11:82d8768d7351 161
Lightvalve 11:82d8768d7351 162 extern int16_t VALVE_CENTER;
Lightvalve 11:82d8768d7351 163
Lightvalve 11:82d8768d7351 164 extern int16_t VALVE_FF;
Lightvalve 11:82d8768d7351 165
Lightvalve 11:82d8768d7351 166 extern int16_t BULK_MODULUS;
Lightvalve 11:82d8768d7351 167
Lightvalve 11:82d8768d7351 168 extern int16_t CHAMBER_VOLUME_A;
Lightvalve 11:82d8768d7351 169 extern int16_t CHAMBER_VOLUME_B;
Lightvalve 11:82d8768d7351 170
Lightvalve 11:82d8768d7351 171 extern int16_t PISTON_AREA_A;
Lightvalve 11:82d8768d7351 172 extern int16_t PISTON_AREA_B;
Lightvalve 30:8d561f16383b 173 extern float PISTON_AREA_alpha;
Lightvalve 55:f4819de54e7a 174 extern float alpha3;
Lightvalve 11:82d8768d7351 175
jobuuu 218:2c3e5ecbe7e1 176 extern float PRES_SUPPLY_NOM;
jobuuu 218:2c3e5ecbe7e1 177 extern float PRES_SUPPLY;
Lightvalve 11:82d8768d7351 178
Lightvalve 11:82d8768d7351 179 extern int16_t ENC_LIMIT_PLUS;
Lightvalve 11:82d8768d7351 180 extern int16_t ENC_LIMIT_MINUS;
Lightvalve 11:82d8768d7351 181
Lightvalve 11:82d8768d7351 182 extern int16_t STROKE;
Lightvalve 11:82d8768d7351 183
Lightvalve 131:22ab22818e01 184 extern float Amm;
Lightvalve 131:22ab22818e01 185 extern float beta;
Lightvalve 131:22ab22818e01 186 extern float Ps;
Lightvalve 131:22ab22818e01 187 extern float Pt;
Lightvalve 131:22ab22818e01 188 extern float gamma_hat;
Lightvalve 208:066030f7951f 189 extern float a_hat;
Lightvalve 165:42c938a40313 190 extern float V_adapt;
Lightvalve 131:22ab22818e01 191 extern float x_4_des_old;
Lightvalve 131:22ab22818e01 192
Lightvalve 55:f4819de54e7a 193 //extern int16_t VALVE_LIMIT_PLUS;
Lightvalve 55:f4819de54e7a 194 //extern int16_t VALVE_LIMIT_MINUS;
Lightvalve 11:82d8768d7351 195
Lightvalve 47:889798ff9329 196 extern float ENC_PULSE_PER_POSITION;
Lightvalve 47:889798ff9329 197 extern float TORQUE_SENSOR_PULSE_PER_TORQUE;
Lightvalve 47:889798ff9329 198
Lightvalve 30:8d561f16383b 199 extern float PRES_SENSOR_A_PULSE_PER_BAR;
Lightvalve 30:8d561f16383b 200 extern float PRES_SENSOR_B_PULSE_PER_BAR;
Lightvalve 11:82d8768d7351 201
hyhoon 214:82a3ca333004 202 extern int16_t HOMEPOS_OFFSET;
Lightvalve 11:82d8768d7351 203 extern int HOMEPOS_VALVE_OPENING;
Lightvalve 11:82d8768d7351 204
Lightvalve 30:8d561f16383b 205 extern float FRICTION;
Lightvalve 30:8d561f16383b 206 extern float REF_PERIOD;
Lightvalve 30:8d561f16383b 207 extern float REF_MAG;
Lightvalve 11:82d8768d7351 208 extern int REF_NUM;
Lightvalve 11:82d8768d7351 209
Lightvalve 11:82d8768d7351 210
Lightvalve 30:8d561f16383b 211 extern float DAC_REF;
Lightvalve 30:8d561f16383b 212 extern float DAC_RESOL;
Lightvalve 11:82d8768d7351 213
jobuuu 218:2c3e5ecbe7e1 214 extern float REF_FORCE;
jobuuu 218:2c3e5ecbe7e1 215 extern float REF_TORQUE;
hyhoon 215:699c3e572283 216 extern float REF_POSITION;
hyhoon 215:699c3e572283 217 extern float REF_VELOCITY;
jobuuu 218:2c3e5ecbe7e1 218
jobuuu 218:2c3e5ecbe7e1 219 extern float REF_POSITION_FINDHOME;
jobuuu 218:2c3e5ecbe7e1 220
Lightvalve 11:82d8768d7351 221 extern int16_t REF_PWM;
Lightvalve 11:82d8768d7351 222 extern int16_t REF_VALVE_POSITION;
Lightvalve 14:8e7590227d22 223 extern int16_t REF_CURRENT;
Lightvalve 11:82d8768d7351 224
Lightvalve 11:82d8768d7351 225 extern int REF_MOVE_TIME_5k;
Lightvalve 11:82d8768d7351 226 extern int INIT_REF_PWM;
Lightvalve 11:82d8768d7351 227 extern int INIT_REF_VALVE_POS;
Lightvalve 11:82d8768d7351 228 extern int INIT_REF_VEL;
Lightvalve 11:82d8768d7351 229 extern int INIT_REF_TORQUE;
Lightvalve 11:82d8768d7351 230 extern int INIT_REF_PRES_DIFF;
Lightvalve 14:8e7590227d22 231 extern int INIT_REF_CURRENT;
Lightvalve 11:82d8768d7351 232
Lightvalve 11:82d8768d7351 233 extern unsigned int TMR2_COUNT_LED1;
Lightvalve 11:82d8768d7351 234 extern unsigned int TMR2_COUNT_LED2;
Lightvalve 11:82d8768d7351 235 extern unsigned int TMR2_COUNT_CAN_TX;
Lightvalve 52:647072f5307a 236 extern unsigned int TMR3_COUNT_TEST;
Lightvalve 11:82d8768d7351 237
Lightvalve 11:82d8768d7351 238 extern int num_err;
Lightvalve 11:82d8768d7351 239 extern int flag_err[8];
Lightvalve 11:82d8768d7351 240 extern int flag_err_old[8];
Lightvalve 11:82d8768d7351 241 extern int flag_err_rt;
Lightvalve 11:82d8768d7351 242
Lightvalve 11:82d8768d7351 243 extern int flag_ref_enable;
Lightvalve 11:82d8768d7351 244
Lightvalve 11:82d8768d7351 245 extern int flag_data_request[5];
Lightvalve 11:82d8768d7351 246
Lightvalve 44:35fa6884d0c6 247 extern int MODE_POS_FT_TRANS;
Lightvalve 64:a8e6799dbce3 248 extern int NN_Control_Flag;
Lightvalve 44:35fa6884d0c6 249
Lightvalve 164:645207e160ca 250 extern int cnt_buffer;
Lightvalve 164:645207e160ca 251
Lightvalve 55:f4819de54e7a 252 extern float CUR_CURRENT_mA;
Lightvalve 30:8d561f16383b 253 extern float CUR_TORQUE_NM;
Lightvalve 30:8d561f16383b 254 extern float CUR_TORQUE_NM_PRESS;
Lightvalve 11:82d8768d7351 255
jobuuu 218:2c3e5ecbe7e1 256 extern float FORCE_VREF;
Lightvalve 30:8d561f16383b 257 extern float PRES_A_VREF;
Lightvalve 30:8d561f16383b 258 extern float PRES_B_VREF;
Lightvalve 11:82d8768d7351 259
Lightvalve 30:8d561f16383b 260 extern float VALVE_PWM_RAW_FB;
Lightvalve 30:8d561f16383b 261 extern float VALVE_PWM_RAW_FF;
Lightvalve 55:f4819de54e7a 262 extern float VALVE_PWM_RAW;
Lightvalve 11:82d8768d7351 263 extern int VALVE_PWM_VALVE_DZ;
Lightvalve 11:82d8768d7351 264
Lightvalve 30:8d561f16383b 265 extern float VALVE_GAIN_LPM_PER_V[10];
Lightvalve 30:8d561f16383b 266 extern float VALVE_POS_VS_PWM[25];
Lightvalve 11:82d8768d7351 267 extern long JOINT_VEL[100];
Lightvalve 11:82d8768d7351 268
Lightvalve 11:82d8768d7351 269 extern int VALVE_MAX_POS;
Lightvalve 11:82d8768d7351 270 extern int VALVE_MIN_POS;
Lightvalve 225:c2cfe349f5c1 271 extern int VALVE_ELECTRIC_CENTER;
Lightvalve 11:82d8768d7351 272 extern int VALVE_POS_NUM;
Lightvalve 32:4b8c0fedaf2c 273 extern float VALVE_CENTER_OFFSET;
Lightvalve 33:91b17819ec30 274 extern float VALVE_DZ_MINUS_OFFSET;
Lightvalve 33:91b17819ec30 275 extern float VALVE_DZ_PLUS_OFFSET;
Lightvalve 11:82d8768d7351 276
Lightvalve 14:8e7590227d22 277 extern int TMR3_COUNT_FINDHOME;
Lightvalve 14:8e7590227d22 278 extern int TMR3_COUNT_FLOWRATE;
Lightvalve 14:8e7590227d22 279 extern int TMR3_COUNT_DEADZONE;
Lightvalve 14:8e7590227d22 280 extern int TMR3_COUNT_PRES_NULL;
Lightvalve 14:8e7590227d22 281 extern int TMR3_COUNT_TORQUE_NULL;
Lightvalve 14:8e7590227d22 282 extern int TMR3_COUNT_PRES_CALIB;
Lightvalve 14:8e7590227d22 283 extern int TMR3_COUNT_REFERENCE;
Lightvalve 14:8e7590227d22 284 extern int TMR3_COUNT_JOINT;
Lightvalve 14:8e7590227d22 285 extern int TMR3_COUNT_ROTARY_FRIC_TUNE;
Lightvalve 11:82d8768d7351 286
Lightvalve 30:8d561f16383b 287 extern float TUNING_TIME;
Lightvalve 11:82d8768d7351 288
Lightvalve 30:8d561f16383b 289 extern float REFERENCE_FREQ;
Lightvalve 30:8d561f16383b 290 extern float REFERENCE_MAG;
Lightvalve 11:82d8768d7351 291
Lightvalve 11:82d8768d7351 292 extern bool FLAG_FIND_HOME;
Lightvalve 11:82d8768d7351 293
Lightvalve 11:82d8768d7351 294 extern int MODE_JUMP_STATUS;
Lightvalve 11:82d8768d7351 295
Lightvalve 30:8d561f16383b 296 extern float CUR_PRES_DIFF_BAR;
Lightvalve 30:8d561f16383b 297 extern float CUR_PRES_A_sum;
Lightvalve 30:8d561f16383b 298 extern float CUR_PRES_B_sum;
Lightvalve 30:8d561f16383b 299 extern float CUR_PRES_A_mean;
Lightvalve 30:8d561f16383b 300 extern float CUR_PRES_B_mean;
jobuuu 218:2c3e5ecbe7e1 301 extern float PRES_A_NULL_pulse;
jobuuu 218:2c3e5ecbe7e1 302 extern float PRES_B_NULL_pulse;
jobuuu 218:2c3e5ecbe7e1 303 extern float FORCE_NULL_pulse;
Lightvalve 13:747daba9cf59 304
Lightvalve 30:8d561f16383b 305 extern float Ref_Valve_Pos_Old;
Lightvalve 13:747daba9cf59 306
Lightvalve 13:747daba9cf59 307 extern int VALVE_ID_timer;
Lightvalve 13:747daba9cf59 308 extern int VALVE_DZ_timer;
Lightvalve 13:747daba9cf59 309 extern int VALVE_FR_timer;
Lightvalve 35:34ce7b0347b8 310 extern int VALVE_HPL_timer;
Lightvalve 13:747daba9cf59 311 extern int VALVE_POS_TMP;
Lightvalve 13:747daba9cf59 312 extern int JOINT_VEL_TMP;
Lightvalve 13:747daba9cf59 313 extern int DDV_POS_AVG ;
Lightvalve 19:23b7c1ad8683 314 extern int VALVE_POS_AVG[50];
Lightvalve 13:747daba9cf59 315 extern int VALVE_POS_AVG_OLD;
Lightvalve 13:747daba9cf59 316 extern int data_num;
Lightvalve 13:747daba9cf59 317 extern int ID_index;
Lightvalve 13:747daba9cf59 318 extern int DZ_index;
Lightvalve 19:23b7c1ad8683 319 extern int ID_index_array[50];
Lightvalve 13:747daba9cf59 320 extern int first_check;
Lightvalve 30:8d561f16383b 321 extern float init_time;
Lightvalve 13:747daba9cf59 322 extern int DZ_case;
Lightvalve 13:747daba9cf59 323 extern int START_POS;
Lightvalve 13:747daba9cf59 324 extern int FINAL_POS;
Lightvalve 13:747daba9cf59 325 extern int DZ_DIRECTION;
Lightvalve 13:747daba9cf59 326 extern int FIRST_DZ;
Lightvalve 13:747daba9cf59 327 extern int SECOND_DZ;
Lightvalve 13:747daba9cf59 328 extern int DZ_NUM;
Lightvalve 13:747daba9cf59 329 extern int one_period_end;
Lightvalve 30:8d561f16383b 330 extern float Ref_Vel_Test;
Lightvalve 13:747daba9cf59 331 extern long TMR2_FOR_SLOW_LOGGING;
Lightvalve 19:23b7c1ad8683 332 //extern int velcount;
Lightvalve 13:747daba9cf59 333 extern char max_check;
Lightvalve 13:747daba9cf59 334 extern char min_check;
Lightvalve 13:747daba9cf59 335
Lightvalve 30:8d561f16383b 336 extern float valve_pos_err, valve_pos_err_old, valve_pos_err_diff, valve_pos_err_sum;
Lightvalve 30:8d561f16383b 337 extern float joint_pos_err, joint_pos_err_old, joint_pos_err_diff, joint_pos_err_diff_fil, joint_pos_err_sum;
Lightvalve 30:8d561f16383b 338 extern float joint_torq_err, joint_torq_err_old, joint_torq_err_diff, joint_torq_err_sum;
Lightvalve 30:8d561f16383b 339 extern float VALVE_PWM_RAW_POS, VALVE_PWM_RAW_TORQ;
Lightvalve 227:8ac5c6162bc1 340 extern float force_ref_filter;
Lightvalve 13:747daba9cf59 341
Lightvalve 30:8d561f16383b 342 extern float CUR_FLOWRATE;
Lightvalve 30:8d561f16383b 343 extern float VALVE_FF_VOLTAGE;
Lightvalve 13:747daba9cf59 344
Lightvalve 13:747daba9cf59 345 extern int pos_plus_end;
Lightvalve 13:747daba9cf59 346 extern int pos_minus_end;
Lightvalve 13:747daba9cf59 347
Lightvalve 13:747daba9cf59 348 extern bool need_enc_init;
Lightvalve 13:747daba9cf59 349
Lightvalve 13:747daba9cf59 350 extern int temp_time;
Lightvalve 13:747daba9cf59 351
Lightvalve 30:8d561f16383b 352 extern float CUR_VELOCITY_sum;
Lightvalve 30:8d561f16383b 353 extern float temp_vel_sum;
Lightvalve 13:747daba9cf59 354
Lightvalve 13:747daba9cf59 355 extern int DZ_dir;
Lightvalve 13:747daba9cf59 356 extern int DZ_temp_cnt;
Lightvalve 13:747daba9cf59 357 extern int DZ_temp_cnt2;
Lightvalve 13:747daba9cf59 358 extern int DZ_end;
Lightvalve 13:747daba9cf59 359 extern int flag_flowrate;
Lightvalve 13:747daba9cf59 360 extern int fl_temp_cnt;
Lightvalve 13:747daba9cf59 361 extern int fl_temp_cnt2;
Lightvalve 13:747daba9cf59 362 extern int cur_vel_sum;
Lightvalve 13:747daba9cf59 363
hyhoon 215:699c3e572283 364 extern int cnt_finddz;
hyhoon 215:699c3e572283 365 extern int cnt_vel_finddz;
hyhoon 215:699c3e572283 366 extern int flag_finddz;
hyhoon 215:699c3e572283 367 extern int FINDDZ_VELOCITY;
hyhoon 215:699c3e572283 368 extern int FINDDZ_VELOCITY_OLD;
hyhoon 215:699c3e572283 369 extern int FINDDZ_POSITION;
hyhoon 215:699c3e572283 370 extern int FINDDZ_POSITION_OLD;
hyhoon 215:699c3e572283 371
hyhoon 215:699c3e572283 372 extern double temp_VALVE_DEADZONE_PLUS;
hyhoon 215:699c3e572283 373 extern double temp_VALVE_DEADZONE_MINUS;
hyhoon 215:699c3e572283 374 extern float temp_pos_ref;
hyhoon 215:699c3e572283 375 extern float temp_pos_ref_offset;
hyhoon 215:699c3e572283 376
Lightvalve 13:747daba9cf59 377 // valve gain
Lightvalve 13:747daba9cf59 378 extern int check_vel_pos_init;
Lightvalve 13:747daba9cf59 379 extern int check_vel_pos_fin;
Lightvalve 13:747daba9cf59 380 extern int check_vel_pos_interv;
Lightvalve 13:747daba9cf59 381 extern int valve_gain_repeat_cnt;
Lightvalve 30:8d561f16383b 382 extern float VALVE_VOLTAGE;
Lightvalve 13:747daba9cf59 383
Lightvalve 30:8d561f16383b 384 extern float freq_fric_tune;
Lightvalve 13:747daba9cf59 385
Lightvalve 14:8e7590227d22 386 extern uint32_t TMR3_COUNT_CAN_TX;
Lightvalve 14:8e7590227d22 387
Lightvalve 55:f4819de54e7a 388 // Current Control Variables
Lightvalve 55:f4819de54e7a 389 extern double I_REF;
Lightvalve 55:f4819de54e7a 390 extern double I_REF_fil;
hyhoon 214:82a3ca333004 391 extern double I_REF_fil_DZ;
Lightvalve 55:f4819de54e7a 392 extern double I_ERR;
Lightvalve 55:f4819de54e7a 393 extern double I_ERR_INT;
Lightvalve 55:f4819de54e7a 394 extern double I_REF_fil_old;
Lightvalve 55:f4819de54e7a 395 extern double I_REF_fil_diff;
Lightvalve 55:f4819de54e7a 396
Lightvalve 55:f4819de54e7a 397 // system id
Lightvalve 55:f4819de54e7a 398 extern int cnt_sysid;
Lightvalve 55:f4819de54e7a 399 extern double freq_sysid_Iref;
Lightvalve 55:f4819de54e7a 400
Lightvalve 164:645207e160ca 401 extern int cnt_freq_test;
Lightvalve 164:645207e160ca 402 extern int cnt_step_test;
Lightvalve 164:645207e160ca 403 extern int buffer_data_size;
Lightvalve 164:645207e160ca 404 extern int cnt_send_buffer;
Lightvalve 164:645207e160ca 405 extern float freq_test_valve_ref;
Lightvalve 164:645207e160ca 406 extern float ref_array[10000];
Lightvalve 164:645207e160ca 407 extern int pos_array[10000];
Lightvalve 187:637092202815 408 extern int flag_every_reference;
Lightvalve 164:645207e160ca 409
Lightvalve 14:8e7590227d22 410 extern int TMR3_COUNT_IREF;
Lightvalve 30:8d561f16383b 411 extern float CUR_CURRENT;
Lightvalve 30:8d561f16383b 412 extern float u_CUR[3];
Lightvalve 19:23b7c1ad8683 413
Lightvalve 29:69f3f5445d6d 414 extern int FINDHOME_STAGE;
Lightvalve 29:69f3f5445d6d 415 extern int FINDHOME_INIT;
Lightvalve 29:69f3f5445d6d 416 extern int FINDHOME_GOTOLIMIT;
Lightvalve 29:69f3f5445d6d 417 extern int FINDHOME_ZEROPOSE;
Lightvalve 29:69f3f5445d6d 418
hyhoon 215:699c3e572283 419 extern int FINDDZ_STAGE;
hyhoon 215:699c3e572283 420 extern int FINDDZ_INIT;
hyhoon 215:699c3e572283 421 extern int FINDDZ_START1;
hyhoon 215:699c3e572283 422 extern int FINDDZ_START2;
hyhoon 215:699c3e572283 423 extern int FINDDZ_STOP;
hyhoon 215:699c3e572283 424
Lightvalve 44:35fa6884d0c6 425 extern float alpha_trans;
Lightvalve 44:35fa6884d0c6 426
Lightvalve 55:f4819de54e7a 427
Lightvalve 55:f4819de54e7a 428 extern float V_out;
Lightvalve 55:f4819de54e7a 429 extern float V_rem;
Lightvalve 55:f4819de54e7a 430 extern float V_MAX;
Lightvalve 55:f4819de54e7a 431
Lightvalve 55:f4819de54e7a 432 extern float PWM_out;
Lightvalve 55:f4819de54e7a 433
Lightvalve 55:f4819de54e7a 434 extern double K_v;
jobuuu 218:2c3e5ecbe7e1 435 extern double C_d;
Lightvalve 55:f4819de54e7a 436 extern double mV_PER_mA;
Lightvalve 55:f4819de54e7a 437 extern double mV_PER_pulse;
Lightvalve 55:f4819de54e7a 438 extern double mA_PER_pulse;
Lightvalve 55:f4819de54e7a 439
Lightvalve 55:f4819de54e7a 440 extern int timer_while;
Lightvalve 55:f4819de54e7a 441 extern int while_index;
Lightvalve 165:42c938a40313 442 extern int RL_timer;
Lightvalve 23:59218d4a256d 443
Lightvalve 65:c2812cf26c38 444 extern float K_LPF;
Lightvalve 65:c2812cf26c38 445 extern float D_LPF;
Lightvalve 65:c2812cf26c38 446
Lightvalve 212:985dba42f261 447 extern float torq_sen_past;
Lightvalve 198:c70c5a9f17dd 448 extern float torq_ref_past;
Lightvalve 97:7bbcb3c0fb06 449 extern float output_normalized;
Lightvalve 70:3436ce769b1e 450
Lightvalve 64:a8e6799dbce3 451
Lightvalve 32:4b8c0fedaf2c 452
Lightvalve 35:34ce7b0347b8 453
Lightvalve 36:a46e63505ed8 454
Lightvalve 44:35fa6884d0c6 455
Lightvalve 44:35fa6884d0c6 456
Lightvalve 47:889798ff9329 457
Lightvalve 48:e7bcfc244d40 458
Lightvalve 49:3c630b5eba9f 459
Lightvalve 51:8ea76864368a 460
Lightvalve 52:647072f5307a 461