CN105045199A - 一种基于plc的丝杆回程误差检测补偿方法 - Google Patents

一种基于plc的丝杆回程误差检测补偿方法 Download PDF

Info

Publication number
CN105045199A
CN105045199A CN201510339652.2A CN201510339652A CN105045199A CN 105045199 A CN105045199 A CN 105045199A CN 201510339652 A CN201510339652 A CN 201510339652A CN 105045199 A CN105045199 A CN 105045199A
Authority
CN
China
Prior art keywords
microswitch
plc
stepper motor
slide
pulse value
Prior art date
Legal status (The legal status is an assumption and is not a legal conclusion. Google has not performed a legal analysis and makes no representation as to the accuracy of the status listed.)
Granted
Application number
CN201510339652.2A
Other languages
English (en)
Other versions
CN105045199B (zh
Inventor
刘媛媛
冯宏伟
Current Assignee (The listed assignees may be inaccurate. Google has not performed a legal analysis and makes no representation or warranty as to the accuracy of the list.)
Wuxi Zhuoxin Intellectual Property Service Co.,Ltd.
Original Assignee
Wuxi Professional College of Science and Technology
Priority date (The priority date is an assumption and is not a legal conclusion. Google has not performed a legal analysis and makes no representation as to the accuracy of the date listed.)
Filing date
Publication date
Application filed by Wuxi Professional College of Science and Technology filed Critical Wuxi Professional College of Science and Technology
Priority to CN201510339652.2A priority Critical patent/CN105045199B/zh
Publication of CN105045199A publication Critical patent/CN105045199A/zh
Application granted granted Critical
Publication of CN105045199B publication Critical patent/CN105045199B/zh
Active legal-status Critical Current
Anticipated expiration legal-status Critical

Links

Classifications

    • GPHYSICS
    • G05CONTROLLING; REGULATING
    • G05BCONTROL OR REGULATING SYSTEMS IN GENERAL; FUNCTIONAL ELEMENTS OF SUCH SYSTEMS; MONITORING OR TESTING ARRANGEMENTS FOR SUCH SYSTEMS OR ELEMENTS
    • G05B19/00Programme-control systems
    • G05B19/02Programme-control systems electric
    • G05B19/04Programme control other than numerical control, i.e. in sequence controllers or logic controllers
    • G05B19/05Programmable logic controllers, e.g. simulating logic interconnections of signals according to ladder diagrams or function charts
    • G05B19/058Safety, monitoring
    • GPHYSICS
    • G05CONTROLLING; REGULATING
    • G05BCONTROL OR REGULATING SYSTEMS IN GENERAL; FUNCTIONAL ELEMENTS OF SUCH SYSTEMS; MONITORING OR TESTING ARRANGEMENTS FOR SUCH SYSTEMS OR ELEMENTS
    • G05B2219/00Program-control systems
    • G05B2219/10Plc systems
    • G05B2219/16Plc to applications
    • G05B2219/163Domotique, domestic, home control, automation, smart, intelligent house

Landscapes

  • Physics & Mathematics (AREA)
  • General Physics & Mathematics (AREA)
  • Engineering & Computer Science (AREA)
  • Automation & Control Theory (AREA)
  • Control Of Stepping Motors (AREA)
  • Length Measuring Devices With Unspecified Measuring Means (AREA)

Abstract

本发明涉及梯形丝杆螺母传动的回程误差技术领域,具体为一种基于PLC的丝杆回程误差检测补偿方法,一种基于PLC的丝杆回程误差检测补偿方法,其能够方便地检测出回程误差,并根据回程误差调节程序参数达到弥补误差的作用,实现精确定位,成本低,将需要检测的丝杆连接步进电机的输出端,步进电机输入端通过步进电机驱动器连接PLC控制器,在丝杆一侧安装可滑动的检测微动开关,检测微动开关电控连接PLC控制器,在丝杆螺母上安装与检测微动开关接触配合的滑座,然后开始回程误差检测补偿步骤。

Description

一种基于PLC的丝杆回程误差检测补偿方法
技术领域
本发明涉及梯形丝杆螺母传动的回程误差技术领域,具体为一种基于PLC的丝杆回程误差检测补偿方法。
背景技术
梯形丝杆螺母传动是较常用的传动形式,虽然存在不可避免的回程误差,但由于价格便宜,总体性价比高,在机电设备中应用广泛。在实际操作过程中可以采用增加机械调整装置的方法弥补回程误差,调整装置机械结构比较复杂,而且成本较高。
发明内容
为了解决上述问题,本发明提供了一种基于PLC的丝杆回程误差检测补偿方法,其能够方便地检测出回程误差,并根据回程误差调节程序参数达到弥补误差的作用,实现精确定位,成本低。
其技术方案是这样的:一种基于PLC的丝杆回程误差检测补偿方法,其特征在于,将需要检测的丝杆连接步进电机的输出端,步进电机输入端通过步进电机驱动器连接PLC控制器,在丝杆一侧安装可滑动的检测微动开关,检测微动开关电控连接PLC控制器,在丝杆螺母上安装与检测微动开关接触配合的滑座,回程误差检测补偿步骤如下所述:
(1)启动步进电机正向运行,步进电机工作驱动滑座移动至梯形丝杆螺母需要检测回程误差的检测点处,将检测微动开关移动至其滚轮与滑座接触,检测微动开关的动作簧片不处于压下的临界点,触点开关不闭合,记录检测微动开关的滚轮与滑座的接触点和此时PLC控制器输出的脉冲值n1;
(2)启动步进电机反向运行,步进电机继续工作驱动滑座反向移动,当滑座压下检测微动开关的动作簧片使触点开关闭合时,检测微动开关控制步进电机停止工作,记录此时PLC控制器输出的脉冲值n2,并计算脉冲值n2与脉冲值n1的差值n3;
(3)将检测微动开关从检测点处移走,启动步进电机正向运行,步进电机工作驱动滑座向前移动越过检测点一定距离,然后启动步进电机使其反向工作,步进电机驱动滑座反向移动至检测点处,移动检测微动开关使其滚轮与滑座接触,接触点与步骤(1)中接触点为同一位置,检测微动开关的动作簧片不处于压下的临界点,触点开关不闭合,记录此时PLC控制器输出的脉冲值n4;
(4)启动步进电机反向运行,步进电机工作驱动滑座反向移动,当滑座压下检测微动开关的动作簧片使触点开关闭合时,检测微动开关控制步进电机停止工作,记录此时PLC控制器输出的脉冲值n5,并计算脉冲值n5与脉冲值n4的差值n6;
(5)回程误差△计算公式为△=(n3-n6)/B*L,其中B为步进电机每转步数,L为丝杆导程;
(6)步进电机驱动梯形丝杆螺母改变运动方向时通过PLC控制器增加或减少回程误差所对应的脉冲值来进行补偿。
其进一步特征在于,所述丝杆一侧还设置有与检测微动开关对应的原点定位微动开关;
所述PLC控制器连接触摸显示屏;
所述滑座下端刻有定位刻度。
采用本发明的方法后,可以方便地得出梯形丝杆回程误差,根据回程误差调节程序参数达到弥补误差的作用,实现精确定位,无需其他机械装置等,成本低。
附图说明
图1为本发明方法实现的装置示意图;
图2为本发明检测补偿步骤流程示意图;
图3为本发明检测点A处示意图;
图4为Q0_0_CTRL示意图;
图5为使用本发明进行物料取料放料示意图;
图6为自动定位程序部分示意图。
具体实施方式
见图1,图2,图3所示,一种基于PLC的丝杆回程误差检测补偿方法,将需要检测的丝杆1连接步进电机2的输出端,步进电机2输入端通过步进电机驱动器3连接PLC控制器4,PLC控制器4连接触摸显示屏5,可以实时显示状态,PLC控制器4采用西门子S7-200系列PLC作为控制器,S7-200系列PLC控制器本体PTO提供了应用库MAPSERVQ0.0和MAPSERVQ0.1,分别用于Q0.0和Q0.1的脉冲串输出,MAP库各个块的功能简要介绍如下:Q0_X_CTRL,参数定义和控制;Q0_X_MoveRelative,执行一次相对位移运动;Q0_X_MoveAbsolute,执行一次绝对位移运动;Q0_X_MoveVelocity,按预设速度运动;Q0_X_Home,寻找参考点位置,Q0_X_Stop,停止运动;编程调试时,首先编写手动程序对机械手X轴进行定位移动,X轴的传动由梯形丝杆螺母带动,在Q0_0_CTRL中定义X轴当前位置C-Pos对应脉冲值存在VD1000中,具体见图4所示,触摸显示屏实时显示VD1000中的脉冲值,将需要检测的每个X轴的坐标位置记录下来;
在丝杆1一侧安装可滑动的检测微动开关6,丝杆1端部还设置有与检测微动开关6对应的原点定位微动开关7,检测微动开关、原点定位微动开关7分别电控连接PLC控制器4,其中检测微动开关6常开触点连接PLC控制器4的输入口I1.0,在梯形丝杆螺母上安装与检测微动开关6接触配合的滑座8,滑座8上刻有刻度,精度为1mm,设梯形丝杆螺母从右往左移动方向为正向移动,回程误差检测补偿步骤如下:
(1)启动步进电机2正向运行,步进电机2工作驱动滑座8移动至梯形丝杆螺母需要检测回程误差的检测点A处,移动检测微动开关6使其滚轮与滑座8接触,检测微动开关6的动作簧片不处于压下的临界点,触点开关不闭合,记录检测微动开关6的滚轮与滑座8的接触点和此时PLC控制器4输出的脉冲值n1,脉冲值n1存于VD1000;
(2)启动步进电机2反向运行,步进电机2工作驱动滑座8反向移动,当滑座8压下检测微动开关的动作簧片使触点开关闭合时,输入口I1.0有信号时调用Q0_0_Stop,让X轴停止运动,即检测微动开关6控制步进电机2停止工作,记录此时PLC控制器4输出的脉冲值n2,脉冲值n2存于VD1000,并计算脉冲值n2与脉冲值n1的差值n3;
(3)将检测微动开关6从检测点A处移走,启动步进电机2正向运行,步进电机2工作驱动滑座8正向移动越过检测点A一定距离,然后启动步进电机2使其反向工作,步进电机2驱动滑座8从左向右,即反向移动至检测点A处,移动检测微动开关6使其的滚轮与滑座8接触,接触点与步骤(1)中接触点为同一点,检测微动开关6的动作簧片不处于压下的临界点,触点开关不闭合,记录此时PLC控制器4输出的脉冲值n4,脉冲值n4存于VD1000;
(4)启动步进电机2反向运行,步进电机2继续工作驱动滑座8反向移动,当滑座8压下检测微动开关6的动作簧片使触点开关闭合时,检测微动开关6控制步进电机2停止工作,记录此时PLC控制器4输出的脉冲值n5,脉冲值n5存于VD1000,并计算脉冲值n5与脉冲值n4的差值n6;
(5)回程误差△计算公式为△=(n3-n6)/B*L,其中B为步进电机2每转步数,L为丝杆导程;
(6)步进电机2驱动梯形丝杆螺母改变运动方向时通过PLC控制器4增加或减少回程误差所对应的脉冲值来进行补偿;具体补偿方法如下所述:设右侧的原点定位微动开关7作为坐标原点,从右往左移动方向为正向移动,从左往右移动方向为反向移动,如果某一点M处对应脉冲值为N1,回程误差的对应脉冲值为N2,从正向切换到反向运动移至M点时,通过PLC控制器设定的脉冲值为(N1-N2),从反向切换到正向运动移至M点时,通过PLC控制器设定的脉冲值为(N1+N2)。
下面具体举例说明:见图5,图6所示,丝杆螺母需从坐标原点移至物料站9取料,再返回二号仓位B点放料,以右侧原点定位微动开关7处为坐标原点,测得二号仓位B点对应的脉冲值为18600,在正向切换到反向运行时设定存储位X轴坐标VD500值为18600-100=18500,反向多退回100脉冲的位置以弥补回程误差。如果是由反向切换到正向,则VD500应设定为18600+100=18700。
这边只是说明了X轴向上的回程误差的检测补偿,与X轴垂直的Z轴同样可以采用上述方法实现,图6中有Z轴自动定位程序部分。

Claims (4)

1.一种基于PLC的丝杆回程误差检测补偿方法,其特征在于,将需要检测的丝杆连接步进电机的输出端,步进电机输入端通过步进电机驱动器连接PLC控制器,在丝杆一侧安装可滑动的检测微动开关,检测微动开关电控连接PLC控制器,在丝杆螺母上安装与检测微动开关接触配合的滑座,回程误差检测补偿步骤如下所述:
(1)启动步进电机正向运行,步进电机工作驱动滑座移动至梯形丝杆螺母需要检测回程误差的检测点处,将检测微动开关移动至其滚轮与滑座接触,检测微动开关的动作簧片不处于压下的临界点,触点开关不闭合,记录检测微动开关的滚轮与滑座的接触点和此时PLC控制器输出的脉冲值n1;
(2)启动步进电机反向运行,步进电机继续工作驱动滑座反向移动,当滑座压下检测微动开关的动作簧片使触点开关闭合时,检测微动开关控制步进电机停止工作,记录此时PLC控制器输出的脉冲值n2,并计算脉冲值n2与脉冲值n1的差值n3;
(3)将检测微动开关从检测点处移走,启动步进电机正向运行,步进电机工作驱动滑座向前移动越过检测点一定距离,然后启动步进电机使其反向工作,步进电机驱动滑座反向移动至检测点处,移动检测微动开关使其滚轮与滑座接触,接触点与步骤(1)中接触点为同一位置,检测微动开关的动作簧片不处于压下的临界点,触点开关不闭合,记录此时PLC控制器输出的脉冲值n4;
(4)启动步进电机反向运行,步进电机工作驱动滑座反向移动,当滑座压下检测微动开关的动作簧片使触点开关闭合时,检测微动开关控制步进电机停止工作,记录此时PLC控制器输出的脉冲值n5,并计算脉冲值n5与脉冲值n4的差值n6;
(5)回程误差△计算公式为△=(n3-n6)/B*L,其中B为步进电机每转步数,L为丝杆导程;
(6)步进电机驱动梯形丝杆螺母改变运动方向时通过PLC控制器增加或减少回程误差所对应的脉冲值来进行补偿。
2.根据权利要求1所述的一种基于PLC的丝杆回程误差检测补偿方法,其特征在于,所述丝杆一侧还设置有与检测微动开关对应的原点定位微动开关。
3.根据权利要求1所述的一种基于PLC的丝杆回程误差检测补偿方法,其特征在于,所述PLC控制器连接触摸显示屏。
4.根据权利要求1所述的一种基于PLC的丝杆回程误差检测补偿方法,其特征在于,所述滑座下端刻有定位刻度。
CN201510339652.2A 2015-06-18 2015-06-18 一种基于plc的丝杆回程误差检测补偿方法 Active CN105045199B (zh)

Priority Applications (1)

Application Number Priority Date Filing Date Title
CN201510339652.2A CN105045199B (zh) 2015-06-18 2015-06-18 一种基于plc的丝杆回程误差检测补偿方法

Applications Claiming Priority (1)

Application Number Priority Date Filing Date Title
CN201510339652.2A CN105045199B (zh) 2015-06-18 2015-06-18 一种基于plc的丝杆回程误差检测补偿方法

Publications (2)

Publication Number Publication Date
CN105045199A true CN105045199A (zh) 2015-11-11
CN105045199B CN105045199B (zh) 2017-08-01

Family

ID=54451813

Family Applications (1)

Application Number Title Priority Date Filing Date
CN201510339652.2A Active CN105045199B (zh) 2015-06-18 2015-06-18 一种基于plc的丝杆回程误差检测补偿方法

Country Status (1)

Country Link
CN (1) CN105045199B (zh)

Cited By (9)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
CN106547279A (zh) * 2016-12-08 2017-03-29 深圳市合信自动化技术有限公司 一种具有单向定位功能的伺服驱动器的定位方法
CN107470978A (zh) * 2017-10-18 2017-12-15 广东正业科技股份有限公司 一种丝杠及其轴向补偿系统与方法
CN107770419A (zh) * 2016-08-17 2018-03-06 奥林巴斯株式会社 观察装置、观察方法和观察系统
CN110185769A (zh) * 2019-05-14 2019-08-30 深圳画贝智能科技有限公司 一种同步带装置的校准方法
CN112650014A (zh) * 2020-12-24 2021-04-13 四川长虹电器股份有限公司 投影设备调焦马达回程误差的计算方法及投影控制系统
CN112737437A (zh) * 2020-12-25 2021-04-30 安徽大学 用于空间光学载荷步进电机定位的微动开关位置调整方法
CN113604996A (zh) * 2021-09-15 2021-11-05 汝州玛雅机电科技有限公司 绣花机换色控制方法和电子设备
CN113865472A (zh) * 2021-09-27 2021-12-31 中信科移动通信技术股份有限公司 电调天线回程误差计算方法及系统
CN111158406B (zh) * 2019-12-20 2023-05-09 上海力申科学仪器有限公司 一种标定流量调节装置的机械间隙的控制系统及方法

Citations (7)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
US20050278130A1 (en) * 2002-01-07 2005-12-15 Siemens Energy & Automation, Inc. Systems, methods, and devices for generating pulses
CN1936753A (zh) * 2006-10-19 2007-03-28 南京埃斯顿工业自动化有限公司 用于剪扳机、折弯机后挡料定位补偿的方法和系统
JP2007213341A (ja) * 2006-02-09 2007-08-23 Seiko Instruments Inc プログラマブルロジックコントローラ、情報処理装置、制御プログラム、およびテーブル作成プログラム
CN101334655A (zh) * 2007-06-25 2008-12-31 西门子工厂自动化工程有限公司 数控加工中的位移补偿装置和位移补偿方法
CN101564819A (zh) * 2008-12-25 2009-10-28 贵州科邦科技实业有限责任公司 一种数控机床数控轴位移精度的连续补偿方法
JP2010242971A (ja) * 2010-06-07 2010-10-28 Thk Co Ltd ボールねじを用いた減衰装置
CN104529141A (zh) * 2014-12-17 2015-04-22 上海维宏电子科技股份有限公司 玻璃切割系统中实现间距自动补偿的方法

Patent Citations (7)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
US20050278130A1 (en) * 2002-01-07 2005-12-15 Siemens Energy & Automation, Inc. Systems, methods, and devices for generating pulses
JP2007213341A (ja) * 2006-02-09 2007-08-23 Seiko Instruments Inc プログラマブルロジックコントローラ、情報処理装置、制御プログラム、およびテーブル作成プログラム
CN1936753A (zh) * 2006-10-19 2007-03-28 南京埃斯顿工业自动化有限公司 用于剪扳机、折弯机后挡料定位补偿的方法和系统
CN101334655A (zh) * 2007-06-25 2008-12-31 西门子工厂自动化工程有限公司 数控加工中的位移补偿装置和位移补偿方法
CN101564819A (zh) * 2008-12-25 2009-10-28 贵州科邦科技实业有限责任公司 一种数控机床数控轴位移精度的连续补偿方法
JP2010242971A (ja) * 2010-06-07 2010-10-28 Thk Co Ltd ボールねじを用いた減衰装置
CN104529141A (zh) * 2014-12-17 2015-04-22 上海维宏电子科技股份有限公司 玻璃切割系统中实现间距自动补偿的方法

Non-Patent Citations (3)

* Cited by examiner, † Cited by third party
Title
刘媛媛 等: "基于伺服电机和PLC的工作台运动控制", 《机械工程与自动化》 *
李继中: "数控机床螺距误差补偿与分析", 《工艺与装备》 *
王建平 等: "利用PLC脉冲输出和高速计数功能实现轴的精确定位控制", 《沈阳建筑大学学报(自然科学版)》 *

Cited By (12)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
CN107770419A (zh) * 2016-08-17 2018-03-06 奥林巴斯株式会社 观察装置、观察方法和观察系统
CN106547279A (zh) * 2016-12-08 2017-03-29 深圳市合信自动化技术有限公司 一种具有单向定位功能的伺服驱动器的定位方法
CN106547279B (zh) * 2016-12-08 2019-10-25 深圳市合信自动化技术有限公司 一种具有单向定位功能的伺服驱动器的定位方法
CN107470978A (zh) * 2017-10-18 2017-12-15 广东正业科技股份有限公司 一种丝杠及其轴向补偿系统与方法
CN107470978B (zh) * 2017-10-18 2019-07-09 广东正业科技股份有限公司 一种丝杠及其轴向补偿系统与方法
CN110185769A (zh) * 2019-05-14 2019-08-30 深圳画贝智能科技有限公司 一种同步带装置的校准方法
CN111158406B (zh) * 2019-12-20 2023-05-09 上海力申科学仪器有限公司 一种标定流量调节装置的机械间隙的控制系统及方法
CN112650014A (zh) * 2020-12-24 2021-04-13 四川长虹电器股份有限公司 投影设备调焦马达回程误差的计算方法及投影控制系统
CN112737437A (zh) * 2020-12-25 2021-04-30 安徽大学 用于空间光学载荷步进电机定位的微动开关位置调整方法
CN113604996A (zh) * 2021-09-15 2021-11-05 汝州玛雅机电科技有限公司 绣花机换色控制方法和电子设备
CN113865472A (zh) * 2021-09-27 2021-12-31 中信科移动通信技术股份有限公司 电调天线回程误差计算方法及系统
CN113865472B (zh) * 2021-09-27 2023-10-27 中信科移动通信技术股份有限公司 电调天线回程误差计算方法及系统

Also Published As

Publication number Publication date
CN105045199B (zh) 2017-08-01

Similar Documents

Publication Publication Date Title
CN105045199A (zh) 一种基于plc的丝杆回程误差检测补偿方法
CN102553968B (zh) 水箱拉丝机排线机构的位置误差消除方法及装置
CN102118128A (zh) 一种对步进电机精确定位的控制方法及装置
CN103760921B (zh) 低精度多个传感器融合的原点精确定位系统及定位方法
CN203791144U (zh) 一种自动点胶机
CN103123042A (zh) 可变气容装置
CN202720488U (zh) 基于plc的折弯机的自动控制系统
CN100504696C (zh) 用于剪扳机、折弯机后挡料定位补偿的方法和系统
CN104807424B (zh) 一种接触式管内焊缝余高测量装置
CN109257002A (zh) 一种基于伺服驱动的往复运动的原点检测控制方法
CN203465564U (zh) 一种电脑横机摇床控制系统及其摇床电机专用编码器
CN103940347B (zh) 增量式光栅尺故障检测装置及其检测方法
CN101844174B (zh) 冲压机械装置
CN102385311B (zh) 电液线速度数字伺服系统的控制方法
CN104374356A (zh) 一种位移传感器动态标定方法
CN105909624A (zh) 一种电液混合伺服系统
CN205087497U (zh) 一种用于移动治具的设备
CN201275725Y (zh) 数控珩磨机往复行程控制装置
CN103699054B (zh) 工业直线运动机构的快速精确预测定位方法及定位系统
CN205977867U (zh) 一种电液混合伺服系统用推杆油缸装置
CN205721324U (zh) 机控设备、控制系统及驱动装置、控制装置
CN109397298B (zh) 一种并联机器人初始位置标定方法
CN109366468B (zh) 一种机器人自动示教方法和自动示教系统
CN109434837B (zh) 一种并联机器人初始位置标定装置
CN103163412A (zh) 电线加速度试验机

Legal Events

Date Code Title Description
C06 Publication
PB01 Publication
C10 Entry into substantive examination
SE01 Entry into force of request for substantive examination
GR01 Patent grant
GR01 Patent grant
TR01 Transfer of patent right
TR01 Transfer of patent right

Effective date of registration: 20240529

Address after: Room 603, Building B, No. 4 Longshan Road, Xinwu District, Wuxi City, Jiangsu Province, 214000

Patentee after: Wuxi Zhuoxin Intellectual Property Service Co.,Ltd.

Country or region after: China

Address before: New District Wuxi city Jiangsu province 214028 Xi Road No. 8

Patentee before: WUXI PROFESSIONAL College OF SCIENCE AND TECHNOLOGY

Country or region before: China