STM32驱动步进电机 M2 ^5 R3 q- l
, U/ v: }, \9 ]2 J步进电机是将电脉冲信号转变为角位移或线位移,可以通过控制脉冲来控制,因此比一般的电机更精准。这篇文章将会讲述我对四线两项步进电机的调试经验。! N4 H k5 ?# p, L+ i3 m/ X
; J. x( j9 R/ {' ]& u( [& f9 w+ p3 A
1.步进电机以及THB7128的接线1 t8 n7 _1 ~+ z
THB7128步进电机驱动有两个接线口,J4口与stm32的IO口相接,J2口与步进电机和电源相接。
1 G( j& P+ v, _7 [7 x, U
0 E, k9 d; r/ n R3 w" D5 D, c: c2 I' [% ?$ g) m
J2口有6个端子,从两个端口旁的接口定义可以看出,接口分别为B-,B+,A-,A+,V-,V+。其中V+与9~32V的电源相接,V-接电源地,其余的接口B+,B-一组,A+,A-一组与步进电机的两组同相线相接(注:想要判断步进电机哪两根线同相,只需用万用表测量,短接的即为同相)。
8 A6 l; E0 z( l9 m' l
3 y" S* ?7 g; m6 o, _- b9 ^( m1 E- x" L, d8 h
J4口同样可以从端口定义看出,分别有CP+,CP-,DIR+,DIR-,EN+,EN-6个端子。CP为脉冲信号输入端,DIR为电机正反转控制端,EN为电机脱机控制端。在J4端口有共阳极和共阴极两种接线方法。
8 G9 z+ n/ W$ V. Z5 k共阳极接法:分别将CP+,DIR+,EN+连接到STM32板子的输出电压上,脉冲输入信号通过CP-接入;此时,DIR,EN-在低电平有效。' D. n9 k) I, y' q# t5 y- S
共阴极接法:分别将CP-,DIR-,EN-连接到控制系统的地端(与电源地隔离);此时脉冲输入信号通过CP+加入,U/D+,EN+在高电平有效。
/ E3 k5 h" a# H* w0 H) b(注:我采用的是共阴极接法,所以之后只介绍共阴极的程序); g9 a! t' [ Q$ M% S- Z+ `0 \
J4端口共阴极接线. @' S& B% ~ f
2. THB7128设置
$ c ^$ r( `( RTBH7128有6个拨盘开关(S1~S6),前3个开关控制细分设置,即控制电机每一步转动多少度,步距角=电机固有步距角/细分数。后三个S3~S6设置电流大小,设置的电流不要超过电机的额定电流。具体如何设置根据自己实际情况参考驱动芯片背后的说明表进行调节。说明表所示:
2 o8 Z6 f% {- I) G9 j4 b3.程序设计
, |& B5 [, b* m/ r- \6 Z4 Q(1)使步进电机稳定转动
! O# z- y8 _4 o驱动接收到一个脉冲步进电机就动一步,所以我们可以用定时器中断将脉冲按一定的频率从STM32的IO口输入到驱动中,这样就可以使步进电机稳定转动起来
* m3 S, Z9 M, B& K) @) {+ L$ }(2)步进电机的开启、截止以及变向
% \6 z. \6 O7 O R当THB7128使能端EN+接收到高电平时步进电机停止运转,接收到低电平时正常运转。因此改变与EN+相接的IO口的电平高低就可以控制电机的开启与截止。
/ T* L# ^/ N7 o/ c3 [# z当正反控制端DIR+接收到高电平时步进电机改变转动方向,改变相应的IO口电平即可让步进电机变向。9 p, u2 y4 H+ E; _
(3)步进电机变速
- z6 i3 F) A7 q0 ]4 D我用的定时器中断来驱动电机转动,所以只要想办法改变定时器中断的参数就可以让电机改变速度
: g% O ^5 ^8 B$ G/ @# k
4 g4 a7 Y! g) b3 c, r8 ^! w6 H9 W' B9 `3 W1 M6 S
具体程序如下:" O: S; f- R/ w
* G2 ?2 X0 ?& s1 {: {; ]' i
, z& ?: d& a# E! X# c* T
* E. b9 P- _1 a' ^1 {+ L# y
①定时器设置及IO口初始化2 b5 n$ r- k: l. s4 M
- #include "dianji.h"+ M: m9 Z; s( V G3 c- a* S
- #include "led.h"0 @5 [4 V3 q) T( e6 M
, d# ~# g I7 |% d' p& p; L5 T) q- void TIM3_Int_Init(u16 arr,u16 psc)
/ J7 I, \% u: F5 ~ - {0 p! V7 Z# @1 ~4 ]
- TIM_TimeBaseInitTypeDef TIM_TimeBaseStructure;
3 w, m" b$ j/ u - NVIC_InitTypeDef NVIC_InitStructure;
6 y9 `- m' x; u/ v' {) F - 6 @4 x4 X4 S' J- N; L
- RCC_APB1PeriphClockCmd(RCC_APB1Periph_TIM3, ENABLE); //时钟使能. @ F# Q7 X& A- X. Y }
- ( n3 e. _+ I1 Z U! X
- //定时器TIM3初始化! h4 l% V! f# A
- TIM_TimeBaseStructure.TIM_Period = arr;//自动重装载寄存器周期的值& L" x- ?' ]& l$ C& t2 p2 b
- TIM_TimeBaseStructure.TIM_Prescaler = psc;//预分频值
" d- _8 a$ [, \2 q' x' H' l - TIM_TimeBaseStructure.TIM_ClockDivision = TIM_CKD_DIV1;//设置时钟分割
' |$ ~& z* L4 n+ c) H) U - TIM_TimeBaseStructure.TIM_CounterMode = TIM_CounterMode_Up;//向上计数模式0 v9 _- S: J2 \
- TIM_TimeBaseInit(TIM3,&TIM_TimeBaseStructure);
+ Q2 ^5 ^; W- l: U( ?* r' D6 V) l
' Z* ]7 z' G+ `! q2 ]+ e- TIM_ITConfig(TIM3,TIM_IT_Update,ENABLE); //使能指定的TIM3中断,允许更新中断4 ~5 `5 |+ k( t
, E! K! f/ u5 M) |- //中断优先级NVIC设置
; Y6 a3 M+ v4 x% M - NVIC_InitStructure.NVIC_IRQChannel = TIM3_IRQn;//TIM3中断& L5 n# H7 v. }; @8 R& ~# s; i) M8 b
- NVIC_InitStructure.NVIC_IRQChannelCmd =ENABLE; # r% i% T. q* h) {% k# s
- NVIC_InitStructure.NVIC_IRQChannelPreemptionPriority = 0; //抢占优先级
5 O& O# M$ |& y/ ? - NVIC_InitStructure.NVIC_IRQChannelSubPriority = 3;//响应优先级
) _1 j3 _* o; c5 e - NVIC_Init(&NVIC_InitStructure);
: m- h: k) k# E* c
8 L# R0 C- T! Y- TIM_Cmd(TIM3,ENABLE);//使能TIMx
5 i! T, C" r d- V a Y+ ? - }
( F! A) |8 e& S% g$ ?
; h2 O1 y9 c% o5 @& f2 B6 B- void TIM3_IRQHandler(void)//TIM3中断函数* y& p+ t6 G# G! e- z
- {
- [; [5 `# p. X) ] - if(TIM_GetITStatus(TIM3,TIM_IT_Update) != RESET)//检查TIM3更新中断发生与否
- ?$ j0 b+ S- Y6 u8 t/ I - {7 D+ f! y; U. m7 ?0 p" W
- TIM_ClearITPendingBit(TIM3,TIM_IT_Update);//清除TIMx更新中断标志4 q! d: {% P- G
- LED0=!LED0;" n% ] Z! o5 }7 c
- }
6 M, W3 {7 D" L/ [0 [% z - }
. X( R' C- W" ~& j2 ~; F
- g' V, R) f$ @' a. W2 `
0 N8 b' f8 ?& P8 f. c6 \; a' h- B- void DJ_Init(void)2 L+ B. y' t `/ z
- {; N6 G# A/ l2 O6 x
- GPIO_InitTypeDef GPIO_InitStruct;8 _: O( v9 e6 u0 S- j+ r
& k% y$ ~7 n* u* |# Z- RCC_APB2PeriphClockCmd(RCC_APB2Periph_GPIOB,ENABLE);//使能GPIOB( v+ V% B/ S9 @- D. |( X6 N
- RCC_APB2PeriphClockCmd(RCC_APB2Periph_GPIOG,ENABLE);//使能GPIOG5 J! V& J7 J' ^6 u
* F6 C8 G# H4 N# q5 @6 G" P- GPIO_InitStruct.GPIO_Mode = GPIO_Mode_Out_PP;//推挽输出
; Y& q- `* | L: `6 x - GPIO_InitStruct.GPIO_Pin = GPIO_Pin_6|GPIO_Pin_4;
6 A5 ~ m$ Y* w" e6 t6 k/ Q* [, u - GPIO_InitStruct.GPIO_Speed = GPIO_Speed_50MHz;, L0 y8 t- K- F" x
- GPIO_Init(GPIOB,&GPIO_InitStruct);
5 h) \" r( q( A$ ` - GPIO_SetBits(GPIOB,GPIO_Pin_6);
8 M5 G) p( F( U
1 f8 ]1 \' ^1 D' W2 M- GPIO_InitStruct.GPIO_Mode = GPIO_Mode_Out_PP;//推挽输出 8 n K6 }5 N; ^! a7 g
- GPIO_InitStruct.GPIO_Pin = GPIO_Pin_9;
5 v' W( u7 s8 ? - GPIO_InitStruct.GPIO_Speed = GPIO_Speed_50MHz;
4 \, S# S* g0 \. T' V - GPIO_Init(GPIOG,&GPIO_InitStruct);2 G" o( [7 m4 M7 ~6 f3 `
- GPIO_SetBits(GPIOG,GPIO_Pin_9);
# J- c; Y2 U+ D3 y6 W - }
复制代码 ②主函数(具体操作控制)
$ i1 N! ^. G* N* F D1 q! ?- #include "stm32f10x.h"$ m, W$ [% N q' F/ L8 T% I
- #include "usart.h"
0 G$ O! j, c5 w - #include "led.h"
0 E- U% r5 A, A2 ~6 |. h- E0 \5 u - #include "delay.h"5 P5 Z* i. `; F8 w+ |' u3 J
- #include "sys.h"
9 K1 v. E6 h+ V - #include "timer.h"9 B) {' y B$ P( Z; G
- #include "key.h"
, z- U8 S( k* Y% X- K- x! o - #include "dianji.h"$ C% K: r& P3 ^! e6 S, ~
- - E" \& b! Z* \) f& J& q
- #define up 1 / @2 x1 n' q5 b
- #define down 0
0 E1 ~) H4 S: C$ ]0 j, g - ) M0 o$ B. E3 Z1 o3 H: A
% Y7 Y1 }9 C: ^/ H w- int main(void)- ^" n9 k; o" s) q& g. A$ h1 z
- {
* o/ `5 ~1 s! a4 K8 _! o; }6 p4 E - vu8 key = 0;
( D' Y8 W, l1 `5 E' s9 u7 x I - vu8 key1 = 0;( s8 C: |- u' i! V! L- X3 y
- vu8 num0 = 0;
4 s1 P3 ^; Z! H. X) @% V& @ - vu8 num1 = 0;
' h) d' F) c- W( g+ U1 v - vu8 num2 = 0;7 A) k" A7 U; o8 Y% i3 M
- vu8 speed = 1;7 [% n9 `" `# d# c
- vu16 arrLowest = 189;/ B" n8 C( }% j
- vu16 arrMax= 409;' Z( ?5 g# _3 l/ b* m
- vu16 arr =299;/ e) F F5 N( y/ l+ t3 F! k& I# z$ ~2 x
- vu16 psc = 359;
; r+ [6 a) b n* W% }. z - LED_Init();: N \( R9 V2 s( I4 y
- delay_init();6 k9 O Q3 }( V& F9 J! R
- KEY_Init();
- ]0 s3 }$ o" G6 f! G - DJ_Init();6 k4 q$ s7 j, W- z
- NVIC_PriorityGroupConfig(NVIC_PriorityGroup_2);2 q' s* Q. T0 t- t( q
- uart_init(115200); //串口初始化为115200! z5 I0 J& {) E
- 6 Z* Z) T1 |" y3 C
- TIM3_Int_Init(arr,psc);//10Khz的计数频率,计数到100为10ms (arr+1)*(psc+1)/72
8 P/ Z* h/ X$ ~+ S2 w4 h3 G4 y - while(1)
, u6 e" C/ y6 ~0 Z# v - {
: h8 o9 N6 @6 H: ? - key = KEY_Scan(0);
6 L" U) W9 M) h. | - if(key == KEY0_PRES)
8 h+ z; H6 R' p# p - {
: a& r7 H) |# U! N/ e1 P4 r+ u - if(num0 == 0)+ O5 W" y* f- G- z3 ?4 _
- {
$ A7 D6 q2 v# b) ^) R - num0 = 1;
: r8 d8 _8 K( V2 d1 R* | - LED1=0;3 z- |2 R K! |( M6 ^0 `# L
- GPIO_ResetBits(GPIOB,GPIO_Pin_6);
2 Z( o' j! C$ t3 Z - }
- T+ f @. O, J - else- M9 E( ~3 V$ ?) [; F
- {& w( T# ?" t; g. C+ C8 X* l
- num0 = 0;0 f9 j2 g( d. ?7 O. i/ Y
- LED1=1;
: V/ r. Z$ M0 W0 L0 [# H2 ~8 F _ - GPIO_SetBits(GPIOB,GPIO_Pin_6);& e' y6 p K3 N. q% S
- }$ b) { a$ g: ~: y0 K
- }
2 y8 P3 K/ A3 j3 r3 Q - if(key == KEY1_PRES)2 e1 g+ r9 s- t8 a* ^
- {- i4 s/ x# H2 p
- if(num2 == 0)
: P# o: T# L+ C% W& J" q d - {
) t$ ~9 A2 ^1 s- S/ @ - GPIO_SetBits(GPIOG,GPIO_Pin_9);
7 h9 J) o/ I" } I, T$ E - num2 = 1;
1 p9 b8 {, U. g/ W/ L - }
) |4 Q s ~9 e( y1 W4 D - else7 n( ~2 |- l$ O4 Q* v* L
- {
& O7 I- q& s5 i - GPIO_ResetBits(GPIOG,GPIO_Pin_9);: m6 E- F( M$ V7 _$ X y' I& P) Y( e
- num2 = 0;
; c& C1 V' w: O) J( t6 G - }
2 f! M* J6 U+ _9 h) [ - }
1 Z9 e$ u- p5 @/ t: K1 n - while(key == WKUP_PRES)
]7 K; i' ]+ _; s- m* U: |7 y. T6 k - {
# d$ ]/ c; G0 r - if(speed == down)
! W( J8 [* e% e9 B$ ~ - {
' E7 N! t, L" }# k0 V. Y _% J - arr+=2;
( R5 F: i6 j' }& Z @9 m - TIM3_Int_Init(arr,psc);
7 q. Y7 v1 {" i' A. r - delay_ms(50);: G/ X8 \ ~: e' u
- key1 = KEY_Scan(0);
6 H4 Y2 ^8 h1 o$ r8 L! O - if(arr > arrMax)9 \0 V, _1 i) t
- {! {/ d( B6 ]4 ? u& w4 a
- speed = up;
. U' q6 D; o8 O/ ~. O - }
& \9 W" b8 L( s% P( j - if(key1 == WKUP_PRES)//关闭变速
; z- o7 B/ n# u* f - {, H# Q: F8 N& h
- LED1 = 0;
q3 p1 z+ q- h) P - key = 0;, V7 f2 W, j/ X0 A0 f% W, M, y
- }$ |: Z* }4 M3 @5 Y D
- }8 I, j) q& B, Z9 A$ ?0 _( u
- if(speed == up)9 s8 g1 E/ ]. ]1 J& ^; P0 T
- { 1 F$ H5 B- r! x5 |
- arr-=2;
' {2 u0 v/ S4 P1 Y! s - TIM3_Int_Init(arr,psc);
: ?5 t! O' o @ - delay_ms(50);+ |: d# \( w7 A% a
- if(arr < arrLowest)( d0 i: }8 S. l# |2 C
- {
; T" D% D$ z+ x - speed = down;1 M% j" [- k6 `) r2 D# [8 w
- }4 T5 c8 J9 H: v- Q1 W
- key1 = KEY_Scan(0);; n4 b* L% u/ ^
- if(key1 == WKUP_PRES)
1 z% k. K& K; S" [0 c' r* J; D - {
) t4 ^3 c+ f4 r2 F; G - LED1 = 0;$ ^( ~* B8 M: s8 e
- key = 0;
3 ^ p" F2 x a9 y1 v# \ - } 1 q7 ?* Z2 u4 L# `$ H. L8 \; f* b/ W
- }
& K5 u3 C, `6 P0 f+ Y3 X - } 9 O! O9 C5 P, H" a+ d6 K
- }
4 b' L5 g* I& U7 j: G0 Y% P3 W. d - }
复制代码 4.总结$ d$ _0 N5 D! a& k* `6 f
通过以上过程的调试,我实现了用按键控制步进电机的启动、截止、变向以及加减速这些功能。
" B# q/ F- R R; ] w; ^: T9 Q可能我的电机驱动和大家的不一样, 希望能让读者起到参考作用。3 T2 P9 n+ Q% d) v% E* b
3 ~1 B* Q; Q7 T/ ?+ G
|