标题: STM32步进、伺服电机驱动 不开源 只提供.LIB和.H文件 [打印本页]
作者: wzlxhtzy    时间: 2021-8-23 15:53
标题: STM32步进、伺服电机驱动 不开源 只提供.LIB和.H文件
此电机驱动函数，只需开一个定时器，即可控制最大9路电机，已在项目中多次验证OK。只需在自己工程中添加点LIB和点H文件，按下面功能描述驱动即可。

一、电机驱动函数定义
1. 电机相关参数初始化
函数名：void MotorInit(u8 motorNum,u8dirReset,u8 stepReset)
参数：motorNum：控制板需控制电机总个数最大为10轴；dirReset：电机方向信号复位电平，即电机停止运行时方向脚电平，可设置NPNSensor或PNPSensor；stepReset：电机脉冲信号复位电平，即电机停止运行时脉冲脚电平，可设置NPNSensor或PNPSensor；
返回：无

2. 电机相关参数加载
函数名    ：void AxisParaLoad(u8 index,MotorParaStruct mStruct)
参数：index：轴号 0至9；mStruct：电机参数结构体，包含驱动器拨码、丝杠导程、原点及极限极性、原点与极性引脚、最大软限位
返回：无

3. 电机运动到指定点位
函数名：u8 MotorMoveToPosi(u8 index,MotorModelmModel,u16 accT,u16 decT,float runS,float distance)
参数：index：轴号 0至9；mModel：电机运行模式，Uniform_Model匀速运行、T_Model 梯形加减速、S_Model  S型加减速；accT：加速时间(ms) 至针点梯形加减速有效，如100为100ms，为0时切换为匀速运动；decT：减速时间(ms) 至针点梯形加减速有效，如100为100ms，为0时切换为匀速运动；runS：运行速度，加减速完成后的速度；distance：目标位置，需运动到的点位
返回：0：运动中  1：正常运动结束 2：碰到正限位运动结束  3：碰到负限位运动结束

4. 电机回原点处理
函数名    ：u8 MotorMoveHome(u8 index,MotorModel mModel,u16 accT,u16 decT,floatspeedH,float speedL,u8 homeMode,u8 homeDir)
参数：index：轴号 0至9；mModel：电机运行模式，Uniform_Model匀速运行、T_Model 梯形加减速、S_Model  S型加减速；accT：加速时间(ms) 至针点梯形加减速有效，如100为100ms，为0时切换为匀速运动；decT：减速时间(ms) 至针点梯形加减速有效，如100为100ms，为0时切换为匀速运动；speedH：回零高速速度，加减速完成后的速度；speedL：回零低速速度，加减速完成后的速度；distance：目标位置，需运动到的点位；homeMode：回零方式，0为一次回零，即电机碰到原点立即停止；1为一次回零加反找，电机向原点运动感应到原点减速停止，然后再反向找原点,直到未感应到原点停止停止；2为两次回零，在一次回零加反找未感应到原点后减速停止,然后再找原点立即停止；homeDir：回零方向，0为往负方向回零，1为往正方向回零
返回：0：运动中  1：正常运动结束 2：碰到正限位运动结束  3：碰到负限位运动结束

5. 获取电机当前位置
函数名：double MotorGetPosi(u8 index)
参数：index：轴号 0至9；
返回：该轴电机当前位置

6. 设置电机当前位置
函数名：u8 MotorSetPosi(u8 index,int posi)
参数：index：轴号 0至9；posi：待设定的位置
返回：0：设置失败  1：设置成功

7. 电机运动完成结果检测
函数名：u8 MotorCheckDone(u8 index)
参数：index：轴号 0至9
返回：0为电机还在运动中，1为运动结束

8. 电机运动停止
函数名：void MotorStop(u8 index)
参数：index：轴号 0至9
返回：无

  1. #ifndef __MOTOR_H
  2. #define __MOTOR_H
  3. #include "sys.h"

  5. #define NPNSENSOR       0          //NPN型信号
  6. #define PNPSENSOR       1                //PNP型信号

  8. typedef enum
  9. {
  10.         Uniform_Model = 0,                                //匀速模式
  11.         T_Model,                                                      //梯形加减速模式
  12.         S_Model                                                                                //S型加减速模式
  13. }MotorModel;

  15. typedef struct
  16. {
  17.         float MaxPosi;                                                //行程上限
  18.         float CycleRange;                                        //电机运转一圈的距离或者度数 丝杆导程
  19.         u32 MotorPluse;                                                //驱动器拨码
  20.         u8 OrgPolar;                                                        //电机原点信号极性
  21.         u8 ElPolar;                                                                //电机极限信号极性
  22.         u8 DirSwitch;             //电机方向切换
  23.         uint32_t *StepPin;                                //电机脉冲引脚
  24.         uint32_t *DirPin;         //电机方向引脚
  25.         uint32_t *OrgPin;         //电机原点引脚
  26.         uint32_t *ElPPin;                                        //电机正极限引脚
  27.         uint32_t *ElNPin;                                        //电机负极限引脚
  28. }MotorParaStruct;

  30. /*******************************************************************************
  31. * 函数名                ：MotorGpioInit
  32. * 描述                        ：电机GPIO口初始化  只需构造 驱动会自行调用
  33. * 参数                        ：无
  34. * 返回                        ：无
  35. *******************************************************************************/
  36. void MotorGpioInit(void);        
  37. /*******************************************************************************
  38. * 函数名                ：MotorTimerPro
  39. * 描述                        ：电机定时器开启/关闭 频率切换   只需构造 驱动会自行调用
  40. * 参数                        ：timerEnable:定时器开启/关闭 freq:切换的频率
  41. * 返回                        ：无
  42. *******************************************************************************/
  43. void MotorTimerPro(u8 timerEnable,u32 freq);

  45. /*******************************************************************************
  46. * 函数名                ：MotorInit
  47. * 描述                        ：电机相关参数初始化
  48. * 参数                        ：motorNum:轴数  dirReset:电机方向信号复位电平
  49. * 参数                        ：stepReset:电机脉冲信号复位电平
  50. * 返回                        ：无
  51. *******************************************************************************/
  52. void MotorInit(u8 motorNum,u8 dirReset,u8 stepReset);        
  53. /*******************************************************************************
  54. * 函数名                ：AxisParaLoad
  55. * 描述                        ：电机相关参数加载
  56. * 参数                        ：index:轴号  mStruct 电机参数结构体
  57. * 返回                        ：无
  58. *******************************************************************************/
  59. void AxisParaLoad(u8 index,MotorParaStruct mStruct);        
  60. /*******************************************************************************
  61. * 函数名                ：MotorMoveHome
  62. * 描述                        ：电机回原点处理
  63. * 参数                        ：index:轴号  mModel电机运行模式 0 无加减速 1 梯形加减速 2 S型加减速
  64. * 参数                        ：accT:加速时间(ms) decT:减速时间(ms) speedH:高速速度  speedL:低速速度
  65. * 参数                        ：homeMode: 0 一次回零 即电机反向运动，碰到原点立即停止，适合短距离回零
  66. * 参数                        ：homeMode: 1 一次回零加反找 电机向原点运动感应到原点后减速停止
  67. * 参数                        ：然后再正向找到未感应到原点位置结束
  68. * 参数                        ：homeMode: 2 两次回零
  69. * 参数                        ：homeDir: 0 负方向回零  1 正方向回零
  70. * 返回                        ：0电机还在复位 1电机复位完成 2碰到正限位停止 3碰到负限位停止
  71. *******************************************************************************/
  72. u8 MotorMoveHome(u8 index,MotorModel mModel,u16 accT,u16 decT,float speedH,float speedL,u8 homeMode,u8 homeDir);
  73. /*******************************************************************************
  74. * 函数名                ：MotorMoveToPosi
  75. * 描述                        ：电机运动到指定点位
  76. * 参数                        ：index:轴号  mModel电机运行模式 0 无加减速 1 梯形加减速 2 S型加减速
  77. * 参数                        ：accT:加速时间(ms) decT:减速时间(ms) runS:运行速度  distance:目标位置
  78. *******************************************************************************/
  79. u8 MotorMoveToPosi(u8 index,MotorModel mModel,u16 accT,u16 decT,float runS,float distance);
  80. /*******************************************************************************
  81. * 函数名                ：MotorCheckDone
  82. * 描述                        ：电机运动完成结果检测
  83. * 参数                        ：index:轴号
  84. * 返回                        ：0电机还在运动中，1为运动结束
  85. *******************************************************************************/
  86. u8 MotorCheckDone(u8 index);
  87. /*******************************************************************************
  88. * 函数名                ：MotorStop
  89. * 描述                        ：电机运动停止
  90. * 参数                        ：index:轴号
  91. * 返回                        ：无
  92. *******************************************************************************/
  93. void MotorStop(u8 index);                                                         
  94. /*******************************************************************************
  95. * 函数名                ：MotorPlusePro
  96. * 描述                        ：电机脉冲控制   定时器中断需要调用
  97. * 参数                        ：无
  98. * 返回                        ：无
  99. *******************************************************************************/
  100. void MotorPlusePro(void);                                                               
  101. /*******************************************************************************
  102. * 函数名                ：MotorGetPosi
  103. * 描述                        ：获取电机当前位置
  104. * 参数                        ：index:轴号
  105. * 返回                        ：无
  106. *******************************************************************************/
  107. float MotorGetPosi(u8 index);                          
  108. /*******************************************************************************
  109. * 函数名                ：MotorSetPosi
  110. * 描述                        ：设置电机位置
  111. * 参数                        ：index:轴号
  112. * 返回                        ：0未设定成功 1设定成功
  113. *******************************************************************************/
  114. u8 MotorSetPosi(u8 index,float posi);
  115. #endif
复制代码

没有源码 只提供.LIB和点.文件: Motor.zip (81.47 KB, 下载次数: 52)

作者: wzlxhtzy    时间: 2021-8-23 15:55
项目中使用的是STM32F103VET6，GD32F103VCT6
作者: liesnake    时间: 2021-8-23 19:24
有个杨工开源的步进电机的项目，全部开源的，如果有兴趣的可以考虑下载看看。不过楼主这个虽然没有开源，但感觉功能还是很强大了，不错，这也是分享，挺好。
作者: zyluglugl    时间: 2021-8-24 22:58
留个标签，希望以后能用得着。
作者: wzlxhtzy    时间: 2021-9-1 23:14
liesnake 发表于 2021-8-23 19:24
有个杨工开源的步进电机的项目，全部开源的，如果有兴趣的可以考虑下载看看。不过楼主这个虽然没有开源，但 ...

好的，哪个杨工，可以给一下他主页，直接去看帖子吗
作者: 171821203    时间: 2021-9-8 17:22
用原子的模板程序调用提示 L6218E: Undefined symbol MotorTimerPro (referred from main.o).
                                       Not enough information to list image symbols.
作者: wzlxhtzy    时间: 2022-3-15 19:34
171821203 发表于 2021-9-8 17:22
用原子的模板程序调用提示 L6218E: Undefined symbol MotorTimerPro (referred from main.o).
            ...

main里面调用MotorTimePro，但你没有定义，把我给的文档看仔细。就懂其中的奥妙了
作者: 天上跑着玩    时间: 2022-7-16 18:34
wzlxhtzy 发表于 2022-3-15 19:34
main里面调用MotorTimePro，但你没有定义，把我给的文档看仔细。就懂其中的奥妙了

那这个定时器怎么定义呢，需要中断吗？
void MotorTimerPro(u8 timerEnable,u32 freq)
{
        TIM_TimeBaseInitTypeDef  TIM_TimeBaseStructure;
        NVIC_InitTypeDef NVIC_InitStructure;

        RCC_APB1PeriphClockCmd(RCC_APB1Periph_TIM3, ENABLE);
       
        TIM_TimeBaseStructure.TIM_Period = 72-1;
        TIM_TimeBaseStructure.TIM_Prescaler =1;
        TIM_TimeBaseStructure.TIM_ClockDivision = TIM_CKD_DIV1;
        TIM_TimeBaseStructure.TIM_CounterMode = TIM_CounterMode_Up;  
        TIM_TimeBaseInit(TIM3, &TIM_TimeBaseStructure);

        TIM_ITConfig(TIM3,TIM_IT_Update,ENABLE );

        NVIC_InitStructure.NVIC_IRQChannel = TIM3_IRQn;  
        NVIC_InitStructure.NVIC_IRQChannelPreemptionPriority = 0;
        NVIC_InitStructure.NVIC_IRQChannelSubPriority = 3;  
        NVIC_InitStructure.NVIC_IRQChannelCmd = ENABLE;
        NVIC_Init(&NVIC_InitStructure);  
       
  TIM_Cmd(TIM3, timerEnable);                
}
作者: huaishang    时间: 2022-9-2 18:24
楼主，控制伺服最高频率是多少？
作者: henge-stone    时间: 2022-9-3 12:34
wzlxhtzy 发表于 2021-9-1 23:14
好的，哪个杨工，可以给一下他主页，直接去看帖子吗

你去某1个宝搜  杨工的小店



欢迎光临 (http://www.51hei.com/bbs/) Powered by Discuz! X3.1