無刷無感電機過零檢測單片機源程序

ID:299262 · 發(fā)表于 2018-3-30 09:18

附件中的源文件是無感三相電機零速定位，開環(huán)加速以前閉環(huán)控制（含過零檢測的程序）

單片機源程序如下:

#include "hardware.h"
#include "bldc.h"
u16 Temp = 0;
volatile State_TypeDef State = Idle;
Task_TypeDef Task;
Flag_TypeDef Flag;
vu16 ADC_VALUE[ADC_NUMBER*ADC_BUFFER]={0};
u16 SysTime = 0; /* 系統(tǒng)時間 */
u8 Phase = 0; /* 通電繞組 */
u16 PwmDuty = 0; /* PWM占空比 */
u8 AlignRotorCount = 0; /* 電機啟動時鎖定轉(zhuǎn)子的次數(shù) */
u8 BlankingCount = 0; /* 消隱時長 */
//u8 ZeroBeforeCount = 0; /* 過零點之前的檢測次數(shù) */
u8 ZeroCrossCount = 0; /* 到達(dá)過零點的檢測次數(shù) */
u8 ZeroAcquireCount = 0; /* 進(jìn)入到同步運行狀態(tài)前的過零點次數(shù) */
u16 CommutateTime = 0; /* 過零檢測到到換向的時間 */
u16 AccelerateCommutateTime = 0; /* 電機加速的換向的時間 */
u16 AdcPotentiometer = 0; /* 電位器ADC轉(zhuǎn)換結(jié)果 */
u16 AdcBEMF = 0; /* BEMF電壓ADC轉(zhuǎn)換結(jié)果 */
u16 AdcCurrent = 0; /* 電流放大器ADC轉(zhuǎn)換結(jié)果 */
u16 AdcVbus = 0; /* 電源電壓ADC轉(zhuǎn)換結(jié)果 */
u16 ZeroVref = 0; /* 過零檢測基準(zhǔn)電壓，等于電源電壓的一半 */
u8 SpeedErrorCount = 0; /* 電機速度異常次數(shù) */
u16 ZeroPeriod = 1000; /* 過零周期即60度換向時間 */
u16 MotorRpm = 0; /* 電機轉(zhuǎn)速，單位RPM */
u16 AccelerateTime = 0; /* 電機加速運轉(zhuǎn)的時間 */
//u16 PhaseAdvance = 0; /* 超前相位 */
u16 Current = 0; /* 電流值 */
u16 Iref = 0; /* 電流放大器輸出偏置 */
#define MaxIX 999 //最大記錄條數(shù)
vu16 BEMF_REC[MaxIX+1]={0}; // 反電動勢記錄
u16 ix = 0; // 記錄下標(biāo)
/********************************************************************************************
* Function Name : void Scan_Key(void)
* Description : 按鍵掃描程序，用于啟動或者停止電機運轉(zhuǎn)
* Input : 無
* Return : 無
*********************************************************************************************/
void Scan_Key(void)
{
if(Key_Status() == PRESS)
{
if(State == Idle)
{
while(Key_Status() != RELEASE);
State = Start;
}
else
{
while(Key_Status() != RELEASE);
State = Stop;
}
}
}
void Start_Motor(void)
{
Close_LED7();
Close_LED8();
Close_LED9();
Flag.AcquireZero = 0;
Flag.ZeroCross = 0;
SpeedErrorCount = 0;
AccelerateTime = 0;
AlignRotorCount = 3; /* 初始化電機轉(zhuǎn)子定位次數(shù) */
Update_PwmDuty((u32)ALIGN_ROTOR_PWM*FULL_DUTY/100);
Phase = 0;
Commutate();
TIM_CtrlPWMOutputs(TIM1, ENABLE);
State = AlignRotor;
SysTime = 0;
Task.AlignRotor = 0;
printf("Start AlignRotor !!!\n\r");
}
/********************************************************************************************
* Function Name : void AlignMotorRotor(void)
* Description : 轉(zhuǎn)子定位程序
* Input : 無
* Return : 無
*********************************************************************************************/
void Align_MotorRotor(void)
{
if(AlignRotorCount > 0)
{
Phase = 0;
Commutate();
Update_PwmDuty((u32)ALIGN_ROTOR_PWM*FULL_DUTY/100);
AlignRotorCount --;
if (AlignRotorCount == 0)
{
Update_PwmDuty((u32)PWM_ACCELERATE_START*FULL_DUTY/100); //更新初始加速占空比
AccelerateCommutateTime = TIM2_FREQ*20/START_RPM/MOTOR_POLES; //設(shè)計初始加速時間參數(shù)
/* 啟動TIM2，進(jìn)入到加速狀態(tài) */
TIM2_Counter = 0;
Clear_TIM2_Update_IF();
Enable_TIM2_Update_IT();
Clear_TIM1_CC4_IF();
Enable_TIM1_CC4_IT();
State = Accelerate;
//State = Stop;
}
}
}
void Commutate(void)
{
Disable_AH();
Disable_AL();
Disable_BH();
Disable_BL();
Disable_CH();
Disable_CL();
switch(Phase)
{
case 0: /* AB相 */
{
//Disable_CH();
Enable_AH();
Enable_BL();
#if (DIRECTION == COUNTER_CLOCKWISE)
Flag.BemfEdge = FALLING;
Phase = 1;
#else
Flag.BemfEdge = RISING;
Phase = 5;
#endif
}
break;
case 1: /* AC相 */
{
Enable_AH();
//Disable_BL();
Enable_CL();
#if (DIRECTION == COUNTER_CLOCKWISE)
Flag.BemfEdge = RISING;
Phase = 2;
#else
Flag.BemfEdge = FALLING;
Phase = 0;
#endif
}
break;
case 2: /* BC相 */
{
//Disable_AH();
Enable_BH();
Enable_CL();
#if (DIRECTION == COUNTER_CLOCKWISE)
Flag.BemfEdge = FALLING;
Phase = 3;
#else
Flag.BemfEdge = RISING;
Phase = 1;
#endif
}
break;
case 3: /* BA相 */
{
Enable_BH();
//Disable_CL();
Enable_AL();
#if (DIRECTION == COUNTER_CLOCKWISE)
Flag.BemfEdge = RISING;
Phase = 4;
#else
Flag.BemfEdge = FALLING;
Phase = 2;
#endif
}
break;
case 4: /* CA相 */
{
//Disable_BH();
Enable_CH();
Enable_AL();
#if (DIRECTION == COUNTER_CLOCKWISE)
Flag.BemfEdge = FALLING;
Phase = 5;
#else
Flag.BemfEdge = RISING;
Phase = 3;
#endif
}
break;
case 5: /* CB相 */
{
Enable_CH();
//Disable_AL();
Enable_BL();
#if (DIRECTION == COUNTER_CLOCKWISE)
Flag.BemfEdge = RISING;
Phase = 0;
#else
Flag.BemfEdge = FALLING;
Phase = 4;
#endif
}
break;
default:
break;
}
Flag.ZeroCross = 0;
BlankingCount = BLANKING_COUNT;
ZeroCrossCount = 0;
}
void Stop_Running(void)
{
Disable_PwmOutput();
Clear_TIM1_CC4_IF();
Disable_TIM1_CC4_IT();
Clear_TIM2_Update_IF();
Disable_TIM2_Update_IT();
State = Idle;
if(Flag.FailedStart) /* 輸出錯誤標(biāo)志 */
{
Flag.FailedStart = 0;
printf("Error: Failed to start!!!\n\r");
}
if(Flag.CurrentHigh)
{
Flag.CurrentHigh = 0;
printf("Error: Current is too large!!!\n\r");
}
if(Flag.SpeedHigh)
{
Flag.SpeedHigh = 0;
printf("Error: Motor speed is too high !!!\n\r");
}
if(Flag.SpeedLow)
{
Flag.SpeedLow = 0;
printf("Error: Motor speed is too low !!!\n\r");
}
if(Flag.LostZero)
{
Flag.LostZero = 0;
printf("Error: Sensor error !!!\n\r");
}
printf("Motor stop !!!\n\r");
}
// ROUNDUP( INDIRECT("E7") * 20 / ( INDIRECT("D13")* B7*B7 / INDIRECT("F13") / INDIRECT("F13") + INDIRECT("F7") ) / INDIRECT("G7") ,0 )
void Accelerate_Motor(void) // 加速
{
u16 speed = 0; // 新的目標(biāo)速度
u32 ct = 0; // 新的換向時間
speed = ((u32)AccelerateTime*AccelerateTime)/ACCELERATE_TIME; /* 計算新的目標(biāo)速度 */
speed = ((u32)(END_RPM - START_RPM)*speed)/ACCELERATE_TIME;
speed += START_RPM;
ct = (u32)TIM2_FREQ*20/speed/MOTOR_POLES; /* 將速度轉(zhuǎn)換為相應(yīng)的換向時長 */
//ct = AccelerateCommutateTime*14/15-1;
if(ct > 65535) AccelerateCommutateTime = 65535;
else AccelerateCommutateTime = ct;
PwmDuty = ((u32)PWM_ACCELERATE_DELTA*AccelerateTime/ACCELERATE_TIME); /* 計算PWM增量 */
PwmDuty += (u16)((u32)PWM_ACCELERATE_START*FULL_DUTY/100); /* 更新PWM */
Update_PwmDuty(PwmDuty);
if((AccelerateCommutateTime <= TIM2_FREQ*20/ZERO_ACQUIRE_RPM/MOTOR_POLES)&& /* 開始捕獲過零點 */
(Flag.AcquireZero == 0))
{
Flag.AcquireZero = 1;
ZeroAcquireCount = 0;
// Open_LED7();
}
if(AccelerateCommutateTime <= TIM2_FREQ*20/END_RPM/MOTOR_POLES) /* 加速到啟動終止速度時，啟動失敗 */
{
State = Stop;
Flag.FailedStart = 1;
Open_LED6();
}
}
void Check_ZeroCrossing(void)
{
u16 t = 0;
if(BlankingCount > 0) /* 等待消隱 */
{
BlankingCount --;
return;
}
if((Flag.BemfEdge == FALLING)&&(AdcBEMF < ZeroVref)) /* 判斷BEMF電壓是否過零 */
ZeroCrossCount ++;
if((Flag.BemfEdge == RISING)&&(AdcBEMF > ZeroVref))
ZeroCrossCount ++;
//Open_LED7();
if (ZeroCrossCount > ZERO_SAMPLES-1) /* 達(dá)到預(yù)期的過零次數(shù) */
{
BEMF_REC[ix] = AdcBEMF;
ix++;
if(ix>MaxIX) ix = 0;
//Open_LED8();
ZeroPeriod = TIM3_Counter; /* 從TIM3計數(shù)器讀取2次過零點的周期 */
TIM3_Counter = 0;
t = ZeroPeriod >> 1; /* 計算30度換向時長 */
CommutateTime = ((u32)t * (30 - ADVANCE_ANGLE))/30; /* 超前相位補償 */
if(CommutateTime > ZERO_CHECK_DELAY) /* ADC過零檢測延遲補償 */
CommutateTime -= ZERO_CHECK_DELAY;
else
CommutateTime = 1;
if (State == Running)
{
Flag.ZeroCross = 1;
Disable_TIM2_Update_IT();
TIM2->ARR = CommutateTime;
TIM2_Counter = 0;
Clear_TIM2_Update_IF();
Enable_TIM2_Update_IT();
Open_LED9(); // 標(biāo)志著已經(jīng)切換到閉環(huán)控制狀態(tài)
}
else /* 電機加速到同步運轉(zhuǎn)狀態(tài)的判斷 */
{
ZeroAcquireCount ++;
if(ZeroAcquireCount > ZERO_ACQUIRE_COUNT-1) /* 進(jìn)入過零點同步狀態(tài) */
{
Flag.ZeroCross = 1;
Disable_TIM2_Update_IT();
Flag.AcquireZero = 0;
State = Running;
TIM2->ARR = CommutateTime; /* 更新TIM2定時換向 */
TIM2_Counter = 0;
Clear_TIM2_Update_IF();
Enable_TIM2_Update_IT();
// Open_LED9(); // 標(biāo)志著已經(jīng)從開環(huán)加速正在切換到閉環(huán)控制狀態(tài)
}
}
}
}
/********************************************************************************************
* Function Name : void Get_MotorSpeed(void)
* Description : 計算電機速度程序
RPM = 60/((60°換向周期(秒)*6)*(極數(shù)/2)) = 20/(T*P)
* Input : 無
* Return : 無
*********************************************************************************************/
void Get_MotorSpeed(void)
{
static u16 t = 0;
t += ZeroPeriod; /* 計算2次60度換向周期的平均值 */
t = t >> 1;
MotorRpm = (u32)TIM2_FREQ*20/t/MOTOR_POLES; /* RPM = 60/((60°換向周期(秒)*6)*(極數(shù)/2)) = 20/(T*P) */
}
void Control_Speed(void)
{
u16 duty = 0;
duty = ((u32)AdcPotentiometer*FULL_DUTY)/4095; /* 將ADC轉(zhuǎn)換結(jié)果線性轉(zhuǎn)換為PWM的占空比 */
if(duty > PwmDuty) /* 逐漸調(diào)整PWM占空比，避免占空比調(diào)整步長太大導(dǎo)致電機失速 */
{
PwmDuty += 4;
if(PwmDuty > FULL_DUTY) PwmDuty = FULL_DUTY;
}
else if(duty < PwmDuty)
{
if(PwmDuty < 4) PwmDuty = 0;
else PwmDuty -= 4;
}
else return;
Update_PwmDuty(PwmDuty); /* 更新PWM占空比 */
}
/********************************************************************************************
* Function Name : void Monitor_Speed(void)
* Description : 電機失速監(jiān)控程序
* Input : 無
* Return : 無
*********************************************************************************************/
void Monitor_Speed(void)
{
if(MotorRpm < MIN_SPEED) /* 檢查電機速度是否過低 */
……………………
…………限于本文篇幅余下代碼請從51黑下載附件…………

復(fù)制代碼

下載：

bldc.rar (3.46 KB, 下載次數(shù): 183)

ID:268389 · 發(fā)表于 2018-4-19 21:03

正在做相關(guān)方向，參考一下，謝謝無私分享

ID:324611 · 發(fā)表于 2018-7-9 11:00

好東西，學(xué)習(xí)下。

ID:324611 · 發(fā)表于 2018-7-9 11:01

正在研究BLCD相關(guān)的東西，學(xué)習(xí)下。

ID:427831 · 發(fā)表于 2018-11-16 17:16

led是8位IO口嗎？沒太看懂你的

ID:460143 · 發(fā)表于 2019-1-2 15:43

樓主可以提供電路圖嗎？

ID:460143 · 發(fā)表于 2019-1-2 16:15

程序中的兩個頭文件在哪里呢？

ID:691135 · 發(fā)表于 2020-2-10 22:51

正在做相關(guān)方向，參考一下，謝謝無私分享,如果有原理圖配合程序那就更完美了。

ID:967978 · 發(fā)表于 2021-9-28 14:05

請問樓主有頭文件嗎？

ID:640527 · 發(fā)表于 2021-10-18 10:45

正要做這塊，幫大忙了，非常感謝

ID:194006 · 發(fā)表于 2021-11-27 21:03

正在學(xué)習(xí)無刷驅(qū)動，謝謝分享

ID:826226 · 發(fā)表于 2022-1-7 18:14

有更完整源碼嗎？

ID:412301 · 發(fā)表于 2023-9-9 15:51

配上原理圖就更完善了

帳號		自動登錄	找回密碼
密碼			立即注冊