AC-Motor-FU6815/User/include/Customer.h

#ifndef __CUSTOMER_H_
#define __CUSTOMER_H_

// ------------------------------------------------------------------------------------------------------------------
// 1.电机相关参数: 电阻(Ω) DQ电感(H) 反电动势常数(V/RPM)  转向(CW/CCW) 基准转速(RPM) 极对数
#define RS                             (6.4)
#define LD                             (0.080)
#define LQ                             (LD)
#define Ke                             (0.0)
#define Psi                            (float)(Ke * 207.84 / 1000.0 / 2.0 / 1.732 / Pole_Pairs / _2PI )
#define IRMODE                         (CCW)
#define MOTOR_SPEED_BASE               (9000.0)
#define Pole_Pairs                     (3)


#define ID_Limit                       I_Value(-Psi/LD/2)

// ------------------------------------------------------------------------------------------------------------------
// 2.硬件相关:载波频率(KHz) 死区(us) 单电阻最小窗口(us) 驱动电平 基准电压(V) 
#define PWM_FREQUENCY                  (5.0)
#define PWM_DEADTIME                   (5.0)
#define MIN_WIND_TIME                  (5.9)
#define HW_ADC_VREF                    (VREF5_0)
#define HW_ADC_REF                     (5.0)
// 运放配置 运放倍数
#define HW_AMP_MODE                    (AMP_NOMAL)
#define HW_AMPGAIN                     (0.5)


// ------------------------------------------------------------------------------------------------------------------
// 3.其他



#define HW_RSHUNT                      (0.04)                                  // (Ω)  采样电阻


#define RV1                            (940.0)                                  // (kΩ) 母线电压分压电阻1
#define RV2                            (940.0)                                  // (kΩ) 母线电压分压电阻2
#define RV3                            (0.3)                                    // (kΩ) 母线电压分压电阻3
#define VC1                            (1.0)                                    // 电压补偿系数
#define RV                             ((RV1 + RV2 + RV3) / RV3)                // 分压比


#define RL1                            (450.0)                                  // (kΩ) 母线电压分压电阻1
#define RL2                            (2.0)                                    // (kΩ) 母线电压分压电阻2
#define RL                             ((RL1 + RL2) / RL2)                // 分压比    
#define HW_L_VOLT_MAX                  (HW_ADC_REF * RL)                        // (V)  ADC可测得的最大母线电压  


#define Udcmax_ms                      (20.0* PWM_FREQUENCY )                       //  60*ms读取一次UDC最大值和最小值         


/*预充电设置值-------------------------------------------------------------------*/
#define Charge_Time                    (100) //30                              // (ms) 预充电时间，单位：ms
#define Calib_Duty                     (0.1)                                   // 预充电占空比


/*正常运行时估算算法的参数设置值-------------------------------------------------*/
#define OBS_KSLIDE                     _Q15(0.85)  //0.65                     // SMO算法里的滑膜增益值
#define E_BW1                          (80.0)                                 // PLL算法里的反电动势滤波值
#define E_BW2                          (80.0)                                 // PLL算法里的反电动势滤波值
#define E_BW3                          (80.0)                                 // PLL算法里的反电动势滤波值
#define E_BW4                          (80.0)                                 // PLL算法里的反电动势滤波值
#define E_BW5                          (80.0)                                 // PLL算法里的反电动势滤波值

#define AlignTestMode                  (0)                                     // 预定位测试模式


#define DQKP_Alignment					_Q12(2.0)
#define DQKI_Alignment					_Q15(0.05)

#define IQ_Align_CURRENT				I_Value(0.0)
#define ID_Align_CURRENT_Start			I_Value(1.0)
#define ID_Align_CURRENT_End			ID_Align_CURRENT_Start

#define Align_Angle1					_Q15((float)0.0 / 180.0)
#define Align_Angle2					_Q15((float)90.0 / 180.0)
#define Align_Start						(Align_Angle2 - _Q15((float)30.0 / 180.0))

#define AlignmentRampTime               (500.0)
#define AlignmentHoldTime1              (500.0)
#define AlignmentHoldTime2              (500.0)
#define Align_Time                      (AlignmentRampTime + AlignmentHoldTime1+AlignmentHoldTime2)

// 启动电流
#define ID_Start_CURRENT               I_Value(0.0)                            // (A) D轴启动电流
#define IQ_Start_CURRENT               I_Value(2.0)                            // (A) Q轴启动电流
#define IQ_Start_CURRENT2              I_Value(2.0)                            // (A) Q轴启动电流

#define Start_FOC_THECOMP              _Q15(10.0/180.0)                        //启动补偿角度

/*************Omega启动的参数***************/
#define ATO_BW                         (120.0)                               // 观测器带宽的滤波值，经典值为1.0-200.0
#define ATO_BW_RUN                     (130.0)
#define ATO_BW_RUN1                    (140.0)
#define ATO_BW_RUN2                    (150.0)
#define ATO_BW_RUN3                    (160.0)
#define ATO_BW_RUN4                    (190.0)


#define SPD_BW                         (25.0)                                   // 速度带宽的滤波值，经典值为5.0-40.0
#define ATT_COEF                       (0.95)                                  // 无需改动
/*转速参数值-------------------------------------------------------------------*/
/* motor start speed value */
//open 算法启动参数
#define MOTOR_OPEN_ACC                 (1.0)  //30.0                                // 强拖启动的增量(每载波周期加一次)
#define MOTOR_OPEN_ACC_MIN             (100.0)    //20.0                           // 强拖启动的初始速度
#define MOTOR_OPEN_ACC_CNT             (250.0)     //100.0                    // 强拖启动的执行次数(MOTOR_OPEN_ACC_CNT*256)
#define MOTOR_OPEN_ACC_CYCLE           (100)           //5             // 强拖启动循环拖动的次数

//OMEGA启动参数
#define Motor_Omega_Ramp_ACC           (300.0) //(50.00) //5.0  //60                                // omega启动的增量   12
#define MOTOR_OMEGA_ACC_MIN            (200.0) //(800.0) //20.0 //100                                // (RPM) omega启动的最小切换转速
#define MOTOR_OMEGA_ACC_END            (400.0)   //50.0                               // (RPM) omega启动的限制转速


#define TARGET_SPEED_SET				_Q15(2000.0/MOTOR_SPEED_BASE)

#define MOTOR_SPEED_SMOMIN_RPM         (400.0)
#define MOTOR_LOOP_RPM					_Q15(500.0 / MOTOR_SPEED_BASE)


#define MOTOE_MIN_SPEED					_Q15(900.0/ MOTOR_SPEED_BASE)
#define MOTOR_MAX_SPEED					_Q15(5400.0/ MOTOR_SPEED_BASE)
#define MOTOR_STALL_MIN_SPEED			_Q15(800.0/ MOTOR_SPEED_BASE)
#define MOTOR_STALL_MAX_SPEED			_Q15(7000.0/ MOTOR_SPEED_BASE)
#define MOTOR_STOP_SPEED				_Q15(1300.0/ MOTOR_SPEED_BASE)




/*******运行时的参数*****************/
/*电流环参数设置值--------------------------------------------------------------*/
/*启动*/
#define DQKPStart                      _Q12(2.5)  //1.1                             
#define DQKIStart                      _Q15(0.01) //0.01                             
/*低速*/
#define DQKP                           _Q12(2.0)  //带载时5.0                            
#define DQKI                           _Q15(0.002)  //此值不能太大，大了后影响低速性能（与转矩补偿冲突） 
/*中速*/
#define DQKP_zhong                     _Q12(1.5)  //带载时5.0                            
#define DQKI_zhong                     _Q15(0.002)  //      
/*高速*/
#define DQKP_highspeed                 _Q12(1.5)  //4.0  切换时易导致转速波动                            
#define DQKI_highspeed                 _Q15(0.002)  //0.02  0.011                          



#define QOUTINC                        (1)

/*外环参数设置值----------------------------------------------------------------*/
#define SPEED_LOOP_TIME                (1)  //2                                  // (ms) 速度环调节周期 SPEED_INC_DEC_TIME
#define WEAK_LOOP_TIME                 (1)  //2                                  // (ms) 速度环调节周期 SPEED_INC_DEC_TIME
#define SPEED_INC_DEC_TIME             (200)                                    // (ms) 速度环爬坡周期


/*启动*/
#define SKP                            _Q12(0.65)  //0.25                            // 外环KP
#define SKI                            _Q15(0.010) //0.00251
/*低速*/
#define SKPRun                         _Q12(0.45)         //0.35                                 // 外环KP
#define SKIRun                         _Q15(0.03)    //0.03                                      // 外环KI    0.01 ，影响转矩补偿
/*中速*/
#define SKPRun1                        _Q12(0.30)//0.2  太大高速时波动，太小
#define SKIRun1                        _Q15(0.01) //0.0005   
/*高速*/
#define SKPRun2                        _Q12(0.30)//0.15  太大高速时波动，太小
#define SKIRun2                        _Q15(0.01) //0.0002  // 外环KI  

#define SOUTMAX                        I_Value(60.0)  //7.0  //16                       // (A) 外环最大限幅值
#define SOUTMIN                        I_Value(0.0)  //0.02                         // (A) 外环最小限幅值

#define I_OVER                         I_Value(78.0) //   降频点  超过此值降频率
#define I_LIMIT                        I_Value(77.0) //   限制电流值 
#define P_OVER                         P_Power(15180) //   降频点  超过此值降频率
#define P_LIMIT                        P_Power(15150) //   限制功率值 


/*外环增量*/
#define SPEED_INC_Start                (200.0)
#define SPEED_INC                      (200.0) //150                                // 速度环增量
#define SPEED_DEC                      (200.0) //150                                // 速度环减量
#define SPEED_DEC1                     (800.0) //150                              // 速度环减量  停机时使用
#define SpeedRampStartInc              (S_Value(SPEED_INC_Start))/(1000/SPEED_INC_DEC_TIME)
#define Motor_Speed_Inc                (S_Value(SPEED_INC))      /(1000/(SPEED_LOOP_TIME*20.0))
#define Motor_Speed_Dec                (S_Value(SPEED_DEC))      /(1000/(SPEED_LOOP_TIME*20.0))
#define Motor_Speed_Dec1               (S_Value(SPEED_DEC1))     /(1000/SPEED_INC_DEC_TIME)


#define MotorStartHoldTime				(15000)                                 //上油时间  15000
#define Motor_Start_Hold_Speed			_Q15(2700.0 / MOTOR_SPEED_BASE)



#define OUT_LOOP_CONTROL				(0)
#define LOOP_MODE						(SPEED_CONTROL_MODE)


#define CONTROL_MODE					(UARTMODE) 




#define StopBrakeFlag                  (0)
#define StopWaitTime                   (2000)                                  // (ms) 刹车等待时间


// 弱磁控制
#define FiledWeakenCompEnable			(0)
#define DcbusK							_Q15(0.8)
#define FiledWeakenKp					_Q12(0.4)
#define FiledWeakenKi					_Q15(0.0001)


#define IFFDebugg                      (0)            //  强拖测试模式 
#define IF_I_Value                     I_Value(10.0)   //  强拖测试电流


#define VoltageCompensationEn           (0)//电压补偿使能位

//电压限频
#define VAC_Min_F                         900
#define VAC_Max_F                         900
#define VAC_Min                           _Q15((290.0*1.414) / HW_L_VOLT_MAX)
#define VAC_Max                           _Q15((360.0*1.414) / HW_L_VOLT_MAX)
#define VAC_Max_K                        ((float)(VAC_Max_F-VAC_Min_F)/(float)(VAC_Max-VAC_Min))
	

#endif