S7-200SMART 圆形轨迹的算法及程序

（一）电气设备

（1）原理图：Q0.0为X轴脉冲，Q0.2为X轴方向；Q0.1为y轴脉冲，Q0.7为y轴方向

（2）实物图：三个步进驱动器，三套电机配合丝杆，定义往电机方向移动为正方向，丝杆的逻辑为4mm，步进驱动的细分设置为3200个脉冲一转。如下图所示：

（二）走圆轨迹算法

西门子S7-200SMART系列PLC不支持圆弧插补功能，所以需要自己根据算法进行计算后分别驱动X轴和Y轴的移动从而来实现画圆功能，要驱动XY轴画圆，可采用极限逼近法，把画圆弧变成画线段，如下图所示左侧为六等分，角度a=30°，右侧为十二等分，角度a=15°。

从上图中可以看出，当等边多边形的边越多时，则多边形的轨迹就越和圆相近，所以当角度a足够小时，则得到的多边形轨迹就越与圆接近。根据以上分析需要完成画圆功能，我们需要知道“圆心坐标值”、“圆的半径”、“画圆的速度”，然后根据分为三部分来实现：

1、画笔移动到圆上

把XY轴分别回原点，回原点后的位置默认为XY平面坐标的原点，然后由原点移动到圆心坐标，如下图所示1#点为圆心，2#点为圆上点。

假设1#点的坐标为（X1，Y1），速度为V，则X轴移动的距离为X1，Y轴移动的距离为Y1。根据勾股定理可计算出原点到圆心的距离“Y(0→1)”、X轴移动速度“VXaxis”和Y轴移动速度“VYaxis” ，计算公式如下所示：

当画笔到达1#点后，然后Y轴不动，X轴以V的速度移动半径R的距离到达圆上2#点位置，假2#点的坐标为（X2，Y2）

2、画笔开始画圆

画笔从2#点位置开始移动画圆，假设下个圆上的点为3#点，坐标为（X3,Y3），从圆心到3#点和从圆心到2#点的角度为a，如下图所示：

根据三角函数可计算出3#点的坐标（X3，Y3）的值分别为：

X3=Cos（a）*R+X1，Y3=Sin（a）*R+Y1

根据勾股定理可计算出XY轴要移动的距离 “Y(2→3)”的值。X轴移动速度“VXaxis”和Y轴移动速度“VYaxis” ，计算公式如下所示：

注：此时X2和Y2为X轴和Y轴的当前位置，X3和Y3为X轴和Y轴要移动的目标位置,速度需要取绝对值。

同理：当画笔到达3#点后，角度变为2a，则对应的圆上点为4#点，坐标为（X4，Y4），如下图所示：

根据三角函数可计算出4#点的坐标（X4，Y4）的值分别为：

X4=Cos（2a）*R+X1，Y4=Sin（2a）*R+Y1

根据勾股定理可计算出XY轴要移动的距离 “Y(3→4)”的值。X轴移动速度“VXaxis”和Y轴移动速度“VYaxis” ，计算公式如下所示：

注：此时X3和Y3为X轴和Y轴的当前位置，X4和Y4为X轴和Y轴要移动的目标位置，速度需要取绝对值。

依次下去，每走完一次后，角度自加一次，当角度值大于360°时，则认为画圆完成。

（三）PLC程序

根据分析，对于S7-200SMART系列PLC的程序设计主要分为“运动向导的组态配置”、“初始与会原点程序”、“速度计算程序”、“开始画圆程序”

（1）初始化和回原点

（2）速度换算程序

（3）画圆程序

子程序结构

程序运行

【延伸阅读】S7-200 SMART 运动控制指令详解

S7-200 smart 运动控制指令由编程软件向导生成，运动控制指令有很多条构成，且每条指令都带有很多接口参数，想要使用这些指令，要先知道接口是什么意思，虽然帮助文章都有解释，但读懂帮助文件也很费劲，今天就详细给大家介绍运动指令的使用。

S7-200 SMRAT 运动控制指令如下图生成：

1、选择"运动"右键打开。

2、本次就以"轴0"为例。

3、命个名字。

4、数字1位选择工程单位，可以使工程单位，也可以使用脉冲。

数字2是电机旋转一圈的脉冲量，我目前步进拨码设定是10000个脉冲旋转一周

数字3是单位，根据自己需要设定

数字4是电机旋转一圈的工程量，我设定的是360度，也就是说10000个脉冲对应360度。

5、方向控制，我是用的脉冲加方向，所以选择单项2轴。

6、正负极限根据需要设定，我这个没有正负极限就没有选择。

7、零电位使用，走绝对位置和相对位置之前一定要定义好原点，否则绝对位置和相对位置不运行。

8、0脉冲位置，也可以使用此点定义0点。

9、停止根据需要选择，通过阅读STP就能理解什么意思。

10、停止根据需要选择，通过阅读TRIG就能理解什么意思。

11、禁用根据需要选择，通过阅读DIS就能理解什么意思。

12、最大速度和最小速度根据现场情况设定，我设定最大速度为360度/秒。

13、JOG命令也就是手动运行，根据需要设定速度，建议设定小一些，看看运行速度再调整。

14、此处设定加减速时间，也就是脉冲输出的加减速时间，根据现场情况设定。

15、急停补偿。

16、反冲补偿，也就是校准丝杠间隙。

17、参考点设定

18、找零点时速度和方向设定。

19、偏移量设定

20、搜索参考点方式选择

21、从驱动器中读取绝对位置

22、曲线设定，我这里没用曲线，没有生成曲线。

23、点"建议"自动分配地址。

24、组件

25、映射显示

26、完成，点击生成就完成了。

1．启用并初始化轴

AXISx_CTRL子程序（控制）启用和初始化运动轴，方法是自动命令运动轴每CPU更改为RUN模式时加载组态/曲线表。在项目中只对每条运动轴使用此子程序一次，并确保程序会在每次扫描时调用此子程序。使用SM0.0（始终开启）作为EN参数的输入。

管脚含义：

MODE：启用模块。1=可发送命令；0=中止进行中的任何命令

Done：完成标志位

Error：错误代码（字节）

C_Pos：轴的当前位置（绝对定位或者相对定位），工程单位：Real型数据；相对脉冲：DINT型数据

C_Speed：轴的当前速度，Real型数据

C_Dir：轴的当前方向（1=反向，0=正向）

2.手动控制轴

AXISx_MAN子例程（手动模式）将运动轴置为手动模式。这允许电机按不同的速度运行，或沿正向或负向慢进。在同一时间仅能启用RUN、JOG_P或JOG_N输入之一。

管脚含义：

RUN：1=轴手动运行（速度和方向分别由Speed和Dir管脚控制）0=停止手动控制

JOG_P：1=正转点动控制

JOG_N：1=反转点动控制

Speed：RUN运行时的目标速度，Real型数据

Dir：RUN运行时的方向

Error：错误代码（字节）

C_Pos：轴当前位置（绝对定位或者相对定位），工程单位：Real型数据；相对脉冲：DINT型数据

C_Speed：轴当前速度，Real型数据

C_Dir：轴的当前方向（1=反向，0=正向）

3、查找参考点

走绝对位置和相对位置前需要找到真实的零点，绝对位置和相对位置才能根据零点运行。

AXISx_RSEEK子程序（搜索参考点位置）使用组态/曲线表中的搜索方法启动参考点搜索操作。运动轴找到参考点且运动停止后，运动轴将RP_OFFSET参数值载入当前位置。

管脚含义：

START：每接通一个扫描周期，就执行一次查找参考点（参考点查找方式由轴组态确定）

Done：完成标志位

Error：错误代码（字节）

4.绝对或者相对定位

AXISx_GOTO子程序命令运动轴转到所需位置。

管脚含义：

START：每接通一个扫描周期，就执行一次定位

Pos：目标位置（绝对定位为坐标点，相对定位为两点间距离），工程单位：Real型数据；相对脉冲：DINT型数据

Speed：目标速度，Real型数据

MODE：移动模式0：绝对位置 1：相对位置 2：单速连续 正向旋转 3：单速连续反向旋转

Abort：停止正在执行的运动

Done：完成标志位

Error：错误代码（字节）

C_Pos：轴当前位置（绝对定位或者相对定位），工程单位：Real型数据；相对脉冲：DINT型数据

C_Speed：轴当前速度，Real型数据

如何用西门子PLC和上位机实现自动画圆？

【导读】用S7-200SMART和博途WinCC实现自动画圆。

需求分析

设计一个画圆程序，即求圆周上的点的坐标值，根据求得的坐标值绘制圆形，并在上位机上动态显示绘制过程。

功能设计

根据以上需求进行如下设计：

1.启动Start按钮按下，开始绘制，利用定时中断，每隔100ms计算一次坐标值。

2.把坐标值保存为历史记录，并作为f(x)趋势视图的数据源，在趋势视图中动态显示画圆过程。

3.清除Clear按钮按下，清除趋势视图中已经绘制的图形。

4.再次按下启动Start按钮，将重新绘制圆形。

开发环境

硬件：SR20，6ES7 288-1SR20-0AA0。

软件：STEP 7-Micro/WIN SMART，V2.5，WinCC Professional V16。

程序设计

编写代码（LAD）。

1.编写计算坐标子程序。

由于COS和SIN指令的输入参数接受弧度值，所以需要先进行角度到弧度的转换。

2.编写定时中断子程序。

调用计算坐标子程序，角度从0°开始，每隔100ms增加1°，到达360°时（一周），则复位为0°，重新计算。

3.编写主程序。

启动按钮M0.0按下，启动100ms定时中断，调用定时中断子程序，并初始化坐标值。清除按钮M0.1按下，停止定时中断程序。

人机交互HMI设计

在WinCC Professional中设计一个人机交互画面，通过该画面进行操作和动态绘制圆形，从而得到直观的测试结果。

1.添加HMI硬件，TP700 Comfort面板。

2.建立连接。

通信驱动程序选择SIMATIC S7 200，接口选择以太网，HMI的IP地址设置为电脑的IP地址，PLC设备的IP地址设置为在线的PLC的IP地址。如果连接失败，请检查PG/PC接口设置。

3.添加变量，和PLC变量地址相对应。

4.建立数据记录。

5.设计画面。

按照上图设计，不再赘述。

6.为启动Start按钮添加事件属性。

7.为清除Clear按钮添加事件属性。

7.为f(x)趋势视图添加数据源。

关闭f(x)趋势图控件中的工具栏、状态栏和网格线等。

系统测试

在TIA Portal WinCC Professional中启动运行系统。

按下启动Start按钮，开始圆形绘制，按下清除Clear按钮，清除趋势视图中已经绘制的图形。

相关问答

s7-200plc有没有圆计算指令?

S7-200系列西门子PLC具有丰富的内置集成功能,其中包括许多用于处理数据的指令,但是并不包括圆计算指令。S7-200系列PLC主要用于基本的逻辑控制、顺序控制和定...

plc点数什么意思?

PLC的点数就是PLC上面输入输出接线端子的数量总和。点数估算:I/O点数估算时应考虑适当的余量,通常根据统计的输入输出点数,再增加10%~20%的可扩展余量后,作...

连接PLC数据线的类别及各种接头的名称-ZOL问答

PLC通讯,常用的有串行通讯,以太网通讯,现场总线通讯。串行通讯里,分为D口和USB口。D口为九针口型,针的叫公型口,口的叫母型,有三种协议,分别为:RS232,RS422和...

三菱gt1030-lbd-c和plc通信线怎么做，两头都是圆的_汽配人问答

[最佳回答]发生---接收接收--发生GND--GND应该可以直接接RS232口和PLC编程口直接相接。

支持插补的plc有哪些?

支持插补的PLC包括:西门子S7-1200、S7-1500和S7-300系列;罗克韦尔Automation的ControlLogix和CompactLogix系列;倍福A...

三菱PLC通信口是不是用232的?

三菱PLC通信口圆8针的都是RS422的,可以使用SC09通讯电缆进行通讯。如果使用RS232通讯扩展板和通讯扩展模块可以与电脑进行RS232通讯。并且可以使用DB9插头座制...

CNC怎么手动编写铣平面程序-ZOL问答

aqiang1168床编程与操作4.1数控车床简介4.1.1数控车床概述数控车床作为当...能够通过程序控制自动完成内外圆柱面、锥面、圆弧、螺纹等工序的切削加工,并进...

英语翻译该方案主要利用TMS6437嵌入式主板、相机、光源、触...

[回答]ThisschemeismainlyusedTMS6437embeddedmainboards,cameras,lamp-house,touchscreensandPLCtob...

PLC电路接线图-盖德问答-化工人互助问答社区

k1,k2,k3,k4的出线和k5,k6,k7,k8的进线是不连的,所以没有电源的正负极短接,不会击穿二极管。通常交叉线中间画一个实心圆是表示相连,没有就表示是...

信捷PLC数据线与三菱PLC数据线可共用吗-懂得

不可以的,两个共用品牌的端口定义是不一样的。一个是圆的,一个是串口的形状就不一样。信捷PLC通信口是RS232通信格式,三菱PLC通信口是RS422通信格式...