DMA 原理从 0 到 1:为什么它能解放 CPU?一文讲透 DMA 的工作流程
【福利三:雨露均沾·逢7狂欢】之五:STM32系统时钟PLL故障排除1例
【福利三:雨露均沾·逢7狂欢】之三:AI帮我查BUG
福利三:雨露均沾·逢7狂欢】之二:STM32F407VG串口通信乱码故障的排除
基于STM32F103的I2C主从机通信
OpenBLT移植到STM32F103战舰开发板上适用于所有STM32F103系列的Bootloader
TFT LCD 与 FSMC 的硬件连接大容量 STM32F10xxx FSMC 接口
单片机:初学者该了解的STM32F103基础知识
2025软件工具兔哥知道
STM32之继电器模块
微信公众号
手机版
/**3 R% n! Q* Q7 O" m# |& h, ?
* 函数功能: 定时器中断服务函数
* 输入参数: 无3 G$ X% f0 n0 d* T) v
* 返 回 值: 无
* 说 明: 实现加减速过程
*/- J2 P$ {$ j: O! J% v0 z( q) e
void STEPMOTOR_TIMx_IRQHandler(void)//定时器中断处理/ T0 m$ D! V3 O. }$ _7 y- [
{ & d) ?: v# p; u; w, p" o5 N: `# u: C
__IO uint16_t tim_count=0;
// 保存新(下)一个延时周期
uint16_t new_step_delay=0;
// 加速过程中最后一次延时(脉冲周期).
__IO static uint16_t last_accel_delay=0;
// 总移动步数计数器$ v3 I4 E( \' `5 c' a: i% L
__IO static uint32_t step_count = 0;1 k3 G7 D% S: W" x. P7 }' H
// 记录new_step_delay中的余数,提高下一步计算的精度9 ^. K% Y" H) v3 _' y6 v
__IO static int32_t rest = 0;+ N3 e5 ?: O$ L4 ?! z; n% {
//定时器使用翻转模式,需要进入两次中断才输出一个完整脉冲0 }! S3 Z$ i- Q) ?: u4 X
__IO static uint8_t i=0;
if(__HAL_TIM_GET_IT_SOURCE(&htimx_STEPMOTOR, STEPMOTOR_TIM_IT_CCx) !=RESET)
{
// 清楚定时器中断
__HAL_TIM_CLEAR_IT(&htimx_STEPMOTOR, STEPMOTOR_TIM_IT_CCx);* ^7 M. `' X0 `7 ]
// 设置比较值3 ^- `4 Z' T* }1 R$ p
tim_count=__HAL_TIM_GET_COUNTER(&htimx_STEPMOTOR);9 o7 T4 B3 P. h# L
__HAL_TIM_SET_COMPARE(&htimx_STEPMOTOR,STEPMOTOR_TIM_CHANNEL_x,tim_count+srd.step_delay);
# U y5 l+ D4 W0 m0 ~( L' t. W
i++; // 定时器中断次数计数值3 ?6 _4 C0 y) ]: W+ _4 a1 K. j
if(i==2) // 2次,说明已经输出一个完整脉冲9 _7 l) s- ~8 Z: q
{
i=0; // 清零定时器中断次数计数值/ g- a! n7 w/ s6 @
switch(srd.run_state) // 加减速曲线阶段. C6 X! ?7 J1 ~; B8 @
{
case STOP:
step_count = 0; // 清零步数计数器
rest = 0; // 清零余值6 K8 t0 V" b2 o9 L+ ~6 |8 O9 z
// 关闭通道
TIM_CCxChannelCmd(STEPMOTOR_TIMx, STEPMOTOR_TIM_CHANNEL_x, TIM_CCx_DISABLE);
__HAL_TIM_CLEAR_FLAG(&htimx_STEPMOTOR, STEPMOTOR_TIM_FLAG_CCx);, ^8 X" z, w& _* {
STEPMOTOR_OUTPUT_DISABLE();
MotionStatus = 0; // 电机为停止状态
break;
case ACCEL:
step_count++; // 步数加1. G3 V4 [0 F2 v- k2 F. b: V3 p6 ~& B
if(srd.dir==CW)5 J+ t/ |5 Z0 j; V4 y2 V
{
step_position++; // 绝对位置加1
}
else
{
step_position--; // 绝对位置减1; S6 N# O5 ^1 x* ?4 }0 G
}
srd.accel_count++; // 加速计数值加1+ u; Q+ x; h5 |. @5 W/ Y
new_step_delay = srd.step_delay - (((2 *srd.step_delay) + rest)/(4 * srd.accel_count + 1));//计算新(下)一步脉冲周期(时间间隔)
rest = ((2 * srd.step_delay)+rest)%(4 * srd.accel_count + 1);// 计算余数,下次计算补上余数,减少误差
if(step_count >= srd.decel_start)// 检查是够应该开始减速+ Y, o8 v. F0 \8 p( z
{# |4 M0 i& e- O& C
srd.accel_count = srd.decel_val; // 加速计数值为减速阶段计数值的初始值
srd.run_state = DECEL; // 下个脉冲进入减速阶段/ Q2 V# n7 i" O
}
else if(new_step_delay <= srd.min_delay) // 检查是否到达期望的最大速度# e' ^2 p7 Y% d, M
{
last_accel_delay = new_step_delay; // 保存加速过程中最后一次延时(脉冲周期)5 Z2 r* k/ u% l, a. D. R- d* ?* f
new_step_delay = srd.min_delay; // 使用min_delay(对应最大速度speed)6 i- G7 x, M- y% l- u& E# H
rest = 0; // 清零余值: Y* c; }: r) O2 D( }( j
srd.run_state = RUN; // 设置为匀速运行状态
}# x5 h2 F& B$ x( l% e$ h/ V0 L6 I
break;
case RUN:
step_count++; // 步数加1
if(srd.dir==CW)* t! W) X1 k/ Z
{ 8 N% y6 T: R7 {% @" A1 x5 t* M
step_position++; // 绝对位置加1, E' \( C- j( t+ V+ F" L" N
}
else9 p2 o" g" g* y( `
{+ h( f9 Z& k& S* t" x" o( J
step_position--; // 绝对位置减1
}
new_step_delay = srd.min_delay; // 使用min_delay(对应最大速度speed)
if(step_count >= srd.decel_start) // 需要开始减速! l! j4 U8 S# `* b$ D
{5 N1 ]+ V1 ]4 b. W3 c
srd.accel_count = srd.decel_val; // 减速步数做为加速计数值
new_step_delay = last_accel_delay;// 加阶段最后的延时做为减速阶段的起始延时(脉冲周期)2 u+ U1 z. G! Z- c$ p# c! g/ E% k
srd.run_state = DECEL; // 状态改变为减速4 x+ ^: e* ^0 v W
}
break;
case DECEL:
step_count++; // 步数加13 |& i2 ^* u9 z5 r( x
if(srd.dir==CW)
{ 8 z+ I J) A( [* }; ?1 y9 T' g; Z- D
step_position++; // 绝对位置加1. b, E- v# D T( {* f
}
else
{3 w- w. V" q( c+ P5 l5 ]4 x
step_position--; // 绝对位置减11 v7 A4 H" P- a* ?, r9 C" P; m; L( y
}
srd.accel_count++;
new_step_delay = srd.step_delay - (((2 * srd.step_delay) + rest)/(4 * srd.accel_count + 1)); //计算新(下)一步脉冲周期(时间间隔)
rest = ((2 * srd.step_delay)+rest)%(4 * srd.accel_count + 1);// 计算余数,下次计算补上余数,减少误差
//检查是否为最后一步/ m( g4 G: [0 @, q& b! ^! r' o/ Z+ ?
if(srd.accel_count >= 0)
{
srd.run_state = STOP;
}
break;
} - o* ]$ ^ u: `1 ?( {
srd.step_delay = new_step_delay; // 为下个(新的)延时(脉冲周期)赋值! v2 i, `( t" i. z1 Z) Q. c1 p
}
}
}
/**8 R; T6 ~4 }! i
* 函数功能: 相对位置运动:运动给定的步数5 d1 \; s) u& C. |- w, _4 c: | A
* 输入参数: step:移动的步数 (正数为顺时针,负数为逆时针).. D9 G6 o* U, C- T2 l p! X1 R0 c
accel 加速度,实际值为accel*0.1*rad/sec^2# t6 q% O* s& W' X Q6 b5 L
decel 减速度,实际值为decel*0.1*rad/sec^2
speed 最大速度,实际值为speed*0.1*rad/sec0 T3 B* S% k& r" S, J8 s. R' E
* 返 回 值: 无- e0 w# C* \+ T" Z
* 说 明: 以给定的步数移动步进电机,先加速到最大速度,然后在合适位置开始) V& w) G+ \# `6 l: O
* 减速至停止,使得整个运动距离为指定的步数。如果加减速阶段很短并且% q% x; H8 R- {2 e2 I/ B
* 速度很慢,那还没达到最大速度就要开始减速
*/
void STEPMOTOR_AxisMoveRel(__IO int32_t step, __IO uint32_t accel, __IO uint32_t decel, __IO uint32_t speed)1 G# D' h$ F5 K
{ 7 Z% z& G+ L. o* a9 E( S! n
__IO uint16_t tim_count;
// 达到最大速度时的步数
__IO uint32_t max_s_lim;# M" ~+ e, c+ b. n! d' u8 o
// 必须要开始减速的步数(如果加速没有达到最大速度)% m6 f" d4 y% r$ z1 `9 T; ]& ~% b
__IO uint32_t accel_lim;) c; _: a7 v& t* z; n" c
if(step < 0) // 步数为负数; }9 {. _ d0 O; z- y! w
{
srd.dir = CCW; // 逆时针方向旋转& V5 q* X! A2 ]' X$ ~- B" H
STEPMOTOR_DIR_REVERSAL();
step =-step; // 获取步数绝对值0 m7 i, z8 f; a5 w/ J; r/ u6 E+ g% x
}. i- i u9 K4 B
else
{6 c" t7 {8 S3 ]9 ~# Z$ E$ R. ]- b
srd.dir = CW; // 顺时针方向旋转
STEPMOTOR_DIR_FORWARD();
}5 F; Y1 E4 ^' y( h
. c# X' _) G6 Q0 S2 d3 X! ^
if(step == 1) // 步数为1" v; Y+ e# X& N: Z
{
srd.accel_count = -1; // 只移动一步/ K2 }9 [ S8 W4 F |
srd.run_state = DECEL; // 减速状态.+ @( e9 T% e" E. |8 x) r1 V0 A
srd.step_delay = 1000; // 短延时
}
else if(step != 0) // 如果目标运动步数不为00 m6 z, Q1 Y: Y# N% `
{- o2 P5 ]& |1 s r7 o& P
// 我们的驱动器用户手册有详细的计算及推导过程
// 设置最大速度极限, 计算得到min_delay用于定时器的计数器的值。8 D0 V1 c; Q' f. ]8 _" Z
// min_delay = (alpha / tt)/ w
srd.min_delay = (int32_t)(A_T_x10/speed);5 h; [. L b+ S; C& W, f
// 通过计算第一个(c0) 的步进延时来设定加速度,其中accel单位为0.1rad/sec^2: H/ [, K0 \, G8 S
// step_delay = 1/tt * sqrt(2*alpha/accel)
// step_delay = ( tfreq*0.676/10 )*10 * sqrt( (2*alpha*100000) / (accel*10) )/100
srd.step_delay = (int32_t)((T1_FREQ_148 * sqrt(A_SQ / accel))/10);
9 s) I C. |+ A7 i2 ?. M6 T
// 计算多少步之后达到最大速度的限制3 T: b+ Z3 j; B/ ]$ }) r4 X
// max_s_lim = speed^2 / (2*alpha*accel)
max_s_lim = (uint32_t)(speed*speed/(A_x200*accel/10));
// 如果达到最大速度小于0.5步,我们将四舍五入为0$ E) h7 d! m: R: k5 U1 c
// 但实际我们必须移动至少一步才能达到想要的速度
if(max_s_lim == 0){
max_s_lim = 1;
}8 D* T. c+ V( g9 ?- j7 f+ e
// n1 = (n1+n2)decel / (accel + decel)' t' ^3 u! r& c I7 L7 S
accel_lim = (uint32_t)(step*decel/(accel+decel));
// 我们必须加速至少1步才能才能开始减速.# {3 \ s7 N" c
if(accel_lim == 0){
accel_lim = 1;! ^7 X* a2 e2 h# E% |" O! ]
}
// 使用限制条件我们可以计算出减速阶段步数
if(accel_lim <= max_s_lim){9 P$ G2 \6 D2 {. P
srd.decel_val = accel_lim - step;% S( c& d+ e! C/ g. Y ?
}
else{
srd.decel_val = -(max_s_lim*accel/decel);! r7 u( F+ Y7 p g0 a( I
}
// 当只剩下一步我们必须减速
if(srd.decel_val == 0){
srd.decel_val = -1;
}5 U" D3 B3 ?& A7 O% v5 P% n5 }
4 v n- i; A' m, e$ ]9 m6 y
// 计算开始减速时的步数& f9 L* m, |2 Z4 h6 Y$ A" i- X- v
srd.decel_start = step + srd.decel_val;& p" E2 u4 S0 F
& E) J0 o/ [6 w
// 如果最大速度很慢,我们就不需要进行加速运动5 ~$ p7 C. |- l/ W0 s
if(srd.step_delay <= srd.min_delay){) S( n7 s: Q0 ]2 A( d
srd.step_delay = srd.min_delay;" _) k* {/ n, m* E% l q0 w7 g
srd.run_state = RUN;: G( B8 U& L& ]1 w
}: }5 D' E5 m! y/ T& K: o8 C- c- ^3 z
else{
srd.run_state = ACCEL;7 M9 c3 e- M8 ?2 F1 j" L9 w% w+ w
} v. a: m4 p/ M5 R' |2 A
// 复位加速度计数值; D# W" r& ^+ p# M8 K# s
srd.accel_count = 0;
}6 s4 }( y6 f! T* P
MotionStatus = 1; // 电机为运动状态
tim_count=__HAL_TIM_GET_COUNTER(&htimx_STEPMOTOR);2 z3 Q! n. U) l# Y' w; z. d
__HAL_TIM_SET_COMPARE(&htimx_STEPMOTOR,STEPMOTOR_TIM_CHANNEL_x,tim_count+srd.step_delay); // 设置定时器比较值" @% O/ G6 Y% W* _4 G; @0 `
TIM_CCxChannelCmd(STEPMOTOR_TIMx, STEPMOTOR_TIM_CHANNEL_x, TIM_CCx_ENABLE); // 使能定时器通道
STEPMOTOR_OUTPUT_ENABLE();% K2 J2 z# ]+ ?
}
1、机器人和工业驱动器
2、纺织、缝纫机
3、包装机械
4、工厂和实验室自动化
5、高速 3D 打印机 p9 ]3 t2 T( {* `! U
6、液体处理& G9 R2 V2 D) ~1 P5 G6 m
7、医疗
8、办公自动化
9、有线闭路电视4 _8 w: p; b0 H# T( E
10、自动取款机、现金回收2 i; u% Z4 T* ?# I) A
11、泵和阀门
电机驱动主芯片采用TMC2160, H+ L X: B2 _+ R! @/ b0 p
TMC2160和5160区别:5160带UART控制及智能定位控制(如速度控制、位置控制);
TMC2160和TMC260 TMC262区别:以前版本需要通过SPI接口设置细分、电流等,新的TMC2160可通过拨码开关设置;8 }! h' E) ^' c& y
( a( z! l. F7 y$ U% {
有条件的输入输出最好加些滤波和保护,输出加脉冲整形(比如加74HC14)3 O R4 q3 s8 R* k0 ~6 x
拨码开关ON:设置为高电平1,反之低电平06 y. \3 u8 @) e
细分设置:CFG1、CFG0
CFG1、CFG0:
11:64细分3 _8 `5 C& N1 H) b2 ~
10:32细分
01:16细分8 I1 E i2 s- p
00:8细分% E/ U/ y% w) ^4 L
运行电流设置:CFG4、CFG3、CFG2
CFG4、CFG3、CFG2:
111:IRUN=31
110:IRUN=28
101:IRUN=26 s3 ~8 \7 [; a' [! ^& x+ {6 w9 W
100:IRUN=248 y# S" N' c! X% H: u
011:IRUN=22
010:IRUN=209 R1 Y R. V8 l1 G! e; J/ ~
001:IRUN=18( x. `/ B; Q# d) w
000:IRUN=16# U: ?- ?1 @' F& q/ C$ I: X. o
Irms=Vfs/(IRUN/32)/(Rsense*1.414);
Vfs =325mV,Rsense为0.05欧时,则最大电流为4.5A左右;
CFG5:
1:SpreadCyle模式,低速、低平稳运行模式
0:SpreadCyle模式,高速、高运动稳定模式5 i6 J" X7 d ^) o
保持电流设置:CFG63 _5 ?. [6 U7 _* z6 n/ b
CFG6:& E r1 V; g% }4 X
1:保持电流=运行电流/2 d; J- k* A( r$ c
0:保持电流=运行电流1 g" k' p% ]: f( y: u7 [+ Y7 n
DIR+STEP接口模式位置控制(无需SPI接口)
COM端:接24V或12V或5V+ R5 p7 ~5 ~8 b, w* e
DRV_ENN、STER、DIR:接集电极开路输出
为测试方便:
COM端:接3.3V
DRV_ENN:使能,接PB14
DIR:方向, PB15
STEP:脉冲,PA8% e/ D5 v- j( k Z1 w" e