STC15W401AS-實現四軸飛行器無刷電機的電調控制-參考程序和電路

ID:603344 · 發表于 2019-9-1 18:23

STC15W401AS-實現四軸飛行器無刷電機的電調控制電路原理圖如下：

單片機源程序如下:

/*---------------------------------------------------------------------*/
/* --- STC MCU International Limited ----------------------------------*/
/* --- STC 1T Series MCU Demo Programme -------------------------------*/
/* --- QQ: 800003751 -------------------------------------------------*/
/* 如果要在程序中使用此代碼,請在程序中注明使用了宏晶科技的資料及程序 */
/*---------------------------------------------------------------------*/
/************* 功能說明 **************
本程序試驗使用STC15W401AS-35I-SOP16<RMB1.6>來驅動航模用的無傳感器無刷三相直流馬達.
本程序參考自網上的代碼(作者: 瑞生), 改良而來.
電路圖見文件 "BLDC-V10-實驗電路.pdf".
控制信號由P3.2輸入正脈沖信號, 間隔5~20ms, 脈沖寬度1.000~1.610ms.
1.160ms開始啟動, 1.610ms為最高速度, 分辨率為2us.
本程序僅僅是簡單控制, 軟件沒有處理過0延時30度切換過流檢測.
由于過0檢測部分有RC濾波, 所以改變電容值可以大約的對應在最高速時延時30度的時間.
有意者可自行完善電路和程序.
******************************************/
#define MAIN_Fosc 24000000L //定義主時鐘
#include "STC15Fxxxx.H"
#define MCU_PIN 16 /* 選擇MCU引腳數, 只支持16或20腳(28腳或32腳跟20腳一樣) */
//CMPCR1
#define CMPEN 0x80 //1: 允許比較器, 0: 禁止,關閉比較器電源
#define CMPIF 0x40 //比較器中斷標志, 包括上升沿或下降沿中斷, 軟件清0
#define PIE 0x20 //1: 比較結果由0變1, 產生上升沿中斷
#define NIE 0x10 //1: 比較結果由1變0, 產生下降沿中斷
#define PIS 0x08 //輸入正極性選擇, 0: 選擇外部P5.5做正輸入, 1: 由ADCIS[2:0]所選擇的ADC輸入端做正輸入.
#define NIS 0x04 //輸入負極性選擇, 0: 選擇內部BandGap電壓BGv做負輸入, 1: 選擇外部P5.4做輸入.
#define CMPOE 0x02 //1: 允許比較結果輸出到P1.2, 0: 禁止.
#define CMPRES 0x01 //比較結果, 1: CMP+電平高于CMP-, 0: CMP+電平低于CMP-, 只讀
//CMPCR2
#define INVCMPO 0x80 //1: 比較器輸出取反, 0: 不取反
#define DISFLT 0x40 //1: 關閉0.1uF濾波, 0: 允許
#define LCDTY 0x00 //0~63, 比較結果變化延時周期數
#if (MCU_PIN == 20)
sbit PWM2_L = P3^4;
sbit PWM1_L = P3^5;
sbit PWM0_L = P3^6;
#endif
#if (MCU_PIN == 16)
sbit PWM2_L = P5^5;
sbit PWM1_L = P3^3;
sbit PWM0_L = P3^6;
#endif
u8 Step;
u8 PWM_Value; // 決定PWM占空比的值
u16 RxPulseWide;
bit B_RxOk;
bit B_RUN;
u8 PWW_Set;
u8 cnt10ms;
u8 Rx_cnt;
u8 TimeOut; //堵轉超時
#define DISABLE_CMP_INT CMPCR1 &= ~0X40 // 關閉比較器中斷
#define ENABLE_CMP_INT CMPCR1 |= 0X40 // 打開比較器中斷
/*************************/
void Delay_n_ms(u8 dly)
{
u16 j;
do
{
j = MAIN_Fosc / 13000; //延時1ms, 主程序在此節拍下運行
while(--j) ;
}while(--dly);
}
void delay_us(u8 us)
{
do
{
NOP(20); //@24MHz
}
while(--us);
}
void StepXL(void) // 換相序列函數
{
switch(Step)
{
case 0: // AB
PWM0_L=0; PWM2_L=0;
CCAP0H = PWM_Value; CCAP1H=0; CCAP2H=0; // 打開A相的高端
PWM1_L = 1; // 打開B相的低端
ADC_CONTR = 0XED; // 選擇P1.5作為ADC輸入即c相電壓
CMPCR1 = 0x9C; //bit7=1 允許比較器, bit4=1 比較結果由1變0, 產生下降沿中斷 (不能響應下降沿中斷?)
break;
case 1: // AC
PWM0_L=0; PWM1_L=0;
CCAP0H = PWM_Value; CCAP1H=0; CCAP2H=0; // 打開A相的高端
PWM2_L = 1; // 打開C相的低端
ADC_CONTR = 0XEC; // 選擇P1.4作為ADC輸入即B相電壓
CMPCR1 = 0xAC; //上升沿中斷
break;
case 2: // BC
PWM0_L=0; PWM1_L=0;
CCAP0H=0; CCAP2H=0; CCAP1H = PWM_Value; // 打開B相的高端
PWM2_L = 1; // 打開C相的低端
ADC_CONTR = 0XEB; // 選擇P1.3作為ADC輸入即a相電壓
CMPCR1 = 0x9C; //下降沿中斷
break;
case 3: // BA
PWM1_L=0; PWM2_L=0;
CCAP0H=0; CCAP2H=0; CCAP1H = PWM_Value; // 打開B相的高端
PWM0_L = 1; // 打開A相的低端
ADC_CONTR = 0XED; // 選擇P1.5作為ADC輸入即c相電壓
CMPCR1 = 0xAC; //上升沿中斷
break;
case 4: // CA
PWM1_L=0; PWM2_L=0;
CCAP0H=0; CCAP1H=0; CCAP2H = PWM_Value; // 打開C相的高端
PWM0_L = 1; // 打開A相的低端
ADC_CONTR = 0XEC; // 選擇P1.4作為ADC輸入即B相電壓
CMPCR1 = 0x9C; //下降沿中斷
break;
case 5: // CB
PWM0_L=0; PWM2_L=0;
CCAP0H=0; CCAP1H=0; CCAP2H = PWM_Value;// 打開C相的高端
PWM1_L = 1; // 打開B相的低端
ADC_CONTR = 0XEB; // 選擇P1.3作為ADC輸入即a相電壓
CMPCR1 = 0xAC; //上升沿中斷
break;
default:
break;
}
}
void PWM_Init(void)
{
PWM0_L = 0;
PWM1_L = 0;
PWM2_L = 0;
#if (MCU_PIN == 20)
P3n_push_pull(0x70);
#endif
#if (MCU_PIN == 16)
P3n_push_pull(0x48);
P5n_push_pull(0x20);
#endif
// CMOD = 1 << 1; //選擇系統時鐘/2為時鐘源，即PWM頻率=24M/2/256=46.9K
CMOD = 5 << 1; //選擇系統時鐘/4為時鐘源，即PWM頻率=24M/4/256=23.4K
// CMOD = 6 << 1; //選擇系統時鐘/6為時鐘源，即PWM頻率=24M/6/256=15.6K
CL=0; // PCA計數器清零
CH=0;
PCA_PWM0 = 0X00;
CCAP0H=0; // 初始化占空比為0% H的值裝載到L中
CCAP0L=0;
CCAPM0=0x42; // 設置為PWM模式
PCA_PWM1 = 0X00;
CCAP1H=0; // 初始化占空比為0%
CCAP1L=0;
CCAPM1=0x42; // 設置為PWM模式
PCA_PWM2 = 0X00;
CCAP2H=0; // 初始化占空比為0%
CCAP2L=0;
CCAPM2=0x42; // 設置為PWM模式
CR = 1;
}
void ADC_Init(void)
{
P1n_pure_input(0x38);
P1ASF = 0X38; // 開通P1.3 P1.4 P1.5的AD輸入口
}
void CMP_INT(void) interrupt 21
{
CMPCR1 &= ~0X40; // 需軟件清除中斷標志位
if(Step<5) Step++;
else Step = 0;
StepXL();
TimeOut = 10; //10ms超時
}
void CMP_Init(void)
{
CMPCR1 = 0X8C; // 1000 1100 打開比較器，P5.4作為比較器的反相輸入端，ADC引腳作為正輸入端
CMPCR2 = 60; // 60個時鐘濾波
P5n_pure_input(0x10);
}
u8 StartMotor(void)
{
u16 timer,i;
DISABLE_CMP_INT; // 禁止比較器中斷
PWM_Value = 30; // 初始占空比=16/256=6%
Step = 0;
StepXL(); // 初始位置
Delay_n_ms(5);//delay_ms(5);
timer = 300;
while(1)
{
for(i=0; i<timer; i++) delay_us(50); //
timer -= timer /15 + 1;
if(timer < 25) return(1);
if( Step < 5) Step++;
else Step = 0;
StepXL();
}
}
void T0_Iint(void)
{
Timer0_AsTimer(); /* 時器0用做定時器 */
Timer0_12T(); /* Timer0 clodk = fo/12 12分頻, default */
Timer0_16bit();
Timer0_Gate_INT0_P32(); /* 時器0由外部INT0高電平允許定時計數 */
TH0 = 0;
TL0 = 0;
TR0 = 1; // 打開定時器0
ET0 = 1;// 允許ET0中斷
}
void T0_Interrupt(void) interrupt 1
{
Rx_cnt = 0; //一旦出現溢出, 則開始的n個脈沖無效
RxPulseWide = 1000; //停止
B_RxOk = 1; //虛擬收到一個脈沖
}
/********************* INT0中斷函數 *************************/
void INT0_int (void) interrupt INT0_VECTOR
{
u16 j;
TR0 = 0;
j = ((u16)TH0 << 8) + TL0;
TH0 = 0;
TL0 = 0;
TR0 = 1;
if(++Rx_cnt >= 5) Rx_cnt = 5;
j >>= 1; //為了好處理, 轉成單位為us
if((j >= 800) && (j <= 2000) && (Rx_cnt == 5))
{
RxPulseWide = j;
B_RxOk = 1; //標志收到一個脈沖
}
}
/**********************************************/
void main(void)
{
u16 j;
PWM_Init();
ADC_Init();
CMP_Init();
T0_Iint();
IE0 = 0; // 清除外中斷0標志位
EX0 = 1; // INT0 Enable
IT0 = 1; //INT0 下降沿中斷
RxPulseWide = 1000;
PWW_Set = 0;
cnt10ms = 0;
Rx_cnt = 0;
TimeOut = 0;
EA = 1; // 打開總中斷
while (1)
{
Delay_n_ms(1); //延時1ms, 主程序在此節拍下運行
if(TimeOut > 0)
{
if(--TimeOut == 0) //堵轉超時
{
CCAP0H=0; CCAP1H=0; CCAP2H=0; // 占空比為0
PWM0_L=0; PWM1_L=0; PWM2_L=0;
DISABLE_CMP_INT; // 關比較器中斷
Delay_n_ms(250); //堵轉時,延時1秒再啟動
Delay_n_ms(250);
Delay_n_ms(250);
Delay_n_ms(250);
RxPulseWide = 1000;
PWW_Set = 0;
PWM_Value = 0;
B_RxOk = 0;
B_RUN = 0;
Rx_cnt = 0;
TimeOut = 0;
}
}
if(B_RxOk) //收到一個脈沖
{
B_RxOk = 0;
j = RxPulseWide;
if(j >= 1100) // 1100~1610對應PWM占空比值0~255
{
j = (j - 1100) >> 1; //2us對應PWM一個步進
if(j > 256) j = 255;
}
else j = 0;
PWW_Set = (u8)j;
}
if(!B_RUN && (PWW_Set >= 30)) // PWM_Set >= 30, 并且馬達未運行, 則啟動馬達
{
StartMotor(); // 啟動馬達
CMPCR1 &= ~0X40; // 需軟件清除中斷標志位
ENABLE_CMP_INT; // 打開比較器中斷
B_RUN = 1;
TimeOut = 0;
}
if(++cnt10ms >= 10) // 10ms時隙
{
cnt10ms = 0;
if(B_RUN)
{
if(PWM_Value < PWW_Set) PWM_Value++;
if(PWM_Value > PWW_Set) PWM_Value--;
if(PWM_Value < 20) // 停轉
{
PWM_Value = 0;
B_RUN = 0;
CCAP0H=0; CCAP1H=0; CCAP2H=0; // 占空比為0
PWM0_L=0; PWM1_L=0; PWM2_L=0;
DISABLE_CMP_INT; // 關比較器中斷
}
}
}
}
}

復制代碼

所有資料51hei提供下載:

STC15W401AS-實現四軸飛行器無刷電機的電調控制-參考程序和電路.zip (161.85 KB, 下載次數: 247)

ID:56665 · 發表于 2019-9-2 19:27

我怎么沒有看到哪里有過流檢測。

ID:639666 · 發表于 2021-2-11 10:48

本電路和程序沒過流保護，要用到大功率P溝場管，限制了高電源電壓的應用，在15伏左右的電源電壓下玩玩是可以的。食之無味，棄之可惜。

ID:671687 · 發表于 2021-3-30 12:44

問個問題，樓主P13 P14 P15 P54是干嘛用的，可以省嗎？

ID:73327 · 發表于 2021-8-26 22:37

感謝樓主分享！學習學習啦！

ID:73327 · 發表于 2021-8-26 22:38

stc8a864a12 發表于 2021-3-30 12:44
問個問題，樓主P13 P14 P15 P54是干嘛用的，可以省嗎？

不可以省，過零點檢測用的！

ID:1014955 · 發表于 2022-4-1 17:07

可以做普通單相電機嗎？4極矽鋼片，普通散熱風扇。有做過程序嗎？

ID:378732 · 發表于 2022-4-3 16:55

這不是STC官網的例程嗎

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

	7^# 無效樓層，該帖已經被刪除

	8^# 無效樓層，該帖已經被刪除

	11^# 無效樓層，該帖已經被刪除

欧美极品高清xxxxhd,国产日产欧美最新,无码AV国产东京热AV无码,国产精品人与动性XXX,国产传媒亚洲综合一区二区,四库影院永久国产精品,毛片免费免费高清视频,福利所导航夜趣136

STC15W401AS-實現四軸飛行器無刷電機的電調控制-參考程序和電路