標(biāo)題: 單片機(jī)步進(jìn)電機(jī)的驅(qū)動(dòng)程序模板可控制精度，有接口的調(diào)用方法 [打印本頁(yè)]
作者: DKC_LIN_123    時(shí)間: 2021-1-27 11:10
標(biāo)題: 單片機(jī)步進(jìn)電機(jī)的驅(qū)動(dòng)程序模板可控制精度，有接口的調(diào)用方法
初始化：
stepper_motor_init(stepper_motor_a_ptr);
stepper_motor_init(stepper_motor_b_ptr);

定時(shí)器需要放置的函數(shù)： 定時(shí)器暫用1ms，可根據(jù)應(yīng)用修改
stepper_motor_timer(stepper_motor_a_ptr);
stepper_motor_timer(stepper_motor_b_ptr);
旋轉(zhuǎn)配置：
stepper_motor_mode_set(stepper_motor_a_ptr,STEPPER_MOTOR_F,512,STEPPER_MOTOR_A_SPEED);  //Motor A順時(shí)針轉(zhuǎn)一圈
stepper_motor_mode_set(stepper_motor_b_ptr,STEPPER_MOTOR_R,512,STEPPER_MOTOR_B_SPEED);  //Motor B逆時(shí)針轉(zhuǎn)一圈
stepper_motor_mode_set 參數(shù)說(shuō)明：
1、結(jié)構(gòu)體指針
2、旋轉(zhuǎn)方向
   STEPPER_MOTOR_F  順時(shí)針
   STEPPER_MOTOR_R  逆時(shí)針
   STEPPER_MOTOR_STOP  停止
3、旋轉(zhuǎn)角度  （實(shí)際轉(zhuǎn)動(dòng)角度 = angle * 5.625 / 8）
4、旋轉(zhuǎn)速度  1 最快，數(shù)值越大，速度越慢

單片機(jī)源程序如下:
  1. /*
  2. * @Descripttion:
  3. * @version:
  4. * @Author: linsuwei
  5. * @Date: 2020-10-27 10:39:36
  6. * @LastEditors: linsuwei
  7. * @LastEditTime: 2020-10-29 11:43:50
  8. */

  10. #include "stepper_motor.h"

  12. static u8 get_Offset(STEPPER_MOTOR_PTR stepmo_ptr);


  15. u32 a_motor_a_io[] = {
  16.     STEPPER_MOTOR_A_IO_0,
  17.     STEPPER_MOTOR_A_IO_1,
  18.     STEPPER_MOTOR_A_IO_2,
  19.     STEPPER_MOTOR_A_IO_3,
  20. };

  22. u32 a_motor_b_io[] = {
  23.     STEPPER_MOTOR_B_IO_0,
  24.     STEPPER_MOTOR_B_IO_1,
  25.     STEPPER_MOTOR_B_IO_2,
  26.     STEPPER_MOTOR_B_IO_3,
  27. };


  30. #define __IO_L    0
  31. #define __IO_F    1

  33. u8 stepper_timing_tab[] = {
  34.     __IO_L,__IO_F,__IO_F,__IO_F,    //pulse 1
  35.     __IO_L,__IO_L,__IO_F,__IO_F,    //pulse 2
  36.     __IO_F,__IO_L,__IO_F,__IO_F,    //...
  37.     __IO_F,__IO_L,__IO_L,__IO_F,
  38.     __IO_F,__IO_F,__IO_L,__IO_F,
  39.     __IO_F,__IO_F,__IO_L,__IO_L,
  40.     __IO_F,__IO_F,__IO_F,__IO_L,
  41.     __IO_L,__IO_F,__IO_F,__IO_L,
  42. };


  45. STEPPER_MOTOR_S stepper_motor_a = {
  46.     .mode = STEPPER_MOTOR_STOP,
  47.     .pulse = 0,
  48.     .speed = 1,
  49.     .max_step = 0,
  50.     .step = 0,
  51.     .timing_tab_ptr = &stepper_timing_tab[0],
  52.     .io_tab_ptr = &a_motor_a_io[0],
  53. };

  55. STEPPER_MOTOR_S stepper_motor_b = {
  56.     .mode = STEPPER_MOTOR_STOP,
  57.     .pulse = 0,
  58.     .speed = 1,
  59.     .max_step = 0,
  60.     .step = 0,
  61.     .timing_tab_ptr = &stepper_timing_tab[0],
  62.     .io_tab_ptr = &a_motor_b_io[0],
  63. };

  65. STEPPER_MOTOR_PTR stepper_motor_a_ptr = &stepper_motor_a;
  66. STEPPER_MOTOR_PTR stepper_motor_b_ptr = &stepper_motor_b;


  69. static u8 get_Offset(STEPPER_MOTOR_PTR stepmo_ptr)
  70. {
  71.     if(NULL == stepmo_ptr)
  72.         return 0;
  73.     if(STEPPER_MOTOR_F == stepmo_ptr->mode)
  74.         return stepmo_ptr->step;
  75.     else if(STEPPER_MOTOR_R == stepmo_ptr->mode)
  76.         return (7 - stepmo_ptr->step);
  77.     else
  78.         return stepmo_ptr->step;
  79. }


  82. void stepper_motor_stop(STEPPER_MOTOR_PTR stepmo_ptr)
  83. {
  84.     if(NULL == stepmo_ptr)
  85.         return;
  86.     for (u8 i = 0; i < 4; i++)
  87.     {
  88.         gpio_direction_input(stepmo_ptr->io_tab_ptr[i]);
  89.     }
  90.     stepmo_ptr->mode = STEPPER_MOTOR_STOP;
  91. }



  95. void stepper_motor_init(STEPPER_MOTOR_PTR stepmo_ptr)
  96. {
  97.     if(NULL == stepmo_ptr)
  98.         return;
  99.     stepmo_ptr->mode = STEPPER_MOTOR_STOP;
  100.     stepmo_ptr->step = 0;
  101.     stepmo_ptr->max_step = 0;
  102.     stepmo_ptr->pulse = 0;
  103.     stepmo_ptr->speed = 1;
  104.     stepmo_ptr->timing_tab_ptr = &stepper_timing_tab[0],
  105.     stepper_motor_stop(stepmo_ptr);
  106. }

  108. //減速比 64
  109. // Precision = 360 /((360/5.625)*64) = 5.625/64  控制精度
  110. // 實(shí)際轉(zhuǎn)動(dòng)角度 = (angle *8) * Precision = angle * 5.625 / 8

  112. void stepper_motor_mode_set(STEPPER_MOTOR_PTR stepmo_ptr, u8 mode, u16 angle ,u8 speed)
  113. {
  114.     if(NULL == stepmo_ptr)
  115.         return;
  116.     stepmo_ptr->mode = mode;
  117.     stepmo_ptr->speed = speed;
  118.     stepmo_ptr->max_step = angle * 8;   // 這里將精度放大 8倍，方便計(jì)算
  119.     if(STEPPER_MOTOR_STOP == mode)
  120.     {
  121.         stepper_motor_stop(stepmo_ptr);
  122.     }
  123. }



  127. void stepper_motor_timer(STEPPER_MOTOR_PTR stepmo_ptr)
  128. {
  129.     static u8 cnt = 0;
  130.     if(NULL == stepmo_ptr)
  131.         return;
  132.     if (STEPPER_MOTOR_STOP == stepmo_ptr->mode)
  133.     {
  134.         // stepper_motor_stop(stepmo_ptr);
  135.         return;
  136.     }
  137.     else
  138.     {
  139.         if (++cnt >= stepmo_ptr->speed)
  140.         {
  141.             cnt = 0;

  143.             if (stepmo_ptr->max_step > 0)
  144.             {
  145.                 if (++stepmo_ptr->pulse > stepmo_ptr->max_step)
  146.                 {
  147.                     stepmo_ptr->pulse = 0;
  148.                     stepmo_ptr->mode = STEPPER_MOTOR_STOP;
  149.                     stepper_motor_stop(stepmo_ptr);
  150.                     return;
  151.                 }
  152.             }
  153.             for (u8 i = 0; i < 4; i++)
  154.             {
  155.                 if (__IO_L == stepmo_ptr->timing_tab_ptr[get_Offset(stepmo_ptr) * 4 + i])
  156.                 {
  157.                     gpio_direction_output(stepmo_ptr->io_tab_ptr[i], 1);
  158.                 }
  159.                 else
  160.                 {
  161.                     gpio_direction_output(stepmo_ptr->io_tab_ptr[i], 0);
  162.                 }
  163.             }
  164.             stepmo_ptr->step = (++stepmo_ptr->step) & (8 - 1); //+1然后對(duì)8取余
  165.         }
  166.     }
  167. }
復(fù)制代碼

所有資料51hei提供下載:
步進(jìn)電機(jī)驅(qū)動(dòng)程序.zip (2.41 KB, 下載次數(shù): 23)

作者: 51hei團(tuán)團(tuán)    時(shí)間: 2021-1-27 18:18
這個(gè)程序真牛,能分享一下電路圖嗎?幾相的電機(jī),貌似還有位置反饋?
作者: DKC_LIN_123    時(shí)間: 2021-1-28 17:00
是5線的步進(jìn)電機(jī)，沒(méi)有位置反饋的，應(yīng)用比較簡(jiǎn)單，只需要知道大概轉(zhuǎn)動(dòng)的角度！

11.pdf

136.04 KB, 下載次數(shù): 12, 下載積分: 黑幣 -5

補(bǔ)充一個(gè)原理圖
作者: qw2229    時(shí)間: 2021-1-29 08:59
正想做個(gè)分角器，正在考慮角度細(xì)分和精確度的問(wèn)題，學(xué)習(xí)了。



歡迎光臨 (http://www.torrancerestoration.com/bbs/) Powered by Discuz! X3.1