设为首页收藏本站
开启辅助访问 切换到宽版

 找回密码
 立即注册

QQ登录

只需一步，快速开始

热门： 51单片机 | 24小时必答区 | 单片机教程 | 单片机DIY制作 | STM32 | Cortex M3 | 模数电子 | 电子DIY制作 | 音响/功放 | 拆机乐园 | Arduino | 嵌入式OS | 程序设计

搜索
»论坛 › 嵌入式/单片机论坛 › STM32/8 › STM32步进、伺服电机驱动 不开源 只提供.LIB和.H文件
返回列表 发新帖
查看: 3222|回复: 9
收起左侧

STM32步进、伺服电机驱动 不开源 只提供.LIB和.H文件

  [复制链接]
ID:487396 发表于 2021-8-23 15:53 | 显示全部楼层 |阅读模式
此电机驱动函数，只需开一个定时器，即可控制最大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)
回复

使用道具 举报

ID:487396 发表于 2021-8-23 15:55 | 显示全部楼层
项目中使用的是STM32F103VET6，GD32F103VCT6
回复

使用道具 举报

ID:319585 发表于 2021-8-23 19:24 来自手机 | 显示全部楼层
有个杨工开源的步进电机的项目，全部开源的，如果有兴趣的可以考虑下载看看。不过楼主这个虽然没有开源，但感觉功能还是很强大了，不错，这也是分享，挺好。

评分

参与人数 1黑币 +20 收起 理由
admin + 20 回帖助人的奖励！

查看全部评分

回复

使用道具 举报

ID:584195 发表于 2021-8-24 22:58 | 显示全部楼层
留个标签，希望以后能用得着。
回复

使用道具 举报

ID:487396 发表于 2021-9-1 23:14 | 显示全部楼层
liesnake 发表于 2021-8-23 19:24
有个杨工开源的步进电机的项目，全部开源的，如果有兴趣的可以考虑下载看看。不过楼主这个虽然没有开源，但 ...

好的，哪个杨工，可以给一下他主页，直接去看帖子吗
回复

使用道具 举报

ID:602498 发表于 2021-9-8 17:22 | 显示全部楼层
用原子的模板程序调用提示 L6218E: Undefined symbol MotorTimerPro (referred from main.o).
                                       Not enough information to list image symbols.
回复

使用道具 举报

ID:487396 发表于 2022-3-15 19:34 | 显示全部楼层
171821203 发表于 2021-9-8 17:22
用原子的模板程序调用提示 L6218E: Undefined symbol MotorTimerPro (referred from main.o).
            ...

main里面调用MotorTimePro，但你没有定义，把我给的文档看仔细。就懂其中的奥妙了
回复

使用道具 举报

ID:137243 发表于 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);                
}
回复

使用道具 举报

ID:25103 发表于 2022-9-2 18:24 | 显示全部楼层
楼主，控制伺服最高频率是多少？
回复

使用道具 举报

ID:970790 发表于 2022-9-3 12:34 | 显示全部楼层
wzlxhtzy 发表于 2021-9-1 23:14
好的，哪个杨工，可以给一下他主页，直接去看帖子吗

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

使用道具 举报

返回列表 发新帖
高级模式
B Color Image Link Quote Code Smilies
您需要登录后才可以回帖 登录 | 立即注册

本版积分规则

手机版|小黑屋|51黑电子论坛 |51黑电子论坛6群 QQ 管理员QQ:125739409;技术交流QQ群281945664

Powered by 单片机教程网

快速回复 返回顶部 返回列表