本帖最后由 freeelectron 于 2018-9-2 18:17 编辑 ) k% b7 k( B _" p9 j; @+ Q
) {2 Y4 }2 e; b/ f, P7 a8 J
通过任务3:主要学习电机反转指令,调用函数知道当前电机运行状态,清除报错,电机回到IDLE状态 。. K. G7 {- S& s& m5 h+ q( C
/ E7 f( f2 x; m0 X 代码说明:参考了论坛大佬的代码 - /* USER CODE BEGIN 1 */6 t, c# X+ J& b3 N5 K3 p) k
- State_t sts_motor1;
7 r2 G5 z+ V) o - /* USER CODE END 1 */
复制代码- /* USER CODE BEGIN 2 */
5 k6 @9 k6 j+ {5 W - MC_ProgramSpeedRampMotor1(-3000/6,1000);//负转3000RPM% H U$ A4 t4 ?5 a6 \* H
- MC_StartMotor1();
: q, ?0 }4 T: b! ^- K* ]6 i8 C+ ` - HAL_Delay(10000); m( e$ v+ f" Z( L) c/ a6 a
- MC_ProgramSpeedRampMotor1(3000/6,1000);//正转3000RPM
5 u3 w( _* t1 J# c" ]; u - /* USER CODE END 2 */8 F' e2 O0 y& |/ j9 `4 K9 C
- $ Y' A* Z" \2 L2 I6 R/ j
复制代码- /* USER CODE BEGIN 3 */
/ M& a* x( f0 J) I5 D9 z9 I$ g - ; K1 l7 U; J7 ]3 }
-
4 N b* h0 z4 ~* k2 T - sts_motor1 = MC_GetSTMStateMotor1(); //返回 Motor 1 状态机当前的状态
! j: y; J) q, U" z8 O% \. @9 } - if(FAULT_OVER==sts_motor1) 8 p9 J! @- I' ?: r" S" M5 V
- { 2 |: B8 V% d x+ e- k, F
- MC_AcknowledgeFaultMotor1();
0 ] m4 p$ g; s' r; _, O4 i - }
3 N" X% ~! g$ k* X% x ^) E$ R - else
! I% ]/ d2 K! s' T - {: U% c9 |* J7 ~
- if(IDLE==sts_motor1), e9 _1 s. Z9 U+ `
- {
5 @; ~/ p7 D9 i* {0 T) T* t3 { - MC_StartMotor1();; Y& ?6 |$ k0 j1 O( ^
- MC_ProgramSpeedRampMotor1(MC_GetLastRampFinalSpeedMotor1(), 1000);//最后一次设定的速度
- [8 r0 d. n$ N1 M4 R4 P+ i - }; d/ c1 j8 \7 }6 X
- }: O) G: u3 ^9 z' ~, T
-
7 M+ y" a; S6 u: S% i. u ^ - }6 p# f# Z8 E" X+ K" K
- /* USER CODE END 3 */
复制代码
- A5 @% s4 o( {& ?7 V- r查看速度波形文件:
" U) w$ c" y' P
: Q% u( x/ m, P1 M MC_AcknowledgeFaultMotor1(); 函数说明:应答 Motor 1 发生过的故障。用户调用这个函数前,如果电机发生了故障。电机将停留在FAULT_OVER状态,并保留故障代码。在调用了这个函数之后,状态机将清除故障代码的记录,并恢复到 IDLE 状态。
# L" m7 a% s1 T5 N* b7 g . g" Q4 U; u' j% K2 k6 |) w
电机常用的几种状态:
$ P9 n) M# r) s; C
4 i0 X/ s1 u; Q3 _( k0 [/ W+ { |
嗯嗯,谢谢指正