51单片机控制双步进电机的魔法师思想

嵌入式ARM 2022-09-08 12:01

01

背景与介绍


步进电机是一个用数字来控制运动的数字化电机,特别适用于精准控制场合。今天,我们将通过步进电机控制云台准确定位转动的应用,详细讲解一下对步进电机运动的控制。


首先,云台通过一个摇杆控制器进行控制,速度分为0~63。其中,0即为停止,63即为最快速度。该产品模型,如图1所示:


图1:云台控制模型

在控制逻辑上,这里使用的方案是一片2051作为步进电机驱动,一片80C5x作为主控芯片实现产品功能,从而形成了一个双机系统,如图2所示:

图2:云台双机控制系统

双机通信口线定义如下:

sbit Cdata    = P?^?;       // ->2051sbit Cctrl    = P?^?;        // -INT0sbit Crclk    = P?^?;sbit Ctclk    = P?^?;

02

分析与对策


我们都知道,51单片机的客观条件不怎么好。


首先是工作频率较低。传统的51单片机是12T机,也就是说,执行一条指令的速度是1/12主频,即12M的晶振执行指令的速度只有1M。当然,后来出了一些变种51单片机是1T机,大部分指令速度是1T的,无论这个大部分有多大概率,至少执行速度是提高了不少。


这里采用的就是1T机,因为这款产品实际上有两个步进电机,如果单片机速度太慢,有很多产品功能就无法流畅实现。要充分利用JBC指令来实现判断跳转,这条指令对应的C语言语句是_testbit_(abitvar)。不能小看这一点点的节省,这对一个功能复杂、运行速度敏感的产品来说非常重要!


其次是定时器数量少,单次计时时间短。作为一个产品的主控芯片,因为51单片机是8位机,定时器资源也非常紧缺,所以本产品利用了定时器0的模式3,将定时器0一拆为二,变成了两个不能自动重载的8位定时器(此时原定时器1只能作为波特率发生器<这也正是我们需要的>,原定时器1的寄存器都作为定时器0的第二个定时器<新定时器1>的控制寄存器,一旦启动,无法更改)。


因为这种模式一旦启动,后期不能进行修改。所以,为了极大地减少指令数量,可将这两个定时器工作于伪重载的模式下。即当定时器计数寄存器溢出为0后,直接将这个0作为重载数据,从而避免通过命令进行重载。对于一个反复运行的代码来说,精简一条指令的收益是不容小觑的。


定时器初始化代码如下:


setBaud(BaudID);        // 先初始化定时器1作为波特率发生器

第三是内存资源很有限。变种的51单片机有一个神奇的现象,那就是代码存储器容量足够大,而RAM(即使用MOV来访问)却依然很少,片内扩展的外部存储器(即使用MOVX来访问)执行时耗又比较大。所以,将好钢用在刀刃上就变得非常重要了,甚至我们经常还需要用代码来换取RAM的节约使用。


03

编程魔法师观点


编程魔法师的观点,就是要面向对象处理。也就是后面使用步进电机时,不能夹带控制代码,只能设置设置参数(属性)、调用调用动作(函数)。


为了减少生涩的说明,这里直接用云台自检为例简要说明。云台x轴自检过程,如图3所示:


图3:自检流程

光电管口线定义:

sbit Pos0x    = Px^?;        // x光电管信号

我们先来看一下自检的代码:


voidSelfChk(void){       Pscx= (Pos0x)?0:1;      while(fx)      {       WDI = !WDI;      // ******** 喂狗 ********
       if(NdCtrlx)        {            NdCtrlx = 0;         if(fx)         {                   Pscx++;                   switch(Pscx)                   {                            case  2: xRun321(0,CVauto,CWavoid);                                        Sx = 0;                                        xRun();                                        break;                            case  1: Pscx = 3;                            case  3: Sx = 0;                                        xRun321(1,CVauto,0xFFFF);                                     xRun();                                        break;                            case  5: CSmaxx1 = Sx;                            case  4: Sx = 0;                                        break;                            case  6: CSdelta = Sx - 1;             // 自检确定光电管宽度                                        fx = 0;                                        xStop();                 }         }        }      }}

从自检代码中,我们可以看出,对步进电机的控制只使用了一些方法(函数/宏)。这是一种撸码的较高境界,即代码与日常语义贴近。


接下来,我们再看一下步进电机的方法代码:


/*--------------------------------------------------------  功能:x方向运动预备           填入目标Sendx、速度Vobj、运行方向mmd  参数:o1: 运行方向           o2: 目标速度           o3: 目标行程--------------------------------------------------------*/#definexRun321(o1,o2,o3)  {mmdx = o1;\                                       mmCmdx =((o2)>CVmax)?CVmax:o2;\                                       mmSx =o3; mmcx = 1;\                                     }
/*--------------------------------------------------------  功能:x方向运动开始           调用之前要确认目标Sendx、速度Vobj、运行方向mmd--------------------------------------------------------*/void xRun(void){      if(TR0) return;      TL0    = CT2Vooo; // 进入运行的时间      NdCtrlx = 0;      TR0    = 1;}
/*--------------------------------------------------------  功能:x方向运动停止--------------------------------------------------------*/#define xStop(){mmCmdx = 0x40;mmcx = 1;}

很显然,通过控制步进电机的运行参数设置、步进电机的起与停,符合我们的日常控制习惯,这就是工程学与实际应用完美统一的境界。


04

步进电机运动控制策略


控制步进电机运动有两种方式:一种是速度控制方式,另一种是终点控制方式。


速度控制方式是指在实时控制时,只有目标速度,没有目标位置的控制方式。这种控制具有随意性,它可能是从一个速度到另一个速度的变化,也可能是保持某个速度的运动;而速度的变化可以是增速,也可以是减速;一个速度与另一个速度可以是0,也可以不是0(如图4所示)。


图4:速度控制中的速度变化

目标控制方式是指在**了预存点坐标的再现控制时,读出当前运行的目标终点坐标并以一定的速度走到该点的控制方式。这种控制目标确定,运行速度确定,对运动的控制要求就是走位精确(如图5所示)。

图5:终点控制的速度行程曲线

确定了步进电机控制策略后,我们就需要不断扫描步进电机的控制策略,一旦出现变化,我们就立即响应。这些在时间上的微分控制用程序来实现我们利用定时器,这样做的好处就是时间微分量能够得到保证,时间微分量的均匀性也能够得到保证,从而在体验上获得一种稳定的感觉。

其实,这种需求就是一种确定的、机械的需求,我们可以将其整合到步进电机运动的定时器中去。这样一来,我们就能得到一个步进电机微分控制逻辑图了(如图6所示)。

图6:步进电机控制微分流程图

05

代 码


我知道很多小伙伴不喜欢啰嗦、只喜欢代码,所以这里就不多说了,大家直接复制代码就行了。


定时器0(x电机)的ISR如下:


voidTimer0(void) interrupt 1 using 1{      static UINT  data Dis=0;              //剩余行程      static bit        D=0;                  //运动方向      static UCH   data Vend=0;           //目标速度      static UCH   data V=0;                      //当前速度      static UCH   data lps=0;              //定时器延时倍率计数器      static bit        Wavoid=0;      //--------------------------------------------------------------------------------      if(_testbit_(mmcx))            // 存在立即执行命令      {           switch(mmCmdx)           {                 case 0x40:  // 停止                                  if(Dis>V)Dis = V;                                 Vend= 0;                                  mmCmdx = 0x00;                                  break;                 default  :   // 开始命令解释: mmcx = 0 表示速度变化,其他命令必须mmcx = 1                                  if(V&&(D!=mmdx)) // 如果速度大于0反向则执行减速到自动停止                                  {                                       if(Vend){Dis= V; Vend = 0;}                                  }                                  else                                  {                                       D = mmdx;                                       Vend = mmCmdx;                                       Sendx =mmSx;                                       if(Sendx<(CSmaxx1))                                             Dis= (fx)?(Sendx -Sx):((D)?((Sendx>=Sx)?(Sendx-Sx):(CSmaxx1-Sx+Sendx)):((Sendx<=Sx)?(Sx-Sendx):(CSmaxx1-Sendx+Sx)));                                       else                                             Dis= 0xFFFF;                                  }                                  if(!Dis)StopRunx();                                 if(!lps) lps = CT2Vooo; //以最快速度进入第一步           }      }      // 运行处理      if(++lps) return;                     // 延长定时器定时时间,lps自增到溢出(==0)才进行一次运动运动处理      SendMx();                   //根据当前方向运动一步      NextPx();                    //求下一个圆周坐标Sx,以及剩余行程Dis(行程不能大于等于最大圆周坐标,自动计算近距离及方向到达目标)      WidAvd();                   //光电管处同步处理(自检正方向从未遮挡到遮挡处为0,从遮挡到未遮挡处为光电管宽度,反方向倒着处理)      NxtxAn();                    //求下一个速度参数}

步进电机走一步代码如下(此处代码根据硬件确定,以下仅供参考):


#define SendMx(){\                            Cctrl = 1; Cdata =0; Cctrl = 0; \                            Cctrl = 1; Cdata =!D; Cctrl = 0; \                       }

步进电机走一步后坐标与行程处理的代码如下:


#define NextPx(){\                            if(fx)\                            {\                                  Sx++;\                            }\                            else\                            {\                                  if(D)\                                  {\                                       Sx++;\                                       if(Sx>=CSmaxx1)Sx = 0;\                                  }\                                  else\                                  {\                                       if(Sx)Sx--; else Sx = CSmaxx1 - 1;\                                  }\                            }\                            if(Dis &&(Dis<(CSmaxx1))) Dis--;\                        }

每次检测到光电管后同步处理的代码如下:


#define WidAvd(){\                            if(Wavoid)\                            {\                                  if(Pos0x)\                                  {\                                       Wavoid =0;\                                       if(fx)if(Pscx==5) NdCtrlx = 1;\                                  }\                            }\                            else\                            {\                                  if(!Pos0x)\                                  {\                                       Wavoid =1;\                                       if(fx)\                                       {\                                             if((Pscx==3)||(Pscx==4))NdCtrlx = 1;\                                       }\                                       else\                                       {\                                             Sx= (D)?0:CSdelta;\                                       }\                                  }\                            }\                       }

步进电机走一步后速度处理的代码如下:


#define NxtxAn(){\                            if(Dis)\                            {\                                  if(Dis>V)\                                  {\                                       if(V                                       {\                                             V++;\                                       }\                                       else\                                       {\                                             if(V>Vend)V--;\                                       }\                                  }\                                  else\                                  {\                                       V--;\                                  }\                                  lps = CxT2Vmin+ V;\                            }\                            else\                            {\                                  StopRunx();\                            }\                       }

06

相关问题与处理方法


1、由于步进电机是一种电转换率很低的设备,因此,当负载与输出功率出现矛盾时,一定要保证设备不能出现失步,尽可能降低负载影响是重中之重。例如,减轻负载质量、降低负载运动阻力等,都是很重要的工作。


2、选择铜耗铁耗低的步进电机,是在体积一定的情况下提高步进电机带载能力的优选方案,如果你能接受这样做带来的成本增加的话。


3、速度突变容易导致步进电机失步,这主要是“既想步进电机小,又想步进电机快”导致的步进电机功率跟不上速度变化。在不提高步进电机功率的前提下,利用合适的加速曲线能一定程度上抑制失步。


4、光电管位置同步,是避免步进电机控制时,因机械误差导致数位累积误差的有效办法。由于这种误差通常只会在整周转动时产生累积,因此只要在每次经过零位光电管时进行一次同步即可消除。


5、对于计算时出现位置速度偏差的处理方法是,当到达指定目标前速度按加减速曲线应该变为0时,保持速度1不变,直到到达终点。当到达指定目标时速度按加减速曲线计算无法到达0时,到达终点时速度直接降为0。


尽管这种处理看起来不太合理,但这种偏差在运算出现±1误差时进行强制修正,实际造成的影响可以忽略不计。


6、如果出现步进电机在某个速度时抖动特别厉害(电机运行声音明显变大),可以通过改变负载结构与质量的方式修改产品的固有谐振频率,以避开结构共振点造成的抖动。

好了,以上就是今天分享的所有内容了,如果有需要查看原图和代码的小伙伴,请点击底部“阅读原文”进行下载。


END

作者:yyy71cj
来源:21ic论坛

版权归原作者所有,如有侵权,请联系删除。

推荐阅读
最新泛955不加班的公司名单
10个超赞的C语言开源项目,强烈推荐!
手把手教你VSCode搭建STM32开发环境

→点关注,不迷路←
嵌入式ARM 关注这个时代最火的嵌入式ARM,你想知道的都在这里。
评论
  • 这篇内容主要讨论三个基本问题,硅电容是什么,为什么要使用硅电容,如何正确使用硅电容?1.  硅电容是什么首先我们需要了解电容是什么?物理学上电容的概念指的是给定电位差下自由电荷的储藏量,记为C,单位是F,指的是容纳电荷的能力,C=εS/d=ε0εrS/4πkd(真空)=Q/U。百度百科上电容器的概念指的是两个相互靠近的导体,中间夹一层不导电的绝缘介质。通过观察电容本身的定义公式中可以看到,在各个变量中比较能够改变的就是εr,S和d,也就是介质的介电常数,金属板有效相对面积以及距离。当前
    知白 2025-01-06 12:04 173浏览
  • 根据Global Info Research项目团队最新调研,预计2030年全球封闭式电机产值达到1425百万美元,2024-2030年期间年复合增长率CAGR为3.4%。 封闭式电机是一种电动机,其外壳设计为密闭结构,通常用于要求较高的防护等级的应用场合。封闭式电机可以有效防止外部灰尘、水分和其他污染物进入内部,从而保护电机的内部组件,延长其使用寿命。 环洋市场咨询机构出版的调研分析报告【全球封闭式电机行业总体规模、主要厂商及IPO上市调研报告,2025-2031】研究全球封闭式电机总体规
    GIRtina 2025-01-06 11:10 104浏览
  • 在智能家居领域中,Wi-Fi、蓝牙、Zigbee、Thread与Z-Wave等无线通信协议是构建短距物联局域网的关键手段,它们常在实际应用中交叉运用,以满足智能家居生态系统多样化的功能需求。然而,这些协议之间并未遵循统一的互通标准,缺乏直接的互操作性,在进行组网时需要引入额外的网关作为“翻译桥梁”,极大地增加了系统的复杂性。 同时,Apple HomeKit、SamSung SmartThings、Amazon Alexa、Google Home等主流智能家居平台为了提升市占率与消费者
    华普微HOPERF 2025-01-06 17:23 145浏览
  •     为控制片内设备并且查询其工作状态,MCU内部总是有一组特殊功能寄存器(SFR,Special Function Register)。    使用Eclipse环境调试MCU程序时,可以利用 Peripheral Registers Viewer来查看SFR。这个小工具是怎样知道某个型号的MCU有怎样的寄存器定义呢?它使用一种描述性的文本文件——SVD文件。这个文件存储在下面红色字体的路径下。    例:南京沁恒  &n
    电子知识打边炉 2025-01-04 20:04 100浏览
  • 彼得·德鲁克被誉为“现代管理学之父”,他的管理思想影响了无数企业和管理者。然而,关于他的书籍分类,一种流行的说法令人感到困惑:德鲁克一生写了39本书,其中15本是关于管理的,而其中“专门写工商企业或为企业管理者写的”只有两本——《为成果而管理》和《创新与企业家精神》。这样的表述广为流传,但深入探讨后却发现并不完全准确。让我们一起重新审视这一说法,解析其中的矛盾与根源,进而重新认识德鲁克的管理思想及其著作的真正价值。从《创新与企业家精神》看德鲁克的视角《创新与企业家精神》通常被认为是一本专为企业管
    优思学院 2025-01-06 12:03 119浏览
  • PLC组态方式主要有三种,每种都有其独特的特点和适用场景。下面来简单说说: 1. 硬件组态   定义:硬件组态指的是选择适合的PLC型号、I/O模块、通信模块等硬件组件,并按照实际需求进行连接和配置。    灵活性:这种方式允许用户根据项目需求自由搭配硬件组件,具有较高的灵活性。    成本:可能需要额外的硬件购买成本,适用于对系统性能和扩展性有较高要求的场合。 2. 软件组态   定义:软件组态主要是通过PLC
    丙丁先生 2025-01-06 09:23 85浏览
  • 根据环洋市场咨询(Global Info Research)项目团队最新调研,预计2030年全球无人机锂电池产值达到2457百万美元,2024-2030年期间年复合增长率CAGR为9.6%。 无人机锂电池是无人机动力系统中存储并释放能量的部分。无人机使用的动力电池,大多数是锂聚合物电池,相较其他电池,锂聚合物电池具有较高的能量密度,较长寿命,同时也具有良好的放电特性和安全性。 全球无人机锂电池核心厂商有宁德新能源科技、欣旺达、鹏辉能源、深圳格瑞普和EaglePicher等,前五大厂商占有全球
    GIRtina 2025-01-07 11:02 71浏览
  • 本文介绍Linux系统更换开机logo方法教程,通用RK3566、RK3568、RK3588、RK3576等开发板,触觉智能RK3562开发板演示,搭载4核A53处理器,主频高达2.0GHz;内置独立1Tops算力NPU,可应用于物联网网关、平板电脑、智能家居、教育电子、工业显示与控制等行业。制作图片开机logo图片制作注意事项(1)图片必须为bmp格式;(2)图片大小不能大于4MB;(3)BMP位深最大是32,建议设置为8;(4)图片名称为logo.bmp和logo_kernel.bmp;开机
    Industio_触觉智能 2025-01-06 10:43 87浏览
  • By Toradex 秦海1). 简介嵌入式平台设备基于Yocto Linux 在开发后期量产前期,为了安全以及提高启动速度等考虑,希望将 ARM 处理器平台的 Debug Console 输出关闭,本文就基于 NXP i.MX8MP ARM 处理器平台来演示相关流程。 本文所示例的平台来自于 Toradex Verdin i.MX8MP 嵌入式平台。  2. 准备a). Verdin i.MX8MP ARM核心版配合Dahlia载板并
    hai.qin_651820742 2025-01-07 14:52 45浏览
  • 大模型的赋能是指利用大型机器学习模型(如深度学习模型)来增强或改进各种应用和服务。这种技术在许多领域都显示出了巨大的潜力,包括但不限于以下几个方面: 1. 企业服务:大模型可以用于构建智能客服系统、知识库问答系统等,提升企业的服务质量和运营效率。 2. 教育服务:在教育领域,大模型被应用于个性化学习、智能辅导、作业批改等,帮助教师减轻工作负担,提高教学质量。 3. 工业智能化:大模型有助于解决工业领域的复杂性和不确定性问题,尽管在认知能力方面尚未完全具备专家级的复杂决策能力。 4. 消费
    丙丁先生 2025-01-07 09:25 80浏览
  • 自动化已成为现代制造业的基石,而驱动隔离器作为关键组件,在提升效率、精度和可靠性方面起到了不可或缺的作用。随着工业技术不断革新,驱动隔离器正助力自动化生产设备适应新兴趋势,并推动行业未来的发展。本文将探讨自动化的核心趋势及驱动隔离器在其中的重要角色。自动化领域的新兴趋势智能工厂的崛起智能工厂已成为自动化生产的新标杆。通过结合物联网(IoT)、人工智能(AI)和机器学习(ML),智能工厂实现了实时监控和动态决策。驱动隔离器在其中至关重要,它确保了传感器、执行器和控制单元之间的信号完整性,同时提供高
    腾恩科技-彭工 2025-01-03 16:28 170浏览
  • 村田是目前全球量产硅电容的领先企业,其在2016年收购了法国IPDiA头部硅电容器公司,并于2023年6月宣布投资约100亿日元将硅电容产能提升两倍。以下内容主要来自村田官网信息整理,村田高密度硅电容器采用半导体MOS工艺开发,并使用3D结构来大幅增加电极表面,因此在给定的占位面积内增加了静电容量。村田的硅技术以嵌入非结晶基板的单片结构为基础(单层MIM和多层MIM—MIM是指金属 / 绝缘体/ 金属) 村田硅电容采用先进3D拓扑结构在100um内,使开发的有效静电容量面积相当于80个
    知白 2025-01-07 15:02 75浏览
  • 随着市场需求不断的变化,各行各业对CPU的要求越来越高,特别是近几年流行的 AIOT,为了有更好的用户体验,CPU的算力就要求更高了。今天为大家推荐由米尔基于瑞芯微RK3576处理器推出的MYC-LR3576核心板及开发板。关于RK3576处理器国产CPU,是这些年的骄傲,华为手机全国产化,国人一片呼声,再也不用卡脖子了。RK3576处理器,就是一款由国产是厂商瑞芯微,今年第二季推出的全新通用型的高性能SOC芯片,这款CPU到底有多么的高性能,下面看看它的几个特性:8核心6 TOPS超强算力双千
    米尔电子嵌入式 2025-01-03 17:04 55浏览
  • 每日可见的315MHz和433MHz遥控模块,你能分清楚吗?众所周知,一套遥控设备主要由发射部分和接收部分组成,发射器可以将控制者的控制按键经过编码,调制到射频信号上面,然后经天线发射出无线信号。而接收器是将天线接收到的无线信号进行解码,从而得到与控制按键相对应的信号,然后再去控制相应的设备工作。当前,常见的遥控设备主要分为红外遥控与无线电遥控两大类,其主要区别为所采用的载波频率及其应用场景不一致。红外遥控设备所采用的射频信号频率一般为38kHz,通常应用在电视、投影仪等设备中;而无线电遥控设备
    华普微HOPERF 2025-01-06 15:29 127浏览
我要评论
0
点击右上角,分享到朋友圈 我知道啦
请使用浏览器分享功能 我知道啦